CN110058519B - 一种基于快速自适应技术的主动编队容错控制方法 - Google Patents

一种基于快速自适应技术的主动编队容错控制方法 Download PDF

Info

Publication number
CN110058519B
CN110058519B CN201910261490.3A CN201910261490A CN110058519B CN 110058519 B CN110058519 B CN 110058519B CN 201910261490 A CN201910261490 A CN 201910261490A CN 110058519 B CN110058519 B CN 110058519B
Authority
CN
China
Prior art keywords
fault
matrix
error
aircraft
formation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910261490.3A
Other languages
English (en)
Other versions
CN110058519A (zh
Inventor
张柯
刘万璋
姜斌
陈谋
盛守照
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN201910261490.3A priority Critical patent/CN110058519B/zh
Publication of CN110058519A publication Critical patent/CN110058519A/zh
Application granted granted Critical
Publication of CN110058519B publication Critical patent/CN110058519B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种基于快速自适应技术的主动编队容错控制方法,通过构建多智能体系统的连接图并得出分布式多智能体系统的拉普拉斯矩阵和领导跟随连通矩阵;针对存在非线性项的四旋翼飞行器模型,构建相应的观测器设计快速自适应故障估计器来预测故障的实际大小;构造局部增广系统误差动态方程和全局增广系统误差动态方程;构建Lyapunov函数,通过相应的理论推导得出计算控制器和故障估计器中参数的方法,使得系统在发生执行器故障和外部干扰的作用下完成编队控制的要求。本发明可在理论层面上彻底消除外界干扰对容错控制的不利影响,提升故障估计的性能,并实现四旋翼飞行器编队任何一个节点出现执行器故障或者多个节点同时出现执行器故障的容错控制。

Description

一种基于快速自适应技术的主动编队容错控制方法
技术领域
本发明属于多智能体系统技术领域,特别涉及一种基于快速自适应技术的主动编队容错控制方法。
背景技术
近些年,随着系统互联复杂化、任务模式协同化趋势的不断加深,基于多智能体系统(Multi-Agent Systems,MAS)技术的相关理论与应用研究逐步开展与完善起来,而与之密切相关的故障诊断理论与方法研究也愈发引人关注。多智能体系统自身特有的网络链接、自由分布、信息共享等优点,使得相关故障诊断系统可以以前所未有的姿态朝着“体大量多”的方向集成和互操作,同时子系统或者说单一智能体在网络化通讯层面上诊断信息的多样化交换和共享方式,也在极大程度上提升了复杂系统的诊断设计自由度和诊断结果准确性,从而有效地拓宽了容错控制方法的研究领域和适用范围。值得一提的是,面对日益复杂的网络化控制系统,基于多智能技术的容错控制方法相较于传统的以冗余设计或分立设计为核心的控制方法,兼有了更小通讯负载、更少资源消耗,且易于扩展、易于维护等特点。这些都将对网络化控制系统容错控制技术的发展与应用起到举足轻重的推动作用。
随着飞行控制系统的发展,需要多智能体协同完成任务的情况层出不穷,基于多智能体系统技术的研究也得到了越来越多的重视和研究。飞行控制系统的一项重要指标就是高可靠性,因为实际飞行过程中复杂的环境影响,在设计飞行控制系统时就要考虑到各种因外界因素引起的不确定性。一个理想的飞行控制系统应当完成如下设计目标:在飞机内部发生部件故障或者遭遇到外界影响发生意外损伤时,系统能够按照故障发生的性质和损伤的特性进行控制策略的应急改变。随着对无人机的研究逐步深化和对无人机的应用领域不断扩大,面对越来越复杂的环境,单个无人机存在的任务执行效率无法进一步提升、容错性较差、受能源和体积限制等问题逐步显露出来,因此,多无人机协同提高完成任务已成为必然趋势。在研究飞行器群的编队、协同等控制问题时,如果机群中的任何一架飞行器或多架飞行器自身发生了故障,且不能及时的进行处理,那么基于导航系统和各种传感器设备,通过飞行器之间的相关信息交互,很有可能会将单个飞行器故障的影响扩散的整个集群当中,该问题的解决对于集群控制是至关重要的。而本专利提出的基于快速自适应技术的飞行控制系统编队容错控制方法正是针对上述情况完成的研究,具有十分重要的理论研究价值和广阔的应用背景。
发明内容
发明目的:针对现有技术的问题,提供一种基于快速自适应技术的主动编队容错控制方法,借助快速自适应观测器来对故障进行预估,并利用观测器得到的状态信息来设计容错控制器,可在理论层面上彻底消除外界干扰对容错控制的不利影响,提升故障估计的性能,并实现四旋翼飞行器编队任何一个节点出现执行器故障或者多个节点同时出现执行器故障的容错控制。
技术方案:为解决上述技术问题,本发明提供基于快速自适应技术的主动编队容错控制方法,包括如下步骤:
(1)构建多智能体系统的连接图并以有向图的形式表示,得出分布式多智能体系统的拉普拉斯矩阵L和领导跟随连通矩阵G;
(2)针对存在非线性项的四旋翼飞行器模型,设计一个相应的领导节点,并构建相应的观测器来观察每个智能体的状态变量并设计快速自适应故障估计器来预测故障的实际大小;
(3)针对有向通讯拓扑结构下的每个智能体,利用观测器的全局误差变量和故障估计值来设计相应的控制器,并构造局部增广系统误差动态方程和全局增广系统误差动态方程;
(4)利用局部增广系统误差和全局增广系统误构建Lyapunov函数,通过相应的理论推导得出计算控制器和故障估计器中参数的方法,根据定理中所计算得到的参数可以使得系统在发生执行器故障和外部干扰的作用下完成编队控制的要求。
进一步的,所述步骤(1)的具体步骤如下:
本发明考虑了一组具有领导者跟随架构的四旋翼飞行器的编队控制,由一个领导节点和N个跟随者组成。假设领导者节点是标记为0的节点,并且每个跟随者的标记分别为i∈Γ={1,2,3,…,N},且该集合为一个有限集合。这里用
Figure BDA0002015426110000021
来表示N个节点之间的通讯拓扑,其中V={vi}和
Figure BDA0002015426110000022
分别代表节点集合和边集合。定义
Figure BDA0002015426110000023
为图
Figure BDA0002015426110000024
的邻接矩阵,如果在节点i和j之间有通讯连接,即(vi,vj)∈ε,则aij=aji>0,否则,aij=aji=0,对于所有的i∈Γ有aii=0,其中节点vi的临接集合可以由
Figure BDA0002015426110000025
来表示。在这里定义图
Figure BDA0002015426110000031
的度矩阵为
Figure BDA0002015426110000032
其中
Figure BDA0002015426110000033
且有向图的拉普拉斯矩阵
Figure BDA0002015426110000034
定义领导跟随连通矩阵G=diag{g1,g2,…,gN},其中gi∈{0,1},当gi=1时代表第i个飞行器可以接收到期望轨迹的信息,接受不到时gi则为0。
进一步的,所述步骤(2)的具体步骤如下:
四旋翼飞行器的外环子系统可以通过如下的动态方程来表示:
Figure BDA0002015426110000035
其中,
Figure BDA0002015426110000036
为状态变量,
Figure BDA0002015426110000037
为系统的控制输入,
Figure BDA0002015426110000038
为故障向量,
Figure BDA0002015426110000039
为传感器输出,
Figure BDA00020154261100000310
为外界干扰项。
Figure BDA00020154261100000311
Figure BDA00020154261100000312
为系统已知的矩阵。函数
Figure BDA00020154261100000313
是一个连续函数,表示第i个飞行器的非线性动态,i=1,2,…,N。且非线性函数η(·,·)满足Lipschitz条件,且其Lipschitz常数为Lη,即满足以下条件:
|η(x1(t),t)-η(x2(t),t)||≤Lη||x1(t)-x2(t)||,t≥0.
领导节点的动态方程如下:
Figure BDA00020154261100000314
在对编队控制问题进行研究时,执行器故障通常被考虑在内。不失一般性,假设
Figure BDA00020154261100000323
其中
Figure BDA00020154261100000324
为矩阵B的第ql列,因此,存在一个矩阵
Figure BDA00020154261100000315
满足
Figure BDA00020154261100000316
Figure BDA00020154261100000317
Figure BDA00020154261100000318
的性质可得
Figure BDA00020154261100000319
其余项都为0。有了矩阵
Figure BDA00020154261100000320
之后,执行器故障可表示为:
Figure BDA00020154261100000321
为了监控不同的通道的执行器,可以选择指定的
Figure BDA00020154261100000322
此外,根据不同故障fi(t)的选择,可以根据故障的严重程度,故障的性质和时变性质来考虑不同类型的故障,而上述的表述方法则可以表示各种类型的执行器故障。
控制器的设计往往需要用到状态反馈信息,然而在大多数实际应用中,飞行器的状态通常是不可测量的。为了估计飞行器的状态xi(t),通常可以设计如下的观测器:
Figure BDA0002015426110000041
其中,
Figure BDA0002015426110000042
Figure BDA0002015426110000043
分别代表xi(t),fi(t)和yi(t)的估计值,
Figure BDA0002015426110000044
为待设计的观测器的增益矩阵。
在观测器设计好的基础上,利用快速自适应方法可以利用状态的估计值来估计故障的大小,具体形式如下:
Figure BDA0002015426110000045
其中,
Figure BDA0002015426110000046
为输出误差,
Figure BDA0002015426110000047
为故障估计误差,
Figure BDA0002015426110000048
为ey,i(t)对时间t的求导,
Figure BDA0002015426110000049
为权重矩阵且Γ=ΓT>0,
Figure BDA00020154261100000410
为两个待设计的矩阵,σ为一个正常数。
进一步的,所述步骤(3)中的具体步骤如下:
假设相邻飞行器或者相邻车辆之间的状态误差是可以精确测量的。在这些基础上来进行设计,便有了如下的协同编队控制方案:
Figure BDA00020154261100000411
其中,c为待设计的加权系数,
Figure BDA00020154261100000412
为待设计的反馈增益矩阵。
Figure BDA00020154261100000413
为飞行器i和飞行器j之间的期望误差向量。
定义状态误差为
Figure BDA00020154261100000414
编队误差为
Figure BDA00020154261100000415
进一步又可以得到
Figure BDA00020154261100000416
将上述控制器带入到四旋翼飞行器模型当中,可以得到如下形式的闭环系统:
Figure BDA00020154261100000417
根据上述结果又可以得出第i个飞行器的误差动态方程:
Figure BDA00020154261100000513
其中,
Figure BDA0002015426110000052
再将上述结构通过全局误差的形式进行表述,可以得出:
Figure BDA0002015426110000053
其中,Π(ex(t),t)=[κT(xx,1(t),t),κT(xx,2(t),t),…,κT(xx,N(t),t)]T
Figure BDA0002015426110000054
Figure BDA00020154261100000512
对于第i个四旋翼飞行器,编队误差为:
Figure BDA0002015426110000057
其相应的全局形式为:
Figure BDA0002015426110000058
其中,κ1(ei(t),t)=η(xi(t),t)-η(xi r(t),t),
Figure BDA0002015426110000059
Figure BDA00020154261100000510
第i个四旋翼飞行器的故障估计误差可以表示为:
Figure BDA00020154261100000511
其相应的全局形式为:
Figure BDA0002015426110000061
为了使得本发明中控制器的参数可以满足编队控制的要求,在此进行如下的定义:
对于本步骤中所描述的多智能体系统,当满足以下条件时则称该多智能体系统满足了编队控制:
(1)在不出现干扰和执行器故障的情况下有:
Figure BDA0002015426110000062
(2)在执行器故障和外部干扰的影响且系统满足零初始的条件下,误差变量
Figure BDA0002015426110000063
满足
Figure BDA0002015426110000064
其中β>0的大小取决于
Figure BDA0002015426110000065
Figure BDA0002015426110000066
Figure BDA0002015426110000067
分别为
Figure BDA0002015426110000068
的上限,γ为一个应该被设计的尽量小的正常数。
并且,假设外部干扰wi(t)满足||wi(t)||<βw,(i=1,2,…,N),加性故障fi(t)与其导数
Figure BDA0002015426110000069
是有界的,即
Figure BDA00020154261100000610
其中βf
Figure BDA00020154261100000611
为两个已知的正常数。
进一步的,所述步骤(4)的具体步骤如下:
由上述内容可知,观测器中的矩阵
Figure BDA00020154261100000612
控制器中的矩阵K,故障估计器中的矩阵R1,R2以及增益矩阵Γ,耦合参数c和σ均是未知的,上述相关参数可以通过下列矩阵不等式获取:
K=BTP,R1C=FTP,
Figure BDA00020154261100000613
Figure BDA00020154261100000614
Figure BDA00020154261100000615
Figure BDA0002015426110000071
其中,
Figure BDA0002015426110000072
为一个正定的实对称矩阵,矩阵D=R2C,参数α12,…,α7为几个应被设计的尽量小的正常数,接下来将给出具体的证明过程。
考虑下列的Lyapunov函数:
Figure BDA0002015426110000073
将V(t)沿时间t求导,将步骤三种得到几个全局误差向量带入到上式当中,可以得到:
Figure BDA0002015426110000074
Figure BDA0002015426110000075
Figure BDA0002015426110000076
Figure BDA0002015426110000077
且K=BTP,
Figure BDA0002015426110000078
T=L+G,
Figure BDA0002015426110000079
则上式又可被重写为:
Figure BDA00020154261100000710
由上式还可以进一步得到:
Figure BDA00020154261100000711
由向量的不等式相关条件,可以得出下列结论:
Figure BDA0002015426110000081
Figure BDA0002015426110000082
Figure BDA0002015426110000083
Figure BDA0002015426110000084
Figure BDA0002015426110000085
Figure BDA0002015426110000086
Figure BDA0002015426110000087
其中,αi>0,i=1,2,…,7为已知常数。将上述的不等式代入到之前的推导当中并考虑到条件FTP-1=RTC,D=R2C,可以得到:
Figure BDA0002015426110000088
再考虑如下的不等式条件:
Figure BDA0002015426110000091
将上述的不等式带入到之前的推导过程当中,又可以得到:
Figure BDA0002015426110000092
又因为
Figure BDA0002015426110000093
Figure BDA0002015426110000094
为实对称矩阵,且
Figure BDA0002015426110000095
可以得出
Figure BDA0002015426110000096
Figure BDA0002015426110000097
又因为
Figure BDA0002015426110000098
Figure BDA0002015426110000099
为实对称矩阵,且
Figure BDA00020154261100000910
可以得出
Figure BDA00020154261100000911
Figure BDA00020154261100000912
则上式又可以进一步为:
Figure BDA00020154261100000913
再对上式进行进一步的整理,可以得出:
Figure BDA0002015426110000101
即满足第四步中提出的假设条件且不存在外部干扰时,
Figure BDA0002015426110000102
进而可以得出
Figure BDA0002015426110000103
在上述的基础上,再进一步讨论第三步所提到的性能指标,J可以表示为:
Figure BDA0002015426110000104
Figure BDA0002015426110000105
的定义,J又可被重写为:
Figure BDA0002015426110000106
从而可以得出,当系统满足零初始条件下,性能指标J<0,由此证明完成。从上述的证明过程中可以看出,α12,…,α7的大小选择取决于第四步中的矩阵不等式,这样就可以保证误差可以收敛到一个很小的范围内,以此实现理想编队轨迹。
与现有技术相比,本发明的优点在于:
(1)针对非线性系统,将系统中可能出现的外部干扰考虑在内,研究了其编队容错控制问题。
(2)基于自适应观测器方法,利用观测器的状态估计值进行控制器的设计,并对执行器故障进行了估计,得到的故障估计值同样被应用到控制器当中,以用于补偿实际故障。
(3)利用误差信息设计了Lyapunov函数,对误差和外部干扰进行处理,并设计了相应的性能指标,保证了编队误差在意义下具有渐进稳定的趋势。
附图说明
图1为具体实施例中本发明控制系统的具体结构图;
图2为具体实施例中多智能体系统的无向通讯拓扑图;
图3为具体实施例中控制器中无补偿项时,五个四旋翼飞行器的运动轨迹曲线图;
图4为具体实施例中控制器中无补偿项时的响应曲线,(a)图为飞行器1的误差响应曲线,(b)图为飞行器4的误差响应曲线;
图5为具体实施例中控制器中有补偿项时,五个四旋翼飞行器的运动轨迹曲线图;
图6为具体实施例中控制器中有补偿项时的响应曲线,(a)图为飞行器1的误差响应曲线,(b)图为飞行器4的误差响应曲线;
图7为具体实施例中飞行器1的故障估计值的响应曲线图;
图8为具体实施例中飞行器4的故障估计值的响应曲线图;
图9为具体实施例中飞行器1和飞行器4的故障估计值与实际值的误差响应曲线图。
具体实施方式
下面结合附图和具体实施方式,进一步阐明本发明。本发明描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所得到的其他实施例,都属于本发明所保护的范围。
本发明将使用四旋翼飞行器平台对本发明的理论结果进行验证,主要通过matlab对四旋翼飞行器进行建模并进行数值仿真。交换拓扑结构如图2所示,为了便于分析,假设所有四旋翼飞行器的运动都在x,y坐标轴上,且每个飞行器的高度和姿态角都指定为常量。
对于每个四旋翼飞行器,轨迹系统中的时间常数远远大于姿态系统的时间常数。因此,如果编队飞行仅考虑四旋翼飞行器的位置和速度,则可以将四旋翼模型解耦为内环控制系统和外环控制系统,其中外环系统使得飞行器可以按照理想轨迹飞行,内环系统则跟踪外环系统生成的一个预期值,具体结构如图1所示。
本发明主要考虑了四旋翼飞行器的外环系统,一个飞行器可以看做是质心分布的,即其动力学方程可以由下列的二阶系统近似描述:
Figure BDA0002015426110000121
其中,
Figure BDA0002015426110000122
Figure BDA0002015426110000123
分别代表四旋翼飞行器的位置和速度,ui(t)为飞行器的控制输入,Ki=0.01为飞行器的气动阻尼系数,质量mi=0.468kg。ρx(t)=[pi,x(t),vi,x(t)]T且ρy(t)=[pi,x(t),vi,y(t)]T,pi,x(t)和pi,y(t)为飞行器在x-y坐标系上的位移,vi,x(t)和vi,y(t)为飞行器在x-y坐标系上的速度。
令xi(t)=[ρx(t),ρy(t)]T,则四旋翼飞行器的动态方程又可以表示为:
Figure BDA0002015426110000124
其中
Figure BDA0002015426110000125
Figure BDA0002015426110000126
Figure BDA0002015426110000127
代表矩阵之间的Kronecker积。
在不考虑模型中不确定性的情况下,可以用上述数学模型来表示四旋翼飞行器的动力学方程。本发明考虑了外部干扰和执行器故障的影响,因此,上述模型可以扩展为以下的形式:
Figure BDA0002015426110000128
其中:
Figure BDA0002015426110000129
矩阵C和F分别为输出矩阵和故障分布矩阵,通过以往对四旋翼飞行器所进行的建模实验,系统中的非线性项可以选择为如下的形式:
ηi(xi(t),t)=0.1sin(xi(t))+0.05cos(xi(t))+0.3sin(xi(t))cos(2xi(t)).
首先,构建多智能体系统连接图并以无向图表示,如图2所示,1-5代表无向图具有的五个四旋翼飞行器,从图2可以的得到拉普拉斯矩阵L和领导跟随连通矩阵G:
Figure BDA0002015426110000131
五个飞行器的参考轨迹分别为:
x1,x(t)=x2,x(t)=x3,x(t)=x4,x(t)=x5,x(t)=t,
x1,y(t)=5sin(0.214x1,x(t)),
x2,y(t)=5sin(0.214x2,x(t))+4,
x3,y(t)=5sin(0.214x3,x(t))+8,
x4,y(t)=5sin(0.214x4,x(t))+12,
x5,y(t)=5sin(0.214x5,x(t))+16,
经过矩阵的相关计算可以得出以下的控制器参数:c=1.0875,σ=2.4512
Figure BDA0002015426110000132
Figure BDA0002015426110000133
Figure BDA0002015426110000134
Figure BDA0002015426110000135
Figure BDA0002015426110000136
且五个飞行器的初始条件分别为:
x1(0)=[5.178,0,1.379,0]T,x2(0)=[0.3185,0,5.322,0]T,x3(0)=[-4.684,0,1.137,0]T,x4(0)=[-2.368,0,-4.158,0]T,x5(0)=[3.082,0,-3.585,0]T.
仿真实例:
在本发明中,设仿真时间为120s,并且假设飞行器1和飞行器4为故障飞行器,执行器故障的形式如下:
Figure BDA0002015426110000141
Figure BDA0002015426110000142
为验证本发明容错控制方法的效果,应用matlab中的simulink模板进行仿真验证,仿真将通过两种情况来进行,情况一为控制器中无补偿项的数值仿真,情况二为控制器中有补偿项的数值仿真。两种情况下的仿真结果分别如下:
情况1:对于编队系统,使用一般形式下的控制方案,即去除控制器中的故障补偿项。在该控制方案的作用下,五个飞行器的运动轨迹如图3所示。在发生执行器故障之前,可以看到系统在该控制方案的作用下可以完成编队队形。然而,在飞行器1和飞行器4发生故障之后,队形明显被破坏,该结果可以从图3中清楚的观察到。
情况2:该情况则考虑控制方案中用于补偿和抵消执行器故障的一项,图5为五个飞行器的运动轨迹,可以观察到在飞行器1和飞行器4发生执行器故障之前和之后都可以按照预定的队形飞行。从图6中可以清楚的观察到在发生故障之前和发生故障之后误差的响应曲线。
从这些仿真图形中可以得出结论,本容错控制方案可以保证飞行器在发生执行器故障时,整个系统仍能按照指定的轨迹飞行。此外,飞行器1和飞行器4故障估计的结果分别如图7和图8所示,估计值与实际值的误差分别如图9所示,从中可以发现所提出的故障估计器可以准确、快速的实现故障估计。
本发明的具体实施方式中凡未涉到的说明属于本领域的公知技术,可参考公知技术加以实施。
以上具体实施方式是对本发明提出的一种基于未知输入观测器的直升机协同编队低频故障诊断方法技术思想的具体支持,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在本发明技术方案基础上所做的任何等同变化或等效的改动,均仍属于本发明技术方案保护的范围。

Claims (4)

1.一种基于快速自适应技术的主动编队容错控制方法,其特征在于,包括如下步骤:
(1)构建多智能体系统的连接图并以有向图的形式表示,得出分布式多智能体系统的拉普拉斯矩阵L和领导跟随连通矩阵G;
(2)针对存在非线性项的四旋翼飞行器模型,设计一个相应的领导节点,并构建相应的观测器来观察每个智能体的状态变量并设计快速自适应故障估计器来预测故障的实际大小;
(3)针对有向通讯拓扑结构下的每个智能体,利用观测器的全局误差变量和故障估计值来设计相应的控制器,并构造局部增广系统误差动态方程和全局增广系统误差动态方程;
(4)利用局部增广系统误差和全局增广系统误差构建Lyapunov函数,通过相应的理论推导得出计算控制器和故障估计器中参数的方法,根据定理中所计算得到的参数可以使得系统在发生执行器故障和外部干扰的作用下完成编队控制的要求;
所述步骤(2)中构建相应的观测器来观察每个智能体的状态变量并设计快速自适应故障估计器来预测故障的实际大小的具体步骤如下:
四旋翼飞行器的外环子系统通过如下的动态方程来表示:
Figure FDA0002408431830000011
其中,
Figure FDA0002408431830000012
为状态变量,
Figure FDA0002408431830000013
为系统的控制输入,
Figure FDA0002408431830000014
为故障向量,
Figure FDA0002408431830000015
为传感器输出,
Figure FDA0002408431830000016
为外界干扰项;
Figure FDA0002408431830000017
是系统矩阵,
Figure FDA0002408431830000018
是控制输入矩阵,
Figure FDA0002408431830000019
是输出矩阵,
Figure FDA00024084318300000110
是干扰输入分布矩阵和
Figure FDA00024084318300000111
为故障分布矩阵;函数
Figure FDA00024084318300000112
是一个连续函数,表示第i个飞行器的非线性动态,i=1,2,…,N;且非线性函数η(xi(t),t)满足Lipschitz条件,且其Lipschitz常数为Lη,即满足以下条件:
||η(x1(t),t)-η(x2(t),t)||≤Lη||x1(t)-x2(t)||,t≥0.
领导节点的动态方程如下:
Figure FDA0002408431830000021
其中,
Figure FDA0002408431830000022
是领导节点的状态向量;
在对编队控制问题进行研究时,执行器故障通常被考虑在内;不失一般性,假设
Figure FDA0002408431830000023
其中
Figure FDA0002408431830000024
为矩阵B的第ql列,因此,存在一个矩阵
Figure FDA0002408431830000025
满足
Figure FDA0002408431830000026
Figure FDA0002408431830000027
Figure FDA0002408431830000028
的性质可得
Figure FDA0002408431830000029
其余项都为0;有了矩阵
Figure FDA00024084318300000210
之后,执行器故障表示为:
Figure FDA00024084318300000211
为了监控不同的通道的执行器,选择指定的
Figure FDA00024084318300000212
此外,根据不同故障fi(t)的选择,根据故障的严重程度,故障的性质和时变性质来考虑不同类型的故障,而上述的表述方法则表示各种类型的执行器故障;
为了估计飞行器的状态xi(t),设计如下的观测器:
Figure FDA00024084318300000213
其中,
Figure FDA00024084318300000214
Figure FDA00024084318300000215
分别代表xi(t),fi(t)和yi(t)的估计值,
Figure FDA00024084318300000216
为待设计的观测器的增益矩阵;
在观测器设计好的基础上,利用快速自适应方法可以利用状态的估计值来估计故障的大小,具体形式如下:
Figure FDA00024084318300000217
其中,
Figure FDA00024084318300000218
为输出误差,
Figure FDA00024084318300000219
为故障估计误差,
Figure FDA00024084318300000220
为ey,i(t)对时间t的求导,
Figure FDA00024084318300000221
为权重矩阵且Γ=ΓT>0,
Figure FDA00024084318300000222
为两个待设计的矩阵,σ为一个正常数;所述步骤(4)中使得系统在发生执行器故障和外部干扰的作用下完成编队控制的要求的具体步骤如下:
观测器中的矩阵
Figure FDA00024084318300000223
控制器中的矩阵K,故障估计器中的矩阵R1,R2以及增益矩阵Γ,耦合参数c和σ均是未知的,上述相关参数可以通过下列矩阵不等式获取:
K=BTP,R1C=FTP,
Figure FDA0002408431830000031
Figure FDA0002408431830000032
Figure FDA0002408431830000033
Figure FDA0002408431830000034
其中,
Figure FDA0002408431830000035
为一个正定的实对称矩阵,矩阵D=R2C,参数α12,…,α7为几个应被设计的尽量小的正常数,接下来将给出具体的证明过程;
考虑下列的Lyapunov函数:
Figure FDA0002408431830000036
将V(t)沿时间t求导,将步骤三种得到几个全局误差向量带入到上式当中,可以得到:
Figure FDA0002408431830000037
Figure FDA0002408431830000038
Figure FDA0002408431830000039
Figure FDA00024084318300000310
且K=BTP,
Figure FDA00024084318300000311
T=L+G,
Figure FDA00024084318300000312
则上式又被重写为:
Figure FDA0002408431830000041
由上式还进一步得到:
Figure FDA0002408431830000042
由向量的不等式相关条件,得出下列结论:
Figure FDA0002408431830000043
Figure FDA0002408431830000044
Figure FDA0002408431830000045
Figure FDA0002408431830000046
Figure FDA0002408431830000047
Figure FDA0002408431830000048
Figure FDA0002408431830000049
其中,αi>0,i=1,2,…,7为已知常数;将上述的不等式代入到之前的推导当中并考虑到条件FTP-1=RTC,D=R2C,得到:
Figure FDA0002408431830000051
再考虑如下的不等式条件:
Figure FDA0002408431830000052
Figure FDA0002408431830000053
Figure FDA0002408431830000054
将上述的不等式带入到之前的推导过程当中,得到:
Figure FDA0002408431830000055
又因为
Figure FDA0002408431830000061
Figure FDA0002408431830000062
为实对称矩阵,且
Figure FDA0002408431830000063
得出
Figure FDA0002408431830000064
Figure FDA0002408431830000065
又因为
Figure FDA0002408431830000066
Figure FDA0002408431830000067
为实对称矩阵,且
Figure FDA0002408431830000068
得出
Figure FDA0002408431830000069
Figure FDA00024084318300000610
则上式又进一步为:
Figure FDA00024084318300000611
再对上式进行进一步的整理,得出:
Figure FDA00024084318300000612
即满足第四步中提出的假设条件且不存在外部干扰时,
Figure FDA00024084318300000613
Figure FDA00024084318300000614
进而可以得出
Figure 2
在上述的基础上,再进一步讨论步骤(3)中所提到的性能指标,J表示为:
Figure 5
Figure FDA00024084318300000617
的定义,J又被重写为:
Figure FDA0002408431830000071
从而得出,当系统满足零初始条件下,性能指标J<0,由此证明完成;从上述的证明过程中可以看出,α12,…,α7的大小选择取决于上述中的矩阵不等式,这样就可以保证误差可以收敛到一个很小的范围内,以此实现理想编队轨迹。
2.根据权利要求1所述的一种基于快速自适应技术的主动编队容错控制方法,其特征在于,所述步骤(1)中得出分布式多智能体系统的拉普拉斯矩阵L和领导跟随连通矩阵G的具体步骤如下:
具有领导者跟随架构的四旋翼飞行器的编队控制,由一个领导节点和N个跟随者组成;其中领导者节点是标记为0的节点,并且每个跟随者的标记分别为i∈Γ={1,2,3,…,N},且该集合为一个有限集合;用
Figure FDA0002408431830000072
来表示N个节点之间的通讯拓扑,其中V={vi}和
Figure FDA0002408431830000073
分别代表节点集合和边集合;
定义
Figure FDA0002408431830000074
为图
Figure FDA0002408431830000075
的邻接矩阵,如果在节点i和j之间有通讯连接,即(vi,vj)∈ε,则aij=aji>0,否则,aij=aji=0,对于所有的i∈Γ有aii=0,其中节点vi的临接集合可以由
Figure FDA0002408431830000076
来表示;定义图
Figure FDA0002408431830000077
的度矩阵为
Figure FDA0002408431830000078
其中
Figure FDA0002408431830000079
且有向图的拉普拉斯矩阵
Figure FDA00024084318300000710
定义领导跟随连通矩阵G=diag{g1,g2,…,gN},其中gi∈{0,1},当gi=1时代表第i个飞行器可以接收到期望轨迹的信息,接受不到时gi则为0。
3.根据权利要求1所述的一种基于快速自适应技术的主动编队容错控制方法,其特征在于,所述步骤(3)中构造局部增广系统误差动态方程和全局增广系统误差动态方程的具体步骤如下:
其中协同编队控制方案如下:
Figure FDA0002408431830000081
其中,c为待设计的加权系数,
Figure FDA0002408431830000082
为待设计的反馈增益矩阵;
Figure FDA0002408431830000083
为飞行器i和飞行器j之间的期望误差向量;
定义状态误差为
Figure FDA0002408431830000084
编队误差为
Figure FDA0002408431830000085
进一步又可以得到
Figure FDA0002408431830000086
将上述控制器带入到四旋翼飞行器模型当中,可以得到如下形式的闭环系统:
Figure FDA0002408431830000087
其中,
Figure FDA0002408431830000088
为状态变量,
Figure FDA0002408431830000089
是领导节点的状态向量,
Figure FDA00024084318300000810
是系统矩阵,
Figure FDA00024084318300000811
是控制输入矩阵,
Figure FDA00024084318300000812
是输出矩阵,
Figure FDA00024084318300000813
是干扰输入分布矩阵和
Figure FDA00024084318300000814
为故障分布矩阵;函数
Figure FDA00024084318300000815
是一个连续函数,表示第i个飞行器的非线性动态,i=1,2,…,N;
根据上述结果又可以得出第i个飞行器的误差动态方程:
Figure FDA00024084318300000816
其中,
Figure 6
; 再将上述结构通过全局误差的形式进行表述,可以得出:
Figure FDA00024084318300000818
其中,
Figure FDA00024084318300000819
Figure 1
对于第i个四旋翼飞行器,编队误差为:
Figure FDA0002408431830000091
其相应的全局形式为:
Figure FDA0002408431830000092
其中,
Figure FDA0002408431830000093
Figure 7
第i个四旋翼飞行器的故障估计误差可以表示为:
Figure FDA0002408431830000095
其相应的全局形式为:
Figure FDA0002408431830000096
4.根据权利要求1所述的一种基于快速自适应技术的主动编队容错控制方法,其特征在于,所述步骤(3)中协同编队控制方案需要满足如下条件:
在不出现干扰和执行器故障的情况下有:
Figure FDA0002408431830000097
在执行器故障和外部干扰的影响且系统满足零初始的条件下,误差变量
Figure FDA0002408431830000098
满足
Figure FDA0002408431830000099
其中β>0的大小取决于
Figure FDA0002408431830000101
Figure FDA0002408431830000102
Figure FDA0002408431830000103
分别为
Figure FDA0002408431830000104
的上限,γ为一个应该被设计的尽量小的正常数;
并且,假设外部干扰wi(t)满足||wi(t)||<βw,(i=1,2,…,N),加性故障fi(t)与其导数
Figure FDA0002408431830000105
是有界的,即
Figure FDA0002408431830000106
其中βf
Figure FDA0002408431830000107
为两个已知的正常数。
CN201910261490.3A 2019-04-02 2019-04-02 一种基于快速自适应技术的主动编队容错控制方法 Active CN110058519B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910261490.3A CN110058519B (zh) 2019-04-02 2019-04-02 一种基于快速自适应技术的主动编队容错控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910261490.3A CN110058519B (zh) 2019-04-02 2019-04-02 一种基于快速自适应技术的主动编队容错控制方法

Publications (2)

Publication Number Publication Date
CN110058519A CN110058519A (zh) 2019-07-26
CN110058519B true CN110058519B (zh) 2020-07-07

Family

ID=67318223

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910261490.3A Active CN110058519B (zh) 2019-04-02 2019-04-02 一种基于快速自适应技术的主动编队容错控制方法

Country Status (1)

Country Link
CN (1) CN110058519B (zh)

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110794825A (zh) * 2019-08-13 2020-02-14 浙江工业大学 一种异构舞台机器人编队控制方法
CN110597061B (zh) * 2019-09-18 2022-04-26 中国人民解放军火箭军工程大学 一种多智能体完全分布式自抗扰时变编队控制方法
CN111169666B (zh) * 2020-01-19 2020-10-23 北京空间飞行器总体设计部 一种可恢复状态域的受限系统可重构性包络确定方法
CN111443715B (zh) * 2020-04-22 2020-12-15 北京航空航天大学 一种集群系统编队-合围控制方法及系统
CN111948944B (zh) * 2020-08-07 2022-04-15 南京航空航天大学 一种基于自适应神经网络的四旋翼编队容错控制方法
CN112034823B (zh) * 2020-09-03 2022-03-22 西北工业大学 一种基于区间观测器的飞机系统容错控制方法
CN112379596B (zh) * 2020-11-17 2021-11-23 南京航空航天大学 基于rbf神经网络的异构多智能体系统协同容错控制方法
CN114326781B (zh) * 2020-12-08 2024-03-15 北京航空航天大学 完全分布式导弹编队协同自适应容错补偿控制器
CN112558613B (zh) * 2020-12-18 2021-12-21 浙江工业大学 基于复拉普拉斯矩阵的编队控制方法
CN112904723B (zh) * 2021-01-19 2022-07-22 南京航空航天大学 非匹配干扰下的空地固定时间协同容错编队控制方法
CN112650303B (zh) * 2021-01-20 2022-01-11 南京航空航天大学 一种基于固定时间技术的无人机编队容错控制方法
CN112947086B (zh) * 2021-03-09 2022-10-04 南京航空航天大学 一种无人机和无人车组成的异构多智能体系统编队控制中执行器故障的自适应补偿方法
CN113093554B (zh) * 2021-04-14 2022-07-05 西北工业大学 一种基于Time Base Generator的固定时间动态区域跟踪控制方法
CN113359437B (zh) * 2021-05-14 2022-09-09 北京理工大学 基于演化博弈的多智能体编队的分层模型预测控制方法

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100429894B1 (ko) * 2001-10-30 2004-05-03 한국전자통신연구원 멀티 에이전트간 통신에 의한 네트워크 장애 관리 장치 및방법
CN103135553B (zh) * 2013-01-21 2015-06-17 南京航空航天大学 四旋翼飞行器容错控制方法
CN104407619B (zh) * 2014-11-05 2017-03-15 沈阳航空航天大学 不确定环境下的多无人机同时到达多个目标方法
CN104965506B (zh) * 2015-06-09 2017-12-05 南京航空航天大学 一种基于可调参数分布式飞行控制系统实时故障诊断方法
JP6645857B2 (ja) * 2015-07-31 2020-02-14 株式会社東芝 分散処理システム、方法、およびプログラム、ならびに分散処理システムを適用した耐故障マルチエージェントシステムおよび病院連携分散処理システム
CN105204499B (zh) * 2015-10-09 2018-01-02 南京航空航天大学 基于未知输入观测器的直升机协同编队故障诊断方法
CN105242544B (zh) * 2015-10-30 2017-11-14 山东科技大学 考虑随机扰动的非线性多无人机系统容错编队控制方法
CN107168281B (zh) * 2017-05-12 2019-02-22 南京航空航天大学 基于有限时间观测器的多智能体系统故障诊断方法
CN109491244B (zh) * 2017-09-13 2021-10-22 南京航空航天大学 一种基于滑模观测器的无人机编队系统故障诊断方法
CN108803316B (zh) * 2018-03-09 2020-12-15 南京航空航天大学 针对多智能体系统执行器故障的主动容错控制方法
CN108681240B (zh) * 2018-03-09 2021-04-02 南京航空航天大学 基于未知输入观测器的无人机分布式编队的故障诊断方法
CN108762091B (zh) * 2018-06-25 2021-06-22 东南大学 一种基于未知控制方向的自适应编队控制算法
CN109116737B (zh) * 2018-09-19 2021-04-06 南京航空航天大学 观测器下的多智能体系统故障评估及容错一致性控制算法

Also Published As

Publication number Publication date
CN110058519A (zh) 2019-07-26

Similar Documents

Publication Publication Date Title
CN110058519B (zh) 一种基于快速自适应技术的主动编队容错控制方法
Lin et al. Event-based finite-time neural control for human-in-the-loop UAV attitude systems
CN105204499B (zh) 基于未知输入观测器的直升机协同编队故障诊断方法
CN111948944B (zh) 一种基于自适应神经网络的四旋翼编队容错控制方法
CN111638726B (zh) 基于事件触发通信的多无人机编队一致性控制方法
CN107272639B (zh) 刚性航天器反作用飞轮故障的检测、估计及其调节方法
CN110161847B (zh) 一种基于分布式奇异观测器的无人机编队系统传感器故障估计方法
CN112904723B (zh) 非匹配干扰下的空地固定时间协同容错编队控制方法
CN109884902B (zh) 一种基于区间观测器无人机编队系统故障检测方法
CN111781942B (zh) 一种基于自构造模糊神经网络的容错飞行控制方法
Cong et al. Formation control for multiquadrotor aircraft: Connectivity preserving and collision avoidance
Van Oort et al. Full-envelope modular adaptive control of a fighter aircraft using orthogonal least squares
Liu et al. Single parameter adaptive neural network control for multi-agent deployment with prescribed tracking performance
Emami et al. Intelligent trajectory tracking of an aircraft in the presence of internal and external disturbances
Cheng et al. Fixed-time formation tracking for heterogeneous multiagent systems under actuator faults and directed topologies
Guo et al. Event-driven-observer-based fuzzy fault-tolerant control for nonlinear system with actuator fault
CN117055605A (zh) 多无人机姿态控制方法及系统
CN114851198A (zh) 一种多单连杆式机械臂的一致跟踪固定时间稳定控制方法
Ma et al. Inverse optimal control for unmanned aerial helicopters with disturbances
Azarbahram et al. Event-triggered tracking formation of networked nonlinear intelligent transportation systems surrounded by random disturbances
CN113268084B (zh) 一种无人机编队智能容错控制方法
CN116880478A (zh) 一种基于事件触发的轮式机器人滑模编队容错控制方法
Wang et al. Sliding mode fault tolerant control of quadrotor UAV with state constraints under actuator fault
CN110275514B (zh) 带有时变传感器故障的编队飞控系统渐近故障诊断方法
CN113741192A (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
GR01 Patent grant
GR01 Patent grant