バイアスを考慮した等変IMUプリインテグレーション:ガリレイ群によるアプローチ
Equivariant IMU Preintegration with Biases: a Galilean Group Approach
IMUバイアスをガリレイ群の接群上で幾何学的に統合する新しいプリインテグレーション手法を提案し、従来法より線形化誤差と一貫性を改善した。
著者: Giulio Delama, Alessandro Fornasier, Robert Mahony, Stephan Weiss
分類: cs.RO
原文アブストラクト
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) \ltimes \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.
