fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-28 16:04:06 +08:00
Code Issues Packages Projects Releases Wiki Activity

commander: move valid mission check inside

Browse Source 
I think it makes more sense to move this check inside of
main_state_transition.
This commit is contained in:
Julian Oes 2021-05-06 14:32:45 +02:00 committed by Matthias Grob
parent 916ffef04c
commit 52563264e6
2 changed files with 7 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
src/modules/commander/Commander.cpp
View File

@ -813,13 +813,7 @@ Commander::handle_command(const vehicle_command_s &cmd)
break;
case PX4_CUSTOM_SUB_MODE_AUTO_MISSION:
if (_status_flags.condition_auto_mission_available) {
desired_main_state = commander_state_s::MAIN_STATE_AUTO_MISSION;
} else {
main_ret = TRANSITION_DENIED;
}
desired_main_state = commander_state_s::MAIN_STATE_AUTO_MISSION;
break;
case PX4_CUSTOM_SUB_MODE_AUTO_RTL:

8
src/modules/commander/state_machine_helper.cpp
View File

@ -368,9 +368,13 @@ main_state_transition(const vehicle_status_s &status, const main_state_t new_mai
case commander_state_s::MAIN_STATE_AUTO_MISSION:
if (!status_flags.condition_auto_mission_available) {
ret = TRANSITION_DENIED;
}
/* need global position, home position, and a valid mission */
if (status_flags.condition_global_position_valid &&
status_flags.condition_auto_mission_available) {
else if (status_flags.condition_global_position_valid &&
status_flags.condition_auto_mission_available) {
ret = TRANSITION_CHANGED;
}