无人机系统中无人机的编队和避障控制方法技术方案

本发明专利技术公开了一种无人机系统中无人机的编队和避障控制方法，属于无人机控制技术，其包括S1对所有无人机进行编队，S2根据无人机t时刻采集的信号，判断无人机设定范围内是否存在障碍物，若存在，则进入步骤S3，否则进入步骤S5；S3、根据无人机t时刻的速度和位置，计算无人机的避障控制器的输出；S4根据无人机t时刻的输出、速度和位置，计算无人机t+1时刻的速度和位置，并在t+1时刻调整无人机后，令t＝t+1并进入步骤S2；S5根据无人机系统是否避障及是否到达目的，进行编队、避障及结束方法的调整。本方案提供的控制方法可以解决无人机保持编队航行时避障差及避障后不能重组的问题。

Formation and obstacle avoidance control method of UAV in UAV system

【技术实现步骤摘要】
无人机系统中无人机的编队和避障控制方法
本专利技术涉及无人机控制
，具体涉及一种无人机系统中无人机的编队和避障控制方法。
技术介绍
无人机在实际应用中获得越来越广泛的关注，比如灾难援助，农业，电力传输等等。这些任务往往需要多架无人机来协同，通过信息交互和传输，更加高效地完成任务。研究表明，多架无人机保持有序的编队能够节约能源消耗，同时使它们之间的通信链路更加稳定。对此，实际应用场景中常常要求无人机保持有序的编队飞向目的地，但是无人机在保持编队飞行中不可避免地会遇到障碍物。因此，研究如何躲避袭击或越过障碍的算法具有重要意义。许多现有的避障策略研究都针对设定的特殊场景，例如固定的障碍物和已知的威胁集，这使得算法不够灵活，处理紧急情况的能力也不强。尽管在某些情况下一些分割编队的算法可以越过障碍，但不能保证分割编队后的无人机再聚合。
技术实现思路
针对现有技术中的上述不足，本专利技术提供的无人机系统中无人机的编队和避障控制方法解决了无人机保持编队航行时避障差及避障后不能重组的问题。为了达到上述专利技术目的，本专利技术采用的技术方案为：提供一种无人机系统中无人机的编队和避障控制方法，其包括：S1、无人机系统中的无人机i利用其编队控制器，根据其位置和速度及其邻居无人机的位置和速度迭代更新其下一时刻的位置和速度进行编队，编队完成后进入步骤S2；S2、根据无人机i在t时刻采集的信号，判断无人机i设定范围内是否存在障碍物，若存在，则进入步骤S3，否则进入步骤S5；>S3、根据无人机i在t时刻的速度和位置，计算无人机i的避障控制器的输出ui'(t)：其中，a为无人机i远离障碍物的加速度，为无人机i的归一化速度；D为无人机i与障碍物之间的距离；c为障碍物与无人机之间的安全范围；wij(t)为t时刻无人机i、j的链路连通系数，链路连通时，wij(t)＝1，否则，wij(t)＝0；vi(t)为无人机i在t时刻的速度；φa、φp、φn分别为速度、方向和噪声项的控制参数，φa+φp+φn＝1；为无人机j的归一化速度；θij为以无人机i为中心建立的坐标系中，投影边缘的角度；ei(t)为无人机i的噪声项；d为无人机之间的距离；c0为无人机之间的安全范围；a0为远离距离满足d<c0的无人机的加速度；ai1、ai2、ai3为避障加速度；S4、根据无人机i在t时刻的输出ui'(t)、速度和位置，计算无人机i在t+1时刻的速度和位置，并在t+1时刻调整无人机i后，令t＝t+1并进入步骤S2；S5、判断无人机i是否进行了避障及是否达到目的地：若存在无人机i进行避障，且未到达目的地，则更新时间t，并返回步骤S1；若无人机i没有进行避障，且未到达目的地，则令t＝t+1后返回步骤S2；若无人机i达到目的地，则结束控制方法。本专利技术的有益效果为：本方案的无人机在设定范围内存在障碍物时，可以通过调整避障控制器的输出对无人机的位置和速度进行调整，以实现自主灵活地避开动态障碍物，而在无人机避障完成后又能再次形成有序编队，提高了系统处理突发事件的能力，从而提升无人机系统的任务完成率；无人机避障前后持续保持有序状态航行至目的地，可以节约能源。另外，本方案提供的两种调整无人机编队输出的方式，能够在信号不稳定时通过wij(t)不同时刻的值，保证无人机编队控制器在信号不好时仍能正常的输出，进而保证无人机在编队过程位置和速度的迭代更新，使得本方案的编队方法同时适用于固定和切换网络拓扑结构。附图说明图1为无人机系统中无人机的编队和避障控制方法的流程图。图2为投影检测示意图。图3为无人机队列采用本方案的方法保持V型编队的航行图。图4为无人机航行过程中躲避动态障碍物的示例图。具体实施方式下面对本专利技术的具体实施方式进行描述，以便于本
的技术人员理解本专利技术，但应该清楚，本专利技术不限于具体实施方式的范围，对本
的普通技术人员来讲，只要各种变化在所附的权利要求限定和确定的本专利技术的精神和范围内，这些变化是显而易见的，一切利用本专利技术构思的专利技术创造均在保护之列。本方案用于编队的所有无人机构成一个网络拓扑图，每一架无人机上均具有编队控制器和避障控制器，具体而言编队控制器和避障控制器可以为无人机的控制器中的一个模型，每一无人机i的编队信息设计为fi＝[fix,fiv]T，其中fix、fiv分别代表设定的编队位置和编队速度，在进行编队前，每架无人机的编队信息及其邻居无人机都会进行预先设定。无人机系统总的编队队形表示为F＝(f1,f2,...,fN)，在设计时，一般让fiv＝0，这并不意味着编队的速度为零或编队是静态的，而是编队速度用航行的速度，即中心轨迹的速度来考虑。所有无人机构成的网络拓扑图G＝{V,E,W}描述了无人机之间的通信，其中V＝{1,2,...,N}是节点集，每一节点代表一架无人机，N代表系统/网络拓扑中无人机的数目。E＝{(j,i)|i,j∈V}是链路集，链路(j,i)代表从无人机j到无人机i的通信信道；无人机i到无人机j的路径指一系列连通的链路(i,i1),(i1,i2),...,(in,j)。W＝[wij]∈RN×N就是网络拓扑图的邻接矩阵，它是一个N×N维矩阵，当链路(j,i)连通时，wij＝1；否则，wij(t)＝0。当任意两架无人机都可以通过中间的无人机节点，比如无人机i1,...,in进行信息传输时，则通信拓扑图G被称为连通图。定义为联合图，其节点集和链路集分别为切换子图G0,G1,...,Gm的节点集和链路集的并集。由于考虑通信环境不稳定的情况，某些链路在某些时刻可能断开，下一时刻又可能恢复连接，本方案中的wij(t)是时变的(链路(j,i)连通时，wij＝1；否则，wij(t)＝0)。参考图1，图1示出了无人机系统中无人机的编队和避障控制方法的流程图，如图1所示，该方法S包括步骤S1至S5。在步骤S1中，无人机系统中的无人机i利用其编队控制器，根据其位置和速度及其邻居无人机的位置和速度迭代更新其下一时刻的位置和速度进行编队，编队完成后进入步骤S2。在本专利技术的一个实施例中，所述步骤S1进一步包括：S11、无人机i向其邻居无人机发送其t时刻的速度和位置，并接收来自于其邻居无人机发送的t时刻的位置和速度；S12、根据无人机i与其所有邻居无人机t时刻的位置和速度，计算无人机i的编队控制器的输出ui(t)；S13、根据无人机i在t时刻的输出ui(t)、速度和位置，计算无人机i在t+1时刻的速度和位置，并根据无人机i在t+1时刻的速度和位置调整无人机i；S14、判断无人机t+1时刻的速度和位置是否满足设定条件，若满足，则在完成编队后，令t＝t+1并进入步骤S2，否则，令t＝t+1，并返回步骤S11。实施时，本方案编队控制器的输出ui(t)的计算公式可以为：其中，H为编队矩阵；K为本文档来自技高网...

