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

Dependencies:   mbed MODSERIAL FATFileSystem

Revision:
88:1813f583cee9
Parent:
87:6d95f853dab3
--- a/StateMachine/StateMachine.cpp	Wed May 08 13:24:04 2019 +0000
+++ b/StateMachine/StateMachine.cpp	Thu May 09 14:26:40 2019 +0000
@@ -2630,6 +2630,11 @@
     _state   = currentLegStateStruct.state;
     // _multi_leg_counter += 1;  // this is wrong, because this subroutine is called multiple times on the same leg, I need indicator of 'next_leg', first.
 }
+void StateMachine::setstate_frommain(int set_state_val, int new_timeout) {  // used for setting state from main, when find_neutral has not been run
+    _state = set_state_val;
+    _timeout = new_timeout;
+    }
+
 
 void StateMachine::printCurrentSdLog() {
     xbee().printf("SD card log work in progress\r\n");