att_control: remove resetting the attitude setpoint

since the position controller publishes them again already when disarmed.
This commit is contained in:
Matthias Grob
2019-11-24 11:06:03 -05:00
committed by Daniel Agar
parent d3bd251ffc
commit 28755d5bbf
2 changed files with 0 additions and 22 deletions
@@ -247,13 +247,6 @@ void
MulticopterAttitudeControl::control_attitude()
{
_v_att_sp_sub.update(&_v_att_sp);
// reinitialize the setpoint while not armed to make sure no value from the last mode or flight is still kept
if (!_v_control_mode.flag_armed) {
Quatf().copyTo(_v_att_sp.q_d);
Vector3f().copyTo(_v_att_sp.thrust_body);
}
_rates_sp = _attitude_control.update(Quatf(_v_att.q), Quatf(_v_att_sp.q_d), _v_att_sp.yaw_sp_move_rate);
}