CN108196583A - 无人机集群控制方法 - Google Patents
无人机集群控制方法 Download PDFInfo
- Publication number
- CN108196583A CN108196583A CN201810178712.0A CN201810178712A CN108196583A CN 108196583 A CN108196583 A CN 108196583A CN 201810178712 A CN201810178712 A CN 201810178712A CN 108196583 A CN108196583 A CN 108196583A
- Authority
- CN
- China
- Prior art keywords
- unmanned plane
- individual
- obstacle
- cluster
- acceleration
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 57
- 230000033001 locomotion Effects 0.000 claims abstract description 29
- 230000001133 acceleration Effects 0.000 claims abstract description 27
- 230000004888 barrier function Effects 0.000 claims description 25
- 230000009471 action Effects 0.000 claims description 9
- 230000000694 effects Effects 0.000 abstract description 13
- 230000006870 function Effects 0.000 description 22
- 238000002474 experimental method Methods 0.000 description 10
- 238000001514 detection method Methods 0.000 description 8
- 238000004891 communication Methods 0.000 description 7
- 230000001419 dependent effect Effects 0.000 description 4
- 230000002776 aggregation Effects 0.000 description 3
- 238000004220 aggregation Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000016776 visual perception Effects 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 230000004931 aggregating effect Effects 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000010006 flight Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000010606 normalization Methods 0.000 description 1
- 238000005381 potential energy Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
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)
- Peptides Or Proteins (AREA)
- Acyclic And Carbocyclic Compounds In Medicinal Compositions (AREA)
Abstract
本发明公开了一种无人机集群控制方法,涉及无人机技术领域。所述方法包括如下步骤:通过无人机集群群内部成员的空间位置、速度以及加速度构建无人机集群群内部成员模型;构建无人机集群群内部成员的加速度控制函数;通过构建的所述加速度控制函数实现对无人机集群群内部成员的群聚运动、朝向目标运动以及规避障碍运动进行控制。本发明所述方法在控制集群运动方面灵活性强,一致性好,控制与避障效果显著。
Description
本分案申请的原申请号为2017107194482,申请日为2017年08月21日,发明名称为“无人机集群控制方法”。
技术领域
本发明涉及无人机技术领域,尤其涉及一种无人机集群控制方法。
背景技术
多架无人机(Unmanned Aerial Vehicles,UAVs)彼此协同完成军事目标打击、目标跟踪与侦察等任务可大幅度减少任务执行的时间、提高作战的效率和成功率。随着作战环境的日趋复杂,不仅空间无人机的数量和密度上升,而且强电磁环境易使无人机通信致盲,以及潜在的突发障碍给无人机集群的飞行控制与安全带来一系列挑战,已成为一个亟待解决的问题。
无人机集群***属于局部感知或通信的分布式体系结构,目前主要的控制方法有:基于局部规则的控制、软控制、领航跟随法和人工势场法。基于局部规则的控制方法最基础,能实现集群智能的涌现控制,但仅靠它难使集群涌现到期望的控制方向;软控制是在局部规则的基础上通过为集群加入一外部可控的个体引导群内其它个体朝着人们期望的方向运动;领航控制法利用集群中信息丰富的个体引导实现集群控制,现有技术中将掌握航迹信息的个体直接设为领导者,没考虑个体间在无直接通信的实际情况下如何辨识谁是领导者的问题;人工势场通过构建全局势场函数引导智能体向势能降低的方向运动,该方法简单实用,在避障方面有优势,但存在局部极值问题。综上,现有技术中的无人机集群控制方法普遍存在研究情况理想、方法使用各有利弊,存在灵活性不足、控制与避障效果不佳等问题。
发明内容
本发明所要解决的技术问题是如何提供一种活性强,一致性好,控制与避障效果显著的无人机集群运动控制方法。
为解决上述技术问题,本发明所采取的技术方案是:一种无人机集群控制方法,其特征在于包括如下步骤:
通过无人机集群群内部成员的空间位置、速度以及加速度构建无人机集群群内部成员模型;无人机集群是由N个个体组成的分布式***,每个个体的运动可抽象为:
其中:Pi表示无人机i的空间位置,vi表示速度,ai表示加速度,表示对Pi求一阶导数,表示对vi求一阶导数;
无人机飞行时存在以下约束:
加速度约束:
其中,Amax为无人机的最大加速度;
速度约束:
其中,Vmax为无人机的最大速度;
构建无人机集群群内部成员的加速度控制函数;
对无人机集群群内部成员个体i的质量进行归一化处理后其运动控制量加速度函数ai表示为:
ai=γ1·α·fi g+γ2·fi o+γ3·fi j+γ1·(1-α)·fi G (4)
上式中γ1·α·fi g为目标吸引产生的控制分量,γ2·fi o为规避障碍所需的控制分量,γ3·fi j为群内邻居无人机j对无人机i产生的群聚作用力,γ1·(1-α)·fi G为无人机个体G领导无人机个体i产生的控制分量;α为无人机个体i接收到航点信息的标志,α=1表示无人机i能接收航点信息,此时(4)式等号右侧的γ1·(1-α)·fi G为0;α=0则表示无人机i不能接收航点信息,(4)式等号右侧的γ1·α·fi g为0,γ1·(1-α)·fi G不为0,个体i将从探测区域内选择无人机G作为领导者进行跟随,即接收不到目标航点的情况下把无人机G作为目标航点并朝向它运动;γ1、γ2和γ3为各个控制分量的权重,fi g为目标g与无人机i的作用力函数,fi o为障碍O与无人机i之间的作用力函数,fi j为无人机j与无人机i的作用力函数,fi G为无人机i与选定的领导者无人机G之间的作用力;
通过构建的所述加速度控制函数实现对无人机集群群内部成员的群聚运动、朝向目标运动以及规避障碍运动进行控制,设个体i与障碍物O之间的警戒距离为γβ,其中γβ<da,则二者之间通过以下函数进行控制:
其中,
其中:fi o为障碍O与无人机i之间的作用力,由无人机i和障碍O的位置Pi、PO和速度vi、vO决定,决定的方法:表示该作用力的作用方向,为单位方向矢量,Fi O为该作用力的大小,由无人机i和障碍O的位置Pi、PO根据(14)式求解,无人机i和障碍O之间的距离另由无人机i和障碍O的速度vi、vO产生的作用力为(13)式中等号右侧的第二项;γβ为无人机i和障碍物O之间的警戒距离,为距离调节参数,为无人机i和障碍O之间的斥力强度调节系数,为无人机i和障碍O之间的速度一致性控制系数,和γβ可先给定一初值,再在***实验时进一步调节。
采用上述技术方案所产生的有益效果在于:所述方法首先通过将局部规则与势场法融合产生了一种新的控制函数,并结合软控制方法控制虚拟的目标航点的运动成功引导个体实现了聚集和集群的飞行控制,对未知突发障碍在有限视觉感知的基础上提出“探测即规避”的避障策略;其次,针对电磁环境只有部分个体能正常接收航迹信息的情况,采用邻域辨识的方法为未接收到航迹信息的个体选定目标个体进行跟随,实现期望的集群运动。本发明所述方法在控制集群运动方面控制简单、考虑的情形比较接近实际情况、灵活性强,一致性好,控制与避障效果显著。
附图说明
下面结合附图和具体实施方式对本发明作进一步详细的说明。
图1是本发明实施例所述方法的流程图;
图2是本发明实施例所述方法中个体成员之间的作用力图;
图3是本发明实施例所述方法中个体与目标航点之间的作用力图;
图4是本发明实施例所述方法中个体与目标个体之间的作用力图;
图5是本发明实施例所述方法中个体与障碍之间的作用力图;
图6是本发明实施例所述方法进行仿真实验时无人机个体聚集和沿航迹飞行的轨迹图;
图7是本发明实施例所述方法进行仿真实验时各架无人机之间距离的曲线图;
图8是本发明实施例所述方法进行仿真实验时编队中心与实时航点的距离偏差曲线图;
图9是本发明实施例所述方法进行仿真实验时无人机集群躲避障碍的场景图;
图10是本发明实施例所述方法进行仿真实验时各无人机到障碍的距离曲线图;
图11是本发明实施例所述方法进行仿真实验时基于邻域辨识的集群控制的无人机航迹图;
其中,1、规划的航迹曲线;2、各无人机航迹曲线;
3、无人机1与无人机2之间的距离曲线;4、无人机1与无人机3之间的距离曲线;5、无人机1与无人机4之间的距离曲线;6、无人机1与无人机5之间的距离曲线;7、无人机1与无人机6之间的距离曲线;8、无人机2与无人机3之间的距离曲线;9、无人机2与无人机4之间的距离曲线;10、无人机2与无人机5之间的距离曲线;11、无人机2与无人机6之间的距离曲线;12、无人机3与无人机4之间的距离曲线;13、无人机3与无人机5之间的距离曲线;14、无人机3与无人机6之间的距离曲线;15、无人机4与无人机5之间的距离曲线;16、无人机4与无人机6之间的距离曲线;17、无人机5与无人机6之间的距离曲线;
18、障碍物一;19、障碍物二;20、无人机1与障碍物一之间的距离曲线;21、无人机1与障碍物二之间的距离曲线;22、无人机2与障碍物一之间的距离曲线;23、无人机2与障碍物二之间的距离曲线;24、无人机3与障碍物一之间的距离曲线;25、无人机3与障碍物二之间的距离曲线;26、无人机4与障碍物一之间的距离曲线;27、无人机4与障碍物二之间的距离曲线;28、无人机5与障碍物一之间的距离曲线;29、无人机5与障碍物二之间的距离曲线;30、无人机6与障碍物一之间的距离曲线;31、无人机6与障碍物二之间的距离曲线;32、第三种情况下能够接收航点信息的无人机航迹曲线。
具体实施方式
下面结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是本发明还可以采用其他不同于在此描述的其它方式来实施,本领域技术人员可以在不违背本发明内涵的情况下做类似推广,因此本发明不受下面公开的具体实施例的限制。
总体的,如图1所示,本发明实施例公开了一种无人机集群控制方法,包括如下步骤:
S101:通过无人机集群群内部成员的空间位置、速度以及加速度构建无人机集群群内部成员模型;
S102:构建无人机集群群内部成员的加速度控制函数;
S103:通过构建的所述加速度控制函数实现对无人机集群群内部成员的群聚运动(主要解决集群内部的避碰、保持速度的一致性以及群的整体性)、朝向目标运动以及规避(集群外部)障碍的运动进行控制。
以下从建模、稳定性分析以及仿真实验验证三个方面对所述方法进行详细的说明:
1、构建无人机集群群内部成员的加速度函数
1.1群内部成员模型
无人机集群是由N个个体组成的分布式***,每个个体的运动可用一个6自由度的运动方程表示,经过模型化简和质量归一化处理可抽象为以下形式:
其中Pi表示无人机i的空间位置,vi表示速度,ai表示加速度,表示对Pi求一阶导数,表示对vi求一阶导数。通过在制导***环节设计加速度ai可控制无人机沿着预定路径飞行,其它交由自动驾驶仪完成。另外,无人机i飞行时存在以下约束:
加速度约束:
其中,Amax为无人机的最大加速度。
速度约束:
其中,Vmax为无人机的最大速度。
1.2个体的运动控制规则
本发明所述的无人机集群的整体运动受集群内无人机个体运动规则控制,是个体间局部交互产生的一种涌现行为。根据个体行为交互对象的不同,可将集群内部个体的运动分解为三个子目标:保持群聚、奔向目标和规避障碍,因此它受邻近个体群聚力、目标的吸引力与障碍的排斥力三者的综合作用,对个体质量进行归一化处理后其运动控制量加速度函数ai可表示为:
ai=γ1·α·fi g+γ2·fi o+γ3·fi j+γ1·(1-α)·fi G (4)
上式中γ1·α·fi g为目标吸引产生的控制分量,γ2·fi o为规避障碍所需的控制分量,γ3·fi j为群内邻居无人机j对无人机i产生的群聚作用力;γ1·(1-α)·fi G为无人机个体G领导无人机个体i产生的控制分量;α为无人机个体i接收到航点信息的标志,α=1表示无人机i能接收航点信息,此时(4)式等号右侧的γ1·(1-α)·fi k为0;α=0则表示无人机i不能接收航点信息,(4)式等号右侧的γ1·α·fi g为0和γ1·(1-α)·fi G不为0,个体i将从探测区域内选择无人机G作为领导者,即接收不到目标航点的情况下把无人机G视为领导者并跟随它运动;γ1、γ2和γ3为各个控制分量的权重,fi g为目标g与无人机i的作用力函数,fi o为障碍O与无人机i之间的作用力函数,fi j为无人机j与无人机i的作用力函数,fi G为无人机i与选定的领导者无人机G之间的作用力。
1.2.1群聚运动的控制
设无人机个体i通过视觉感知周围个体的位置和速度,探测距离为da;以个体i为中心,da为半径,构成的圆形区域为无人机i的探测区域;邻域为t时刻落在无人机i的探测区域内的无人机个体集合(不包括无人机i);该探测区域划分为三个区域:排斥域一致域吸引域排斥域Rn空间的点集一致域吸引域其中,dr为排斥域与一致域的分界距离,do为一致域与吸引域的分界距离,0<dr<do<da,Rn表示n维实数集,表示无人机i和无人机j之间的距离。
邻域内的无人机j与无人机i之间的作用力fi j表示为:
为对Vi j求负梯度。
其中:fi j由无人机i和无人机j的位置Pi、Pj和速度vi、vj决定;决定的方法:表示力的作用方向,为单位方向矢量,Fi j为该作用力的大小,由无人机i和无人机j的位置Pi、Pj根据(7)式求解;Vi j为由无人机i和无人机j的位置Pi、Pj产生的势场,对Vi j求负梯度得到Fi j;为对Vi j求负梯度;由无人机i和无人机j的速度vi、vj产生的作用力为式(5)中等号右侧的第二项;为无人机i和无人机j之间的斥力强度控制参数、为距离调节参数、为无人机i和无人机j之间的引力强度控制参数,为无人机i和无人机j之间的速度一致性控制参数,和可先给定一初值,然后在***实验时再进一步调节。个体成员之间的作用力如图2所示。
1.2.2朝向目标的运动控制
为控制无人机集群到达目标区执行任务,首先将无人机集群作为一个整体进行航迹规划,以减少路径规划的复杂性;其次将无人机航迹分解成一系列序列位置点Track={T1,T2,...Tm},随时间由机载(或地面控制站的)广播式自动相关监视***发射端逐个发送,设集群内部每架无人机可通过机载广播式自动相关监视***接收端实时接收广播式自动相关监视***发射端发送的航点位置、速度信息,通过航点的更新控制目标虚拟体的运动位置引导集群到达期望的作战区域。该信息分发***可布置于集群内部的任意一架无人机,也可布置在地面控制站,此时可灵活改变航点,提高集群控制的机动性和灵活性。根据机载广播终端能否正常接收航点信息,可分为以下两种情况:
(1)所有个体均可获得航点信息
设集群内部每架无人机可通过机载数据终端接收航点的实时位置、速度,个体与航点的位置偏差为为实现集群朝向目标的运动,本发明设计了以下作用力函数:
其中,
fi g为目标g与无人机i之间的作用力,由无人机i和目标g的位置Pi、Tk和速度vi、vg决定。决定的方法:表示该作用力的作用方向,为单位方向矢量,Fi g为该作用力的大小,具体由无人机i和目标g的位置根据(9)式求解,无人机i和目标g之间的距离另由无人机i和目标g的速度差产生的作用力为(8)式中等号右侧的第二项(注:vg的求法:在将无人机航迹分解成一系列序列位置点Track={T1,T2,...Tm}后,设每两个相邻航迹点Tk和Tk+1(k=1...m-1)之间播发的时间间隔为Δt,则目标航点在该航迹段的飞行速度vg为);为无人机i和目标g之间的作用强度调节系数,rτ为目标g与无人机i之间的作用力形式发生变化的分界距离;目标与个体之间的作用力如图3所示。
(2)少部分个体可获得航点信息
强电磁干扰易使无人机的通信中断导致其不能获得目标航点信息,此时现有技术中直接将获得航点信息的无人机个体设为领导者,依靠局部通信领导未获得航点信息的个体的运动,使无人机成员聚集和形成群聚运动。但随着掌握航点信息个体的比例下降,集群内部个体飞行路径的平滑度大幅度下降,当比例下降到到1/3以下时,个体经常产生脱离集群的现象,给集群的控制与安全带来了很大的困难;且强电磁干扰环境下无人机之间的局部通信会受到影响,使未获得航迹信息的无人机无法与获得航迹信息的无人机之间进行正常通信,从而无法得知谁是领导者。对此本发明提出了基于视觉的邻域感知与辨识的方法,假设无人机个体i不能接收到目标航点信息,因此无法与能收到航点信息的个体通信,但能通过机载视觉传感***感知视觉范围内邻居无人机个体的位置和速度:
其中表示无人机j在t时刻和t-τ时刻都在无人机i的邻域内,τ为个体i前后两次对邻域内的个***置进行观察的时间间隔,Δj表示τ时间段内无人机j的位置变化量,为无人机j在t时刻的位置,为无人机j在t-τ时刻的位置;个体i采用(10)式所述的方法从邻域中辨识出速度最快的个体G后,把它当作领导者进行追随,二者之间通过以下函数作用:
其中:fi G为无人机G与无人机i之间的作用力,由无人机i和无人机G的位置Pi、PG和速度vi、vG决定。决定的方法:表示该力的作用方向,为单位方向矢量,Fi G为该作用力的大小,具体由无人机i和无人机G的位置根据(12)式求解,无人机i和无人机G之间的距离另由无人机i和无人机G的速度差产生的作用力为(11)式中等号右侧的第二项。dr为排斥域与一致域之间的分界距离,dr+rt为目标无人机个体G与无人机i之间的引力形式发生变化的分界距离;为无人机i和无人机G之间的斥力强度控制系数、为距离调节参数、均为无人机i和无人机G之间的引力强度控制系数,为无人机i和无人机G之间的速度一致性控制系数,和可先给定一初值,再在***实验时进一步调节。个体与目标个体之间的作用力如图4所示。
1.2.3规避障碍的运动控制
集群沿着预定航迹飞往目的地的过程中,会遇到一些障碍的威胁。个体为保证自身的飞行安全,需要对障碍物进行规避。根据威胁事先是否已知可分为已知威胁和和未知威胁。对于已知威胁,可在航迹规划阶段进行初步处理,飞行过程中个体主动进行规避;对于未知威胁,则依赖于机载传感器的探测能力、计算机信息处理速度和执行机构的动作时间。本发明针对未知威胁,为了与实际情况相符,设无人机个体i的探测距离为γβ,机载信息处理和执行响应的时间和为τ'=0.25s,个体自探测到障碍的时刻起的τ'秒后进行规避(探测即规避),则二者之间通过以下作用力函数进行设计:
其中,
其中,fi o为障碍O与无人机i之间的作用力,由无人机i和障碍O的位置Pi、PO和速度vi、vO决定,决定的方法:表示该作用力的作用方向,为单位方向矢量,Fi O为该作用力的大小,由无人机i和障碍O的位置根据(14)式求解,无人机i和障碍O之间的距离另由无人机i和障碍O的速度差产生的作用力为(13)式中等号右侧的第二项;γβ为无人机i和障碍物O之间的警戒距离,为距离调节参数,为无人机i和障碍O之间的斥力强度调节系数,为无人机i和障碍O之间的速度一致性控制系数,和γβ可先给定一初值,再在***实验时进一步调节。个体与障碍之间的作用力如图5所示。
2、稳定性分析
对集群而言,如果集群内部个体与邻居之间的距离保持不变则说明其具有良好的稳定性和鲁棒性。为简化稳定性分析过程,本文首先考虑集群内部只有两架无人机i和j的情况,它们在彼此的探测距离之内。根据(1)式,设和分别为无人机i和j的相对位置和相对速度(***的两个状态变量),将两机视为一个***,即稳定性与fi j有关。
设李雅普诺夫函数:
则
两机速度逐渐趋于一致,即二机之间的距离也趋于一定值,***达到稳定状态!
接下来考虑集群内部有3架无人机,编号分别为1、2、3,且各自在彼此的探测距离内。以个体2为例进行稳定性分析,其邻居为1和3,按上述方法设则:
设李雅普诺夫函数:
结论同上,以此类推,设集群内部有N架无人机,无人机i有M个邻居,用表示其集合,为简化证明过程,对M个邻居另用编号l=1、2...M表示。
则
设李雅普诺夫函数:则:
根据李雅普诺夫稳定性判别方法,判别***稳定!
3、仿真实验验证
为方便进行结果分析,下面对三维空间的无人机集群飞行与障碍规避进行仿真验证。按个体能否接收航点信息,仿真实验主要从以下几方面展开:
情形一:无人机集群内部个体均能获得实时航迹信息,且飞行空间无障碍
设集群内部无人机个体数为6,个体均能通过广播终端接收实时航迹信息(α=1)。根据(4)式,该情况下无人机个体的运动控制加速度函数ai=γ1·fi g+γ2·fi o+γ3·fi j且fi o=0。无人机成员的初始速度为0,初始位置随机,在接收到航点信息后开始朝向它飞行,机载传感器探测距离为60m,最大速度为40m/s,最大加速度为0.5m/s2,机身长2m,γ1=1,γ2=3,γ3=0.5,rτ=20m,dr=20m,do=30m,da=60m。在上述参数决定的控制输入作用下个体最终向航迹运动方向聚集和沿目标航迹飞行,航迹如图6所示,各机之间的距离如图7所示。若用表示集群的中心,E(t)=Tk-Pgroup表示集群中心与当前航点Tk之间的距离偏差,其变化过程如图8所示。
图6表明各架无人机能在所述控制方法下从任意初始状态向规划的航迹方向运动、逐渐靠近、聚集和形成一个整体的运动;图7更清晰显示了各个时刻任意两机间的距离,其曲线走向表明该距离在初始时刻最大,后来逐渐收敛至一稳定值,且任意两机间的最小距离为7.8米(大于机身长度2米),保证了无碰撞的发生;图9显示随着时间的推移偏差逐渐收敛,集群中心基本能够压航迹飞行。
情形二:集群内无人机个体均能获得实时航迹信息,飞行空间有未知障碍
无人机集群内部个体在沿航迹飞行过程中,当飞至障碍附近时其机载传感器检测到该障碍物的位置、速度信息,仍可采用情形一的控制方法,但此时fi o≠0,令γβ=25m,障碍物一的空间位置为(48,72,50)(m),障碍物二的空间位置为(78,50,50)(m),其它参数同情形一。三维空间的仿真效果如图9所示,各机之间的距离如图10所示。
图9中的球体即为障碍所在的区域,从无人机航迹线可明显看到无人机在接近障碍物时发生明显背离障碍的侧向弯曲,即为检测到障碍和产生的规避行为;图10中的2个最低谷即为集群规避障碍物一和障碍物二的时间段(见椭圆虚线标注部分),各机始终与障碍物保持10米以上的距离。同样采用情形一的数据分析方法得各机间的最近距离为4.3m,仍大于机身长度值2m,能避免与障碍的碰撞。
情形三:集群内部少数个体可获得实时航点信息,飞行空间无障碍
该情况下,已收到航点信息的个体继续按照情形一的方法进行控制,未收到航点信息的个体采用邻域辨识的方法选择邻居无人机个体G作为领导者进行追随,其控制输入为ai=γ2·fi o+γ3·fi j+γ1·fi G, dr=20,rτ=20,τ=1,其余参数设置同前,其效果如图11所示。
从图11看出,集群内部有6架无人机,只有1架能够接收航迹信息(标号为32的曲线,占群体数的1/6),初始条件下另外5架无人机中每一架无人机的探测区域内至少存在其它1架无人机且均能通过该方法关联到能接收航迹信息的1架无人机上,,采用邻域跟随与辨识的方法为未接收到航迹信息的个体选择领导者,个体能在群聚作用、领导者的引导和目标牵引下下从任意初始状态聚集靠拢和形成整体运动。
Claims (1)
1.一种无人机集群控制方法,其特征在于包括如下步骤:
通过无人机集群群内部成员的空间位置、速度以及加速度构建无人机集群群内部成员模型;无人机集群是由N个个体组成的分布式***,每个个体的运动可抽象为:
其中:Pi表示无人机i的空间位置,vi表示速度,ai表示加速度,表示对Pi求一阶导数,表示对vi求一阶导数;
无人机飞行时存在以下约束:
加速度约束:
其中,Amax为无人机的最大加速度;
速度约束:
其中,Vmax为无人机的最大速度;
构建无人机集群群内部成员的加速度控制函数;
对无人机集群群内部成员个体i的质量进行归一化处理后其运动控制量加速度函数ai表示为:
ai=γ1·α·fi g+γ2·fi o+γ3·fi j+γ1·(1-α)·fi G (4)
上式中γ1·α·fi g为目标吸引产生的控制分量,γ2·fi o为规避障碍所需的控制分量,γ3·fi j为群内邻居无人机j对无人机i产生的群聚作用力,γ1·(1-α)·fi G为无人机个体G领导无人机个体i产生的控制分量;α为无人机个体i接收到航点信息的标志,α=1表示无人机i能接收航点信息,此时(4)式等号右侧的γ1·(1-α)·fi G为0;α=0则表示无人机i不能接收航点信息,(4)式等号右侧的γ1·α·fi g为0,γ1·(1-α)·fi G不为0,个体i将从探测区域内选择无人机G作为领导者进行跟随,即接收不到目标航点的情况下把无人机G作为目标航点并朝向它运动;γ1、γ2和γ3为各个控制分量的权重,fi g为目标g与无人机i的作用力函数,fi o为障碍O与无人机i之间的作用力函数,fi j为无人机j与无人机i的作用力函数,fi G为无人机i与选定的领导者无人机G之间的作用力;
通过构建的所述加速度控制函数实现对无人机集群群内部成员的群聚运动、朝向目标运动以及规避障碍运动进行控制,设个体i与障碍物O之间的警戒距离为γβ,其中γβ<da,则二者之间通过以下函数进行控制:
其中,
其中:fi o为障碍O与无人机i之间的作用力,由无人机i和障碍O的位置Pi、PO和速度vi、vO决定,决定的方法:表示该作用力的作用方向,为单位方向矢量,Fi O为该作用力的大小,由无人机i和障碍O的位置Pi、PO根据(14)式求解,无人机i和障碍O之间的距离另由无人机i和障碍O的速度vi、vO产生的作用力为(13)式中等号右侧的第二项;γβ为无人机i和障碍物O之间的警戒距离,为距离调节参数,为无人机i和障碍O之间的斥力强度调节系数,为无人机i和障碍O之间的速度一致性控制系数,和γβ可先给定一初值,再在***实验时进一步调节。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810178712.0A CN108196583B (zh) | 2017-08-21 | 2017-08-21 | 无人机集群控制方法 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810178712.0A CN108196583B (zh) | 2017-08-21 | 2017-08-21 | 无人机集群控制方法 |
CN201710719448.2A CN107340784B (zh) | 2017-08-21 | 2017-08-21 | 无人机集群控制方法 |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710719448.2A Division CN107340784B (zh) | 2017-08-21 | 2017-08-21 | 无人机集群控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108196583A true CN108196583A (zh) | 2018-06-22 |
CN108196583B CN108196583B (zh) | 2020-09-01 |
Family
ID=60214741
Family Applications (3)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710719448.2A Expired - Fee Related CN107340784B (zh) | 2017-08-21 | 2017-08-21 | 无人机集群控制方法 |
CN201810178713.5A Expired - Fee Related CN108121358B (zh) | 2017-08-21 | 2017-08-21 | 无人机控制方法 |
CN201810178712.0A Expired - Fee Related CN108196583B (zh) | 2017-08-21 | 2017-08-21 | 无人机集群控制方法 |
Family Applications Before (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710719448.2A Expired - Fee Related CN107340784B (zh) | 2017-08-21 | 2017-08-21 | 无人机集群控制方法 |
CN201810178713.5A Expired - Fee Related CN108121358B (zh) | 2017-08-21 | 2017-08-21 | 无人机控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (3) | CN107340784B (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109460064A (zh) * | 2019-01-03 | 2019-03-12 | 中国人民解放军战略支援部队航天工程大学 | 基于虚拟势场函数的无人机集群区域覆盖方法及其装置 |
CN109557936A (zh) * | 2018-12-03 | 2019-04-02 | 北京航空航天大学 | 基于人工势场法的可垂起无人机机间防碰撞控制方法 |
CN110737281A (zh) * | 2019-10-15 | 2020-01-31 | 中国航空无线电电子研究所 | 一种面向集群无人机的分布式控制方法 |
CN111522319A (zh) * | 2020-05-29 | 2020-08-11 | 南京航空航天大学 | 一种基于扩散模型使无人***生成群集性的分布式控制方法 |
CN111580093A (zh) * | 2020-05-25 | 2020-08-25 | 南京理工大学 | 用于探测无人机集群目标的雷达*** |
CN112558637A (zh) * | 2020-12-11 | 2021-03-26 | 西安航光卫星测控技术有限公司 | 无人机群中无人机对空中运动目标的规避方法 |
CN112783210A (zh) * | 2021-01-04 | 2021-05-11 | 中国人民解放军国防科技大学 | 无人机集群控制***的多目标控制参数调优方法 |
CN113325876A (zh) * | 2021-06-21 | 2021-08-31 | 四川大学 | 无人机诱导突防策略 |
CN113507339A (zh) * | 2021-06-01 | 2021-10-15 | 中国人民解放***箭军工程大学 | 一种基于群体行为特征的无人机蜂群反制方法 |
CN114115341A (zh) * | 2021-11-18 | 2022-03-01 | 中国人民解放军陆军工程大学 | 一种智能体集群协同运动方法及*** |
CN114980024A (zh) * | 2022-06-28 | 2022-08-30 | 安徽大学 | 一种基于离散种子优化算法的通信节点无人机网络部署方法 |
CN117608318A (zh) * | 2024-01-23 | 2024-02-27 | 北京航空航天大学 | 基于仿鸟类趋光性的无人机编队避障控制方法及*** |
Families Citing this family (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107807671B (zh) * | 2017-11-27 | 2018-08-14 | 中国人民解放军陆军工程大学 | 无人机集群危险规避方法 |
CN108415425B (zh) * | 2018-02-08 | 2020-10-30 | 东华大学 | 一种基于改进基因调控网络的分布式群机器人协同集群算法 |
CN108279704B (zh) * | 2018-02-09 | 2021-05-04 | 沈阳航空航天大学 | 一种增加通信链路的多无人机的协同控制策略 |
CN108398960B (zh) * | 2018-03-02 | 2021-01-26 | 南京航空航天大学 | 一种改进APF与分段Bezier相结合的多无人机协同目标追踪方法 |
CN108388270B (zh) * | 2018-03-21 | 2021-08-31 | 天津大学 | 面向安全域的集群无人机轨迹姿态协同控制方法 |
CN108549407B (zh) * | 2018-05-23 | 2020-11-13 | 哈尔滨工业大学(威海) | 一种多无人机协同编队避障的控制算法 |
CN108762300A (zh) * | 2018-05-31 | 2018-11-06 | 智飞智能装备科技东台有限公司 | 一种用于无人机组飞行的地面控制编程*** |
CN109000653B (zh) * | 2018-06-06 | 2020-05-05 | 西南交通大学 | 一种多维空间多载运工具路径智能优化方法 |
CN110737212B (zh) * | 2018-07-18 | 2021-01-01 | 华为技术有限公司 | 无人机控制***和方法 |
CN109062252B (zh) * | 2018-08-27 | 2021-05-25 | 中国人民解放军战略支援部队航天工程大学 | 基于人工势场法的四旋翼无人机集群控制方法及其装置 |
CN108983825B (zh) * | 2018-09-30 | 2020-04-03 | 北京航空航天大学 | 一种无人机时变编队的跟踪方法及*** |
CN109445459B (zh) * | 2018-10-25 | 2019-10-15 | 中国人民解放军战略支援部队航天工程大学 | 无人机集群编队控制方法及其装置 |
CN109116868B (zh) * | 2018-10-31 | 2021-07-13 | 中国人民解放军32181部队 | 分布式无人机编队协同控制方法 |
CN111352435B (zh) * | 2018-12-20 | 2021-07-16 | 中国科学院沈阳自动化研究所 | 一种无人机编队自主空中加油方法 |
CN110275527B (zh) * | 2019-05-29 | 2022-02-11 | 南京航空航天大学 | 一种基于改进拟态物理法的多智能体***运动控制方法 |
CN110320929B (zh) * | 2019-06-04 | 2022-03-29 | 杭州电子科技大学 | 一种自主式无人机群目标跟随避障方法 |
CN110502032B (zh) * | 2019-08-31 | 2021-10-26 | 华南理工大学 | 一种基于行为控制的无人机集群编队飞行方法 |
CN110554709A (zh) * | 2019-09-06 | 2019-12-10 | 哈尔滨工业大学(深圳) | 一种分布式的仿生的多智能体自主集群控制方法 |
CN110687920B (zh) * | 2019-10-28 | 2022-06-28 | 中国电子科技集团公司电子科学研究院 | 无人机集群编队控制方法、装置及储存介质 |
CN110989656A (zh) * | 2019-11-13 | 2020-04-10 | 中国电子科技集团公司第二十研究所 | 一种基于改进人工势场法的冲突解脱方法 |
CN111142562B (zh) * | 2019-12-27 | 2021-04-30 | 北京理工大学 | 基于应力矩阵的混合条件约束下的编队变换控制方法 |
CN111077909B (zh) * | 2019-12-31 | 2021-02-26 | 北京理工大学 | 一种基于视觉信息的新型无人机自组群自洽优化控制方法 |
CN111487995B (zh) * | 2020-04-30 | 2023-04-07 | 湖南科技大学 | 基于三维简化虚拟模型的群无人机多目标搜索协作方法 |
CN112034891B (zh) * | 2020-09-21 | 2022-03-29 | 北京邮电大学 | 飞行自组网移动性控制方法和装置 |
CN113536984B (zh) * | 2021-06-28 | 2022-04-26 | 北京沧沐科技有限公司 | 一种基于无人机的图像目标识别与跟踪*** |
CN117270393B (zh) * | 2023-10-07 | 2024-05-17 | 重庆大学 | 智能机器人集群协同控制*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090125165A1 (en) * | 2005-02-04 | 2009-05-14 | Airbus France | Method and device for piloting a pitching aircraft |
CN103329182A (zh) * | 2010-11-08 | 2013-09-25 | Cmte发展有限公司 | 用于人工指令***的碰撞避免***和方法 |
JP5775632B2 (ja) * | 2014-09-16 | 2015-09-09 | 株式会社トプコン | 飛行体の飛行制御システム |
CN105549617A (zh) * | 2016-01-13 | 2016-05-04 | 北京航空航天大学 | 一种仿鸟群行为和虚拟结构的无人机编队控制方法 |
CN105912004A (zh) * | 2016-06-23 | 2016-08-31 | 北京理工大学 | 无人机自主高速着舰辅助***及方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101694587B (zh) * | 2009-10-13 | 2011-08-17 | 清华大学 | 一种应用于微小型飞行器的集群控制*** |
CN102393747B (zh) * | 2011-08-17 | 2015-07-29 | 清华大学 | 无人机集群的协作交互方法 |
CN102707693B (zh) * | 2012-06-05 | 2015-03-04 | 清华大学 | 一种时空联合的多架无人机协同控制***的构建方法 |
CN103197684B (zh) * | 2013-04-25 | 2016-09-21 | 清华大学 | 无人机群协同跟踪目标的方法及*** |
CN104155998B (zh) * | 2014-08-27 | 2017-08-25 | 电子科技大学 | 一种基于势场法的航迹规划方法 |
JP2016079918A (ja) * | 2014-10-17 | 2016-05-16 | グレースマリー・ワールド株式会社 | 宇宙推進及び滞宙(成層圏上等の滞空)システム等 |
-
2017
- 2017-08-21 CN CN201710719448.2A patent/CN107340784B/zh not_active Expired - Fee Related
- 2017-08-21 CN CN201810178713.5A patent/CN108121358B/zh not_active Expired - Fee Related
- 2017-08-21 CN CN201810178712.0A patent/CN108196583B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090125165A1 (en) * | 2005-02-04 | 2009-05-14 | Airbus France | Method and device for piloting a pitching aircraft |
CN103329182A (zh) * | 2010-11-08 | 2013-09-25 | Cmte发展有限公司 | 用于人工指令***的碰撞避免***和方法 |
JP5775632B2 (ja) * | 2014-09-16 | 2015-09-09 | 株式会社トプコン | 飛行体の飛行制御システム |
CN105549617A (zh) * | 2016-01-13 | 2016-05-04 | 北京航空航天大学 | 一种仿鸟群行为和虚拟结构的无人机编队控制方法 |
CN105912004A (zh) * | 2016-06-23 | 2016-08-31 | 北京理工大学 | 无人机自主高速着舰辅助***及方法 |
Non-Patent Citations (5)
Title |
---|
ALESSANDRO BOMBELLI等: "Strategic Air Traffic Planning with Fréchet Distance Aggregation and Rerouting", 《JOURNAL OF GUIDANCE,CONTROL, AND DYNAMICS》 * |
M. BÄUMKER等: "ENHANCEMENTS IN UAV FLIGHT CONTROL AND SENSOR ORIENTATION", 《INTERNATIONAL ARCHIVES OF THE PHOTOGRAMMETRY, REMOTE SENSING AND SPATIAL INFORMATION SCIENCES》 * |
李磊等: "基于单位四元数的四旋翼编队反演控制方法", 《计算机测量与控制》 * |
毛琼等: "基于 PDA的无人机野战信息支援***研究", 《基于PDA的无人机野战信息支援***研究》 * |
苏立军等: "基于强化学习的四旋翼高度控制器设计", 《测控技术》 * |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109557936A (zh) * | 2018-12-03 | 2019-04-02 | 北京航空航天大学 | 基于人工势场法的可垂起无人机机间防碰撞控制方法 |
CN109557936B (zh) * | 2018-12-03 | 2020-07-07 | 北京航空航天大学 | 基于人工势场法的可垂起无人机机间防碰撞控制方法 |
CN109460064B (zh) * | 2019-01-03 | 2019-11-15 | 中国人民解放军战略支援部队航天工程大学 | 基于虚拟势场函数的无人机集群区域覆盖方法及其装置 |
CN109460064A (zh) * | 2019-01-03 | 2019-03-12 | 中国人民解放军战略支援部队航天工程大学 | 基于虚拟势场函数的无人机集群区域覆盖方法及其装置 |
CN110737281B (zh) * | 2019-10-15 | 2022-09-06 | 中国航空无线电电子研究所 | 一种面向集群无人机的分布式控制方法 |
CN110737281A (zh) * | 2019-10-15 | 2020-01-31 | 中国航空无线电电子研究所 | 一种面向集群无人机的分布式控制方法 |
CN111580093A (zh) * | 2020-05-25 | 2020-08-25 | 南京理工大学 | 用于探测无人机集群目标的雷达*** |
CN111522319A (zh) * | 2020-05-29 | 2020-08-11 | 南京航空航天大学 | 一种基于扩散模型使无人***生成群集性的分布式控制方法 |
CN112558637A (zh) * | 2020-12-11 | 2021-03-26 | 西安航光卫星测控技术有限公司 | 无人机群中无人机对空中运动目标的规避方法 |
CN112783210A (zh) * | 2021-01-04 | 2021-05-11 | 中国人民解放军国防科技大学 | 无人机集群控制***的多目标控制参数调优方法 |
CN112783210B (zh) * | 2021-01-04 | 2022-03-25 | 中国人民解放军国防科技大学 | 无人机集群控制***的多目标控制参数调优方法 |
CN113507339A (zh) * | 2021-06-01 | 2021-10-15 | 中国人民解放***箭军工程大学 | 一种基于群体行为特征的无人机蜂群反制方法 |
CN113507339B (zh) * | 2021-06-01 | 2022-08-12 | 中国人民解放***箭军工程大学 | 一种基于群体行为特征的无人机蜂群反制方法 |
CN113325876A (zh) * | 2021-06-21 | 2021-08-31 | 四川大学 | 无人机诱导突防策略 |
CN114115341A (zh) * | 2021-11-18 | 2022-03-01 | 中国人民解放军陆军工程大学 | 一种智能体集群协同运动方法及*** |
CN114115341B (zh) * | 2021-11-18 | 2022-11-01 | 中国人民解放军陆军工程大学 | 一种智能体集群协同运动方法及*** |
CN114980024A (zh) * | 2022-06-28 | 2022-08-30 | 安徽大学 | 一种基于离散种子优化算法的通信节点无人机网络部署方法 |
CN114980024B (zh) * | 2022-06-28 | 2023-10-13 | 安徽大学 | 一种基于离散种子优化算法的通信节点无人机网络部署方法 |
CN117608318A (zh) * | 2024-01-23 | 2024-02-27 | 北京航空航天大学 | 基于仿鸟类趋光性的无人机编队避障控制方法及*** |
CN117608318B (zh) * | 2024-01-23 | 2024-04-09 | 北京航空航天大学 | 基于仿鸟类趋光性的无人机编队避障控制方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN108121358B (zh) | 2020-08-28 |
CN108121358A (zh) | 2018-06-05 |
CN107340784A (zh) | 2017-11-10 |
CN108196583B (zh) | 2020-09-01 |
CN107340784B (zh) | 2018-04-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108196583A (zh) | 无人机集群控制方法 | |
CN108549407B (zh) | 一种多无人机协同编队避障的控制算法 | |
CN108594853A (zh) | 无人机队形控制方法 | |
CN104932526B (zh) | 一种飞行设备的控制方法及飞行设备 | |
CN109032168A (zh) | 一种基于dqn的多无人机协同区域监视的航路规划方法 | |
CN109521794A (zh) | 一种多无人机航路规划及动态避障方法 | |
CN108731684A (zh) | 一种多无人机协同区域监视的航路规划方法 | |
CN112068587B (zh) | 基于欧椋鸟通信机制的有人/无人机共融集***互方法 | |
Tang et al. | A joint global and local path planning optimization for UAV task scheduling towards crowd air monitoring | |
CN115951598A (zh) | 一种多无人机的虚实结合仿真方法、装置及*** | |
Natalizio et al. | Two families of algorithms to film sport events with flying robots | |
CN107807671A (zh) | 无人机集群危险规避方法 | |
Huo et al. | Live-fly experimentation for pigeon-inspired obstacle avoidance of quadrotor unmanned aerial vehicles | |
Hu et al. | Multi-UAV coverage path planning: A distributed online cooperation method | |
CN116301051A (zh) | 一种无人机集群控制与避障方法和装置 | |
Kwon et al. | Mathematical modeling for flocking flight of autonomous multi-UAV system, including environmental factors | |
Song et al. | Distributed swarm system with hybrid-flocking control for small fixed-wing UAVs: Algorithms and flight experiments | |
Schlecht et al. | Decentralized Search by Unmanned Air Vehicles Using Local Communication. | |
Park et al. | Multiple aerial vehicle formation using swarm intelligence | |
Bai et al. | Dynamic multi-UAVs formation reconfiguration based on hybrid diversity-PSO and time optimal control | |
Lu et al. | Research on trajectory planning in thunderstorm weather based on dynamic window algorithm during approach segment | |
Jamalipour et al. | Special issue on amateur drone and UAV communications and networks | |
Gowtham et al. | Simulation of multi UAV flight formation | |
Shao et al. | Situation Awareness Method and Simulation Test of UAVs and Observer Wards Air-Ground Cooperation | |
Shuriji et al. | Robots swarm communication control based on biological behavior inspiration |
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 | ||
CB03 | Change of inventor or designer information | ||
CB03 | Change of inventor or designer information |
Inventor after: Mao Qiong Inventor after: Xi Leiping Inventor after: Ma Yanheng Inventor after: Wang Zhengjun Inventor before: Mao Qiong |
|
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200901 Termination date: 20210821 |