Inertial Navigation System Alignment Based on Fading Kalman Filter and Fixed Point Smoother

This study concerns the divergence problem of Kalman filter (KF) in the strapdown inertial navigation system (SINS) initial alignment. Fading Kalman filter (FKF) and fixed point smoother (FPS) are investigated in this work, and an improved alignment algorithm is proposed. FKF ensures the fast convergence of filter, and the accuracy loss of FKF is compensated by FPS. A performance comparison between traditional KF alignment algorithm and the proposed algorithm demonstrates that the proposed algorithm performs better in terms of rapidity, convergence and accuracy.

[1]  Ali H. Sayed,et al.  Diffusion Strategies for Distributed Kalman Filtering and Smoothing , 2010, IEEE Transactions on Automatic Control.

[2]  P. Savage.  A Unified Mathematical Framework for Strapdown Algorithm Design , 2006 .

[3]  Seiichi Nakamori.  Square-root algorithms of RLS Wiener filter and fixed-point smoother in linear discrete stochastic systems , 2008, Appl. Math. Comput..

[4]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .

[5]  Q. Wang,et al.  Fuzzy adaptive Kalman filtering for INS/GPS data fusion , 1999 .

[6]  Kyoung-Ho Choi,et al.  Ground vehicle navigation in harsh urban conditions by integrating inertial navigation system, global positioning system, odometer and vision data , 2011 .

[7]  Jamshaid Ali,et al.  Initial orientation of inertial navigation system realized through nonlinear modeling and filtering , 2011 .

[8]  Jinling Wang,et al.  A Novel Initial Alignment Scheme for Low-Cost INS Aided by GPS for Land Vehicle Applications , 2010, Journal of Navigation.

[9]  N. F. Toda,et al.  Divergence in the Kalman Filter , 1967 .

[10]  Chris Hide,et al.  Adaptive Kalman Filtering for Low-cost INS/GPS , 2002, Journal of Navigation.

[11]  S. Y. Chen,et al.  Kalman Filter for Robot Vision: A Survey , 2012, IEEE Transactions on Industrial Electronics.

[12]  J. Ali.  Strapdown inertial navigation system/astronavigation system data synthesis using innovation-based fuzzy adaptive Kalman filtering , 2010 .

[13]  Bjarne A. Foss,et al.  Applying the unscented Kalman filter for nonlinear state estimation , 2008 .

[14]  Jiang Cheng Fang,et al.  A fast initial alignment method for strapdown inertial navigation system on stationary base , 1996 .

[15]  An Li,et al.  Strapdown inertial navigation system alignment based on marginalised unscented kalman filter , 2013 .

[16]  G. Kitagawa.  Monte Carlo Filter and Smoother for Non-Gaussian Nonlinear State Space Models , 1996 .