Variational Adaptive LM-IEKF for Full State Navigation System of Wind Disturbance and Observability Analysis
Yue Yang, Xiaoxiong Liu, Xuhang Liu, Yicong Guo, Weiguo Zhang · IEEE Transactions on Instrumentation and Measurement · 2022
Robust and accurate state estimation algorithms applied to the small UAVs are always promising depending on the multiple onboard local and global sensors. This paper proposes a variational adaptive Levenberg-Marquardt iterated extended Kalman filter (VA-LM-IEKF) full state estimation algorithm to calculate the reliable UAV flight state parameters in wind disturbance. The navigation system based on the LM-IEKF can provide an accurate state by expanding the optimization range of estimated points. An adaptive filter using the variational Bayesian approach is proposed to improve the filter robustness to the observation noise covariance matrix. Moreover, a judging criterion is introduced into the filter observation correction step to eliminate the observed abnormal values. In addition, observability analysis with Lie algebra for the navigation system is established to evaluate the system observability. Simulation and real-data experiments in the self-developed small UAVs platform demonstrate that the performance of the proposed algorithm is better than the state-of-art methods in solution accuracy and filter robustness.