Browse Source

AC_AttitudeControl: update throttle rpy mix on every iteration

master
Randy Mackay 9 years ago
parent
commit
b7431b7d0c
  1. 3
      libraries/AC_AttitudeControl/AC_AttitudeControl.cpp

3
libraries/AC_AttitudeControl/AC_AttitudeControl.cpp

@ -395,6 +395,9 @@ void AC_AttitudeControl::attitude_controller_run_quat(const Quaternion& att_targ @@ -395,6 +395,9 @@ void AC_AttitudeControl::attitude_controller_run_quat(const Quaternion& att_targ
void AC_AttitudeControl::rate_controller_run()
{
// move throttle vs attitude mixing towards desired (called from here because this is conveniently called on every iteration)
update_throttle_rpy_mix();
_motors.set_roll(rate_bf_to_motor_roll(_ang_vel_target_rads.x));
_motors.set_pitch(rate_bf_to_motor_pitch(_ang_vel_target_rads.y));
_motors.set_yaw(rate_bf_to_motor_yaw(_ang_vel_target_rads.z));

Loading…
Cancel
Save