Cubature Kalman Filtering for Continuous-Discrete Systems: Theory and Simulations

被引:468
作者
Arasaratnam, Ienkaran [1 ]
Haykin, Simon [2 ]
Hurd, Thomas R. [3 ]
机构
[1] McMaster Univ, Ctr Mechatron & Hybrid Technol, Hamilton, ON L8S 4K1, Canada
[2] McMaster Univ, Cognit Syst Lab, Hamilton, ON L8S 4K1, Canada
[3] McMaster Univ, Dept Math & Stat, Hamilton, ON L8S 4K1, Canada
关键词
Bayesian filters; cubature Kalman filter (CKF); Ito-Taylor expansion; nonlinear filtering; square-root filtering; STATE ESTIMATION; TRACKING;
D O I
10.1109/TSP.2010.2056923
中图分类号
TM [电工技术]; TN [电子技术、通信技术];
学科分类号
0808 ; 0809 ;
摘要
In this paper, we extend the cubature Kalman filter (CKF) to deal with nonlinear state-space models of the continuous-discrete kind. To be consistent with the literature, the resulting nonlinear filter is referred to as the continuous-discrete cubature Kalman filter (CD-CKF). We use the Ito-Taylor expansion of order 1.5 to transform the process equation, modeled in the form of stochastic ordinary differential equations, into a set of stochastic difference equations. Building on this transformation and assuming that all conditional densities are Gaussian-distributed, the solution to the Bayesian filter reduces to the problem of how to compute Gaussian-weighted integrals. To numerically compute the integrals, we use the third-degree cubature rule. For a reliable implementation of the CD-CKF in a finite word-length machine, it is structurally modified to propagate the square-roots of the covariance matrices. The reliability and accuracy of the square-root version of the CD-CKF are tested in a case study that involves the use of a radar problem of practical significance; the problem considered herein is challenging in the context of radar in two respects-high dimensionality of the state and increasing degree of nonlinearity. The results, presented herein, indicate that the CD-CKF markedly outperforms existing continuous-discrete filters.
引用
收藏
页码:4977 / 4993
页数:17
相关论文
共 43 条
[1]  
[Anonymous], 1971, Approximate Calculation of Multiple Integrals
[2]  
[Anonymous], 1989, FOKKERPLANCK EQUATIO
[3]  
Arasaratnam I., 2009, Cubature Kalman Filtering: Theory Applications
[4]   Square-root quadrature Kalman filtering [J].
Arasaratnam, Ienkaran ;
Haykin, Simon .
IEEE TRANSACTIONS ON SIGNAL PROCESSING, 2008, 56 (06) :2589-2593
[5]   Cubature Kalman Filters [J].
Arasaratnam, Ienkaran ;
Haykin, Simon .
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, 2009, 54 (06) :1254-1269
[6]  
ASTROM K. J., 1970, Introduction to stochastic control
[7]   SUBOPTIMAL STATE ESTIMATION FOR CONTINUOUS-TIME NONLINEAR SYSTEMS FOR DISCRETE NOISY MEASUREMENTS [J].
ATHANS, M ;
WISHNER, RP ;
BERTOLINI, A .
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, 1968, AC13 (05) :504-+
[8]  
Bangerth W., 2003, LEC MATH
[9]  
Bar-Shalom Y, 1988, Tracking and data association
[10]  
BEARD R, 1992, J GUID CONTR DYN, V22