CN108121358B - 无人机控制方法 - Google Patents
无人机控制方法 Download PDFInfo
- Publication number
- CN108121358B CN108121358B CN201810178713.5A CN201810178713A CN108121358B CN 108121358 B CN108121358 B CN 108121358B CN 201810178713 A CN201810178713 A CN 201810178713A CN 108121358 B CN108121358 B CN 108121358B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- drone
- target
- individual
- 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.)
- Expired - Fee Related
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
Abstract
本发明公开了一种无人机控制方法,涉及无人机技术领域。所述方法包括如下步骤:通过无人机集群群内部成员的空间位置、速度以及加速度构建无人机集群群内部成员模型;构建无人机集群群内部成员的加速度控制函数;通过构建的所述加速度控制函数实现对无人机集群群内部成员的群聚运动、朝向目标运动以及规避障碍运动进行控制。本发明所述方法在控制集群运动方面灵活性强,一致性好,控制与避障效果显著。
Description
本分案申请的原申请号为2017107194482,申请日为2017年08月21日,发明名称为“无人机集群控制方法”。
技术领域
本发明涉及无人机技术领域,尤其涉及一种无人机控制方法。
背景技术
多架无人机(Unmanned Aerial Vehicles,UAVs)彼此协同完成军事目标打击、目标跟踪与侦察等任务可大幅度减少任务执行的时间、提高作战的效率和成功率。随着作战环境的日趋复杂,不仅空间无人机的数量和密度上升,而且强电磁环境易使无人机通信致盲,以及潜在的突发障碍给无人机集群的飞行控制与安全带来一系列挑战,已成为一个亟待解决的问题。
无人机集群系统属于局部感知或通信的分布式体系结构,目前主要的控制方法有:基于局部规则的控制、软控制、领航跟随法和人工势场法。基于局部规则的控制方法最基础,能实现集群智能的涌现控制,但仅靠它难使集群涌现到期望的控制方向;软控制是在局部规则的基础上通过为集群加入一外部可控的个体引导群内其它个体朝着人们期望的方向运动;领航控制法利用集群中信息丰富的个体引导实现集群控制,现有技术中将掌握航迹信息的个体直接设为领导者,没考虑个体间在无直接通信的实际情况下如何辨识谁是领导者的问题;人工势场通过构建全局势场函数引导智能体向势能降低的方向运动,该方法简单实用,在避障方面有优势,但存在局部极值问题。综上,现有技术中的无人机控制方法普遍存在研究情况理想、方法使用各有利弊,存在灵活性不足、控制与避障效果不佳等问题。
发明内容
本发明所要解决的技术问题是如何提供一种活性强,一致性好,控制与避障效果显著的无人机集群运动控制方法。
为解决上述技术问题,本发明所采取的技术方案是:一种无人机控制方法,其特征在于包括如下步骤:
通过无人机集群群内部成员的空间位置、速度以及加速度构建无人机集群群内部成员模型;无人机集群是由N个个体组成的分布式系统,每个个体的运动可抽象为:
无人机飞行时存在以下约束:
加速度约束:
其中,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的作用力函数,fio为障碍O与无人机i之间的作用力函数,fi j为无人机j与无人机i的作用力函数,fi G为无人机i与选定的领导者无人机G之间的作用力;
通过构建的所述加速度控制函数实现对无人机集群群内部成员的群聚运动、朝向目标运动以及规避障碍运动进行控制;
所述无人机i朝向目标g运动的作用力函数fi g的构建方法如下:
1)所有个体均可获得航点信息
将无人机航迹分解成一系列序列位置点Track={T1,T2,...Tm},随时间由机载或地面控制站的广播式自动相关监视系统发射端逐个发送,设集群内部每架无人机可通过机载广播式自动相关监视系统接收端实时接收广播式自动相关监视系统发射端发送的航点位置、速度,个体与当前航点的位置偏差为构造目标g与无人机i之间的作用力函数fi g如下:
其中: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之间播发的时间间隔为Δt,k=1...m-1,则目标航点在该航迹段的飞行速度vg为为无人机i和目标g之间的作用强度控制系数,rτ为目标g与无人机i之间的引力形式发生变化的分界距离;
2)少部分个体可获得航点信息
在少部分个体可获得航点信息的情况下,对于能获得航迹信息的个体,按着1)中描述的方法产生作用力fi g;对于不能获得航点信息的个体i,则采用以下方法选出邻域内运动速度变化最快的个体G:
其中,表示无人机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的位置Pi、PG根据(12)式求解,无人机i和无人机G之间的距离由无人机i和无人机G的速度vi、vG产生的作用力为(11)式中等号右侧的第二项;dr为引力与斥力的分界距离,dr+rτ为目标无人机个体G与无人机i之间的引力形式发生变化的分界距离;为无人机i和无人机G之间的斥力强度控制系数、为距离调节参数、均为无人机i和无人机G之间的引力强度控制系数,为无人机i和无人机G之间的速度一致性控制系数,和可先给定一初值,再在系统实验时进一步调节。
采用上述技术方案所产生的有益效果在于:所述方法首先通过将局部规则与势场法融合产生了一种新的控制函数,并结合软控制方法控制虚拟的目标航点的运动成功引导个体实现了聚集和集群的飞行控制,对未知突发障碍在有限视觉感知的基础上提出“探测即规避”的避障策略;其次,针对电磁环境只有部分个体能正常接收航迹信息的情况,采用邻域辨识的方法为未接收到航迹信息的个体选定目标个体进行跟随,实现期望的集群运动。本发明所述方法在控制集群运动方面控制简单、考虑的情形比较接近实际情况、灵活性强,一致性好,控制与避障效果显著。
附图说明
下面结合附图和具体实施方式对本发明作进一步详细的说明。
图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可表示为:
上式中γ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之间的距离。
其中: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、仿真实验验证
为方便进行结果分析,下面对三维空间的无人机集群飞行与障碍规避进行仿真验证。按个体能否接收航点信息,仿真实验主要从以下几方面展开:
情形一:无人机集群内部个体均能获得实时航迹信息,且飞行空间无障碍设集群内部无人机个体数为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个个体组成的分布式系统,每个个体的运动可抽象为:
无人机飞行时存在以下约束:
加速度约束:
其中,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之间的作用力;
通过构建的所述加速度控制函数实现对无人机集群群内部成员的群聚运动、朝向目标运动以及规避障碍运动进行控制;
目标g与无人机i之间的作用力fi g的构建方法如下:
1)所有个体均可获得航点信息
将无人机航迹分解成一系列序列位置点Track={T1,T2,...Tm},随时间由机载或地面控制站的广播式自动相关监视系统发射端逐个发送,设集群内部每架无人机可通过机载广播式自动相关监视系统接收端实时接收广播式自动相关监视系统发射端发送的航点位置、速度,个体与当前航点的位置偏差为构造目标g与无人机i之间的作用力fi g如下:
其中: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之间播发的时间间隔为Δt,k=1...m-1,则目标航点在该航迹段的飞行速度vg为 为无人机i和目标g之间的作用强度控制系数,rτ为目标g与无人机i之间的引力形式发生变化的分界距离;
2)少部分个体可获得航点信息
在少部分个体可获得航点信息的情况下,对于能获得航迹信息的个体,按着1)中描述的方法产生作用力fi g;对于不能获得航点信息的个体i,则采用以下方法选出邻域内运动速度变化最快的个体G:
其中,表示无人机j在t时刻和t-τ时刻都在无人机i的邻域内,τ为个体i前后两次对邻域内的个体位置进行观察的时间间隔,Δj表示τ时间段内无人机j的位置变化量,为无人机j在t时刻的位置,为无人机j在t-τ时刻的位置;个体i采用(10)式所述的方法从邻域中辨识出速度最快的个体G后,把它当作目标进行追随,二者之间通过以下函数作用:
其中:fi G为无人机i与选定的领导无人机G之间的作用力,由无人机i和无人机G的位置Pi、PG和速度vi、vG决定;决定的方法如下:表示该作用力的方向,为单位方向矢量,Fi G为该作用力的大小,由无人机i和无人机G的位置Pi、PG根据(12)式求解,无人机i和无人机G之间的距离由无人机i和无人机G的速度vi、vG产生的作用力为(11)式中等号右侧的第二项;dr为引力与斥力的分界距离,dr+rτ为目标无人机个体G与无人机i之间的引力形式发生变化的分界距离;为无人机i和无人机G之间的斥力强度控制系数、为距离调节参数、均为无人机i和无人机G之间的引力强度控制系数,为无人机i和无人机G之间的速度一致性控制系数,和可先给定一初值,再在系统实验时进一步调节。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810178713.5A CN108121358B (zh) | 2017-08-21 | 2017-08-21 | 无人机控制方法 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710719448.2A CN107340784B (zh) | 2017-08-21 | 2017-08-21 | 无人机集群控制方法 |
CN201810178713.5A CN108121358B (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 |
---|---|
CN108121358A CN108121358A (zh) | 2018-06-05 |
CN108121358B true CN108121358B (zh) | 2020-08-28 |
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 (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710719448.2A Expired - Fee Related CN107340784B (zh) | 2017-08-21 | 2017-08-21 | 无人机集群控制方法 |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810178712.0A Expired - Fee Related CN108196583B (zh) | 2017-08-21 | 2017-08-21 | 无人机集群控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (3) | CN107340784B (zh) |
Families Citing this family (37)
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部队 | 分布式无人机编队协同控制方法 |
CN109557936B (zh) * | 2018-12-03 | 2020-07-07 | 北京航空航天大学 | 基于人工势场法的可垂起无人机机间防碰撞控制方法 |
CN111352435B (zh) * | 2018-12-20 | 2021-07-16 | 中国科学院沈阳自动化研究所 | 一种无人机编队自主空中加油方法 |
CN109460064B (zh) * | 2019-01-03 | 2019-11-15 | 中国人民解放军战略支援部队航天工程大学 | 基于虚拟势场函数的无人机集群区域覆盖方法及其装置 |
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 | 哈尔滨工业大学(深圳) | 一种分布式的仿生的多智能体自主集群控制方法 |
CN110737281B (zh) * | 2019-10-15 | 2022-09-06 | 中国航空无线电电子研究所 | 一种面向集群无人机的分布式控制方法 |
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 | 湖南科技大学 | 基于三维简化虚拟模型的群无人机多目标搜索协作方法 |
CN111580093B (zh) * | 2020-05-25 | 2022-11-04 | 南京理工大学 | 用于探测无人机集群目标的雷达系统 |
CN111522319A (zh) * | 2020-05-29 | 2020-08-11 | 南京航空航天大学 | 一种基于扩散模型使无人系统生成群集性的分布式控制方法 |
CN112034891B (zh) * | 2020-09-21 | 2022-03-29 | 北京邮电大学 | 飞行自组网移动性控制方法和装置 |
CN112558637B (zh) * | 2020-12-11 | 2022-11-25 | 西安航光卫星测控技术有限公司 | 无人机群中无人机对空中运动目标的规避方法 |
CN112783210B (zh) * | 2021-01-04 | 2022-03-25 | 中国人民解放军国防科技大学 | 无人机集群控制系统的多目标控制参数调优方法 |
CN113507339B (zh) * | 2021-06-01 | 2022-08-12 | 中国人民解放军火箭军工程大学 | 一种基于群体行为特征的无人机蜂群反制方法 |
CN113325876B (zh) * | 2021-06-21 | 2022-04-05 | 四川大学 | 无人机诱导突防策略 |
CN113536984B (zh) * | 2021-06-28 | 2022-04-26 | 北京沧沐科技有限公司 | 一种基于无人机的图像目标识别与跟踪系统 |
CN114115341B (zh) * | 2021-11-18 | 2022-11-01 | 中国人民解放军陆军工程大学 | 一种智能体集群协同运动方法及系统 |
CN114980024B (zh) * | 2022-06-28 | 2023-10-13 | 安徽大学 | 一种基于离散种子优化算法的通信节点无人机网络部署方法 |
CN117608318B (zh) * | 2024-01-23 | 2024-04-09 | 北京航空航天大学 | 基于仿鸟类趋光性的无人机编队避障控制方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103329182A (zh) * | 2010-11-08 | 2013-09-25 | Cmte发展有限公司 | 用于人工指令系统的碰撞避免系统和方法 |
CN104155998A (zh) * | 2014-08-27 | 2014-11-19 | 电子科技大学 | 一种基于势场法的航迹规划方法 |
JP5775632B2 (ja) * | 2014-09-16 | 2015-09-09 | 株式会社トプコン | 飛行体の飛行制御システム |
CN105549617A (zh) * | 2016-01-13 | 2016-05-04 | 北京航空航天大学 | 一种仿鸟群行为和虚拟结构的无人机编队控制方法 |
CN105912004A (zh) * | 2016-06-23 | 2016-08-31 | 北京理工大学 | 无人机自主高速着舰辅助系统及方法 |
CN107208612A (zh) * | 2014-10-17 | 2017-09-26 | 格雷斯玛丽世界株式会社 | 宇宙推进和航天飞行(平流层上等处的航空飞行)系统 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2881849B1 (fr) * | 2005-02-04 | 2007-04-06 | Airbus France Sas | Procede et dispositif de pilotage d'un avion en tangage |
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 | 清华大学 | 无人机群协同跟踪目标的方法及系统 |
-
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 (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103329182A (zh) * | 2010-11-08 | 2013-09-25 | Cmte发展有限公司 | 用于人工指令系统的碰撞避免系统和方法 |
CN104155998A (zh) * | 2014-08-27 | 2014-11-19 | 电子科技大学 | 一种基于势场法的航迹规划方法 |
JP5775632B2 (ja) * | 2014-09-16 | 2015-09-09 | 株式会社トプコン | 飛行体の飛行制御システム |
CN107208612A (zh) * | 2014-10-17 | 2017-09-26 | 格雷斯玛丽世界株式会社 | 宇宙推进和航天飞行(平流层上等处的航空飞行)系统 |
CN105549617A (zh) * | 2016-01-13 | 2016-05-04 | 北京航空航天大学 | 一种仿鸟群行为和虚拟结构的无人机编队控制方法 |
CN105912004A (zh) * | 2016-06-23 | 2016-08-31 | 北京理工大学 | 无人机自主高速着舰辅助系统及方法 |
Non-Patent Citations (6)
Title |
---|
M. Bäumker等.ENHANCEMENTS IN UAV FLIGHT CONTROL AND SENSOR ORIENTATION.《International Archives of the Photogrammetry, Remote Sensing and Spatial Information Sciences》.2013,第33-38页. * |
Strategic Air Traffic Planning with Fréchet Distance Aggregation and Rerouting;Alessandro Bombelli等;《JOURNAL OF GUIDANCE,CONTROL, AND DYNAMICS》;20170531;第40卷(第5期);第1117-1129页 * |
UAV集群自组织飞行建模与控制策略研究;孙强等;《系统工程与电子技术》;20160731;第38卷(第7期);第1649-1653页 * |
基于 PDA的无人机野战信息支援系统研究;毛琼等;《基于PDA的无人机野战信息支援系统研究》;20080229;第24卷(第2-2期);第57-58、104页 * |
基于单位四元数的四旋翼编队反演控制方法;李磊等;《计算机测量与控制》;20160229(第2期);第64-67页 * |
基于强化学习的四旋翼高度控制器设计;苏立军等;《测控技术》;20161031;第35卷(第10期);第51-53、58页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108121358A (zh) | 2018-06-05 |
CN107340784A (zh) | 2017-11-10 |
CN108196583A (zh) | 2018-06-22 |
CN107340784B (zh) | 2018-04-17 |
CN108196583B (zh) | 2020-09-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108121358B (zh) | 无人机控制方法 | |
CN108549407B (zh) | 一种多无人机协同编队避障的控制算法 | |
Qiu et al. | A multi-objective pigeon-inspired optimization approach to UAV distributed flocking among obstacles | |
CN108594853B (zh) | 无人机队形控制方法 | |
Ross et al. | Learning monocular reactive uav control in cluttered natural environments | |
CN109726804B (zh) | 一种基于行车预测场和bp神经网络的智能车辆驾驶行为拟人化决策方法 | |
Qiu et al. | Pigeon interaction mode switch-based UAV distributed flocking control under obstacle environments | |
CN103576692A (zh) | 一种多无人机协同飞行方法 | |
CN111158393B (zh) | 一种无人机的控制方法、装置、电子设备及存储介质 | |
Wan et al. | Distributed conflict-detection and resolution algorithm for UAV swarms based on consensus algorithm and strategy coordination | |
CN111077909B (zh) | 一种基于视觉信息的新型无人机自组群自洽优化控制方法 | |
US20220155732A9 (en) | System and Method of Efficient, Continuous, and Safe Learning Using First Principles and Constraints | |
Zhang | Unmanned aerial vehicle formation inspired by bird flocking and foraging behavior | |
Sun et al. | Cooperative strategy for pursuit-evasion problem in the presence of static and dynamic obstacles | |
Isakhani et al. | A furcated visual collision avoidance system for an autonomous microrobot | |
CN112034880A (zh) | 一种新型多无人机协同航路规划方法 | |
Chen et al. | Flocking control algorithms based on the diffusion model for unmanned aerial vehicle systems | |
CN116203989A (zh) | 基于粒子群算法的多无人机协同目标搜索方法及系统 | |
CN116301051A (zh) | 一种无人机集群控制与避障方法和装置 | |
Bai et al. | Dynamic multi-UAVs formation reconfiguration based on hybrid diversity-PSO and time optimal control | |
Albaba et al. | A 3D game theoretical framework for the evaluation of unmanned aircraft systems airspace integration concepts | |
CN113759935B (zh) | 基于模糊逻辑的智能群体编队移动控制方法 | |
Caruntu et al. | A concept of multiple-lane vehicle grouping by swarm intelligence | |
Zhou et al. | Taxiing speed intelligent management of aircraft based on DQN for A-SMGCS | |
CN113485454A (zh) | 几何改进人工势场的无人机避障机动方法和系统 |
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: Dong Hairui 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: 20200828 Termination date: 20210821 |