基于拓扑路径的旋翼无人机轨迹生成方法

本发明提出了一种基于拓扑路径的旋翼无人机轨迹生成方法，实现步骤为：初始化参数；生成局部轨迹；判断局部轨迹是否与障碍物发生碰撞；生成多条拓扑路径；对每个类别的拓扑路径进行紧缩和离散；获取无人机局部轨迹生成结果；获取无人机轨迹生成结果。本发明通过舍弃与障碍物发生碰撞的几何路径形成多条拓扑路径，并对由拓扑路径形成的离散点集合进行优化，然后对优化的多个不同初始解进行优化，生成多条拓扑轨迹，最后选择其中加加速度积分值最小的拓扑轨迹作为局部轨迹，从而充分地利用了轨迹优化的自由空间且不易陷入局部最优，有效提高了局部轨迹的平滑度，并使局部轨迹远离障碍物，有效提高了无人机的飞行速度和安全性。