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:
52:f207567d3ea4
--- a/ServoDriver_new/ServoDriver.hpp	Mon Jul 30 16:48:48 2018 +0000
+++ b/ServoDriver_new/ServoDriver.hpp	Tue Aug 14 21:06:48 2018 +0000
@@ -11,6 +11,8 @@
     void neutralPosition(float input_neutral_position);
     void setPosition_deg(float input_position);
     
+    void setPWM(float input_pwm);     // 8/2/2018
+    
     float slope();
 
     void setMinPWM(float pwm_input);
@@ -19,8 +21,8 @@
     void setMinDeg(float deg);
     void setMaxDeg(float deg);
     
-    float getPosition_deg();
-    float getPosition_pwm();
+    float getSetPosition_deg();
+    float getSetPosition_pwm();
     
     void init();
     
@@ -44,6 +46,8 @@
     float _min_deg;
     float _max_deg;
     
+    volatile bool _paused;
+    
     float _degrees_set_position;
     
     volatile unsigned int _valid_servo_position_pwm;      //signal in microseconds, for example 1580 microseconds (close to center of servo)