基于几何分布的无人机分级编队方法与流程

本发明属于无人机领域，特别涉及一种无人机编队控制技术。

背景技术：

无人驾驶飞机，简称为无人机，与传统的有人驾驶飞机不同，无人机具有体积小、灵活性高、无人员伤亡等优势。近年来无人机在军用和民用领域得到了广泛的应用，吸引了越来越多的研究人员和机构。但是单个无人机的性能有限，其任务执行能力也会受到相应程度的影响。如在军事领域，单架无人机在作战半径、杀伤能力等方面受限，会降低作战任务的成功率。此外，如果单架无人机在执行任务途中发生故障，需要立刻中断任务返航，则可能对整个任务的执行造成严重影响。

无人机集群编队飞行作为近年来研究的一个前沿领域，可充分利用无人机性能，执行更为复杂的任务。无人机集群编队飞行是指将多架具有自主功能的无人机按照一定的结构进行三维空间排列，使其在飞行过程中保持稳定的队形，并能根据外部情况和任务需求进行动态调整，以体现整个机群的协同一致性。

无人机集群编队执行任务的能力由无人机集群的密度和规模所决定，随着集群规模和密度的增长，如何提高集群编队控制的精度，避免飞行路径冲突、发生碰撞事故，成为无人机集群编队控制研究的关键问题。

技术实现要素：

为解决上述技术问题，本发明提出一种基于几何分布的无人机分级编队方法，通过子集群内采用能量最优的编队控制结合子集群间采用基于预测的体密度几何编队控制，达到无人机集群编队飞行过程中队形保持的目的。

为达到上述目的，本发明采用以下技术方案实现。

本发明的技术方案为：基于几何分布的无人机分级编队方法，包括三个模块：

1、建立无人机集群分层分级编队组网架构

将无人机集群分为若干个子集群，每个子集群由一架引领机(可有备份引领机)和多架成员机组成。无人机分层分级组网架构由两个层级组成，分别是引领机组成的引领层和由各子集群的成员机组成的子群层。在引领层，各引领机通过远距离低速链路构成网状拓扑。在子群层，各子集群的引领机通过近距离高速链路和本子集群的成员机构成星型拓扑。

子集群内部各成员机通过近距离高速链路和引领机进行通信，成员机通过基于能量最优的编队控制方法来调整自身飞行航向、速度等参数。子集群之间的通信由处于引领层的各引领机通过远距离低速链路进行通信来完成，引领机间通过基于密度的几何编队控制方法来调整自身飞行的加速度，间接完成了对引领机所属子集群的整体航向、速度参数的调整。

2、能量最优的编队控制算法

A1、建立子集群中成员机的受力模型；

A2、根据步骤A1的受力模型建立子集群中成员机的动力学模型；

A3、根据步骤A2建立的动力学模型,将编队控制问题转化为系统的总能量问题；按照最优的编队位置对应着系统总能量最低的状态进行子集群内部编队控制。

3、密度的几何编队控制算法

B1、预测子集群在Δt时间后所处的空间坐标；

其中，Δt表示邻居引领机发出其空间坐标到当前引领机接收到该坐标信息存在的时延；

B2、基于Voronoi图估算子集群所占空域的三维体积；

B3、根据步骤B2得到的子集群所占空域三维体积估算子集群的无人机体密度；

B4、建立引领机二阶运动学模型；

B5、计算当前引领机的加速度；步骤B5具体为：

B51、初始化，包括部引领机空间坐标集合、局部子集群无人机体密度集合、集群无人机期望体密度以及子集群期望半径；

B52、若当前引领机所属子集群的体密度等于集群无人机期望体密度，则结束；否则执行步骤B53；

B53、遍历当前引领机的邻居引领机空间坐标集合，若当前引领机与邻居引领机的距离不等于2倍子集群期望半径，则根据当前引领机与邻居引领机的距离、子集群期望半径的梯度以及最大通信半径，计算该次遍历的邻居引领机对当前引领机影响的加速度分量；否则此次遍历的加速度分量为0；

对每次遍历得到的加速度分量求和，得到当前引领机的总加速度矢量。

B6、根据步骤B5得到的当前引领机的加速度，结合B4建立的引领机二阶运动学模型；对当前引领机飞行状态进行调整。

综上，本发明的基于几何分布的无人机分级编队方法流程为：

S1、将无人机集群横向划分为若干子集群，纵向划分为引领层和子群层；所述引领层由横向划分得到的若干子集群的引领机组成；所述子群层由横向划分得到的若干子集群的成员及组成；

所述引领层中各引领机通过远距离低速链路构成网状拓扑通信；所述子群层中各子集群的引领机通过近距离高速链路和本子集群的成员机构成星型拓扑通信。

S2、在子集群内部采用能量最优的编队控制；

S3、在子集群之间采用密度的几何编队控制。

本发明的有益效果：本发明的基于几何分布的无人机分级编队方法，具有以下有益效果：

