An EKF-SLAM algorithm with consistency properties

Abstract

In this paper we address the inconsistency of the EKF-based SLAM algorithm that stems from non-observability of the origin and orientation of the global reference frame. We prove on the non-linear two-dimensional problem with point landmarks observed that this type of inconsistency is remedied using the Invariant EKF, a recently introduced variant ot the EKF meant to account for the symmetries of the state space. Extensive Monte-Carlo runs illustrate the theoretical results.

Submitted

Cited by in corpus (25)

• Strapdown Inertial Navigation System Initial Alignment based on Group of Double Direct Spatial Isometries
• Contact-Aided Invariant Extended Kalman Filtering for Legged Robot State Estimation
• The Geometry of Navigation Problems
• EqVIO: An Equivariant Filter for Visual Inertial Odometry
• Equivariant Filter (EqF)
• InGVIO: A Consistent Invariant Filter for Fast and High-Accuracy GNSS-Visual-Inertial Odometry
• VIO-DualProNet: Visual-Inertial Odometry with Learning Based Process Noise Covariance
• Observer Design for Nonlinear Systems with Equivariance
• Equivariant Systems Theory and Observer Design
• Sparse Pose Graph Optimization in Cycle Space
• An Equivariant Observer Design for Visual Localisation and Mapping
• Know What You Don't Know: Consistency in Sliding Window Filtering with Unobservable States Applied to Visual-Inertial SLAM (Extended Version)
• An Invariant-EKF VINS Algorithm for Improving Consistency
• Equivariant Systems Theory and Observer Design for Second Order Kinematic Systems on Matrix Lie Groups
• The Geometry and Kinematics of the Matrix Lie Group $S{E}_K(3)$
• SE(3) based Extended Kalman Filter for Spacecraft Attitude Estimation
• Inertial based Integration with Transformed INS Mechanization in Earth Frame
• A Right Invariant Extended Kalman Filter for Object based SLAM
• A Minimum Energy Filter for Localisation of an Unmanned Aerial Vehicle
• Invariant Smoothing for Localization: Including the IMU Biases
• Convergence and Consistency Analysis for A 3D Invariant-EKF SLAM
• Inertial Collaborative Localisation for Autonomous Vehicles using a Minimum Energy Filter
• Equivariant filter (EqF): A general filter design for systems on homogeneous spaces
• Invariant Cubature Kalman Filter for Monocular Visual Inertial Odometry with Line Features
• Exploiting Symmetries to Design EKFs with Consistency Properties for Navigation and SLAM