以STM32F407为硬件平台,使用MPU9250结合mahony姿态融合算法,融合加速度计、磁力计、陀螺仪数据解算出表征姿态的四元数,第二版修正输出角度误差