一种基于空间网格的无人机群安全作业航线自动生成方法技术

本发明专利技术一种基于空间网格的无人机群安全作业航线自动生成方法，包括按照无人机作业高度，将空间细分为空间网格，并对禁入区域进行形状补全；在空间网格内构建基于禁入区域的斥力场和基于目标点的引力场，建立离散势能场的模型函数；求解出各个网格的势能值，生成完整势能场；依次对每个集群内每个无人机进行计算，获取其当前位置及速度，根据无人机的位置和速度，计算集群对该无人机的影响，从而计算无人机的综合受力情况，计算其梯度，不断迭代求出完整无人机航线。本发明专利技术避免了陷入局部最优解；通过建立势能场可为大量无人机的改航活动计算改航最优路径；建立可通过性集合,避免无人机在狭窄通道口“堵死”的问题。的问题。的问题。

【技术实现步骤摘要】
一种基于空间网格的无人机群安全作业航线自动生成方法


[0001]本专利技术涉及集群无人机改航路径规划方法，尤其涉及一种基于空间网格的无人机群安全作业航线自动生成方法。

技术介绍

[0002]对于大规模无人机的集群前往作业地点时，一方面需要规避人工划设的禁入区域，例如下方有居民区，周边有危险地形等；另一方面也需要考虑无人机集群内部特点。因此在无人机集群改航时需要对集群内每个无人机生成一条安全航线，这本质上是一种路径规划问题，自上世纪90年代起，国内外学者开始对改航路径规划问题进行研究，根据实施时间的不同可将改航路径规划问题分为飞行前规划和实时规划两种，前者为静态路径规划，后者为动态路径规划。
[0003]其中，飞行前改航路径规划的主要方法包括：(1)基于多边形的改航路径规划法：考虑影响飞行区域的多边形边界特点，运用几何方法对航路进行规划；(2)基于网格的改航路径规划法：在网格改航环境模型中运用路径搜索算法规划改航飞行路径；(3)基于可视图和权重的改航路径规划法：将影响飞行区域划分为不同等级并赋予权重，运用可视图确定权重距离最短的飞机改航路径；(4)基于已有航路点的改航路径规划法：将改航策略与地面等待模型结合，运用A*算法在现有航线网络中搜索改航路径。
[0004]静态路径规划的常用算法为：栅格法、可视图法、构型空间法、Dijkstra算法和A*算法等，实时改航路径规划的主要方法包括：(1)基于标准进离场程序的改航路径规划法：以标准进离场程序中的航路点为参考，通过适当的选取改航点进行改航路径规划；(2)基于自由飞行的改航路径规划法：将移动的飞行危险天气区域视为一个区域较大、移动速率较慢的航空器，寻找规避飞行冲突的避让路径；(3)基于椭圆边界的改航路径规划法：通过沿椭圆状危险天气影响区域的边缘绕飞，在满足容量约束的前提下，选取距离最短者作为最终的改航路径；动态路径规划的常用算法为：遗传算法、神经网络法、人工势场法和模糊逻辑算法等。
[0005]以上这些方法虽可有效进行无人机改航路径规划，但大多针对单个无人机，未考虑多无人机甚至是大量无人机时的路径规划问题,且未考虑无人机内部的相互影响，同时考虑的限制因素较为单一，不具备限制因素的可扩展性,而且对大量无人机通过狭窄路口时的可通过性问题都没涉及。

技术实现思路

