MATLAB-based general approach for square-root extended-unscented and fifth-degree cubature Kalman filtering methods

被引:11
作者
Kulikova, M. V. [1 ]
Kulikov, G. Yu. [1 ]
机构
[1] Univ Lisbon, Inst Super Tecn, CEMAT, Av Rovisco Pais, P-1049001 Lisbon, Portugal
关键词
Unscented Kalman filter; Cubature Kalman filter; Continuous-discrete filtering; Square-root implementations; MATLAB; Ordinary differential equations; STATE ESTIMATION; ALGORITHMS; SYSTEMS; TARGET;
D O I
10.1016/j.ejcon.2021.01.003
中图分类号
TP [自动化技术、计算机技术];
学科分类号
0812 ;
摘要
A stable square-root approach has been recently proposed for the unscented Kalman filter (UKF) and fifth-degree cubature Kalman filter (5D-CKF) as well as for the mixed-type methods consisting of the ex-tended Kalman filter (EKF) time update and the UKF/5D-CKF measurement update steps. The mixed-type estimators provide a good balance in trading between estimation accuracy and computational demand because of the EKF moment differential equations involved. The key benefit is a consolidation of reliable state mean and error covariance propagation by using delicate discretization error control while solving the EKF moment differential equations and an accurate measurement update according to the advanced UKF and/or 5D-CKF filtering strategies. Meanwhile the drawback of the previously proposed estimators is an utilization of sophisticated numerical integration scheme with the built-in discretization error control that is, in fact, a complicated and computationally costly tool. In contrast, we design here the mixed -type methods that keep the same estimation quality but reduce a computational time significantly. The novel estimators elegantly utilize any MATLAB-based numerical integration scheme developed for solving ordinary differential equations (ODEs) with the required accuracy tolerance pre-defined by users. In sum-mary, a simplicity of the suggested estimators, their numerical robustness with respect to roundoff due to the square-root form utilized as well as their estimation accuracy due to the MATLAB ODEs solvers with discretization error control involved are the attractive features of the novel estimators. The numeri-cal experiments are provided for illustrating a performance of the suggested methods in comparison with the existing ones. (c) 2021 European Control Association. Published by Elsevier Ltd. All rights reserved.
引用
收藏
页码:1 / 12
页数:12
相关论文
共 58 条
[1]  
[Anonymous], 2012, IFAC Proc. Vol, DOI DOI 10.3182/20120711-3-BE-2027.00188
[2]  
Arasaratnam I., 2017, MULTISENSOR DATA FUS, P193
[3]   Discrete-time nonlinear filtering algorithms using Gauss-Hermite quadrature [J].
Arasaratnam, Ienkaran ;
Haykin, Simon ;
Elliott, Robert J. .
PROCEEDINGS OF THE IEEE, 2007, 95 (05) :953-977
[4]   Cubature Kalman Filtering for Continuous-Discrete Systems: Theory and Simulations [J].
Arasaratnam, Ienkaran ;
Haykin, Simon ;
Hurd, Thomas R. .
IEEE TRANSACTIONS ON SIGNAL PROCESSING, 2010, 58 (10) :4977-4993
[5]   Cubature Kalman Filters [J].
Arasaratnam, Ienkaran ;
Haykin, Simon .
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, 2009, 54 (06) :1254-1269
[6]  
Bar-Shalom Yaakov., 1993, ESTIMATION TRACKING
[7]  
BIERMAN GJ, 1977, FACTORIZATION METHOD
[8]  
Bilik I., 2016, P 2006 IEEE C RADAR, P282
[9]   Solving the indefinite least squares problem by hyperbolic QR factorization [J].
Bojanczyk, A ;
Higham, NJ ;
Patel, H .
SIAM JOURNAL ON MATRIX ANALYSIS AND APPLICATIONS, 2003, 24 (04) :914-931
[10]   Hierarchical particle filter for bearings-only tracking [J].
Brehard, T. ;
Le Cadre, J. -P. .
IEEE TRANSACTIONS ON AEROSPACE AND ELECTRONIC SYSTEMS, 2007, 43 (04) :1567-1585