// AHRS.c // S.O.H. Madgwick // 25th August 2010 // // Quaternion implementation of the DCM filter [Mayhony et al]. Incorporates the magnetic distortion // compensation algorithms from my filter [Madgwick] which eliminates the need for a re