Shi, Y., Lian, B., Zeng, Y., & Kurniawan, E. (2025). Tightly-Coupled 6DoF Localization in Complex Environments With GNSS Raw Data. IEEE Transactions on Intelligent Transportation Systems, 26(3), 3369–3386. https://doi.org/10.1109/tits.2025.3528888
Abstract:
In large-scale urban environments, precise six degree-of-freedom (6DOF) pose estimation is essential for vehicles and robots to perform autonomous driving and exploration, as well as to achieve high intelligence and full autonomy of Unmanned Aerial Vehicles (UAV). Achieving 6DOF pose estimation in Global Navigation Satellite System (GNSS)-denied environments is challenging. The performance of relative 6DOF localization systems based on Light Detection and Ranging (LiDAR), vision, and inertial data is easily affected by environmental conditions, leading to error accumulation and a significant decrease in estimation accuracy in complex environments. To address this issue, we propose a tightly coupled framework based on nonlinear optimization for vision, LiDAR, inertial, and GNSS raw data. In the experimental section, we validate the effectiveness of the proposed optimization factor model for GNSS data, LiDAR data, and visual data in improving position and orientation estimation accuracy through simulations. Additionally, we use real datasets to compare the proposed algorithm with several existing open-source programs in terms of computational efficiency, pose estimation accuracy, worst case scenarios, and reliability. The experimental results show that, although the total processing time increases, the position estimation accuracy and orientation estimation accuracy of the proposed fusion algorithm improve by at least 58.0%. Overall,
the proposed tightly-coupled algorithm outperforms the existing methods.
License type:
Publisher Copyright
Funding Info:
This research / project is supported by the National Research Foundation, Singapore and Infocomm Media Development Authority - Future Communications Research & Development Programme: Multi-Sensor Mobile Edge Platform for Integrated Sensing and Communication (ISAC) Co-Optimization
Grant Reference no. : FCP-NTU-RG-2022-021