Iterated Invariant EKF for Quadruped Robot Odometry

• URL: http://arxiv.org/abs/2604.15449v1
• Date: Thu, 16 Apr 2026 18:09:15 GMT
• Title: Iterated Invariant EKF for Quadruped Robot Odometry
• Abstract summary: We introduce a novel open-source state estimation algorithm for legged robots based on the IterIEKF.<n>We demonstrate that the IterIEKF outperforms the vanilla IEKF, the SO(3)-based Kalman Filter, and its iterated variant in terms of both accuracy and consistency.
• Score: 2.975934604778082
• License: http://arxiv.org/licenses/nonexclusive-distrib/1.0/
• Abstract: Kalman filter-based algorithms are fundamental for mobile robots, as they provide a computationally efficient solution to the challenging problem of state estimation. However, they rely on two main assumptions that are difficult to satisfy in practice: (a) the system dynamics must be linear with Gaussian process noise, and (b) the measurement model must also be linear with Gaussian measurement noise. Previous works have extended assumption (a) to nonlinear spaces through the Invariant Extended Kalman Filter (IEKF), showing that it retains properties similar to those of the classical Kalman filter when the system dynamics are group-affine on a Lie group. More recently, the counterpart of assumption (b) for the same nonlinear setting was addressed in [1]. By means of the proposed Iterated Invariant Extended Kalman Filter (IterIEKF), the authors of that work demonstrated that the update step exhibits several compatibility properties of the classical linear Kalman filter. In this work, we introduce a novel open-source state estimation algorithm for legged robots based on the IterIEKF. The update step of the proposed filter relies solely on proprioceptive measurements, exploiting kinematic constraints on foot velocity during contact and base-frame velocity, making it inherently robust to environmental conditions. Through extensive numerical simulations and evaluation on real-world datasets, we demonstrate that the IterIEKF outperforms the vanilla IEKF, the SO(3)-based Kalman Filter, and its iterated variant in terms of both accuracy and consistency.

Related papers

• The Iterative Equivariant Filter [7.623718506733591]
  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.<n>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.
  arXiv  Detail & Related papers  (2026-09-11T01:22:37Z)
• Generative Bayesian Filtering for State Estimation [8.548885512840073]
  We propose a filtering framework that replaces restrictive observation models with pretrained conditional generative models parametrized by conditional variational autoencoders (CVAE)<n>Experiments on synthetic datasets and real-world applications involving manufacturing system monitoring and arrhythmia diagnosis demonstrate that GBF improves state estimation accuracy and robustness relative to baseline approaches.
  arXiv  Detail & Related papers  (2026-07-09T00:05:23Z)
• Natural Gradient Bayesian Filtering: Geometry-Aware Filter for Dynamical Systems [29.83667827978134]
  This tutorial revisits Gaussian filtering from an information-geometric perspective.<n>Within this framework, we introduce a geometry-aware Gaussian filtering approach.<n>We show that a single natural-gradient step exactly recovers the Kalman measurement update in the linear-Gaussian case.
  arXiv  Detail & Related papers  (2026-05-04T07:59:02Z)
• Preserving linear invariants in ensemble filtering methods [0.0]
  We introduce a generic class of nonlinear ensemble filters that automatically preserve desired linear invariants in non-Gaussian filtering problems. We show how to combine existing regularization techniques for the ensemble Kalman filter with the preservation of the linear invariants.
  arXiv  Detail & Related papers  (2024-04-22T16:39:32Z)
• Closed-form Filtering for Non-linear Systems [83.91296397912218]
  We propose a new class of filters based on Gaussian PSD Models, which offer several advantages in terms of density approximation and computational efficiency. We show that filtering can be efficiently performed in closed form when transitions and observations are Gaussian PSD Models. Our proposed estimator enjoys strong theoretical guarantees, with estimation error that depends on the quality of the approximation and is adaptive to the regularity of the transition probabilities.
  arXiv  Detail & Related papers  (2024-02-15T08:51:49Z)
• System Identification for Continuous-time Linear Dynamical Systems [0.7510165488300368]
  Generalizing the learning of latent linear dynamical systems to continuous-time may extend the use of the hybrid Kalman filter. We apply the method by learning the parameters of a latent, multivariate Fokker-Planck SDE representing a toggle-switch genetic circuit.
  arXiv  Detail & Related papers  (2023-08-23T05:53:13Z)
• Low-rank extended Kalman filtering for online learning of neural networks from streaming data [71.97861600347959]
  We propose an efficient online approximate Bayesian inference algorithm for estimating the parameters of a nonlinear function from a potentially non-stationary data stream. The method is based on the extended Kalman filter (EKF), but uses a novel low-rank plus diagonal decomposition of the posterior matrix. In contrast to methods based on variational inference, our method is fully deterministic, and does not require step-size tuning.
  arXiv  Detail & Related papers  (2023-05-31T03:48:49Z)
• Inverse Extended Kalman Filter -- Part II: Highly Non-Linear and Uncertain Systems [18.244578289687123]
  This paper proposes an inverse extended Kalman filter (I-EKF) to address the inverse filtering problem in non-linear systems. Part I: Theory of I-EKF (with and without unknown inputs) and I-KF (with unknown inputs) Part II: Theory of I-EKF (with and without unknown inputs) and I-KF (with unknown inputs)
  arXiv  Detail & Related papers  (2022-08-13T16:55:39Z)
• Computational Doob's h-transforms for Online Filtering of Discretely Observed Diffusions [65.74069050283998]
  We propose a computational framework to approximate Doob's $h$-transforms. The proposed approach can be orders of magnitude more efficient than state-of-the-art particle filters.
  arXiv  Detail & Related papers  (2022-06-07T15:03:05Z)
• Deep Learning for the Benes Filter [91.3755431537592]
  We present a new numerical method based on the mesh-free neural network representation of the density of the solution of the Benes model. We discuss the role of nonlinearity in the filtering model equations for the choice of the domain of the neural network.
  arXiv  Detail & Related papers  (2022-03-09T14:08:38Z)
• Inverse Extended Kalman Filter -- Part I: Fundamentals [19.078991171384015]
  In this paper, we develop the theory of inverse extended Kalman filter (I-EKF) in detail. We provide theoretical stability guarantees using both bounded non-linearity and unknown matrix approaches. In the companion paper (Part II), we propose reproducing kernel Hilbert space-based EKF to handle incomplete system model information.
  arXiv  Detail & Related papers  (2022-01-05T10:56:58Z)
• KalmanNet: Neural Network Aided Kalman Filtering for Partially Known Dynamics [84.18625250574853]
  We present KalmanNet, a real-time state estimator that learns from data to carry out Kalman filtering under non-linear dynamics. We numerically demonstrate that KalmanNet overcomes nonlinearities and model mismatch, outperforming classic filtering methods.
  arXiv  Detail & Related papers  (2021-07-21T12:26:46Z)
• Neural Kalman Filtering [62.997667081978825]
  We show that a gradient-descent approximation to the Kalman filter requires only local computations with variance weighted prediction errors. We also show that it is possible under the same scheme to adaptively learn the dynamics model with a learning rule that corresponds directly to Hebbian plasticity.
  arXiv  Detail & Related papers  (2021-02-19T16:43:15Z)

This list is automatically generated from the titles and abstracts of the papers in this site.

This site does not guarantee the quality of this site (including all information) and is not responsible for any consequences.