基于共轭梯度的MARG传感器姿态解算方法

Conjugate Gradient Based Method for Attitude Calculation of MARG Sensor

针对基于惯性测量单元(IMU)的姿态解算算法噪声大、精度低且无法准确解算偏航方向上姿态角变化的问题,提出一种基于共轭梯度算法的MARG传感器系统姿态解算方法。使用加速度计和磁强计测量姿态误差,通过共轭梯度算法对陀螺仪姿态四元数进行补偿和修正,对数据加权融合求解得到飞行器姿态四元数。利用三轴转台对算法稳定性和准确性进行验证,结果表明,该算法能够有效抑制测量噪声,提高姿态角解算的精度。

Aiming at the problem that the attitude calculation algorithm based on the Inertial Measurement Unit(IMU)is noisy has low accuracy and cannot accurately calculate the attitude angle variation in the yaw direction a MARG sensor system attitude calculation method based on the conjugate gradient algorithm is proposed.The accelerometer and magnetometer are used to measure the attitude error the conjugate gradient algorithm is used to compensate for and correct the gyroscope attitude quaternion and the data is weighted and fused to obtain the aircraft attitude quaternion.A three-axis turntable is used to verify the stability and accuracy of the algorithm.The results show that the algorithm can effectively suppress measurement noise and improve the accuracy of attitude angle calculation.