Skip to content

A quaternion based sensor fusion algorithm that fuses accelerometers and gyroscopes and optionally magnetometers

License

Notifications You must be signed in to change notification settings

bjohnsonfl/Madgwick_Filter

Folders and files

NameName
Last commit message
Last commit date

Latest commit

 

History

15 Commits
 
 
 
 
 
 
 
 
 
 
 
 
 
 

Repository files navigation

Madgwick Filter

The paper can be found here. My explanation of the filter can be found on my website here, just scroll down to the Madgwick Filter section.

Brief Description

An IMU is a sensor suite complete with an accelerometer and gyroscope. A MARG contains an IMU plus a Magnetometer. All three of these sensors measure physical qualities of Earth's fields or orientation due to angular momentum. Alone, these sensors have faults thats that the other sensors can make up for. One problem is when a sensor has an axis aligned with Earth's field which prevents using trig functions to determine orientation due to tan(90) being undefined. The fusion of sensors is critical for accuracy of orientation and for a complete transformation from the sensor's inertial frame to the Earth frame.

The Madgwick Filter fuses the IMU and optonally the MARG. It does this by using gradient descent to optimize a Quaternion that orients accelerometer data to a known reference of gravity. This quaternion is weighted and integrated with the gyroscope quaternion and previous orientation. This result is normalized and and converted to Euler angles.

A Quaternion is a 4 dimensional number, an extension of the complex plane. It has a real component and 3 imaginary components. Rather than rotate about 3 axes, the quaternion rotates a certain amount of degrees about a vector. The math is ridiculously simple (in quaternion form) compared to euler rotation matrices. My website link above goes into quaternions to a deeper level.

Whats next

This filter will be used in my IMU project, also on github, and run on an embedded MCU. I also intend to implement the MARG filter.

Build Instructions

This Project includes a basic CMakeList.txt. Run the following commands to build, make, and run the program.

# Clone the repo and cd to the root of the directory

# Create a build directory 
 mkdir build

 # Run CMake
 cmake -S . -B build

 # Build the program with the generated make files
 cmake --build build/

 # Run the program
 ./build/Madgwick_Filter

CMake

Use this Modern CMake guide as an introduction to CMake.

About

A quaternion based sensor fusion algorithm that fuses accelerometers and gyroscopes and optionally magnetometers

Topics

Resources

License

Stars

Watchers

Forks

Releases

No releases published

Packages

No packages published