Skip to content

Commit d64b59b

Browse files
Stifaelbkueng
authored andcommitted
FlightTaskUtility: remove duplicate slewrate
1 parent c1bb0cb commit d64b59b

File tree

1 file changed

+2
-5
lines changed

1 file changed

+2
-5
lines changed

src/lib/FlightTasks/tasks/Utility/ManualSmoothingXY.cpp

Lines changed: 2 additions & 5 deletions
Original file line numberDiff line numberDiff line change
@@ -63,6 +63,8 @@ ManualSmoothingXY::smoothVelocity(matrix::Vector2f &vel_sp, const matrix::Vector
6363
_updateAcceleration(vel_sp, vel, yaw, yawrate_sp, dt);
6464

6565
_velocitySlewRate(vel_sp, dt);
66+
67+
_vel_sp_prev = vel_sp;
6668
}
6769

6870
void
@@ -106,11 +108,6 @@ ManualSmoothingXY::_updateAcceleration(matrix::Vector2f &vel_sp, const matrix::V
106108
* intention. Jerk is only used for braking.
107109
*/
108110
_getStateAcceleration(vel_sp, vel, intention, dt);
109-
110-
/* Smooth velocity setpoint based on acceleration */
111-
_velocitySlewRate(vel_sp, dt);
112-
113-
_vel_sp_prev = vel_sp;
114111
}
115112

116113
ManualSmoothingXY::Intention

0 commit comments

Comments
 (0)