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