A robust Kalman filter scheme is proposed to resist the influence of the outliers in the observations. Two kinds of observation error are studied, i.e., the outliers in the actual observations and the heavy-tailed distribution of the observation noise. Either of the two kinds of errors can seriously degrade the performance of the standard Kalman filter. In the proposed method, a judging index is defined as the square of the Mahalanobis distance from the observation to its prediction. By assuming that the observation is Gaussian distributed with the mean and covariance being the observation prediction and its associate covariance, the judging index should be Chi-square distributed with the dimension of the observation vector as the degree of freedom. Hypothesis test is performed to the actual observation by treating the above Gaussian distribution as the null hypothesis and the judging index as the test statistic. If the null hypothesis should be rejected, it is concluded that outliers exist in the observations. In the presence of outliers scaling factors can be introduced to rescale the covariance of the observation noise or of the innovation vector, both resulting in a decreased filter gain. And the scaling factors can be solved using the Newton’s iterative method or in an analytical manner. The harmful influence of either of the two kinds of errors can be effectively resisted in the proposed method, so robustness can be achieved. Moreover, as the number of iterations needed in the iterative method may be rather large, the analytically calculated scaling factor should be preferred.
Kalman filter Robust Hypothesis test Mahalanobis distance
This is a preview of subscription content, log in to check access.
I am grateful to the associate editor and three anonymous reviewers for their valuable comments. This work was supported by the National Basic Research Program of China (973 Program, No. 2012CB719902) and the National Natural Science Foundation of China (No.41274013).
Schick I, Mitter S (1994) Robust recursive estimation in the presence of heavy-tailed observation noise. Ann Stat 22:1045–1080CrossRefGoogle Scholar
Simon D (2006) Optimal state estimation: Kalman, H infinity, and nonlinear approaches. Wiley-Interscience, New JerseyCrossRefGoogle Scholar
Soken H, Hajiyev C (2010) Pico satellite attitude estimation via robust unscented Kalman filter in the presence of measurement faults. ISA Trans 49:249–256CrossRefGoogle Scholar
Wang X, Cui N, Guo J (2010) Huber-based unscented filtering and its application to vision-based relative navigation. IET Radar Sonar Navig 4:134–141CrossRefGoogle Scholar
Yang Y (1991) Robust bayesian estimation. J Geod 65:145–150Google Scholar
Yang Y, Gao W (2007) Comparison of two fading filters and adaptively robust filter. Geo Spatial Inf Sci 10:200–203CrossRefGoogle Scholar
Yang Y, He H, Xu G (2001) Adaptively robust filtering for kinematic geodetic positioning. J Geod 75:109–116CrossRefGoogle Scholar
Yang Y, Song L, Xu T (2002a) Robust estimator for correlated observations based on bifactor equivalent weights. J Geod 76:353–358CrossRefGoogle Scholar
Yang Y, Song L, Xu T (2002b) Robust parameter estimation for correlated geodetic observations. Acta Geod Cartogr Sin 31:95–99Google Scholar
Zhou D, Frank P (1996) Strong tracking filtering of nonlinear time-varying stochastic systems with coloured noise: application to parameter estimation and empirical robustness analysis. Int J Control 65:295–307CrossRefGoogle Scholar