most functionality to splashdwon, find neutral and start mission. short timeouts still in code for testing, will adjust to go directly to sit_idle after splashdown
--- a/main.cpp Wed Nov 22 23:04:11 2017 +0000 +++ b/main.cpp Thu Nov 23 02:20:08 2017 +0000 @@ -83,6 +83,9 @@ - Fixed issue with keyboard function, the keyboard function was continuously active instead of checking pc readable in sit idle - Bench tested neutral finding sequence and multi-dive sequence, so far so good - Question: Why do we want the keyboard and FSM to run together, specifically allowing the FSM call the keyboard? + Modified 2017-11-22 by Dan + - added ability for substate NEUTRAL_CHECK_PITCH to move the battery toward level, then saves offsets. + - added new entry state NEUTRAL_FIRST_PITCH that also moves the battery toward level, but doesn't save. */ #include "mbed.h"