|
|
@ -761,10 +761,12 @@ MulticopterAttitudeControl::task_main() |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
} else { |
|
|
|
} else { |
|
|
|
/* attitude controller disabled */ |
|
|
|
/* attitude controller disabled, poll rates setpoint topic */ |
|
|
|
// TODO poll 'attitude_rates_setpoint' topic
|
|
|
|
vehicle_rates_setpoint_poll(); |
|
|
|
_rates_sp.zero(); |
|
|
|
_rates_sp(0) = _v_rates_sp.roll; |
|
|
|
_thrust_sp = 0.0f; |
|
|
|
_rates_sp(1) = _v_rates_sp.pitch; |
|
|
|
|
|
|
|
_rates_sp(2) = _v_rates_sp.yaw; |
|
|
|
|
|
|
|
_thrust_sp = _v_rates_sp.thrust; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
if (_v_control_mode.flag_control_rates_enabled) { |
|
|
|
if (_v_control_mode.flag_control_rates_enabled) { |
|
|
|