一种基于人工势场法的改进无人机航迹规划方法与流程

1.本发明属于无人机航迹规划领域，涉及一种基于人工势场法的改进无人机航迹规划方法。


背景技术：

2.在社会与经济的发展历程中，森林的作用不可忽视，因此，林业也是国家生态建设的主体。另一方面，我国不仅是森林资源大国，也是森林火灾多发国家，尽管疆域辽阔，森林资源总量大，但人均森林覆盖率较低、且类型繁杂，森林防火的工作既要面临着不利的气候、地理环境等条件，也要时刻面临着火源难以掌控，可燃物超载，防控能力不足等实际困难。在森林防火中应用的主要技术包括卫星遥感监测、航空巡护、瞭望台监测、地面传感/视频网络监测以及人工巡护等。在这些技术中，航空巡护最为有效，因为该方法覆盖范围广，能准确快速地对火情进行侦察。但是，传统航空巡护由飞行员驾驶飞机，飞行受气象情况制约，飞行成本高，且具有潜在的人员伤亡风险等，这些问题一定程度上限制了航空巡护的应用。无人机是一种可远程控制航行的飞行器，对交通条件差、危险性高的森林消防工作来说，使用无人机在森林可燃物调查、野外火源监控、森林防火巡护、森林火灾扑救指挥和灾后调查评估等方面都有重要意义。
3.实现无人机在森林防火中的应用，一个关键问题就是航迹规划。对于该问题的研究已有多年的历史，研究者提出了许多算法，其中人工势场法是一种实时在线的路径规划算法，该方法可以满足无人机三维路径规划的要求，同时还具有计算时间短、满足实时控制、规划路径安全平滑的优点。但该方法也存在目标不可达、容易陷入局部最小值、路径震荡等缺点。


技术实现要素：

