CS Paper Radar

A simple derivation of the Kalman filter

Marco Chiani, Giovanni Petris, Moe Z. Win

eess.SP math.OCeess.SYmath.STstat.ME ·submitted 2026-09-02 09:09 UTC · v1
published

Abstract

In this lecture note, we present a concise and self-contained derivation of the discrete-time Kalman filter equations that requires only a basic understanding of least squares estimation. The treatment is designed to minimize mathematical overhead while preserving both rigor and generality.

Comment
To be published in IEEE Signal Processing Magazine

Closest papers

Nearest neighbours by meaning across the whole index.

The Iterative Equivariant Filter

eess.SY cs.RO ·2026-09-11 ·Pieter van Goor, James Richard Forbes
similarity 0.59
Abstract · 9 pages, 1 figure, submitted

This paper presents the iterative equivariant filter (IterEqF). The iterative extended Kalman filter (IterEKF) replaces the standard EKF correction step with an iterative correction step that is the Gauss-Newton solution to a nonlinear weighted least squares problem. The standard equivariant filter (EqF) exploits and respects the underlying symmetry of state estimation problems posed on homogeneous spaces and Lie groups. The motivation behind the IterEqF is to combine the features of both the IterEKF and the EqF, thus leading to a high-performance state estimation solution that is well suited to navigation problems. This paper derives the iteration procedure for the IterEqF update step and shows how the intrinsic nonlinearity of the approach naturally results in a `reset' of the filter's covariance into new coordinates. Monte-Carlo simulations of range-based localisation for a mobile robot demonstrate the improvement in performance relative to a standard EqF, especially during the transient convergence.

0.36

Accuracy Evaluation of INS/ZUPT Filtering Methods Based on Different Geometric Error Definitions

cs.RO ·2026-09-25 ·Wei Ouyang, Jiale Han, Yarong Luo, Maoran Zhu
similarity 0.56
Abstract

Geometric filters have recently been introduced to improve the accuracy and consistency of inertial-based integrated navigation systems. Error states were defined through specific group operations, introducing state correlations in error definition, which were lacked in the additive error used by a conventional indirect Kalman filter. The desirable consistent filtering models can be obtained based on specific geometric errors. For zero-velocity measurements expressed in the reference frame, this paper derives left-error process and measurement models from invariant filtering, two-frame-group filtering, and equivariant filtering. Importantly, a new group operation is introduced for the left tangent-group equivariant error. The analysis shows that the two-frame-group invariant extended Kalman filter (TFG-IEKF) and the tangent-group equivariant filter (TG-EqF) do not offer a significant consistency advantage over the invariant extended Kalman filter (IEKF). Experiments with an INS/ZUPT measurement system show that, under small initial attitude errors, the conventional indirect extended Kalman filter (EKF) achieves loop-closure position errors below $0.1\%$ of the traveled distance, while the three geometric filters achieve comparable positioning accuracy.

0.13

Wiener Space Cubature for Nonlinear Gaussian Filtering

eess.SP ·2026-10-02 ·Luke Snow, Daniel Waxman, Matthew E. Levine
theory similarity 0.55
Abstract

Continuous-discrete filtering is a classical problem in signal processing and control theory, whereby the state driving a stochastic differential equation (SDE) must be inferred from noisy, partial discrete-time observations. Corresponding filtering algorithms are often formed as discrete-time methods and applied to a discretization of the SDE, an approach limited by the incurred discretization error, or model a type of Gaussian moment ordinary differential equation (ODE) flow, which is approximate for nonlinear dynamics. We introduce a new method, the Wiener-space cubature Kalman filter (WSC-KF), for Gaussian filtering in this continuous-discrete setting. The WSC-KF combines spatial sigma-point representations with Wiener space cubature integration, effectively approximating iterated integral terms of the driving Brownian motion to higher-order than standard discretization (e.g., Ito-Taylor expansions), or approximate moment-ODE flows (e.g., as in the unscented Kalman filter). Theoretically, we characterize the path-law approximation degree of WSC-KF through a tunable model order parameter. We prove that, depending on the model order chosen, WSC-KF provides weak order bounds comparable to or dominating that of a cubature Kalman filter using a first-order Ito predict step. Numerically, we confirm that rate on a globally Lipschitz Levy-area diffusion. Degree-5 Wiener cubature matches mixed iterated integrals that existing continuous-discrete Kalman predictors omit, while remaining efficiently computable; this is the mechanism enabling higher-order weak path-law approximation.

0.25

Efficient Sensor Fusion Through Covariance-Constrained Observation Decimation (CCOD)

eess.SY ·2026-09-02 ·Andres Enriquez Fernandez, Erik Blasch, Angel Flores-Abad, John J. Bird
similarity 0.54
Abstract

Observation decimation is frequently employed in state estimation to reduce sensing, communication, and computational requirements, but decreasing the measurement assimilation frequency increases estimation uncertainty. Selecting an appropriate observation decimation factor therefore requires accurately predicting the resulting estimator performance. While the discrete algebraic Riccati equation (DARE) provides the steady-state estimation-error covariance for standard linear time-invariant Kalman filters, it is not directly applicable to estimators employing decimated measurement updates. Existing approaches address this limitation through lifted system representations or periodic Riccati equation formulations, both of which incur additional computational complexity. This paper presents a covariance-constrained observation decimation (CCOD) framework that reformulates the DARE inputs using equivalent decimated system and process-noise matrices that capture covariance growth between measurement updates. The proposed reformulation enables direct prediction of the steady-state estimation-error covariance through a single DARE evaluation without increasing the system dimension or solving coupled periodic Riccati equations. The resulting covariance prediction is used to determine the maximum observation decimation factor that satisfies a prescribed estimation uncertainty bound. Validation using a high dimensional linear time-invariant system and a space object tracking application demonstrates that the proposed approach accurately predicts steady-state estimator performance while reducing the measurement assimilation frequency required to satisfy specified covariance constraints.

0.21

On asymptotic stability of the time-varying Kalman filter for unstabilizable linear systems: an optimization perspective

eess.SY ·2026-09-16 ·James B. Rawlings, Titus Quah, Matthias A. Müller
similarity 0.54
Abstract

This paper establishes the necessary and sufficient conditions for asymptotic stability of the time-varying Kalman filter applied to a linear time invariant system with semidefinite initial state covariance and positive definite process and measurement noise. Rather than analyze the discrete Riccati equation as in the classic literature, the equivalent state smoothing optimization problem is stated and all results are established using properties of this optimization problem. A Lyapunov-like function, termed a modified $Q$-function is derived and used for this analysis. This optimization approach removes the need for the classic but cumbersome Riccati iteration algebra and provides better generalization and application for nonlinear systems.

0.22

Neural Kalman Filtering for Unknown Dynamics: Task-Aware Learning with a Koopman Backbone

eess.SP ·2026-09-21 ·Mintaek Oh, Jeonghun Park, Nir Shlezinger, Yonina C. Eldar, Jinseok Choi
hot direction similarity 0.54
Abstract · 13 pages, 6 figures

Recent years have witnessed a growing interest in AI-aided Kalman filters. While emerging methodologies, such as KalmanNet, were shown to facilitate tracking in partially known state-space models, they are not directly applicable when the underlying dynamics is unknown. To overcome this limitation, we extend the KalmanNet philosophy to the unknown-dynamics regime by developing blind Kalman filtering frameworks that learn both the predictor and the correction gain from data, assuming that the state-evolution function and the noise statistics are both unavailable. To this end, we first introduce a task-aware neural Kalman filtering framework, Blind-KalmanNet, which carries the learning principle of the Kalman gain into the prediction step through a two-head neural architecture that jointly learns a state-dependent linear surrogate and the Kalman gain from data. Building on this formulation, we then develop our main framework, Koopman-aided Blind-KalmanNet, which incorporates Koopman operator theory to lift the unknown dynamics into a latent space where the state evolves linearly. The lifted linear predictor integrates seamlessly into the Blind-KalmanNet structure: the pre-trained deep Koopman network serves as a globally structured predictor, augmented by the task-aware residual surrogate and the learned Kalman gain inherited from Blind-KalmanNet. Extensive experiments demonstrate that the proposed frameworks achieve competitive performance against baselines, with Koopman-aided Blind-KalmanNet attaining the best accuracy across all considered settings.

0.33

An Algebraic Observer for State-Affine Systems

eess.SY ·2026-09-21 ·Romeo Ortega, Alexey Bobtsov, Anton Pyrkin, Olga Zarina
similarity 0.53
Abstract · 14 pages, 13 figures, submitted to Automatica

We present a new systematic method to design an algebraic swapping lemma observer for nonlinear systems which are affine in the state. Four are the main features of the new observer: (i) Far superior transient performance compared to standard asymptotically convergent observers; (ii) structural simplicity - its construction relies solely on basic linear filtering and a single matrix inversion; (iii) applicability to non-uniformly-completely-observable systems, for which classical methods are not applicable; (iv) straightforward extension to the cases of unknown time-varying parameters and measurement delay. The core idea exploited in the paper is to combine the construction of a generalized parameter estimation-based observer with a simple filtering technique to derive the algebraic observer. The resulting design is shown to apply to a class of state-affine systems satisfying a weak generic condition. Moreover, it is established that for time-invariant systems, this condition is always satisfied globally.

0.30

Online Digital Twins: Data Assimilation and Control

eess.SY math.OCmath.NA ·2026-11-09 ·Sebastian Reich
similarity 0.53
Abstract

The online assimilation of data and the application of controls are essential ingredients of the digital twin paradigm. In this paper, we formalize the online interaction between the physical process and its virtual digital representation in the setting of continuously arriving data from the physical process and a receding horizon virtual planning process, which provides the control for the physical process. Our mathematical formulation relies on a mean field representation of the data assimilation process as well as a mean field Pontryagin minimum principle for the optimal control problem. Such mean field formulations are computationally attractive because they allow for simultaneous implementation in terms of Hamiltonian interacting particle systems. A more detailed discussion is included for the ensemble Kalman-Bucy filter in combination with affine approximations of the receding horizon control laws. This paper sets out the mathematical framework, while a computational study is left for future research.

0.24