AC_AttControl: relax earth frame rate targets along with bf

This commit is contained in:
Randy Mackay 2015-07-27 16:37:10 +09:00
parent 72c8f411d7
commit 0bf1d04172

View File

@ -80,6 +80,7 @@ void AC_AttitudeControl::relax_bf_rate_controller()
// ensure zero error in body frame rate controllers
const Vector3f& gyro = _ahrs.get_gyro();
_rate_bf_target = gyro * AC_ATTITUDE_CONTROL_DEGX100;
frame_conversion_bf_to_ef(_rate_bf_target, _rate_ef_desired);
_pid_rate_roll.reset_I();
_pid_rate_pitch.reset_I();