12345678910111213141516171819202122232425262728293031323334 |
- //=====================================================================================================
- // MadgwickAHRS.h
- //=====================================================================================================
- //
- // Implementation of Madgwick's IMU and AHRS algorithms.
- // See: http://www.x-io.co.uk/node/8#open_source_ahrs_and_imu_algorithms
- //
- // Date Author Notes
- // 29/09/2011 SOH Madgwick Initial release
- // 02/10/2011 SOH Madgwick Optimised for reduced CPU load
- //
- //=====================================================================================================
- #ifndef MadgwickAHRS_h
- #define MadgwickAHRS_h
- //----------------------------------------------------------------------------------------------------
- // Variable declaration
- // extern volatile float q0, q1, q2, q3; // quaternion of sensor frame
- // relative to auxiliary frame
- //---------------------------------------------------------------------------------------------------
- // Function declarations
- void MadgwickAHRSupdate(float gx, float gy, float gz, float ax, float ay,
- float az, float mx, float my, float mz);
- void MadgwickAHRSupdateIMU(float gx, float gy, float gz, float ax, float ay,
- float az, float *pitch, float *roll, float *yaw);
- void MadgwickAHRSetBeta(float beta);
- #endif
- //=====================================================================================================
- // End of file
- //=====================================================================================================
|