Distributed Optimization-Based Path Planning for Multiple Unmanned Surface Vehicles to Pass through Narrow Waters

Abstract

Safety and efficiency are important when Unmanned Surface Vehicles (USVs) pass through narrow waters in complex marine environments. This paper considers the issue of path planning for USVs passing through narrow waterways. We propose a distributed optimization algorithm based on a polymorphic network architecture, which maintains connectivity and avoids collisions between USVs while planning optimal paths. Firstly, the initial path through the narrow waterway is planned for each USV using the narrow water standard route method, and then the interpolating spline method is used to determine its corresponding functional form and rewrite the function as a local cost function for the USV. Secondly, a polymorphic network architecture and a distributed optimization algorithm were designed for multi-USVs to maintain connectivity and avoid collisions between USVs, and to optimize the initial paths of the multi-USV system. The effectiveness of the algorithm is demonstrated by Lyapunov stability analysis. Finally, Lingshui Harbor of Dalian Maritime University and a curved narrow waterway were selected for the simulation experiments, and the results demonstrate that the paths planned by multiple USVs were optimal and collision-free, with velocities achieving consistency within a finite time.