基于加速度修正模型的无人机姿态解算算法

In order to improve the accuracy of attitude of unmanned aerial vehicle (UAV) navigation system in dynamic environment, an attitude calculation algorithm based on acceleration correction model is proposed. First, the acceleration correction model is established to calculate the estimated non-gravitational acceleration and external non-gravitational acceleration to modify the output value of the accelerometer, which reduces the influence of non-gravitational acceleration on the attitude calculation in dynamic environment. Then, the attitude calculation model based on Kalman filter is built, attitude angle calculated by corrected acceleration and magnetometer as measurement of filtering model, and the attitude calculation algorithm based on the acceleration correction model is designed. The experimental results show that the algorithm can reduce the interference of non-gravitational acceleration to attitude calculation, which avoids attitude angle divergence of UAV navigation system in dynamic environment, and improves the accuracy and anti-interference ability of UAV navigation system in dynamic environment.