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:
42:d6217332ce19
Parent:
40:ccdd34615533
--- a/System/StaticDefs.cpp	Wed Feb 14 21:10:51 2018 +0000
+++ b/System/StaticDefs.cpp	Wed Feb 14 21:47:31 2018 +0000
@@ -55,7 +55,7 @@
 }
 
 IMU & imu() {
-    static IMU imu(p13,p14); // tx, rx pin
+    static IMU imu(p28,p27); // tx, rx pin
     return imu;    
 }