fw-atune: fix immediate failure on first try

The flight mode needs to be updated before starting the autotune,
otherwise it appears as a mode change and aborts the autotune
This commit is contained in:
bresch authored and Mathieu Bresciani committed 2025-08-04 16:42:54 +02:00
1 parent 8c6337e94e
commit 77e8ccaf6a
1 file changed
+9 -9
@@ -98,15 +98,6 @@ void FwAutotuneAttitudeControl::Run()
updateStateMachine(hrt_absolute_time());
}
_aux_switch_en = isAuxEnableSwitchEnabled();
// new control data needed every iteration
if ((_state == state::idle && !_aux_switch_en)
|| !_vehicle_torque_setpoint_sub.updated()) {
return;
}
if (_vehicle_status_sub.updated()) {
vehicle_status_s vehicle_status;
@@ -116,6 +107,15 @@ void FwAutotuneAttitudeControl::Run()
}
}
_aux_switch_en = isAuxEnableSwitchEnabled();
// new control data needed every iteration
if ((_state == state::idle && !_aux_switch_en)
|| !_vehicle_torque_setpoint_sub.updated()) {
return;
}
if (_actuator_controls_status_sub.updated()) {
actuator_controls_status_s controls_status;