CN110162093A - 一种基于几何相似性设计的高适应性编队控制方法 - Google Patents
一种基于几何相似性设计的高适应性编队控制方法 Download PDFInfo
- Publication number
- CN110162093A CN110162093A CN201910510362.8A CN201910510362A CN110162093A CN 110162093 A CN110162093 A CN 110162093A CN 201910510362 A CN201910510362 A CN 201910510362A CN 110162093 A CN110162093 A CN 110162093A
- Authority
- CN
- China
- Prior art keywords
- level
- formation
- host node
- intelligent body
- node
- 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
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 122
- 238000000034 method Methods 0.000 title claims abstract description 19
- 238000013461 design Methods 0.000 title claims abstract description 18
- 238000001514 detection method Methods 0.000 claims abstract description 16
- 238000004891 communication Methods 0.000 claims abstract description 12
- 238000011217 control strategy Methods 0.000 claims abstract description 12
- 230000004888 barrier function Effects 0.000 claims abstract description 5
- 230000001133 acceleration Effects 0.000 claims description 65
- 230000033001 locomotion Effects 0.000 claims description 42
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000000694 effects Effects 0.000 claims description 6
- 238000013519 translation Methods 0.000 abstract description 13
- 230000006978 adaptation Effects 0.000 abstract description 2
- 230000003993 interaction Effects 0.000 abstract 1
- 239000003795 chemical substances by application Substances 0.000 description 7
- 230000005540 biological transmission Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 6
- 239000007787 solid Substances 0.000 description 3
- 230000003044 adaptive effect Effects 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 238000012512 characterization method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000035800 maturation Effects 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012876 topography 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)
Abstract
本发明涉及一种基于几何相似性设计的高适应性编队控制方法。首先,根据几何相似性设计了一种可用于平移、伸缩和旋转等相似变化的编队构型,给出了期望编队构型下各智能体间的几何关系约束;然后,在此基础上考虑各智能体对障碍物和非合作威胁智能体等威胁的检测需要,确定了各智能体通信和测量配置;最后,针对不同任务背景下的编队安全控制和机动控制需要,依次给出了各智能体安全控制策略和平移、伸缩和旋转等相似变化对应的编队机动控制策略。本发明基于编队局部交互通信信息实现了编队期望构型的控制,同时使编队具备平移、伸缩和旋转等适应变化的能力。
Description
技术领域
本发明属于多智能体系统协同控制技术领域,特别涉及一种基于几何相似性设计的高适应性编队控制方法。
背景技术
近年来,多智能体系统由于自主性强和灵活度高等突出优点而在许多领域呈现出广泛应用潜力和巨大发展前景。在民用领域,以多星编队和多无人机编队为代表的多智能体系统广泛应用于地形地貌测绘、环境监测和抗灾救险搜救等任务,避免了传统单智能体任务执行模式下的性能要求高、可靠性差、容错性低和适用任务范围窄等缺陷;在军事领域,随着多无人机协同和多弹协同等智能体协同技术的成熟,蜂群作战和饱和打击等新型作战理念不断涌现,传统作战模式将被彻底改变。基于此,世界各主要大国为进一步巩固和提高自身的经济和军事实力,均不断对多智能体系统技术发展加大技术攻关力度。
编队是多智能体系统协同的一种重要形式,利用几何关系约束是设计编队构型的一种重要方法。目前根据具体几何约束量,可将基于几何关系约束的主要编队类型分为四类:基于绝对位置约束、基于相对位置约束、基于相对距离约束和基于相对方位约束。受几何约束量性质影响,以上四类编队呈现出不同的适应性能。具体而言,绝对位置约束型编队不能进行任何适应性变化,相对位置约束型编队可进行平移变化、相对距离约束型编队可进行平移和旋转变化,相对方位约束型编队可进行平移和伸缩变化。因此,编队构型的设计需结合具体任务对编队适应性能的要求。
为在复杂环境下执行多样化任务,编队必须具备较高的适应性能。如对于搜索、侦查和监视等常见的编队应用场景,任务执行过程中要求编队搜索、侦查和监视的范围和位置会持续变化,这要求编队需同时具备平移、伸缩和旋转等适应性能。目前,主要研究的编队类型均不同时具备以上这些适应能力,而只能在任务执行过程中通过切换编队构型,完成以上适应性变化,但这加大了通信协调的复杂度,也对控制可靠性提出了更高的要求。
发明内容
本发明提出一种基于几何相似性设计的高适应性编队控制方法,可基于编队局部交互通信信息实现编队期望构型的控制,同时使编队具备平移、伸缩和旋转等适应变化的能力。
本发明包括下列步骤:
S1:设计编队构型,确定主节点智能体和各智能体间的几何约束
S2:根据几何约束,确定智能体间的通信配置;结合智能体安全控制需求,确定智能体的威胁检测配置;
S3:规划编队航迹,并在任务执行前加载到一级主节点智能体;
S4:任务执行过程中,若一级主节点判定任务执行完毕,执行步骤S8,否则执行下一步;
S5:任务执行过程中,各智能体进行威胁检测;各智能体结合威胁检测信息,生成对应于智能体安全规避的加速度和其在智能体最终控制输入的权重;
S6:任务执行过程中,一级主节点智能体依据预加载编队航迹,生成对应于编队机动控制的加速度;同时判定当前任务机动模式,确定二级、三级主节点期望位置和速度;二级、三级和从节点智能体结合期望位置、速度或者几何约束生成对应于编队机动控制的加速度;
S7:任务执行过程中,各智能体综合编队安全规避加速度和机动控制加速度,生成控制输入加速度;
S8:各智能体执行控制输入加速度,然后返回步骤S4;
S9:任务执行完毕,各智能体停止运动。
进一步地,所述S1中具体步骤为:
假设编队由n个节点组成,其中n≥3,分别编号为v1、v2,……vn;所述节点表征不同的实体;
对于在三维空间下运动的编队,定义v1为一级主节点,v2为二级主节点,v3为三级主节点,v1、v2、……vn-3为从节点,夹角表示期望编队构型下节点vj和vk相对于vi的夹角,比值表示期望编队构型下节点vj和vk相对于vi的距离比值lij/lik;对节点v3指定相对于v1和v2的夹角约束φ132和边约束l31/l32,节点v3、v4,……vn共指定nφ-1个夹角约束和nl-1个边约束;对各夹角约束编号为各边约束编号为r1*、定义约束函数Fφl为:
定义为各节点的位置,约束函数Fφl对的梯度矩阵记为:
为保证满足约束的编队构型与期望构型相似,梯度矩阵的秩需满足:
rank(Rφl)=3n-7 3
对于在二维平面下运动的编队,定义v1和v2为一级和二级主节点,其余节点v3、v4,……vn为从节点;对v3、v4,……vn指定nφ个夹角约束和nl个边约束;利用各夹角和边约束,同样可定义约束函数Fφl,且为保证满足约束的编队构型与期望构型相似,Fφl应满足:
进一步地,所述S2中,
智能体间的通信配置包括,定义与节点有夹角约束或者边约束的节点为的相邻节点,主节点间能相互通信以获得彼此的位置和速度信息,从节点能与其相邻节点和相邻节点的相邻节点通信以获得它们的位置和速度信息;
智能体间的危险检测配置包括,各智能体配置测量设备,测量危险障碍物或者非合作智能体的状态特性;
进一步地,所述S5中包括:
根据智能体与威胁的相对距离ri,o,设计各智能体安全规避加速度在其控制输入中的权重取值km,i:
其中,对于三维空间下运动的编队,图中ri,d1、ri,d2和ri,d3表示的是以智能体几何中心为球心的球形区域,而对于二维平面下运动的编队,ri,d1、ri,d2和ri,d3表示的是以智能体几何中心为圆心的圆形区域。ri,o≤ri,d1表示智能体将会与障碍物或者非合作智能体发生碰撞的距离范围;ri,d2≥ri,o>ri,d1表示智能体将以保证智能体安全为唯一控制目的的距离范围;ri,d3≥ri,o>ri,d2表示智能体将兼顾智能体安全和任务执行双重目的的距离范围。ri,d2和ri,d3根据各智能体控制能力确定,ri,d1由各智能体尺寸大小决定;
根据智能体与威胁的相对运动状态,设计各智能体的安全规避加速度:
其中表示垂直于ri,o的单位方向向量,tgo,i,o为智能体与威胁碰撞的剩余飞行时间,可近似为:
进一步地,所述S6中包括:
当一级主节点根据加载的期望航迹信息判定当前编队应处于平移运动模式时,一级主节点将采用以下的指令加速度形式:
其中和为一级主节点在t时刻对应的期望位置和速度信息,p1(t)和v1(t)为t时刻的位置和速度,um,1为一级主节点的指令加速度,k1,1和k1,2为大于0的比例系数;
同时,一级主节点向二级主节点发送当前处于平移这一运动模式信息、二级主节点的期望位置,此时可令二级主节点的指令加速度形式为:
对于三维空间下的编队,一级主节点还需向三级主节点发送其当前处于平移这一运动模式形式,同时结合夹角约束φ132、边约束l31/l32和当前编队的期望指向确定三级主节点的期望位置,此时可令三级主节点的指令加速度形式为:
对于编队中的从节点,其指令加速度形式为:
对上式分解后可得um,4、um,5……,um,n的形式,式中kp和kv为大于0的比例系数;
分别定义ps、pr、Rφl,ss和Rφl,sr为:
基于此控制策略,编队将整体以定常速度vc进行平移运动;
当一级主节点根据加载的期望航迹信息判定当前编队应处于平移运动模式时,一级主节点将采取11式所示的指令加速度形式;
同时,一级主节点向二级主节点发送当前处于伸缩这一运动模式信息、二级主节点的期望位置,二级主节点将采取如下形式的指令加速度:
为达到编队整体伸缩的效果,一级主节点和二级主节点运动速度指令为:
其中α1、是常值且满足为期望编队构型所在位置的中心,可表示为:
对于三维空间下的编队,一级主节点还需向三级主节点告知其当前处于伸缩这一运动模式形式,同时结合夹角约束φ132、边约束l31/l32和当前编队的期望指向确定三级主节点的期望位置;三级主节点的指令加速度形式如13式所示;
从节点运动加速度指令如14式所示,此时,基于此编队控制策略,编队将保持中心不变,定常速度向中心收敛;
当一级主节点根据预设航迹信息判定当前编队应处于旋转运动模式时,一级主节点的指令加速度形式如11式所示;
同时,一级主节点向二级主节点发送当前处于旋转这一运动模式信息、二级主节点的期望位置,此时可令二级主节点的指令加速度形式如16所示;为达到编队整体旋转的效果,对于二维平面下运动的编队,一级主节点和二级主节点的期望速度形式应满足:
其中α1、是常值且满足M2×2(x)表示是欧拉角旋转矩阵:
对于三维空间下运动的编队,记旋转角速度大小为ω,方向单位矢量为er,则编队为达到期望旋转效果,令一级主节点、二级主节点和三级主节点的速度分别为:
其中“×”表示矢量的叉乘;
从节点运动加速度指令仍然如式14所示。此时,基于此编队控制策略,编队将保持中心不变,以角速度ω旋转,角速度方向为er。
进一步地,k1,1取值1、k1,2取值2,kp取值1和kv取值2。
本发明将基于几何相似的性质设计一种新型编队构型,使编队构型约束对平移、伸缩和旋转等操作具有不变性,然后在此基础上,本发明将进一步结合编队在复杂环境下的任务执行需要,提出多智能体协同进行平移、伸缩、旋转和避障等操作对应的控制律。
附图说明
图1本发明编队控制方法流程图;
图2夹角约束和边约束示意图;
图3智能体威胁检测示意图;
图4威胁目标完全落在目标视场范围示意图;
图5威胁目标只占目标视场局部范围示意图;
图6威胁目标占满目标视场范围示意图。
具体实施方式
下面将结合附图对本发明进行详细的阐述。
由几何学中的相似定义知,若一几何体是由另一几何体通过平移、伸缩或旋转变化得到,则两几何体相似。基于此,本发明将基于几何相似的性质设计一种新型编队构型,使编队构型约束对平移、伸缩和旋转等操作具有不变性,然后在此基础上,本发明将进一步结合编队在复杂环境下的任务执行需要,提出多智能体协同进行平移、伸缩、旋转和避障等操作对应的控制律。
如图1所示,本发明方法有如下步骤:
第一步:设计编队构型,确定主节点智能体和各智能体间的几何约束
第二步:根据几何约束,确定智能体间的通信配置;结合智能体安全控制需求,确定智能体的威胁检测配置;
第三步:规划编队航迹,并在任务执行前加载到一级主节点智能体;
第四步:任务执行过程中,若一级主节点判定任务执行完毕,执行步骤S8,否则执行下一步;
第五步:任务执行过程中,各智能体进行威胁检测;各智能体结合威胁检测信息,生成对应于智能体安全规避的加速度和其在智能体最终控制输入的权重;
第六步:任务执行过程中,一级主节点智能体依据预加载编队航迹,生成对应于编队机动控制的加速度;同时判定当前任务机动模式,确定二级、三级主节点期望位置和速度;二级、三级和从节点智能体结合期望位置、速度或者几何约束生成对应于编队机动控制的加速度;
第七步:任务执行过程中,各智能体综合编队安全规避加速度和机动控制加速度,生成控制输入加速度;
第八步:各智能体执行控制输入加速度,然后返回步骤S4;
第九步:任务执行完毕,各智能体停止运动。
一.编队构型配置
假设编队由n(n≥3)个节点组成,分别编号为v1、v2,……vn,这里编队中的每一个节点可结合具体任务表征不同的实体,如无人机、无人车和机器人等。以三维空间下运动的编队为例,定义v1为一级主节点,v2为二级主节点,v3为三级主节点,v1、v2、……vn-3为从节点,夹角表示期望编队构型下节点vj和vk相对于vi的夹角,比值表示期望编队构型下节点vj和vk相对于vi的距离比值lij/lik,如图2所示。对节点v3指定相对于v1和v2的夹角约束φ132和边约束l31/l32,节点v3、v4,……vn共指定nφ-1个夹角约束和nl-1个边约束。方便起见,对各夹角约束编号为各边约束编号为r1 *、定义约束函数Fφl为:
定义为各节点的位置,约束函数Fφl对的梯度矩阵记为:
为保证满足约束的编队构型与期望构型相似,梯度矩阵的秩需满足:
rank(Rφl)=3n-7 3
对于在二维平面下运动的编队,定义v1和v2为一级和二级主节点,其余节点v3、v4,……vn为从节点。对v3、v4,……vn指定nφ个夹角约束和nl个边约束。利用各夹角和边约束,同样可定义约束函数Fφl,且为保证满足约束的编队构型与期望构型相似,Fφl应满足:
二.智能体通信和测量配置
定义与节点vi有夹角约束或者边约束的节点为vi的相邻节点,如图1中的vj和vk。为提供编队控制所需要的信息,这里首先要求主节点间能相互通信以获得彼此的位置和速度信息,从节点能与其相邻节点和相邻节点的相邻节点通信以获得它们的位置和速度信息。
同时,考虑到编队飞行期间,各智能体可能会遭遇障碍物、失效智能体或者非合作智能体引起的碰撞风险,为保证各智能体安全,这里要求各智能体配置有光学或者微波等测量设备,以及时检测到危险,并测量或估计到危险障碍物或者非合作智能体的状态特性,如位置、速度和大小规模等信息。
三.编队任务执行控制策略
假设智能体的运动模型可近似为:
其中和ui表示各智能体的速度和加速度控制输入,对于三维空间和二维平面下运动的编队,加速度控制输入分别有和
考虑到各智能体需同时满足编队任务执行和安全保障两方面需求,这里定义编队智能体的控制输入形式为:
ui=km,ium,i+(1-km,i)uo,i 6
其中um对应于智能体保持编队构型或者按预定航迹飞行等编队具体任务的加速度指令,uo对应于智能体规避威胁、保证自身安全的加速度指令,km,i取值范围是0≤km,i≤1,表示编队任务控制的权重。
下面将依次给出km,i、uo和um的确定方法。
3.1威胁检测与规避
图3给出了智能体的威胁检测示意图。对于三维空间下运动的编队,图中ri,d1、ri,d2和ri,d3表示的是以智能体几何中心为球心的球形区域,而对于二维平面下运动的编队,ri,d1、ri,d2和ri,d3表示的是以智能体几何中心为圆心的圆形区域。若智能体受其配置的威胁检测设备能力限制,仅能对其运动方向的威胁进行检测,如图3所示的前视区域。当智能体与威胁的相对距离ri,o处于范围ri,o≤ri,d1时,智能体将会与障碍物或者非合作智能体发生碰撞;当ri,o处于范围ri,d2≥ri,o>ri,d1时,智能体将以保证智能体安全为唯一控制目的;当ri,o处于范围ri,d3≥ri,o>ri,d2时,智能体将兼顾智能体安全和任务执行双重目的。对应于ri,d1、ri,d2和ri,d3的定义,可按如下设计控制权重km,i的取值:
考虑到各智能体的控制能力限制,不同运动速度的智能体将需要不同的ri,d2和ri,d3,以保证其有足够的规避反应时间。基于此,本发明利用剩余运动时间定义ri,d2和ri,d3:
其中tgo,i,2和tgo,i,3可由智能体的控制性能进一步确定。ri,d1由智能体的尺寸大小确定,可由智能体的包络球/圆半径确定。
对检测到威胁的智能体,设计uo形式如下:
其中表示垂直于ri,o的单位方向向量,tgo,i,o为智能体与威胁碰撞的剩余飞行时间,可近似为:
其中vi,o表示智能体相对于威胁的相对速度,vi,o·er,i,o表示相对速度在相对距离方向上的分量。注意到可能存在vi,o·er,i,o<0的情况,此时智能体实际上是在远离威胁,不需要采取避碰措施。
在三维空间或者二维平面内,垂直于ri,o的单位方向向量指向并不唯一。因此,为避免歧义性,这里将分情况讨论的指向。当威胁目标完全落在目标的视场范围内,或者只占视场的局部范围内时,如图4和图5所示,此时定义指向危险目标在智能体视场范围一侧的反向,如图4和图5中er,i,o所示指向。当威胁目标占满视场范围,如图6所示,此时智能体无法确定哪一个方向是捷径。方便起见,定义逆时针指向为正。
3.2编队机动控制
任务执行前,首先需要结合任务为一级主节点智能体规划出一条预设航迹,包括不同时刻的期望位置和速度等信息。任务执行过程中,编队将在一级主节点的引领下完成平移、伸缩和旋转等常见的机动变化。本发明将针对此三种机动模式依次给出各智能体的机动控制策略,生成对应式6中的加速度um。
3.2.1编队平移
当一级主节点根据加载的期望航迹信息判定当前编队应处于平移运动模式时,一级主节点将采用以下的指令加速度形式:
其中和为一级主节点在t时刻对应的期望位置和速度信息,p1(t)和v1(t)为t时刻的位置和速度,um,1为一级主节点的指令加速度。
同时,一级主节点向二级主节点发送当前处于平移这一运动模式信息、二级主节点的期望位置,此时可令二级主节点的指令加速度形式为:
对于三维空间下的编队,一级主节点还需向三级主节点发送其当前处于平移这一运动模式形式,同时结合夹角约束φ132、边约束l31/l32和当前编队的期望指向确定三级主节点的期望位置,此时可令三级主节点的指令加速度形式为:
对于编队中的从节点,其指令加速度形式为:
对上式分解后可得um,4、um,5……,um,n的形式。式中kp>0和kv>0表示比例系数(取值分别为1和2),分别定义ps、pr、Rφl,ss和Rφl,sr为:
基于此控制策略,编队将整体以定常速度vc进行平移运动。
3.2.2编队伸缩
当一级主节点根据加载的期望航迹信息判定当前编队应处于平移运动模式时,一级主节点将采取11式所示的指令加速度形式。
同时,一级主节点向二级主节点发送当前处于伸缩这一运动模式信息、二级主节点的期望位置,二级主节点将采取如下形式的指令加速度:
为达到编队整体伸缩的效果,一级主节点和二级主节点运动速度指令为:
其中α1、是常值且满足为期望编队构型所在位置的中心,可表示为:
对于三维空间下的编队,一级主节点还需向三级主节点告知其当前处于伸缩这一运动模式形式,同时结合夹角约束φ132、边约束l31/l32和当前编队的期望指向确定三级主节点的期望位置。三级主节点的指令加速度形式如13式所示。
从节点运动加速度指令仍然如14式所示。此时,基于此编队控制策略,编队将保持中心不变,定常速度向中心收敛。
3.2.3编队旋转
当一级主节点根据预设航迹信息判定当前编队应处于旋转运动模式时,一级主节点的指令加速度形式如11式所示。
同时,一级主节点向二级主节点发送当前处于旋转这一运动模式信息、二级主节点的期望位置,此时可令二级主节点的指令加速度形式如16式所示。为达到编队整体旋转的效果,对于二维平面下运动的编队,一级主节点和二级主节点的期望速度形式应满足:
其中α1、是常值且满足M2×2(x)表示是欧拉角旋转矩阵:
对于三维空间下运动的编队,记旋转角速度大小为ω,方向单位矢量为er,则编队为达到期望旋转效果,令一级主节点、二级主节点和三级主节点的速度分别为:
其中“×”表示矢量的叉乘。
从节点运动加速度指令仍然如14式所示。此时,基于此编队控制策略,编队将保持中心不变,以角速度ω旋转,角速度方向为er。
Claims (6)
1.一种基于几何相似性设计的高适应性编队控制方法,其特征在于,包括下列步骤:
S1:设计编队构型,确定主节点智能体和各智能体间的几何约束
S2:根据几何约束,确定智能体间的通信配置;结合智能体安全控制需求,确定智能体的威胁检测配置;
S3:规划编队航迹,并在任务执行前加载到一级主节点智能体;
S4:任务执行过程中,若一级主节点判定任务执行完毕,执行步骤S8,否则执行下一步;
S5:任务执行过程中,各智能体进行威胁检测;各智能体结合威胁检测信息,生成对应于智能体安全规避的加速度和其在智能体最终控制输入的权重;
S6:任务执行过程中,一级主节点智能体依据预加载编队航迹,生成对应于编队机动控制的加速度;同时判定当前任务机动模式,确定二级、三级主节点期望位置和速度;二级、三级和从节点智能体结合期望位置、速度或者几何约束生成对应于编队机动控制的加速度;
S7:任务执行过程中,各智能体综合编队安全规避加速度和机动控制加速度,生成控制输入加速度;
S8:各智能体执行控制输入加速度,然后返回步骤S4;
S9:任务执行完毕,各智能体停止运动。
2.根据权利要求1所述的一种基于几何相似性设计的高适应性编队控制方法,其特征在于,所述S1中具体步骤为:
假设编队由n个节点组成,其中n≥3,分别编号为v1、v2,……vn;所述节点表征不同的实体;
对于在三维空间下运动的编队,定义v1为一级主节点,v2为二级主节点,v3为三级主节点,v1、v2、……vn-3为从节点,夹角表示期望编队构型下节点vj和vk相对于vi的夹角,比值表示期望编队构型下节点vj和vk相对于vi的距离比值lij/lik;对节点v3指定相对于v1和v2的夹角约束φ132和边约束l31/l32,节点v3、v4,……vn共指定nφ-1个夹角约束和nl-1个边约束;对各夹角约束编号为各边约束编号为定义约束函数Fφl为:
定义为各节点的位置,约束函数Fφl对的梯度矩阵记为:
为保证满足约束的编队构型与期望构型相似,梯度矩阵的秩需满足:
rank(Rφl)=3n-7 3
对于在二维平面下运动的编队,定义v1和v2为一级和二级主节点,其余节点v3、v4,……vn为从节点;对v3、v4,……vn指定nφ个夹角约束和nl个边约束;利用各夹角和边约束,同样可定义约束函数Fφl,且为保证满足约束的编队构型与期望构型相似,Fφl应满足:
3.根据权利要求1所述的一种基于几何相似性设计的高适应性编队控制方法,其特征在于,所述S2中,
智能体间的通信配置包括,定义与节点有夹角约束或者边约束的节点为的相邻节点,主节点间能相互通信以获得彼此的位置和速度信息,从节点能与其相邻节点和相邻节点的相邻节点通信以获得它们的位置和速度信息;
智能体间的危险检测配置包括,各智能体配置测量设备,测量危险障碍物或者非合作智能体的状态特性。
4.根据权利要求1所述的一种基于几何相似性设计的高适应性编队控制方法,其特征在于,所述S5中包括:
根据智能体与威胁的相对距离ri,o,设计各智能体安全规避加速度在其控制输入中的权重取值km,i:
其中,对于三维空间下运动的编队,图中ri,d1、ri,d2和ri,d3表示的是以智能体几何中心为球心的球形区域,而对于二维平面下运动的编队,ri,d1、ri,d2和ri,d3表示的是以智能体几何中心为圆心的圆形区域。ri,o≤ri,d1表示智能体将会与障碍物或者非合作智能体发生碰撞的距离范围;ri,d2≥ri,o>ri,d1表示智能体将以保证智能体安全为唯一控制目的的距离范围;ri,d3≥ri,o>ri,d2表示智能体将兼顾智能体安全和任务执行双重目的的距离范围。ri,d2和ri,d3根据各智能体控制能力确定,ri,d1由各智能体尺寸大小决定;
根据智能体与威胁的相对运动状态,设计各智能体的安全规避加速度:
其中表示垂直于ri,o的单位方向向量,tgo,i,o为智能体与威胁碰撞的剩余飞行时间,可近似为:
5.根据权利要求1所述的一种基于几何相似性设计的高适应性编队控制方法,其特征在于,所述S6中包括:
当一级主节点根据加载的期望航迹信息判定当前编队应处于平移运动模式时,一级主节点将采用以下的指令加速度形式:
其中和为一级主节点在t时刻对应的期望位置和速度信息,p1(t)和v1(t)为t时刻的位置和速度,um,1为一级主节点的指令加速度,k1,1和k1,2为大于0的比例系数;
同时,一级主节点向二级主节点发送当前处于平移这一运动模式信息、二级主节点的期望位置,此时可令二级主节点的指令加速度形式为:
对于三维空间下的编队,一级主节点还需向三级主节点发送其当前处于平移这一运动模式形式,同时结合夹角约束φ132、边约束l31/l32和当前编队的期望指向确定三级主节点的期望位置,此时可令三级主节点的指令加速度形式为:
对于编队中的从节点,其指令加速度形式为:
对上式分解后可得um,4、um,5……,um,n的形式,式中kp和kv为大于0的比例系数;
分别定义ps、pr、Rφl,ss和Rφl,sr为:
基于此控制策略,编队将整体以定常速度vc进行平移运动;
当一级主节点根据加载的期望航迹信息判定当前编队应处于平移运动模式时,一级主节点将采取11式所示的指令加速度形式;
同时,一级主节点向二级主节点发送当前处于伸缩这一运动模式信息、二级主节点的期望位置,二级主节点将采取如下形式的指令加速度:
为达到编队整体伸缩的效果,一级主节点和二级主节点运动速度指令为:
其中α1、是常值且满足 为期望编队构型所在位置的中心,可表示为:
对于三维空间下的编队,一级主节点还需向三级主节点告知其当前处于伸缩这一运动模式形式,同时结合夹角约束φ132、边约束l31/l32和当前编队的期望指向确定三级主节点的期望位置;三级主节点的指令加速度形式如13式所示;
从节点运动加速度指令如14式所示,此时,基于此编队控制策略,编队将保持中心不变,定常速度向中心收敛;
当一级主节点根据预设航迹信息判定当前编队应处于旋转运动模式时,一级主节点的指令加速度形式如11式所示;
同时,一级主节点向二级主节点发送当前处于旋转这一运动模式信息、二级主节点的期望位置,此时可令二级主节点的指令加速度形式如16所示;为达到编队整体旋转的效果,对于二维平面下运动的编队,一级主节点和二级主节点的期望速度形式应满足:
其中α1、是常值且满足M2×2(x)表示是欧拉角旋转矩阵:
对于三维空间下运动的编队,记旋转角速度大小为ω,方向单位矢量为er,则编队为达到期望旋转效果,令一级主节点、二级主节点和三级主节点的速度分别为:
其中“×”表示矢量的叉乘;
从节点运动加速度指令仍然如式14所示。此时,基于此编队控制策略,编队将保持中心不变,以角速度ω旋转,角速度方向为er。
6.根据权利要求5所述的一种基于几何相似性设计的高适应性编队控制方法,其特征在于,所述k1,1取值1、k1,2取值2,kp取值1和kv取值2。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910510362.8A CN110162093B (zh) | 2019-06-13 | 2019-06-13 | 一种基于几何相似性设计的高适应性编队控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910510362.8A CN110162093B (zh) | 2019-06-13 | 2019-06-13 | 一种基于几何相似性设计的高适应性编队控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110162093A true CN110162093A (zh) | 2019-08-23 |
CN110162093B CN110162093B (zh) | 2022-02-11 |
Family
ID=67628995
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910510362.8A Active CN110162093B (zh) | 2019-06-13 | 2019-06-13 | 一种基于几何相似性设计的高适应性编队控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110162093B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112348157A (zh) * | 2020-11-18 | 2021-02-09 | 中国空间技术研究院 | 多智能体系统编队构型的协同优化方法及装置 |
CN116400604A (zh) * | 2023-06-06 | 2023-07-07 | 浙江大学海南研究院 | 具有避碰性能的多智能体系统球形编队控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5416713A (en) * | 1992-10-30 | 1995-05-16 | Mitsubishi Denki Kabushiki Kaisha | Obstacle avoidance apparatus |
CN102591358A (zh) * | 2012-03-12 | 2012-07-18 | 北京航空航天大学 | 一种多无人机的动态编队控制方法 |
CN107065922A (zh) * | 2017-02-14 | 2017-08-18 | 中国科学院自动化研究所 | 基于队形库的多无人机队形编队方法 |
CN108536171A (zh) * | 2018-03-21 | 2018-09-14 | 电子科技大学 | 一种多约束下多无人机协同跟踪的路径规划方法 |
CN108958285A (zh) * | 2018-07-17 | 2018-12-07 | 北京理工大学 | 一种基于分解思想的高效多无人机协同航迹规划方法 |
CN109116868A (zh) * | 2018-10-31 | 2019-01-01 | 中国人民解放军32181部队 | 分布式无人机编队协同控制方法 |
US20190051193A1 (en) * | 2017-11-30 | 2019-02-14 | Intel Corporation | Vision-based cooperative collision avoidance |
CN109582040A (zh) * | 2019-01-25 | 2019-04-05 | 中国人民解放军国防科技大学 | 一种无人机集群队形及性能脆弱性评估方法及系统 |
-
2019
- 2019-06-13 CN CN201910510362.8A patent/CN110162093B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5416713A (en) * | 1992-10-30 | 1995-05-16 | Mitsubishi Denki Kabushiki Kaisha | Obstacle avoidance apparatus |
CN102591358A (zh) * | 2012-03-12 | 2012-07-18 | 北京航空航天大学 | 一种多无人机的动态编队控制方法 |
CN107065922A (zh) * | 2017-02-14 | 2017-08-18 | 中国科学院自动化研究所 | 基于队形库的多无人机队形编队方法 |
US20190051193A1 (en) * | 2017-11-30 | 2019-02-14 | Intel Corporation | Vision-based cooperative collision avoidance |
CN108536171A (zh) * | 2018-03-21 | 2018-09-14 | 电子科技大学 | 一种多约束下多无人机协同跟踪的路径规划方法 |
CN108958285A (zh) * | 2018-07-17 | 2018-12-07 | 北京理工大学 | 一种基于分解思想的高效多无人机协同航迹规划方法 |
CN109116868A (zh) * | 2018-10-31 | 2019-01-01 | 中国人民解放军32181部队 | 分布式无人机编队协同控制方法 |
CN109582040A (zh) * | 2019-01-25 | 2019-04-05 | 中国人民解放军国防科技大学 | 一种无人机集群队形及性能脆弱性评估方法及系统 |
Non-Patent Citations (10)
Title |
---|
AZADE AGHAEEYAN,等: ""UAV guidance for tracking control of mobile robots in presence of obstacles"", 《2013 FIRST RSI/ISM INTERNATIONAL CONFERENCE ON ROBOTICS AND MECHATRONICS (ICROM)》 * |
LEI CHEN,等: ""Factor analysis of interceptor capture probability"", 《JOURNAL OF SYSTEMS ENGINEERING AND ELECTRONICS》 * |
YAN, MAO-DE,等: ""Consensus-based three-dimensionalmulti-UAV formation control strategy with high precision"", 《FRONTIERS OF INFORMATION TECHNOLOGY & ELECTRONIC ENGINEERING》 * |
张旭,等: ""考虑几何约束的无人机双机编队相对姿态确定方法"", 《战术导弹技术》 * |
曾志文: ""非线性_量化和结构约束的多智能体协同控制研究"", 《中国博士学位论文全文数据库 信息科技辑》 * |
林倩玉: ""无人机协同编队控制算法研究"", 《万方学位论文全文数据库》 * |
林锋,等: ""基于目标概率威胁值评估的多平台分布式目标分配"", 《舰船电子工程》 * |
欧超杰: ""多无人机编队控制技术研究"", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
白显宗,等: ""空间目标碰撞概率计算方法研究"", 《宇航学报》 * |
邹彬彬: ""自主式水下航行器的建模及圆形编队的研究"", 《万方学位论文全文数据库》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112348157A (zh) * | 2020-11-18 | 2021-02-09 | 中国空间技术研究院 | 多智能体系统编队构型的协同优化方法及装置 |
CN112348157B (zh) * | 2020-11-18 | 2024-04-30 | 中国空间技术研究院 | 多智能体系统编队构型的协同优化方法及装置 |
CN116400604A (zh) * | 2023-06-06 | 2023-07-07 | 浙江大学海南研究院 | 具有避碰性能的多智能体系统球形编队控制方法 |
CN116400604B (zh) * | 2023-06-06 | 2023-08-18 | 浙江大学海南研究院 | 具有避碰性能的多智能体系统球形编队控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110162093B (zh) | 2022-02-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107390706B (zh) | 一种基于预演机动规则系统的无人机近距格斗决策方法 | |
Wang et al. | Evaluation methods for the autonomy of unmanned systems | |
Wang et al. | A bio-inspired robot with undulatory fins and its control methods | |
CN102147255B (zh) | 一种威胁信息共享环境下的无人机群实时航路规划方法 | |
Djapic et al. | Using collaborative autonomous vehicles in mine countermeasures | |
CN110162093A (zh) | 一种基于几何相似性设计的高适应性编队控制方法 | |
Choi et al. | Reactive collision avoidance of unmanned aerial vehicles using a single vision sensor | |
CN108319291A (zh) | 一种基于安全边界分析的无人机认知防碰撞控制方法 | |
CN111880535A (zh) | 一种基于强化学习的无人艇混合感知自主避障方法及系统 | |
An et al. | Task planning and collaboration of jellyfish-inspired multiple spherical underwater robots | |
Fan et al. | Formation control of multiple unmanned surface vehicles using the adaptive null-space-based behavioral method | |
Xin et al. | The latest status and development trends of military unmanned ground vehicles | |
Ouyang et al. | Path planning technologies for USV formation based on improved RRT | |
Luo et al. | Natural feature-based visual servoing for grasping target with an aerial manipulator | |
Mancini et al. | Development of a low-cost Unmanned Surface Vehicle for digital survey | |
Huang et al. | Immersive virtual simulation system design for the guidance, navigation and control of unmanned surface vehicles | |
Vadakkepat et al. | Fuzzy logic controllers for navigation and control of AR. Drone using microsoft kinect | |
Amaral et al. | UAV cooperative perception for target detection and tracking in maritime environment | |
Chen et al. | Design and implementation of human following for separable omnidirectional mobile system of smart home robot | |
Raja et al. | Dynamic inversion-based nonlinear aiming point guidance of unmanned aerial vehicles for reactive obstacle avoidance | |
Qin et al. | Formation control and obstacle avoidance for multi-robot systems | |
Zhang et al. | An interactive control system for mobile robot based on cloud services | |
Pei et al. | Small target detection with remote sensing images based on an improved YOLOv algorithm | |
Liu et al. | An Overview of Behavioral Cooperative Control of Multiple Unmanned Surface Vehicles | |
Sun et al. | Construction Method of Unmanned Surface Vehicles Power Control Platform Based on Environmental Force Feedback [J] |
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 |