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:
75:92e79d23d29a
Parent:
74:d281aaef9766
--- a/IMU/IMU.cpp	Tue Aug 14 21:06:48 2018 +0000
+++ b/IMU/IMU.cpp	Thu Aug 16 13:57:19 2018 +0000
@@ -195,15 +195,15 @@
 }
 
 float IMU::getRoll() {
-    return -1*euler[0];
+    return euler[0];
 }
 
 float IMU::getPitch() {
-    return -1*euler[1];
+    return euler[1];
 }
 
 float IMU::getHeading() {
-    return -1*euler[2];
+    return euler[2];    //
 }
 
 bool IMU::getIsValid2dFix() {