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:
65:2ac186553959
Parent:
57:ec69651c8c21
Child:
66:0f20870117b7
--- a/System/StaticDefs.cpp	Mon Jun 18 21:04:09 2018 +0000
+++ b/System/StaticDefs.cpp	Tue Jun 19 18:10:50 2018 +0000
@@ -71,11 +71,6 @@
     return depth;
 }
 
-//IMU & imu() {
-//    static IMU imu(p13, p14);       // tx, rx pin
-//    return imu;    
-//}
-
 IMU & imu() {
     static IMU imu(p28, p27);       // tx, rx pin
     return imu;