Hybrid Kalman and unscented Kalman filters for INS/GPS integrated system considering constant lever arm effect

Abstract

In inertial navigation system (INS) and global positioning system (GPS) integrated system, GPS antennas are usually not located at the same location as the inertial measurement unit (IMU) of the INS, so the lever arm effect exists, which makes the observation equation highly nonlinear. The INS/GPS integration with constant lever arm effect is studied. The position relation of IMU and GPS’s antenna is represented in the earth centered earth fixed frame, while the velocity relation of these two systems is represented in local horizontal frame. Due to the small integration time interval of INS, i.e. 0.1 s in this work, the nonlinearity in the INS error equation is trivial, so the linear INS error model is constructed and addressed by Kalman filter’s prediction step. On the other hand, the high nonlinearity in the observation equation due to lever arm effect is addressed by unscented Kalman filter’s update step to attain higher accuracy and better applicability. Simulation is designed and the performance of the hybrid filter is validated.

Keywords

inertial navigation system / global positioning system (GPS) / integrated system / lever arm effect / Kalman filter / unscented Kalman filter

References

[1] WoodmanO JAn introduction to inertial navigation [R], 2007

[2] SavageP G. A unified mathematical framework for strapdown algorithm design [J]. Journal of Guidance, Control, and Dynamics, 2006, 29(2): 237-249

[3] ZhangL-d, LianJ-x, WuM-p, HuX-ping. An improved computation scheme of strapdown inertial navigation system using rotation technique [J]. Journal of Central South University, 2012, 19(5): 1258-1266

[4] YangJ, WuW-q, WuY-x, LianJ-xiang. An iterative calibration method for nonlinear coefficients of marine triaxial accelerometers [J]. Journal of Central South University, 2013, 20(11): 3103-3115

[5] TangY-g, WuY-x, WuM-p, WuW-q, HuX-p, ShenL-cheng. INS/GPS integration: Global observability analysis [J]. IEEE Transactions on Vehicular Technology, 2009, 58(3): 1129-1142

[6] ChangG-bin. Robust kalman filtering based on mahalanobis distance as outlier judging criterion [J]. Journal of Geodesy, 2014, 88(4): 391-401

[7] ChangG-bin. Loosely coupled INS/GPS integration with constonlt lever arm using marginal unscented Kalman filter [J]. Journal of Navigation, 2014, 67(3): 419-436

[8] van der MerweRSigma-point Kalman filters for probabilistic inference in dynamic state-space models [D], 2004, Portland, Oregon Health & Science University

[9] JulierS, UhlmannJ, Durrant-whyteH. A new method for the nonlinear transformation of means and covariances in filters and estimators [J]. IEEE Transactions on Automatic Control, 2000, 45(3): 477-482

[10] ItoK, XiongK. Gaussian filters for nonlinear fitering problems [J]. IEEE Transactions on Automatic Control, 2000, 45(5): 910-927

[11] NorgaardM, PoulsenN K, RavnO. New developments in state estimation for nonlinear systems [J]. Automatica, 2000, 36(11): 215-221

[12] LefebvreT, BruyninckxH, De SchutterJ. Comment on a new method for the nonlinear transformation of means and covariances in filters and estimators [J]. IEEE Transactions on Automatic Control, 2002, 47(8): 1406-1408

[13] LernerUHybrid bayesian networks for reasoning about complex systems [D], 2002, Stanford, Stanford University

[14] LiS-q, ChangG-b, JinJ-h, LiKe. Solving planar intersection problem using Gauss quadrature rule exact for three-order monomials [J]. Survey Review, 2013, 45(332): 372-379

[15] WuY-x, HuD-w, WuM-p, HuX-ping. A numerical-integration perspective on Gaussian filters [J]. IEEE Transactions on Signal Processing, 2006, 54(8): 2910-2921

[16] WangX-x, LiangY, PanQ, YangFeng. Unscented Kalman filter for nonlinear systems with colored measurement noise [J]. Acta Automatica Sinica, 2012, 38(6): 986-998

[17] WangX-x, PanQ, ChengY-m, ZhaoC-hui. New sigma point filtering algorithms for nonlinear stochastic systems with correlated noises [J]. Journal of Central South University, 2012, 19(4): 1010-1020

[18] ChangG-bin. Marginal unscented Kalman filter for cross-correlated process and observation noise at the same epoch [J]. IET Radar, Sonar & Navigation, 2014, 8(1): 54-64

[19] ArasaratnamI, HaykinS. Cubature kalman filters [J]. IEEE Transactions on Automatic Control, 2009, 54(6): 1254-1269

[20] GustafssonF, HendebyG. Some relations between extended and unscented Kalman filters [J]. IEEE Transactions on Signal Processing, 2012, 60(2): 545-555

[21] ChangL-b, HuB-q, LiA, QinF-jun. Transformed unscented kalman filter [J]. IEEE Transactions on Automatic Control, 2013, 58(1): 252-257

[22] DaumF. Nonlinear filters: Beyond the Kalman filter [J]. IEEE Aerospace and Electronic Systems Magazine, 2005, 20(8): 57-69

[23] GengY-r, WangJ-ling. Adaptive estimation of multiple fading factors in Kalman filter for navigation applications [J]. GPS Solutions, 2008, 12(4): 273-279

[24] KolasS, FossB, ScheiT. Constrained nonlinear state estimation based on the UKF approach [J]. Computers & Chemical Engineering, 2009, 33(8): 1386-1401

[25] WuY-x, ZhangH-l, WuM-p, HuX-p, HuD-wen. Observability of strapdown ins alignment: A global perspective [J]. IEEE Transactions on Aerospace and Electronic Systems, 2012, 48(1): 78-102