H-RINS: Hierarchical Tightly-coupled Radar-Inertial Navigation via Smoothing and Mapping
- URL: http://arxiv.org/abs/2603.14109v1
- Date: Sat, 14 Mar 2026 20:30:49 GMT
- Title: H-RINS: Hierarchical Tightly-coupled Radar-Inertial Navigation via Smoothing and Mapping
- Abstract summary: Millimeter-wave radar provides robust perception in visually degraded environments.<n>Radar-inertial state estimation is inherently susceptible to drift.<n>We propose a tightly coupled, hierarchical radar-inertial factor graph framework.
- Score: 2.3821762993135507
- License: http://arxiv.org/licenses/nonexclusive-distrib/1.0/
- Abstract: Millimeter-wave radar provides robust perception in visually degraded environments. However, radar-inertial state estimation is inherently susceptible to drift. Because radar yields only sparse, body-frame velocity measurements, it provides weak constraints on absolute orientation. Consequently, IMU biases remain poorly observable over the short time horizons typical of sliding-window filters. To address this fundamental observability challenge, we propose a tightly coupled, hierarchical radar-inertial factor graph framework. Our architecture decouples the estimation problem into a high-rate resetting graph and a persistent global graph. The resetting graph fuses IMU preintegration, radar velocities, and adaptive Zero-Velocity Updates (ZUPT) to generate the smooth, low-latency odometry required for real-time control. Concurrently, the persistent graph is a full-state factor graph maintaining the complete information of poses, velocities, and biases by fusing inertial data with keyframe-based geometric mapping and loop closures. Leveraging Incremental Smoothing and Mapping, the persistent graph can operate without explicit marginalization of variables, preserving their information while ensuring long-term bias observability. The cornerstone of our approach is a probabilistic tight-coupling mechanism: fully observable, optimized biases and their exact covariances are continuously injected from the persistent graph into the resetting graph's prior, effectively anchoring the high-rate estimator against integration drift. Extensive evaluations demonstrate our system achieves high accuracy with drift-reduced estimation at 27x real-time execution speeds. We release the implementation code and datasets upon the acceptance of the paper.
Related papers
- Dual Spatial-Temporal Attribution: Architecture-Aligned Post-Hoc Explainability for Recurrent Graph Anomaly Detection [1.8899300124593645]
We present X-AddGraph, a post-hoc explainability framework for anomaly detection in dynamic graphs.<n>Because the detector is frozen, detection performance is preserved exactly.<n>X-AddGraph reproduces every score identically while adding explanations where none existed.
arXiv Detail & Related papers (2026-08-12T15:58:27Z) - Dense Soft Weighting for Radar Ego-Velocity Estimation [6.356174487225252]
We present Dense Soft Weighting, an analytic radar front-end for ego-velocity estimation.<n>It maps every range-Doppler cell to a continuous confidence metric rather than enforcing a binary detection threshold.<n>It reduces mean absolute pose error by 31-45% relative to the strongest CFAR point-cloud baseline.
arXiv Detail & Related papers (2026-07-29T14:37:52Z) - FAST-LIVGO: A Degeneracy-Robust LiDAR-Inertial-Visual-GNSS Fusion Odometry [14.641801914375163]
State estimation and mapping in long-term, large-scale, and highly dynamic environments remains a key challenge in robotics.<n>Existing LiDAR-In-ertial-Visual Odometry (LIVO) systems achieve strong local accuracy but suffer from accumulated drift over long distances.<n>We propose a LiDAR-aided fusion framework based on an Error-State Iterated Kalman Filter to address these limitations.<n>Our system reduces accumulated drift and map ghosting, outperforming state-of-the-art methods in accuracy and robustness.
arXiv Detail & Related papers (2026-06-17T15:33:11Z) - Event-based SLAM Benchmark for High-Speed Maneuvers [68.148886127117]
Event-based cameras are bio-inspired sensors with pixels that independently and asynchronously respond to brightness changes at microsecond resolution.<n>Existing event-based approaches, although successful in mitigating motion blur caused by high-speed maneuvers, suffer from many limitations.<n>We introduce a benchmarking framework for event-based state estimation, called EvSLAM, characterized by sufficient variation in data collection platforms.
arXiv Detail & Related papers (2026-04-27T04:36:41Z) - CT-VIR: Continuous-Time Visual-Inertial-Ranging Fusion for Indoor Localization with Sparse Anchors [8.090575303185078]
We propose a continuous-time state estimation method for visual-inertial-ranging (VIR) fusion localization.<n>Introductor, visual, and ranging constraints are formulated as factors in a sliding-window graph.<n> Evaluations on public datasets and real-world experiments demonstrate the effectiveness and practical potential of the proposed approach.
arXiv Detail & Related papers (2026-04-16T02:23:57Z) - UNRIO: Uncertainty-Aware Velocity Learning for Radar-Inertial Odometry [16.577608323279662]
UNRIO is an uncertainty-aware radar-inertial odometry system.<n>It estimates ego-velocity directly from raw mmWave radar IQ signals.
arXiv Detail & Related papers (2026-04-15T07:43:06Z) - Efficient On-Board Processing of Oblique UAV Video for Rapid Flood Extent Mapping [7.460695517551536]
Temporal Token Reuse (TTR) is an adaptive inference framework capable of accelerating video segmentation on embedded devices.<n>We show that TTR achieves a 30% reduction in inference latency with negligible degradation in segmentation accuracy ( 0.5% mIoU)<n>These findings confirm that TTR effectively shifts the operational frontier, enabling high-fidelity, real-time oblique video understanding for time-critical remote sensing missions.
arXiv Detail & Related papers (2026-01-16T13:41:56Z) - Learning Time-Varying Graphs from Incomplete Graph Signals [1.7430416823420511]
We develop an efficient Alternating Direction Multiplier algorithm for solving the problem of imputing missing data from a graph.<n>We prove that the proposed ADMM scheme converges to and we derive a stationary point.
arXiv Detail & Related papers (2025-10-19T11:12:13Z) - Gaussian Process Regression for Improved Underwater Navigation [13.221163846643607]
Doppler velocity logs (DVLs) are typically used to mitigate this drift through velocity measurements.<n>This paper proposes a data-driven alternative based on multi-output Gaussian process regression (MOGPR) to improve DVL velocity estimation.<n>We evaluate our proposed approach using real-world AUV data and compare it against LS and a state-of-the-art deep learning model, BeamsNet.
arXiv Detail & Related papers (2025-02-23T09:13:41Z) - ReLoc-PDR: Visual Relocalization Enhanced Pedestrian Dead Reckoning via
Graph Optimization [4.188058836787458]
This work proposes ReLoc-PDR, a fusion framework combining pedestrian dead reckoning and visual relocalization.
A graph optimization-based fusion mechanism with the Tukey kernel effectively corrects cumulative errors and mitigates the impact of abnormal visual observations.
Real-world experiments demonstrate that our ReLoc-PDR surpasses representative methods in accuracy and robustness.
arXiv Detail & Related papers (2023-09-04T14:54:47Z) - Uncovering the Missing Pattern: Unified Framework Towards Trajectory
Imputation and Prediction [60.60223171143206]
Trajectory prediction is a crucial undertaking in understanding entity movement or human behavior from observed sequences.
Current methods often assume that the observed sequences are complete while ignoring the potential for missing values.
This paper presents a unified framework, the Graph-based Conditional Variational Recurrent Neural Network (GC-VRNN), which can perform trajectory imputation and prediction simultaneously.
arXiv Detail & Related papers (2023-03-28T14:27:27Z) - RAGO: Recurrent Graph Optimizer For Multiple Rotation Averaging [62.315673415889314]
This paper proposes a deep recurrent Rotation Averaging Graph (RAGO) for Multiple Rotation Averaging (MRA)
Our framework is a real-time learning-to-optimize rotation averaging graph with a tiny size deployed for real-world applications.
arXiv Detail & Related papers (2022-12-14T13:19:40Z) - Correlating sparse sensing for large-scale traffic speed estimation: A
Laplacian-enhanced low-rank tensor kriging approach [76.45949280328838]
We propose a Laplacian enhanced low-rank tensor (LETC) framework featuring both lowrankness and multi-temporal correlations for large-scale traffic speed kriging.
We then design an efficient solution algorithm via several effective numeric techniques to scale up the proposed model to network-wide kriging.
arXiv Detail & Related papers (2022-10-21T07:25:57Z) - E-Graph: Minimal Solution for Rigid Rotation with Extensibility Graphs [61.552125054227595]
A new minimal solution is proposed to solve relative rotation estimation between two images without overlapping areas.
Based on E-Graph, the rotation estimation problem becomes simpler and more elegant.
We embed our rotation estimation strategy into a complete camera tracking and mapping system which obtains 6-DoF camera poses and a dense 3D mesh model.
arXiv Detail & Related papers (2022-07-20T16:11:48Z) - DM-VIO: Delayed Marginalization Visual-Inertial Odometry [62.746533939737446]
We present DM-VIO, a visual-inertial system based on delayed marginalization and pose graph bundle adjustment.
We evaluate our system on the EuRoC, TUM-VI, and 4Seasons datasets, which comprise flying drone, large-scale handheld, and automotive scenarios.
arXiv Detail & Related papers (2022-01-11T18:30:37Z)
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.