Regular Kalman-based IMU/MARG sensor fusion on a bare metal Freescale FRDM-KL25Z - View it on GitHub