CS Paper Radar

An Equivariant Filter for Spacecraft Nonlinear Relative Navigation with Range and Bearing Measurements

Gil Serrano, Bruno J. Guerreiro, Pedro Lourenço, Rita Cunha

eess.SY ·submitted 2026-09-11 17:29 UTC · v1
unusual

Abstract

Relative navigation is a fundamental task in space proximity operations and autonomous rendezvous. The nonlinear relative orbital dynamics are equivariant and admit a semidirect product Lie group symmetry. This property is used to design an Equivariant Filter (EqF). The filter estimates the relative position and velocity between a chaser spacecraft and a target by lifting the filter dynamics to the group, while respecting the underlying geometry of the problem. Simulations demonstrate the filter's performance and effectiveness.

Comment
Extended version of a manuscript submitted to IEEE for possible publication

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

Equivariant Filter Design for Acoustic and Depth Aided Inertial Navigation Systems

cs.RO ·2026-09-17 ·Arihant Lunawat, Pieter van Goor, Frank Dellaert, Stefan B. Williams
benchmark similarity 0.57
Abstract · 12 pages, 6 figures, submitted to ICRA 2027

Autonomous Underwater Vehicles (AUVs) navigating without GPS typically fuse inertial measurements with acoustic Doppler Velocity Log (DVL) velocities and pressure-derived depth. Posing the navigation state on a Lie group improves accuracy and consistency. However, state-of-the-art filters based on the Invariant Extended Kalman Filter (IEKF) append the Inertial Measurement Unit (IMU) biases as a Euclidean extension, which breaks the group-affine structure required for exact log-linear error dynamics, causing the reported covariance to degrade alongside the estimate. We apply the Tangent-Group (TG) symmetry, which carries the biases within the geometry of the state space, to derive an Equivariant Filter (EqF) for this system, leaving zero linearization error in the navigation states and second-order error only in the biases. We develop an equivariant output model for the DVL, whose update incurs only third-order linearization error, together with a direct pressure output. Monte Carlo simulations benchmark the TG-EqF against a Two-Frame-Group IEKF and a Multiplicative EKF. The TG-EqF reduces error by 18--25\% against both alternatives in each of attitude, velocity, and position. The main benefit is in the covariance it estimates: its Average Normalized Estimation Error Squared (ANEES) stays closer to its nominal value of one than that of the others. Offline analysis on AUV field data corroborates the findings of the simulations, demonstrating reduced position drift.

0.19

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.50
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

Two-impulse Rendezvous Planning about Thrusting Spacecraft on SE2(3)

eess.SY ·2026-09-23 ·Micah Condie, Abigaile Woodbury, James Goppert
hot direction similarity 0.50
Abstract

The classical Hill--Clohessy--Wiltshire equations assume an unforced Keplerian reference trajectory, an assumption that is violated by missions requiring continuous thrust. We formulate spacecraft relative motion on the $\mathrm{SE}_2(3)$ Lie group, which encodes position, velocity, and attitude in a single geometric state, linearize the gravity and body-frame control mismatches between the two vehicles, and derive analytic bounds on every neglected term. Under circular coasting Keplerian assumptions the framework recovers the Hill--Clohessy--Wiltshire equations exactly. For thrusting references the state transition matrix acquires thrust-induced attitude--translation coupling blocks that, when the two vehicles share body-frame inputs, are exact in log coordinates and independent of the attitude error, and a mismatch between the vehicles' inputs re-centers the linearization at their mean. A two-impulse rendezvous planner follows directly. A scalar coupling ratio, computable before planning, separates two regimes. Where it exceeds unity, the planner reduces the terminal error of coupling-blind planners by more than an order of magnitude, and somewhat above unity it is also more accurate than a Cartesian planner of the same computational structure; well below unity, simpler planners are adequate or better. Simulations confirm the recovery to machine precision and validate every bound along the transfer.

0.33

Reference-Filter-Driven Transition Probabilities for IMM-Based Satellite Maneuver Detection

eess.SY astro-ph.IMeess.SP ·2026-10-08 ·Euiseok Han, Sangheon Choi, Seung-Hyun Kong
similarity 0.49
Abstract · 14 pages, 6 figures

Maneuver detection of non-cooperative satellites is an essential task of space situational awareness. The interacting multiple model (IMM) filter has been applied to detect unannounced maneuvers, but the standard IMM assumes a fixed Markov transition probability matrix (TPM) that must be tuned without knowledge of the maneuver rate of the target. To avoid this tuning, adaptive-TPM approaches update the TPM online from statistics computed inside the IMM. However, these statistics already depend on the TPM through the mixing step, and this dependence forms a feedback loop. Under the dynamics mismatch of orbit tracking, the loop can keep the maneuver probability high in the absence of a maneuver or suppress its rise when a maneuver occurs. In this paper, the TPM is driven by the normalized innovation squared (NIS) of a reference coast filter that is not mixed with the IMM, and the NIS is mapped continuously to the coast-to-maneuver transition probability. The reference-driven IMM (RD-IMM) is evaluated with four space-based optical sensors tracking a geosynchronous target. RD-IMM detects small burns that the fixed-TPM IMM fails to detect, with few false declarations in maneuver-free runs, and avoids both failures of the closed-loop adaptation. Moreover, RD-IMM reduces the position error after a small in-track burn by more than 50% compared with the single-filter approaches.

