CN110989690B - 一种基于诱导信息的多无人机寻路方法 - Google Patents

Abstract

本发明公开一种基于诱导信息的多无人机寻路方法，根据目标始末位置以及现有路径规划算法确定可行路径，计算通过路径的延时函数和等待函数；根据这两个函数计算并向无人机发送诱导信息；随后无人机根据诱导信息以及当前时刻各个路径的延时函数与等待函数，计算所有可行路径代价函数；无人机选择代价函数最小的路径作为其飞行路线。最后更新当前时刻所有路径的无人机数量值，完成当前无人机的路径选择。本发明可完成无人机能够在规定起始点的条件下实现自主飞行并进行路径选择；同时，优化无人机在路径选择时可能产生的自私路由问题，确保无人机群安全，高效地到达目的地点。

Description

一种基于诱导信息的多无人机寻路方法

技术领域

本发明属于无人机技术领域，涉及多无人机寻路自私路由问题的优化解决，具体来说，是一种基于诱导信息的多无人机寻路方法。

背景技术

随着无人机技术的发展与广泛应用，近年来，无人机已经在侦查、监控、灌溉、物流等领域发挥出了越来越重要的作用。除了单个无人机的应用前景被不断开发，无人机群也成为了未来的发展趋势。无人机通过群组内的相互配合，细化分工，能够胜任更加复杂的任务，扩大工作半径，提高执行效率。

然而，无人机群的应用也会引出一些相应问题。当无人集群中的无人机达到一定数目，无人机的路由问题就会突显。空中交通环境具有很高的复杂性，在具体的任务执行中，无人机往往要根据地理环境和飞行状态选择合适的飞行路径，而可行飞行路径的数目往往是有限的。当无人机数目较多时，若所有无人机都遵循自身到达时间最短的原则进行路径选择，就可能产生局部堵塞、碰撞、以及系统总体延时与个体延时无法同时达到最优等问题，这就是无人机系统中的自私路由问题。同时，由于无人机飞行的特殊性，出于安全性考虑，同一路径上的无人机数量不宜过多，且相邻两架无人机需保持一定安全航行距离，在等待过程中产生的燃油消耗等成本也应该被考虑在内。

无人机交通诱导系统，就是通过电子、计算机、网络等技术，根据无人机的始末点和当前航线信息，对无人机路径的选择提供指引，使无人机在指引下根据自私策略选择路径。通过对无人机的诱导，以达到减小系统整体延时，优化自私路由问题的目的。

现阶段的无人机诱导系统研究，多以集中式控制为主，通过集群调控将无人机规划至目标位置。这种方法在场景简单、无人机数量少时可以起到较好的效果。然而当无人机数量增加，集中式规划难度将大幅上升，而现有的无人机诱导系统忽略了高飞行密度条件下可能产生的无人机自私路由问题，导致了群体飞行效率降低，飞行时间增加，空间资源浪费等问题的发生。

发明内容

针对上述问题，本发明提出一种基于诱导信息的多无人机寻路方法，实现无人机能够在规定起始点的条件下实现自主飞行并进行路径选择；同时，优化无人机在路径选择时可能产生的自私路由问题，确保无人机群安全，高效地到达目的地点。

本发明基于诱导信息的多无人机寻路方法，包括以下步骤：

步骤一、组装无人机并进行调试。

步骤二、根据目标始末位置以及现有路径规划算法确定m条可行路径，计算通过路径的延时函数和等待函数。

步骤三、计算并向无人机发送诱导信息。

对步骤二中得到的延时函数与等待函数进行加和计算，预估无人机将选择的策略，计算该策略下场景中所有无人机产生的总体代价函数S；遍历当前时间无人机所有可能选择策略并取最小值S_min；若S＝S_min，系统产生数组a₁＝a₂＝……＝a_m＝1以及b₁＝b₂＝……＝b_m＝1作为无人机选择第m条路径的诱导信息并发送至无人机端；若S>S_min,系统产生数组a₁,a₂,……,a_m以及b₁,b₂,……,b_m作为诱导信息并发送至无人机端；其中a₁,a₂,……,a_m以及b₁,b₂,……,b_m的取值使当前无人机选择得到S_min的策略。

步骤四、无人机根据诱导信息以及当前时刻各个路径的延时函数与等待函数，计算所有可行路径代价函数。

步骤五、无人机在完成计算所有路径的代价函数情况下，对所有可行路径的代价函数进行比较，根据自私策略，将选择代价函数最小的路径作为自己的飞行路线。

步骤六、更新当前时刻所有路径的n值。

步骤七、返回步骤二对群体中下一架无人机进行路径选择，直至群体中所有无人机选择路径结束。

本发明的优点在于：

1、本发明基于诱导信息的多无人机寻路方法，通过诱导信息的引入，使无人机在进行路径选择时符合总体利益最大化原则。

2、本发明基于诱导信息的多无人机寻路方法，优化了总体通行时间，减少了燃油消耗，并有利于降低有限航路的交通拥堵问题。

3、本发明基于诱导信息的多无人机寻路方法，利用了无人机追求自身代价函数最小的自私特征，可以将本方法进行拓展并应用于各种关于自私个体的路径选择问题上，优化自私路由带来的资源浪费等问题。

附图说明

图1是本发明基于诱导信息的多无人机寻路方法流程图；

图2是本发明实施例中无人机寻路问题示意图。

具体实施方式

下面结合附图对本发明作进一步详细说明。

本发明基于诱导信息的多无人机寻路方法，如图1、图2所示，具体步骤如下：

步骤一、无人机的设备安装与准备。

