Add DCM Mahony motion algorithm just in case madgwick had a poor accuracy on air