GNSS/Multi-Sensor Fusion Using Continuous-Time Factor Graph Optimization for Robust Localization

Abstract

Accurate and robust vehicle localization in highly urbanized areas is challenging. Sensors are often corrupted in those complicated and large-scale environments. This paper introduces GNSS-FGO, an online and global trajectory estimator that fuses GNSS observations alongside multiple sensor measurements for robust vehicle localization. In GNSS-FGO, we fuse asynchronous sensor measurements into the graph with a continuous-time trajectory representation using Gaussian process regression. This enables querying states at arbitrary timestamps so that sensor observations are fused without requiring strict state and measurement synchronization. Thus, the proposed method presents a generalized factor graph for multi-sensor fusion. To evaluate and study different GNSS fusion strategies, we fuse GNSS measurements in loose and tight coupling with a speed sensor, IMU, and lidar-odometry. We employed datasets from measurement campaigns in Aachen, Duesseldorf, and Cologne in experimental studies and presented comprehensive discussions on sensor observations, smoother types, and hyperparameter tuning. Our results show that the proposed approach enables robust trajectory estimation in dense urban areas, where the classic multi-sensor fusion method fails due to sensor degradation. In a test sequence containing a 17km route through Aachen, the proposed method results in a mean 2D positioning error of 0.48m while fusing raw GNSS observations with lidar odometry in a tight coupling.

Accepted for publication in the IEEE Transactions on Robotics

References in corpus (9)

• RTAB-Map as an Open-Source Lidar and Visual SLAM Library for Large-Scale and Long-Term Online Operation
• VILENS: Visual, Inertial, Lidar, and Leg Odometry for All-Terrain Legged Robots
• Unified Multi-Modal Landmark Tracking for Tightly Coupled Lidar-Visual-Inertial Odometry
• Towards Robust GNSS Positioning and Real-time Kinematic Using Factor Graph Optimization
• Memory Management for Real-Time Appearance-Based Loop Closure Detection
• Multi-Session Visual SLAM for Illumination Invariant Re-Localization in Indoor Environments
• GNSS Odometry: Precise Trajectory Estimation Based on Carrier Phase Cycle Slip Estimation
• Variational Inference with Parameter Learning Applied to Vehicle Trajectory Estimation
• Continuous-time Trajectory Estimation: A Comparative Study Between Gaussian Process and Spline-based Approaches

Cited by in corpus (2)

• Learning-based NLOS Detection and Uncertainty Prediction of GNSS Observations with Transformer-Enhanced LSTM Network
• Automotive Speed Estimation: Sensor Types and Error Characteristics from OBD-II to ADAS