New sigma point filtering algorithms for nonlinear stochastic systems with correlated noises

Abstract

New sigma point filtering algorithms, including the unscented Kalman filter (UKF) and the divided difference filter (DDF), are designed to solve the nonlinear filtering problem under the condition of correlated noises. Based on the minimum mean square error estimation theory, the nonlinear optimal predictive and correction recursive formulas under the hypothesis that the input noise is correlated with the measurement noise are derived and can be described in a unified framework. Then, UKF and DDF with correlated noises are proposed on the basis of approximation of the posterior mean and covariance in the unified framework by using unscented transformation and second order Stirling’s interpolation. The proposed UKF and DDF with correlated noises break through the limitation that input noise and measurement noise must be assumed to be uncorrelated in standard UKF and DDF. Two simulation examples show the effectiveness and feasibility of new algorithms for dealing with nonlinear filtering issue with correlated noises.

Keywords

nonlinear system / correlated noise / sigma point / unscented Kalman filter / divided difference filter

References

[1] HoY. C., LeeR. C. K.. A bayesian approach to problems in stochastic estimation and control [J]. IEEE Transactions on Automatic Control, 1964, 9(4): 333-339

[2] SorensonH. W.. On the development of practical nonlinear filters [J]. Informaiton Sciences, 1974, 7(2): 253-270

[3] GobboD. D., NapolitanoM., FamouriP., InnocentiM.. Experimental application of extended Kalman filtering for sensor validation [J]. IEEE Transactions on Control System Technology, 2001, 9(2): 376-380

[4] JulierS., UhlmannJ., Durrant-WhyteH. F.. 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

[5] NørqaardM., PoulsenN. K., RavnO.. New developments in state estimation for nonlinear systems [J]. Automatica, 2000, 36(11): 1627-1638

[6] ArulampalamM. S., MaskellS., GordonN., ClappT.. A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian Tracking [J]. IEEE Transactions on Signal Processing, 2000, 50(2): 174-188

[7] BoutayebM., AubryD.. A strong tracking extended Kalman observer for nonlinear discrete-time systems [J]. IEEE Transactions on Automatic Control, 1999, 44(8): 1550-1556

[8] van der MERWE R, WAN E A. Sigma-point kalman filters for probabilistic inference in dynamic state-space models [EB/OL]. [2004-03]. http://www.cse.ogi.edu/~rudmerwe/#research/.

[9] JulierS. J., UhlmannJ. K.. Unscented filtering and nonlinear estimation [C]. Proceedings of the IEEE, 2004WashingtonIEEE Press401-422

[10] NørqaardM., PoulsenN. K., RavnO.Advances in derivative-free state estimation for nonlinear systems [D], 2000Lyngby, CopenhagenDepartment of Mathematical Modelling, Technical University of Denmark

[11] JulierS., UhlmannJ., Durrant-WhyteH. F.. New approach for filtering nonlinear system [C]. Proceedings of the American Control Conference, 1995WashingtonIEEE Press1628-1632

[12] JulierS. J., UhlmannJ. K.A general method for approximating nonlinear transformations of probability distributions [D], 1996LondonDepartment of Engineering Science, University of Oxford

[13] van der MerweR., WanE. A., JulierS. J., BogdanovA., HarveyG., HuntJ.. Sigma-point kalman filters for nonlinear estimation and sensor fusion: Applications to integrated navigation [C]. Proceedings of the AIAA Guidance Navigation and Control Conference, 2004ProvidenceIEEE Press1735-1764

[14] BlomH. A. P., Bar-ShalomY.. The interacting multiple model algorithm for system with markovian switching coefficients [J]. IEEE Transactions on Automatic Control, 1988, 33(8): 780-783

[15] ChoS. Y., KimB. D.. Adaptive IIR/FIR fusion filter and its application to the INS/GPS integrated system [J]. Automatica, 2006, 44(8): 2040-2047

[16] SimandlM., DunrikJ.. Derivative-free estimation methods: New results and performance analysis [J]. Automatica, 2009, 45(7): 1749-1757

[17] SubrahmanyaN., ShinY. C.. Adaptive divided difference filtering for simultaneous state and parameter estimation [J]. Automatica, 2009, 45(7): 1686-1693

[18] LevenW. E., LantermanA. D.. Unscented Kalman filters for multiple target tracking with symmetric measurement equations [J]. IEEE Transactions on Automatic Control, 2009, 54(2): 370-375

[19] MaybeckP. S.Stochastic models, estimation and control [M], 1979New YorkAcademic Press139-142

[20] HuH. D., HuangX. L., LiM. M., SongZ. L.. Federated unscented particle filtering algorithm for SINS/CNS/GPS system [J]. Journal of Central South University of Technology, 2010, 17(4): 778-785

[21] van der MerweR., WanE. A.. Gaussian mixture sigma-point particle filters for sequential probabilistic inference in dynamic state-space models [C]. IEEE International Conference on Acoustics, Speech, and Signal Processing, 2003Hong KongIEEE Press698-701

[22] JulierS. J.. The scaled unscented transformation [C]. Proceedings of the American Control Conference, 2002AnchorageIEEE Press4555-4559