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:
57:ec69651c8c21
Parent:
55:f4ec445c42fe
Child:
58:94b7fd55185e
--- a/StateMachine/StateMachine.hpp	Tue Jun 12 16:20:03 2018 +0000
+++ b/StateMachine/StateMachine.hpp	Thu Jun 14 16:10:25 2018 +0000
@@ -47,7 +47,8 @@
     
     int runStateMachine();
     
-    void showMenu();
+    void showSimpleMenu();  // simple menu
+    void showDebugMenu();   // debug menu
     
     void keyboard();
     
@@ -103,6 +104,8 @@
     float getFloatUserInput();
     
 private:
+    bool _debug_menu_on;         // default is false to show simple menu, debug allows more tuning and has a lot of keyboard commands
+
     int _timeout;                // generic timeout for every state, seconds
     float _pitchTolerance;       // pitch angle tolerance for neutral finding exit criteria
     float _bceFloatPosition;     // bce position for "float" states
@@ -166,6 +169,9 @@
     
     float _data_log[9];
     
+    float _BCE_position_command;                    // NEW COMMANDS FOR POSITION CONTROLLER
+    float _BMM_position_command;                    // NEW COMMANDS FOR POSITION CONTROLLER
+    
     volatile bool _file_closed;
 };