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:
85:dd8176285b6e
Parent:
84:eccd8e837134
Child:
87:6d95f853dab3
--- a/StateMachine/StateMachine.hpp	Tue Feb 19 20:11:43 2019 +0000
+++ b/StateMachine/StateMachine.hpp	Mon Feb 25 21:26:34 2019 +0000
@@ -25,7 +25,8 @@
     LEG_POSITION_RISE,
     TX_MBED_LOG,
     RX_SEQUENCE,
-    FB_EXIT
+    FB_EXIT,
+    ENDLEG_WAIT
 };
  
 // find_neutral finite state machine enumerations
@@ -135,7 +136,7 @@
     float _pitch_reading;       // pitch reading (to get the readings at the same time)   
     float _timer_reading;       // pitch reading (to get the readings at the same time)
     
-    Timer _fsm_timer;               //timing variable used in class
+    Timer _fsm_timer;               //timing variable used in class  how do I know this is seconds?
     Timer _yotimer;                // timer for each yo in a yoyo leg
     
     volatile int _state;                 // current state of Finite State Machine (FSM)