GRVINS: Tightly Coupled GNSS-Range-Visual-Inertial System

Bridge inspection is currently a labor intensive task. Utilizing unmanned aerial vehicles (UAVs) to assist in inspection tasks is a promising direction. However, enabling UAVs for autonomous inspection involves the UAV state estimation problems. Since parts of UAV sensors could be unavailable, how to estimate states via sensor fusion is the key. In this paper, we propose a tightly-coupled nonlinear optimization-based system that integrates four kinds of sensors: camera, IMU, Ultra-wideband (UWB) range measurements, and global navigation satellite system (GNSS). Due to the tightly-coupled multi-sensor fusion method and system design, the system takes the advantage of the four sensors, and can seamlessly respond to indoor and outdoor GNSS and UWB loss or reacquisition. It can effectively reduce the long-term trajectory drift and provide smooth and continuous state estimation. The experimental results show that the proposed method outperforms the state-of-the-art approaches.