Mostly fixed Magnetometer. Still needs some calibration.
backup
Kalman
Kalman