A Novel COLREGs-Based Automatic Berthing Scheme for Autonomous Surface Vessels

Abstract

This paper tackles the highly challenging problem of automatic berthing for autonomous surface vessels (ASVs), encompassing trajectory planning, trajectory tracking, and collision avoidance. Firstly, a novel A* algorithm integrated with a quasi-uniform B-spline and quadratic interpolation method (A*QB) is proposed for generating a smooth trajectory from the initial position to the berth, utilizing an offline-generated scaled map. Secondly, the optimal nonlinear model predictive control (NMPC)-based trajectory-tracking framework is established, incorporating the model’s uncertainty, the input saturation, and environmental disturbances, based on a 3-DOF model of a ship. Finally, considering the collision risks during port berthing, a COLREGs-based collision avoidance method is investigated. Consequently, a novel trajectory-tracking and COLREGs-based collision avoidance (TTCCA) scheme is proposed, ensuring that the ASV navigates along the desired trajectory, safely avoids both static and dynamic obstacles, and successfully reaches the berth. To validate the TTCCA approach, numerical simulations are conducted across four scenarios with comparisons to existing methods. The experimental results demonstrate the effectiveness and superiority of the proposed scheme.

Bibliographic Information