Quaternion kinematics for the error-state Kalman filter

Abstract

This article is an exhaustive revision of concepts and formulas related to quaternions and rotations in 3D space, and their proper use in estimation engines such as the error-state Kalman filter. The paper includes an in-depth study of the rotation group and its Lie structure, with formulations using both quaternions and rotation matrices. It makes special attention in the definition of rotation perturbations, derivatives and integrals. It provides numerous intuitions and geometrical interpretations to help the reader grasp the inner mechanisms of 3D rotation. The whole material is used to devise precise formulations for error-state Kalman filters suited for real applications using integration of signals from an inertial measurement unit (IMU).

Cited by in corpus (9)

• A Robust Laser-Inertial Odometry and Mapping Method for Large-Scale Highway Environments
• R2LIVE: A Robust, Real-time, LiDAR-Inertial-Visual tightly-coupled state Estimator and mapping
• Good Graph to Optimize: Cost-Effective, Budget-Aware Bundle Adjustment in Visual SLAM
• Drift with Devil: Security of Multi-Sensor Fusion based Localization in High-Level Autonomous Driving under GPS Spoofing (Extended Version)
• Convex Optimization for Trajectory Generation
• Targetless Calibration of LiDAR-IMU System Based on Continuous-time Batch Estimation
• A Versatile Keyframe-Based Structureless Filter for Visual Inertial Odometry
• Comparing Representations in Tracking for Event Camera-based SLAM
• Depth Camera Based Particle Filter for Robotic Osteotomy Navigation