[发明专利]基于模糊虚拟力的无人机航路规划方法

摘要

为解决基于虚拟力航路规划方法出现的局部极小问题，并实现规划过程中实时的自适应规划参数设置，本发明采用基于模糊虚拟力(FVF)的无人机航路规划方法，其采用贝叶斯网络和模糊逻辑推理相结合进行实时的自适应规划参数设置，并提出威胁合并法解决虚拟力法的局部极小问题。本发明的基于模糊虚拟力的无人机航路规划方法包含以下步骤：1)设置无人机航路规划的初始条件，包括规划起始点、目标点、威胁分布及属性；2)设置无人机航路规划的迭代步长；3)设置规划参数，从而确定虚拟斥力系数与虚拟引力系数之间的关系；4)进行航路规划；5)判断是否进入局部极小，若是，则进行威胁合并，若否，则继续进行航路规划直至目标点。

主权项

1.一种基于模糊虚拟力的无人机航路规划方法，其特征在于包含以下步骤：1)设置无人机航路规划的初始条件，包括规划起始点、目标点、威胁分布及属性；2)设置无人机航路规划的迭代步长；3)设置规划参数k，从而确定虚拟斥力系数与虚拟引力系数之间的关系，其中，k＝G_R/G_A，G_A表示虚拟引力系数，G_R表示虚拟斥力系数；4)进行航路规划，航路规划坐标变化量Δx和Δy为：其中，F_Ax和F_Ay分别表示虚拟引力在x轴和y轴的投影，R_A是当前点和目标点间的距离，θ_A是当前点与目标点连线和x轴的夹角；F_Rx和F_Ry分别表示虚拟斥力在x轴和y轴的投影，R_R是当前点和威胁间的距离，r₀是常量可设置为威胁的半径，θ_R是当前点与威胁连线和x轴的夹角；δ为航路规划的迭代步长，且α＝[(F_Ax+∑F_Rx)²+(F_Ay+∑F_Ry)²]^-1/2；5)判断是否进入局部极小，若是，则进行威胁合并，若否，则继续进行航路规划直至目标点。