CS Paper Radar

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

Wei Ouyang, Jiale Han, Yarong Luo, Maoran Zhu

cs.RO ·submitted 2026-09-25 09:54 UTC · v2

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.

Closest papers

Nearest neighbours by meaning across the whole index.

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

The Iterative Equivariant Filter

eess.SY cs.RO ·2026-09-11 ·Pieter van Goor, James Richard Forbes
similarity 0.68
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

The Setting of IMU Parameters in Kalman Filtering-based Information Fusion

cs.RO eess.SY ·2026-08-17 ·Qiang Hu, Yanhua Zou, Shuaiyi Huo, Haibo Ge, Wei Ouyang
similarity 0.65
Abstract · 2026 International Conference on Guidance, Navigation and Control

The setting or tuning of specifications for the inertial measurement unit (IMU) is tricky in sensor fusion. The underneath conundrum is caused by the fact that the working condition of IMU is more complex than the stationary calibration scenario. Since the noises and biases instabilities calibrated under static condition cannot accommodate other cases, the effective tuning of IMU parameters largely hinges on the experience or profound understanding of the system. In the current work, the setting method of IMU parameters based on Allan variance calibration is delved into within the Kalman filtering framework. Specifically, the relationship between the power sepctral density and Allan variance is leveraged in formulating the process uncertainty in continuous-time filtering. Three typical IMU-based sensor fusion systems, including INS/GNSS integration, LiDAR-inertial odometry, and visual-inertial odometry are considered to show the feasibility and effectiveness of this parameter setting process.

0.23

Design and Implementation of a Kalman Filter-Infused Algorithm for Tilt Estimation

cs.CV cs.ROeess.SPeess.SY ·2026-09-01 ·Yuehan Ma, Hongji Dai
similarity 0.61
Abstract · 12 pages, 24 figures, 10 references

Accurate tilt angle estimation is important in many engineering applications, such as robotics, motion tracking, and embedded control systems. However, measurements from low-cost inertial sensors are often degraded by noise and drift. This paper presents a single-axis tilt angle estimation system based on the MPU6050 inertial measurement unit, implemented on an RP2040 microcontroller platform, with sensor fusion achieved through a Kalman filter. The accelerometer provides a direct estimate of tilt angle from gravity but is sensitive to noise and short-term fluctuations. The gyroscope provides smooth angular rate measurements, but integration over time introduces drift. To overcome these limitations, a Kalman filter is used to combine measurements from both sensors, leveraging the long-term stability of the accelerometer and the short-term smoothness of the gyroscope. Both simulation and hardware experiments are performed. In simulation, sensor noise and drift are modeled to evaluate the filter performance under control conditions. In the hardware implementation, real-time MPU6050 data is acquired and processed by the RP2040 platform, and the estimated tilt angle is compared with accelerometer-only and gyroscope-only outputs. The results show that the proposed method effectively reduces noise measurements and suppresses long-term drift while preserving good dynamic response. Overall, the system provides more stable and accurate tilt estimation than either sensor alone, demonstrating a practical and accessible approach for Kalman filter based sensor fusion in embedded application. This manuscript is a preprint version of the work. Keywords: Kalman Filter, Accelerometer, Gyroscope, Noise Reduction, Angle Tracking

0.27

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

cs.RO ·2026-08-30 ·Jonathan Kelly
published similarity 0.60
Abstract · Accepted to the IEEE International Conference on Multisensor Fusion and Integration (MFI), Pilsen, Czechia, Sep 2-4, 2026

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.

0.51

Calibration-free IMU-based Relative Orientation Estimation under Dynamic Human Motion

cs.RO eess.SY ·2026-10-22 ·Ruiyuan Li, Hassan Osman, Ajay Seth, Manon Kok
similarity 0.58
Abstract · 8 pages, 7 figures, 1 table. Submitted to IEEE Sensors Journal

