Robust State Estimation via Maximum Correntropy EKF on Matrix Lie Groups With Application to Low-Cost INS/GPS-Integrated Navigation System
- 21 March 2023
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Sensors Journal
- Vol. 23 (9) , 9467-9479
Abstract
This paper focuses on solving state estimation problems of nonlinear systems whose states evolve on matrix Lie groups and measurements live in the Euclidean space under non-Gaussian measurement noise. Building upon the maximum correntropy criterion and the invariant Kalman filtering theory, a generalized robust extended Kalman filtering algorithm on matrix Lie groups is derived from maximizing a novel optimization cost function. This cost function is introduced by considering the correntropy and the system geometry structure. Then, two alternative versions of the proposed filtering algorithm are provided according to the distinct processing approaches of the nonlinear measurement function in the cost function. A Gaussian-Newton method on Lie groups and a fixed-point iterative method are applied to update the posterior estimation. In addition, sufficient conditions are given to ensure the convergence of fixed-point iterative steps. Extensive Monte-Carlo simulations on an INS/GPS integrated navigation system and experiments on open-source datasets validate the theoretical analysis and illustrate the effectiveness and robustness of the proposed filter.Keywords
Funding Information
- National Natural Science Foundation of China (62073265)
This publication has 46 references indexed in Scilit:
- Maximum correntropy Kalman filterAutomatica, 2017
- The Invariant Extended Kalman Filter as a Stable ObserverIEEE Transactions on Automatic Control, 2016
- Visual inertial odometry for quadrotors on SE(3)2016
- From Intrinsic Optimization to Iterated Extended Kalman Filtering on Lie GroupsJournal of Mathematical Imaging and Vision, 2016
- Convergence of a Fixed-Point Algorithm under Maximum Correntropy CriterionIEEE Signal Processing Letters, 2015
- Invariant particle filtering with application to localization2014
- Continuous-Discrete Extended Kalman Filter on Matrix Lie Groups Using Concentrated Gaussian DistributionsJournal of Mathematical Imaging and Vision, 2014
- Vision meets robotics: The KITTI datasetThe International Journal of Robotics Research, 2013
- Invariant Observer Design for a Helicopter UAV Aided Inertial Navigation SystemIEEE Transactions on Control Systems Technology, 2012
- Non-Linear Symmetry-Preserving Observers on Lie GroupsIEEE Transactions on Automatic Control, 2009