pith. sign in

arxiv: 2308.00513 · v2 · submitted 2023-08-01 · 💻 cs.RO

UVIO: An UWB-Aided Visual-Inertial Odometry Framework with Bias-Compensated Anchors Initialization

Giulio Delama , Farhad Shamsfakhr , Stephan Weiss , Daniele Fontanelli , Alessandro Fornasier This is my paper

Pith reviewed 2026-05-24 07:33 UTC · model grok-4.3

classification 💻 cs.RO
keywords UWBVIOanchor initializationGDOPdrift eliminationUAV localizationsensor fusionbias compensation
0
0 comments X

The pith

UVIO eliminates VIO drift in position and heading by autonomously mapping unknown UWB anchors with a GDOP-optimized trajectory and tightly integrating bias-compensated ranges.

A machine-rendered reading of the paper's core claim, the machinery that carries it, and where it could break.

The paper shows how a UAV can map multiple unknown UWB anchors in a fully autonomous sequence of steps that uses GDOP to pick waypoints minimizing estimation uncertainty. After mapping, the system folds the biased range measurements directly into the visual-inertial state estimator. While the vehicle stays inside the mapped anchor field, accumulated errors in both position and heading stop growing. A reader would care because this removes the usual unbounded drift that limits long flights or operations without GPS.

Core claim

UVIO maps unknown anchors through a multi-step autonomous procedure that selects an optimal set of waypoints via GDOP to reduce mapping uncertainty, then tightly fuses the resulting biased range measurements into the VIO pipeline; the result is that position and heading drift are removed as long as the vehicle remains in range of the initialized anchors.

What carries the argument

The GDOP-driven waypoint selection and trajectory synthesis for anchor mapping, followed by bias-compensated tight fusion of UWB ranges into the VIO estimator.

If this is right

  • Position and heading drift stop accumulating while the vehicle is in range of the initialized anchors.
  • Anchor positions can be determined without any prior map or external reference system.
  • Biases present in the range measurements are handled inside the tight integration step.
  • The same initialization and fusion pipeline works across both simulated and real-world UAV flights.

Where Pith is reading between the lines

These are editorial extensions of the paper, not claims the author makes directly.

  • The same anchor-mapping logic could be applied to other range sensors to create drift-free zones in GPS-denied spaces.
  • Networks of such pre-mapped anchors would support extended autonomous operations by handing off between coverage areas.
  • The approach opens the possibility of on-the-fly anchor addition during a mission rather than requiring a separate mapping phase.

Load-bearing premise

The GDOP-optimized mapping produces anchor locations accurate enough that the added range measurements cancel rather than increase the existing VIO errors.

What would settle it

If position or heading error continues to accumulate during flight while the UAV remains inside the coverage of the mapped anchors, the drift-elimination claim would be falsified.

Figures

Figures reproduced from arXiv: 2308.00513 by Alessandro Fornasier, Daniele Fontanelli, Farhad Shamsfakhr, Giulio Delama, Stephan Weiss.

Figure 1
Figure 1. Figure 1: This figure shows an example of what we described as delayed up [PITH_FULL_IMAGE:figures/full_fig_p003_1.png] view at source ↗
Figure 2
Figure 2. Figure 2: The sample representation of the drone operational volume with 8 [PITH_FULL_IMAGE:figures/full_fig_p005_2.png] view at source ↗
Figure 4
Figure 4. Figure 4: Two Optimal sets of waypoints estimated as the solutions of the [PITH_FULL_IMAGE:figures/full_fig_p006_4.png] view at source ↗
Figure 5
Figure 5. Figure 5: Average GDOP and time distribution analysis for the two sample [PITH_FULL_IMAGE:figures/full_fig_p006_5.png] view at source ↗
Figure 3
Figure 3. Figure 3: Schematic representation of a sample chromosome in the () ()() [PITH_FULL_IMAGE:figures/full_fig_p006_3.png] view at source ↗
Figure 6
Figure 6. Figure 6: Average position error for 10 different MC simulations of the full [PITH_FULL_IMAGE:figures/full_fig_p007_6.png] view at source ↗
Figure 8
Figure 8. Figure 8: Real-world experiment: comparison between OpenVINS and UVIO [PITH_FULL_IMAGE:figures/full_fig_p007_8.png] view at source ↗
Figure 7
Figure 7. Figure 7: Experiment 3: UWB anchors initialization. [PITH_FULL_IMAGE:figures/full_fig_p007_7.png] view at source ↗
Figure 9
Figure 9. Figure 9: UVIO and OpenVINS performance comparison with vision faults. [PITH_FULL_IMAGE:figures/full_fig_p008_9.png] view at source ↗
read the original abstract