1、提高了控制的灵活性，允许由一个或多功能控制者协同控制；

2、分层分级的编队组网架构可以有效降低通信负载与通信时延；

3、子集群内部基于能量最优的编队控制可以有效避免无人机碰撞；

4、子集群间基于密度的几何编队控制可以有效提升大规模无人机集群下编队的精准度和鲁棒性。

附图说明

图1为本发明的无人机分层分级编队组网架构图；

图2为Delaunay三角剖分及Voronoi图生成过程图；

图3为基于能量最优的子集群内无人机编队控制算法流程图；

图4为基于密度的子集群间无人机编队控制算法流程图。

具体实施方式

以下将结合附图对本发明各实施例的技术方案进行清楚、完整的描述，显然，所描述实施例仅仅是本发明的一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其它实施例，都属于本发明所保护的范围。

本发明针对现有的无人机随着集群规模和密度的增长，集群编队控制的精度哪一控制的问题，提出了一种基于几何分布的无人机分级编队方法，由三个模块组成；分别是建立集群编队组网架构方法、子集群内编队控制方法和子集群间编队控制方法。因为三维空间中的实施方法将很容易由二维空间中的实施方法导出，为了更简洁明了地叙述本发明地实施方案，通过将三维空间中地无人机集群映射到二维空间中，在二维空间中对本发明地具体实施方案做更进一步的说明。具体如下：

(1)建立无人机集群分层分级编队组网架构

本发明是一种基于几何分布的无人机分级编队方法，因此必须首先建立无人机编队的分层分级组网架构，具体的组网架构如图1所示。

本发明将无人机集群分为若干个子集群，每个子集群由一架引领机(可有备份引领机)和多架成员机组成。无人机分层分级组网架构由两个层级组成，分别是引领机组成的引领层和由各子集群的成员机组成的子群层。在引领层，各引领机通过远距离低速链路构成网状拓扑。在子群层，各子集群的引领机通过近距离高速链路和本子集群的成员机构成星型拓扑。本发明中划分集群采用均分的方式，在实际应用中也可以根据具体需要对集群进行划分。

子集群内部各成员机通过近距离高速链路和引领机进行通信，成员机通过基于能量最优的编队控制方法来调整自身飞行航向、速度等参数。子集群之间的通信由处于引领层的各引领机通过远距离低速链路进行通信来完成，引领机间通过基于密度的几何编队控制方法来调整自身飞行的加速度，间接完成了对引领机所属子集群的整体航向、速度参数的调整。

(2)子集群内基于能量最优的编队控制方法，具体流程图如图3所示。

A1：建立子集群中成员机的受力模型

公式(1)表示成员机i受引领机∝的吸引势，用来将子集群内的成员机聚集起来，C∝是常数，xi∝是成员机i到引领机∝的距离，l∝是引领机∝吸引力的作用范围。

公式(2)表示成员机i受子集群内其它无人机β的排斥势，用来避免无人机间的碰撞，Cr是常数，是成员机i与β的距离，lr是排斥力的作用范围。

公式(3)表示成员机i方向上受引领机∝的影响，用来保持和引领机间飞行状态的一致性，C0是常数，是成员机i与∝的距离，lo是方向上该影响的作用范围，其中代表单位矢量。

排斥力和吸引力的作用约束范围关系为lo＜l∝，即的作用范围较大，的作用范围较小，排斥力作用范围在邻居之间，吸引力和方向上的作用范围在整个子集群范围内。

A2：建立子集群中成员机的动力学模型

公式(4)中，xi是成员机i的位置矢量，其微分是成员机i的速度矢量vi。

公式(5)表示成员机i的飞行运动学方程，其中是成员机i的速度矢量随时间的微分，其中子集群内的成员机会受到引领机的吸引势的影响、本集群内其它无人机的排斥势的影响以及相邻无人机在飞行方向上的影响Λi。

A3：子集群内部基于能量最优的编队控制方法

通过步骤A2建立子集群内成员机动力学模型后，编队的控制问题即可以转化为系统的总能量问题。最优的编队位置对应着系统总能量最低的状态。

E＝(T+U) (6)

公式(6)为子系统总能量，子集群系统的总能量E由每个成员机的动能和以及每对无人机间的势能和(由排斥势能和吸引势能组成)。

通过d/dt(T+U)＝-∑ivi·Λi可知当∑ivi·Λi＝0时无人机子集群的能量将会降低到一个最低的状态。即时，子系统总能量最小。因此在子集群内部，当每一架成员机i与以l0为半径的范围内的无人机β满足时(即diβ＜l0)，子集群内的无人机会处于具有一个固定距离和速度的相对稳定状态。

因此，根据公式(5)可得成员机的加速度通过向成员机的自动驾驶仪输入ai，来控制成员机的运动速度和航向，以调节子集群内无人机位置状态，使其最终处于一个具有固定距离和速度的相对稳定状态。

(3)子集群间基于密度的几何编队控制方法

