Multi-AUV three-dimensional collaborative route planning method

Abstract

The invention discloses a multi-AUV three-dimensional collaborative route planning method. The method mainly comprises the steps of three-dimensional environment abstract modeling, level set functioninitialization, level set function evolution, optimal route point selection, collaborative route scheme design, route conflict judgment and re-planning and planning result output. According to the invention, the level set algorithm is improved; a plurality of airways can be simultaneously planned in a navigation space, thereby improving planning efficiency of algorithms, all AUVs are required to reach the end point at the same time during collaborative scheme design; each AUV needs to start one by one according to delay time, in addition, under the condition of considering rapidity and concealment, a collaborative planning scheme with the concealment and navigation time fused optimally is designed, the influence of ocean current and sound velocity factors is considered at the same time, conflict judgment and re-planning links are added, and a collaborative route is safer; compared with two-dimensional air route planning, the implementation of the three-dimensional air route planning ismore practical, and the actual navigation requirement can be better met.

Description

technical field [0001] The invention belongs to the technical field of three-dimensional path planning of underwater submersibles, and relates to a multi-AUV three-dimensional collaborative route planning method, in particular to a multi-AUV three-dimensional collaborative route planning method considering the influence of the marine environment. Background technique [0002] At present, most of the research is limited to the route planning problem of a single AUV, and there is a lack of research on the multi-route collaborative planning problem from multiple origins to multi-destinations under the influence of the marine environment. In the actual situation, in order to improve the completion rate of the task, all AUVs need to reach the multi-task point at the same time. At this time, how to generate an effective route for each AUV and coordinate the arrival time of each AUV is one of the prerequisites for completing the task. Due to the needs of practical applications, th...

AI Technical Summary

Problems solved by technology

Patent CN201810519546.6 discloses a UUV path planning method based on multi-objective optimization of energy consumption and sampling volume under the influence of complex marine environments. The marine environmental information considered is only ocean currents, and marine environmental information such as temperature and salinity are not considered.

Patent CN201610887874.2 discloses a time-optimal route planning method based on level set algorithm. It only designs a single route planning algorithm for a single AUV under the influence of ocean currents in the ocean environment, and does not consider multiple AUVs for collaborative route research. , there is no published literature on the application of the level set algorithm to the study of 3D collaborative route planning considering the influence of the marine environment

Images