Path Planning Method of Unmanned Surface Vehicles Formation Based on Improved A* Algorithm

Abstract

Unmanned surface vehicle (USV) formation is a hot topic of current research. Path planning is the core technology for USV formation. This paper focuses on a USV formation path planning problem considering kinetic constraints. Firstly, an improved A* algorithm is proposed to solve the point-to-point path planning of a USV considering kinetic constraints. In this algorithm, the yaw constraint is introduced on top of the position constraint to extend the state space of the USV to three dimensions, and the convergence speed is accelerated by building a heuristic map. The dynamics model of the USV is used to generate the minimum trajectory elements to ensure that the path conforms to the kinetic constraints. Secondly, the mathematical model of USV formation based on the virtual structure method is established, and the path planning scheme of formation navigation and formation reconfiguration is given according to the improved A* algorithm. Finally, we carry out a USV model identification experiment for SL900 USV and simulation experiments based on the model. The experimental results show that the output path of the proposed method is smoother compared with the traditional method. This method can provide a globally safe path with kinetic constraints for USV formation navigation and formation reconstruction.