diff options
author | Julian Oes <joes@student.ethz.ch> | 2013-02-21 13:06:56 -0800 |
---|---|---|
committer | Julian Oes <joes@student.ethz.ch> | 2013-02-21 13:06:56 -0800 |
commit | ebe0285ce7964ac1a81a65bae417e978cf366466 (patch) | |
tree | 4ed1344991cee2e50906df7023c4440378d23b65 /apps/commander/commander.c | |
parent | 0e29f2505a599d473244b0bb7e4b309d392ebb3c (diff) | |
download | px4-firmware-ebe0285ce7964ac1a81a65bae417e978cf366466.tar.gz px4-firmware-ebe0285ce7964ac1a81a65bae417e978cf366466.tar.bz2 px4-firmware-ebe0285ce7964ac1a81a65bae417e978cf366466.zip |
Checkpoint: navigation state machine as discussed with Lorenz
Diffstat (limited to 'apps/commander/commander.c')
-rw-r--r-- | apps/commander/commander.c | 16 |
1 files changed, 2 insertions, 14 deletions
diff --git a/apps/commander/commander.c b/apps/commander/commander.c index 8b9e7c49c..4e2b4907b 100644 --- a/apps/commander/commander.c +++ b/apps/commander/commander.c @@ -1319,7 +1319,7 @@ int commander_thread_main(int argc, char *argv[]) /* make sure we are in preflight state */ memset(¤t_status, 0, sizeof(current_status)); - current_status.navigation_state = NAVIGATION_STATE_STANDBY; + current_status.navigation_state = NAVIGATION_STATE_INIT; current_status.arming_state = ARMING_STATE_INIT; current_status.hil_state = HIL_STATE_OFF; current_status.flag_system_armed = false; @@ -1857,19 +1857,7 @@ int commander_thread_main(int argc, char *argv[]) } /* Now it's time to handle the stick inputs */ - - if (current_status.arming_state == ARMING_STATE_ARMED) { - - if (current_status.mode_switch == MODE_SWITCH_MANUAL) { - do_navigation_state_update(stat_pub, ¤t_status, mavlink_fd, NAVIGATION_STATE_MANUAL ); - } else if (current_status.mode_switch == MODE_SWITCH_SEATBELT) { - do_navigation_state_update(stat_pub, ¤t_status, mavlink_fd, NAVIGATION_STATE_SEATBELT ); - } else if (current_status.mode_switch == MODE_SWITCH_AUTO) { - if (current_status.navigation_state == NAVIGATION_STATE_MANUAL) { - do_navigation_state_update(stat_pub, ¤t_status, mavlink_fd, NAVIGATION_STATE_MISSION ); - } - } - } + navigation_state_update(stat_pub, ¤t_status, mavlink_fd); /* handle the case where RC signal was regained */ if (!current_status.rc_signal_found_once) { |