Abstract:Kalman filter is presumably one of the most important and extensively used filtering techniques in modern control systems. Yet, nearly all current variants of Kalman filters are formulated in the Euclidean space $\mathbb{R}^n$, while many real-world systems (e.g., robotic systems) are really evolving on manifolds. In this paper, we propose a method to develop Kalman filters for such on-manifold systems. Utilizing $\boxplus$, $\boxminus$ operations and further defining an oplus operation on the respective manifold, we propose a canonical representation of the on-manifold system. Such a canonical form enables us to separate the manifold constraints from the system behaviors in each step of the Kalman filter, ultimately leading to a generic and symbolic Kalman filter framework that are naturally evolving on the manifold. Furthermore, the on-manifold Kalman filter is implemented as a toolkit in $C$++ packages which enables users to implement an on-manifold Kalman filter just like the normal one in $\mathbb{R}^n$: the user needs only to provide the system-specific descriptions, and then call the respective filter steps (e.g., predict, update) without dealing with any of the manifold constraints. The existing implementation supports full iterated Kalman filtering for systems on any manifold composed of $\mathbb{R}^n$, $SO(3)$ and $\mathbb{S}^2$, and is extendable to other types of manifold when necessary. The proposed symbolic Kalman filter and the developed toolkit are verified by implementing a tightly-coupled lidar-inertial navigation system. Results show that the developed toolkit leads to superior filtering performances and computation efficiency comparable to hand-engineered counterparts. Finally, the toolkit is opened sourced at https://github.com/hku-mars/IKFoM to assist practitioners to quickly deploy an on-manifold Kalman filter.

Equivariant Filter (EqF)

Equivariant filter (EqF): A general filter design for systems on homogeneous spaces

Equivariant Filters are Equivariant

Equivariant Filter Design for Discrete-time systems

Equivariant Filter Design for Kinematic Systems on Lie Groups

Equivariant Filtering Framework for Inertial-Integrated Navigation

An Equivariant Filter for Visual Inertial Odometry

EqVIO: An Equivariant Filter for Visual Inertial Odometry

Equivariant Filter Design for Inertial Navigation Systems with Input Measurement Biases

Equivariant Filter for Tightly Coupled LiDAR-Inertial Odometry

MSCEqF: A Multi State Constraint Equivariant Filter for Vision-aided Inertial Navigation

Invariant extended Kalman filter on matrix Lie groups

Equivariant Symmetries for Inertial Navigation Systems

Discrete‐time invariant extended Kalman filter on matrix Lie groups

Equivariant Symmetries for Aided Inertial Navigation

A Note on the Extended Kalman Filter on a Manifold

Toward Consistent and Efficient Map-Based Visual-Inertial Localization: Theory Framework and Filter Design

Contact-Aided Invariant Extended Kalman Filtering for Robot State Estimation

H-Infinity Filtering and Physical Modeling for Robust Kinematics Estimation

Iterated Invariant Extended Kalman Filter (IIEKF)

Kalman Filters on Differentiable Manifolds