一种基于改进APF-A*混合算法的UAV三维避障方法

本发明涉及一种基于改进APF‑A*混合算法的无人机三维避障方法，其特征在于：包括以下步骤：首先，确定三维空间下无人机的初始位置、障碍物的位置、改进人工势场法中引力增益系数、斥力增益系数、削弱因子、障碍影响距离等初始化参数的确认，其次根据数据求出无人机与目标点以及障碍物三方向的夹角以及距离，计算得到三个方向的引力分力以及斥力分力，从而计算合引力、合斥力并得到势场合力，计算UAV的下一个三维坐标。判断无人机最新位置是否达到目标点。如果达到则停止，如果未达到则判断无人机停止运动,如果未停止跳至前步骤直至达到目标点，否则使用改进A*算法直至迭代点斥力分力为零，时跳至前步骤直至达到目标点。本发明具有适用性，能解决无人机初始点附近容易发生碰撞问题、附近有障碍物的目标不可达问题、抖振问题以及陷入局部最小值问题，对传统APF以及A*算法进行改进融合，提高无人机的避障能力和避障效率。