4.要解决的技术问题
5.为了避免现有技术的不足之处，本发明提出一种基于人工势场法的改进无人机航迹规划方法，解决森林火灾中无人机的航迹规划问题。
6.技术方案
7.一种基于人工势场法的改进无人机航迹规划方法，其特征在于步骤如下：
8.步骤1：对三维地形及森林环境空间进行建模，即将环境表示为一个人工势场，以目标点为中心建立引力势场，以障碍物及威胁为中心建立斥力势场；
9.步骤2：根据所述建立的人工势场，计算出无人机当前所受合力，并使无人机在合力作用下前进，合力计算如下：
10.f
total
＝f
rep
f
att
11.其中，f
rep
为无人机所受斥力，f
att
为无人机所受引力；
12.步骤3：通过计算无人机当前时刻与前一时刻位置之间欧氏距离l，判断无人机是否陷入局部最小值点；若无人机陷入局部最小值点，根据无人机当前位置计算出无人机行
进方向上的障碍物边界坐标点，将其设为子目标点，并将所述子目标点作为当前目标点位置，重构人工势场，计算此时无人机所受的引力，使无人机朝所述子目标点位置移动，达到跳出局部最小值点的目的；若无人机并未陷入局部最小值点，使无人机按照当前路线继续前进；
13.步骤4：通过雷达和图像传感器对所述森林环境中的动态障碍进行感知，检测无人机周围是否存在动态障碍；若存在动态障碍，则计算无人机与障碍之间相对速度，并计算出无人机与动态障碍物相对速度和距离的夹角θ，若时，进行动态避障，即对动态障碍物建立斥力场模型，更新所述无人机斥力f
rep
；若不存在动态障碍或θ不在所述范围内时，使无人机按照当前路线继续前进；
14.步骤5：通过计算无人机当前时刻与目标点位置之间欧氏距离d，判断无人机是否抵达目标点；若所述欧氏距离d小于预先设定的第二阈值，则说明无人机已达到目标点，运行结束；若所述欧氏距离d大于预先设定的第二阈值，则说明无人机并未达到目标点，重复步骤2～5。
15.本发明技术方案更进一步的说：步骤1中所述的人工势场的数学模型具体如下：
[0016][0017][0018]
其中，u
att
(x)为引力场，k
att
为引力系数，ρ
g
(x)为无人机与目标点距离，d
′
为第三阈值；u
rep
(x)为斥力场，k
rep
为斥力系数，ρ(x)为无人机与障碍物距离，ρ0为障碍物影响无人机的极限距离。
[0019]
本发明技术方案更进一步的说：无人机所受引力f
att
与斥力f
rep
分别为引力场与斥力场的负梯度：
[0020][0021][0022]
本发明技术方案更进一步的说：步骤3中陷入局部最小值点的判断方法：将欧氏距离l与预先设定的第一阈值进行比对，若小于第一阈值，则说明无人机陷入局部最小值点。
[0023]
本发明技术方案更进一步的说：第一阈值设置为0.1。
[0024]
本发明技术方案更进一步的说：无人机与动态障碍相对速度计算如下：
[0025]
v
r
＝v
uav
‑
v
obs
[0026]
其中，v
uav
为无人机速度，v
obs
为障碍物相对速度。
[0027]
本发明技术方案更进一步的说：步骤5中的第二阈值设置为1。
[0028]
有益效果
[0029]
本发明提出的一种人工势场法的改进无人机航迹规划方法，该方法提出了包含经度、纬度、高程、威胁信息的网格模型对三维空间进行划分，大大简化了三维路径规划问题，
同时通过改进势场函数解决了传统人工势场法存在的目标点不可达、存在局部最小值等不足，并且针对森林火灾中存在动态障碍物的情况提出了动态避障的方法，进一步保证了无人机的安全。在森林火灾情形下，基于人工势场法的改进无人机航迹规划方法与其他航迹规划方法相比，计算效率更高，且安全性更强，因而对推动无人机在森林防火中的应用有重要意义。
附图说明
[0030]
附图仅用于示出具体实施例的目的，而并不认为是对本发明的限制，在整个附图中，相同的参考符号表示相同的部件。
[0031]
图1为本发明基于改进人工势场法的无人机航迹规划方法流程图；
[0032]
图2为三维空间划分网格模型；
[0033]
图3为人工势场法原理；
[0034]
图4为无人机跳出局部极小点的方法图；
[0035]
图5为算法规划得到的航迹；
具体实施方式
[0036]
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图和实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本发明，并不用于限定本发明。此外，下面描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
[0037]
请参阅图1，为本发明提供的一种基于人工势场法的改进无人机航迹规划方法，所述方法包括：
[0038]
使用如图2所示的改进网格模型对三维地形及森林环境空间进行划分，每个网格点包含该位置经度、纬度、高程、威胁信息，能够更加有效划分三维空间，提高算法效率。
[0039]
在空间内建立人工势场，以目标点为中心建立引力势场u
att
(x)，以障碍物及威胁为中心建立斥力势场u
rep
(x)，具体建模方法如下：
[0040][0041]
式中k
att
为引力常数，若无人机与目标点之间的距离小于等于阈值d
′
，引力场与距离ρ
g
(x)的平方成正比，若无人机与目标点之间的距离大于阈值d
′
，设置引力为常数。以解决无人机与目标点的距离非常大时，引力远远大于斥力，导致无人机与障碍物相撞的问题。
[0042][0043]
式中k
rep
为斥力常数，若无人机与障碍之间的距离ρ(x)大于极限距离ρ0，障碍对无人机无斥力。
[0044]
如图3所示，根据所建立的人工势场，计算出无人机当前所受合力，并使无人机在
合力作用下前进，无人机所受引力f
att
与斥力f
rep
分别为引力场与斥力场的负梯度：
[0045][0046][0047]
通过计算无人机当前时刻与前一时刻位置之间欧氏距离l，比较该距离与设定第一阈值0.1，以判断此时无人机是否陷入局部最小值点。若所述欧氏距离l小于预先设定的阈值，则说明无人机陷入局部最小值点，根据无人机当前位置计算出无人机行进方向上的障碍物边界坐标点，将其设为子目标点，并将所述子目标点作为当前目标点位置，使无人机朝所述子目标点位置移动，达到跳出局部最小值点的目的，如果所述欧氏距离l大于预先设定的阈值，则认为无人机并未陷入局部最小值点，使无人机按照当前路线继续前进；
[0048]
通过雷达和传感器对动态障碍进行感知，检测无人机周围是否存在动态障碍。若存在，则进行动态避障，计算无人机与障碍之间相对速度和距离的夹角θ，当时，说明动态障碍物逐渐接近无人机，此时需要将障碍物的影响纳入考虑中，对动态障碍物建立斥力场模型，更新所述无人机斥力f
rep
；反之则说明动态障碍物逐渐远离无人机，无需考虑该障碍物的影响；
[0049]
通过计算无人机当前时刻与目标点位置之间欧氏距离d，判断无人机是否抵达目标点。预先设定第二阈值等于1，若所述欧氏距离d小于预先设定的第二阈值，则说明无人机已达到目标点，算法程序运行结束。若所述欧氏距离d大于预先设定的第二阈值，则说明无人机并未达到目标点，算法继续循环运行。最终得到的规划航迹如图5所示。
[0050]
以上所述，仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明公开的技术范围内，可轻易想到各种等效的修改或替换，这些修改或替换都应涵盖在本发明的保护范围之内。