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

exPosVelFilter/ex_hPosVelFilter.txt

Committer:
joel_ssc
Date:
2019-05-13
Revision:
92:52a91656458a
Parent:
87:6d95f853dab3

File content as of revision 92:52a91656458a:

#ifndef POSVELFILTER_H
#define POSVELFILTER_H

#include "mbed.h"

class PosVelFilter
{
public:
    PosVelFilter();
    
    void update(float deltaT, float counts);
    
    void init();
    
    float getPosition();
    float getVelocity();
    float getDt();
    
    void writeWn(float wn);
    
protected:
    float x1;
    float x2;
    float x2_dot;
    float x1_dot;
    float w_n; 
    
    float dt;
    float position;
    float velocity;
};

#endif