具有执行器和传感器故障的多智能体跟踪系统的滑模容错控制方法与流程

背景技术：
：随着现代社会、工程以及通信网络的飞速发展，近些年，多智能体系统得到不断发展和广泛应用，关于多智能体系统控制技术的研究也吸引了众多控制领域学者的关注。相比于传统的单个系统，多智能体系统具有更广泛的任务领域、更高的效率等优点，可通过智能体之间的相互协作有效地完成单个智能体无法完成的复杂任务。目前，多智能体系统已应用于众多领域，如编队飞行，传感器网络等。在过去的近几年里，多智能体系统的一致性和编队问题引起了广大学者的研究热情，也有了许多优秀的成果，但大部分文献都未考虑智能体发生故障的情况。然而，规模较大且结构复杂的多智能体系统在长期运行时，智能体难免会发生执行器或传感器故障，导致全局任务的失败，造成严重的经济损失或人员伤亡。因此，关于多智能体系统的容错控制研究具有极其重要的研究价值和实际意义。目前，多智能体系统的容错控制研究成果大部分都是采用被动容错控制方法，学者张旭等人针对一类具有执行器故障和外部干扰问题的多智能体跟踪系统，设计了具有自适应增益的补偿控制律实现容错控制。邓超等人提出了一种自适应输出反馈控制方法解决了一类非线性多智能体系统的执行器故障问题。关于多智能体系统的主动容错控制在近两年才受到关注，相关研究成果也比较少。鉴于主动容错控制需要先获取故障信息，再进行控制结构和参数的调整，使得主动容错控制具有更有效的容错控制效果。杨蒲等人针对一类具有执行器故障的领导-跟随多智能体系统，基于分布式观测器并依据相对输出信息提出了一种输出反馈容错控制策略。khodabandehs等考虑了多智能体系统的执行器故障问题，通过龙伯格观测器设计了一种基于虚拟执行器的分布式容错控制方法。不同于现有的多智能体系统主动容错控制研究成果，本发明同时考虑了智能体的执行器故障和传感器故障以及系统的固有非线性问题，并运用分布式观测器和滑模控制方法实现多智能体系统的容错控制。滑模控制是一类特殊的非线性控制，且具有响应快，对系统的不确定参数不灵敏，物理实现简单，鲁棒性好的优点，因此非常适于多智能体系统的容错控制研究。技术实现要素：发明目的：针对一类线性多智能体跟踪系统的执行器和传感器故障，基于分布式观测器，提出一种滑模容错控制方法，补偿故障对系统的负面影响，确保系统能够稳定运行。技术方案：一种基于滑模的线性多智能体系统的主动容错控制方法，其特征在于：考虑具有无向通讯拓扑结构的多智能体跟踪系统中存在的执行器故障、传感器故障以及领导者控制输入非零且未知的问题，通过分布式观测器和滑模控制方法，提出一种分布式容错控制策略，使得多智能体系统在发生故障的情况下仍能顺利完成跟踪任务，首先为每个跟随者建立增广的跟踪误差系统并引入一个中间变量，基于智能体的邻集输出信息为跟踪系统和中间变量设计分布式观测器，同时对多种故障和领导者的未知控制输入进行估计，根据获得的观测信息为跟踪误差系统设计滑模面，增加系统的鲁棒性，并设计了滑模容错控制器，使得多智能体系统在发生故障后仍能够继续安全运行。包括如下具体步骤：步骤1)获取多智能体跟踪系统的控制模型、故障模型以及通讯拓扑结构：步骤1.1)领导者控制模型如式(1)所示：其中，x0(t)∈rn和y0(t)∈rp分别代表领导者智能体系统的状态量和输出量，r0(t)∈rm表示领导者系统的控制输入，且r0(t)≠0；步骤1.2)发生执行器和传感器故障的跟随者控制模型如式(2)所示：其中，xi(t)∈rn，ui(t)∈rm和yi(t)∈rp分别代表第i个智能体的状态量、控制输入及输出量；fai(t)∈ra表示第i个跟随者的执行器故障；连续向量值函数gi(xi(t)，t)∈rn表示跟随者系统的固有非线性；fsi(t)∈rs代表第i个跟随者的传感器故障；矩阵a，b，c，fa和fs是具有适当维数的系统矩阵，且假设(a，b)是稳定的，(a，c)是可观测的，矩阵b，fa和fs列满秩，且满足rank([b，fa])＝rank(b)；步骤1.3)多智能体跟踪系统的通讯拓扑结构：考虑包含一个领导者(标记为0)和n个跟随者(标记为i＝1，2，...，n)的多智能体系统，无向图g＝(v，e)表示包括领导者和跟随者在内的所有节点之间的通讯拓扑图，其中节点集合v＝{0，1，2，...，n}，节点之间的通讯链接集合为e＝v×v；g的子图是跟随者之间的通讯拓扑图，其中表示图g的邻接矩阵；记l为图g的laplacian矩阵，定义其中是由各节点的度组成的对角矩阵，则lij的定义如式(3)所示：令g＝diag(g1，g2，...，gn)表示领导者与跟随者之间的邻接矩阵，如果领航者0与第i个跟随者之间有一条无向边，那么gi＝1，否则，gi＝0；定义为第i个跟随者的邻集；步骤2)定义zi(t)＝xi(t)-x0(t)为第i个跟随者的跟踪误差变量，根据式(1)和式(2)，建立如式(4)所示的跟踪误差系统：将传感器故障信号作为一个辅助状态量来构建如式(5)所示的增广跟踪误差系统：其中，是传感器故障函数的导数，i，0分别是适当维数的单位矩阵和零矩阵；由rank([b，fa])＝rank(b)可知，存在一个矩阵使得等式成立。则式(5)可重写为其中，步骤3)引入一个中间变量mi(t)∈rm：其中，α是一个可选择的正实数。则由式(5)和(6)可得：步骤4)为跟踪误差系统和中间变量设计分布式观测器：其中，和分别是变量mi(t)和vi(t)的估计值；矩阵为待设计得观测器增益矩阵，为的估计值；ξi(t)∈rp是第i个跟随者的邻集输出跟踪误差，代表ξi(t)的估计量，分别描述为：其中，aij代表第i个跟随者和第j个跟随者之间的连接权重，gi代表第i个跟随者与领导者之间的连接权重，代表第i个跟随者的邻集；步骤5)根据以下线性矩阵不等式(12)获得分布式观测器增益矩阵存在正定矩阵p1∈r(n+s)×(n+s)，p2∈rm×m和矩阵n∈r(n+s)×(n+s)满足其中，步骤6)为每个跟随者的跟踪误差估计系统设计如式(13)所示的滑模面：其中，是矩阵b的广义逆矩阵，k∈rn×n是待设计的矩阵；步骤7)根据以下线性矩阵不等式(14)和等式(15)获得滑模面矩阵k，存在正定矩阵q∈rn×n以及矩阵满足其中，步骤8)为每个跟随者设计如式(16)所示的分布式容错控制器：其中，γ为一正实数；步骤9)根据步骤5)和7)，求得所需要得控制参数，通过式(16)所示的控制器实现多智能体系统的跟踪容错控制。有益效果：本发明提出的一种基于分布式观测器和滑模控制方法的线性多智能体系统执行器和传感器故障的容错控制方法，考虑多智能体跟踪系统中存在的执行器故障、传感器故障以及领导者控制输入非零且未知的问题，通过分布式观测器和滑模控制方法，提出一种分布式容错控制策略，使得多智能体系统在发生故障的情况下仍能顺利完成跟踪任务。具有如下优点：(1)针对一般的线性多智能体系统，同时考虑执行器、传感器故障和系统的固有非线性问题；(2)考虑了领导者控制输入非零且无法被任何跟随者获取的情况，具有一定的实际意义。(3)根据智能体之间的通讯拓扑结构，基于智能体获取的邻集输出信息设计了分布式观测器，提高对故障的估计准确度；(4)基于观测的故障信息设计了非线性滑模面和容错控制器，增强控制系统的鲁棒性，使得多智能体系统在发生故障的情况下，仍然能够完成跟踪任务，提高了系统的容错能力。本发明所用方法作为一种线性多智能体系统执行器和传感器故障的的容错控制方法，有较好的鲁棒性和容错能力，灵活性强且易于实现，具有一定的实际应用价值，可广泛应用于多智能体系统执行器和喜欢干起故障的容错控制领域。附图说明图1是本发明方法的流程图；图2是quanser公司的四旋翼飞行器qball-x4及其姿态运动示意图；图3是多四旋翼飞行器系统的通讯拓扑结构图；图4是多四旋翼飞行器系统中每个飞行器系统的容错控制原理框图；图5是第1个跟随者飞行器执行器故障和领导者的未知输入信号的估计曲线；图6是第1个跟随者飞行器传感器故障的估计曲线；图7是第3个跟随者飞行器执行器故障和领导者的未知输入信号的估计曲线；图8是第3个跟随者飞行器传感器故障的估计曲线；图9是跟随者飞行器的x轴方向位移跟踪误差曲线；图10是跟随者飞行器的x轴方向速度跟踪误差曲线；具体实施方式下面结合附图对本发明做更进一步的解释。如图1所示，考虑一类线性多智能体系统的执行器和传感器故障及固有非线性问题，根据智能体的邻集输出信息设计分布式观测器，并基于获得的故障和领导者未知控制输入信息提出非线性滑模面和滑模容错控制器。具体步骤如下：步骤1)获取多智能体跟踪系统的控制模型、故障模型以及通讯拓扑结构：步骤1.1)领导者控制模型如式(1)所示：其中，x0(t)∈rn和y0(t)∈rp分别代表领导者智能体系统的状态量和输出量，r0(t)∈rm表示领导者系统的控制输入，且r0(t)≠0；步骤1.2)发生执行器和传感器故障的跟随者控制模型如式(2)所示：其中，xi(t)∈rn，ui(t)∈rm和yi(t)∈rp分别代表第i个智能体的状态量、控制输入及输出量；fai(t)∈ra表示第i个跟随者的执行器故障；连续向量值函数gi(xi(t)，t)∈rn表示跟随者系统的固有非线性；fsi(t)∈rs代表第i个跟随者的传感器故障；矩阵a，b，c，fa和fs是具有适当维数的系统矩阵，且假设(a，b)是稳定的，(a，c)是可观测的，矩阵b，fa和fs列满秩，且满足rank([b，fa])＝rank(b)；步骤1.3)多智能体跟踪系统的通讯拓扑结构：考虑包含一个领导者(标记为0)和n个跟随者(标记为i＝1，2，...，n)的多智能体系统，无向图g＝(v，e)表示包括领导者和跟随者在内的所有节点之间的通讯拓扑图，其中节点集合v＝{0，1，2，...，n}，节点之间的通讯链接集合为e＝v×v；g的子图是跟随者之间的通讯拓扑图，其中表示图g的邻接矩阵；记l为图g的laplacian矩阵，定义其中是由各节点的度组成的对角矩阵，则lij的定义如式(3)所示：令g＝diag(g1，g2，...，gn)表示领导者与跟随者之间的邻接矩阵，如果领航者0与第i个跟随者之间有一条无向边，那么gi＝1，否则，gi＝0；定义为第i个跟随者的邻集；步骤2)定义zi(t)＝xi(t)-x0(t)为第i个跟随者的跟踪误差变量，根据式(1)和式(2)，建立如式(4)所示的跟踪误差系统：将传感器故障信号作为一个辅助状态量来构建如式(5)所示的增广跟踪误差系统：其中，是传感器故障函数的导数，i，0分别是适当维数的单位矩阵和零矩阵；由rank([b，fa])＝rank(b)可知，存在一个矩阵使得等式成立。则式(5)可重写为其中，步骤3)引入一个中间变量mi(t)∈rm：其中，α是一个可选择的正实数。则由式(5)和(6)可得：步骤4)为跟踪误差系统和中间变量设计分布式观测器：其中，和分别是变量mi(t)和vi(t)的估计值；矩阵为待设计得观测器增益矩阵，为的估计值；ξi(t)∈rp是第i个跟随者的邻集输出跟踪误差，代表ξi(t)的估计量，分别描述为：其中，aij代表第i个跟随者和第j个跟随者之间的连接权重，gi代表第i个跟随者与领导者之间的连接权重，代表第i个跟随者的邻集；步骤5)根据以下线性矩阵不等式(12)获得分布式观测器增益矩阵存在正定矩阵p1∈r(n+s)×(n+s)，p2∈rm×m和矩阵n∈r(n+s)×(n+s)满足其中，步骤6)为每个跟随者的跟踪误差估计系统设计如式(13)所示的滑模面：其中，是矩阵b的广义逆矩阵，k∈rn×n是待设计的矩阵；步骤7)根据以下线性矩阵不等式(14)和等式(15)获得滑模面矩阵k，存在正定矩阵q∈rn×n以及矩阵满足其中，步骤8)为每个跟随者设计如式(16)所示的分布式容错控制器：其中，γ为一正实数；步骤9)根据步骤5)和7)，求得所需要得控制参数，通过式(16)所示的控制器实现多智能体系统的跟踪容错控制。以上所述仅是本发明的优选实施方式，应当指出，对于本
技术领域：
的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。下面以实际案例仿真说明实施方案的有效性。采用加拿大quanser公司生产的四旋翼飞行器qball-x4作为具体的算法实验仿真对象。图2是quanser的四旋翼飞行器qball-x4及其姿态运动示意图，由图2可以看出，四旋翼飞行器相对于地面存在六维度变量(x，y，z，ψ，θ，φ)，其中前三个变量为位置变量，即相对于惯性系中心的位置。后三个变量为四旋翼直升机的姿态欧拉角：偏航ψ，俯仰θ，滚转φ。不失一般性，这里选用x轴方向的位移，速度和执行器动态作为状态量对其进行仿真实验。四旋翼飞行器x轴方向的状态空间模型如下：写成如下标准形式的状态空间表达式：其中，为状态量，u(t)为控制输入，系统输出y(t)为x轴方向位移。该四旋翼飞行器的机体参数值如表1所示：表1机体参数数值表参数值·单位k120nω15rad/secm1.4kg假设θ＝0.035rad，则可以得到标称系统中各系数矩阵如下：这里我们考虑由一个领导者和四个跟随者组成的多四旋翼飞行器跟踪控制系统，其中，领导者标记为0，跟随者标记为i(i＝1，2，3，4)。领导者飞行器qball-x4的系统模型为：考虑跟随者飞行器qball-x4系统存在执行器、传感器故障和固有非线性问题，其系统模型为：假设多四旋翼飞行器系统的通讯拓扑结构如图3所示，则我们可以得到如下laplacian矩阵l和邻接矩阵g：跟随者飞行器系统考虑的执行器和传感器故障分布矩阵分别为fa＝[0015]t，fs＝0.2，固有非线性函数为gi(xi3，t)＝[000.33sin(xi3)]t。领导者飞行器的控制输入设为r0(t)＝0.3sin(2t)，且领导者的控制输入信息不能被任何跟随者飞行器获取。每个飞行器系统的初始状态设置为x0(t)＝[0.510.15]t，x1(t)＝[-1.520.2]t，x2(t)＝[-0.50.40.35]t，x3(t)＝[2-0.20.15]t，x4(t)＝[0.20.30.1]t。考虑跟随者飞行器1和3在飞行过程中发生执行器和传感器故障，故障形式描述为：fa1(t)＝0.7sin(t)，fs1(t)＝sin(2t)，t≥10fa3(t)＝0.8sin(2t)，fs1(t)＝0.5sin(t)，t≥10选择设计参数α＝0.8，ε＝1，通过matlablmi工具箱求得如下观测器和控制器增益矩阵：根据本发明方法，对存在执行器、传感器故障和固有非线性的的多四旋翼飞行器系统进行容错控制，图5-6分别是是第1个跟随者飞行器执行器故障和领导者未知输入的结合信号以及传感器故障的估计曲线；图7-8分别是是第3个跟随者飞行器执行器故障和领导者未知输入的结合信号以及传感器故障的估计曲线；图9-10分别是跟随者飞行器x轴方向的位置和跟踪跟踪误差曲线。由图5-图10可知，本发明中的分布式观测器可对故障和领导者未知输入信号进行快速准确地估计。且在本发明的容错控制策略下，跟随者飞行器的x轴位置和速度跟踪误差均能在故障发生后的较短时间内再次趋于零，进而说明当系统发生故障后，多飞行器系统仍然能够顺利完成全局跟踪任务，避免事故的发生以及任务的失败。当前第1页12