CN110825116B - 基于时变网络拓扑的无人机编队方法 - Google Patents
基于时变网络拓扑的无人机编队方法 Download PDFInfo
- Publication number
- CN110825116B CN110825116B CN201911273681.8A CN201911273681A CN110825116B CN 110825116 B CN110825116 B CN 110825116B CN 201911273681 A CN201911273681 A CN 201911273681A CN 110825116 B CN110825116 B CN 110825116B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- formation
- speed
- time
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 92
- 238000000034 method Methods 0.000 title claims abstract description 27
- 238000004891 communication Methods 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 15
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 230000009897 systematic effect Effects 0.000 claims 1
- 238000005516 engineering process Methods 0.000 abstract description 4
- 238000005755 formation reaction Methods 0.000 description 64
- 230000005540 biological transmission Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于时变网络拓扑的无人机编队方法,属于无人机控制技术,其包括S1无人机向其邻居无人机发送其t时刻的速度和位置,并接收来自于其邻居无人机发送的t时刻的位置和速度;S2根据无人机与其所有邻居无人机t时刻的位置和速度,计算无人机的编队控制器的输出ui(t);S3根据无人机t时刻的输出ui(t)、速度和位置,计算无人机下一时刻的速度和位置,并调整无人机;S4判断无人机t+1时刻的速度和位置是否满足设定条件,若满足,则完成编队,否则,令t=t+1,并返回步骤S1。本方案的编队方法解决了在通信环境较差,多条通信链路不能很好维持情况下,无人机很难形成设定的编队队形航行至目的地的问题。
Description
技术领域
本发明涉及无人机控制技术领域,具体涉及一种基于时变网络拓扑的无人机编队方法。
背景技术
无人机在实际应用中获得越来越广泛的关注,比如灾难援助,农业,电力传输等等。这些任务往往需要多架无人机来协同,通过信息交互和传输,更加高效地完成任务。研究表明,多架无人机保持有序的编队能够节约能源消耗,同时使它们之间的通信链路更加稳定。因此,研究由多架无人机组成的无人机***的编队具有重要意义。
现有的很多技术都能控制多架无人机形成设定的编队,其中以基于一致性问题的控制技术为主。很多已经被提出的算法基于固定的网络拓扑,然而在实际中,由于时变的网络通信环境,导致某些链路可能在某些时刻链接失败,使得固定网络拓扑的要求很难被达到。
现有的关于切换网络拓扑的技术,大多受限于联合连通条件,也就是说,时变的网络拓扑被要求在一定时间段内的联合网络拓扑图是连通的,这样的限制依然是较为严格的。因为链接失败的链路是随机的,很多时候也并不能保证联合连通条件被满足。
发明内容
针对现有技术中的上述不足,本发明提供的基于时变网络拓扑的无人机编队方法解决了在通信环境较差,多条通信链路不能很好维持情况下,无人机很难形成设定的编队队形航行至目的地的问题。
为了达到上述发明目的,本发明采用的技术方案为:
提供一种基于时变网络拓扑的无人机编队方法,其包括:
S1、无人机向其邻居无人机发送其t时刻的速度和位置,并接收来自于其邻居无人机发送的t时刻的位置和速度;
S2、根据无人机与其所有邻居无人机t时刻的位置和速度,计算无人机的编队控制器的输出ui(t):
其中,K2=-K1为控制矩阵;ξi(t)=[xi(t),vi(t)]T,xi(t)、vi(t)分别为无人机i在t时刻的位置和速度,[.]T为转置;fi、fj分别为无人机i、j的编队信息;h(t)为t时刻航行路线用编队中心轨迹,为常数,σ为***控制增益;Δhv(t)为编队中心轨迹在相邻时间步上速度的变化;链路连通时,wij(t)=1,否则,wij(t)=0;N为无人机i邻居无人机总架数;
S3、根据无人机t时刻的输出ui(t)、速度和位置,计算无人机t+1时刻的速度和位置,并根据无人机t+1时刻的速度和位置调整无人机;
S4、判断无人机t+1时刻的速度和位置是否满足设定条件,若满足,则完成编队,否则,令t=t+1,并返回步骤S1。
本发明的有益效果为:本方案构建的计算无人机编队控制器输出的模型,能够在信号不稳定时,通过wij(t)不同时刻的值,以及设计的控制器的参数,保证无人机编队控制器在信号不好时仍能正常的输出,从而保证了无人机在编队过程位置和速度的迭代更新,使得本方案的编队方法同时适用于固定和切换网络拓扑结构。
本方案通过构建的模型能够在极端条件下,即所有链路均不连通时,仍能使编队过程顺利进行,保证了无人机***能够保持编队进行航行,飞行效率更高,同时节约能源消耗。
本方案在无人机队形编队完成后,在航行路线用编队中心轨迹的作用下,无人机按照中心轨迹设定的航行路线和航行速度航行到目的地。
附图说明
图1为基于时变网络拓扑的无人机编队方法的流程图。
图2为无人机队列采用本方案的方法保持V型编队的航行图。
图3为按图2中V型编队的条件飞行时,以X轴为例,无人机在X轴上的位置变化图。
图4为按图2中V型编队的条件飞行时,以Y轴为例,无人机在Y轴上的速度变化图。
具体实施方式
下面对本发明的具体实施方式进行描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
本方案用于编队的所有无人机构成一个网络拓扑图,每一架无人机上均具有编队控制器,每一无人机i的编队信息设计为fi=[fix,fiv]T,其中fix、fiv分别代表设定的编队位置和编队速度,在进行编队前,每架无人机的编队信息及其邻居无人机都会进行预先设定。
无人机***总的编队队形表示为F=(f1,f2,...,fN),无人机***的航行路线用编队中心轨迹h(t)=[hx(t),hv(t)]T来表示,hx(t)和hv(t)分别代表编队航行时的位移变化和速度变化。在设计时,一般让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的节点集和链路集的并集。
参考图1,图1示出了基于时变网络拓扑的无人机编队方法的流程图,如图1所示,该方法S包括步骤S1至S4。
在步骤S1中,无人机向其邻居无人机发送其t时刻的速度和位置,并接收来自于其邻居无人机发送的t时刻的位置和速度;
在步骤S2中,根据无人机与其所有邻居无人机t时刻的位置和速度,计算无人机的编队控制器的输出ui(t):
其中,K2=-K1为控制矩阵;ξi(t)=[xi(t),vi(t)]T,xi(t)、vi(t)分别为无人机i在t时刻的位置和速度,[.]T为转置;fi、fj分别为无人机i、j的编队信息;
Δhv(t)=hv(t+1)-hv(t)为编队中心轨迹在相邻时间步上速度的变化,hv(t+1)为t+1时刻编队航行时的速度变化;wij(t)为t时刻无人机i、j的链路连通系数;N为无人机i邻居无人机总架数。
采用离散时间Riccati-like等式求解正定矩阵解P:
根据正定矩阵解P计算反馈矩阵为K2:
在步骤S3中,根据无人机t时刻的输出ui(t)、速度和位置,计算无人机t+1时刻的速度和位置,并根据无人机t+1时刻的速度和位置调整无人机;
实施时,本方案优选计算无人机下一时刻的速度和位置的公式为:
vi(t+1)=vi(t)+σui(t),xi(t+1)=xi(t)+σvi(t)
其中,vi(t+1)、xi(t+1)分别为无人机i在t+1时刻的速度和位置。
具体地,xi(t)∈Rn和vi(t)∈Rn,Rn指的是n维向量空间,i指的是***中无人机编号;ui(t)∈Rm作用是控制无人机***达到设定的编队,Rm指的是m维向量空间。
在步骤S4中,判断无人机t+1时刻的速度和位置是否满足设定条件,若满足,则完成编队,否则,令t=t+1,并返回步骤S1。
时变网络拓扑中的所有无人机在进行编队时,每架无人机都需要按照步骤S1至步骤S4的方式进行其队伍的排列。
本方案引入航行路线用编队中心轨迹后,所有无人机达到编队位置后,其会以无人机***的航行路线用编队中心轨迹进行航向,期间无人机与其邻居无人机之间的相对速度不会发生改变。
实施时,本方案优选设定条件为:
limt→∞(xi(t+1)-fix-hix(t+1))=0,limt→∞(vi(t+1)-fiv-hiv(t+1))=0
其中,fix、fiv分别为无人机i的编队位置和编队速度;hix(t+1)、hiv(t+1)分别为无人机保持编队飞行时,编队的飞行路线和飞行速度。
所有无人机在实现编队后,编队控制器的输出主要是控制编队按照中心轨迹设定的路线和速度进行航行。
为了验证本方案提供的编队方法的有效性,下面结合仿真实验进行说明:
本实例中设计一个V型编队,实验考虑由11架无人机组成的***,每一架无人机有两个维度,分别代表X和Y方向。
编队初始位置任意生成,也可按照实际给定。在网络拓扑图时变条件下,即链路随机连通或断开,对于每个无人机的编队控制器,可以设置σ=0.5,τ=0.2,μ=1和α=0.2。
基于配置的参数,采用本方案的方法对无人机进行编队后,会形成如图2所示的V型编队,在整个飞行过程中无人机在X轴上的位置变化及无人机在Y轴上的速度变化分别如图3和图4所示。
通过图2可以看出,本方案提供的编队方法能够在无人机队形排列完成后,在编队中心轨迹的作用下,仍能保持队形进行航行;从图3和图4可以看出,无人机能够在很短时间内完成编队,编队完成后相邻无人机间能够一直保持相同的相对位置和固定速度航行,通过该仿真实验验证了本方案的编队方法的有效性。
Claims (5)
1.基于时变网络拓扑的无人机编队方法,其特征在于,包括:
S1、无人机向其邻居无人机发送其t时刻的速度和位置,并接收来自于其邻居无人机发送的t时刻的位置和速度;
S2、根据无人机与其所有邻居无人机t时刻的位置和速度,计算无人机的编队控制器的输出ui(t):
其中,K2=-K1为控制矩阵;ξi(t)=[xi(t),vi(t)]T,xi(t)、vi(t)分别为无人机i在t时刻的位置和速度,[.]T为转置;h(t)为t时刻航行路线用编队中心轨迹,为常数,σ为***控制增益;Δhv(t)为编队中心轨迹在相邻时间步上速度的变化;wij(t)为t时刻无人机i、j的链路连通系数,链路连通时,wij(t)=1,否则,wij(t)=0;N为无人机i的邻居无人机总架数;h(t)=[hx(t),hv(t)]T为无人机***的航行路线用编队中心轨迹,hx(t)和hv(t)分别代表编队航行时的位移变化和速度变化;fi、fj分别为无人机i、j的编队信息,其中fix和fiy分别表示第i个无人机的编队在X和Y方向上的位置;和分别表示第i个无人机的编队在X和Y方向上的速度;
S3、根据无人机t时刻的输出ui(t)、速度和位置,计算无人机t+1时刻的速度和位置,并根据无人机t+1时刻的速度和位置调整无人机;
S4、判断无人机t+1时刻的速度和位置是否满足设定条件,若满足,则完成编队,否则,令t=t+1,并返回步骤S1;所述设定条件为:
limt→∞(xi(t+1)-fix-hix(t+1))=0,limt→∞(vi(t+1)-fiv-hiv(t+1))=0
其中,fix、fiv分别为无人机i的编队位置和编队速度;hix(t+1)、hiv(t+1)分别为无人机保持编队飞行时,编队的飞行路线和飞行速度。
2.根据权利要求1所述的基于时变网络拓扑的无人机编队方法,其特征在于,计算无人机下一时刻的速度和位置进行编队的计算公式为:
vi(t+1)=vi(t)+σui(t),xi(t+1)=xi(t)+σvi(t)
其中,vi(t+1)、xi(t+1)分别为无人机i在t+1时刻的速度和位置。
3.根据权利要求1所述的基于时变网络拓扑的无人机编队方法,其特征在于,编队中心轨迹在相邻时间步上速度的变化为:
Δhv(t)=hv(t+1)-hv(t)
其中,hv(t+1)为t+1时刻编队航行时的速度变化。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911273681.8A CN110825116B (zh) | 2019-12-12 | 2019-12-12 | 基于时变网络拓扑的无人机编队方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911273681.8A CN110825116B (zh) | 2019-12-12 | 2019-12-12 | 基于时变网络拓扑的无人机编队方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110825116A CN110825116A (zh) | 2020-02-21 |
CN110825116B true CN110825116B (zh) | 2020-08-04 |
Family
ID=69544875
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911273681.8A Active CN110825116B (zh) | 2019-12-12 | 2019-12-12 | 基于时变网络拓扑的无人机编队方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110825116B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111736628B (zh) * | 2020-06-29 | 2023-04-07 | 众芯汉创(北京)科技有限公司 | 无线紫外光mimo协作无人机最优持久编队生成方法 |
CN112327934B (zh) * | 2020-12-10 | 2021-08-24 | 电子科技大学 | 基于时变拓扑和时变通信时延的无人机***编队控制方法 |
CN112666982A (zh) * | 2021-01-07 | 2021-04-16 | 西安理工大学 | 无线紫外光协作无人机编队快速集结方法 |
CN113485452B (zh) * | 2021-08-20 | 2023-06-16 | 电子科技大学 | 一种基于领航跟随的无人机编队控制方法 |
CN114025434B (zh) * | 2021-11-05 | 2024-02-20 | 江西洪都航空工业集团有限责任公司 | 一种通信网络拓扑结构自适应重构方法及装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102520729A (zh) * | 2011-12-05 | 2012-06-27 | 清华大学 | 一种可视导航中的无人机集群信息传输方法 |
CN103592949A (zh) * | 2013-11-28 | 2014-02-19 | 电子科技大学 | 一种用于无人机编队同时到达目标的分布式控制方法 |
CN104836640A (zh) * | 2015-04-07 | 2015-08-12 | 西安电子科技大学 | 一种无人机编队分布式协作通信方法 |
CN105138006A (zh) * | 2015-07-09 | 2015-12-09 | 哈尔滨工程大学 | 一种时滞非线性多智能体***的协同追踪控制方法 |
CN107491086A (zh) * | 2017-08-03 | 2017-12-19 | 哈尔滨工业大学深圳研究生院 | 时变网络拓扑下的无人机编队避障方法及*** |
CN107992090A (zh) * | 2018-01-25 | 2018-05-04 | 西北工业大学深圳研究院 | 一种应用于网络化集群智能体***的自适应编队方法 |
CN108549407A (zh) * | 2018-05-23 | 2018-09-18 | 哈尔滨工业大学(威海) | 一种多无人机协同编队避障的控制算法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050114023A1 (en) * | 2003-11-26 | 2005-05-26 | Williamson Walton R. | Fault-tolerant system, apparatus and method |
-
2019
- 2019-12-12 CN CN201911273681.8A patent/CN110825116B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102520729A (zh) * | 2011-12-05 | 2012-06-27 | 清华大学 | 一种可视导航中的无人机集群信息传输方法 |
CN103592949A (zh) * | 2013-11-28 | 2014-02-19 | 电子科技大学 | 一种用于无人机编队同时到达目标的分布式控制方法 |
CN104836640A (zh) * | 2015-04-07 | 2015-08-12 | 西安电子科技大学 | 一种无人机编队分布式协作通信方法 |
CN105138006A (zh) * | 2015-07-09 | 2015-12-09 | 哈尔滨工程大学 | 一种时滞非线性多智能体***的协同追踪控制方法 |
CN107491086A (zh) * | 2017-08-03 | 2017-12-19 | 哈尔滨工业大学深圳研究生院 | 时变网络拓扑下的无人机编队避障方法及*** |
CN107992090A (zh) * | 2018-01-25 | 2018-05-04 | 西北工业大学深圳研究院 | 一种应用于网络化集群智能体***的自适应编队方法 |
CN108549407A (zh) * | 2018-05-23 | 2018-09-18 | 哈尔滨工业大学(威海) | 一种多无人机协同编队避障的控制算法 |
Non-Patent Citations (1)
Title |
---|
Time-varying formation control for unmanned aerial vehicles with switching interaction topologies;Xiwang Dong 等;《Control Engineering Practice》;20160131;第26-36页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110825116A (zh) | 2020-02-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110825116B (zh) | 基于时变网络拓扑的无人机编队方法 | |
Ren et al. | A survey of consensus problems in multi-agent coordination | |
Kuriki et al. | Formation control with collision avoidance for a multi-UAV system using decentralized MPC and consensus-based control | |
CN110347181B (zh) | 基于能耗的无人机分布式编队控制方法 | |
CN108897340B (zh) | 一种通信和计算约束下航天器编队飞行相对位置控制方法 | |
CN114020042A (zh) | 一种异构无人集群编队合围跟踪控制方法及*** | |
CN110262494B (zh) | 一种同构多无人艇***的协同学习与编队控制方法 | |
WO2023010712A1 (zh) | 一种空中集群通信网络的优化方法及装置 | |
CN103412564A (zh) | 一种无人***分布式一致性编队控制方法及其*** | |
CN110865655B (zh) | 无人机***中无人机的编队和避障控制方法 | |
CN109818792B (zh) | 一种基于二阶线性***时变耦合复杂动态网络模型的控制器 | |
CN114779645B (zh) | 一种有向固定通信拓扑下胸鳍拍动式机器鱼编队控制方法 | |
CN115877871A (zh) | 一种基于强化学习的非零和博弈无人机编队控制方法 | |
CN113985915B (zh) | 一种高阶群***多领导者分簇编队跟踪控制方法 | |
Xiaowei et al. | Multi-UAVs cooperative control in communication relay | |
CN114935943A (zh) | 一种无人机与无人车集群编队跟踪控制方法及*** | |
CN109491381B (zh) | 基于观测器的多移动机器人自适应编队跟踪控制方法 | |
CN110673651B (zh) | 一种通信受限条件下的无人机群鲁棒编队方法 | |
CN114564044B (zh) | 一种输入限幅事件触发的无人机有限时间编队控制方法 | |
Chung et al. | Cooperative robot control and synchronization of Lagrangian systems | |
CN110716585B (zh) | 基于分布式一致性与自组网的自主协同控制方法及*** | |
Wang et al. | Distance-based formation stabilization and flocking control for distributed multi-agent systems | |
CN113495574B (zh) | 一种无人机群飞行的控制方法、装置 | |
CN115933631A (zh) | 一种应用于欠驱动无人艇的编队控制器构建方法及装置 | |
CN112327932B (zh) | 一种针对消防无人机编队的增量式pid控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |