CN109445447A - 一种多智能体编队跟踪控制方法及系统 - Google Patents
一种多智能体编队跟踪控制方法及系统 Download PDFInfo
- Publication number
- CN109445447A CN109445447A CN201910031546.6A CN201910031546A CN109445447A CN 109445447 A CN109445447 A CN 109445447A CN 201910031546 A CN201910031546 A CN 201910031546A CN 109445447 A CN109445447 A CN 109445447A
- Authority
- CN
- China
- Prior art keywords
- follower
- agent
- determining
- formation
- saturation
- 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 149
- 238000000034 method Methods 0.000 title claims abstract description 35
- 230000003190 augmentative effect Effects 0.000 claims abstract description 23
- 230000003044 adaptive effect Effects 0.000 claims abstract description 22
- 239000003795 chemical substances by application Substances 0.000 claims description 157
- 239000011159 matrix material Substances 0.000 claims description 67
- 230000003416 augmentation Effects 0.000 claims description 17
- 238000004891 communication Methods 0.000 claims description 17
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 229920006395 saturated elastomer Polymers 0.000 abstract 2
- 230000004927 fusion Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 7
- 238000004088 simulation Methods 0.000 description 6
- 238000013461 design Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000015556 catabolic process Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 238000006731 degradation reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000005312 nonlinear dynamic Methods 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 230000000087 stabilizing effect Effects 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/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0291—Fleet control
-
- 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)
- Feedback Control In General (AREA)
Abstract
本发明公开一种多智能体编队跟踪控制方法及系统。该方法包括:获取各个智能体的位置;根据各个智能体的位置确定领航者、跟随者以及各跟随者相对领航者的位置状态,从而得到智能体编队;引入增广对象,建立智能体编队的故障和饱和模型;以领航者的状态为参考,确定利用故障和饱和模型实现时变编队跟踪的目标函数;利用一阶滤波器的输出信号和增广对象的输出信号建立饱和约束下的自适应容错控制律,确定控制律的参数,得到自适应容错和抗饱和控制律;以目标函数为控制目标,按照自适应容错和抗饱和控制律对各个智能体进行控制。本发明的方法及系统,保证多智能体编队跟踪误差的收敛性,即便在发生故障时控制信号在执行器的饱和边界之内。
Description
技术领域
本发明涉及多智能体系统领域,特别是涉及一种多智能体编队跟踪控制方法及系统。
背景技术
多智能体系统具有广阔的应用前景,融合了多传感器技术、通信技术和协同控制,相对于单智能体有无可比拟的优势。在众多的实际应用场景中,比如卫星导航、机器人控制、搜索救援,多智能体的编队和跟踪控制是实现典型任务的必要技术。然而,随着多智能体系统规模增大,个体产生执行器故障的概率随之提高。此外,如果多智能体系统遭到攻击,那么会有个体同时产生执行器偏差和效率下降故障。执行器故障是需要考虑的一个因素,另一个因素是执行器的饱和特性,这是由执行器的客观物理约束决定的。因此,必须设计控制方法以抑制由执行器故障和饱和所导致的多智能体系统的性能下降、保证安全可靠地执行任务。
目前,在多智能体编队技术方面,基于行为的编队控制、“长机-僚机”方式的编队控制和虚拟结构方式编队控制是机器人和飞行器领域的经典控制方法,这三种典型控制方法分别有各自的优点与缺点。近年来,随着多智能体一致性研究的发展,基于一致性的多智能体编队方法被逐渐采用,并且已经证明基于一致性的编队控制方法相较于上述三种典型控制方法更具有普遍性。
多智能体系统编队跟踪控制中必须要考虑的实际问题是容错控制。某一个智能体产生的故障可能通过通信拓扑传导至系统的其他个体,可能导致整个系统的瘫痪失效。实际情况是,执行器会产生效率下降和控制偏差,并且两者的范围是未知的,因此容错控制需采用鲁棒控制方法或自适应控制。执行器的不可避免的约束是饱和,从而导致控制信号超出执行器的饱和输出边界。
发明内容
本发明的目的是提供一种多智能体编队跟踪控制方法及系统,保证多智能体编队跟踪误差的收敛性,即便在发生故障时控制信号在执行器的饱和边界之内。
为实现上述目的,本发明提供了如下方案:
一种多智能体编队跟踪控制方法,包括:
获取各个智能体的位置;
根据各个智能体的位置确定领航者、跟随者以及各所述跟随者相对领航者的位置状态,从而得到智能体编队;
引入增广对象,建立所述智能体编队的故障和饱和模型;
以领航者的状态为参考,确定利用所述故障和饱和模型实现时变编队跟踪的目标函数;
利用一阶滤波器的输出信号和增广对象的输出信号建立饱和约束下的自适应容错控制律,确定所述控制律的参数,得到自适应容错和抗饱和控制律;
以所述目标函数为控制目标,按照所述自适应容错和抗饱和控制律对各个智能体进行控制。
可选的,所述根据各个智能体的位置确定领航者、跟随者以及各所述跟随者相对领航者的位置状态,从而得到智能体编队,具体包括:
将无邻居的智能体确定为领航者;
将具有邻居的智能体确定为跟随者;
计算每个跟随者的邻居集合中领航者的数量;
当当前跟随者的邻居集合中包含所有的领航者时,确定当前跟随者为灵敏跟随者;
当当前跟随者的邻居集合中包含0个领航者时,确定当前跟随者为不灵敏跟随者;
当当前跟随者的邻居集合中包含部分领航者和至少一个跟随者时,切断当前跟随者与邻居集合中的领航者的通信,并将当前跟随者确定为不灵敏跟随者。
可选的,所述引入增广对象,建立所述智能体编队的故障和饱和模型,具体包括:
对执行器进行建模:
uiF=ρi(t)sat(ui(t))+uib(t)
其中uiF为驱动控制输入,ui(t)为控制输入指令ui(t)∈Rm;uib(t)为执行器偏差,uib(t)∈Rm;ρi(t)为执行器效率矩阵,ρi(t)=diag{ρi1(t),ρi2(t),...,ρim(t)},0<ρij(t)≤1;sat:Rm→Rm为标准饱和函数,sat(uij(t))=sgn(uij(t))min(|uij(t)|,uM),uM为执行器物理特性相关的饱和值;ρij(t)=1,uibj=0时,表示无智能体故障;若0<ρij(t)<1,则表示执行器的第j通道失去了部分效率;若uibj≠0,表示执行器的第j通道存在输出偏差;
引入假设条件:执行器偏差uib(t)未知但有界,满足|uib(t)|≤di,其中di为未知待估计的正的常数;执行器效率矩阵的元素ρij(t)未知但有界,满足ρ ij≤ρij≤1,其中ρ ij为未知待估计的正的常数;
引入双曲正切函数,令ui=f(uic),其中f(uic)=uMtanh(uic),从而将执行器模型转化为:
uiF=ρi(t)f(uic(t))+uib(t)
引入增广对象,并将转化后的执行器模型代入领航者与跟随者的动态线性方程,得到:
其中αic为控制信号,uic为增广对象的状态,uic∈Rm;f(uic)为增广对象的输出信号;所述领航者与跟随者的动态线性方程为:
其中xk,xi分别为领航者和跟随者的状态xk∈Rn,xi∈Rn;为xk(t)的微分;为xi(t)的微分;A,B为系统矩阵和控制分布矩阵A∈Rn×n,B∈Rn×n;uiF为包含失效与饱和特性的控制输入,H为领航者编号集合,F为跟随者编号集合。
可选的,所述以领航者的状态为参考,确定利用所述故障和饱和模型实现时变编队跟踪的目标函数,具体包括:
以作为时变编队跟踪的目标函数;其中hi(t)是相对于编队参考的分段连续可微偏移向量,hi(t)∈Rn×1,i∈F;hi(t)及其微分是默认有界的;当满足limt→∞(xi(t)-hi(t)-c(t))=0,i∈F,则称跟随者形成了hF(t)表示的时变编队;c(t)为编队参考;αk(k∈H)为常数,αk(k∈H),
可选的,所述利用一阶滤波器的输出信号和增广对象的输出信号建立饱和约束下的自适应容错控制律,确定所述控制律的参数,得到自适应容错和抗饱和控制律,具体包括:
利用公式确定第一虚拟控制律;其中Si1为跟随者的第一个动态面,跟随者i的当地编队跟踪误差,θi(t)=xi(t)-hi(t);aij、aik为系统邻接矩阵元素,若智能体i为智能体j邻居,那么aij=1,否则aij=0;若智能体i为智能体k邻居,那么aik=1,否则aik=0; 表示自适应时变增益c的估计;表示,故障参数边界的估计;表示故障参数边界的估计;ρ i=min(ρ i1,ρ i2,...,ρ im);P为正定矩阵,P∈Rn×n;vi(t)为时变编队hi(t)相关的补偿信号;σi是正的常数;
利用公式
确定估计参数 和的控制律;其中κi,μi为正的常数;
利用公式计算补偿信号vi(t);
利用公式Q0=AP+PAT-ηBBT<0计算正定矩阵P;
令信号αi1(t)通过一阶滤波器,时间常数为τ:
βi1(0)=αi1(0)
其中βi1(t)为αi1(t)通过一阶滤波器后得到的输出信号;
利用公式确定自适应容错和抗饱和控制律;其中Si2(t)表示第二个动态面,Si2(t)=f(uic)-βi1(t);K为第二个动态面Si2(t)的增益;且自适应容错和抗饱和控制律中各个参数的约束条件为:
其中ε、γi(i=1,2,3)为正的常数,ρ=min{ρ 1,ρ 2,...,ρ n};λM为矩阵L1的最大特征根。
本发明还公开一种多智能体编队跟踪控制系统,包括:
获取模块,用于获取各个智能体的位置;
编队模块,用于根据各个智能体的位置确定领航者、跟随者以及各所述跟随者相对领航者的位置状态,从而得到智能体编队;
建模模块,用于引入增广对象,建立所述智能体编队的故障和饱和模型;
目标函数确定模块,用于以领航者的状态为参考,确定利用所述故障和饱和模型实现时变编队跟踪的目标函数;
控制律确定模块,用于利用一阶滤波器的输出信号和增广对象的输出信号建立饱和约束下的自适应容错控制律,确定所述控制律的参数,得到自适应容错和抗饱和控制律;
控制模块,用于以所述目标函数为控制目标,按照所述自适应容错和抗饱和控制律对各个智能体进行控制。
可选的,所述编队模块具体包括:
领航者确定单元,用于将无邻居的智能体确定为领航者;
跟随者确定单元,用于将具有邻居的智能体确定为跟随者;
领航者数量计算单元,用于计算每个跟随者的邻居集合中领航者的数量;
灵敏状态确定单元,用于当当前跟随者的邻居集合中包含所有的领航者时,确定当前跟随者为灵敏跟随者;
第一不灵敏状态确定单元,用于当当前跟随者的邻居集合中包含0个领航者时,确定当前跟随者为不灵敏跟随者;
第二不灵敏状态确定单元,用于当当前跟随者的邻居集合中包含部分领航者和至少一个跟随者时,切断当前跟随者与邻居集合中的领航者的通信,并将当前跟随者确定为不灵敏跟随者。
可选的,所述建模模块具体包括:
建模单元,用于对执行器进行建模:
uiF=ρi(t)sat(ui(t))+uib(t)
其中uiF为驱动控制输入,ui(t)为控制输入指令ui(t)∈Rm;uib(t)为执行器偏差,uib(t)∈Rm;ρi(t)为执行器效率矩阵,ρi(t)=diag{ρi1(t),ρi2(t),...,ρim(t)},0<ρij(t)≤1;sat:Rm→Rm为标准饱和函数,sat(uij(t))=sgn(uij(t))min(|uij(t)|,uM),uM为执行器物理特性相关的饱和值;ρij(t)=1,uibj=0时,表示无智能体故障;若0<ρij(t)<1,则表示执行器的第j通道失去了部分效率;若uibj≠0,表示执行器的第j通道存在输出偏差;
假设条件引入单元,用于引入假设条件:执行器偏差uib(t)未知但有界,满足|uib(t)|≤di,其中di为未知待估计的正的常数;执行器效率矩阵的元素ρij(t)未知但有界,满足ρ ij≤ρij≤1,其中ρ ij为未知待估计的正的常数;
模型转换单元,用于引入双曲正切函数,令ui=f(uic),其中f(uic)=uMtanh(uic),从而将执行器模型转化为:
uiF=ρi(t)f(uic(t))+uib(t)
增广对象引入单元,用于引入增广对象,并将转化后的执行器模型代入领航者与跟随者的动态线性方程,得到:
其中αic为控制信号,uic为增广对象的状态,uic∈Rm;f(uic)为增广对象的输出信号;所述领航者与跟随者的动态线性方程为:
其中xk,xi分别为领航者和跟随者的状态xk∈Rn,xi∈Rn;为xk(t)的微分;为xi(t)的微分;A,B为系统矩阵和控制分布矩阵A∈Rn×n,B∈Rn×n;uiF为包含失效与饱和特性的控制输入,H为领航者编号集合,F为跟随者编号集合。
可选的,所述目标函数确定模块具体包括:
目标函数确定单元,用于以作为时变编队跟踪的目标函数;其中hi(t)是相对于编队参考的分段连续可微偏移向量,hi(t)∈Rn×1,i∈F;hi(t)及其微分是默认有界的;当满足limt→∞(xi(t)-hi(t)-c(t))=0,i∈F,则称跟随者形成了hF(t)表示的时变编队;c(t)为编队参考;αk(k∈H)为常数,αk(k∈H),
可选的,所述控制模块具体包括:
第一控制律确定单元,用于利用公式确定第一虚拟控制律;其中Si1为跟随者的第一个动态面,跟随者i的当地编队跟踪误差,θi(t)=xi(t)-hi(t);aij、aik为系统邻接矩阵元素,若智能体i为智能体j邻居,那么aij=1,否则aij=0;若智能体i为智能体k邻居,那么aik=1,否则aik=0; 表示自适应时变增益c的估计;表示,故障参数边界的估计;表示故障参数边界的估计;ρ i=min(ρ i1,ρ i2,...,ρ im);P为正定矩阵,P∈Rn×n;vi(t)为时变编队hi(t)相关的补偿信号;σi是正的常数;
估计参数确定单元,用于利用公式
确定估计参数 和的控制律;其中κi,μi为正的常数;
补偿信号确定单元,用于利用公式计算补偿信号vi(t);
正定矩阵确定单元,用于利用公式Q0=AP+PAT-ηBBT<0计算正定矩阵P;
滤波单元,用于令信号αi1(t)通过一阶滤波器,时间常数为τ:
βi1(0)=αi1(0)
其中βi1(t)为αi1(t)通过一阶滤波器后得到的输出信号;
第二控制律确定单元,用于利用公式确定自适应容错和抗饱和控制律;其中Si2(t)表示第二个动态面,Si2(t)=f(uic)-βi1(t);K为第二个动态面Si2(t)的增益;且自适应容错和抗饱和控制律中各个参数的约束条件为:
其中ε、γi(i=1,2,3)为正的常数,ρ=min{ρ 1,ρ 2,...,ρ n};λM为矩阵L1的最大特征根。
根据本发明提供的具体实施例,本发明公开了以下技术效果:本发明所公开的多智能体编队跟踪控制系统,根据各个智能体的位置确定领航者、跟随者以及各所述跟随者相对领航者的位置状态,从而得到智能体编队;引入增广对象,建立所述智能体编队的故障和饱和模型;以领航者的状态为参考,确定利用所述故障和饱和模型实现时变编队跟踪的目标函数;利用一阶滤波器的输出信号和增广对象的输出信号建立饱和约束下的自适应容错控制律,确定所述控制律的参数,得到自适应容错和抗饱和控制律;以所述目标函数为控制目标,按照所述自适应容错和抗饱和控制律对各个智能体进行控制。该方法及系统,结合增广对象建立自适应容错和抗饱和控制律,能够有效处理执行器的未知边界偏差和效率损失等故障,并且在饱和约束下编队误差满足半全局一致毕竟有界收敛,从而保证多智能体编队跟踪误差的收敛性,即便在发生故障时控制信号在执行器的饱和边界之内。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明多智能体编队跟踪控制方法实施例的方法流程图;
图2为多智能体系统通信拓扑;
图3为智能体编队在不同时间的相对位置图;
图4为时变编队误差与时间的变化曲线;
图5为自适应参数的曲线;
图6为自适应参数的曲线;
图7为自适应参数的曲线;
图8为控制输入ui1的曲线;
图9为控制输入ui2的曲线;
图10为本发明多智能体编队跟踪控制系统的系统结构图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明的目的是提供一种多智能体编队跟踪控制方法及系统,保证多智能体编队跟踪误差的收敛性,即便在发生故障时控制信号在执行器的饱和边界之内。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
实施例1:
图1为本发明多智能体编队跟踪控制方法实施例的方法流程图。
参见图1,该多智能体编队跟踪控制方法,包括:
步骤101:获取各个智能体的位置;
步骤102:根据各个智能体的位置确定领航者、跟随者以及各所述跟随者相对领航者的位置状态,从而得到智能体编队;
步骤103:引入增广对象,建立所述智能体编队的故障和饱和模型;
步骤104:以领航者的状态为参考,确定利用所述故障和饱和模型实现时变编队跟踪的目标函数;
步骤105:利用一阶滤波器的输出信号和增广对象的输出信号建立饱和约束下的自适应容错控制律,确定所述控制律的参数,得到自适应容错和抗饱和控制律;
步骤106:以所述目标函数为控制目标,按照所述自适应容错和抗饱和控制律对各个智能体进行控制。
可选的,步骤102具体包括:
将无邻居的智能体确定为领航者;
将具有邻居的智能体确定为跟随者;
计算每个跟随者的邻居集合中领航者的数量;
当当前跟随者的邻居集合中包含所有的领航者时,确定当前跟随者为灵敏跟随者;
当当前跟随者的邻居集合中包含0个领航者时,确定当前跟随者为不灵敏跟随者;
当当前跟随者的邻居集合中包含部分领航者和至少一个跟随者时,切断当前跟随者与邻居集合中的领航者的通信,并将当前跟随者确定为不灵敏跟随者。
可选的,步骤103具体包括:
在多智能体编队跟踪问题中,为了处理控制失效和输入饱和等安全威胁,首先对执行器进行建模:
uiF=ρi(t)sat(ui(t))+uib(t)
其中i表示跟随者,uiF为驱动控制输入,ui(t)为控制输入指令ui(t)∈Rm;uib(t)为执行器偏差,uib(t)∈Rm;ρi(t)为执行器效率矩阵,ρi(t)=diag{ρi1(t),ρi2(t),...,ρim(t)},用ρij(t)表示执行器效率矩阵的第j个对角元素,0<ρij(t)≤1;sat:Rm→Rm为标准饱和函数,sat(uij(t))=sgn(uij(t))min(|uij(t)|,uM),uM为执行器物理特性相关的饱和值;用uibj表示执行器偏差向量的第j个元素,j=1,2,…,m;当ρij(t)=1,uibj=0时,表示无智能体故障,此时执行器仅存在饱和约束;若0<ρij(t)<1,则表示执行器的第j通道失去了部分效率;若uibj≠0,表示执行器的第j通道存在输出偏差;
引入假设条件:执行器偏差uib(t)未知但有界,满足|uib(t)|≤di,其中di为未知待估计的正的常数;执行器效率矩阵的元素ρij(t)未知但有界,满足ρ ij≤ρij≤1,其中ρ ij为未知待估计的正的常数;
引入双曲正切函数,令ui=f(uic),其中f(uic)=uMtanh(uic),从而将执行器模型转化为:
uiF=ρi(t)f(uic(t))+uib(t)
引入增广对象,并将转化后的执行器模型代入领航者与跟随者的动态线性方程,得到:
其中αic为控制信号,uic为增广对象的状态,uic∈Rm;为uic的微分;f(uic)为增广对象的输出信号;
上述的领航者与跟随者的动态线性方程为:
其中xk,xi分别为领航者和跟随者的状态xk∈Rn,xi∈Rn;为xk(t)的微分;为xi(t)的微分;A,B为系统矩阵和控制分布矩阵A∈Rn×n,B∈Rn×n;uiF为包含失效与饱和特性的控制输入,H为领航者编号集合,F为跟随者编号集合。
可选的,所述以领航者的状态为参考,确定利用所述故障和饱和模型实现时变编队跟踪的目标函数,具体包括:
以作为时变编队跟踪的目标函数;其中hi(t)是相对于编队参考的分段连续可微偏移向量,hi(t)∈Rn×1,i∈F;hi(t)及其微分是默认有界的;当满足limt→∞(xi(t)-hi(t)-c(t))=0,i∈F,则称跟随者形成了hF(t)表示的时变编队;c(t)为编队参考;αk(k∈H)为常数,αk(k∈H),
可选的,步骤104具体包括:
利用公式确定第一虚拟控制律;其中Si1为跟随者i的当地编队跟踪误差,Sil(t)函数表示跟随者的第一个动态面,θi(t)=xi(t)-hi(t);aij、aik为系统邻接矩阵元素,若智能体i为智能体j邻居,那么aij=1,否则aij=0;若智能体i为智能体k邻居,那么aik=1,否则aik=0; 表示自适应时变增益c的估计;表示,故障参数边界的估计;表示故障参数边界的估计;ρ i=min(ρ i1,ρ i2,...,ρ im);P为正定矩阵,P∈Rn×n;vi(t)为时变编队hi(t)相关的补偿信号;σi是正的常数;
利用公式
确定估计参数 和的控制律;其中κi,μi为正的常数;
利用公式计算补偿信号vi(t);
利用公式Q0=AP+PAT-ηBBT<0计算正定矩阵P;
令信号αi1(t)通过一阶滤波器,时间常数为τ:
βi1(0)=αi1(0)
其中βi1(t)为αi1(t)通过一阶滤波器后得到的输出信号;
利用公式确定自适应容错和抗饱和控制律;其中Si2(t)表示第二个动态面,Si2(t)=f(uic)-βi1(t);K为第二个动态面Si2(t)的增益;且自适应容错和抗饱和控制律中各个参数的约束条件为:
其中ε、γi(i=1,2,3)为正的常数,ρ=min{ρ 1,ρ 2,...,ρ n};λM为矩阵L1的最大特征根。
实施例2:
S1:确定跟随者和领航者,验证通信拓扑连通性
在多智能体系统中,如果某个智能体没有邻居,那么称该智能体为领航者,否则称为跟随者。如果跟随者的邻居集合中包含所有领航者,那么称该跟随者为灵敏的,如果邻居集合中没有领航者,则称该跟随者是不灵敏的。
为保证跟随者对多领航者航迹跟踪的一致性,需验证通信拓扑满足如下连通性条件:对于任意的跟随者,只有灵敏和不灵敏两种状态。跟随者之间的通信是无向的。对于每一个不灵敏的跟随者,必定有灵敏跟随者与之存在连接路径。
在实际编队应用中,如果存在跟随者与部分领航者、跟随者同时连通的情况,那么应当避免接受领航者的航迹信息,以满足上述条件。
多智能体系统通信拓扑的数学描述如下:
多智能体系统的通信拓扑关系由加权图G={V,E,W}来描述,其中,V={v1,v2,...,vN}为包含N个顶点的顶点集合,为边集,W=[wij]∈RN×N为有向图的邻接矩阵。G中的每条边为eij=(vi,vj),表示vi为vj的邻居,即智能体j可以从智能体i获取信息。邻接矩阵的元素wij表示智能体j到智能体i的信号强度,因此,如果eji∈E,那么wij>0,否则wij=0。智能体i的所有邻居用集合Ni={vj∈V:eji∈E}来表示。
假定存在M个跟随者和N-M个领航者。跟随者和领航者的下标集合分别表示为F={1,2,3,...,M},H={M+1,M+2,...,N}。节点vi的入度为那么图G的入度矩阵为D=diag{degin(vi),i=1,2,...,N}。定义拉普拉斯矩阵L=D-W。拉普拉斯矩阵L具有这样的形式其中分块L1∈RM×M,L2∈RM×(N-M),L1是对称阵。
S2:建立领航者和跟随者动态方程,建立执行器故障和饱和模型,引入执行器控制信号的增广对象
领航者i和跟随者k的一般线性动态方程为
其中,xk∈Rn,xi∈Rn分别为领航者和跟随者的状态,A∈Rn×n,B∈Rn×n为系统矩阵,uiF为式中的包含失效与饱和特性的控制输入,H为领航者编号集合,F为跟随者编号集合。
一般地面机器人运动满足非线性动态方程
其中,xXi(t)和yYi(t)分别表示智能体i的X轴和Y轴的位置,βi(t)表示偏航角,v(t)和pi(t)分别表示线速度和角速度。为xXi(t)的微分,为yYi(t)的微分;
可通过反馈线性化的方式将非线性动态方程转化为所示的线性系统。因此,采用作为所研究对象的动态方程式合适的。
在多智能体编队跟踪问题中,为了处理控制失效和输入饱和等安全威胁,首先对执行器进行建模。实际的驱动控制输入uiF表示为
uiF=ρi(t)sat(ui(t))+uib(t)
其中,ui(t)∈Rm为控制输入指令;uib(t)∈Rm为执行器偏差;ρi(t)=diag{ρi1(t),ρi2(t),...,ρim(t)}为执行器效率矩阵,满足0<ρij(t)≤1;sat:Rm→Rm为标准饱和函数,定义为sat(uij(t))=sgn(uij(t))min(|uij(t)|,uM),uM为执行器物理特性相关的饱和值。当不存在失效时,有ρij(t)=1,uibj=0,此时执行器仅存在饱和约束;若0<ρij(t)<1,则表示执行器的第j通道失去了部分效率;若uibj≠0,表示执行器的第j通道存在输出偏差。
引入假设条件:(1)执行器偏差uib(t)未知但有界,满足|uib(t)|≤di,其中di为未知待估计的正的常数;(2)执行器效率矩阵的元素ρij(t)未知但有界,满足ρ ij≤ρij≤1,其中ρ ij为未知待估计的正的常数。
饱和函数sat(·)是连续但在uM和-uM处是不可微的,这给分析带来了困难。处理这个问题的一个途径是引入光滑但能够描述饱和特性的双曲正切函数。令ui=f(uic),其中控制输入指令f(uic)按元素定义为f(uic)=uMtanh(uic)。
因此,执行器模型另写为:
uiF=ρi(t)f(uic(t))+uib(t)
为方便后续饱和约束下的控制协议设计,引入增广对象见式,并将式带入跟随者动态方程,得到
其中,αic是待设计的控制信号,uic∈Rm和f(uic)为增广对象的状态和输出,根据控制输入定义f(uic)=uMtanh(uic),可知
至此,跟随者的动力学特性是严格反馈的,并且考虑到式描述的增广对象动态方程写为因此将使用与动态面控制方法设计控制协议。
S3:多智能体时变编队描述和编队跟踪目标函数
跟随者的时变编队由向量hF(t)=[h1 T(t),h2 T(t),...,hM T(t)]来定义,hF(t)的元素hi(t)∈Rn×1,i∈F是相对于编队参考的分段连续可微偏移向量。考虑到多智能体编队的内在物理动力学特性,hi(t)及其微分是默认有界的。当满足limt→∞(xi(t)-hi(t)-c(t))=0,i∈F,则称跟随者形成了hF(t)表示的时变编队,其中c(t)为上面提到的编队参考。所有跟随者具有同一编队参考c(t),这意味着状态xi(t)-hi(t)(i∈F)实现了渐进一致性。
对于具有多领航者的多智能体系统,如果编队参考由领航者的状态决定,那么有如下控制目标:
对于任意给定的有界初始状态,如果存在正常数αk(k∈H),满足
那么具有多领航者的多智能体系统可以实现时变编队跟踪。
从上述定义可看出,时变编队跟踪由两部分运动合成。一是时变编队运动,从可得到这表示跟随者状态的空间构型与编队偏移向量在几何上是全等的,跟随者状态的相对位置关系完全由编队偏移向量决定,通过构造编队偏移向量,可以实现跟随者的编队运动;二是跟踪运动,任意一个跟随者都要求跟踪领航者产生的参考轨迹,该轨迹是由领航者状态的凸组合产生的,即需要指出的是,系数αk(k∈H)必须唯一确定,并且确保所有跟随者仅根据邻居信息便能获得该系数。
S4:多智能体系统编队跟踪的自适应容错和抗饱和控制律设计
实现饱和约束下多智能体编队的容错控制算法,由以下几个步骤组成:4.1:定义第一个动态面,设计第一虚拟控制律
定义跟随者的第一个动态面:
其中,Si1表示跟随者i的当地编队跟踪误差,θi(t)=xi(t)-hi(t);aij、aik为系统邻接矩阵元素,若智能体i为智能体j邻居,那么aij=1,否则aij=0,同理可确定aik取值。
动态面Si1的定义写成向量形式为
其中,L1=[aij]M×M,L2=[aik]M×(N-M),θF=[θ1 T,θ2 T,...,θM T]T,M为跟随者数量,N-M为领导者数量。
多智能体编队跟踪误差可写为为使动态面Si1镇定,设计分布式的第一虚拟控制律:
其中, 分别表示自适应时变增益c,故障参数边界和的估计,ρ i=min(ρ i1,ρ i2,...,ρ im),P∈Rn×n为正定矩阵,vi(t)为时变编队hi(t)相关的补偿信号,σi是正的常数。
第一虚拟控制律中参数由以下方式确定:
①参数的自适应律:
其中,κi,μi为正的常数。
②补偿信号由时变编队可行性条件求得:
③正定矩阵P为下列线性矩阵不等式的解:
Q0=AP+PAT-ηBBT<0
其中,通过调整参数η,可使得Q0的最大特征根任意小。
为避免复杂性爆炸,令信号αi1(t)通过一阶滤波器,时间常数为τ:
βi1(0)=αi1(0)
βi1(t)为αi1(t)通过一阶滤波器后得到的输出信号。
4.2:定义第二个动态面,设计饱和约束下的自适应容错控制律
定义第二个动态面:
Si2(t)=f(uic)-βi1(t)
求微分,得到
最终获得饱和约束下的自适应容错控制律αic(t)为
其中,K为第二个动态面Si2(t)的增益。
步骤4.3:确定上述步骤控制律的参数约束条件
分析得到控制律使系统稳定的参数约束条件:
其中,ε、γi(i=1,2,3)为正的常数,ρ=min{ρ 1,ρ 2,...,ρ n};λM为矩阵L1的最大特征根。
求解满足约束的控制律参数:η,K,σi,κi,μi,即可完成全系统控制律的设计。
仿真算例
考虑具有6个跟随者和3个跟随者的三阶多智能体系统,系统通信拓扑关系如图2所示。编号1-6的个体为跟随者,编号7-9的个体为领导者;有箭头实线表示单向通信关系,无箭头实线表示双向通信关系。动态方程系统矩阵和控制分布矩阵分别为
时变编队偏移向量设计为
在故障出现之前,执行器模型参数为ρi(t)=I2,ubi=0,uM=50。当系统运行时间t>15s,智能体2和智能体4出现故障。智能体2存在效率降低故障,效率矩阵ρ2(t)=diag{0.8-0.2sin(t),0.9}。智能体4同时存在输出偏差和效率下降故障:u4b=[-0.2e-0.1(t-15),0.1+0.01cos(t)]T,ρ4(t)=diag{0.5+0.2e-0.1(t-15),0.4+0.1cos(t)}。
根据控制律参数约束条件,确定智能体i(i∈F)的控制律参数为κi=0.1,μi=0.1,η=100,τ=0.01,σi=0.01,K=0.5。
仿真采用定步长龙格库塔法,仿真步长0.1ms,仿真时间100s,仿真结果如图3-图9所示。
图3为智能体编队在不同时间的相对位置图,第一行的第一幅的时刻为t=0s,第一行的第二幅的时刻为t=15s,第二行的第一幅的时刻为t=30s,第二行的第二幅的时刻为t=45s。浅色五角星形表示领航者,深色五角星形表示编队参考,其他形状的图像表示跟随者。与时变编队偏移向量设计相符,跟随者围绕领航者状态的凸组合进行圆周围绕运动;图4为时变编队误差与时间的变化曲线,多智能体编队误差实现了一致毕竟有界收敛,在15s时,系统出现故障,编队误差突然变大,但是算法仍然能够控制误差范围,显示了自适应容错算法的有效性;图5-图7为自适应参数的变化曲线,自适应参数能够对系统故障作出显著调整,并且最终收敛;图8-图9为控制输入信号曲线,显示所有控制信号包括其分量能够维持在饱和约束边界uM=50之内。仿真算例,显示了本发明提出的控制算法在处理执行器故障和饱和方面的有效性。
实施例3:
图10为本发明多智能体编队跟踪控制系统的系统结构图。
参见图10,该多智能体编队跟踪控制系统,包括:
获取模块1001,用于获取各个智能体的位置;
编队模块1002,用于根据各个智能体的位置确定领航者、跟随者以及各所述跟随者相对领航者的位置状态,从而得到智能体编队;
建模模块1003,用于引入增广对象,建立所述智能体编队的故障和饱和模型;
目标函数确定模块1004,用于以领航者的状态为参考,确定利用所述故障和饱和模型实现时变编队跟踪的目标函数;
控制律确定模块1005,用于利用一阶滤波器的输出信号和增广对象的输出信号建立饱和约束下的自适应容错控制律,确定所述控制律的参数,得到自适应容错和抗饱和控制律;
控制模块1006,用于以所述目标函数为控制目标,按照所述自适应容错和抗饱和控制律对各个智能体进行控制。
可选的,所述编队模块1002具体包括:
领航者确定单元,用于将无邻居的智能体确定为领航者;
跟随者确定单元,用于将具有邻居的智能体确定为跟随者;
领航者数量计算单元,用于计算每个跟随者的邻居集合中领航者的数量;
灵敏状态确定单元,用于当当前跟随者的邻居集合中包含所有的领航者时,确定当前跟随者为灵敏跟随者;
第一不灵敏状态确定单元,用于当当前跟随者的邻居集合中包含0个领航者时,确定当前跟随者为不灵敏跟随者;
第二不灵敏状态确定单元,用于当当前跟随者的邻居集合中包含部分领航者和至少一个跟随者时,切断当前跟随者与邻居集合中的领航者的通信,并将当前跟随者确定为不灵敏跟随者。
可选的,所述建模模块1003具体包括:
建模单元,用于对执行器进行建模:
uiF=ρi(t)sat(ui(t))+uib(t)
其中uiF为驱动控制输入,ui(t)为控制输入指令ui(t)∈Rm;uib(t)为执行器偏差,uib(t)∈Rm;ρi(t)为执行器效率矩阵,ρi(t)=diag{ρi1(t),ρi2(t),...,ρim(t)},0<ρij(t)≤1;sat:Rm→Rm为标准饱和函数,sat(uij(t))=sgn(uij(t))min(|uij(t)|,uM),uM为执行器物理特性相关的饱和值;ρij(t)=1,uibj=0时,表示无智能体故障;若0<ρij(t)<1,则表示执行器的第j通道失去了部分效率;若uibj≠0,表示执行器的第j通道存在输出偏差;
假设条件引入单元,用于引入假设条件:执行器偏差uib(t)未知但有界,满足|uib(t)|≤di,其中di为未知待估计的正的常数;执行器效率矩阵的元素ρij(t)未知但有界,满足ρ ij≤ρij≤1,其中ρ ij为未知待估计的正的常数;
模型转换单元,用于引入双曲正切函数,令ui=f(uic),其中f(uic)=uMtanh(uic),从而将执行器模型转化为:
uiF=ρi(t)f(uic(t))+uib(t)
增广对象引入单元,用于引入增广对象,并将转化后的执行器模型代入领航者与跟随者的动态线性方程,得到:
其中αic为控制信号,uic为增广对象的状态,uic∈Rm;f(uic)为增广对象的输出信号;所述领航者与跟随者的动态线性方程为:
其中xk,xi分别为领航者和跟随者的状态xk∈Rn,xi∈Rn;为xk(t)的微分;为xi(t)的微分;A,B为系统矩阵和控制分布矩阵A∈Rn×n,B∈Rn×n;uiF为包含失效与饱和特性的控制输入,H为领航者编号集合,F为跟随者编号集合。
可选的,所述目标函数确定模块1004具体包括:
目标函数确定单元,用于以作为时变编队跟踪的目标函数;其中hi(t)是相对于编队参考的分段连续可微偏移向量,hi(t)∈Rn ×1,i∈F;hi(t)及其微分是默认有界的;当满足limt→∞(xi(t)-hi(t)-c(t))=0,i∈F,则称跟随者形成了hF(t)表示的时变编队;c(t)为编队参考;αk(k∈H)为常数,αk(k∈H),
可选的,所述控制模块具体包括:
第一控制律确定单元,用于利用公式确定第一虚拟控制律;其中Si1为跟随者的第一个动态面,跟随者i的当地编队跟踪误差,θi(t)=xi(t)-hi(t);aij、aik为系统邻接矩阵元素,若智能体i为智能体j邻居,那么aij=1,否则aij=0;若智能体i为智能体k邻居,那么aik=1,否则aik=0; 表示自适应时变增益c的估计;表示,故障参数边界的估计;表示故障参数边界的估计;ρ i=min(ρ i1,ρ i2,...,ρ im);P为正定矩阵,P∈Rn×n;vi(t)为时变编队hi(t)相关的补偿信号;σi是正的常数;
估计参数确定单元,用于利用公式
确定估计参数 和的控制律;其中κi,μi为正的常数;
补偿信号确定单元,用于利用公式计算补偿信号vi(t);
正定矩阵确定单元,用于利用公式Q0=AP+PAT-ηBBT<0计算正定矩阵P;
滤波单元,用于令信号αi1(t)通过一阶滤波器,时间常数为τ:
βi1(0)=αi1(0)
其中βi1(t)为αi1(t)通过一阶滤波器后得到的输出信号;
第二控制律确定单元,用于利用公式确定自适应容错和抗饱和控制律;其中Si2(t)表示第二个动态面,Si2(t)=f(uic)-βi1(t);K为第二个动态面Si2(t)的增益;且自适应容错和抗饱和控制律中各个参数的约束条件为:
其中ε、γi(i=1,2,3)为正的常数,ρ=min{ρ 1,ρ 2,...,ρ n};λM为矩阵L1的最大特征根。
根据本发明提供的具体实施例,本发明公开了以下技术效果:
(1)设计了多智能体系统存在多领航者的编队跟踪方法,编队参考航迹由领航者状态的凸组合生成;
(2)建立了同时考虑执行器故障和饱和的数学模型,通过双曲正弦函数描述饱和特性,并引入了增广对象及动态方程,为后续动态面控制律设计提供了基础;
(3)设计了自适应容错和抗饱和控制律,在不确定执行器效率下降程度和偏差大小的情况下,该控制律能够保证多智能体编队跟踪误差的收敛性、有界性,同时控制信号在执行器的饱和边界之内。
对于实施例公开的系统而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。
Claims (10)
1.一种多智能体编队跟踪控制方法,其特征在于,包括:
获取各个智能体的位置;
根据各个智能体的位置确定领航者、跟随者以及各所述跟随者相对领航者的位置状态,从而得到智能体编队;
引入增广对象,建立所述智能体编队的故障和饱和模型;
以领航者的状态为参考,确定利用所述故障和饱和模型实现时变编队跟踪的目标函数;
利用一阶滤波器的输出信号和增广对象的输出信号建立饱和约束下的自适应容错控制律,确定所述控制律的参数,得到自适应容错和抗饱和控制律;
以所述目标函数为控制目标,按照所述自适应容错和抗饱和控制律对各个智能体进行控制。
2.根据权利要求1所述的多智能体编队跟踪控制方法,其特征在于,所述根据各个智能体的位置确定领航者、跟随者以及各所述跟随者相对领航者的位置状态,从而得到智能体编队,具体包括:
将无邻居的智能体确定为领航者;
将具有邻居的智能体确定为跟随者;
计算每个跟随者的邻居集合中领航者的数量;
当当前跟随者的邻居集合中包含所有的领航者时,确定当前跟随者为灵敏跟随者;
当当前跟随者的邻居集合中包含0个领航者时,确定当前跟随者为不灵敏跟随者;
当当前跟随者的邻居集合中包含部分领航者和至少一个跟随者时,切断当前跟随者与邻居集合中的领航者的通信,并将当前跟随者确定为不灵敏跟随者。
3.根据权利要求1所述的多智能体编队跟踪控制方法,其特征在于,所述引入增广对象,建立所述智能体编队的故障和饱和模型,具体包括:
对执行器进行建模:
uiF=ρi(t)sat(ui(t))+uib(t)
其中uiF为驱动控制输入,ui(t)为控制输入指令,ui(t)∈Rm;uib(t)为执行器偏差,uib(t)∈Rm;ρi(t)为执行器效率矩阵,ρi(t)=diag{ρi1(t),ρi2(t),...,ρim(t)},0<ρij(t)≤1;sat:Rm→Rm为标准饱和函数,sat(uij(t))=sgn(uij(t))min(|uij(t)|,uM),uM为执行器物理特性相关的饱和值;ρij(t)=1,uibj=0时,表示无智能体故障;若0<ρij(t)<1,则表示执行器的第j通道失去了部分效率;若uibj≠0,表示执行器的第j通道存在输出偏差;
引入假设条件:执行器偏差uib(t)未知但有界,满足|uib(t)|≤di,其中di为未知待估计的正的常数;执行器效率矩阵的元素ρij(t)未知但有界,满足ρ ij≤ρij≤1,其中ρ ij为未知待估计的正的常数;
引入双曲正切函数,令ui=f(uic),其中f(uic)=uMtanh(uic),从而将执行器模型转化为:
uiF=ρi(t)f(uic(t))+uib(t)
引入增广对象,并将转化后的执行器模型代入领航者与跟随者的动态线性方程,得到:
其中αic为控制信号,uic为增广对象的状态,uic∈Rm;f(uic)为增广对象的输出信号;所述领航者与跟随者的动态线性方程为:
其中xk,xi分别为领航者和跟随者的状态xk∈Rn,xi∈Rn;为xk(t)的微分;为xi(t)的微分;A,B为系统矩阵和控制分布矩阵A∈Rn×n,B∈Rn×n;uiF为包含失效与饱和特性的控制输入,H为领航者编号集合,F为跟随者编号集合。
4.根据权利要求3所述的多智能体编队跟踪控制方法,其特征在于,所述以领航者的状态为参考,确定利用所述故障和饱和模型实现时变编队跟踪的目标函数,具体包括:
以作为时变编队跟踪的目标函数;其中hi(t)是相对于编队参考的分段连续可微偏移向量,hi(t)∈Rn×1,i∈F;hi(t)及其微分是默认有界的;当满足limt→∞(xi(t)-hi(t)-c(t))=0,i∈F,则称跟随者形成了hF(t)表示的时变编队;c(t)为编队参考;αk(k∈H)为常数,αk(k∈H),
5.根据权利要求4所述的多智能体编队跟踪控制方法,其特征在于,所述利用一阶滤波器的输出信号和增广对象的输出信号建立饱和约束下的自适应容错控制律,确定所述控制律的参数,得到自适应容错和抗饱和控制律,具体包括:
利用公式确定第一虚拟控制律;其中Si1为跟随者的第一个动态面,跟随者i的当地编队跟踪误差,θi(t)=xi(t)-hi(t);aij、aik为系统邻接矩阵元素,若智能体i为智能体j邻居,那么aij=1,否则aij=0;若智能体i为智能体k邻居,那么aik=1,否则aik=0; 表示自适应时变增益c的估计;表示,故障参数边界的估计;表示故障参数边界的估计;ρ i=min(ρ i1,ρ i2,...,ρ im);P为正定矩阵,P∈Rn×n;vi(t)为时变编队hi(t)相关的补偿信号;σi是正的常数;
利用公式
确定估计参数和的控制律;其中κi,μi为正的常数;
利用公式计算补偿信号vi(t);
利用公式Q0=AP+PAT-ηBBT<0计算正定矩阵P;
令信号αi1(t)通过一阶滤波器,时间常数为τ:
βi1(0)=αi1(0)
其中βi1(t)为αi1(t)通过一阶滤波器后得到的输出信号;
利用公式确定自适应容错和抗饱和控制律;其中Si2(t)表示第二个动态面,Si2(t)=f(uic)-βi1(t);K为第二个动态面Si2(t)的增益;且自适应容错和抗饱和控制律中各个参数的约束条件为:
其中ε、γi(i=1,2,3)为正的常数,ρ=min{ρ 1,ρ 2,...,ρ n};λM为矩阵L1的最大特征根。
6.一种多智能体编队跟踪控制系统,其特征在于,包括:
获取模块,用于获取各个智能体的位置;
编队模块,用于根据各个智能体的位置确定领航者、跟随者以及各所述跟随者相对领航者的位置状态,从而得到智能体编队;
建模模块,用于引入增广对象,建立所述智能体编队的故障和饱和模型;
目标函数确定模块,用于以领航者的状态为参考,确定利用所述故障和饱和模型实现时变编队跟踪的目标函数;
控制律确定模块,用于利用一阶滤波器的输出信号和增广对象的输出信号建立饱和约束下的自适应容错控制律,确定所述控制律的参数,得到自适应容错和抗饱和控制律;
控制模块,用于以所述目标函数为控制目标,按照所述自适应容错和抗饱和控制律对各个智能体进行控制。
7.根据权利要求6所述的多智能体编队跟踪控制系统,其特征在于,所述编队模块具体包括:
领航者确定单元,用于将无邻居的智能体确定为领航者;
跟随者确定单元,用于将具有邻居的智能体确定为跟随者;
领航者数量计算单元,用于计算每个跟随者的邻居集合中领航者的数量;
灵敏状态确定单元,用于当当前跟随者的邻居集合中包含所有的领航者时,确定当前跟随者为灵敏跟随者;
第一不灵敏状态确定单元,用于当当前跟随者的邻居集合中包含0个领航者时,确定当前跟随者为不灵敏跟随者;
第二不灵敏状态确定单元,用于当当前跟随者的邻居集合中包含部分领航者和至少一个跟随者时,切断当前跟随者与邻居集合中的领航者的通信,并将当前跟随者确定为不灵敏跟随者。
8.根据权利要求6所述的多智能体编队跟踪控制系统,其特征在于,所述建模模块具体包括:
建模单元,用于对执行器进行建模:
uiF=ρi(t)sat(ui(t))+uib(t)
其中uiF为驱动控制输入,ui(t)为控制输入指令ui(t)∈Rm;uib(t)为执行器偏差,uib(t)∈Rm;ρi(t)为执行器效率矩阵,ρi(t)=diag{ρi1(t),ρi2(t),...,ρim(t)},0<ρij(t)≤1;sat:Rm→Rm为标准饱和函数,sat(uij(t))=sgn(uij(t))min(|uij(t)|,uM),uM为执行器物理特性相关的饱和值;ρij(t)=1,uibj=0时,表示无智能体故障;若0<ρij(t)<1,则表示执行器的第j通道失去了部分效率;若uibj≠0,表示执行器的第j通道存在输出偏差;
假设条件引入单元,用于引入假设条件:执行器偏差uib(t)未知但有界,满足|uib(t)|≤di,其中di为未知待估计的正的常数;执行器效率矩阵的元素ρij(t)未知但有界,满足ρ ij≤ρij≤1,其中ρ ij为未知待估计的正的常数;
模型转换单元,用于引入双曲正切函数,令ui=f(uic),其中f(uic)=uMtanh(uic),从而将执行器模型转化为:
uiF=ρi(t)f(uic(t))+uib(t)
增广对象引入单元,用于引入增广对象,并将转化后的执行器模型代入领航者与跟随者的动态线性方程,得到:
其中αic为控制信号,uic为增广对象的状态,uic∈Rm;f(uic)为增广对象的输出信号;所述领航者与跟随者的动态线性方程为:
其中xk,xi分别为领航者和跟随者的状态xk∈Rn,xi∈Rn;为xk(t)的微分;为xi(t)的微分;A,B为系统矩阵和控制分布矩阵A∈Rn×n,B∈Rn×n;uiF为包含失效与饱和特性的控制输入,H为领航者编号集合,F为跟随者编号集合。
9.根据权利要求8所述的多智能体编队跟踪控制系统,其特征在于,所述目标函数确定模块具体包括:
目标函数确定单元,用于以作为时变编队跟踪的目标函数;其中hi(t)是相对于编队参考的分段连续可微偏移向量,hi(t)∈Rn×1,i∈F;hi(t)及其微分是默认有界的;当满足limt→∞(xi(t)-hi(t)-c(t))=0,i∈F,则称跟随者形成了hF(t)表示的时变编队;c(t)为编队参考;αk(k∈H)为常数,αk(k∈H),
10.根据权利要求9所述的多智能体编队跟踪控制系统,其特征在于,所述控制模块具体包括:
第一控制律确定单元,用于利用公式确定第一虚拟控制律;其中Si1为跟随者的第一个动态面,跟随者i的当地编队跟踪误差,θi(t)=xi(t)-hi(t);aij、aik为系统邻接矩阵元素,若智能体i为智能体j邻居,那么aij=1,否则aij=0;若智能体i为智能体k邻居,那么aik=1,否则aik=0; 表示自适应时变增益c的估计;表示,故障参数边界的估计;表示故障参数边界的估计;ρ i=min(ρ i1,ρ i2,...,ρ im);P为正定矩阵,P∈Rn×n;vi(t)为时变编队hi(t)相关的补偿信号;σi是正的常数;
估计参数确定单元,用于利用公式
确定估计参数和的控制律;其中κi,μi为正的常数;
补偿信号确定单元,用于利用公式计算补偿信号vi(t);
正定矩阵确定单元,用于利用公式Q0=AP+PAT-ηBBT<0计算正定矩阵P;
滤波单元,用于令信号αi1(t)通过一阶滤波器,时间常数为τ:
βi1(0)=αi1(0)
其中βi1(t)为αi1(t)通过一阶滤波器后得到的输出信号;
第二控制律确定单元,用于利用公式确定自适应容错和抗饱和控制律;其中Si2(t)表示第二个动态面,Si2(t)=f(uic)-βi1(t);K为第二个动态面Si2(t)的增益;且自适应容错和抗饱和控制律中各个参数的约束条件为:
其中ε、γi(i=1,2,3)为正的常数,ρ=min{ρ 1,ρ 2,...,ρ n};λM为矩阵L1的最大特征根。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910031546.6A CN109445447B (zh) | 2019-01-14 | 2019-01-14 | 一种多智能体编队跟踪控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910031546.6A CN109445447B (zh) | 2019-01-14 | 2019-01-14 | 一种多智能体编队跟踪控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109445447A true CN109445447A (zh) | 2019-03-08 |
CN109445447B CN109445447B (zh) | 2020-02-14 |
Family
ID=65544154
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910031546.6A Active CN109445447B (zh) | 2019-01-14 | 2019-01-14 | 一种多智能体编队跟踪控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109445447B (zh) |
Cited By (32)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110377051A (zh) * | 2019-07-04 | 2019-10-25 | 河海大学 | 一种应用于无人机群的时变编队蜂拥控制方法 |
CN110442134A (zh) * | 2019-08-01 | 2019-11-12 | 北京理工大学 | 一种基于双层网络的多智能体群集控制方法 |
CN110488845A (zh) * | 2019-09-18 | 2019-11-22 | 中国人民解放军火箭军工程大学 | 一种障碍物遮挡下多智能体自抗扰时变编队跟踪与避撞控制方法 |
CN110764602A (zh) * | 2019-10-16 | 2020-02-07 | 北京航空航天大学 | 用于降低存储开销的汇流阵列 |
CN110780668A (zh) * | 2019-04-09 | 2020-02-11 | 北京航空航天大学 | 一种多无人艇的分布式编队合围跟踪控制方法及系统 |
CN110928185A (zh) * | 2019-11-22 | 2020-03-27 | 广东工业大学 | 一种多智能体系统的量化控制方法 |
CN111103833A (zh) * | 2019-12-20 | 2020-05-05 | 南京邮电大学 | 一种多化学反应罐反应液体积一致性控制器系统及设计方法 |
CN111142562A (zh) * | 2019-12-27 | 2020-05-12 | 北京理工大学 | 基于应力矩阵的混合条件约束下的编队变换控制方法 |
CN111240365A (zh) * | 2020-03-12 | 2020-06-05 | 北京航空航天大学 | 带有指定性能的无人机编队自适应执行器故障补偿方法 |
CN111435252A (zh) * | 2020-01-15 | 2020-07-21 | 北京航空航天大学 | 异构多智能体系统分组输出时变编队跟踪控制方法及系统 |
CN111552314A (zh) * | 2020-05-09 | 2020-08-18 | 北京航空航天大学 | 多无人机自适应编队跟踪控制方法 |
CN111651705A (zh) * | 2020-05-18 | 2020-09-11 | 北京航空航天大学 | 集群编队跟踪控制方法 |
CN112034891A (zh) * | 2020-09-21 | 2020-12-04 | 北京邮电大学 | 飞行自组网移动性控制方法和装置 |
CN112306020A (zh) * | 2020-10-29 | 2021-02-02 | 西北工业大学 | 一种多智能体集群对指定目标位置的均匀球面分散控制方法 |
CN112348157A (zh) * | 2020-11-18 | 2021-02-09 | 中国空间技术研究院 | 多智能体系统编队构型的协同优化方法及装置 |
CN112394719A (zh) * | 2019-07-31 | 2021-02-23 | 南京理工大学 | 一种基于采样数据的多运动体系统编队控制装置及方法 |
CN112558476A (zh) * | 2020-12-04 | 2021-03-26 | 广东工业大学 | 基于攻击补偿的非线性多智体系统无领导者一致控制方法 |
CN112947086A (zh) * | 2021-03-09 | 2021-06-11 | 南京航空航天大学 | 一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法 |
CN112987758A (zh) * | 2021-04-29 | 2021-06-18 | 电子科技大学 | 一种多水面航行器协同跟踪编队控制方法 |
CN113093555A (zh) * | 2021-04-14 | 2021-07-09 | 江南大学 | 一种多智能体全局一致性控制方法及系统 |
CN113268064A (zh) * | 2021-07-01 | 2021-08-17 | 黄山学院 | 一种考虑通信时延的多移动机器人协同编队控制方法 |
CN113485101A (zh) * | 2021-06-10 | 2021-10-08 | 杭州电子科技大学 | 一种执行器饱和多智能体系统增益调度控制方法 |
CN113821028A (zh) * | 2021-08-30 | 2021-12-21 | 浙江大学 | 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 |
CN114115262A (zh) * | 2021-11-23 | 2022-03-01 | 上海交通大学 | 基于方位角信息的多auv执行器饱和协同编队控制系统和方法 |
CN114840027A (zh) * | 2022-07-01 | 2022-08-02 | 南京理工大学 | 异构四旋翼飞行器编队姿态容错控制方法 |
CN116679573A (zh) * | 2023-08-04 | 2023-09-01 | 北京全路通信信号研究设计院集团有限公司 | 一种一致性跟踪控制方法、装置、电子设备及存储介质 |
CN116872221A (zh) * | 2023-09-08 | 2023-10-13 | 湖南大学 | 一种多机协同转体大型工件的数据驱动二分一致控制方法 |
CN116893692A (zh) * | 2023-09-07 | 2023-10-17 | 北京航空航天大学 | 一种领导者丢失的无人机编队鲁棒控制系统及控制方法 |
CN117193363A (zh) * | 2023-09-26 | 2023-12-08 | 重庆大学 | 一种基于视觉定位验证平台的多智能体有限时间编队控制方法 |
CN117250998A (zh) * | 2023-11-17 | 2023-12-19 | 北京航空航天大学 | 多智能体系统跟踪控制方法、智能体和程序产品 |
CN117970941A (zh) * | 2024-01-31 | 2024-05-03 | 哈尔滨工业大学 | 一种抗饱和的安全编队控制方法 |
CN117991630A (zh) * | 2023-12-21 | 2024-05-07 | 海南大学 | 一种无人驾驶系统领导-跟随编队的故障检测方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150120126A1 (en) * | 2008-05-27 | 2015-04-30 | Wilfred So | System and method for multiple vehicles moving a common payload |
CN105242544A (zh) * | 2015-10-30 | 2016-01-13 | 山东科技大学 | 考虑随机扰动的非线性多无人机系统容错编队控制方法 |
CN108803316A (zh) * | 2018-03-09 | 2018-11-13 | 南京航空航天大学 | 针对多智能体系统执行器故障的主动容错控制方法 |
-
2019
- 2019-01-14 CN CN201910031546.6A patent/CN109445447B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150120126A1 (en) * | 2008-05-27 | 2015-04-30 | Wilfred So | System and method for multiple vehicles moving a common payload |
CN105242544A (zh) * | 2015-10-30 | 2016-01-13 | 山东科技大学 | 考虑随机扰动的非线性多无人机系统容错编队控制方法 |
CN108803316A (zh) * | 2018-03-09 | 2018-11-13 | 南京航空航天大学 | 针对多智能体系统执行器故障的主动容错控制方法 |
Non-Patent Citations (1)
Title |
---|
宋筱祺: "基于自适应技术的不确定系统容错控制研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (53)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110780668B (zh) * | 2019-04-09 | 2020-08-18 | 北京航空航天大学 | 一种多无人艇的分布式编队合围跟踪控制方法及系统 |
CN110780668A (zh) * | 2019-04-09 | 2020-02-11 | 北京航空航天大学 | 一种多无人艇的分布式编队合围跟踪控制方法及系统 |
CN110377051A (zh) * | 2019-07-04 | 2019-10-25 | 河海大学 | 一种应用于无人机群的时变编队蜂拥控制方法 |
CN112394719B (zh) * | 2019-07-31 | 2023-11-03 | 南京理工大学 | 一种基于采样数据的多运动体系统编队控制装置及方法 |
CN112394719A (zh) * | 2019-07-31 | 2021-02-23 | 南京理工大学 | 一种基于采样数据的多运动体系统编队控制装置及方法 |
CN110442134A (zh) * | 2019-08-01 | 2019-11-12 | 北京理工大学 | 一种基于双层网络的多智能体群集控制方法 |
CN110488845A (zh) * | 2019-09-18 | 2019-11-22 | 中国人民解放军火箭军工程大学 | 一种障碍物遮挡下多智能体自抗扰时变编队跟踪与避撞控制方法 |
CN110764602A (zh) * | 2019-10-16 | 2020-02-07 | 北京航空航天大学 | 用于降低存储开销的汇流阵列 |
CN110928185A (zh) * | 2019-11-22 | 2020-03-27 | 广东工业大学 | 一种多智能体系统的量化控制方法 |
CN110928185B (zh) * | 2019-11-22 | 2022-07-05 | 广东工业大学 | 一种多智能体系统的量化控制方法 |
CN111103833A (zh) * | 2019-12-20 | 2020-05-05 | 南京邮电大学 | 一种多化学反应罐反应液体积一致性控制器系统及设计方法 |
CN111103833B (zh) * | 2019-12-20 | 2023-03-07 | 南京邮电大学 | 一种多化学反应罐反应液体积一致性控制器系统及设计方法 |
CN111142562A (zh) * | 2019-12-27 | 2020-05-12 | 北京理工大学 | 基于应力矩阵的混合条件约束下的编队变换控制方法 |
CN111435252A (zh) * | 2020-01-15 | 2020-07-21 | 北京航空航天大学 | 异构多智能体系统分组输出时变编队跟踪控制方法及系统 |
CN111435252B (zh) * | 2020-01-15 | 2020-12-25 | 北京航空航天大学 | 异构多智能体系统分组输出时变编队跟踪控制方法及系统 |
CN111240365A (zh) * | 2020-03-12 | 2020-06-05 | 北京航空航天大学 | 带有指定性能的无人机编队自适应执行器故障补偿方法 |
CN111552314A (zh) * | 2020-05-09 | 2020-08-18 | 北京航空航天大学 | 多无人机自适应编队跟踪控制方法 |
CN111552314B (zh) * | 2020-05-09 | 2021-05-18 | 北京航空航天大学 | 多无人机自适应编队跟踪控制方法 |
CN111651705B (zh) * | 2020-05-18 | 2022-05-13 | 北京航空航天大学 | 集群编队跟踪控制方法 |
CN111651705A (zh) * | 2020-05-18 | 2020-09-11 | 北京航空航天大学 | 集群编队跟踪控制方法 |
CN112034891A (zh) * | 2020-09-21 | 2020-12-04 | 北京邮电大学 | 飞行自组网移动性控制方法和装置 |
CN112306020A (zh) * | 2020-10-29 | 2021-02-02 | 西北工业大学 | 一种多智能体集群对指定目标位置的均匀球面分散控制方法 |
CN112306020B (zh) * | 2020-10-29 | 2021-10-26 | 西北工业大学 | 一种多智能体集群对指定目标位置的均匀球面分散控制方法 |
CN112348157A (zh) * | 2020-11-18 | 2021-02-09 | 中国空间技术研究院 | 多智能体系统编队构型的协同优化方法及装置 |
CN112348157B (zh) * | 2020-11-18 | 2024-04-30 | 中国空间技术研究院 | 多智能体系统编队构型的协同优化方法及装置 |
CN112558476A (zh) * | 2020-12-04 | 2021-03-26 | 广东工业大学 | 基于攻击补偿的非线性多智体系统无领导者一致控制方法 |
CN112558476B (zh) * | 2020-12-04 | 2022-06-14 | 广东工业大学 | 基于攻击补偿的非线性多智体系统无领导者一致控制方法 |
CN112947086A (zh) * | 2021-03-09 | 2021-06-11 | 南京航空航天大学 | 一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法 |
CN112947086B (zh) * | 2021-03-09 | 2022-10-04 | 南京航空航天大学 | 一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法 |
CN113093555A (zh) * | 2021-04-14 | 2021-07-09 | 江南大学 | 一种多智能体全局一致性控制方法及系统 |
CN113093555B (zh) * | 2021-04-14 | 2022-07-15 | 江南大学 | 一种多智能体全局一致性控制方法及系统 |
CN112987758B (zh) * | 2021-04-29 | 2021-08-06 | 电子科技大学 | 一种多水面航行器协同跟踪编队控制方法 |
CN112987758A (zh) * | 2021-04-29 | 2021-06-18 | 电子科技大学 | 一种多水面航行器协同跟踪编队控制方法 |
CN113485101A (zh) * | 2021-06-10 | 2021-10-08 | 杭州电子科技大学 | 一种执行器饱和多智能体系统增益调度控制方法 |
CN113485101B (zh) * | 2021-06-10 | 2024-10-01 | 杭州电子科技大学 | 一种执行器饱和多智能体系统增益调度控制方法 |
CN113268064A (zh) * | 2021-07-01 | 2021-08-17 | 黄山学院 | 一种考虑通信时延的多移动机器人协同编队控制方法 |
CN113821028B (zh) * | 2021-08-30 | 2023-08-08 | 浙江大学 | 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 |
CN113821028A (zh) * | 2021-08-30 | 2021-12-21 | 浙江大学 | 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 |
CN114115262B (zh) * | 2021-11-23 | 2024-02-02 | 上海交通大学 | 基于方位角信息的多auv执行器饱和协同编队控制系统和方法 |
CN114115262A (zh) * | 2021-11-23 | 2022-03-01 | 上海交通大学 | 基于方位角信息的多auv执行器饱和协同编队控制系统和方法 |
CN114840027A (zh) * | 2022-07-01 | 2022-08-02 | 南京理工大学 | 异构四旋翼飞行器编队姿态容错控制方法 |
CN116679573A (zh) * | 2023-08-04 | 2023-09-01 | 北京全路通信信号研究设计院集团有限公司 | 一种一致性跟踪控制方法、装置、电子设备及存储介质 |
CN116679573B (zh) * | 2023-08-04 | 2023-10-20 | 北京全路通信信号研究设计院集团有限公司 | 一种一致性跟踪控制方法、装置、电子设备及存储介质 |
CN116893692A (zh) * | 2023-09-07 | 2023-10-17 | 北京航空航天大学 | 一种领导者丢失的无人机编队鲁棒控制系统及控制方法 |
CN116893692B (zh) * | 2023-09-07 | 2023-12-08 | 北京航空航天大学 | 一种领导者丢失的无人机编队鲁棒控制系统及控制方法 |
CN116872221B (zh) * | 2023-09-08 | 2023-12-05 | 湖南大学 | 一种多机协同转体大型工件的数据驱动二分一致控制方法 |
CN116872221A (zh) * | 2023-09-08 | 2023-10-13 | 湖南大学 | 一种多机协同转体大型工件的数据驱动二分一致控制方法 |
CN117193363A (zh) * | 2023-09-26 | 2023-12-08 | 重庆大学 | 一种基于视觉定位验证平台的多智能体有限时间编队控制方法 |
CN117250998B (zh) * | 2023-11-17 | 2024-01-30 | 北京航空航天大学 | 多智能体系统跟踪控制方法、智能体和程序产品 |
CN117250998A (zh) * | 2023-11-17 | 2023-12-19 | 北京航空航天大学 | 多智能体系统跟踪控制方法、智能体和程序产品 |
CN117991630A (zh) * | 2023-12-21 | 2024-05-07 | 海南大学 | 一种无人驾驶系统领导-跟随编队的故障检测方法 |
CN117991630B (zh) * | 2023-12-21 | 2024-09-06 | 海南大学 | 一种无人驾驶系统领导-跟随编队的故障检测方法 |
CN117970941A (zh) * | 2024-01-31 | 2024-05-03 | 哈尔滨工业大学 | 一种抗饱和的安全编队控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109445447B (zh) | 2020-02-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109445447B (zh) | 一种多智能体编队跟踪控制方法及系统 | |
Sun et al. | Adaptive decentralized neural network tracking control for uncertain interconnected nonlinear systems with input quantization and time delay | |
Lin et al. | Event-based finite-time neural control for human-in-the-loop UAV attitude systems | |
Mahmood et al. | Decentrailized formation flight control of quadcopters using robust feedback linearization | |
Yoo et al. | Guaranteed performance design for distributed bounded containment control of networked uncertain underactuated surface vessels | |
CN109116736B (zh) | 基于滑模的线性多智能体系统执行器故障的容错控制方法 | |
Wu et al. | Neural network output-feedback consensus fault-tolerant control for nonlinear multiagent systems with intermittent actuator faults | |
CN107797454B (zh) | 基于有限时间控制的多智能体系统协同容错控制方法 | |
Huang et al. | Distributed and performance guaranteed robust control for uncertain MIMO nonlinear systems with controllability relaxation | |
Deng et al. | Distributed adaptive fault-tolerant output regulation of heterogeneous multi-agent systems with coupling uncertainties and actuator faults | |
Yan et al. | Event-triggered formation control for time-delayed discrete-time multi-agent system applied to multi-UAV formation flying | |
Wang et al. | Bioinspired neurodynamics based formation control for unmanned surface vehicles with line-of-sight range and angle constraints | |
Chemachema | Output feedback direct adaptive neural network control for uncertain SISO nonlinear systems using a fuzzy estimator of the control error | |
CN112305918A (zh) | 超螺旋观测器下的多智能体系统滑模容错一致性控制算法 | |
Niu et al. | Event-triggered adaptive command filtered bipartite finite-time tracking control of nonlinear coopetition MASs with time-varying disturbances | |
Liu et al. | Adaptive fault‐tolerant formation control for quadrotors with actuator faults | |
CN116466588A (zh) | 多智能体系统的有限时间时变编队跟踪控制方法及系统 | |
Li et al. | Learning-observer-based adaptive tracking control of multiagent systems using compensation mechanism | |
Gao et al. | Tracking control for a quadrotor via dynamic surface control and adaptive dynamic programming | |
Kim et al. | Distributed event-triggered adaptive formation tracking of networked uncertain stratospheric airships using neural networks | |
Chen et al. | Adaptive optimal consensus control of multiagent systems with unknown dynamics and disturbances via reinforcement learning | |
CN111806728A (zh) | 具有执行器饱和的航天器多智能体姿态同步容错控制方法 | |
Cheng et al. | Optimal Containment Control of a Quadrotor Team With Active Leaders via Reinforcement Learning | |
Ma et al. | A Hierarchical Distributed Data-Driven Adaptive Learning Control for Nonaffine Nonlinear MASs | |
Park et al. | State-Transformation-Based Recursive Design Strategy for Leader-Follower Safety Formation Control of Uncertain Multiple Quadrotors |
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 |