0.29

The Multivariate Feedback Particle Filter for State-dependent Multiplicative Noises and Its Application to Attitude and Pose Estimations

cs.RO math.OC ·2026-11-17 ·Jingyao You, Xue Luo
similarity 0.48
Abstract · 14 pages, 5 figures, 3 tables

Nonlinear filtering with state-dependent multiplicative measurement noise poses a notable challenge for spacecraft attitude determination and robotic pose estimation. This work develops the FPF-DM, a decomposition scheme for feedback particle filters tailored to this family of filtering problems. Extending prior decomposition techniques for additive noise and polynomial measurement models, the proposed method resolves the key difficulty that state-dependent multiplicative noise breaks the polynomial assumption and prevents Hermite spectral backward recursion for the weighted Poisson's equation. By measure transformation and importance reweighting, we incorporate the inverse measurement covariance into particle weights and rescale the feedback gain to restore the polynomial-form Poisson's equation, with the decomposition generalized to non-uniformly weighted mixtures for closed-form gain computation. This general FPF-DM is instantiated on quaternion and dual-quaternion manifolds for attitude tracking and point-cloud registration. Simulations on 4D attitude tracking and 8D point-cloud registration verify that the instantiated filters using only 10 particles achieve superior accuracy and computational performance relative to baseline filters.

0.32

Cislunar navigation is an observability problem: arc-length thresholds, Gramian conditioning, and the Doppler lever

eess.SP astro-ph.EPeess.SYmath.OC ·2026-09-18 ·Chakshu Baweja
similarity 0.46
Abstract · 15 pages, 1 figure, 3 tables, 30 references. Part of the kshana open PNT program. All results reproducible from the released scenario defini…

Dilution of precision is the standard way to describe navigation geometry and it does not apply in cislunar space: its derivation presumes a snapshot solution in which simultaneous measurements determine the state at one instant. A spacecraft tracked by inter-satellite ranging in the Earth-Moon three-body problem has no such solution: range is a function of position only, so the velocity columns of the measurement Jacobian vanish identically and the state is unobservable however many links are in view. The correct figure of merit is dynamical, because the three-body flow carries velocity information into later range measurements. We demonstrate this on four differential-corrected planar distant retrograde orbits, reporting the observability Gramian rather than a dilution of precision. Instantaneous range-only geometry has rank 2 of 4; the full state becomes observable only after a tracking arc of 2.09 h, the first sampled arc at full rank on a 0.26 h grid, and a square-root information filter recomputing the same quantity by a different route becomes well-posed at exactly that arc. Beyond it, conditioning improves monotonically with arc length, the Gramian condition number falling from 1.2e11 at 3 h to 1.4e5 at 48 h. Adding range rate lifts the instantaneous rank from 2 to 4, so a Doppler-capable link makes a snapshot solution exist where a range-only link cannot. Lifting the known-reference assumption, the joint problem of estimating a station and the satellites' states and clocks together is rank-deficient by exactly one without an external interferometric observable in all twenty realizations tested, and full rank with it; the deficiency persists only to four satellites. For the configurations studied, cislunar navigation requirements are better written as arc-length, conditioning and measurement-type budgets than as dilution-of-precision thresholds, which are undefined here.

0.25

Transformer-Informed Trajectory Optimization for Relative Motion in Cislunar Orbits

cs.AI math.OC ·2026-09-21 ·Walter J. Manuel, Yuji Takubo, Simone D'Amico
similarity 0.45
Abstract · 2026 AAS/AIAA Astrodynamics Specialist Conference

Autonomous spacecraft guidance and control requires a fast solution to non-convex trajectory optimization, which can be accelerated by providing a near-optimal initial guess to an optimization protocol, i.e., warm-starting. A robust warm starting method is especially useful for rendezvous, proximity operations, and docking (RPOD) in cislunar space, where the underlying dynamics become severely nonlinear and chaotic compared to those in Earth orbit, especially at perilune. This paper extends the Autonomous Rendezvous Transformer (ART), a transformer-based warm-start trajectory generation method, to cislunar RPOD scenarios for the first time. To accurately and reliably solve the nonconvex optimal control problems (OCPs) posed by these scenarios, a new and enhanced version of ART, ART-TWIN (Two-Way INference), is introduced. Inspired by forward-backward shooting methods used in other trajectory design applications, ART-TWIN autoregressively generates two arcs, one from the initial state and one from the desired terminal state, that are patched together at the midpoint of the timeseries. When evaluated on a set of simulated rendezvous scenarios that are initialized at perilune, ART-TWIN is demonstrated to substantially accelerate convergence and increase feasibility guarantees when used as a warm-start to sequential convex programming (SCP), compared to convex relaxations and the original ART. These results illustrate the necessity of ART-TWIN's dual-arc generation to enable the viability of and gain benefits from using transformer-based warm-start methods in the most challenging areas of the cislunar dynamical regime.

0.35