[0006]专利技术目的：本专利技术的目的是提供一种基于空间网格的无人机群安全作业航线自动生成方法，一方面改进了势场法容易陷入局部最优解的问题；另一方面也避免了大量无人机通过狭窄路径时无法求解的问题。
[0007]技术方案：本专利技术包括如下步骤：（1）按照无人机作业高度，将空间细分为空间网格，将居民区、危险地形作为危险
区域，同时圈定外围作业边界，将危险区域和作业边界映射到空间网格上形成禁入区网格，并对禁入区域进行形状补全，对禁入区外侧随机添加一个最小单位的威胁网格区块；（2）结合无人机集群的特点，构建蜂群约束模型，按照无人机的最小相邻安全距离，建立分离性加速度公式，避免撞机，按照无人机集群平均速度与预设飞行速度，建立一致性加速度公式，使集群中各个体的速度趋于一致，并往预设飞行速度靠近，按照无人机与集群中心点的位置关系，建立凝聚性加速度公式，使单体无人机与周围无人机保持在一定区间范围内；（3）在空间网格离散空间内构建基于禁入区域的斥力场和基于目标点的引力场，建立离散势能场的模型计算函数，模拟无人机对禁入区的规避行为与飞往作业地点的趋近行为；（4）对空间内各个网格的势能情况进行并行计算，求解出各个网格的势能值，生成完整势能场。将无人机集群中的内部约束叠加到势能场上，通过对无人机在该网格内的速度的上下左右四个方向做分量计算，选择最优方向，同时考虑无人机的可通过顺序,不断迭代求出从起始点到目标点的完整无人机航线。
[0008]进一步地，所述步骤（1）包括：（1.1）将环境空间分别在X轴和Y轴方向划分空间网格，将飞行边界数据映射到网格中，形成可活动的空间网格集合；（1.2）按照相邻边向量叉乘的方法判断禁入区域是否为凹多边形，如果是，则对凹多边形进行补全，然后将补全后的禁入区域映射到网格中；（1.3）在空间内随机选择一个网格，计算各禁入区距离该网格最近的网格，并从该网格相邻的非禁入区域网格中随机选择一个作为扰动因子，设置为禁入区域。
[0009]进一步地，所述步骤（2）包括：（2.1）按照分离性原则，建立分离性受力公式，无人机的相邻安全距离设为，首先获取与无人机i距离小于的无人机集合，并设为，用表示无人机i的分离性加速度，则无人机i在t时刻的分离性加速度可以表示为：其中，分别表示无人机n和无人机i的位置； （2.2）按照凝聚性原则，集群内各无人机之间的距离不能相隔太远，即无人机会向无人机集群中心靠拢，因此当无人机发生偏离时，会产生一个向中心的聚合力，t时刻的集群中心点位置为，即：
其中，表示无人机n在t时刻的位置，T为无人机总数，用表示无人机i在t时刻的聚合加速度的公式如下所示：其中，为无人机i的位置，和为待定参数，且； （2.3）根据一致性原则，无人机自身的速度需要与集群速度的方向保持一致，并不断趋近预设速度，即无人机i的一致性力用加速度可表示为：其中，为集群内无人机的速度集合，为集群内无人机n的速度，、为待定参数；（2.4）根据步骤（2.1）
‑
（2.3）可得无人机i在t时刻的集群内合加速度为：。
[0010]进一步地，所述步骤（3）包括：（3.1）构建引力场计算函数，引力场影响的是无人机的加速度，会随无人机所在的网格发生变化， 其在网格处的计算公式如下：
其中，为引力场参数，表示网格和目标点的欧式距离，当时，引力势能的大小与当前位置到目标位置的距离的平方成正比；当时，降低引力计算函数的取值，从而避免远离目标位置时引力过大；（3.2）构建斥力场计算函数，斥力场同样影响无人机的加速度，其在网格处的计算公式如下：其中，为斥力场参数，为斥力最大作用范围，当两个网格之间的距离小于时，斥力随距离的减小而变大，当位置重合时，斥力将变成无穷大；（3.3）综合叠加势能场后，空间内任意一点（m，n）的加速度为：。
[0011]进一步地，所述步骤（4）包括：（4.1）预先对整个网格内的势能场进行计算，遍历网格空间，对区域的属性进行一遍初始设置，即：其中，B为禁入区域网格集合；表示（m，n）位置的网格，是否可进入，1表示可以，0表示不可以,网格空间边界同样设置为不可进入；（4.2）计算综合加速度与速度，将势能场与集群内部影响进行叠加，则无人机i在t时刻的加速度为：
由于空间是网格化的，因此无人机每次移动的距离固定为两个相邻网格间的距离，表示为，认为无人机在一个单元格内的任一方向上做的是匀速直线运动，则速度可以表示为：以表示为：；（4.3）每个无人机在单元格内的移动方向有四个，即上、下、左、右，计算无人机在t时刻在(m，n)格内的速度，则可以计算出在X轴和Y轴的梯度分量，，则无人机i的下一个前进位置为：；（4.4）对位置的校验与调整，如果，不变，如果，则对重新调整，调本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于空间网格的无人机群安全作业航线自动生成方法，其特征在于，包括如下步骤：（1）按照无人机作业高度，将空间细分为空间网格，将居民区、危险地形作为危险区域，同时圈定外围作业边界，将危险区域和作业边界映射到空间网格上形成禁入区网格，并对禁入区域进行形状补全，对禁入区外侧随机添加一个最小单位的威胁网格区块；（2）结合无人机集群的特点，构建蜂群约束模型，按照无人机的最小相邻安全距离，建立分离性加速度公式，避免撞机，按照无人机集群平均速度与预设飞行速度，建立一致性加速度公式，使集群中各个体的速度趋于一致，并往预设飞行速度靠近，按照无人机与集群中心点的位置关系，建立凝聚性加速度公式，使单体无人机与周围无人机保持在一定区间范围内；（3）在空间网格离散空间内构建基于禁入区域的斥力场和基于目标点的引力场，建立离散势能场的模型计算函数，模拟无人机对禁入区的规避行为与飞往作业地点的趋近行为；（4）对空间内各个网格的势能情况进行并行计算，求解出各个网格的势能值，生成完整势能场，将无人机集群中的内部约束叠加到势能场上，通过对无人机在该网格内的速度的上下左右四个方向做分量计算，选择最优方向，同时考虑无人机的可通过顺序,不断迭代求出从起始点到目标点的完整无人机航线。2.根据权利要求1所述的基于空间网格的无人机群安全作业航线自动生成方法，其特征在于，所述步骤（1）包括：（1.1）将环境空间分别在X轴和Y轴方向划分空间网格，将飞行边界数据映射到网格中，形成可活动的空间网格集合；（1.2）按照相邻边向量叉乘的方法判断禁入区域是否为凹多边形，如果是，则对凹多边形进行补全，然后将补全后的禁入区域映射到网格中；（1.3）在空间内随机选择一个网格，计算各禁入区距离该网格最近的网格，并从该网格相邻的非禁入区域网格中随机选择一个作为扰动因子，设置为禁入区域。3.根据权利要求1所述的基于空间网格的无人机群安全作业航线自动生成方法，其特征在于，所述步骤（2）包括：（2.1）按照分离性原则，建立分离性受力公式，无人机的相邻安全距离设为，首先获取与无人机i距离小于的无人机集合，并设为，用表示无人机i的分离性加速度，则无人机i在t时刻的分离性加速度可以表示为：其中，分别表示无人机n和无人机i的位置；（2.2）按照凝聚性原则，集群内各无人机之间的距离不能相隔太远，即无人机会向无人机集群中心靠拢，因此当无人机发生偏离时，会产生一个向中心的聚合力，t时刻的集群中
心点位置为，即：其中，表示无人机n在t时刻的位置，T为无人机总数，用表示无人机i在t时刻的聚合加速度的公式如下所示：其中，为无人机i的位置，和为待定参数，且；（2.3）根据一致性原则，无人机自身的速度需要与集群速度的方向保持一致，并不断趋近预设速度，即无人机i的一致性力用加速...

【专利技术属性】
技术研发人员：张臻，季托，许益智，王宝祥，朱涛，吴澄冉，王立伟，张兵，
申请(专利权)人：中国电子科技集团公司第二十八研究所，
类型：发明
国别省市：