Berthing State Estimation for Autonomous Surface Vessels Using Ship-Based 3D LiDAR

Automated berthing remains a critical challenge for autonomous surface vessels (ASVs), necessitating precise berthing state estimation as a fundamental prerequisite. In this paper, we present a novel berthing state estimation method tailored for ASVs and based on 3D LiDAR technology. Firstly, a berthing plane acquisition scheme based on point cloud plane fitting is proposed; the feasibility of the scheme was verified by experiments. The point cloud registration algorithm was used to realize the ship pose estimation. Before registration, the preprocessing technology was used to filter out the noise and outliers in the point cloud data to improve the accuracy of pose estimation. A detailed method for calculating the berthing state information is proposed. This method considers the influence of ship roll, pitch, and yaw during berthing, and ensures the accuracy of the obtained state information. Finally, a real-time ship berthing perception framework was constructed using the Robot Operating System (ROS), enabling the continuous output of vital berthing state information, including berthing distance, velocity, approaching angle, and yaw rate, at a frequency of 10 Hz. To validate the effectiveness of our algorithm, extensive real ship experiments were conducted, yielding highly promising results. The average angle error was found to be less than 0.26°, with an average distance error below 0.023 m.