This paper introduces UVIO, a multi-sensor framework that leverages Ultra Wide Band (UWB) technology and Visual-Inertial Odometry (VIO) to provide robust and low-drift localization. In order to include range measurements in state estimation, the position of the UWB anchors must be known. This study proposes a multi-step initialization procedure to map multiple unknown anchors by an Unmanned Aerial Vehicle (UAV), in a fully autonomous fashion. To address the limitations of initializing UWB anchors via a random trajectory, this paper uses the Geometric Dilution of Precision (GDOP) as a measure of optimality in anchor position estimation, to compute a set of optimal waypoints and synthesize a trajectory that minimizes the mapping uncertainty. After the initialization is complete, the range measurements from multiple anchors, including measurement biases, are tightly integrated into the VIO system. While in range of the initialized anchors, the VIO drift in position and heading is eliminated. The effectiveness of UVIO and our initialization procedure has been validated through a series of simulations and real-world experiments.

Editorial analysis

A structured set of objections, weighed in public.

Desk editor's note, referee report, simulated authors' rebuttal, and a circularity audit. Tearing a paper down is the easy half of reading it; the pith above is the substance, this is the friction.

Referee Report

2 major / 0 minor

Summary. The manuscript introduces UVIO, a multi-sensor framework combining UWB ranges with VIO for low-drift UAV localization. It proposes a multi-step autonomous initialization that uses GDOP as an optimality criterion to generate waypoints and synthesize a trajectory for mapping multiple unknown anchors via multilateration. After mapping, biased range measurements from the anchors are tightly integrated into the VIO estimator. The central claim is that, once initialized, this integration eliminates VIO drift in both position and heading while the UAV remains in range of the anchors. Validation is reported via simulations and real-world experiments.

Significance. If the initialization produces anchor positions and biases accurate enough for the subsequent tight integration to cancel drift without introducing new inconsistencies, the work would offer a practical method for bootstrapping infrastructure-free UWB-aided VIO on UAVs. The explicit use of GDOP to optimize the mapping trajectory is a concrete technical choice that could reduce uncertainty relative to random trajectories.

major comments (2)
  1. [Abstract] Abstract (paragraph on initialization and integration): the claim that 'the VIO drift in position and heading is eliminated' after initialization rests on the assumption that anchor positions estimated from the VIO trajectory are sufficiently accurate. Because the initialization itself relies on the drifting VIO states as the reference for multilateration, any accumulated position or heading error during the GDOP-optimized trajectory directly biases the anchor estimates; treating those anchors as fixed landmarks in the subsequent filter can then produce inconsistent range residuals that fail to cancel drift and may instead inject bias or instability. No explicit mechanism (joint optimization of VIO states and anchors, loop closure during mapping, or drift analysis) is indicated in the provided description to break this dependency.
  2. [Abstract] Abstract (paragraph on initialization and integration): the multi-step procedure is described as mapping 'multiple unknown anchors' in a 'fully autonomous fashion,' yet the text supplies no quantitative bound on the residual mapping error after GDOP optimization, nor any propagation analysis showing that this error remains below the threshold needed for drift elimination in the tight-integration stage.

Simulated Author's Rebuttal

2 responses · 0 unresolved

We thank the referee for the constructive comments. We address the major comments point by point below, providing clarifications from the full manuscript and indicating where revisions will be made to strengthen the presentation.

