针对无人机在复杂环境下难以规划出兼顾平滑性和安全性等指标的时域连续轨迹问题,基于安全飞行通道提出了一种多目标轨迹规划算法.在基于快速拓展随机树(RRT)改进的RRT^*算法生成的初始离散路径点基础上,建立以凸多面体集合表示的安全飞行通道;根据轨迹在安全飞行通道内部的约束建立安全项目标函数,结合飞行平滑性、动力学特性、飞行时间等性能指标,建立加权多目标优化函数;采用基于梯度下降的凸优化算法,对离散路径点的位置、速度、加速度及轨迹的时间分配进行优化,生成分段多项式表示的时域连续轨迹.基于煤矿井下等复杂环境对算法的有效性及相关性能进行试验及对比验证,结果表明:相比现有算法,本文算法在综合性能上有一定的提升.

Aimed at the problem of generating a smooth, safe, and dynamically feasible continuous-time trajectory for unmanned aerial vehicles (UAV) in complex environments, a trajectory planning algorithm is proposed to minimize a multi-objective function based on safe flight corridors. The safe flight corridor represented by a collection of convex polyhedra is built based on the initial discrete waypoints generated by the improved rapidly-exploring random tree(RRT), namely the RRT^* algorithm. The safety objective function is established according to the constraints of limiting the trajectory inside safe flight corridors. In combination with the flight smoothness, dynamic characteristics, and time performance, a multi-objective function is built. The gradient-based convex optimization algorithm is used to derive the continuous-time trajectory expressed as a piece-wise polynomial by optimizing the position, velocity, acceleration of waypoints, and time allocation. The effectiveness and performance of the proposed algorithm is tested and compared under complex environments such as the coal mine. The test results demonstrate that the proposed algorithm has a better comprehensive performance in comparison with existing algorithms.