针对搜寻任务的无人机阵列实时路径生成方法技术

本发明专利技术属于路径生成领域，具体涉及了一种针对搜寻任务的无人机阵列实时路径生成方法，旨在解决现有的无人机技术由于环境适应性不足难以准确高效应用于搜寻任务的问题。本发明专利技术包括：预先基于卫星图像和深度图像构建原始环境模型，并存入环境数据库；选取定位基准点和设置基准安全区域，进而计算定位基准点的安全半径，构建代价函数；基于寻路起点、寻路终点和代价函数，生成无人机阵列的第一搜寻路径和多个备选第一搜寻路径；通过处于第一阵列边缘的无人机搜索未知威胁；判断第一阵列无人机是否会与未知威胁发生碰撞进而调整路径。本发明专利技术通过对静态、动态的未知威胁采取不同的控制手段，能够高效地应对多种情况的搜寻场景。能够高效地应对多种情况的搜寻场景。能够高效地应对多种情况的搜寻场景。

【技术实现步骤摘要】
针对搜寻任务的无人机阵列实时路径生成方法


[0001]本专利技术属于路径生成领域，具体涉及了一种针对搜寻任务的无人机阵列实时路径生成方法。

技术介绍

[0002]随着电子产业的飞速发展和社会的高度信息化，无人机在众多领域都有了广泛的应用。近些年来，地质灾害频发，每次事件均需要耗费大量的人力进行搜寻，损耗巨大，且由于人员收到身高限制导致视野受限，导致搜索效率不足。
[0003]现有技术中将无人机应用于搜寻任务，由于现场环境复杂且由于地质灾害引发的环境变化使得预先录入的环境模型与实际现场的环境存在出入，使得只能通过专业技术人员通过遥控操作的方式控制单个无人机进行搜寻。依照现有技术想要将无人机技术应用于搜寻、搜救任务存在两大难点。第一，通过人工遥控操作无人机进行搜寻一次只能操作一架无人机，一个人无法同时控制多架无人机进行范围搜索，导致搜寻效率难以提高；第二，现有的无人机路径生成技术通常需要基于精确的明确的环境模型才能够进行寻路，而在地质灾害发生后环境模型通常会与预先存储生成的环境模型产生较大区别，通过现有环境模型已经难以构建精确的搜救路径。

技术实现思路

