mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-02 03:49:12 +08:00
Commander: Fix modes switching back to prev mode
This commit is contained in:
@@ -2590,15 +2590,12 @@ int commander_thread_main(int argc, char *argv[])
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/* reset main state after takeoff or land has been completed */
|
/* reset main state after takeoff has completed */
|
||||||
/* only switch back to at least altitude controlled modes */
|
/* only switch back to posctl */
|
||||||
if (main_state_prev == commander_state_s::MAIN_STATE_POSCTL ||
|
if (main_state_prev == commander_state_s::MAIN_STATE_POSCTL) {
|
||||||
main_state_prev == commander_state_s::MAIN_STATE_ALTCTL) {
|
|
||||||
|
|
||||||
if ((internal_state.main_state == commander_state_s::MAIN_STATE_AUTO_TAKEOFF
|
if (internal_state.main_state == commander_state_s::MAIN_STATE_AUTO_TAKEOFF
|
||||||
&& mission_result.finished) ||
|
&& mission_result.finished) {
|
||||||
(internal_state.main_state == commander_state_s::MAIN_STATE_AUTO_LAND
|
|
||||||
&& land_detector.landed)) {
|
|
||||||
|
|
||||||
main_state_transition(&status, main_state_prev, main_state_prev, &status_flags, &internal_state);
|
main_state_transition(&status, main_state_prev, main_state_prev, &status_flags, &internal_state);
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user