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.

Low-rank approximated Kalman filter using Oja's principal component flow for discrete-time linear systems

Low-rank approximated Kalman-Bucy filters using Oja's principal component flow for linear time-invariant systems

The study of joint input and state estimation with Kalman filtering

Input and state estimation for linear systems: A least squares estimation approach

The Rank-Reduced Kalman Filter: Approximate Dynamical-Low-Rank Filtering In High Dimensions

Direct Method Without the Riccati Equation for a Linear Filtering System with Arbitrary Initial Conditions

Solution to Brockett's Problem on Finite-Dimensional Estimation Algebras of Maximal Rank in Nonlinear Filtering

Some New Non-Riccati Algorithms for Continuous-Time Kalman-Bucy Filtering

Lie Algebraic Method in Nonlinear Filtering with State Space Dimension Up to 6

Online Estimation of the Approximate Posterior Cramer-Rao Lower Bound for Discrete-Time Nonlinear Filtering

An Overdispersed Black-Box Variational Bayesian–Kalman Filter with Inaccurate Noise Second-Order Statistics

Outlier-Insensitive Kalman Filtering: Theory and Applications

Low-rank Kalman filtering under model uncertainty

An Elementary Introduction to Kalman Filtering

Kalman Filters on Differentiable Manifolds

On integrals in multi-output discrete-time Kalman-Bucy filtering

A Finite-Horizon Adaptive Kalman Filter for Linear Systems with Unknown Disturbances

New Classes of Finite Dimensional Filters with Nonmaximal Rank Estimation Algebra on State Dimension N and Linear Rank N-2.

New Direct Method for Kalman-Bucy Filtering System with Arbitrary Initial Condition

Parallel Ode-Solvers for Kalman-Bucy Filter with Arbitrary Initial Condition

Data-Driven Kalman Filter using Maximum Likelihood Optimization