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:
19:aaa0f4f29d50
Parent:
18:85a7535af8fd
Child:
20:8987a9ae2bc7
--- a/StateMachine/StateMachine.cpp	Wed Nov 22 00:06:48 2017 +0000
+++ b/StateMachine/StateMachine.cpp	Wed Nov 22 00:08:03 2017 +0000
@@ -510,7 +510,7 @@
                 output_substate = NEUTRAL_CHECK_PITCH;
             }
             
-            //before the sub-fsm runs again, make sure the piston is in a safe position (retracted)
+            //before the sub-fsm runs again, make sure the piston is in a safe position (extended)
             //NEW: need to double-check this behavior
             //need to set a max travel position ? or just hardcode? or use bceFloatPosition?
             if (bce().getPosition_mm() >= 320) {