一种多无人机分布式队形控制的方法
【技术领域】
[0001] 本发明涉及无人机编队控制领域，具体涉及一种多无人机分布式队形控制的方 法。
【背景技术】
[0002] 无人机是一种拥有动力装置的无人驾驶飞行系统。它具有广泛的应用，既可以用 于航拍，交通巡逻等民用领域，也可以用于侦查、监控等军事领域。在一些危险复杂或者人 难以进入的环境中，需要进行搜索或者搜救活动，比如灾后紧急救援，雪地搜救现场等，一 般只能通过直升机来进行勘察任务，成本巨大且非常危险，无人机的作用就显得尤为突出。
[0003] 目前在灾后搜救、安防扫描等众多应用中，大都采用单个无人机进行地毯式搜索 的方法。然而，受限于单个无人机续航能力的不足，如果要进行大面积地毯式搜索，不仅容 易漏掉目标，而且效率还十分低下。不仅如此，如果在大面积环境中还有一些障碍物的话， 更是难以处理。
[0004] 因此，单个无人机很难满足大面积搜索或者搜救活动的需求，如果任务紧急，那情 况将更加严重。通过多个无人机编队，协作搜索来避免大面积应用场景中单个无人机不高 效的问题，可以使得整个搜索过程高效准确。
[0005] 目前无人机编队控制方法大都以集中式方法进行编队控制，集中式的控制方法往 往需要建立覆盖所有节点的星形通信网络。中国发明专利(CN 102591358 A)公开一种多无 人机的动态编队控制方法，属于飞行控制技术领域，包括步骤一:队形保持方法;步骤二:避 障方法;步骤三:基于行为的编队过程，其中基于行为的编队过程分别为行为分解与控制实 现。该专利引入了基于行为的编队控制方法，降低了对编队无线数据链更新率的要求，增强 了无人机群编队的避障能力；同时引入了虚拟结构作为参考。但是，现有技术中没有存在通 过及时调整队形的尺度，并且采用分布式控制进行编对的方法。
【发明内容】
[0006] 本发明的目的在于针对现有技术的不足，提供一种多无人机分布式队形控制的方 法，通过分布式控制无人机进行编队，同时可以调整队形的尺度避开障碍物。
[0007] 本发明为解决技术问题采取如下技术方案：
[0008] -种多无人机分布式队形控制的方法，包括如下步骤：
[0009] 1)在预设区域内部署η架无人机，η为η 2 3的整数;所述的无人机能够主动测量邻 居无人机的相对位置信息；
[0010] 2)对所述的η架无人机设定期望队形，所述的期望队形表示为：
[0011] ξ = [ξι,ξ2,···,ξη]τ,
[0012] 其中，ξ为期望队形的矩阵表示，ξ:为第1架无人机的位置，ξ2为第2架无人机的位 置，ξη为第η架无人机的位置，Τ为矩阵的转置；
[0013] 3)根据步骤2)中设定的期望队形，确定每架无人机在期望队形中与之测量和通信 的邻居无人机，得到期望队形中无人机的测量关系和通信关系；
[0014] 4)对第1架无人机和第2架无人机进行队形控制，所述的第1架无人机和第2架无人 机设定第一类速度控制器，通过主动测量对方的相对位置信息，进行速度控制使得彼此的 运动距离与期望队形设定的距离一致；
[0015] 5)对第3~η架无人机同时进行队形控制，所述的第3~η架无人机设定第二类速度 控制器，通过主动测量步骤3)中确定的期望队形中邻居无人机的相对位置信息，进行速度 控制使得彼此的队形动态的达到期望队形。
[0016] 上述技术方案不依赖于全局参考坐标系，利用无人机主动测量邻居无人机的相对 位置，从而实现无人机编队控制的方法。对第1架和第2架无人机设定第一类速度控制器，使 得两者保持设定的距离，其次，对第3~η架无人机设定第二类速度控制器，进行速度的控制 得到期望队形。同时，可以通过对第一类速度控制器设定的距离进行调整，达到对期望队形 的尺度的调整，避开障碍物。
[0017] 所述的预设区域为平面，所述的无人机在平面内运动的动态模型如下：
[0018] z7 i = vi, i = 1,2, ··· ,η；
[0019] 其中Vl为第i架无人机的速度向量，ζ、为第i架无人机的位置向量求导。
[0020] 作为优选，所述的步骤4)中第一类速度控制器为：
[0021]
[0022] 其中，Z1为第1架无人机在其惯性平面坐标系下的位置向量，以复数表示;Z2为第2 架无人机在其惯性平面坐标系下的位置向量，以复数表示；I Izrzsl |和| |Z2-Z1| |为第1架 无人机与第2架无人机之间的欧几里得距离;ri2为第1架无人机和第2架无人机之间的期望 距离;k为调节速度的比例系数;vo为队形稳定时，无人机的期望运动速度向量;为第1架 无人机相对于惯性坐标系的速度控制向量，zS为第2架无人机相对于惯性坐标系的速度向 量控制量。
[0023] 作为优选，所述的步骤5)中第二类速度控制器为：
[0024]
[0025]其中，Ni(g)和Ni(H)分别为苐i架尤人机在期望队形中具有测量关系的邻居无人机 集合和具有通讯关系的邻居无人机集合;Zl为第i架无人机在其惯性平面坐标系下的位置 向量，W为第j架无人机在其惯性平面坐标系下的位置向量;m为第i架无人机对第1架或者 第2架无人机的速度估计,?为第j架无人机对第1架或者第2架无人机的速度估计;ζ'i为第i 架无人机相对于惯性坐标系的速度向量控制量，的导数，cU为需要被设计的控制参 数，Wl沩合适的权重指数， &1沩任意正实数。
[0026]作为优选，所述的第一类速度控制器和第二类速度控制器分别简化如下：
[0027]
[0029] 式中，1表示第1架无人机或第2架无人机，f表示第3~η架无人机，12为所有元素为 1的列向量；[0030] 其中，Z1= [zl，Z2]T，Zf= [Ζ3,…，Ζη]τ;[0031 ] ni= [m，n2]T，nf= [η3,…，ηη]τ;
[0028]
[0032]
[0033] 式中，Ιη-2为η-2维的单位矩阵；
[0034] 其中L用复拉普拉斯表示，表示为：
[0035]
[0036] 式中，〇2X2为2X2的0矩阵，02χ(η-2)为2X (η-2)的0矩阵；
[0037] 其中D表示为：
[0038] D = diag(0,0，d3，···，dn)，Df = diag(d3，···，dn);其中dn为对角矩阵Df的最后一个元 素；
[0039]其中Η用拉普拉斯表示，表示为：
[0040]
[0041] 作为进一步优选，所述的第二类速度控制器需要满足以下条件：
[0042] l)L| = 0;2)rank(L) =n_2;3)det(Lff)关0;4)det(Hff)关0;5)DfLff的特征值在复 数右半平面;其中L为期望队形的复拉普拉斯表示，ξ为期望队形，rank(L)为矩阵L的秩，det (Lff)为矩阵Lff的行列式，det(Hff)为Hff的行列式，D fLff为两个矩阵相乘。
[0043]作为优选，所述的第一类速度控制器和第二类速度控制器控制的控制周期为0.05 ~0.15s。该控制周期范围，可以使得无人机及时调整期望速度，更快的达到期望队形。
[0044] 作为优选，所述的期望队形的尺度通过改变第一类速度控制器设定的距离进行调 整。通过调整期望队形的尺度，可以灵活的避开障碍物。
[0045] 同现有技术相比，本发明的有益效果体现在：
[0046] (1)本发明中的速度控制器具有很好的收敛性，保证系统是稳定的。
[0047] (2)对于每个无人机而言，仅仅只需要用到邻居无人机的相对位置信息就能实现 编队控制，从实现的角度考虑，相比于现有的编队控制算法，本发明需要更少的计算资源并 且所需控制量更容易获取。
[0048] (3)队形的尺度可以根据不同的环境进行变换，使得在进行目标搜索任务中，能更 加适应环境的变化。
【附图说明】
[0049] 图1本发明实施例中的期望队形图；
[0050] 图2本发明实施例中的通信图；
[00511图3本发明实施例中队形控制图；
[0052]图4是本发明实施例中期望队形的尺度缩小0.5倍的效果图。
【具体实施方式】
[0053]在水平高度为5米的水平面内，部署5架四旋翼无人机(基于开源飞控pixhawk的自 制四旋翼，型号：轴距550mm)。无人机的硬件系统主要分为底层飞控部分和上层上位机部 分。飞控部分控制无人机的飞行稳定，上层上位机负责具体的算法控制，并且将计算得到的 控制速度发送给底层飞控，从而实现无人机的自主飞行。
[0054]所述的无人机能够主动测量邻居无人机的相对位置信息，主要通过内置激光扫描 仪，能够主动测量邻居无人机和自身的相对位置信息，通过极坐标转换成算法所需的向量。
[0055] 所述的无人机在水平面内运动的动态模型如下：
[0056] z7 i = vi, i = 1,2, ··· ,η；
[0057] 其中Vl为第i架无人机的速度向量，ζ、为第i架无人机的位置向量求导。
[0058]对5架无人机设定期望队形，期望队形表示为：| = [-1，1，0，-11，-21]7，期望队形 图如图1所示，其中箭头表示为5架无人机之间的测量关系;通信图如图2,其中箭头表示为5 架无人机之间的通信关系。
[0059] 然后对第1架无人机和第2架无人机进行队形控制，所述的第1架