[0004]为了解决现有技术中的上述问题，即现有的无人机技术由于环境适应性不足难以准确高效应用于搜寻任务的问题，本专利技术提供了一种针对搜寻任务的无人机阵列实时路径生成方法，所述方法包括：步骤S100，预先基于卫星图像和深度图像构建原始环境模型，并存入环境数据库；其中原始环境模型为包含了基础威胁源的空间栅格模型，根据栅格至威胁源的距离设置栅格威胁值；步骤S200，选取参与当前任务的无人机数量和第一阵列的形状，将参与当前任务的无人机设定为第一阵列，基于所述第一阵列选取一个定位基准点和设置基准安全区域，在原始环境模型中设置定位基准点的寻路起点和寻路终点，所述寻路终点为搜寻区域的起点；步骤S300，基于所述定位基准点和设置基准安全区域，计算定位基准点的安全半径r，基于安全半径r计算回避触发距离，表示定位基准点到基础威胁源的表面的距离；步骤S400，基于所述回避触发距离和栅格威胁值，以路径长度最短和威胁值最低原则构建代价函数；步骤S500，基于寻路起点、寻路终点和代价函数，生成无人机阵列的第一搜寻路径和多个备选第一搜寻路径，并根据每个无人机相对于定位基准点的偏移量获取每个无
人机的独立第一搜寻路径和独立备选第一搜寻路径；所述第一搜寻路径具体为先将无人机阵列抬升至安全平面，在安全平面上移动至寻路终点位置对应的位置后，降低到寻路终点位置；步骤S600，第一阵列的无人机依照第一搜寻路径执行飞行，并通过处于第一阵列边缘的无人机搜索未知威胁；步骤S700，判断第一阵列无人机是否会与未知威胁发生碰撞，如果会发生碰撞，则估计碰撞的威胁响应时间，根据威胁响应时间和未知威胁的动静状态选择重新规划第二搜寻路径或选取备选第一搜寻路径；若不会发生碰撞则第一阵列依照第一搜寻路径继续运行；步骤S800，若第一阵列依照第一搜寻路径运行的过程中未发现搜寻目标，第一阵列的无人机到达寻路终点后，按照设定的巡回搜寻方案将第一阵列的无人机分为多个第二阵列，每个第二阵列依照设定的区域搜寻路线完成分布式搜寻。
[0005]在一些优选的实施方式中，所述代价函数，具体为：； ；其中，表示第m条第一搜寻路径的路径代价，为第条第一搜寻路径的路径代价，表示对满足条件的变量求最小值，表示的第i条子路径的路径长度，表示包含的第类威胁代价，为回避触发距离表示无人机阵列边缘到威胁的距离，表示路径代价权重、表示第类威胁代价权重，表示无人机群路径满足的飞行条件集合；其中，路径代价权重和威胁代价权重满足：。
[0006]在一些优选的实施方式中，所述步骤S700，具体包括：步骤S710，判断所述未知威胁与第一搜寻路径是否存在重叠区域；若不存在重叠区域则判定为不会发生碰撞，第一阵列依照第一搜寻路径继续运行，回到步骤S600；若存在重叠区域则判定为会发生碰撞，进入步骤S720；步骤S720，分析第一阵列应对未知威胁的响应因子；所述响应因子包括响应时效因子、响应信号稳定因子、动静状态响应因子和响应复杂度因子；所述响应时效因子，具体为：基于第一阵列的第一搜寻路径、全局规划时长、第一阵列到达重叠区域的预估碰撞时间和第一搜寻路径中的剩余路径，确定响
应时效因子：当时，设置响应时效因子为0，当时，设置响应时效因子为1；所述响应信号稳定因子，具体为：确定发现位置威胁时刻的信号安全概率；基于重叠区域的位置和第一阵列的飞行速度，估计第一阵列到达重叠区域的预估碰撞时间进而确定预估碰撞时间的信号安全概率；根据所述发现位置威胁时刻的信号安全概率和预估碰撞时间的信号安全概率确定信号稳定因子：若设置响应信号稳定因子为0；若设置响应信号稳定因子为1；所述动静状态响应因子，具体为：判断未知威胁为运动物体还是静止物体，若未知威胁为静止物体则设置动静状态响应因子为0；若未知威胁为运动物体则设置动静状态响应因子为1；所述响应复杂度因子，具体为：若未知威胁为独立的单个威胁，设置响应复杂度因子为0；若未知威胁为多个联合的威胁，根据进一步将响应复杂度因子设置为1或2：步骤A01，判断第一阵列是否能够整体穿越所述多个联合的威胁：将两个相邻的重叠区域或重叠区域与基础威胁源记为威胁点对，若威胁点对之间的距离小于第一阵列的定位基准点的安全半径r的2倍，则判定第一阵列不能够整体穿越所述威胁点对，第一阵列不能够整体穿越的威胁点对设置为碰撞点对；若威胁点对之间的距离大于或等于第一阵列的定位基准点的安全半径r的2倍，则判定第一阵列能够整体穿越所述威胁点对；步骤A02，若碰撞点对的数量大于威胁点对的数量的一半，则设置响应复杂度因子为2；若碰撞点对的数量小于或等于威胁点对的数量的一半，则设置响应复杂度因子为1；若响应复杂度因子为2，将碰撞点对对应的未知威胁或未知威胁与基础威胁源拟合为组合威胁源，以组合威胁源的最小体积外接规则几何体替换原未知威胁；所述规则几何体包括球体、圆柱体、圆台、方体和三角体中的一种；步骤S730，根据所述响应时效因子和响应信号稳定因子设置局部路径决策标识符：若响应时效因子为0，响应信号稳定因子为0，则设置局部路径决策标识符为
‑
2；若响应时效因子为0，响应信号稳定因子为1，则设置局部路径决策标识符为0；若响应时效因子为1，响应信号稳定因子为0，则设置局部路径决策标识符为
‑
1；若响应时效因子为1，响应信号稳定因子为1，则设置局部路径决策标识符为1；步骤S740，基于所述响应因子和局部路径决策标识符，进行路径重规划，获取第二路径，具体包括：步骤S740A，动静状态响应因子为0时，执行第一模式进行第一阵列动态路径调整及威胁信息回传；所述第一模式，具体包括：基于未知威胁的体积、第一阵列的外接球区域和第一阵列的第一搜寻路径，将未知威胁分为局部威胁源或全局威胁源；
若未知威胁为局部威胁源，依据第一搜寻路径与所述重叠区域将第一阵列划分为2个以上的第一子阵列，将第一搜寻路径中存在重叠区域的第一子阵列设定为威胁区无人机子阵列，对威胁区无人机子阵列进本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种针对搜寻任务的无人机阵列实时路径生成方法，其特征在于，所述方法包括：步骤S100，预先基于卫星图像和深度图像构建原始环境模型，并存入环境数据库；其中原始环境模型为包含了基础威胁源的空间栅格模型，根据栅格至威胁源的距离设置栅格威胁值；步骤S200，选取参与当前任务的无人机数量和第一阵列的形状，将参与当前任务的无人机设定为第一阵列，基于所述第一阵列选取一个定位基准点和设置基准安全区域，在原始环境模型中设置定位基准点的寻路起点和寻路终点，所述寻路终点为搜寻区域的起点；步骤S300，基于所述定位基准点和设置基准安全区域，计算定位基准点的安全半径r，基于安全半径r计算回避触发距离 ，表示定位基准点到基础威胁源的表面的距离；步骤S400，基于所述回避触发距离和栅格威胁值，以路径长度最短和威胁值最低原则构建代价函数；步骤S500，基于寻路起点、寻路终点和代价函数，生成无人机阵列的第一搜寻路径和多个备选第一搜寻路径，并根据每个无人机相对于定位基准点的偏移量获取每个无人机的独立第一搜寻路径和独立备选第一搜寻路径；所述第一搜寻路径具体为先将无人机阵列抬升至安全平面，在安全平面上移动至寻路终点位置对应的位置后，降低到寻路终点位置；步骤S600，第一阵列的无人机依照第一搜寻路径执行飞行，并通过处于第一阵列边缘的无人机搜索未知威胁；步骤S700，判断第一阵列无人机是否会与未知威胁发生碰撞，如果会发生碰撞，则估计碰撞的威胁响应时间，根据威胁响应时间和未知威胁的动静状态选择重新规划第二搜寻路径或选取备选第一搜寻路径；若不会发生碰撞则第一阵列依照第一搜寻路径继续运行；步骤S800，若第一阵列依照第一搜寻路径运行的过程中未发现搜寻目标，第一阵列的无人机到达寻路终点后，按照设定的巡回搜寻方案将第一阵列的无人机分为多个第二阵列，每个第二阵列依照设定的区域搜寻路线完成分布式搜寻。2.根据权利要求1所述的针对搜寻任务的无人机阵列实时路径生成方法，其特征在于，所述代价函数，具体为：； ；其中，表示第m条第一搜寻路径的路径代价，为第条第一搜寻路径的路径代价，表示对满足条件的变量求最小值，表示的第i条子路径的路径长度，表示包含的第类威胁代价，为回避触发距离表示无人机阵列边缘到威胁的距离，表示路径代价权重、表示第类威胁代价权重，表示无人机群路径满足的飞行条件集合；
其中，路径代价权重和威胁代价权重满足：。3.根据权利要求2所述的针对搜寻任务的无人机阵列实时路径生成方法，其特征在于，所述步骤S700，具体包括：步骤S710，判断所述未知威胁与第一搜寻路径是否存在重叠区域；若不存在重叠区域则判定为不会发生碰撞，第一阵列依照第一搜寻路径继续运行，回到步骤S600；若存在重叠区域则判定为会发生碰撞，进入步骤S720；步骤S720，分析第一阵列应对未知威胁的响应因子；所述响应因子包括响应时效因子、响应信号稳定因子、动静状态响应因子和响应复杂度因子；所述响应时效因子，具体为：基于第一阵列的第一搜寻路径、全局规划时长、第一阵列到达重叠区域的预估碰撞时间和第一搜寻路径中的剩余路径，确定响应时效因子：当时，设置响应时效因子为0，当时，设置响应时效因子为1；所述响应信号稳定因子，具体为：确定发现位置威胁时刻的信号安全概率；基于重叠区域的位置和第一阵列的飞行速度，估计第一阵列到达重叠区域的预估碰撞时间进而确定预估碰撞时间的信号安全概率；根据所述发现位置威胁时刻的信号安全概率和预估碰撞时间的信号安全概率确定信号稳定因子：若设置响应信号稳定因子为0；若设置响应信号稳定因子为1；所述动静状态响应因子，具体为：判断未知威胁为运动物体还是静止物体，若未知威胁为静止物体则设置动静状态响应因子为0；若未知威胁为运动物体则设置动静状态响应因子为1；所述响应复杂度因子，具体为：若未知威胁为独立的单个威胁，设置响应复杂度因子为0；若未知威胁为多个联合的威胁，根据进一步将响应复杂度因子设置为1或2：步骤A01，判断第一阵列是否能够整体穿越所述多个联合的威胁：将两个相邻的重叠区域或重叠区域与基础威胁源记为威胁点对，若威胁点对之间的距离小于第一阵列的定位基准点的安全半径r的2倍，则判定第一阵列不能够整体穿越所述威胁点对，第一阵列不能够整体穿越的威胁点对设置为碰撞点对；若威胁点对之间的距离大于或等于第一阵列的定位基准点的安全半径r的2倍，则判定第一阵列能够整体穿越所述威胁点对；步骤A02，若碰撞点对的数量大于威胁点对的数量的一半，则设置响应复杂度因子为2；若碰撞点对的数量小于或等于威胁点对的数量的一半，则设置响应复杂度因子为1；若响应复杂度因子为2，将碰撞点对对应的未知威胁或未知威胁与基础威胁源拟合为
组合威胁源，以组合威胁源的最小体积外接规则几何体替换原未知威胁；所述规则几何体包括球体、圆柱体、圆台、方体和三角体中的一种；步骤S730，根据所述响应时效因子和响应信号稳定因子设置局部路径决策标识符：若响应时效因子为0，响应信号稳定因子为0，则设置局部路径决策标识符为
‑
2；若响应时效因子为0，响应信号稳定因子为1，则设置局部路径决策标识符为0；若响应时效因子为1，响应信号稳定因子为0，则设置局部路径决策标识符为
‑
1；若响应时效因子为1，响应信号稳定因子为1，则设置局部路径决策标识符为1；步骤S740，基于所述响应因子和局部路径决策标识符，进行路径重规划，获取第二路径，具体包括：步骤S740A，动静...

【专利技术属性】
技术研发人员：刘昀铮，张程，仇恒德，
申请(专利权)人：中国人民解放军战略支援部队航天工程大学，
类型：发明
国别省市：