Abstract
This paper proposes an ultra-wideband (UWB) aided localization and mapping system that leverages on inertial sensor and depth camera. Inspired by the fact that visual odometry (VO) system, regardless of its accuracy in the short term, still faces challenges with accumulated errors in the long run or under unfavourable environments, the UWB ranging measurements are fused to remove the visual drift and improve the robustness. A general framework is developed which consists of three parallel threads, two of which carry out the visual-inertial odometry (VIO) and UWB localization respectively. The other mapping thread integrates visual tracking constraints into a pose graph with the proposed smooth and virtual range constraints, such that an optimization is performed to provide robust trajectory estimation. Experiments show that the proposed system is able to create dense drift-free maps in real-time even running on an ultra-low power processor in featureless environments.
Introduction
Visual SLAM (Simultaneous Localization and Mapping) systems are notoriously prone to "drift" — the accumulation of small errors over time that lead to a warped trajectory and map. Traditionally, researchers solve this using loop closure, where the system recognizes a previously visited location and "snaps" the map back into alignment. However, visual loop closure is computationally expensive, requires significant memory, and fails in environments with few visual features (like white hallways) or deceptive ones (like glass and mirrors).
The authors address the need for a lightweight SLAM solution for low-power robots (like micro-drones) that can operate reliably where pure vision fails, bypassing the complexity of visual feature matching for global consistency.
System Architecture
The proposed framework consists of three parallel threads designed to provide robust and efficient localization:
- UWB Localization Thread: This thread utilizes peer-to-peer two-way time-of-flight measurements between the robot and fixed anchors. It minimizes a cost function consisting of a "range residual" (distance to anchors) and a "smooth error" to ensure the trajectory remains physically plausible.
- Visual-Inertial Odometry (VIO) Thread: Employs NI-SLAM (Non-Iterative SLAM). This method projects 3D point clouds onto an "axonometric plane" (a 2D representation) and uses correlation filters to estimate movement. This decoupling of rotation and translation significantly reduces computational load.
- Map Optimization Thread: Acting as the integration layer, this thread combines the local high-frequency tracking from the VIO thread with the global, drift-free constraints from the UWB thread into a pose graph.
A key innovation is the Virtual Range Constraint. Instead of just using raw UWB data, the system creates virtual constraints between the nearest VIO-tracked poses and the UWB measurements, allowing the system to correct drift even when UWB and visual data aren't perfectly synchronized in time.
Experimental Evaluation
The system was evaluated using 17 indoor datasets recorded with a hand-held Kinect RGB-D camera. These datasets included challenging geometries (circles, rectangles, and "infinite-shape" paths) and environments with large featureless white walls and glass partitions. All data was benchmarked against a high-precision Vicon motion capture system.
Key Results
- Accuracy: The UWB-aided system significantly outperformed pure NI-SLAM. The mean Absolute Trajectory Error (ATE) RMSE dropped from 0.205m to 0.069m, representing a ~66% improvement.
- Computational Efficiency: The system was tested on an Intel Atom x5-Z8350 (Up-Board), a credit-card-sized computer with a 2W power envelope. It achieved a total processing time of 32ms per frame, enabling true real-time performance on hardware that typically struggles with dense SLAM.
- Generalization: The authors demonstrated that their UWB-fusion framework is agnostic to the underlying VIO system; they successfully integrated it with ORB-SLAM2, reducing its error from 0.209m to 0.076m in the same environments.
Discussion and Conclusion
The most significant insight of this work is that UWB ranging can effectively replace the need for visual loop closure detection. Because UWB provides absolute distance to fixed anchors, it provides a "global truth" that prevents the visual trajectory from ever drifting too far. Furthermore, by performing point cloud matching on 2D axonometric images rather than 3D space, the system reduces 6-DoF estimation into simpler 1D circular shifts, allowing it to run on ultra-low-power processors.
While the system requires pre-installed UWB anchors, making it less "plug-and-play" than pure visual SLAM, its resilience to specular reflections and featureless environments makes it a powerful solution for indoor robotics. Future work could involve automatically calibrating anchor positions or further optimizing the fusion algorithm to better handle high-frequency vibrations.
Summary updated