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