Accurate cubature and extended Kalman filtering methods for estimating continuous-time nonlinear stochastic systems with discrete measurements

This paper further advances the idea of accurate Gaussian filtering towards efficient cubature Kalman filters for estimating continuous-time nonlinear stochastic systems with discrete measurements. It implies that the moment differential equations describing evolution of the predicted mean and covariance of the propagated Gaussian density in time are solved accurately, i.e. with negligible error. The latter allows the total error of the cubature Kalman filtering to be reduced significantly and results in a new accurate continuousdiscrete cubature Kalman filtering method. At the same time, we revise the earlier developed version of the accurate continuousdiscrete extended Kalman filter by amending the involved iteration and relaxing the utilized global error control mechanism. In addition, we build a mixed-type method, which unifies the best features of the accurate continuousdiscrete extended and cubature Kalman filters. More precisely, the time updates are done in this state estimator as those in the first filter whereas the measurement updates are conducted with use of the third-degree spherical-radial cubature rule applied for approximating the arisen Gaussian-weighted integrals. All these are examined in severe conditions of tackling a seven-dimensional radar tracking problem, where an aircraft executes a coordinated turn, and compared to the state-of-the-art cubature Kalman filters.

[1]  D. Hernández-Abreu,et al.  An efficient family of strongly A-stable Runge-Kutta collocation methods for stiff systems and DAEs. Part I: Stability and order results , 2010, J. Comput. Appl. Math..

[2]  Rüdiger Weiner,et al.  Global error estimation and control in linearly-implicit parallel two-step peer W-methods , 2011, J. Comput. Appl. Math..

[3]  M. V. Kulikova,et al.  Accurate Numerical Implementation of the Continuous-Discrete Extended Kalman Filter , 2014, IEEE Transactions on Automatic Control.

[4]  Mohinder S. Grewal,et al.  Kalman Filtering: Theory and Practice , 1993 .

[5]  Simo Särkkä,et al.  On Unscented Kalman Filtering for State Estimation of Continuous-Time Nonlinear Systems , 2007, IEEE Trans. Autom. Control..

[6]  Thomas Mazzoni,et al.  Computational aspects of continuous–discrete extended Kalman-filtering , 2008, Comput. Stat..

[7]  J. Butcher Numerical methods for ordinary differential equations , 2003 .

[8]  Lotfi Senhadji,et al.  Various Ways to Compute the Continuous-Discrete Extended Kalman Filter , 2012, IEEE Transactions on Automatic Control.

[9]  E. Hairer,et al.  Geometric Numerical Integration: Structure Preserving Algorithms for Ordinary Differential Equations , 2004 .

[10]  L. Shampine,et al.  Numerical Solution of Ordinary Differential Equations. , 1995 .

[11]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[12]  P. Kloeden,et al.  Numerical Solution of Stochastic Differential Equations , 1992 .

[13]  Rüdiger Weiner,et al.  Parallel Two-Step W-Methods with Peer Variables , 2004, SIAM J. Numer. Anal..

[14]  M. V. Kulikova,et al.  State estimation in chemical systems with infrequent measurements , 2015, 2015 European Control Conference (ECC).

[15]  A. Jazwinski Stochastic Processes and Filtering Theory , 1970 .

[16]  E. Hairer,et al.  Solving Ordinary Differential Equations II: Stiff and Differential-Algebraic Problems , 2010 .

[17]  J. Verwer,et al.  Stability of Runge-Kutta Methods for Stiff Nonlinear Differential Equations , 1984 .

[18]  G. Kulikov,et al.  Adaptive nested implicit Runge--Kutta formulas of Gauss type , 2009 .

[19]  Helmut Podhaisky,et al.  Multi-Implicit Peer Two-Step W-Methods for Parallel Time Integration , 2005 .

[20]  Ernst Hairer,et al.  Solving Ordinary Differential Equations I: Nonstiff Problems , 2009 .

[21]  Rüdiger Weiner,et al.  Local and global error estimation and control within explicit two-step peer triples , 2014, J. Comput. Appl. Math..

[22]  M. V. Kulikova,et al.  Accurate state estimation in the Van der Vusse reaction , 2014, 2014 IEEE Conference on Control Applications (CCA).

[23]  Peter Lancaster,et al.  The theory of matrices , 1969 .

[24]  S. Särkkä,et al.  On Continuous-Discrete Cubature Kalman Filtering , 2012 .

[25]  Gennady Yu. Kulikov,et al.  Cheap global error estimation in some Runge–Kutta pairs , 2013 .

[26]  Rüdiger Weiner,et al.  A Singly Diagonally Implicit Two-Step Peer Triple with Global Error Control for Stiff Ordinary Differential Equations , 2015, SIAM J. Sci. Comput..

[27]  M. V. Kulikova,et al.  High-order accurate continuous-discrete extended Kalman filter for chemical engineering , 2015, Eur. J. Control.

[28]  E. Hairer,et al.  Solving ordinary differential equations I (2nd revised. ed.): nonstiff problems , 1993 .

[29]  Luis Antonio Aguirre,et al.  Maximum a posteriori state path estimation: Discretization limits and their interpretation , 2014, Autom..

[30]  G. Kulikov Embedded symmetric nested implicit Runge–Kutta methods of Gauss and Lobatto types for solving stiff ordinary differential equations and Hamiltonian systems , 2015 .

[31]  John C. Butcher,et al.  General linear methods for ordinary differential equations , 2009, Math. Comput. Simul..

[32]  D.S. Bernstein,et al.  Spacecraft tracking using sampled-data Kalman filters , 2008, IEEE Control Systems.

[33]  J. Junkins,et al.  Optimal Estimation of Dynamic Systems , 2004 .

[34]  Maria V. Kulikova,et al.  Square-root Accurate Continuous-Discrete Extended Kalman Filter for target tracking , 2013, 52nd IEEE Conference on Decision and Control.

[35]  Fredrik Gustafsson,et al.  Best choice of coordinate system for tracking coordinated turns , 1996, Proceedings of 35th IEEE Conference on Decision and Control.

[36]  D. Hernández-Abreu,et al.  An efficient family of strongly A-stable Runge-Kutta collocation methods for stiff systems and DAEs. Part II: Convergence results , 2012 .

[37]  Helmut Podhaisky,et al.  Superconvergent explicit two-step peer methods , 2009 .

[38]  Mohinder S. Grewal,et al.  Global Positioning Systems, Inertial Navigation, and Integration , 2000 .

[39]  S. Haykin,et al.  Cubature Kalman Filters , 2009, IEEE Transactions on Automatic Control.

[40]  D. Wilson,et al.  Experiences implementing the extended Kalman filter on an industrial batch reactor , 1998 .

[41]  M. V. Kulikova,et al.  A mixed-type accurate continuous-discrete extended-unscented kalman filter for target tracking , 2015, 2015 European Control Conference (ECC).

[42]  Masoud Soroush State and parameter estimations and their applications in process control , 1998 .

[43]  Rüdiger Weiner,et al.  Variable-Stepsize Interpolating Explicit Parallel Peer Methods with Inherent Global Error Control , 2010, SIAM J. Sci. Comput..

[44]  Helmut Podhaisky,et al.  Variable-stepsize doubly quasi-consistentparallel explicit peer methods with globalerror control , 2012 .

[45]  Simon Haykin,et al.  Cubature Kalman Filtering for Continuous-Discrete Systems: Theory and Simulations , 2010, IEEE Transactions on Signal Processing.

[46]  M. V. Kulikova,et al.  The Accurate Continuous-Discrete Extended Kalman Filter for Radar Tracking , 2016, IEEE Transactions on Signal Processing.