【技术保护点】
1.无人机系统中无人机的编队和避障控制方法，其特征在于，包括：/nS1、无人机系统中的无人机i利用其编队控制器，根据其位置和速度及其邻居无人机的位置和速度迭代更新其下一时刻的位置和速度进行编队，编队完成后进入步骤S2；/nS2、根据无人机i在t时刻采集的信号，判断无人机i设定范围内是否存在障碍物，若存在，则进入步骤S3，否则进入步骤S5；/nS3、根据无人机i在t时刻的速度和位置，计算无人机i的避障控制器的输出u

【技术特征摘要】
1.无人机系统中无人机的编队和避障控制方法，其特征在于，包括：
S1、无人机系统中的无人机i利用其编队控制器，根据其位置和速度及其邻居无人机的位置和速度迭代更新其下一时刻的位置和速度进行编队，编队完成后进入步骤S2；
S2、根据无人机i在t时刻采集的信号，判断无人机i设定范围内是否存在障碍物，若存在，则进入步骤S3，否则进入步骤S5；
S3、根据无人机i在t时刻的速度和位置，计算无人机i的避障控制器的输出ui'(t)：
ui'(t)＝ai1+ai2+ai3，



其中，a为无人机i远离障碍物的加速度，为无人机i的归一化速度；D为无人机i与障碍物之间的距离；c为障碍物与无人机之间的安全范围；wij(t)为t时刻无人机i、j的链路连通系数，链路连通时，wij(t)＝1，否则，wij(t)＝0；vi(t)为无人机i在t时刻的速度；φa、φp、φn分别为速度、方向和噪声项的控制参数，φa+φp+φn＝1；为无人机j的归一化速度；θij为以无人机i为中心建立的坐标系中，投影边缘的角度；ei(t)为无人机i的噪声项；d为无人机之间的距离；c0为无人机之间的安全范围；a0为远离距离满足d<c0的无人机的加速度；ai1、ai2、ai3为避障加速度；
S4、根据无人机i在t时刻的输出ui'(t)、速度和位置，计算无人机i在t+1时刻的速度和位置，并在t+1时刻调整无人机i后，令t＝t+1并进入步骤S2；
S5、判断无人机i是否进行了避障及是否达到目的地：
若存在无人机i进行避障，且未到达目的地，则更新时间t，并返回步骤S1；
若无人机i没有进行避障，且未到达目的地，则令t＝t+1后返回步骤S2；
若无人机i达到目的地，则结束控制方法。


