[发明专利]通信延迟下多无人机协同实时航路规划方法

说明书

技术领域

本发明涉及多无人机从不同地点起飞，避开障碍区域飞到同一目标点的实时航路规划方法，有关领域包括路径规划、协同控制和通信技术。

背景技术

多无人机协同航路规划是多无人机协同规划中最基本的任务，它是多无人机协同执行其他任务如协同搜索、协同跟踪等任务的基础，可以应用于灾害中的人员搜索、定位以及事故地点的勘察、探测等，国内外的研究十分广泛。郗永军和周德云在论文《多无人机协同攻击路径规划研究》中提出了一种基于改进A*算法的多无人机协同航路规划算法。首先，构建了多无人机最优协同攻击路径规划系统框架；其次，以人工智能A*算法为基础，结合无人机运动学方程对A*算法进行了改进，得到一种基于步长搜索的无人机路径快速生成算法；再次，基于改进的路径快速生成算法，以多无人机同时攻击目标为约束条件，进行变步长的协同攻击仿真计算，从而得到多无人机协同攻击同一目标的规划路径。

该算法没有考虑通信约束对航路规划算法的影响，而保证通信是多无人机协同的基本要素。多无人机在飞行过程中如果相距太远，就有可能脱离无人机通信平台的通信范围，导致无人机间无法进行通信，也就无法进行消息传递和数据交换。另外通信会有时间延迟，一架无人机发送的数据会在一定时间后才会被另一架无人机接收，这在协同航路规划中也需要考虑。

通信约束是指多无人机协同航路规划中需要考虑的通信系统和通信设备自身存在的约束和限制，比如通信距离限制和通信时间延迟。

发明内容

为了克服现有技术的不足，本发明提供一种通信延迟下多无人机协同实时航路规划方法，规划出通信延迟情况下多无人机协同飞行到达同一目标点的实时航路，多无人机在沿着规划出的航路飞行时能够保持通信，并能满足同时到达约束和避撞约束。

本发明解决其技术问题所采用的技术方案包括以下步骤：

假设本方法执行的时间步长为Δt，初始时间步长为Δt₀，参与航路规划的无人机类型相同，无人机均飞行在相同高度，无人机的速度变化范围为v∈(v_min，v_max)，无人机间的最小安全距离为d_min，最大通信限制距离为d_max，执行通信延迟后，无人机间最小距离为d′_min，最大距离为d′_max。

步骤1：设置无人机数据、障碍数据和目标点数据，生成数字地图，以供A*算法调用。

无人机数据包括：无人机数量n，无人机初始位置坐标(x_i，y_i)(i＝1，2，…，n)；障碍数据包括：障碍数量m，障碍圆中心坐标(x_j，y_j)，半径r_j(j=1，2，…，m)；目标点数据包括：目标点位置坐标(x，y)。

步骤2：执行同时到达约束，得到各无人机的飞行速度v_i，v_i∈(v_min，v_max)，包括以下步骤：

1)使用A*算法规划出各无人机在时间步长Δt下到目标点的最短路径；

2)计算v∈(v_min，v_max)，每条路径对应的飞行时间集S_ti(i＝1，2，…，n)；

3)判断S_t1，S_t2，S_t3，…是否有交集，若没有交集，进入步骤4），若有交集，进入步骤5）；

4)改变时间步长，在Δt基础上增加Δt₀，转到步骤1)；

5)取S_t1，S_t2，S_t3，…交集中使得J最小的t作为协同变量，t是无人机从初始点到目标点的飞行时间；

其中为多无人机协同的代价函数，J_i是第i架无人机的飞行路径代价，x_i是它的飞行路径，v_i是它的飞行速度。

6)取协同变量t对应的v为每架无人机的飞行速度。

步骤3：执行通信延迟约束，得到无人机间距范围。

对于相邻两无人机，

d′_min=d_min+(v₁+v₂)t_d