一种基于人工势场法的改进无人机航迹规划方法技术

本发明专利技术涉及一种基于人工势场法的改进无人机航迹规划方法，属于无人机航迹规划领域。首先，对三维地形及森林环境空间进行建模，即将外部环境分为引力场区域与斥力场区域，以目标点为中心建立引力场，以障碍物为中心建立斥力场，保证目标点为合势场的全局极小点，这样无人机会沿着合势场下降方向到达目标点。然后，通过当前位置势场强度实时计算出无人机在当前时刻所受的合力，无人机在受到其目标引力场和障碍物周围斥力场的共同作用下，朝目标前进。同时，判断无人机是否陷入局部极小点，若陷入，则通过及时更新子目标点的方法，使得无人机跳出局部极小点。最终，无人机以最优路径抵达目标点。本发明专利技术方法计算效率更高，且安全性更强。更强。更强。

【技术实现步骤摘要】
一种基于人工势场法的改进无人机航迹规划方法


[0001]本专利技术属于无人机航迹规划领域，涉及一种基于人工势场法的改进无人机航迹规划方法。

技术介绍

[0002]在社会与经济的发展历程中，森林的作用不可忽视，因此，林业也是国家生态建设的主体。另一方面，我国不仅是森林资源大国，也是森林火灾多发国家，尽管疆域辽阔，森林资源总量大，但人均森林覆盖率较低、且类型繁杂，森林防火的工作既要面临着不利的气候、地理环境等条件，也要时刻面临着火源难以掌控，可燃物超载，防控能力不足等实际困难。在森林防火中应用的主要技术包括卫星遥感监测、航空巡护、瞭望台监测、地面传感/视频网络监测以及人工巡护等。在这些技术中，航空巡护最为有效，因为该方法覆盖范围广，能准确快速地对火情进行侦察。但是，传统航空巡护由飞行员驾驶飞机，飞行受气象情况制约，飞行成本高，且具有潜在的人员伤亡风险等，这些问题一定程度上限制了航空巡护的应用。无人机是一种可远程控制航行的飞行器，对交通条件差、危险性高的森林消防工作来说，使用无人机在森林可燃物调查、野外火源监控、森林防火巡护、森林火灾扑救指挥和灾后调查评估等方面都有重要意义。
[0003]实现无人机在森林防火中的应用，一个关键问题就是航迹规划。对于该问题的研究已有多年的历史，研究者提出了许多算法，其中人工势场法是一种实时在线的路径规划算法，该方法可以满足无人机三维路径规划的要求，同时还具有计算时间短、满足实时控制、规划路径安全平滑的优点。但该方法也存在目标不可达、容易陷入局部最小值、路径震荡等缺点。
专利技术内容
[0004]要解决的技术问题
[0005]为了避免现有技术的不足之处，本专利技术提出一种基于人工势场法的改进无人机航迹规划方法，解决森林火灾中无人机的航迹规划问题。
[0006]技术方案
[0007]一种基于人工势场法的改进无人机航迹规划方法，其特征在于步骤如下：
[0008]步骤1：对三维地形及森林环境空间进行建模，即将环境表示为一个人工势场，以目标点为中心建立引力势场，以障碍物及威胁为中心建立斥力势场；
[0009]步骤2：根据所述建立的人工势场，计算出无人机当前所受合力，并使无人机在合力作用下前进，合力计算如下：
[0010]F
total
＝F
rep
+F
att
[0011]其中，F
rep
为无人机所受斥力，F
att
为无人机所受引力；
[0012]步骤3：通过计算无人机当前时刻与前一时刻位置之间欧氏距离L，判断无人机是否陷入局部最小值点；若无人机陷入局部最小值点，根据无人机当前位置计算出无人机行
进方向上的障碍物边界坐标点，将其设为子目标点，并将所述子目标点作为当前目标点位置，重构人工势场，计算此时无人机所受的引力，使无人机朝所述子目标点位置移动，达到跳出局部最小值点的目的；若无人机并未陷入局部最小值点，使无人机按照当前路线继续前进；
[0013]步骤4：通过雷达和图像传感器对所述森林环境中的动态障碍进行感知，检测无人机周围是否存在动态障碍；若存在动态障碍，则计算无人机与障碍之间相对速度，并计算出无人机与动态障碍物相对速度和距离的夹角θ，若时，进行动态避障，即对动态障碍物建立斥力场模型，更新所述无人机斥力F
rep
；若不存在动态障碍或θ不在所述范围内时，使无人机按照当前路线继续前进；
[0014]步骤5：通过计算无人机当前时刻与目标点位置之间欧氏距离d，判断无人机是否抵达目标点；若所述欧氏距离d小于预先设定的第二阈值，则说明无人机已达到目标点，运行结束；若所述欧氏距离d大于预先设定的第二阈值，则说明无人机并未达到目标点，重复步骤2～5。
[0015]本专利技术技术方案更进一步的说：步骤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所示的改进网格模型对三维地形及森林环境空间进行划分，每个网格点包含该位置经度、本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于人工势场法的改进无人机航迹规划方法，其特征在于步骤如下：步骤1：对三维地形及森林环境空间进行建模，即将环境表示为一个人工势场，以目标点为中心建立引力势场，以障碍物及威胁为中心建立斥力势场；步骤2：根据所述建立的人工势场，计算出无人机当前所受合力，并使无人机在合力作用下前进，合力计算如下：F
total
＝F
rep
+F
att
其中，F
rep
为无人机所受斥力，F
att
为无人机所受引力；步骤3：通过计算无人机当前时刻与前一时刻位置之间欧氏距离L，判断无人机是否陷入局部最小值点；若无人机陷入局部最小值点，根据无人机当前位置计算出无人机行进方向上的障碍物边界坐标点，将其设为子目标点，并将所述子目标点作为当前目标点位置，重构人工势场，计算此时无人机所受的引力，使无人机朝所述子目标点位置移动，达到跳出局部最小值点的目的；若无人机并未陷入局部最小值点，使无人机按照当前路线继续前进；步骤4：通过雷达和图像传感器对所述森林环境中的动态障碍进行感知，检测无人机周围是否存在动态障碍；若存在动态障碍，则计算无人机与障碍之间相对速度，并计算出无人机与动态障碍物相对速度和距离的夹角θ，若时，进行动态避障，即对动态障碍物建立斥力场模型，更新所述无人机斥力F
rep
；若不存在动态障碍或θ不在所述范围内时，使无人机按照当前路线继续前进；步骤5：通过计算无人机当前时刻与目标点位置之间欧氏距离d，判断无人机是否抵达目标点；若所述欧氏距离d小于预先设定的第二阈值，则说明无人机已达到目标点，运行结束；若所述欧氏距离d大于预先设定的第二阈值，则说明无人机并未达到目标...

【专利技术属性】
技术研发人员：屈耀红，谢海涛，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：