Airspeed-Aided State Estimation Algorithm of Small Fixed-Wing UAVs in GNSS-Denied Environments

Aimed at improving the navigation accuracy of the fixed-wing UAVs in GNSS-denied environments, this paper proposes an algorithm of nongravitational acceleration estimation based on airspeed and IMU sensors, which use a differential tracker (TD) model to further supplement the effect of linear acceleration for UAVs under dynamic flight. We further establish the mapping relationship between vehicle nongravitational acceleration and the vehicle attitude misalignment angle and transform it into the attitude angle rate deviation through the nonlinear complementary filtering model for real-time compensation. It can improve attitude estimation precision significantly for vehicles in dynamic conditions. Furthermore, a lightweight complementary filter is used to improve the accuracy of vehicle velocity estimation based on airspeed, and a barometer is fused on the height channel to achieve the accurate tracking of height and the lift rate. The algorithm is actually deployed on low-cost fixed-wing UAVs and is compared with ACF, EKF, and NCF by using real flight data. The position error within 30 s (about 600 m flying) in the horizontal channel flight is less than 30 m, the error within 90 s (about 1800 m flying) is less than 50 m, and the average error of the height channel is 0.5 m. The simulation and experimental tests show that this algorithm can provide UAVs with good attitude, speed, and position calculation accuracy under UAV maneuvering environments.