3D path planning method for underwater vehicles based on real terrain

Aiming at the problem of poor applicability of current path planning results for underwater vehicles, a three-dimensional path planning algorithm for underwater vehicles based on improved particle swarm optimization algorithm was proposed. A Voronoi map based on the real terrain data of sea area was built, and the Dijkstra algorithm was used to generate the initial path set that meets the requirements of navigation safety as the initial particles of particle swarm optimization algorithm, so the generation efficiency of initial particles was improved. At the same time, the particles′ position update method was improved to guide the particle position change according to the position of adjacent nodes on the route, which makes the planned route smoother and more suitable for the navigation of underwater vehicles. Simulation results show that the proposed algorithm is more robust and has better applicability than the traditional particle swarm optimization algorithm in path planning.