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:
23:434f04ef1fad
Parent:
22:a10ee088403b
Child:
24:c7d9b5bf3829
diff -r a10ee088403b -r 434f04ef1fad StateMachine/StateMachine.hpp
--- a/StateMachine/StateMachine.hpp	Thu Nov 23 02:20:08 2017 +0000
+++ b/StateMachine/StateMachine.hpp	Tue Nov 28 18:00:09 2017 +0000
@@ -106,6 +106,9 @@
     float _pitch_KP;
     float _pitch_KI;
     float _pitch_KD;
+    
+    int _state_array[1024];                    //print out the states
+    int _state_array_counter;
 };
  
 #endif
\ No newline at end of file