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:
27:0a5b90cd65d6
Parent:
24:c7d9b5bf3829
Child:
28:16c83a2fdefa
--- a/StateMachine/StateMachine.hpp	Wed Nov 29 17:56:34 2017 +0000
+++ b/StateMachine/StateMachine.hpp	Wed Nov 29 22:37:47 2017 +0000
@@ -69,7 +69,6 @@
     
 private:
     int _timeout;                // generic timeout for every state, seconds
-    float depthTolerance;       // depth tolerance for neutral finding exit critera
     float pitchTolerance;       // pitch angle tolerance for neutral finding exit criteria
     float bceFloatPosition;     // bce position for "float" states
     float battFloatPosition;    // batt position for "broadcast" state