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:
85:dd8176285b6e
Parent:
84:eccd8e837134
Child:
86:ba3a118b0080
--- a/MbedLogger/MbedLogger.cpp	Tue Feb 19 20:11:43 2019 +0000
+++ b/MbedLogger/MbedLogger.cpp	Mon Feb 25 21:26:34 2019 +0000
@@ -127,7 +127,9 @@
     else if (current_state == LEG_POSITION_RISE) 
         string_state = "LEG_POS_RISE";
     else if (current_state == FB_EXIT) 
-        string_state = "FB_EXIT";        
+        string_state = "FB_EXIT"; 
+    else if (current_state == ENDLEG_WAIT) 
+        string_state = "ENDLEG_WAIT";        
         
     string blank_space = ""; //to get consistent spacing in the file (had a nonsense char w/o this)
     
@@ -135,7 +137,8 @@
     
     //verified that this generates the correct line length of 254 using SOLELY an mbed 08/16/2018
     fprintf(_fp, "%17s,%.2d,%10d,%5.1f,%5.1f,%6.1f,%6.1f,%4.0f,%4.0f,%6.1f,%5.1f,%6.1f,%5.1f,%6.1f,%6.1f,%6.1f,%6.3f,%6.2f,%5.0f,%6.2f,%5.3f,%5.3f,%5.3f,%5.3f,%5.3f,%5.3f,%6.2f,%5.3f,%5.3f,%4.1f,%4.1f,%5.3f,%5.3f,%5.3f,%5.3f,%5.3f,%5.3f,%4.1f,%4.1f\n",
-    string_state.c_str(),current_state,data_log_time-start_time,
+    string_state.c_str(),current_state,
+    data_log_time-start_time,   //note offset relative to start 
     _data_log[0],_data_log[1],_data_log[2],_data_log[3],_data_log[4],_data_log[5],_data_log[6],_data_log[7],_data_log[8],_data_log[9],_data_log[10],_data_log[11],_data_log[12],_data_log[13],_data_log[14],_data_log[15],
     _data_log[16],_data_log[17],_data_log[18],_data_log[19],_data_log[20],_data_log[21],_data_log[22],_data_log[23],_data_log[24],_data_log[25],_data_log[26],_data_log[27],_data_log[28],_data_log[29],_data_log[30],
     _data_log[31],_data_log[32],_data_log[33],_data_log[34],_data_log[35]);