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:
10:085ab7328054
Parent:
9:d5fcdcb3c89d
Child:
87:6d95f853dab3
--- a/PosVelFilter/PosVelFilter.hpp	Fri Oct 20 11:41:22 2017 +0000
+++ b/PosVelFilter/PosVelFilter.hpp	Mon Oct 23 12:50:53 2017 +0000
@@ -1,5 +1,5 @@
-#ifndef MBED_DEPTHFILTER_H
-#define MBED_DEPTHFILTER_H
+#ifndef POSVELFILTER_H
+#define POSVELFILTER_H
 
 #include "mbed.h"
 
@@ -16,7 +16,6 @@
     float getVelocity();
     float getDt();
     
- //   void setConfigFlag();
     void writeWn(float wn);
     
 protected:
@@ -26,17 +25,9 @@
     float x1_dot;
     float w_n; 
     
-    //float last_time;
-    //float curr_time;
     float dt;
-    
-    float conv_distance;
     float position;
     float velocity;
-    
- //   bool readConfiguration();
- //   bool configFlag;
- //   int count;
 };
 
 #endif
\ No newline at end of file