Library version of MPU9250AHRS code.
Fork of MPU9250AHRS by
AHRS.h@4:404c35f32ce3, 2014-09-04 (annotated)
- Committer:
- janekm
- Date:
- Thu Sep 04 21:19:05 2014 +0000
- Revision:
- 4:404c35f32ce3
- Child:
- 5:ea541d293095
turning it into more of a library...
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
janekm | 4:404c35f32ce3 | 1 | #ifndef __AHRS_H_ |
janekm | 4:404c35f32ce3 | 2 | #define __AHRS_H_ |
janekm | 4:404c35f32ce3 | 3 | |
janekm | 4:404c35f32ce3 | 4 | #define Kp 2.0f * 5.0f // these are the free parameters in the Mahony filter and fusion scheme, Kp for proportional feedback, Ki for integral |
janekm | 4:404c35f32ce3 | 5 | #define Ki 0.0f |
janekm | 4:404c35f32ce3 | 6 | |
janekm | 4:404c35f32ce3 | 7 | void MadgwickQuaternionUpdate(float ax, float ay, float az, float gx, float gy, float gz, float mx, float my, float mz, float deltat, float *q, float beta); |
janekm | 4:404c35f32ce3 | 8 | void MahonyQuaternionUpdate(float ax, float ay, float az, float gx, float gy, float gz, float mx, float my, float mz, float deltat, float *q); |
janekm | 4:404c35f32ce3 | 9 | |
janekm | 4:404c35f32ce3 | 10 | #endif // __AHRS_H_ |