将四旋翼无人机包括无人机机身主体，具有动力和防护装，与微型计算机、激光测距仪、风速测量仪等自主飞行所需装置组装完成，并调试飞行。微型计算机用于计算可行路径，制定无人机飞行策略，控制无人机飞行。激光测距仪用于检测无人机与障碍物的距离。风速测量仪用于检测环境风速，保证飞行安全稳定。

步骤二、根据目标始末位置以及现有路径规划算法确定m条可行路径，计算通过路径的延时函数和等待函数并上传至中央处理器。

根据实际飞行环境建立飞行环境模型。确定起始点和终止点位置，根据现有的路径规划算法确定m条可行路径：p₁……p_m，并根据路径的长度、宽窄、易通行程度等信息确定每条路径的延时函数：D₁……D_m。延时函数表示无人机从当前时刻开始，在当前实时交通条件，环境条件下通过该路径所需要的时间。每条路径的延时函数D应包括以下参量：

(1)路径总长度L；

(2)当前时刻该路径内无人机数量n；

(3)描述当前时刻天气、风力等环境因素变量e(t)；

即，无人机i在时间t选择路径j的延时函数为：

根据当前时刻系统路径无人机状态，计算每条路径的等待时间函数W。等待时间函数为无人机选择该路径后，从当前时刻开始到可以进行飞行需要等待的时间。出于安全性考虑，在同一路径上，只有前架次无人机起飞一定时长后，后架次无人机才能安全起飞，而等待的过程也会消耗时间和燃油。等待时间函数W应包含以下变量：

(1)距离前架次无人机起飞的时间间隔T；

无人机只有在起飞前计算T的值。对每一条路径j，无人机都会进行T_j的计算和更新。如果该路径有前序无人机，则正常计算前序无人机起飞时间与此时刻的时间间隔；如果这条路径没有前序无人机，那么将T考虑为正无穷即可。

(2)当前型号无人机的最小飞行安全距离d_min；

即,无人机i在时间t选择路径j的等待函数为：

无人机将延时函数与等待函数信息发送给中央处理器。

步骤三、中央处理器计算并向无人机发送诱导信息

中央处理器接收到无人机的延时函数与等待函数信息并进行加和计算。根据无人机自私路由的特点，预估无人机将选择的策略，计算该策略下场景中所有无人机产生的总体代价函数S。遍历当前时间无人机所有可能选择策略并取最小值S_min。若S＝S_min，系统产生数组a₁＝a₂＝……＝a_m＝1以及b₁＝b₂＝……＝b_m＝1作为无人机选择第m条路径的诱导信息并发送至无人机端；若S>S_min,系统产生数组a₁,a₂,……,a_m以及b₁,b₂,……,b_m作为诱导信息并发送至无人机端，其中a₁,a₂,……,a_m以及b₁,b₂,……,b_m的取值使当前无人机选择得到S_min的策略。

步骤四、无人机根据诱导信息以及当前时刻各个路径的延时函数与等待函数，计算所有可行路径代价函数。

无人机接收诱导信息，并对所有可行路径计算代价函数：

至此，无人机已经在诱导信息的影响下完成了对所有路径的代价函数计算。

步骤五、无人机在完成计算所有m条路径的代价函数情况下，对所有可行路径的代价函数进行比较，根据自私策略，将选择代价函数最小的路径作为自己的飞行路线。

步骤六、更新当前时刻所有路径的n值。

无人机选择路径后，将选择结果上传至中央处理器，由中央处理器更新当前时刻所有路径的无人机数目n。

步骤七、返回步骤二对群体中下一架无人机进行路径选择，直至群体中所有无人机选择路径结束。

Claims (1)

1.一种基于诱导信息的多无人机寻路方法，其特征在于：具体步骤如下：

步骤一、组装无人机并进行调试；

步骤二、根据目标始末位置以及现有路径规划算法确定m条可行路径，计算通过路径的延时函数和等待函数；

步骤三、计算并向无人机发送诱导信息；

对步骤二中得到的延时函数与等待函数进行加权求和计算，预估无人机将选择的策略，计算该策略下场景中所有无人机产生的总体代价函数S；遍历当前时间无人机所有可能选择策略并取最小值S_min；若S＝S_min，系统产生数组a₁＝a₂＝……＝a_m＝1以及b₁＝b₂＝……＝b_m＝1作为无人机选择第m条路径的诱导信息并发送至无人机端；若S>S_min,系统产生数组a₁,a₂,……,a_m以及b₁,b₂,……,b_m作为诱导信息并发送至无人机端；其中a₁,a₂,……,a_m以及b₁,b₂,……,b_m的取值使当前无人机选择得到S_min的策略；

步骤四、无人机根据诱导信息以及当前时刻各个路径的延时函数与等待函数，计算所有可行路径代价函数；

无人机接收诱导信息，并对所有可行路径计算代价函数：

无人机i在时间t选择路径j的延时函数为：

其中，L为路径总长度；n为当前时刻路径内无人机数量；e(t)为当前时刻的环境因素变量；

无人机i在时间t选择路径j的等待函数为：

其中，T为当前无人机距离前架次无人机起飞的时间间隔；d_min为当前无人机的最小飞行安全距离；

至此，无人机已经在诱导信息的影响下完成了对所有路径的代价函数计算；

步骤五、无人机在完成计算所有路径的代价函数情况下，对所有可行路径的代价函数进行比较，根据自私策略，将选择代价函数最小的路径作为自己的飞行路线；

步骤六、更新当前时刻所有路径的n值；

无人机选择路径后，将选择结果上传至中央处理器，由中央处理器更新当前时刻所有路径的无人机数目n；

步骤七、返回步骤二对群体中下一架无人机进行路径选择，直至群体中所有无人机选择路径结束。

Images