The invention relates to the technical field of unmanned aerial vehicle
trajectory planning, in particular to a bidirectional tree
random search method based on a complex environment node cost function, which comprises the steps of surveying obstacle data in a flight area and modeling, then introducing a target deviation strategy and a
bidirectional search tree mechanism, and combining with an improved minimum cost method to obtain a
random search result. Alternately expanding the two trees to generate an initial path, and integrating the
path length, the obstacle distance and the
flight height energy consumption by a cost function; and finally,
pruning the initial path, removing redundant nodes,
smoothing the trajectory by adopting a cubic spline interpolation method, ensuring curvature continuity, and generating an optimal path meeting the flight performance of the unmanned aerial vehicle. According to the invention, through an improved bidirectional minimum cost fast expansion
random tree algorithm, dynamic association of obstacle constraint, target deviation and
path cost in unmanned aerial vehicle path planning in a complex environment is represented, and a more efficient search convergence speed and better path quality are obtained. And
rapid convergence and
global optimization of the track of the unmanned aerial vehicle in a high-dynamic environment are realized.