CN114253137B - 基于控制分配的无人机系统故障诊断与容错控制方法 - Google Patents
基于控制分配的无人机系统故障诊断与容错控制方法 Download PDFInfo
- Publication number
- CN114253137B CN114253137B CN202111543246.XA CN202111543246A CN114253137B CN 114253137 B CN114253137 B CN 114253137B CN 202111543246 A CN202111543246 A CN 202111543246A CN 114253137 B CN114253137 B CN 114253137B
- Authority
- CN
- China
- Prior art keywords
- matrix
- fault
- control
- aerial vehicle
- unmanned aerial
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 46
- 238000009826 distribution Methods 0.000 title claims abstract description 39
- 238000003745 diagnosis Methods 0.000 title claims abstract description 22
- 238000013528 artificial neural network Methods 0.000 claims abstract description 16
- 239000011159 matrix material Substances 0.000 claims description 93
- 230000003044 adaptive effect Effects 0.000 claims description 16
- 241000540325 Prays epsilon Species 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 238000009827 uniform distribution Methods 0.000 claims description 3
- 230000004888 barrier function Effects 0.000 claims description 2
- 230000006641 stabilisation Effects 0.000 claims description 2
- 238000011105 stabilization Methods 0.000 claims description 2
- 230000007704 transition Effects 0.000 claims description 2
- 230000007246 mechanism Effects 0.000 description 10
- 229920006395 saturated elastomer Polymers 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000004260 weight control Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive 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/042—Adaptive 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提出了一种基于控制分配的无人机系统故障诊断与容错控制方法,其步骤如下:建立四旋翼无人机的动力学模型,将动力学模型转化为状态空间模型;根据系统的控制分配方程建立具有扰动的控制分配模型;基于自适应权值的加权伪逆方法,设计控制分配律;控制分配律中结合故障观测器提供的故障估计信息,设计故障观测器的增益参数;设计自适应神经网络虚拟控制律;根据李雅普诺夫稳定性理论设计闭环动态系统稳定的充分条件,故障观测器负责提供发生故障的估计信息,利用故障的估计信息设计容错控制器对故障进行补偿,从而保证系统的稳定性。本发明解决了物理约束和故障重构不匹配问题,为系统的安全性和可靠性提供了保障,具有实际意义。
Description
技术领域
本发明涉及无人机容错控制的技术领域,尤其涉及一种基于控制分配的无人机系统故障诊断与容错控制方法,可用于有物理约束和故障重构不匹配影响的旋翼无人机系统的故障诊断与容错控制,为提高系统的可靠性和安全性提供保障。
背景技术
对于四旋翼无人机,现有研究通常是将由实际执行机构真实输入线性组合而成的虚拟控制律作为系统输入。这并不符合四旋翼无人机的实际运行规律,控制分配是将虚拟控制律分配到真实执行机构的技术,基于控制分配的四旋翼无人机系统更有实际意义。在实际飞行控制系统中,物理约束是普遍存在的非线性特性。四旋翼无人机的旋翼不是可以处于任意位置的,且响应速度也不是无限快,存在着较强的物理约束。在控制分配系统的研究中,系统发生故障以及对系统故障的估计与实际故障之间有误差都会引发系统的稳定性问题。要想使四旋翼无人机系统具有安全、可靠的控制性能,必须解决基于控制分配技术的四旋翼无人机系统受到物理约束和故障重构不匹配影响的问题,实现对故障快速、准确的估计以及设计容错控制器保证系统发生故障后仍满足一定的性能要求。
发明内容
针对非线性四旋翼无人机系统具有物理约束和故障重构不匹配的技术问题,本发明提出一种基于控制分配的无人机系统故障诊断与容错控制方法,考虑外部扰动的情况下,设计控制分配律、故障观测器和容错控制器,达到迅速而准确地诊断故障并实现故障后系统输出仍能跟踪给定的输出的目的。
为了达到上述目的,本发明的技术方案是这样实现的:一种基于控制分配的无人机系统故障诊断与容错控制方法,其步骤如下:
步骤一:建立四旋翼无人机的动力学模型,并将动力学模型转化为状态空间模型;
步骤二:根据系统的控制分配方程建立具有扰动的控制分配模型;
步骤三:基于自适应权值的加权伪逆方法,设计控制分配律;控制分配律中结合故障观测器提供的故障估计信息,设计故障观测器的增益参数;
步骤四:设计步骤三中故障观测器的误差动态稳定的充分条件;
步骤五:根据神经网络和模型参考自适应理论设计自适应神经网络虚拟控制律;
步骤六:根据李雅普诺夫稳定性理论设计闭环动态系统稳定的充分条件,故障观测器负责提供发生故障的估计信息,利用故障的估计信息设计容错控制器对故障进行补偿,从而保证系统的稳定性。
所述步骤一的实现方法为:建立四旋翼无人机的动力学模型的简化模型为:
其中,[φ θ ψ]T表示滚转、俯仰、偏航三个欧拉角;g表示重力加速度;l表示各转子中心到重心的距离;m表示无人机的总质量;[Ix Iy Iz]T表示沿各自轴转动的转动惯量,Ki是阻力系数,i=1,2,3;Jr代表螺旋桨的转动惯量;u1,u2分别表示滚转和俯仰输入且u1=(-F2+F4),u2=(-F1+F3);u3为偏航力矩且u3=d(F1-F2+F3-F4)/b;且是由四个转子产生的推力,是系统的实际控制输入;Ωj表示螺旋桨的角速度且j=1,2,3,4,d是力与力矩的比例因子,b是升力系数;Ωr是螺旋桨角速度向量;
定义为状态变量,u=[u1 u2 u3]T为输入变量,/>为输出变量;动力学模型转换为状态空间模型为:
其中,x(t)∈Rn×1,y(t)∈Rq×1分别是状态变量和输出变量,为状态变量x(t)的倒数,R为实数集,u(t)∈Rp×1为虚拟控制输入,g(t,x(t))是非线性项,且满足误差函数/>A,B,C是常值系统矩阵,/>是非线性项g(t,x(t))的估计,γ1是一个任意小的正的常数,/>是状态向量x(t)的估计,n、q、p代表状态向量、输出向量、控制向量的维数。
所述步骤二的实现方法为:根据系统对应的控制分配方程:
u(t)=Bvv(t)
Bδ=BBv
则具有扰动的四旋翼无人机系统的控制分配模型为:
其中,x(t),y(t)分别是状态变量和输出变量;v(t)∈Rm×1表示实际控制律,d(t)∈Rn×1是外部扰动且为非高斯均匀分布函数,g(t,x(t))是非线性项,A,B,C是常值系统矩阵,Bv是控制效率矩阵,Bδ是实际控制矩阵,M是扰动矩阵。
所述步骤三中基于自适应权值的加权伪逆方法,设计控制分配率的方法为:加权伪逆控制分配法中控制矩阵为:
且虚拟控制输入u(t)和实际控制律v(t)的关系为:v(t)=Du(t);
同时考虑物理约束和故障重构不匹配,动态自适应加权矩阵为:
设计控制分配律为:
其中,I为单位矩阵,是设计的故障观测器的故障估计,/>为Bv的加权Moore-Penrose逆矩阵,W为矩阵/>的加权矩阵,/>是动态自适应加权矩阵,W1是参数矩阵,/>是自适应更新率,xr(t)是参考状态,diag表示一个矩阵的对角线元素组成的矩阵,Φ是关于矩阵/>的中间计算矩阵,γ是一个正的常数,Ω是将列向量的实际控制律变成只有对角线含有元素的对角矩阵,ev是实际控制律与虚拟控制律的差值。
所述故障观测器为:
其中,是状态估计及其导数,/>是非线性项的估计,L是故障观测器的增益,/>是输出估计,Γ是故障估计律的参数,P1是需要计算的对称正定矩阵,e(t)是状态和状态估计的误差。
所述步骤四中设计的充分条件为
其中,Y=PL是一个过渡矩阵,L是故障观测器的增益,γ1>0是一个比较小的正常数,P∈R6×6是正定对称矩阵,A、C为常值系统矩阵,P1是对称正定矩阵,M是扰动矩阵。
所述步骤五设计的自适应神经网络虚拟控制律为:
式中,k1是待设计的正的参数,ψ(x)∈Rl是径向基函数矢量,Θ是神经网络权值矩阵,其自适应更新律为:
其中,Γ∈Rl×l为自适应增益矩阵,并且满足ε为未知正数;/>为参考矩阵的逆,r是参考输入,B1是控制矩阵和虚拟控制矩阵的乘积的矩阵,/>是矩阵B1的转置,P是对称正定矩阵。
所述步骤六中闭环动态系统稳定的充分条件为:
其中,k1为正数,P∈Rn×n是正定对称矩阵。
本发明的有益效果:
(1)本发明同时考虑了物理约束和故障重构不匹配对四旋翼无人机系统的影响,解决了物理约束和故障重构不匹配问题,为系统的安全性和可靠性提供了保障,具有实际意义。
(2)本发明结合了故障观测器,设计基于故障诊断的控制分配技术为系统提供实时的故障诊断结果。
(3)本发明设计了自适应神经网络虚拟控制律保证系统的稳定性,使故障后系统的轨迹能够跟踪无故障系统的预期轨迹。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明的流程示意图。
图2为本发明故障诊断的效果图。
图3为本发明滚转角速率的实际轨迹与期望轨迹对比图。
图4为本发明俯仰角速率的实际轨迹与期望轨迹对比图。
图5为本发明偏航角速率的实际轨迹与期望轨迹对比图。
图6为本发明物理约束下的实际执行机构的输入图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有付出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1所示,一种基于控制分配的无人机系统故障诊断与容错控制方法,首先,给出了非线性无人机系统的状态空间模型;其次,提出了一种基于自适应权值的加权伪逆方法,降低了指令饱和对系统的影响(先假设一个已经达到饱和的控制指令,即执行机构不能达到控制指令所给出的数值,此时通过调整控制指令里边包含的矩阵即可调整控制指令的数值,令其不饱和。控制指令的大小是用来控制执行机构的,但是执行机构物理特性是有一定的上限的,或者是速度或者是倾斜度等等,当达不到控制指令的数值时,就被称为指令饱和);然后,设计了一种基于故障效率矩阵的动态权值控制分配方法,权值矩阵可以根据故障观测器提供的故障估计值动态调整控制分配律即权值矩阵/> 等号后边的F(t)是故障估计;接着,将自适应权值和动态权值相结合即/>提出了一种针对故障和物理约束的动态自适应控制分配律方法。
本发明的技术解决方案是:针对具有物理约束和故障重构不匹配的非线性四旋翼无人机系统,基于控制分配技术对系统模型进行变换,考虑控制输入指令趋于饱和的情况,结合故障观测器提供的故障估计信息,设计控制分配律使控制输入指令从饱和趋于非饱和,同时抵消故障估计与实际故障有误差的影响。设计自适应神经网络虚拟控制率,实现故障后的系统输出仍能跟踪期望输出的目的,设计的容错控制器可以补偿故障从而保持系统的稳定性。本发明实现步骤如下:
步骤1:建立四旋翼无人机的动力学模型,简化模型如下:
其中,[φ θ ψ]T表示滚转、俯仰、偏航三个欧拉角;g表示重力加速度;l表示为各转子中心到重心的距离;m表示无人机总质量;[Ix Iy Iz]T表示沿各自轴转动的转动惯量,Ki(i=1,2,3)是阻力系数;Jr代表螺旋桨的转动惯量;u1,u2分别表示为滚转和俯仰输入u1=(-F2+F4),u2=(-F1+F3)。u3为偏航力矩可以表示为u3=d(F1-F2+F3-F4)/b。是由四个转子产生的推力可以看作是系统的实际控制输入。Ωi(i=1,2,3,4)表示螺旋桨的角速度(i=1,2,...),d是力与力矩的比例因子,b是升力系数。Ωr是螺旋桨角速度向量。
步骤2:建立具有扰动的四旋翼无人机系统的控制分配模型
定义为状态变量,u=[u1 u2 u3]T为输入变量,/>为输出变量。系统的状态空间模型表示如下:
其中,x∈Rn×1,y∈Rq×1是状态变量和输出变量。u∈Rp×1代表虚拟控制输入。g(t,x(t))是非线性项,且满足A,B,C是适当维度的常值系统矩阵。/>是非线性项的估计,γ1是一个任意小的正常数、/>是状态变量x(t)的估计,n、q、p分别代表状态向量、输出向量、控制向量的维数。
非线性项如下所示:
根据系统对应的控制分配方程:
u(t)=Bvv(t)
Bδ=BBv
进一步可以得到具有扰动的四旋翼无人机系统的控制分配模型:
其中,v∈Rm×1表示实际控制律,d(t)∈Rn×1是外部扰动,为非高斯均匀分布函数。Bv是控制效率矩阵,Bδ是实际控制矩阵,M是外部扰动矩阵,代表着系统受扰动的范围和程度。
步骤3:设计四旋翼无人机系统的控制分配律
加权伪逆控制分配法:
式中,为Bv的加权Moore-Penrose逆矩阵,W为矩阵/>的加权矩阵,/> 是待设计的权值矩阵,/>是自适应更新率,W1是参数矩阵,b是一个常值,xr(t)为参考状态。
对于四旋翼无人机系统,其虚拟控制律和实际控制律的关系可表示为:
v(t)=Du(t)
v(t)是实际控制律,u(t)是虚拟控制律,两者之间相互转换的矩阵D为控制分配律。
考虑系统的物理约束,令vc(t)为执行器饱和控制信号
改写上式为:
乘进去展开即可得到,其中,Φ是一个中间的符号为了简化公式,是矩阵对角线的元素,下标代表第几行第几个,Ω是一个中间的符号为了简化公式,将列向量的实际控制律变成的只有对角线含有元素的对角矩阵。
非饱和指令跟饱和指令的区别在于权值矩阵通过权值矩阵的差值使控制指令可以自适应调整。设v(t)是经过饱和限制后的控制输入信号,且:
令
其中,Φ*和/>是中间计算矩阵,ev(t)是饱和指令和非饱和指令的差值。
饱和约束时的控制问题转化为设计矩阵使得饱和指令趋于非饱和指令问题,令加权矩阵为:
其中,代表自适应更新率,Proj是投影函数的缩写符号,γ是待设计的参数。因为/>影响着控制指令的大小,设计/>可使饱和指令趋于非饱和指令。
当系统发生故障,故障诊断系统是有误差的,而这种故障重构不匹配会造成控制分配重构误差。为此本发明将自适应观测器与控制分配技术相结合,更能真实的反映系统的特性。假设系统发生执行器损伤故障,系统的状态空间表达式为:
式中,F(t)是执行机构真实残余效能矩阵。针对系统发生的故障采用设计的权值矩阵形式(D),跟执行器饱和情况类似,通过调节加权矩阵降低故障执行机构的比重,增加剩余冗余执行机构的效能。因为执行机构比系统状态多,所以当某一个执行机构故障时,降低其在控制变量里的比重,增强非故障执行机构的效能。加权矩阵为:/>
其中是所设计的故障观测器的故障估计。故障观测器如下所示:
其中:
其中,是状态变量的估计,故障观测器的目的就是为了估计状态和故障,/>是故障估计的一阶导数,/>是非线性项的估计,L为故障观测器的增益,/>是输出变量的估计,Γ是故障估计律的参数,P1是一个对称正定矩阵,e(t)是状态误差。
令
其中,ex(t)和F(t)分别表示状态估计误差和故障估计误差。是实际故障和故障估计的误差。此时,系统的动态误差如下:
步骤4:误差动态稳定和故障诊断观测器存在的充分条件:
定理1:如果存在γ1>0、正定对称矩阵P∈R6×6和Y∈R6×3,使下列方程成立:
其中Y=PL,则系统状态估计误差收敛。
证明:考虑下列形式的李雅普诺夫函数:
其中,V(t)是李雅普诺夫函数,是根据经验选取的。Γ是一个待设计的参数,一般在进行Matlab仿真时进行手动调整。
对其求导可得:
对任何适维矩阵,则下式成立:进一步可得:
令P1(A-LC)+(A-LC)TP1+2γ1P1+P1MMTP1=-Q。
把带入上式,进一步可以得到下面的不等式:
令
其中
当条件:满足时,可得/>即状态误差收敛。
同时考虑物理约束和故障重构不匹配时,动态自适应加权矩阵为:
步骤5:根据神经网络和模型参考自适应理论设计自适应神经网络虚拟控制律。
定义:
B1=BB0
令参考状态xr为:
G0是可逆矩阵。
且Cxr=r
定义er=x-xr,则系统的状态误差的一阶导数为:
自适应神经网络虚拟控制律如下所示:
此虚拟控制律的符号x(t)是前边提到的系统状态,虚拟控制律跟虚拟控制输入是一个意思。
式中:k1是待设计的正的参数,ψ(x)∈Rl是径向基函数矢量,Θ是神经网络权值矩阵,其自适应更新律为:
其中,Γ∈Rl×l为自适应增益矩阵,并且满足ε为未知正数。
步骤6:闭环动态系统稳定的充分条件。
定理3:如果存在正定对称矩阵P∈Rn×n和正数k1使得下列LMI(Linear MatrixInequality线性矩阵不等式)成立,动态误差系统收敛。
证明
进一步得到:
选取李雅普诺夫函数如下:
求导:
整理可得:
式中:ATP+PA-k1PB1B1 TP+PMMTP+2εP=-Q<0
根据李雅普诺夫稳定性理论,动态误差系统稳定。李雅普诺夫稳定性理论规定,选取的李雅普诺夫函数,如其一阶导数小于零,则系统稳定。基于模型的概念,故障观测器负责提供系统发生的故障的估计信息,利用故障的估计信息设计的容错控制器可以保证对故障进行补偿,从而实现故障诊断和容错控制。保证系统的稳定性。
具体实例:
步骤1:运用四旋翼无人机系统的数值模型来验证基于控制分配的受物理约束和故障重构不匹配影响的四旋翼无人机系统故障诊断与容错控制方法的可行性。旋翼无人机由机身、陀螺仪、角速度仪、旋翼组成。系统参数矩阵如下所示
其中,x(0)为系统的初始状态。系统期望输入如下所示:
假设故障的形式如下所示:
步骤2:四旋翼无人机系统的物理约束实质为四旋翼无人机执行机构的输入饱和,其上下界为vmax=-vmin=[3 3 3 3]T。
步骤3:利用matlab LMI求解故障诊断观测器增益:
Γ=0.0043。
步骤4:利用步骤3中matlab LMI工具箱求解的结果,用matlab仿真出等效系统故障诊断和容错控制结果,如图2至图5。图2中实线是故障,虚线是故障的估计,从图2中可以看出由设计的故障观测器提供的故障估计信息与实际故障基本一致。图3-图5中实际轨迹2为不同方法,轨迹1是由本发明的方法即自适应神经网络虚拟控制律,轨迹2是反馈控制,通过轨迹1和轨迹2的对比可以很明显的看出本发明所提的方法优于其他方法。系统的控制输入在物理约束下的轨迹如图6所示,图6中v1-v4表示系统的实际控制输入,用以控制系统的执行机构,但是系统的执行机构是有上限的,即数值不会无穷大。通过图6可以看出每当实际控制输入超过界限时,都会自适应调整,到界限以内。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种基于控制分配的无人机系统故障诊断与容错控制方法,其特征在于,其步骤如下:
步骤一:建立四旋翼无人机的动力学模型,并将动力学模型转化为状态空间模型;
步骤二:根据系统的控制分配方程建立具有扰动的控制分配模型;
所述步骤二的实现方法为:根据系统对应的控制分配方程:
u(t)=Bvv(t)
Bδ=BBv
则具有扰动的四旋翼无人机系统的控制分配模型为:
其中,x(t),y(t)分别是状态变量和输出变量;v(t)∈Rm×1表示实际控制律,d(t)∈Rn×1是外部扰动且为非高斯均匀分布函数,g(t,x(t))是非线性项,A,B,C是常值系统矩阵,Bv是控制效率矩阵,Bδ是实际控制矩阵,M是扰动矩阵;
步骤三:基于自适应权值的加权伪逆方法,设计控制分配律;控制分配律中结合故障观测器提供的故障估计信息,设计故障观测器的增益参数;
所述步骤三中基于自适应权值的加权伪逆方法,设计控制分配率的方法为:加权伪逆控制分配法中控制矩阵为:
且虚拟控制输入u(t)和实际控制律v(t)的关系为:v(t)=Du(t);
同时考虑物理约束和故障重构不匹配,动态自适应加权矩阵为:
设计控制分配律为:
其中,I为单位矩阵,是设计的故障观测器的故障估计,/>为Bv的加权Moore-Penrose逆矩阵,W为矩阵/>的加权矩阵,/>是动态自适应加权矩阵,W1是参数矩阵,/>是自适应更新率,xr(t)是参考状态,diag表示一个矩阵的对角线元素组成的矩阵,Φ是一个参数,γ是一个正的常数,Ω是将列向量的实际控制律变成只有对角线含有元素的对角矩阵,ev是实际控制律与虚拟控制律的差值;
步骤四:设计步骤三中故障观测器的误差动态稳定的充分条件;
步骤五:根据神经网络和模型参考自适应理论设计自适应神经网络虚拟控制律;
所述步骤五设计的自适应神经网络虚拟控制律为:
式中,k1是待设计的正的参数,ψ(x)∈Rl是径向基函数矢量,Θ是神经网络权值矩阵,其自适应更新律为:
其中,Γ∈Rl×l为自适应增益矩阵,并且满足ε为未知正数;/>为参考矩阵的逆,r是参考输入,B1是控制矩阵和虚拟控制矩阵的乘积的矩阵,/>是矩阵B1的转置,P是对称正定矩阵;
步骤六:根据李雅普诺夫稳定性理论设计闭环动态系统稳定的充分条件,故障观测器负责提供发生故障的估计信息,利用故障的估计信息设计容错控制器对故障进行补偿,从而保证系统的稳定性。
2.根据权利要求1所述的基于控制分配的无人机系统故障诊断与容错控制方法,其特征在于,所述步骤一的实现方法为:建立四旋翼无人机的动力学模型的简化模型为:
其中,[φ θ ψ]T表示滚转、俯仰、偏航三个欧拉角;g表示重力加速度;l表示各转子中心到重心的距离;m表示无人机的总质量;[Ix Iy Iz]T表示沿各自轴转动的转动惯量,Ki是阻力系数,i=1,2,3;Jr代表螺旋桨的转动惯量;u1,u2分别表示滚转和俯仰输入且u1=(-F2+F4),u2=(-F1+F3);u3为偏航力矩且u3=d(F1-F2+F3-F4)/b;且是由四个转子产生的推力,是系统的实际控制输入;Ωj表示螺旋桨的角速度且j=1,2,3,4,d是力与力矩的比例因子,b是升力系数;Ωr是螺旋桨角速度向量;
定义为状态变量,u=[u1 u2 u3]T为输入变量,/>为输出变量;动力学模型转换为状态空间模型为:
其中,x(t)∈Rn×1,y(t)∈Rq×1分别是状态变量和输出变量,为状态变量x(t)的倒数,R为实数集,u(t)∈Rp×1为虚拟控制输入,g(t,x(t))是非线性项,且满足误差函数/>A,B,C是常值系统矩阵,/>是非线性项g(t,x(t))的估计,γ1是一个任意小的正的常数,/>是状态向量x(t)的估计,n、q、p代表状态向量、输出向量、控制向量的维数。
3.根据权利要求1所述的基于控制分配的无人机系统故障诊断与容错控制方法,其特征在于,所述故障观测器为:
其中,是状态估计及其导数,/>是非线性项的估计,L是故障观测器的增益,/>是输出估计,Γ是故障估计律的参数,P1是需要计算的对称正定矩阵,e(t)是状态和状态估计的误差。
4.根据权利要求1或3所述的基于控制分配的无人机系统故障诊断与容错控制方法,其特征在于,所述步骤四中设计的充分条件为
其中,Y=PL是一个过渡矩阵,L是故障观测器的增益,γ1>0是一个比较小的正常数,P∈R6×6是正定对称矩阵,A、C为常值系统矩阵,P1是对称正定矩阵,M是扰动矩阵。
5.根据权利要求4所述的基于控制分配的无人机系统故障诊断与容错控制方法,其特征在于,所述步骤六中闭环动态系统稳定的充分条件为:
其中,k1为正数,P∈Rn×n是正定对称矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111543246.XA CN114253137B (zh) | 2021-12-16 | 2021-12-16 | 基于控制分配的无人机系统故障诊断与容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111543246.XA CN114253137B (zh) | 2021-12-16 | 2021-12-16 | 基于控制分配的无人机系统故障诊断与容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114253137A CN114253137A (zh) | 2022-03-29 |
CN114253137B true CN114253137B (zh) | 2023-07-25 |
Family
ID=80795331
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111543246.XA Active CN114253137B (zh) | 2021-12-16 | 2021-12-16 | 基于控制分配的无人机系统故障诊断与容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114253137B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115509136B (zh) * | 2022-11-21 | 2023-03-10 | 西北工业大学 | 一种面向线性传感器故障无人机飞行容错控制系统及方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104035447A (zh) * | 2014-06-27 | 2014-09-10 | 金陵科技学院 | 基于动态控制重新分配的无人飞行器姿态容错控制方法 |
CN108445760A (zh) * | 2018-03-14 | 2018-08-24 | 中南大学 | 基于自适应故障估计观测器的四旋翼无人机容错控制方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9296474B1 (en) * | 2012-08-06 | 2016-03-29 | The United States of America as represented by the Administrator of the National Aeronautics & Space Administration (NASA) | Control systems with normalized and covariance adaptation by optimal control modification |
US11640178B2 (en) * | 2016-12-13 | 2023-05-02 | Acsl Ltd. | Unmanned aircraft, device for controlling unmanned aircraft, method for controlling unmanned aircraft, and device for detecting failure of unmanned aircraft |
CN107065539B (zh) * | 2017-03-14 | 2020-01-31 | 南京航空航天大学 | 一种飞翼布局飞行器的操纵面故障自适应容错控制方法 |
CN107368091B (zh) * | 2017-08-02 | 2019-08-20 | 华南理工大学 | 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法 |
CN108628167B (zh) * | 2018-05-08 | 2021-11-12 | 南京邮电大学 | 基于自适应分配技术的飞行控制系统的容错控制方法 |
WO2020142984A1 (zh) * | 2019-01-10 | 2020-07-16 | 大连理工大学 | 一种基于误差区间观测器的航空发动机主动容错控制方法 |
CN109765920B (zh) * | 2019-03-04 | 2021-08-06 | 北京航空航天大学 | 集成故障观测器和控制分配策略的航天器姿态容错的控制方法 |
CN113568419B (zh) * | 2021-05-18 | 2023-09-12 | 南京邮电大学 | 一种变载四旋翼无人机容错控制方法 |
CN113485304B (zh) * | 2021-07-22 | 2022-06-07 | 北京航空航天大学 | 一种基于深度学习故障诊断的飞行器分层容错控制方法 |
-
2021
- 2021-12-16 CN CN202111543246.XA patent/CN114253137B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104035447A (zh) * | 2014-06-27 | 2014-09-10 | 金陵科技学院 | 基于动态控制重新分配的无人飞行器姿态容错控制方法 |
CN108445760A (zh) * | 2018-03-14 | 2018-08-24 | 中南大学 | 基于自适应故障估计观测器的四旋翼无人机容错控制方法 |
Non-Patent Citations (1)
Title |
---|
基于自适应滑模的多螺旋桨浮空器容错控制;梁宽宽;陈丽;段登平;;工程科学学报(第03期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114253137A (zh) | 2022-03-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Cai et al. | Disturbance suppression for quadrotor UAV using sliding-mode-observer-based equivalent-input-disturbance approach | |
CN106292681B (zh) | 一种基于观测器和在线控制分配的卫星主动容错控制方法 | |
CN107065539B (zh) | 一种飞翼布局飞行器的操纵面故障自适应容错控制方法 | |
Tang et al. | An integral TSMC-based adaptive fault-tolerant control for quadrotor with external disturbances and parametric uncertainties | |
Wang et al. | An adaptive sliding mode fault‐tolerant control of a quadrotor unmanned aerial vehicle with actuator faults and model uncertainties | |
Niu et al. | Nonlinear fuzzy fault-tolerant control of hypersonic flight vehicle with parametric uncertainty and actuator fault | |
CN110850887B (zh) | 一种四旋翼无人机复合动态逆抗干扰姿态控制方法 | |
Ding et al. | Robust fixed-time sliding mode controller for flexible air-breathing hypersonic vehicle | |
CN108776434A (zh) | 一种高超声速飞行器快速自适应滑模容错控制方法 | |
Saied et al. | Fault tolerant control for multiple successive failures in an octorotor: Architecture and experiments | |
Zhang et al. | Time-varying linear control for tiltrotor aircraft | |
Di Francesco et al. | Incremental nonlinear dynamic inversion and control allocation for a tilt rotor UAV | |
Emami et al. | Intelligent trajectory tracking of an aircraft in the presence of internal and external disturbances | |
Nemati et al. | Analysis and design of a multi-channel time-varying sliding mode controller and its application in unmanned aerial vehicles | |
CN114253137B (zh) | 基于控制分配的无人机系统故障诊断与容错控制方法 | |
de Vries et al. | Backstepping based nested multi-loop control laws for a quadrotor | |
Nekoo et al. | Optimized thrust allocation of variable-pitch propellers quadrotor control: A comparative study on flip maneuver | |
CN114721266A (zh) | 飞机舵面结构性缺失故障情况下的自适应重构控制方法 | |
Prach et al. | Development of a state dependent riccati equation based tracking flight controller for an unmanned aircraft | |
Yuan et al. | Adaptive fault-tolerant controller for morphing aircraft based on the L2 gain and a neural network | |
Wang et al. | Self-healing control for attitude system of hypersonic flight vehicle with body flap faults | |
CN114995163B (zh) | 一种无人机免疫控制方法 | |
Huangzhong et al. | Tiltrotor aircraft attitude control in conversion mode based on optimal preview control | |
Perhinschi et al. | Modeling and simulation of failures for primary control surfaces | |
Xiao et al. | Modified model reference adaptive control of UAV with wing damage |
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 |