This is my final project for bachelor degree. AHRS using Madgwick and Kalman Filter
MPU9250 library : https://github.com/bolderflight/MPU9250
myfork library : https://github.com/utamadonny/MPU9250/tree/MadgwickAHRS
GPS Readings : https://github.com/mikalhart/TinyGPSPlus
Madgwick filter: https://x-io.co.uk/open-source-imu-and-ahrs-algorithms/