Strong Tracking UKF-Based Hybrid Algorithm and Its Application to Initial Alignment of Rotating SINS With Large Misalignment Angles
Jianguo Liu, Xiyuan Chen, Junwei Wang
Abstract
In this article, the fast and precise initial alignment of the low-cost rotary strapdown inertial navigation system under mooring conditions is investigated. The unscented Kalman filter (UKF) is used to address model nonlinearity and to achieve fast alignment for large misalignment angles. A generalized multifading strong tracking UKF (GSTUKF) is proposed to effectively compensate for the kinematic model errors caused by mooring and rotary motions. The performance of the standard strong tracking UKF cannot be optimal because only a portion of the fading factors associated with the directly observable state variables can be obtained approximately using the analytical method. By contrast, using the iteration method to calculate the full-dimensional fading factors precisely, the GSTUKF has greater robustness and adaptability. To find out the optimal fading factors in real time, the multivariate nonlinear optimization model is first designed, and then the iteration approach based on a hybrid algorithm consisting of particle swarm optimization and beetle antennae search is developed, which has no risk of falling into a local minimum. Simulations and experiments are conducted to validate the GSTUKF's effectiveness. The experiments demonstrate that the proposed method reduces the yaw error by 47.2% compared with the standard strong tracking UKF.