DeepAI AI Chat
Log In Sign Up

Associating Uncertainty to Extended Poses for on Lie Group IMU Preintegration with Rotating Earth

by   Martin Brossard, et al.

The recently introduced matrix group SE2(3) provides a 5x5 matrix representation for the orientation, velocity and position of an object in the 3-D space, a triplet we call ”extended pose”. In this paper we build on this group to develop a theory to associate uncertainty with extended poses represented by 5x5 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 one hour long experiments using our experimental car. It shows how handling rotating Earth may be beneficial for long-term navigation within incremental smoothing algorithms.


page 1

page 12

page 13


A Mathematical Framework for IMU Error Propagation with Applications to Preintegration

To fuse information from inertial measurement units (IMU) with other sen...

UWB Ranging and IMU Data Fusion: Overview and Nonlinear Stochastic Filter for Inertial Navigation

This paper proposes a nonlinear stochastic complementary filter design f...

Inertial Navigation Using an Inertial Sensor Array

We present a comprehensive framework for fusing measurements from multip...

VID-Fusion: Robust Visual-Inertial-Dynamics Odometry for Accurate External Force Estimation

Recently, quadrotors are gaining significant attention in aerial transpo...

Characterizing the Uncertainty of Jointly Distributed Poses in the Lie Algebra

An accurate characterization of pose uncertainty is essential for safe a...

An Experimental Comparison of Floating Base Estimators for Humanoid Robots with Flat Feet

Extended Kalman filtering is a common approach to achieve floating base ...

Sector Bounds for Vertical Cable Force Error in Cable-Suspended Load Transportation System

This article studies the collaborative transportation of a cable-suspend...