mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-27 04:53:33 +08:00
mc_att_control: reset yaw setpoint after ACRO
This commit is contained in:
@@ -803,6 +803,9 @@ MulticopterAttitudeControl::task_main()
|
|||||||
_rates_sp = math::Vector<3>(_manual_control_sp.y, -_manual_control_sp.x, _manual_control_sp.r).emult(_params.acro_rate_max);
|
_rates_sp = math::Vector<3>(_manual_control_sp.y, -_manual_control_sp.x, _manual_control_sp.r).emult(_params.acro_rate_max);
|
||||||
_thrust_sp = _manual_control_sp.z;
|
_thrust_sp = _manual_control_sp.z;
|
||||||
|
|
||||||
|
/* reset yaw setpoint after ACRO */
|
||||||
|
_reset_yaw_sp = true;
|
||||||
|
|
||||||
/* publish attitude rates setpoint */
|
/* publish attitude rates setpoint */
|
||||||
_v_rates_sp.roll = _rates_sp(0);
|
_v_rates_sp.roll = _rates_sp(0);
|
||||||
_v_rates_sp.pitch = _rates_sp(1);
|
_v_rates_sp.pitch = _rates_sp(1);
|
||||||
|
|||||||
Reference in New Issue
Block a user