eess.SYSep 14, 2026

The Iterative Equivariant Filter

Authors: Pieter van GoorJames Richard Forbes

Abstract

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.

Explore similar work

CardsList
  1. Equivariant Filter for Radar-Inertial Odometry

    Apr 24, 2026Giulio Delama, Jan Michalczyk, Morten Nissov +4Inertial OdometryExtended Kalman Filter

  2. Iterated Invariant EKF for Quadruped Robot Odometry

    Apr 16, 2026Hilton Marques Souza Santana, João Carlos Virgolino Soares, Sven Goffin +4Extended Kalman FilterLegged Robots

  3. Iterated Invariant EKF for 3D Landmark-Aided Inertial Navigation

    Jun 30, 2026Hilton Marques Souza Santana, João Carlos Virgolino Soares, Marco Antonio MeggiolaroInertial Navigation SystemsExtended Kalman Filter