Equivariant IMU Preintegration with Biases: a Galilean Group Approach

Abstract

This letter proposes a new approach for Inertial Measurement Unit (IMU) preintegration, a fundamental building block that can be leveraged in different optimization-based Inertial Navigation System (INS) localization solutions. Inspired by recent advances in equivariant theory applied to biased INSs, we derive a discrete-time formulation of the IMU preintegration on $\mathbf{Gal}(3)⋉\mathfrak{gal}(3)$, the left-trivialization of the tangent group of the Galilean group $\mathbf{Gal}(3)$. We define a novel preintegration error that geometrically couples the navigation states and the bias leading to lower linearization error. Our method improves in consistency compared to existing preintegration approaches which treat IMU biases as a separate state-space. Extensive validation against state-of-the-art methods, both in simulation and with real-world IMU data, implementation in the Lie++ library, and open-source code are provided.

References in corpus (10)

• On-Manifold Preintegration for Real-Time Visual-Inertial Odometry
• A micro Lie theory for state estimation in robotics
• Closed-form Preintegration Methods for Graph-based Visual-Inertial Navigation
• Associating Uncertainty to Extended Poses for on Lie Group IMU Preintegration with Rotating Earth
• EqVIO: An Equivariant Filter for Visual Inertial Odometry
• Equivariant Filter (EqF)
• Galilei invariant theories. I. Constructions of indecomposable finite-dimensional representations of the homogeneous Galilei group: directly and via contractions
• Overcoming Bias: Equivariant Filter Design for Biased Attitude Estimation with Online Calibration
• INSANE: Cross-Domain UAV Data Sets with Increased Number of Sensors for developing Advanced and Novel Estimators
• Equivariant IMU Preintegration with Biases: a Galilean Group Approach

Cited by in corpus (1)

• Equivariant IMU Preintegration with Biases: a Galilean Group Approach