This is the repository for the method to fuse IMU(Gyrosensor, Accelerometer, Magnetometer) by using extended kalman filter.
Equiment | Name |
---|---|
IMU | MPU-9250 |
Main Controller | Arduino-UNO |
the wiring for the sensor is arraged as shown in the image below.
- Euler Gyro: Moudle that receives angular velocity and calculates the euler angle.
- Euler Accel: Module that receives acceleration from accelerometer and calculates euler angle rates.
- Extended Kalman Filter: Module that calculates euler angle by combining data of a gyro sensor and an accelerometer.
- Tilt Compensation: Module that calculates heading angle(yaw) by receiving output of extended kalman filter(roll, pitch) and magnetometer sensing data.
the final result of this repositoy is arraged as shown in the figure below.