B1：预测子集群在Δt时间后所处的空间坐标

假设子集群内无人机均匀分布，并且子集群的空间坐标可以由引领机的空间坐标代表，引领机j可通过机载GPS设备确定其二维空间坐标(x′j,y′j)，引领机j与通信范围D内引领机通过远距离低速链路交换空间坐标后，即可获得局部通信范围内所有引领机的空间坐标(x′m,y′m),m∈djm＜D，其中djm为引领机j与m间的距离，m∈djm＜D表示引领机m是属于通信范围djm内的引领机。

由于通信延迟等因素的影响，邻居引领机m发出其空间坐标到当前引领机j接收到该坐标信息会存在Δt的时延，导致当前引领机j所收到的邻居引领机m的空间坐标存在一定偏差，因此需要借助邻居引领机的瞬时速度v′来预测Δt时延后邻居引领机的位置坐标。

借助公式(7)可以预测得到Δt时延后当前引领机j的位置坐标(xj,yj)以及邻居无人机的空间坐标(xm,ym)。

B2：基于Voronoi图估算子集群所占空域面积

由B1预测得到了Δt后的引领机空间坐标，那么子集群所占的空域面积可以通过下述方法得到。

基于局部引领机的空间坐标进行Delaunay三角剖分，引领机的空间坐标如图2(a)所示，Delaunay三角剖分如图2(b)所示。Delaunay三角形的外心正是Voronoi图的顶点，由此得到如图2(c)所示的Voronoi图。若引领机j与引领机m所属的Voronoi小元胞具有公共边，则称引领机j与引领机m互为邻居。

无论引领机j所属子集群所形成图2(c)中的Voronoi小元胞是否封闭，其所属子集群所占的空域面积均可通过公式(8)估算出，其中是引领机j到Voronoi小元胞每条边的距离rk的加权平均值，wk是距离rk的权重值，如图2(d)中的r1与r2。

B3：估算子集群的无人机密度

引领机j所属子集群的无人机密度可以由公式(9)估算。

ρj＝Nj/Sj (9)

其中，Nj是引领机j所属子集群的无人机总数量，由引领机通过和子集群内成员机通信交互得到。Sj是引领机j所属子集群所占空域的面积，由步骤1基于Voronoi图的方法估算。

B4：建立引领机的二阶运动学模型

在本模型中，忽略引领机的物理尺寸，假设引领机为质点模型，并由基于二阶运动学的自动驾驶仪控制。自动驾驶仪通过接收加速度作为输入参数，自动调整飞行状态。

公式(10)是简化的引领机二阶运动学模型。(xj,yj)是引领机j在平面坐标系中的位置坐标，vj是引领机j的速度，aj是引领机j的加速度，是引领机j航向角(即当前运动方向和正北的夹角)。公式(11)是引领机的运动学约束条件。引领机j的速度vj和加速度aj均有上下界约束。

B5：基于密度控制的引领机加速度方程

引领机j的加速度大小由当前引领机与邻居引领机的距离和子集群期望半径的梯度决定，若则加速度的方向由其邻居引领机m指向引领机j，否则若则加速度的方向由引领机j指向其邻居引领机m。

邻居引领机m对引领机j影响的加速度分量如公式(12)所示，其中是子集群的期望半径由预设的集群无人机期望密度通过公式(8-9)得到，djm是引领机j和m之间的距离，kj、lj为常量，是位移的单位矢量，用来表示加速度的方向。

本发明中，当前引领机通过利用空间坐标、速度、子集群密度等信息，自主进行编队控制决策，本发明方法输出加速度至自动驾驶仪完成飞行控制过程。

本发明设定当前引领机j的空间坐标为(xj,yj)，速度为vj，航向角为输出的加速度为aj。所属当前引领机j所属子集群密度为ρj，邻居子集群引领机空间坐标集合为C(x,y)，集群期望密度子集群的期望半径是

加速度的计算流程图见图4，具体步骤如下：

B51：初始化算法环境，包括输入引领机j的坐标(xj,yj)，所属子集群无人机密度ρj，邻居引领机坐标集合C(x,y)，子集群的期望半径是集群期望密度以及初始化输出参数引领机j的加速度aj＝0。

B52：若则结束算法，否则转至B53；

B53：遍历集合C,对(xm,ym)∈C依次执行以下操作后转至步骤B54

B531、计算djm，若则转至B532，否则返回B53继续遍历

B532、计算加速度分量

B54：计算总加速度

B55、若aj≠0，则输出参数aj并转至步骤B52；

否则执行以下操作：

B551、添加扰动因子后的加速度

B552、输出参数aj并转至步骤B52。

本领域的普通技术人员将会意识到，这里所述的实施例是为了帮助读者理解本发明的原理，应被理解为本发明的保护范围并不局限于这样的特别陈述和实施例。对于本领域的技术人员来说，本发明可以有各种更改和变化。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的权利要求范围之内。