The invention discloses a UUV path
planning method based on an improved fast search
random tree. The method is suitable for the fields of autonomous navigation, task execution,
obstacle avoidance, safety guarantee and the like of UUVs. The method comprises the following steps: S1, determining an initial step length; dynamically adjusting the initial step length according to the scale of the task space and the complexity of the environment; and S2, carrying out target bias sampling. In the sampling process, according to a set bias threshold value, an
algorithm biases a sampling point to a target area according to a certain probability, so that the target guidance quality of search is enhanced; and S3, removing redundant points. A Dijkstra
algorithm is adopted to simplify a path, unnecessary turning points are removed, and more nodes are inserted into the path to improve the intensity of the path, so that the optimization space is increased. Then, redundant point removal is executed again, so that the path is further simplified; and S4,
smoothing the path. Through the maximum curvature constraint, it is ensured that the
turning angle of the path does not exceed the preset limit, meanwhile, in combination with a polynomial fitting method, abrupt turning in the path is reduced, and the smoothness of the path is improved.