Research on a Visual/Ultra-Wideband Tightly Coupled Fusion Localization Algorithm

Pin Jiang,Chen Hu,Tingting Wang,Ke Lv,Tingfeng Guo,Jinxuan Jiang,Wenwu Hu
DOI: https://doi.org/10.3390/s24051710
IF: 3.9
2024-03-07
Sensors
Abstract:In the autonomous navigation of mobile robots, precise positioning is crucial. In forest environments with weak satellite signals or in sites disturbed by complex environments, satellite positioning accuracy has difficulty in meeting the requirements of autonomous navigation positioning accuracy for robots. This article proposes a vision SLAM/UWB tightly coupled localization method and designs a UWB non-line-of-sight error identification method using the displacement increment of the visual odometer. It utilizes the displacement increment of visual output and UWB ranging information as measurement values and applies the extended Kalman filtering algorithm for data fusion. This study utilized the constructed experimental platform to collect images and ultra-wideband ranging data in outdoor environments and experimentally validated the combined positioning method. The experimental results show that the algorithm outperforms individual UWB or loosely coupled combination positioning methods in terms of positioning accuracy. It effectively eliminates non-line-of-sight errors in UWB, improving the accuracy and stability of the combined positioning system.
engineering, electrical & electronic,chemistry, analytical,instruments & instrumentation
What problem does this paper attempt to address?
### Problems Addressed by the Paper The paper primarily addresses the issue of achieving accurate robot localization in environments with weak satellite signals or complex interference, such as forests. Specifically, the paper proposes a tightly coupled visual SLAM/UWB fusion localization method and designs a method to identify UWB non-line-of-sight (NLOS) errors using visual odometry displacement increments. ### Specific Methods 1. **Fusion Localization Algorithm**: - Utilize displacement increments from visual odometry and UWB ranging information as measurements. - Apply the Extended Kalman Filter (EKF) algorithm for data fusion. 2. **NLOS Error Identification and Elimination**: - Use displacement increments from visual SLAM to identify NLOS errors in UWB ranging values. - Suppress outliers and time-varying measurement noise affecting filter performance through threshold detection and adaptive measurement noise estimator. ### Experimental Validation - Construct an experimental platform to collect images and ultra-wideband ranging data in an outdoor environment. - Experimental results show that the proposed algorithm outperforms using UWB alone or loosely coupled combination localization methods in terms of localization accuracy. - Effectively eliminates NLOS errors in UWB, improving the accuracy and stability of the fusion localization system.