Invariant Smoothing for Localization: Including the IMU Biases
arXiv:2309.13903
Abstract
In this article we investigate smoothing (i.e., optimisation-based) estimation techniques for robot localization using an IMU aided by other localization sensors. We more particularly focus on Invariant Smoothing (IS), a variant based on the use of nontrivial Lie groups from robotics. We study the recently introduced Two Frames Group (TFG), and prove it can fit into the framework of Invariant Smoothing in order to better take into account the IMU biases, as compared to the state-of-the-art in robotics. Experiments based on the KITTI dataset show the proposed framework compares favorably to the state-of-the-art smoothing methods in terms of robustness in some challenging situations.
References in corpus (8)
- On-Manifold Preintegration for Real-Time Visual-Inertial Odometry
- Velocity/Position Integration Formula (I): Application to In-flight Coarse Alignment
- An EKF-SLAM algorithm with consistency properties
- Associating Uncertainty to Extended Poses for on Lie Group IMU Preintegration with Rotating Earth
- Contact-Aided Invariant Extended Kalman Filtering for Legged Robot State Estimation
- The Geometry of Navigation Problems
- Equivariant Filter Design for Inertial Navigation Systems with Input Measurement Biases
- Navigation and Control of Unconventional VTOL UAVs in Forward-Flight with Explicit Wind Velocity Estimation