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

PosVelFilter/PosVelFilter.hpp

Committer:
mkelly10
Date:
2017-10-20
Revision:
9:d5fcdcb3c89d
Child:
10:085ab7328054

File content as of revision 9:d5fcdcb3c89d:

#ifndef MBED_DEPTHFILTER_H
#define MBED_DEPTHFILTER_H

#include "mbed.h"

class PosVelFilter
{
public:
    PosVelFilter();
    
    void update(float deltaT, float counts);
    
    void init();
    
    float getPosition();
    float getVelocity();
    float getDt();
    
 //   void setConfigFlag();
    void writeWn(float wn);
    
protected:
    float x1;
    float x2;
    float x2_dot;
    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