Recent magnetometer-free inertial measurement unit (IMU) methods can reduce drift in joint motion estimation using rigid-body constraints, but they typically require pre-calibrated sensor locations, assumptions of specific joint models (e.g., hinge joints) or limited motion types, or an external reference for global orientation. Furthermore, challenges related to high-frequency impacts (e.g. at foot strikes during gait) and numerical differentiation of noisy measurements have not been explicitly addressed. We propose an extended Kalman filter that estimates relative IMU orientation and sensor location simultaneously, requiring neither offline sensor location calibration nor a global orientation anchor. A systematic simulation study shows that the quality of the relative orientation and the sensor location estimates depends on different motion-intensity sources: the joint center acceleration and the relative angular velocity, respectively. A low-pass filter (LPF) is used to mitigate real-signal outliers before applying the rigid-body constraint. When applied to the OpenSense dataset with real IMU measurements across four subjects with three lower-body joint types during walking and complex tasks including various motion types, the proposed method achieves an overall relative orientation error of 2.61°, compared with 10.40° for a baseline using offline-estimated sensor locations and 7.43° for a baseline using marker-derived sensor locations. These results show that the proposed calibration-free estimation framework handles real IMU data effectively and achieves accurate relative orientation without offline sensor location calibration.

0.16

Consensus-Based Distributed Filtering for Angles-Only Tracking in Cislunar Space

eess.SY cs.MA ·2026-10-22 ·Giovanni Romagnoli, Fabrizio Pilone, Giordana Bucchioni
publishedbenchmark similarity 0.57
Abstract · Accepted for presentation at IEEE NAVICON 2026

This paper investigates consensus-based distributed filtering strategies for multi-observer angles-only navigation in the cislunar space. The objective is to estimate the inertial state of a target spacecraft using only line-of-sight measurements collected by a network of observer spacecraft. This problem is particularly relevant for autonomous cislunar navigation, where ground support may be limited, and centralized fusion architectures may be problematic due to communication and computational constraints, and single-point failure risks. Three distributed filtering approaches are considered: the Distributed Extended Kalman Filter, the Information-Weighted Consensus Filter, and the Kalman Consensus Filter. All methods share the same local prediction and measurement-processing steps, but differ in the way information is exchanged and fused across the network. Their performance is evaluated and compared to a centralized Extended Kalman Filter, adopted as benchmark, and independent local filters in a high-fidelity cislunar scenario. Numerical simulations show that the distributed approaches significantly improve estimation accuracy with respect to independent filters. Monte Carlo sensitivity analyses are then conducted to characterize the robustness of the considered methods to finite consensus iterations and prior misalignment among the agents.

0.21

Fusion Based Dynamic Platform Magnetic Compensation Beyond the Tolles Lawson Approach

eess.SY ·2026-08-27 ·Rong Yang, Yaakov Bar-Shalom
similarity 0.57
Abstract · 16 pages, 10 figures, submitted to Journal of Advances in Information Fusion (JAIF) on 3rd Aug 2026

Aeromagnetic compensation for airborne platforms is essential for real-time tracking of the dynamic external magnetic field free from platform interference, enabling robust magnetic navigation (MagNav), magnetic anomaly detection (MAD), and other geophysics applications. While the classical Tolles-Lawson (TL) framework focuses extensively on estimating compensation model parameters, it pays less attention to the real-time estimation of the dynamic external magnetic field. To bridge this gap, this paper proposes a two-stage calibration and compensation framework. First, an augmented linearized model is developed for sensor-based calibration parameter estimation, avoiding the information loss inherent in classical band-pass filtering (BPF). Second, utilizing these pre-estimated parameters, a map-less Kalman Filter Fusion (KFF) algorithm is developed to dynamically estimate the external field and compensate the platform interference directly from multi-sensor measurements corrupted by platform interference. The second step enables real-time joint dynamic estimation and multi-sensor compensation without requiring reference position data (which runs counter to the MagNav purpose) or prior anomaly maps. Validated on the public DAF-MIT MagNav dataset, the framework overcomes the non-causal limitations of existing approaches, reducing average compensation error from 359.2~nT to 12.3~nT while maintaining exceptional robustness against heavily corrupted sensor channels.

0.27