mpu6050+地磁传感器通过卡尔曼滤波得出姿态角，加入HMC588模块，对yaw角度进行融合校准。