An autonomous path planning method considering terrain aided navigation constraints

In order to solve the autonomous path planning problem with terrain aided navigation constraints, a navigation-first path planning method was adopted, that is, the distribution of terrain matching regions and the drift of navigation errors were given priority, and the path planning problem was transformed into the shortest path problem of single source directed graph to determine the nodes on the path. Secondly, the path planning between adjacent nodes is transformed into a path planning problem with initial direction constraint and terminal direction freedom/constraint, and the lateral path is smoothed. Finally, for the local path passing through the no-fly zone, the obstacle avoidance path planning with initial and terminal direction constraints is carried out based on convex optimization method. The simulation results show that the autonomous path planning method considering terrain aided navigation constraints can plan the shortest flight path under the constraints of navigation accuracy, maneuverability and no-fly zone.