read point-by-point responses

  1. Referee: [Abstract] Abstract (paragraph on initialization and integration): the claim that 'the VIO drift in position and heading is eliminated' after initialization rests on the assumption that anchor positions estimated from the VIO trajectory are sufficiently accurate. Because the initialization itself relies on the drifting VIO states as the reference for multilateration, any accumulated position or heading error during the GDOP-optimized trajectory directly biases the anchor estimates; treating those anchors as fixed landmarks in the subsequent filter can then produce inconsistent range residuals that fail to cancel drift and may instead inject bias or instability. No explicit mechanism (joint optimization of VIO states and anchors, loop closure during mapping, or drift analysis) is indicated in the provided description to break this dependency.

    Authors: The initialization does rely on the VIO trajectory for multilateration, and VIO drift can affect anchor estimates. The GDOP-based waypoint selection is intended to minimize the geometric uncertainty and thereby limit the propagation of VIO errors into the anchor map. Once anchors are mapped, the bias-compensated ranges are tightly coupled into the estimator to provide absolute corrections. The full manuscript details the estimator formulation and reports experimental results showing drift elimination while in anchor range. We acknowledge that an explicit drift-propagation analysis during mapping is not highlighted in the abstract; we will add a dedicated subsection on error sensitivity and mapping accuracy in the revised version. revision: yes

  2. Referee: [Abstract] Abstract (paragraph on initialization and integration): the multi-step procedure is described as mapping 'multiple unknown anchors' in a 'fully autonomous fashion,' yet the text supplies no quantitative bound on the residual mapping error after GDOP optimization, nor any propagation analysis showing that this error remains below the threshold needed for drift elimination in the tight-integration stage.

    Authors: The abstract is necessarily concise. The full manuscript contains simulation results that quantify anchor mapping error under the GDOP trajectory and real-world experiments that demonstrate subsequent drift-free operation. We agree that an explicit bound or propagation analysis would make the claims more rigorous and will incorporate such an analysis, including numerical thresholds derived from the GDOP optimization, in the revised manuscript. revision: yes

Circularity Check

0 steps flagged

No significant circularity detected in derivation chain

full rationale

The paper presents a pipeline of GDOP-optimized trajectory generation for anchor mapping followed by tight integration of biased ranges into VIO, with the claim that drift is eliminated once anchors are initialized. No equations, fitted parameters, or self-citations are shown that reduce any prediction or result to its own inputs by construction. The initialization is described as an independent optimization step using GDOP as an external optimality measure, and the subsequent integration treats mapped anchors as fixed inputs. This matches the default case of a self-contained engineering method without any of the enumerated circular patterns (self-definitional, fitted-input-as-prediction, load-bearing self-citation, etc.).

Axiom & Free-Parameter Ledger

0 free parameters · 0 axioms · 0 invented entities

Abstract supplies no explicit free parameters, axioms, or invented entities; the GDOP usage and bias compensation are presented as standard tools without further breakdown.

pith-pipeline@v0.9.0 · 5737 in / 1097 out tokens · 31182 ms · 2026-05-24T07:33:14.392628+00:00 · methodology

discussion (0)

Sign in with ORCID, Apple, or X to comment. Anyone can read and Pith papers without signing in.

Forward citations

Cited by 1 Pith paper

Reviewed papers in the Pith corpus that reference this work. Sorted by Pith novelty score.

  1. A Robust 5G Terrestrial Positioning System with Sensor Fusion in GNSS-denied Scenarios

    cs.IT 2025-07 unverdicted novelty 3.0

    The paper presents a 5G terrestrial positioning system using multi-carrier carrier phase ranging, deep learning for NLOS identification, and IMU/camera sensor fusion via error-state EKF, achieving less than 5 meters e...

Reference graph

Works this paper leans on

