CS Paper Radar

A Sliding Window Filter on the Galilean Group for Consistent Aided Inertial Navigation with Unknown Measurement Delays

Jonathan Kelly

cs.RO ·submitted 2026-08-30 02:34 UTC · v1
published

Abstract

We study aided inertial navigation when the aiding sensor measurements are subject to an unknown constant delay. The goal is to estimate the delay and navigation state jointly so that delayed measurements correct the trajectory at the appropriate times, yielding a more accurate navigation solution. We formulate the problem on the special Galilean group, which provides a natural state-space structure for aided navigation with uncertainty in both motion and timing. We then examine the observability of joint delay and state estimation and show that, for a single delayed measurement, the model admits an exact symmetry in which a change in the delay can be compensated by a change in the navigation state, leaving the measurement unchanged. Processing measurements individually allows spurious information to `leak' along the corresponding null direction of the measurement Jacobian, producing overconfident and inconsistent estimates. Applying measurements from multiple times together can eliminate this direction when the trajectory is informative enough. Motivated by this result, we develop a sliding window filter that retains a short history of navigation states and applies delayed aiding corrections jointly across the active window. We conduct a series of simulation studies to characterize estimator accuracy and consistency. The simulations demonstrate that an estimator that does not maintain an adequate window can rapidly become highly inconsistent, whereas even a short sliding window markedly improves consistency by providing the temporal support that observability requires.

Comment
Accepted to the IEEE International Conference on Multisensor Fusion and Integration (MFI), Pilsen, Czechia, Sep 2-4, 2026

Closest papers

Nearest neighbours by meaning across the whole index.

Compressed delayed-information projection for underwater navigation under acoustic measurement latency

cs.RO ·2026-09-23 ·Shuyue Li, Miguel López-Benítez, Eng Gee Lim, Fei Ma, Qian Dong +3 more
similarity 0.64
Abstract · 31 pages, 7 figures, 6 tables. Submitted to The Journal of the Acoustical Society of America (JASA)

Delayed acoustic position measurements describe past states but may reach an underwater vehicle after its navigation estimate has advanced. This paper presents compressed delayed-information projection (CDIP), a causal delayed-update method implemented in a 15-dimensional error-state Kalman filter (ESKF). CDIP retains source-associated inertial measurement unit (IMU) snapshots and maintains current-to-snapshot cross-covariances, projecting delayed corrections without repeated full-from-start filtering. In 154 paired simulation recordings with synthetic horizontal-position fixes delayed by 1.5~s, CDIP reduced mean trajectory-position root-mean-square error (RMSE) from 1.062~m for a reception-time Baseline to 0.456~m (57.1\%). Its mean RMSE approached that of full-from-start Replay (0.451~m), with 99.2\% lower mean core-loop time per processed IMU step for the tested implementations. A six-delay sweep, scheduled permanent-loss outages of 50--300~s, and packet-erasure tests further characterized sensitivity to measurement timing and availability. A separate 256-trial nonlinear synthetic assessment identified departures from the prespecified calibration criterion for CDIP and two fully augmented ESKF references. Together, these results demonstrate an accuracy--computation trade-off for causal underwater navigation under the evaluated delayed-measurement simulation conditions.

0.23

CT-SGAL-LIO: Causal Continuous Time Refinement of Discrete LiDAR Inertial Odometry

cs.RO ·2026-11-12 ·Nam Tran, Thu Tran, Toan Nguyen, William J Beksi, Tuan Dang
published similarity 0.61
Abstract · 7 pages, 4 figures, ICRA 2027 submissions

State-of-the-art LiDAR-inertial odometry methods, including those on richer state manifolds, achieve strong global accuracy, yet their pose stream alternates between propagation and correction and can oscillate over short horizons even when globally accurate. Most existing methods follow these approaches: they either modify the filter to enable faster updates or estimate a continuous-time trajectory from raw LiDAR and inertial data. The latter involves extra optimization, delaying state updates and becoming less robust during rapid rotations or accelerations. We propose CT-SGAL-LIO, a continuous-time refinement module that smooths the posterior pose stream of a discrete SGal(3) estimator without modifying the estimator itself. The key novelty is to perform continuous-time trajectory refinement directly on the projected SGal(3) posterior: we fit a cubic trajectory over a bounded window of recent poses and evaluate it at a small fixed lag. This places the query time within the observed interval, so the refined pose is obtained by interpolation rather than extrapolation, while preserving causal operation. CT-SGAL-LIO improves relative trajectory accuracy on 17 sequences from three public benchmarks. Across 17 sequences from GRAND-TOUR, MCD, and GEODE, CT-SGAL-LIO improves short-term motion accuracy while largely preserving global accuracy. RTE improves by up to 70% on GRAND-TOUR and on all seven GEODE sequences, with 9.9-51.1% reductions. A 19.5-min R-Campus run also reduces posterior jumps by 85.4% with only a 4.7 mm change in the end-to-start gap. We plan to release our source code and results to support community validation and reproducibility.

0.27

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

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

Galilean Robots, Aristotelian Sensors: Joint Spatiotemporal Trajectory Estimation and Extrinsic Calibration

cs.RO ·2026-11-09 ·Abhishek Goudar, Jonathan Kelly, Timothy D. Barfoot
similarity 0.58
Abstract

Multi-sensor state estimation requires accurate spatial and temporal calibration between heterogeneous sensors. Existing spatiotemporal calibration methods typically represent sensor extrinsic parameters as a rigid-body transformation together with a scalar temporal offset, causing the spatial and temporal parameters to enter the estimation problem through separate mechanisms. While the spatial transformation composes directly with the robot pose, accounting for the temporal offset requires evaluating the trajectory at a shifted time, typically through motion compensation, interpolation, or a continuous-time trajectory representation. In this work, we formulate joint trajectory estimation and spatiotemporal calibration using the special Galilean group for the robot trajectory and the Aristotelian subgroup for sensor extrinsics. This representation incorporates the coupling between motion and temporal offset directly through the group structure, avoiding the need for a separately parameterized continuous-time trajectory. We develop twist- and IMU-driven motion priors, accommodate both ideal and non-ideal clocks, and evaluate the framework with camera, position, and range measurements. Simulated and real experiments demonstrate calibration and trajectory-estimation performance comparable to established methods across heterogeneous sensor configurations. Our simplified framework therefore offers a quality-of-life improvement over existing methods without compromising performance.

0.17

UCON: Uncertainty-aware Navigation with Historical Re-association in Dynamic Environments

cs.RO ·2026-09-24 ·Bing Sun, Yue Lin, Yongsheng Yuan, Yang Liu, Dong Wang +1 more
published similarity 0.58
Abstract · Accepted to the 2026 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2026)

Autonomous navigation in dynamic environments is hindered by two fundamental challenges: perception instability and uncertainty-optimization mismatch. The former leads to identity switches and unreliable motion estimation, while the latter prevents principled incorporation of motion uncertainty into trajectory optimization. To address these challenges, we propose UCON, an uncertainty-aware navigation algorithm in dynamic environments. For perception instability, we present a point-level historical re-association mechanism that leverages historical point cloud fragments to recover lost targets while maintaining identity continuity. Subsequently, a Kalman filter is employed to provide anisotropic motion state estimation and covariance propagation. To resolve the uncertainty-optimization mismatch, we transform predicted states and their covariances into uncertainty sectors, which are embedded as differentiable cost terms within a trajectory optimization framework. This achieves consistent uncertainty-aware dynamic obstacle avoidance while maintaining smoothness and feasibility. Extensive simulations and real-world experiments demonstrate that, while maintaining high computational efficiency, UCON achieves superior perception stability and robust navigation performance in dynamic environments compared to state-of-the-art methods. The code will be open-sourced to facilitate further research.

0.40

Velocity-Free Funnel Control of Euler-Lagrange Systems: An Artificial-Delay Approach

eess.SY ·2026-11-12 ·Chayan Kumar Paul, Pushpak Jagtap
similarity 0.57
Abstract

Classical funnel control keeps the tracking error within a prescribed, time-varying envelope by increasing the feedback gain as the error approaches the boundary. For mechanical systems, this guarantee typically relies on velocity measurements. We show that it can be retained for fully actuated Euler--Lagrange systems using only position measurements. The proposed controller replaces the velocity error with a difference quotient of the position error over a fixed delay, while preserving the classical unbounded gain. It requires no plant model, reference derivatives, observer, or filter states. The central challenge is to reconcile the averaging inherent in delayed feedback with a gain that can grow without bound near the funnel boundary. We resolve this by establishing an a priori bound on the gain along closed-loop trajectories, independent of the delay. This bound yields a computable delay threshold that guarantees tracking within the prescribed funnel and boundedness of all closed-loop signals. The threshold depends only on bounds on the inertia, forces, and reference. Simulations demonstrate tracking accuracy comparable to full-state funnel control and tolerance of delays substantially longer than certified. With quantized position measurements, the controller also requires substantially less torque than an existing derivative-free funnel controller.

0.30

GAUGE: Planner-Conditioned Active Calibration of Opaque Quadruped Velocity Interfaces

cs.RO ·2026-09-26 ·Tianhao Zang, Zihan Liu, Shanze Wang, Liyou Luo, Xingjian Xie +2 more
code/data similarity 0.57
Abstract · 8 pages

In this paper, we present a Goal-Aware Uncertainty-Guided Exploration (GAUGE) framework for planner-conditioned active calibration of opaque quadruped velocity interfaces. Commercial quadrupeds commonly expose planar-velocity commands, but the underlying locomotion controller remains inaccessible and can produce systematic discrepancies between commanded and realized motion. A navigation planner typically uses a structured subset of the command envelope. GAUGE maintains a Bayesian command-to-motion model and selects authorized trials according to their expected reduction of posterior epistemic uncertainty under the planner-induced command distribution. The resulting posterior supports validation-based stopping, bounded inverse compensation, and task-relevant recalibration after detected interface shifts. In three controlled response families, GAUGE reaches the joint criterion for task-facing accuracy and uncertainty with fewer trials than passive, D-optimal, and task-agnostic alternatives. Across six held-out Isaac Sim navigation maps, it meets the declared noninferiority margins against dense calibration. Code is available at https://github.com/EurekaZang/CalibAgent.

0.34