NOT FINISHED YET!!! My first try to get a self built fully working Quadrocopter based on an mbed, a self built frame and some other more or less cheap parts.
Diff: IMU_Filter/IMU_Filter.h
- Revision:
- 30:021e13b62575
- Parent:
- 27:9e546fa47c33
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/IMU_Filter/IMU_Filter.h Sun Feb 10 22:08:10 2013 +0000 @@ -0,0 +1,22 @@ +// by MaEtUgR + +#ifndef IMU_FILTER_H +#define IMU_FILTER_H + +#include "mbed.h" + +#define Rad2Deg 57.295779513082320876798154814105 // factor between radians and degrees of angle (180/Pi) + +class IMU_Filter +{ + public: + IMU_Filter(); + void compute(unsigned long dt, const float * gyro_data, const int * acc_data); + float angle[3]; // calculated values of the position [0: x,roll | 1: y,pitch | 2: z,yaw] + private: + float d_Gyro_angle[3]; + void get_Acc_angle(const int * Acc_data); + float Acc_angle[3]; +}; + +#endif \ No newline at end of file