25 extracted references · 25 canonical work pages · cited by 1 Pith paper

  1. [1]

    Openvins: A research platform for visual-inertial estimation,

    P. Geneva, K. Eckenhoff, W. Lee, Y . Yang, and G. Huang, “Openvins: A research platform for visual-inertial estimation,” in 2020 IEEE International Conference on Robotics and Automation (ICRA) , 2020, pp. 4666–4672

    work page 2020

  2. [2]

    Ultra-wideband aided fast localization and mapping system,

    C. Wang, H. Zhang, T.-M. Nguyen, and L. Xie, “Ultra-wideband aided fast localization and mapping system,” in2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2017, pp. 1602– 1609

    work page 2017

  3. [3]

    Multi- modal mapping and localization of unmanned aerial robots based on ultra-wideband and rgb-d sensing,

    F. J. Perez-Grau, F. Caballero, L. Merino, and A. Viguria, “Multi- modal mapping and localization of unmanned aerial robots based on ultra-wideband and rgb-d sensing,” in 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2017, pp. 3495– 3502

    work page 2017

  4. [4]

    Enhanced uav indoor navigation through slam-augmented uwb localization,

    J. Tiemann, A. Ramsey, and C. Wietfeld, “Enhanced uav indoor navigation through slam-augmented uwb localization,” in 2018 IEEE International Conference on Communications Workshops (ICC Work- shops), 2018, pp. 1–6

    work page 2018

  5. [5]

    Uvip: Robust uwb aided visual-inertial positioning system for complex indoor environments,

    B. Yang, J. Li, and H. Zhang, “Uvip: Robust uwb aided visual-inertial positioning system for complex indoor environments,” in 2021 IEEE International Conference on Robotics and Automation (ICRA) , 2021, pp. 5454–5460

    work page 2021

  6. [6]

    Mir-vio: Mutual information residual-based visual inertial odometry with uwb fusion for robust localization,

    S. Shin, E. Lee, J. Choi, and H. Myung, “Mir-vio: Mutual information residual-based visual inertial odometry with uwb fusion for robust localization,” 2021

    work page 2021

  7. [7]

    Vio-uwb- based collaborative localization and dense scene reconstruction within heterogeneous multi-robot systems,

    J. P. Queralta, Q. Li, F. Schiano, and T. Westerlund, “Vio-uwb- based collaborative localization and dense scene reconstruction within heterogeneous multi-robot systems,” in 2022 International Conference on Advanced Robotics and Mechatronics (ICARM) , 2022, pp. 87–94

    work page 2022

  8. [8]

    Improving visual inertial odometry with uwb positioning for uav indoor navigation,

    J.-R. Zhan and H.-Y . Lin, “Improving visual inertial odometry with uwb positioning for uav indoor navigation,” in 2022 26th International Conference on Pattern Recognition (ICPR) , 2022, pp. 4189–4195

    work page 2022

  9. [9]

    Omni-swarm: A decentralized omnidirectional visual–inertial–UWB state estimation system for aerial swarms,

    H. Xu, Y . Zhang, B. Zhou, L. Wang, X. Yao, G. Meng, and S. Shen, “Omni-swarm: A decentralized omnidirectional visual–inertial–UWB state estimation system for aerial swarms,” IEEE Transactions on Robotics, vol. 38, no. 6, pp. 3374–3394, dec 2022

    work page 2022

  10. [10]

    Gnss-denied uav indoor navigation with uwb incorporated visual inertial odometry,

    H.-Y . Lin and J.-R. Zhan, “Gnss-denied uav indoor navigation with uwb incorporated visual inertial odometry,” Measurement, vol. 206, p. 112256, 2023

    work page 2023

  11. [11]

    Self-calibrating multi-sensor fusion with probabilistic measurement validation for seamless sensor switching on a uav,

    K. Hausman, S. Weiss, R. Brockers, L. Matthies, and G. S. Sukhatme, “Self-calibrating multi-sensor fusion with probabilistic measurement validation for seamless sensor switching on a uav,” in 2016 IEEE International Conference on Robotics and Automation (ICRA) , 2016, pp. 4289–4296

    work page 2016

  12. [12]

    Anchor self-localization algorithm based on uwb ranging and inertial measurements,

    Q. Shi, S. Zhao, X. Cui, M. Lu, and M. Jia, “Anchor self-localization algorithm based on uwb ranging and inertial measurements,” Tsinghua Science and Technology, vol. 24, no. 6, pp. 728–737, 2019

    work page 2019

  13. [13]

    Uwb anchor nodes self-calibration in nlos condi- tions: a machine learning and adaptive phy error correction approach,

    M. Ridolfi, J. Fontaine, B. Van Herbruggen, W. Joseph, J. Hoebeke, and E. De Poorter, “Uwb anchor nodes self-calibration in nlos condi- tions: a machine learning and adaptive phy error correction approach,” Wireless Networks, vol. 27, 05 2021

    work page 2021

  14. [14]

    Low drift visual inertial odometry with uwb aided for indoor localization,

    B. Gao, B. Lian, D. Wang, and C. Tang, “Low drift visual inertial odometry with uwb aided for indoor localization,” IET Communica- tions, vol. 16, no. 10, pp. 1083–1093, 2022

    work page 2022

  15. [15]

    Tightly-coupled single- anchor ultra-wideband-aided monocular visual odometry system,

    T. H. Nguyen, T.-M. Nguyen, and L. Xie, “Tightly-coupled single- anchor ultra-wideband-aided monocular visual odometry system,” in 2020 IEEE International Conference on Robotics and Automation (ICRA), 2020, pp. 665–671

    work page 2020

  16. [16]

    Range-focused fusion of camera-imu-uwb for accurate and drift-reduced localization,

    ——, “Range-focused fusion of camera-imu-uwb for accurate and drift-reduced localization,” IEEE Robotics and Automation Letters , vol. 6, no. 2, pp. 1678–1685, 2021

    work page 2021

  17. [17]

    Viral slam: Tightly coupled camera-imu-uwb-lidar slam,

    T.-M. Nguyen, S. Yuan, M. Cao, T. H. Nguyen, and L. Xie, “Viral slam: Tightly coupled camera-imu-uwb-lidar slam,” 2021

    work page 2021

  18. [18]

    Viral-fusion: A visual-inertial-ranging-lidar sensor fusion approach,

    T.-M. Nguyen, M. Cao, S. Yuan, Y . Lyu, T. H. Nguyen, and L. Xie, “Viral-fusion: A visual-inertial-ranging-lidar sensor fusion approach,” IEEE Transactions on Robotics , vol. 38, no. 2, pp. 958–977, 2022

    work page 2022

  19. [19]

    Fej-viro: A consistent first-estimate jacobian visual-inertial-ranging odometry,

    S. Jia, Y . Jiao, Z. Zhang, R. Xiong, and Y . Wang, “Fej-viro: A consistent first-estimate jacobian visual-inertial-ranging odometry,” in 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2022, pp. 1336–1343

    work page 2022

  20. [20]

    Bias compensated uwb an- chor initialization using information-theoretic supported triangulation points,

    J. Blueml, A. Fornasier, and S. Weiss, “Bias compensated uwb an- chor initialization using information-theoretic supported triangulation points,” in 2021 IEEE International Conference on Robotics and Automation (ICRA), 2021, pp. 5490–5496

    work page 2021

  21. [21]

    Cramer–Rao Lower Bound Attainment in Range-Only Positioning Using Geometry: The G-WLS,

    D. Fontanelli, F. Shamsfakhr, and L. Palopoli, “Cramer–Rao Lower Bound Attainment in Range-Only Positioning Using Geometry: The G-WLS,” IEEE Transactions on Instrumentation and Measurement , vol. 70, pp. 1–14, 2021

    work page 2021

  22. [22]

    The point in polygon problem for arbitrary polygons,

    K. Hormann and A. Agathos, “The point in polygon problem for arbitrary polygons,” Computational geometry, vol. 20, no. 3, pp. 131– 144, 2001

    work page 2001

  23. [23]

    A grid-based evolutionary algorithm for many-objective optimization,

    S. Yang, M. Li, X. Liu, and J. Zheng, “A grid-based evolutionary algorithm for many-objective optimization,” IEEE Transactions on Evolutionary Computation, vol. 17, no. 5, pp. 721–736, 2013

    work page 2013

  24. [24]

    Cns flight stack for reproducible, customizable, and fully autonomous applications,

    M. Scheiber, A. Fornasier, R. Jung, C. Böhm, R. Dhakate, C. Stewart, J. Steinbrener, S. Weiss, and C. Brommer, “Cns flight stack for reproducible, customizable, and fully autonomous applications,” IEEE Robotics and Automation Letters , vol. 7, no. 4, pp. 11 283–11 290, 2022

    work page 2022

  25. [25]

    A tutorial on quantitative trajectory evaluation for visual(-inertial) odometry,

    Z. Zhang and D. Scaramuzza, “A tutorial on quantitative trajectory evaluation for visual(-inertial) odometry,” in 2018 IEEE/RSJ Interna- tional Conference on Intelligent Robots and Systems (IROS), 2018, pp. 7244–7251

    work page 2018