Trajectory optimization of UAV based on Hp-adaptive Radau pseudospectral method

Unmanned Aerial Vehicles (UAVs) have been extensively studied to complete the missions in recent years. The UAV trajectory planning is an important area. Different from the commonly used methods based on path search, which are difficult to consider the UAV state and dynamics constraints, so that the planned trajectory cannot be tracked completely. The UAV trajectory planning problem is considered as an optimization problem for research, considering the dynamics constraints of the UAV and the terrain obstacle constraints during flight. An hp-adaptive Radau pseudospectral method based UAV trajectory planning scheme is proposed by taking the UAV dynamics into account. Numerical experiments are carried out to show the effectiveness and superior of the proposed method. Simulation results show that the proposed method outperform the well-known RRT* and A* algorithm in terms of tracking error.