Convergence and Consistency Analysis for a 3-D Invariant-EKF SLAM

Publication Type:
Journal Article
IEEE Robotics and Automation Letters, 2017, 2 (2), pp. 733 - 740
Issue Date:
Filename Description Size
07812660.pdfPublished Version372.35 kB
Adobe PDF
Full metadata record
© 2016 IEEE. In this letter, we investigate the convergence and consistency properties of an invariant-extended Kalman filter (RI-EKF) based simultaneous localization and mapping (SLAM) algorithm. Basic convergence properties of this algorithm are proven. These proofs do not require the restrictive assumption that the Jacobians of the motion and observation models need to be evaluated at the ground truth. It is also shown that the output of RI-EKF is invariant under any stochastic rigid body transformation in contrast to SO(3) based EKF SLAM algorithm (SO(3)-EKF) that is only invariant under deterministic rigid body transformation. Implications of these invariance properties on the consistency of the estimator are also discussed. Monte Carlo simulation results demonstrate that RI-EKF outperforms SO(3)-EKF, Robocentric-EKF and the 'First Estimates Jacobian' EKF, for three-dimensional point feature-based SLAM.
Please use this identifier to cite or link to this item: