A micro Lie theory for state estimation in robotics

Abstract

A Lie group is an old mathematical abstract object dating back to the XIX century, when mathematician Sophus Lie laid the foundations of the theory of continuous transformation groups. As it often happens, its usage has spread over diverse areas of science and technology many years later. In robotics, we are recently experiencing an important trend in its usage, at least in the fields of estimation, and particularly in motion estimation for navigation. Yet for a vast majority of roboticians, Lie groups are highly abstract constructions and therefore difficult to understand and to use. This may be due to the fact that most of the literature on Lie theory is written by and for mathematicians and physicists, who might be more used than us to the deep abstractions this theory deals with. In estimation for robotics it is often not necessary to exploit the full capacity of the theory, and therefore an effort of selection of materials is required. In this paper, we will walk through the most basic principles of the Lie theory, with the aim of conveying clear and useful ideas, and leave a significant corpus of the Lie theory behind. Even with this mutilation, the material included here has proven to be extremely useful in modern estimation algorithms for robotics, especially in the fields of SLAM, visual odometry, and the like. Alongside this micro Lie theory, we provide a chapter with a few application examples, and a vast reference of formulas for the major Lie groups used in robotics, including most jacobian matrices and the way to easily manipulate them. We also present a new C++ template-only library implementing all the functionality described here.

17 pages, 12 figures, 7 boxed examples, 193 numbered equations. V2 add chapter with a application examples. V3 fix biblio, remove reference to manif library. V4 add reference to the C++ library "manif", which is made available with this version 4. V5 fix formulas (163) and (179). V6, V7 fix typos. V8 fix sign in eq 149. V9 fix Ex. 5 and Jacobian 'H' in EKF example

References in corpus (1)

• Quaternion kinematics for the error-state Kalman filter

Cited by in corpus (24)

• A Robot Web for Distributed Many-Device Localisation
• An Efficient Locally Reactive Controller for Safe Navigation in Visual Teach and Repeat Missions
• Efficient Analytical Derivatives of Rigid-Body Dynamics using Spatial Vector Algebra
• Globally optimal vertical direction estimation in Atlanta World
• Multi-Robot Relative Pose Estimation and IMU Preintegration Using Passive UWB Transceivers
• Self-Supervised Deep Pose Corrections for Robust Visual Odometry
• PALoc: Advancing SLAM Benchmarking with Prior-Assisted 6-DoF Trajectory Generation and Uncertainty Estimation
• Know What You Don't Know: Consistency in Sliding Window Filtering with Unobservable States Applied to Visual-Inertial SLAM (Extended Version)
• Manifold GPLVMs for discovering non-Euclidean latent structure in neural data
• RGB-D Odometry and SLAM
• Distributed Simultaneous Localisation and Auto-Calibration using Gaussian Belief Propagation
• On the Coupling of Depth and Egomotion Networks for Self-Supervised Structure from Motion
• VIRAL-Fusion: A Visual-Inertial-Ranging-Lidar Sensor Fusion Approach
• Probabilistic Regression of Rotations using Quaternion Averaging and a Deep Multi-Headed Network
• Equivariant IMU Preintegration with Biases: a Galilean Group Approach
• Full-Body Torque-Level Non-linear Model Predictive Control for Aerial Manipulation
• DSP-SLAM: Object Oriented SLAM with Deep Shape Priors
• 3DMNDT:3D multi-view registration method based on the normal distributions transform
• A hierarchical framework for collision avoidance in robot-assisted minimally invasive surgery
• Heading Estimation Using Ultra-Wideband Received Signal Strength and Gaussian Processes
• Line Flow based SLAM
• Compositional Scalable Object SLAM
• Tangent Space Backpropagation for 3D Transformation Groups
• High Speed Event Camera TRacking