A LiDAR SLAM-Assisted Fusion Positioning Method for USVs

Wei Shen,Zhisong Yang,Chaoyu Yang,Xin Li

DOI: https://doi.org/10.3390/s23031558

IF: 3.9

2023-02-02

Sensors

Abstract:Confronted with unmanned surface vessel (USV) operations where GNSS signals are unavailable due to obscuration and other factors, a LiDAR SLAM-assisted fusion positioning method for USVs is proposed to combine GNSS/INS positioning with LiDAR-SLAM. When the USV works in wide-open water, the carrier phase differential GNSS/INS loosely coupled integration strategy is applied to fuse and calibrate the positioning data, and the positioning information of the USV is obtained through the coordinate conversion process. The system uses a dynamic switching strategy to enter to LiDAR-SLAM positioning when GNSS signals are not available, compensating the LiDAR data with precise angle information to ensure accurate and stable positioning. The experiments show that compared with the traditional Kalman filter and adaptive Kalman filter fusion algorithms, the positioning error is reduced by 55.4% and 43.5%. The velocity error is also limited by 78.2% and 57.9%. The standard deviation and the root mean square error are stable within 0.1 m, indicating that our method has better data stability, while the probability of positioning anomaly is effectively controlled.

engineering, electrical & electronic,chemistry, analytical,instruments & instrumentation

What problem does this paper attempt to address?

This paper attempts to address the problem of achieving precise and stable positioning in Unmanned Surface Vehicle (USV) operations when Global Navigation Satellite System (GNSS) signals are unavailable due to obstructions or other reasons. To solve this problem, the authors propose a fusion positioning method based on LiDAR Simultaneous Localization and Mapping (LiDAR SLAM) assistance, combining GNSS/Inertial Navigation System (INS) positioning with LiDAR-SLAM. Specifically, when the USV operates in open waters, a loosely coupled integration strategy of carrier phase differential GNSS/INS is used for data fusion and calibration, obtaining the USV's positioning information through the coordinate transformation process. When GNSS signals are unavailable, the system dynamically switches to LiDAR-SLAM positioning and uses precise angle information to compensate for LiDAR data, ensuring positioning accuracy and stability.

Experimental results show that compared to traditional Kalman filter and adaptive Kalman filter fusion algorithms, the proposed method reduces positioning errors by 55.4% and 43.5%, respectively, and speed errors by 78.2% and 57.9%, respectively. The standard deviation and root mean square error are stabilized within 0.1 meters, indicating that the method has better data stability while effectively controlling the probability of positioning anomalies.