Adaptive Two-Stage EKF for INS-GPS Loosely Coupled System with Unknown Fault Bias

Kwang Hoon Kim, Jang Gyu Lee, Chan Gook Park

School of Electrical Engineering and Computer Science, Seoul National University, 133-dong, ASRI #610, San 56-1, Sillim-dong, Gwanak-gu, Seoul, 151-742, South Korea.
School of Mechanical and Aerospace Engineering, Seoul National University, San 56-1, Sillim-dong, Gwanak-gu, Seoul, 151-744, South Korea.

DOI:                 

Abstract

This paper proposes an adaptive two-stage extended Kalman filter (ATEKF) for estimation of unknown fault bias in an INS-GPS loosely coupled system. The Kalman filtering technique requires complete specifications of both dynamical and statistical model parameters of the system. However, in a number of practical situations, these models may contain parameters, which may deviate from their nominal values by unknown random bias. This unknown random bias may seriously degrade the performance of the filter or cause a divergence of the filter. The two-stage extended Kalman filter (TEKF), which considers this problem in nonlinear system, has received considerable attention for a long time. The TEKF suggested until now assumes that the information of a random bias is known. But the information of a random bias is unknown or partially known in general. To solve this problem, this paper firstly proposes a new adaptive fading extended Kalman filter (AFEKF) that can be used for nonlinear system with incomplete information. Secondly, it proposes the ATEKF that can estimate unknown random bias by using the AFEKF. The proposed ATEKF is more effective than the TEKF for the estimation of the unknown random bias. The ATEKF is applied to the INS-GPS loosely coupled system with unknown fault bias.

Keywords

adaptive two-stage extended Kalman filter; covariance rescaling; unknown fault bias

Conflicts of Interest

The authors declare no conflicts of interest.

References

[1]	Alouani A.T., Xia P., Rice T.R. and Blair W.D. (1993) On the Optimality of Two-stage State Estimation In the Presence of Random Bias. IEEE Transactions Automatic Control, AC-38, pp. 1279–1282.
[2]	Caglayan A.K. and Lancraft R.E. (1983) A Separated Bias Identification and State Estimation Algorithm for Nonlinear Systems. Automatica, 19(5), pp. 561–570.
[3]	Friedland B. (1969) Treatment of bias in recursive filtering. IEEE Transactions Automatic Control, AC-14, pp. 359–367.
[4]	Hong H.S., Lee J.G. and Park C.G. (2004) Performance improvement of in-flight alignment for autonomous vehicle under large initial heading error. IEE Proceedings Radar, Sonar and Navigation, 151(1), pp. 57–62.
[5]	Hsieh C.S. and Chen F.C. (1999) Optimal Solution of The Two-stage Kalman Estimator. IEEE Transactions Automatic Control, AC-44, pp. 194–199.
[6]	Ignagni M.N. (1990) Separate-Bias Kalman Estimator with Bias State Noise. IEEE Transactions Automatic Control, AC-35, pp. 338–341.
[7]	Ignagni M.N. (2000) Optimal and Suboptimal Separate-Bias Kalman Estimator for a Stochastic Bias. IEEE Transactions Automatic Control, AC-45, pp. 547–551.
[8]	Keller J.Y. and Darouach. M. (1997) Optimal Two-stage Kalman Filter in the Presence of Random Bias. Automatica, 33(9), pp. 1745–1748.
[9]	Ljung L. (1979) Asymptotic Behavior of the Extended Kalman Filter as a Parameter Estimator for Linear Systems. IEEE Transactions Automatic Control, AC-24, pp. 36–50.
[10]	Mendel J.M. (1976) Extension of Friedland's bias filtering technique to a class of nonlinear systems. IEEE Transactions Automatic Control, AC-21, pp. 296–298
[11]	Shreve R.L. and Hedrick W.R. (1974) Separating bias and state estimates in recursive second-order filter. IEEE Transactions Automatic Control, AC-19, pp. 585–586.
[12]	Titterton D.H. and Weston J.L. (1997) Strapdown inertial navigation technology. Peter Peregrinus, United Kingdom.