2.根据权利要求1所述的无人机系统中无人机的编队和避障控制方法，其特征在于，所述步骤S1进一步包括：
S11、无人机i向其邻居无人机发送其t时刻的速度和位置，并接收来自于其邻居无人机发送的t时刻的位置和速度；
S12、根据无人机i与其所有邻居无人机t时刻的位置和速度，计算无人机i的编队控制器的输出ui(t)；
S13、根据无人机i在t时刻的输出ui(t)、速度和位置，计算无人机i在t+1时刻的速度和位置，并根据无人机i在t+1时刻的速度和位置调整无人机i；
S14、判断无人机t+1时刻的速度和位置是否满足设定条件，若满足，则在完成编队后，令t＝t+1并进入步骤S2，否则，令t＝t+1，并返回步骤S11。


3.根据权利要求2所述的无人机系统中无人机的编队和避障控制方法，其特征在于，所述编队控制器的输出ui(t)的计算公式为：



其中，H为编队矩阵；K为控制矩阵；N为无人机i的邻居无人机总架数；ξi(t)＝[xi(t)，vi(t)]T，ξj(t)＝[xj(t)，vj(t)]T，xi(t)为无人机i在t时刻的位置，xj(t)、vj(t)分别为无人机j...

【专利技术属性】
技术研发人员：骆春波，吴佳，罗杨，刘子健，孙文健，刘翔，张赟疆，
申请(专利权)人：电子科技大学，
类型：发明
国别省市：四川;51