Browse Source

FlightTaskUtility: remove duplicate slewrate

sbg
Dennis Mannhart 7 years ago committed by Beat Küng
parent
commit
d64b59b95f
  1. 7
      src/lib/FlightTasks/tasks/Utility/ManualSmoothingXY.cpp

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

@ -63,6 +63,8 @@ ManualSmoothingXY::smoothVelocity(matrix::Vector2f &vel_sp, const matrix::Vector
_updateAcceleration(vel_sp, vel, yaw, yawrate_sp, dt); _updateAcceleration(vel_sp, vel, yaw, yawrate_sp, dt);
_velocitySlewRate(vel_sp, dt); _velocitySlewRate(vel_sp, dt);
_vel_sp_prev = vel_sp;
} }
void void
@ -106,11 +108,6 @@ ManualSmoothingXY::_updateAcceleration(matrix::Vector2f &vel_sp, const matrix::V
* intention. Jerk is only used for braking. * intention. Jerk is only used for braking.
*/ */
_getStateAcceleration(vel_sp, vel, intention, dt); _getStateAcceleration(vel_sp, vel, intention, dt);
/* Smooth velocity setpoint based on acceleration */
_velocitySlewRate(vel_sp, dt);
_vel_sp_prev = vel_sp;
} }
ManualSmoothingXY::Intention ManualSmoothingXY::Intention

Loading…
Cancel
Save