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:
39:58375ca6b6ff
Parent:
36:966a86937e17
--- a/MbedLogger/MbedLogger.cpp	Thu Dec 21 17:05:35 2017 +0000
+++ b/MbedLogger/MbedLogger.cpp	Thu Dec 21 23:13:44 2017 +0000
@@ -12,14 +12,9 @@
     _fp = fopen("/local/LOG000.csv", "w");
     
     //write the header
-    fprintf(_fp,"state_string,state_ID,timer,depth_cmd,depth(ft),pitch_cmd,pitch(deg), bce_cmd, bce(mm), batt_cmd, batt(mm)\n");
+    fprintf(_fp,"state_ID,timer,depth_cmd,depth(ft),pitch_cmd,pitch(deg), bce_cmd, bce(mm), batt_cmd, batt(mm)\n");
     
-    //file pointer is a class variable, close the file after you are done writing to it    
-}
-
-void MbedLogger::saveDataToFile(string string_state, int input_state, float *input) {    
-    //write to the file (header and data)
-    fprintf(_fp, "%s,%d,%0.1f,%0.1f,%0.1f,%0.1f,%0.1f,%0.1f,%0.1f,%0.1f,%0.1f\n",string_state.c_str(),input_state,input[0],input[1],input[2],input[3],input[4],input[5],input[6],input[7],input[8]);
+    //the file pointer is a class variable, close the file after you are done writing to it    
 }
 
 void MbedLogger::saveDataToFile(int input_state, float *input) {