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:
57:ec69651c8c21
Parent:
56:48a8a5a65b82
Child:
65:2ac186553959
--- a/System/StaticDefs.cpp	Tue Jun 12 16:20:03 2018 +0000
+++ b/System/StaticDefs.cpp	Thu Jun 14 16:10:25 2018 +0000
@@ -71,8 +71,13 @@
     return depth;
 }
 
+//IMU & imu() {
+//    static IMU imu(p13, p14);       // tx, rx pin
+//    return imu;    
+//}
+
 IMU & imu() {
-    static IMU imu(p13, p14);       // tx, rx pin
+    static IMU imu(p28, p27);       // tx, rx pin
     return imu;    
 }