一种基于A*与凸优化算法的无人机三维避障算法

摘要

本发明公开了一种基于A*与凸优化算法的无人机三维避障算法，所述算法包括如下步骤：第一步、明确轨迹规划算法的设计任务；第二步、通过A*算法得到无人机的参考路径；第三步、通过基于半定规划的迭代区域膨胀方法给出一系列凸多面体组成的避障约束；第四步、针对无人机系统，给出无人机的三维避障轨迹规划模型，并通过解算该模型得到无人机的状态序列以及控制序列。本发明的算法不仅能够避开场地中的凸多面体障碍物，而且还能避免无人机在离散的时间步之间撞击障碍物的可能。本发明的算法相比于传统的凸优化避障算法减少了计算量，并最终得到一组符合要求的状态序列以及一组燃料消耗最少的控制序列。