Associating Uncertainty to Extended Poses for on Lie Group IMU Preintegration With Rotating Earth
Top Cited Papers
- 19 August 2021
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Transactions on Robotics
- Vol. 38 (2) , 998-1015
Abstract
The recently introduced matrix group $\mathbf {SE_2(3)}$ provides a 5 $\mathbf {\times }$ 5 matrix representation for the orientation, velocity, and position of an object in the 3-D space, a triplet we call “extended pose.” In this article, we build on this group to develop a theory to associate uncertainty with extended poses represented by 5 $\mathbf {\times }$ 5 matrices. Our approach is particularly suited to describe how uncertainty propagates when the extended pose represents the state of an inertial measurement unit (IMU). In particular, it allows revisiting the theory of IMU preintegration on manifold and reaching a further theoretic level in this field. Exact preintegration formulas that account for rotating earth, that is, centrifugal force and Coriolis force, are derived as a byproduct, and the factors are shown to be more accurate. The approach is validated through extensive simulations and applied to sensor fusion where a loosely coupled fixed-lag smoother fuses IMU and LiDAR on 1-h-long experiments using our experimental car. It shows how handling rotating earth may be beneficial for long-term navigation within incremental smoothing algorithms.
Keywords
All Related Versions
This publication has 52 references indexed in Scilit:
- Tightly-coupled monocular visual-inertial fusion for autonomous flight of rotorcraft MAVs2015
- Continuous-Discrete Extended Kalman Filter on Matrix Lie Groups Using Concentrated Gaussian DistributionsJournal of Mathematical Imaging and Vision, 2014
- Associating Uncertainty With Three-Dimensional Poses for Use in Estimation ProblemsIEEE Transactions on Robotics, 2014
- Vision meets robotics: The KITTI datasetThe International Journal of Robotics Research, 2013
- Information fusion in navigation systems via factor graph based incremental smoothingRobotics and Autonomous Systems, 2013
- iSAM2: Incremental smoothing and mapping using the Bayes treeThe International Journal of Robotics Research, 2011
- Nonparametric Second-order Theory of Error Propagation on Motion GroupsThe International Journal of Robotics Research, 2008
- Sigma-point Kalman filtering for integrated GPS and inertial navigationIEEE Transactions on Aerospace and Electronic Systems, 2006
- A Lie Group Formulation of Robot DynamicsThe International Journal of Robotics Research, 1995
- On the Representation and Estimation of Spatial UncertaintyThe International Journal of Robotics Research, 1986