CN104647378B - 一种单关节机械臂系统的迭代学习故障诊断方法 - Google Patents

一种单关节机械臂系统的迭代学习故障诊断方法 Download PDF

Info

Publication number
CN104647378B
CN104647378B CN201510031469.6A CN201510031469A CN104647378B CN 104647378 B CN104647378 B CN 104647378B CN 201510031469 A CN201510031469 A CN 201510031469A CN 104647378 B CN104647378 B CN 104647378B
Authority
CN
China
Prior art keywords
tau
lambda
formula
centerdot
fault
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
CN201510031469.6A
Other languages
English (en)
Other versions
CN104647378A (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.)
Jiangnan University
Original Assignee
Jiangnan University
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 Jiangnan University filed Critical Jiangnan University
Priority to CN201510031469.6A priority Critical patent/CN104647378B/zh
Publication of CN104647378A publication Critical patent/CN104647378A/zh
Application granted granted Critical
Publication of CN104647378B publication Critical patent/CN104647378B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1674Programme controls characterised by safety, monitoring, diagnostic

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Test And Diagnosis Of Digital Computers (AREA)
  • Cable Transmission Systems, Equalization Of Radio And Reduction Of Echo (AREA)

Abstract

本发明公开了一种单关节机械臂系统的迭代学习故障诊断方法。首先建立单关节非线性机械臂系统模型;构建机械臂非线性状态变量动力方程;然后对状态变量动力系统进行扩展变换;设计扩展系统的迭代学习故障诊断方法;最后分析故障诊断算法的稳定性与参数选择条件,实现机械臂系统的实时故障诊断。其优点是:故障诊断算法不仅适用于不同类型的故障,而且对分别诊断执行器和传感器故障具有通用性;不仅可以定性检测故障的发生,还可以在线进行故障重构和估计,实时性好;扩展方程由系统方程直接构造,迭代算法简单高效,不需要引入大量附加参数变量也不用解繁琐的矩阵方程,易于工程实现。

Description

一种单关节机械臂系统的迭代学习故障诊断方法
技术领域
本发明涉及一种单关节机械臂系统的迭代学习故障诊断方法,属于故障诊断领域。
背景技术
机械臂是高精度、高速的机械手,在工业制造、医疗、航空航天和半导体制造等领域都得到了广泛应用。机械臂在接受指令信号的基础上,可完成批量生产方式下三维(或二维)空间上的点对点作业,提高生产效率和生产人员的安全性。
单关节机械臂是目前在机器人技术领域中得到最广泛实际应用的自动化机械装置,但随着机械臂系统的多次重复动作,其故障发生的几率也随着增加,为安全和连续运行造成了安全隐患。故障诊断技术作为系统安全运行的重要保障对提高机械臂系统的安全可靠性和降低故障风险具有重要意义,也受到越来越多的关注。
基于机器学习和观测器理论的故障诊断方法是故障分析的两个重要分枝,主要的诊断方法和成果有:基于神经网络的方法、基于自适应观测器的方法和基于滑模观测器的方法等。采用神经网络的故障诊断方法一般具有很大的局限性,要获得比较可靠的故障诊断结果,必须要有已知的固定故障诊断实例和一定数量可用于学习的故障样本,同时还需要足够长的时间来进行在线或离线学习训练。自适应观测器方法可用于线性和非线性系统故障诊断,然而当故障类型发生变化时,其故障估计精度将受到影响,还有可能产生局部最优问题.基于滑模观测器的检测方法鲁棒性较好,可以准确检测故障发生时间并实现故障隔离,其弊端在于非连续的切换控制律会使系统产生高频颤动,影响系统精确性。
针对单关节机械臂系统的重复运行特点,将迭代学习算法和观测器理论结合构造故障诊断滤波器,可将迭代学习控制算法简单、控制精度高的优点运用于系统故障重构,最终实现故障检测与估计。现有方法是将滤波器引入进行系统的执行器故障诊断,但由于输出传感器故障和执行器故障有明显区别,所以用于执行器的故障诊断算法一般不能直接推广和应用到系统输出传感器故障的诊断问题。
发明内容
本发明的目的是解决一种单关节机械臂系统的迭代学习故障诊断问题,针对一类存在执行器和传感器故障的单关节机械臂非线性系统,提出基于滤波器的故障重构算法,由机械臂系统方程构造新状态方程对系统作扩展变换,将原机械臂系统输出端非线性和故障转换到扩展系统的状态方程再设计故障诊断滤波器,采用迭代学习调节算法更新虚拟故障使之逼近实际故障,该故障诊断方法可以检测和估计系统故障并且对不同类型故障具有一定适应性。
根据本发明提供的技术方案,所述单关节机械臂系统的迭代学习故障诊断方法包括如下步骤:
第一步:建立单关节非线性机械臂系统模型
单关节非线性机械臂系统模型可描述为:
u ( t ) = J m q · · + sg sin ( q ( t ) ) + Bf ( t ) - - - ( 1 )
其中u(t)是作用点上的输入力矩,q(t)是机械臂旋转角度,f(t)是系统故障,g是重力加速度,系统参数选Jm=0.75ml2,s=lm,B=m,m为质量,l为机械臂长度。系统输出是机械臂旋转角度。
第二步:构建机械臂非线性状态变量动力方程
定义状态变量x1=q,则机械臂系统可描述为
x · 1 x · 2 = 0 1 0 0 x 1 x 2 + 0 - sg sin ( x 1 ) + 0 1 / J m u ( t ) + 0 - B / J m f ( t ) - - - ( 2 )
y=x1+f(t)
显然式(2)可表示为系统(3)形式的状态空间方程
x · ( t ) = Ax ( t ) + g 1 ( x ( t ) , t ) + Bu ( t ) + B f f ( t ) y ( t ) = Cx ( t ) + g 2 ( x ( t ) , t ) + Du ( t ) + D f f ( t ) - - - ( 3 )
其中x(t)∈Rn,y(t)∈Rm,u(t)∈Rr分别表示系统的状态、输出和输入向量;f(t)为待估计的故障函数;A,B,C,D,Bf,Df为相应维数的已知常数矩阵g1(x(t),t),g2(x(t),t)为非线性项。显然系统矩阵(C,A)可观,设g1(x(t),t),g2(x(t),t)满足Lipschitz条件,即||g1(x1(t),t)-g1(x2(t),t)||≤α1||x1(t)-x2(t)||,||g2(x1(t),t)-g2(x2(t),t)||≤α2||x1(t)-x2(t)||,其中α1,α2>0为g1和g2的Lipschitz常数。
第三步:状态变量动力系统的扩展变换
对系统(3)进行扩展变换,利用其输出端方程构造以下新状态方程:
z · ( t ) = A s z ( t ) + B s y ( t ) - - - ( 4 )
式中z(t)∈Rm为新引入的状态向量,AS∈Rm×m,Bs∈Rm×m是根据设计需要选定的新状态方程的系数矩阵。将(3)式输出方程代入式(4),可得:
z · ( t ) = A s z ( t ) + B s Cx ( t ) + B s g 2 ( x ( t ) , t ) + B s Du ( t ) + B s D f f ( t ) - - - ( 5 )
由(3)和(5)可得扩展系统状态方程:
x · ( t ) z · ( t ) = A 0 B S C A S x ( t ) z ( t ) + g 1 ( x ( t ) , t ) B S g 2 ( x ( t ) , t ) + B B S D u ( t ) + B f B S D f f ( t ) - - - ( 6 )
同时令
z ( t ) = 0 I x ( t ) z ( t ) - - - ( 7 )
作为扩展后系统的输出。
对(6)和(7)中的状态和各矩阵重新定义: x ~ ( t ) = x ( t ) z ( t ) T , y ~ ( t ) = z ( t ) ,
A ~ = A 0 B S C A S , g 3 ( x ~ ( t ) , t ) = g 1 ( x ( t ) , t ) B S g 2 ( x ( t ) , t ) , B ~ = B B S D , B ~ f = B f B S D f , C ~ = 0 I .
则式(6)和式(7)可表示为
x ~ · ( t ) = A ~ x ~ ( t ) + g 3 ( x ~ ( t ) , t ) + B ~ u ( t ) + B ~ f f ( t )
y ~ ( t ) = C ~ x ~ ( t ) - - - ( 8 )
式中非线性项在g1(x(t),t),g2(x(t),t)性质的基础上也满足可知t)满足Lipschitz条件,α3为其Lipschitz常数。式(8)表示一类仅存在执行器故障的非线性故障系统,对系统进行的扩展变换将原系统的输出传感器故障转变成新系统的一个执行器故障,因此,可以将已有的用于系统执行器故障诊断的方法直接用于输出传感器故障的检测和估计。扩展滤波器(4)的参数矩阵选取使扩展系统(8)仍然具有可观测性。
第四步:扩展系统的迭代学习故障诊断方法
为对扩展系统(8)的故障进行诊断,设计如下故障跟踪滤波器:
x ~ ^ · = A ~ x ~ ^ ( t ) = g 3 ( x ~ ^ ( t ) , t ) + B ~ u ( t ) + B ~ f f ^ k ( t ) + L ( y ~ ( t ) - y ~ ^ k ( t ) ) - - - ( 9 )
y ~ ^ ( t ) = C ~ x ~ ^ ( t )
系统残差定义如下
r k ( t ) = y ~ ( t ) - y ~ ^ k ( t ) - - - ( 10 )
迭代学习故障估计算法
f ^ k + 1 ( t ) = f ^ k ( t ) + Γ r · k ( t ) + Φ r k ( t ) + Ψ ∫ r k ( t ) dt - - - ( 11 )
故障诊断滤波器启动条件
| | y ~ ( t ) - y ~ ^ k ( t ) | | ∞ > γ - - - ( 12 )
其中分别是系统(8)状态和输出的估计值;下标k表示在优化时域t∈[tn-P,tn]内滤波器的迭代估计次数,P为所选优化时域的长度;矩阵L是预先设计的增益矩阵,使得矩阵(A-LC)的特征根在左半平面;为故障跟踪估计器的可调参数,即虚拟故障;是在优化时域内第k次调节后虚拟故障的大小;rk(t)是在优化时域内第k次调节后故障跟踪滤波器和系统(8)的输出残差;γ是设定的性能指标,式(12)表示输出残差信号幅值超出设定时才对系统进行诊断,合理选取γ值使故障诊断系统具有一定的鲁棒性又满足故障检测精度要求。式(11)是虚拟故障的调节算法,式中Γ,Φ,Ψ是迭代学习增益矩阵;这里采用迭代学习算法,充分利用残差信息在优化时域内反复对虚拟故障进行更新,使之逼近系统实际发生的故障,直至达到设定的精度要求,从而达到故障检测和估计的诊断目的。
第五步:分析故障诊断算法的稳定性与参数选择
不妨假设系统故障诊断的优化周期为[0,tn],取P为优化时域长度,则优化时域区间为[tn-P,tn],系统的状态误差定义为故障估计偏差定义为则由式(8)和式(9)可得误差系统状态方程为
e · ( t ) = ( A ~ - L C ~ ) e ( t ) + B ~ f δ f k ( t ) + g 3 ( x ~ ( t ) , t ) - g 3 ( x ~ ^ ( t ) , t ) r ( t ) = C ~ e ( t ) - - - ( 13 )
考虑到实际控制系统(1)的初始状态未知,即对于扩展系统(8),设计如(11)式所示的故障诊断滤波器和(13)式所示虚拟故障调节算法,在有限优化时域[tn-P,tn]内,若参数满足条件和第k次迭代初态偏差则当k→∞时,在λ范数意义下:
lim k → ∞ t ∈ [ 0 , t n ] | | y ~ ( t ) - y ~ ^ k ( t ) | | λ ≤ L C e 0 + L C a 2 ( 1 - e ( a 1 - λ ) P ) ( b 1 + b 2 P ) e 0 ( λ - a 1 ) ( 1 - ( | | ( I - Γ C ~ B ~ f ) | | + b 1 a 3 1 - e - λP λ + b 2 a 3 ( 1 - e - λP λ ) 2 ) ) - - - ( 14 )
其中 a 1 = | | ( A ~ - L C ~ ) | | + α 3 , a 2 = | | B ~ f | | , b 2 = | | Ψ C ~ | , L C = | | C ~ | | , b 1 = | | Γ C ~ ( A ~ - L C ~ ) + Φ C ~ | | + α 3 | | Γ C ~ | | .
由式(13)可得
e ( t ) = e ( t n - P ) + ∫ t n - P t n [ ( A ~ - L C ~ ) e ( τ ) + B ~ f δ f k ( τ ) + g 3 ( x ~ ( τ ) , τ ) - g 3 ( x ~ ^ ( τ ) , τ ) ] dτ - - - ( 15 )
式(15)等式两边取范数可得
| | e ( t ) | | ≤ | | e ( t n - P ) | | + ∫ t n - P t n | | ( A ~ - L C ~ ) | | · | | e ( τ ) | | dτ + ∫ t n - P t n | | B ~ f | | | | δ f k ( τ ) | | dτ + ∫ t n - P t n | | [ g 3 ( x ~ ( τ ) , τ ) - g 3 ( x ~ ^ ( τ ) , τ ) ] | | dτ - - - ( 16 )
由于g3满足Lipschitz条件,则式(16)可转换为
| | e ( t ) | | ≤ e 0 + a 1 ∫ t n - P t n | | e ( τ ) | | dτ + a 2 ∫ t n - P t n | | δ f k ( τ ) | | dτ - - - ( 17 )
其中 a 1 = | | ( A ~ - L C ~ ) | | + α 3 , a 2 = | | B ~ f | | . 进一步可得
| | e ( t ) | | ≤ e 0 e a 1 · t n + a 2 ∫ t n - P t n e a 1 ( t n - τ ) | | δ f k ( τ ) | | dτ - - - ( 18 )
同理易得
∫ t n - P t n | | e ( s ) | | ds ≤ e 0 e a 1 · t n P + a 2 ∫ t n - P t n ∫ t n - P s e a 1 ( t n - τ ) | | δ f k ( τ ) | | dτds - - - ( 19 )
由式(11)和式(13)可知
f ^ k + 1 ( t ) = f ^ k ( t ) + Γ C ~ e · k ( t ) + Φ C ~ e k ( t ) + Ψ C ~ ∫ t n - P t n e k ( τ ) dτ - - - ( 20 )
式(20)等式两边同时减f(t)可得
δ f k + 1 ( t ) = δ f k ( t ) - Γ C ~ e · k ( t ) - Φ C ~ e k ( t ) - Ψ C ~ ∫ t n - P t n e k ( τ ) dτ - - - ( 21 )
由式(21)和(15)得
δ f k + 1 ( t ) = δ f k ( t ) - Γ C ~ [ ( A ~ - L C ~ ) e ( t ) + B ~ f δ f k ( t ) + g 3 ( x ~ ( t ) , t ) - g 3 ( x ~ ^ ( t ) , t ) ] - Φ C ~ e k ( t ) - Ψ C ~ ∫ t n - P t n e k ( τ ) dτ - - - ( 22 )
式(22)两边取范数
| | δ f k + 1 ( t ) | | ≤ | | I - Γ C ~ B ~ f | | | | δ f k ( t ) | | + | | Γ C ~ | | | | g 3 ( x ~ ( t ) , t ) - g 3 ( x ~ ^ ( t ) , t ) | | + | | Γ C ~ ( A ~ - L C ~ ) + Φ C ~ | | | | e k ( t ) | | + | | Ψ C ~ | | ∫ t n - P t n | | e k ( τ ) | | dτ - - - ( 23 )
| | δ f k + 1 ( t ) | | ≤ | | ( I - Γ C ~ B ~ f ) | | · | | δ f k ( t ) | | + b 1 | | e k ( t ) | | + b 2 ∫ t n - P t n | | e k ( τ ) | | dτ - - - ( 24 )
其中由式(18),(19)和(24)可得
| | δ f k + 1 ( t ) | | ≤ ( b 1 + b 2 P ) e 0 e a 1 · t n + | | ( I - Γ C ~ B ~ f ) | | | | δ f k ( t ) | | + b 1 a 3 ∫ t n - P t n | | δ f k ( τ ) | | dτ + b 2 a 3 ∫ t n - P t n ∫ t n - P s | | δ f k ( τ ) | | dτds - - - ( 25 ) 式(25)两端同取λ范数得
||δfk+1(t)||λ≤M||δfk(t)||λ+(b1+b2P)e0(26)其中 M = | | ( I - &Gamma; C ~ B ~ f ) | | + b 1 a 3 1 - e - &lambda;P &lambda; + b 2 a 3 ( 1 - e - &lambda;P &lambda; ) 2 . 由条件 | | ( I - &Gamma; C ~ B ~ f ) | | < 1 可知,只要取足够大的λ就可使得M<1,则当k→∞时可得:
lim k &RightArrow; &infin; t &Element; [ t n - P , t n ] | | f ( t ) - f ^ k ( t ) | | &lambda; &le; ( b 1 + b 2 P ) e 0 1 - ( | | I - &Gamma; C ~ B ~ f | | + b 1 a 3 1 - e - &lambda;P &lambda; + b 2 a 3 ( 1 - e - &lambda;P &lambda; ) 2 ) - - - ( 27 )
对(18)取λ范数得
| | e ( t ) | | &lambda; &le; e 0 + 1 - e ( a 1 - &lambda; ) P &lambda; - a 1 a 2 | | &delta; f k ( t ) | | &lambda; - - - ( 28 )
由式(27)得
lim k &RightArrow; &infin; t &Element; [ 0 , t n ] | | x ~ ( t ) - x ~ ^ k ( t ) | | &lambda; &le; e 0 + a 2 ( 1 - e ( a 1 - &lambda; ) P ) ( b 1 + b 2 P ) e 0 ( &lambda; - a 1 ) ( 1 - ( | | ( I - &Gamma; C ~ B ~ f ) | | + b 1 a 3 1 - e - &lambda;P &lambda; + b 2 a 3 ( 1 - e - &lambda;P &lambda; ) 2 ) ) - - - ( 29 )
进一步扩展系统方程可得
lim k &RightArrow; &infin; t &Element; [ 0 , t n ] | | y ~ ( t ) - y ~ ^ k ( t ) | | &lambda; &le; L C e 0 + L C a 2 ( 1 - e ( a 1 - &lambda; ) P ) ( b 1 + b 2 P ) e 0 ( &lambda; - a 1 ) ( 1 - ( | | ( I - &Gamma; C ~ B ~ f ) | | + b 1 a 3 1 - e - &lambda;P &lambda; + b 2 a 3 ( 1 - e - &lambda;P &lambda; ) 2 ) ) - - - ( 30 )
其中 L C = | | C ~ | | .
在故障重构过程中,对于一个优化周期内的故障诊断情况,若系统存在初始偏差,由于系统(13)是稳定的,故障跟踪估计器也是稳定的,则初始条件引起的响应是衰减的,所以,随着优化周期的不断前进,其初始偏差逐步减小,初始偏差引起的误差最终趋零,即
本发明的优点是:以单关节机械臂此类典型重复运动的非线性系统为对象进行故障诊断。本发明故障诊断算法的适用性更好,不仅适用于不同类型的故障,而且对分别诊断执行器和传感器故障具有通用性;故障诊断算法的实时性更好,不仅可以定性检测故障的发生,还可以在线进行故障重构和估计;本发明的扩展方程由系统方程直接构造,迭代算法简单高效,不需要引入大量附加参数变量也不用解繁琐的矩阵方程,使得算法的设计和实现都较为方便,同时还可以获得较高的故障诊断精度。可进一步推广到应用于多关节机械手臂和发酵过程等实际工程对象。
附图说明
图1为机械臂系统的故障诊断结构图
图2为机械臂系统突变信号故障的诊断结果
图3为机械臂系统渐变信号故障的诊断结果
图4为机械臂系统周期信号故障的诊断结果
具体实施方式
下面结合附图和实施例对本发明做进一步说明。
针对式(1)形式的单关节机械臂非线性系统,构成如式(2)形式的状态变量动力方程,显然其满足式(3)形式的状态空间模型。再利用式(4)形式的扩展滤波器将状态空间模型(3)转换成式(6)和式(7)形式的状态方程和输出方程。故障诊断结构图如图1所示。当一类单关节机械臂系统参数m=10kg,l=2.5m,Jm=0.75ml2,定义状态变量x1=q,则系统可描述为
x &CenterDot; 1 x &CenterDot; 2 = 0 1 0 0 x 1 x 2 + 0 - 5.33 sin ( x 1 ) + 0 0.0213 u ( t ) + 0 - 0.213 f ( t )
系统输出取y=x1+f(t)。显然系统此时满足可观测性条件,可以进行扩展。当系统初态x0=[0.10.3]Τ时,根据本发明方法,扩展滤波器(4)的参数选为As=-1,Bs=1,则扩展状态方程:
z &CenterDot; ( t ) = - z ( t ) + y ( t )
y ~ ( t ) = z ( t )
设计增益矩阵L=[112]T,设计如下扩展故障诊断滤波器:
x ~ ^ &CenterDot; ( t ) = 0 1 - 1 0 0 - 1 1 0 - 3 x ~ ^ ( t ) + 0 - 5 . 33 sin ( x 1 ) 0 + 0 0.0213 0 u ( t ) + 0 - 0.213 1 f ^ k ( t ) + L y ~ ( t )
y ~ ^ ( t ) = 0 0 1 x ~ ^ ( t )
f ^ k + 1 ( t ) = f ^ k ( t ) + &Gamma; r &CenterDot; k ( t ) + &Phi; r &CenterDot; k ( t ) + &Phi; r k ( t ) + &Psi; &Integral; r k ( t ) dt
优化时域P=3s。在具体实施过程中,选取优化时域P是为了对系统分段诊断和滚动优化使系统残差在有限时间内无限趋零,避免因系统运行时间过长导致故障诊断不及时。P值的选取与被控对象和控制要求有关。对实时性要求较高的控制过程P值相对小一些,其他情况P值选取要求比较宽松
故障诊断方法中的算法启动要求γ=0.05,根据本发明方法选取迭代增益Γ=0.2,进而利用所设计的扩展故障诊断滤波器检测和估计系统故障。当系统故障分别为突变故障函数f1(t),渐变故障函数f2(t)和周期性故障函数f3(t)时
图2、图3和图4是分别对突变故障f1(t),渐变故障f2(t)和周期性故障f3(t)进行诊断的结果。可见本发明的故障诊断方法可以检测故障的发生并对故障进行较准确的估计,而且对不同类型的故障有一定的适应性。由于初值偏差的影响,故障重构起始误差较大,随时间推移逐渐减小,但系统运行时间为有限值,所以故障重构误差始终可以控制在一定范围内。
上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定,对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。

Claims (1)

1.一种单关节机械臂系统的迭代学习故障诊断方法,其特征包括:建立单关节非线性机械臂系统模型;构建机械臂非线性状态变量动力方程;对状态变量动力系统进行扩展变换;设计扩展系统的迭代学习故障诊断方法;分析故障诊断算法的稳定性与参数选择条件,实现机械臂系统的实时故障诊断;
第一步:建立单关节非线性机械臂系统模型
单关节非线性机械臂系统模型可描述为:
u ( t ) = J m q &CenterDot;&CenterDot; + s g s i n ( q ( t ) ) + B f ( t ) - - - ( 1 )
其中u(t)是作用点上的输入力矩,q(t)是机械臂旋转角度,f(t)是系统故障,g是重力加速度,系统参数选Jm=0.75ml2,s=lm,B=m,m为质量,l为机械臂长度,系统输出是机械臂旋转角度;
第二步:构建机械臂非线性状态变量动力方程
定义状态变量x1=q,则机械臂系统可描述为
x &CenterDot; 1 x &CenterDot; 2 = 0 1 0 0 x 1 x 2 + 0 - s g s i n ( x 1 ) + 0 1 / J m u ( t ) + 0 - B / J m f ( t ) - - - ( 2 )
y=x1+f(t)
显然式(2)可表示为系统(3)形式的状态空间方程
x &CenterDot; ( t ) = A x ( t ) + g 1 ( x ( t ) , t ) + B u ( t ) + B f f ( t )
(3)
y(t)=Cx(t)+g2(x(t),t)+Du(t)+Dff(t)
其中x(t)∈Rn,y(t)∈Rm,u(t)∈Rr分别表示系统的状态、输出和输入向量;f(t)为待估计的故障函数;A,B,C,D,Bf,Df为相应维数的已知常数矩阵;g1(x(t),t),g2(x(t),t)为非线性项;显然矩阵(C,A)可观,设g1(x(t),t),g2(x(t),t)满足Lipschitz条件,即||g1(x1(t),t)-g1(x2(t),t)||≤α1||x1(t)-x2(t)||,||g2(x1(t),t)-g2(x2(t),t)||≤α2||x1(t)-x2(t)||,其中α1,α2>0为g1和g2的Lipschitz常数;
第三步:状态变量动力系统的扩展变换
对系统(3)进行扩展变换,利用其输出端方程构造以下新状态方程:
z &CenterDot; ( t ) = A s z ( t ) + B s y ( t ) - - - ( 4 )
式中z(t)∈Rm为新引入的状态向量,AS∈Rm×m,Bs∈Rm×m是根据设计需要选定的新状态方程的系数矩阵;将(3)式输出方程代入式(4),可得:
z &CenterDot; ( t ) = A s z ( t ) + B s C x ( t ) + B s g 2 ( x ( t ) , t ) + B s D u ( t ) + B s D f f ( t ) - - - ( 5 )
由(3)和(5)可得扩展系统状态方程:
x &CenterDot; ( t ) z &CenterDot; ( t ) = A 0 B S C A S x ( t ) z ( t ) + g 1 ( x ( t ) , t ) g S g 2 ( x ( t ) , t ) + B B S D u ( t ) + B f B S D f f ( t ) - - - ( 6 )
同时令
z ( t ) = &lsqb; 0 I &rsqb; x ( t ) z ( t ) - - - ( 7 )
作为扩展后系统的输出;
对(6)和(7)中的状态和各矩阵重新定义: x ~ ( t ) = x ( t ) z ( t ) T , A ~ = A 0 B S C A S , g 3 ( x ~ ( t ) , t ) = g 1 ( x ( t ) , t ) B S g 2 ( x ( t ) , t ) , B ~ = B B S D , B ~ f = B f B S D f , C ~ = &lsqb; 0 I &rsqb; ; 则式(6)和式(7)可表示为
x ~ &CenterDot; ( t ) = A ~ x ~ ( t ) + g 3 ( x ~ ( t ) , t ) + B ~ u ( t ) + B ~ f f ( t )
y ~ ( t ) = C ~ x ~ ( t ) - - - ( 8 )
式中非线性项在g1(x(t),t),g2(x(t),t)性质的基础上也满足 | | g 3 ( x ~ 1 ( t ) , t ) - g 3 ( x ~ 2 ( t ) , t ) | | &le; &alpha; 3 | | x ~ 1 ( t ) - x ~ 2 ( t ) | | , 可知满足Lipschitz条件,α3为其Lipschitz常数;式(8)表示一类仅存在执行器故障的非线性故障系统,对系统进行的扩展变换将原系统的输出传感器故障转变成新系统的一个执行器故障,因此,可以将已有的用于系统执行器故障诊断的方法直接用于输出传感器故障的检测和估计;扩展滤波器(4)的参数矩阵选取使扩展系统(8)仍然具有可观测性;
第四步:扩展系统的迭代学习故障诊断方法
为对扩展系统(8)的故障进行诊断,设计如下故障跟踪滤波器:
x ~ ^ &CenterDot; ( t ) = A ~ x ~ ^ ( t ) + g 3 ( x ~ ^ ( t ) , t ) + B ~ u ( t ) + B ~ f f ^ k ( t ) + L ( y ~ ( t ) - y ~ ^ k ( t ) ) - - - ( 9 )
y ~ ^ ( t ) = C ~ x ~ ^ ( t )
系统残差定义如下
r k ( t ) = y ~ ( t ) - y ~ ^ k ( t ) - - - ( 10 )
迭代学习故障估计算法
f ^ k + 1 ( t ) = f ^ k ( t ) + &Gamma; r &CenterDot; k ( t ) + &Phi;r k ( t ) + &Psi; &Integral; r k ( t ) d t - - - ( 11 )
故障诊断滤波器启动条件
| | y ~ ( t ) - y ~ ^ k ( t ) | | &infin; > &gamma; - - - ( 12 )
其中分别是系统(8)状态和输出的估计值;下标k表示在优化时域t∈[tn-P,tn]内滤波器的迭代估计次数,P为所选优化时域的长度;矩阵L是预先设计的增益矩阵,使得矩阵(A-LC)的特征根在左半平面;为故障跟踪估计器的可调参数,即虚拟故障;是在优化时域内第k次调节后虚拟故障的大小;rk(t)是在优化时域内第k次调节后故障跟踪滤波器和系统(8)的输出残差;γ是设定的性能指标,式(12)表示输出残差信号幅值超出设定时才对系统进行诊断,合理选取γ值使故障诊断系统具有一定的鲁棒性又满足故障检测精度要求;式(11)是虚拟故障的调节算法,式中Γ,Φ,Ψ是迭代学习增益矩阵;这里采用迭代学习算法,充分利用残差信息在优化时域内反复对虚拟故障进行更新,使之逼近系统实际发生的故障,直至达到设定的精度要求,从而达到故障检测和估计的诊断目的;
第五步:分析故障诊断算法的稳定性与参数选择
不妨假设系统故障诊断的优化周期为[0,tn],取P为优化时域长度,则优化时域区间为[tn-P,tn],系统的状态误差定义为故障估计偏差定义为则由式(8)和式(9)可得误差系统状态方程为
e &CenterDot; ( t ) = ( A ~ - L C ~ ) e ( t ) + B ~ f &delta;f k ( t ) + g 3 ( x ~ ( t ) , t ) - g 3 ( x ~ ^ ( t ) , t ) r ( t ) = C ~ e ( t ) - - - ( 13 )
考虑到实际控制系统(1)的初始状态未知,即对于扩展系统(8),设计如(11)式所示的故障诊断滤波器和(13)式所示虚拟故障调节算法,在有限优化时域[tn-P,tn]内,若参数满足条件和第k次迭代初态偏差则当k→∞时,在λ范数意义下:
lim k &RightArrow; &infin; t &Element; &lsqb; 0 , t n &rsqb; | | y ~ ( t ) - y ~ ^ k ( t ) | | &lambda; &le; L C e 0 + L C a 2 ( 1 - e ( a 1 - &lambda; ) P ) ( b 1 + b 2 P ) e 0 ( &lambda; - a 1 ) ( 1 - ( | | ( I - &Gamma; C ~ B ~ f ) | | + b 1 a 3 1 - e - &lambda; P &lambda; + b 2 a 3 ( 1 - e - &lambda; P &lambda; ) 2 ) ) - - - ( 14 )
其中 a 1 = | | ( A ~ - L C ~ ) | | + &alpha; 3 , a 2 = | | B ~ f | | , b 2 = | | &Psi; C ~ | , L C = | | C ~ | | , b 1 = | | &Gamma; C ~ ( A ~ - L C ~ ) + &Phi; C ~ | | + &alpha; 3 | | &Gamma; C ~ | | ;
由式(13)可得
e ( t ) = e ( t n - P ) + &Integral; t n - P t n &lsqb; ( A ~ - L C ~ ) e ( &tau; ) + B ~ f &delta;f k ( &tau; ) + g 3 ( x ~ ( &tau; ) , &tau; ) - g 3 ( x ~ ^ ( &tau; ) , &tau; ) &rsqb; d &tau; - - - ( 15 )
式(15)等式两边取范数可得
| | e ( t ) | | &le; | | e ( t n - P ) | | + &Integral; t n - P t n | | ( A ~ - L C ~ ) | | &CenterDot; | | e ( &tau; ) | | d &tau; + &Integral; t n - P t n | | B ~ f | | | | &delta;f k ( &tau; ) | | d &tau; + &Integral; t n - P t n | | &lsqb; g 3 ( x ~ ( &tau; ) , &tau; ) - g 3 ( x ~ ^ ( &tau; ) , &tau; ) &rsqb; | | d &tau; - - - ( 16 )
由于g3满足Lipschitz条件,则式(16)可转换为
| | e ( t ) | | &le; e 0 + a 1 &Integral; t n - P t n | | e ( &tau; ) | | d &tau; + a 2 &Integral; t n - P t n | | &delta;f k ( &tau; ) | | d &tau; - - - ( 17 )
其中 a 1 = | | ( A ~ - L C ~ ) | | + &alpha; 3 , a 2 = | | B ~ f | | ; 进一步可得
| | e ( t ) | | &le; e 0 e a 1 &CenterDot; t n + a 2 &Integral; t n - P t n e a 1 ( t n - &tau; ) | | &delta;f k ( &tau; ) | | d &tau; - - - ( 18 )
同理易得
&Integral; t n - P t n | | e ( s ) | | d s &le; e 0 e a 1 &CenterDot; t n P + a 2 &Integral; t n - P t n &Integral; t n - P s e a 1 ( t n - &tau; ) | | &delta;f k ( &tau; ) | | d &tau; d s - - - ( 19 )
由式(11)和式(13)可知
f ^ k + 1 ( t ) = f ^ k ( t ) + &Gamma; C ~ e &CenterDot; k ( t ) + &Phi; C ~ e k ( t ) + &Psi; C ~ &Integral; t n - P t n e k ( &tau; ) d &tau; - - - ( 20 )
式(20)等式两边同时减f(t)可得
&delta;f k + 1 ( t ) = &delta;f k ( t ) - &Gamma; C ~ e &CenterDot; k ( t ) - &Phi; C ~ e k ( t ) - &Psi; C ~ &Integral; t n - P t n e k ( &tau; ) d &tau; - - - ( 21 )
由式(21)和(15)得
&delta;f k + 1 ( t ) = &delta;f k ( t ) - &Gamma; C ~ &lsqb; ( A ~ - L C ~ ) e ( t ) + B ~ f &delta;f k ( t ) + g 3 ( x ~ ( t ) , t ) - g 3 ( x ~ ^ ( t ) , t ) &rsqb; - &Phi; C ~ e k ( t ) - &Psi; C ~ &Integral; t n - P t n e k ( &tau; ) d &tau; - - - ( 22 )
式(22)两边取范数
| | &delta;f k + 1 ( t ) | | &le; | | ( I - &Gamma; C ~ B ~ f ) | | | | &delta;f k ( t ) | | + | | &Gamma; C ~ | | | | g 3 ( x ~ ( t ) , t ) - g 3 ( x ~ ^ ( t ) , t ) | | + | | &Gamma; C ~ ( A ~ - L C ~ ) + &Phi; C ~ | | | | e k ( t ) | | + | | &Psi; C ~ | | &Integral; t n - P t n | | e k ( &tau; ) | | d &tau; - - - ( 23 )
| | &delta;f k + 1 ( t ) | | &le; | | ( I - &Gamma; C ~ B ~ f ) | | &CenterDot; | | &delta;f k ( t ) | | + b 1 | | e k ( t ) | | + b 2 &Integral; t n - P t n | | e k ( &tau; ) | | d &tau; - - - ( 24 )
其中 b 1 = ( | | &Gamma; C ~ ( A ~ - L C ~ ) + &Phi; C ~ | | + &alpha; 3 &CenterDot; | | &Gamma; C ~ | | ) , b 2 = | | &Psi; C ~ | | ; 由式(18),(19)和(24)可得
| | &delta;f k + 1 ( t ) | | &le; ( b 1 + b 2 P ) e 0 e a 1 &CenterDot; t n + | | ( I - &Gamma; C ~ B ~ f ) | | | | &delta;f k ( t ) | | + b 1 a 3 &Integral; t n - P t n | | &delta;f k ( &tau; ) | | d &tau; + b 2 a 3 &Integral; t n - P t n &Integral; t n - P s | | &delta;f k ( t ) | | d &tau; d s - - - ( 25 )
式(25)两端同取λ范数得
||δfk+1(t)||λ≤M||δfk(t)||λ+(b1+b2P)e0(26)
其中 M = | | ( I - &Gamma; C ~ B ~ f ) | | + b 1 a 3 1 - e - &lambda; P &lambda; + b 2 a 3 ( 1 - e - &lambda; P &lambda; ) 2 ; 由条件 | | ( I - &Gamma; C ~ B ~ f ) | | < 1 可知,只要取足够大的λ就可使得M<1,则当k→∞时可得:
lim k &RightArrow; &infin; t &Element; &lsqb; t n - P , t n &rsqb; | | f ( t ) - f ^ k ( t ) | | &lambda; &le; ( b 1 + b 2 P ) e 0 1 - ( | | ( I - &Gamma; C ~ B ~ f ) | | + b 1 a 3 1 - e - &lambda; P &lambda; + b 2 a 3 ( 1 - e - &lambda; P &lambda; ) 2 ) - - - ( 27 )
对(18)取λ范数得
| | e ( t ) | | &lambda; &le; e 0 + 1 - e ( a 1 - &lambda; ) P &lambda; - a 1 a 2 | | &delta;f k ( t ) | | &lambda; - - - ( 28 )
由式(27)得
lim k &RightArrow; &infin; t &Element; &lsqb; 0 , t n &rsqb; | | x ~ ( t ) - x ~ ^ k ( t ) | | &lambda; &le; e 0 + a 2 ( 1 - e ( a 1 - &lambda; ) P ) ( b 1 + b 2 P ) e 0 ( &lambda; - a 1 ) ( 1 - ( | | ( I - &Gamma; C ~ B ~ f ) | | + b 1 a 3 1 - e - &lambda; P &lambda; + b 2 a 3 ( 1 - e - &lambda; P &lambda; ) 2 ) ) - - - ( 29 )
进一步扩展系统方程可得
lim k &RightArrow; &infin; t &Element; &lsqb; 0 , t n &rsqb; | | y ~ ( t ) - y ~ ^ k ( t ) | | &lambda; &le; L C e 0 + L C a 2 ( 1 - e ( a 1 - &lambda; ) P ) ( b 1 + b 2 P ) e 0 ( &lambda; - a 1 ) ( 1 - ( | | ( I - &Gamma; C ~ B ~ f ) | | + b 1 a 3 1 - e - &lambda; P &lambda; + b 2 a 3 ( 1 - e - &lambda; P &lambda; ) 2 ) ) - - - ( 30 )
其中 L C = | | C ~ | | ;
在故障重构过程中,对于一个优化周期内的故障诊断情况,若系统存在初始偏差,由于系统(13)是稳定的,故障跟踪估计器也是稳定的,则初始条件引起的响应是衰减的,所以,随着优化周期的不断前进,其初始偏差逐步减小,初始偏差引起的误差最终趋零,即
CN201510031469.6A 2015-01-21 2015-01-21 一种单关节机械臂系统的迭代学习故障诊断方法 Active CN104647378B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510031469.6A CN104647378B (zh) 2015-01-21 2015-01-21 一种单关节机械臂系统的迭代学习故障诊断方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510031469.6A CN104647378B (zh) 2015-01-21 2015-01-21 一种单关节机械臂系统的迭代学习故障诊断方法

Publications (2)

Publication Number Publication Date
CN104647378A CN104647378A (zh) 2015-05-27
CN104647378B true CN104647378B (zh) 2016-03-30

Family

ID=53239272

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510031469.6A Active CN104647378B (zh) 2015-01-21 2015-01-21 一种单关节机械臂系统的迭代学习故障诊断方法

Country Status (1)

Country Link
CN (1) CN104647378B (zh)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105549598B (zh) * 2016-02-16 2018-04-17 江南大学 一种二维运动移动机器人的迭代学习轨迹跟踪控制及其鲁棒优化方法
CN107490964B (zh) * 2017-08-17 2020-06-02 杭州电子科技大学 一种基于特征证据离散化的旋转机械故障特征约简方法
CN108763671B (zh) * 2018-05-15 2022-07-08 中车青岛四方机车车辆股份有限公司 一种计算车间减振器参数的方法及装置
CN109597403A (zh) * 2018-12-14 2019-04-09 江南大学 基于迭代学习滤波器的机电控制系统故障诊断方法
CN109514560A (zh) * 2018-12-25 2019-03-26 中国电子产品可靠性与环境试验研究所((工业和信息化部电子第五研究所)(中国赛宝实验室)) 工业机器人故障监控系统、方法以及装置
CN109683480B (zh) * 2018-12-27 2021-04-02 西北工业大学 考虑执行器故障的非线性机械系统类固定时间控制方法
CN110083981B (zh) * 2019-05-17 2023-04-28 重庆交通大学 一种基于遗忘因子的任意初态下的迭代学习故障估计方法
CN110842913B (zh) * 2019-10-13 2022-05-31 无锡职业技术学院 一种单关节机械臂的自适应滑模迭代学习控制方法
CN112799325B (zh) * 2020-12-31 2022-09-06 泉芯集成电路制造(济南)有限公司 一种机械臂运动监控方法、装置及相关设备
CN113110063B (zh) * 2021-05-08 2022-05-31 江南大学 单轴进给系统的鲁棒单调收敛点对点迭代学习控制方法
CN114083543B (zh) * 2021-12-22 2023-04-18 清华大学深圳国际研究生院 一种空间机械臂主动故障诊断方法
CN117817668A (zh) * 2024-01-30 2024-04-05 哈尔滨工业大学 一种ssrms构型机械臂单关节故障的运动学重构方法
CN117784616B (zh) * 2024-02-23 2024-05-24 西北工业大学 一种基于智能观测器组的高速飞行器故障重构方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101846979A (zh) * 2010-06-29 2010-09-29 北京航空航天大学 一种精确目标跟踪的超前迭代学习控制方法
FR2982050B1 (fr) * 2011-11-01 2014-06-20 Nantes Ecole Centrale Procede et dispositif pour la simulation en temps reel de systemes et de processus complexes
CN102427341B (zh) * 2011-11-22 2015-03-25 上海大学 基于卡尔曼滤波的远程迭代学习控制系统传输噪声抑制方法
WO2014201455A1 (en) * 2013-06-14 2014-12-18 Larimore Wallace E A method and system of dynamic model identification for monitoring and control of dynamic machines with variable structure or variable operation conditions

Also Published As

Publication number Publication date
CN104647378A (zh) 2015-05-27

Similar Documents

Publication Publication Date Title
CN104647378B (zh) 一种单关节机械臂系统的迭代学习故障诊断方法
Wang et al. A nonlinear least-squares approach for identification of the induction motor parameters
CN102354104B (zh) 控制器、观测器及其应用
CN105867360B (zh) 一种机电控制系统的初值预估迭代学习故障诊断算法
CN103406909B (zh) 一种机械臂系统的跟踪控制设备及方法
CN113029559B (zh) 一种齿轮箱故障诊断方法及系统
CN106227964A (zh) 基于扩张状态观测器的迟滞非线性系统参数辨识方法
Oucief et al. Adaptive observer-based fault estimation for a class of Lipschitz nonlinear systems
CN104730922A (zh) 基于扩张状态观测器的伺服系统线性反馈控制和极点配置确定参数方法
CN111752262A (zh) 一种执行器故障观测器与容错控制器集成设计方法
Riaz et al. Design and Implementation of Novel LMI‐Based Iterative Learning Robust Nonlinear Controller
CN109597403A (zh) 基于迭代学习滤波器的机电控制系统故障诊断方法
CN104330972A (zh) 一种基于模型自适应的综合预测迭代学习控制方法
CN116012681A (zh) 基于声振信号融合的管道机器人电机故障诊断方法及系统
CN103744286A (zh) 一种火力发电系统的控制器的设计方法和装置
CN105260604A (zh) 基于符号动力学与云模型的卫星动量轮故障检测方法
Algburi et al. A new synergy of singular spectrum analysis with a conscious algorithm to detect faults in industrial robotics
CN104102130A (zh) 状态空间模型的批次过程无穷时域线性二次容错控制方法
Gédouin et al. Model-free control of shape memory alloys antagonistic actuators
CN109583124B (zh) 一种基于adrc的hmm故障预测系统
Micheal et al. Feed forward linear quadratic controller design for an industrial electro hydraulic actuator system with servo valve
Maddahi et al. A practical approach for designing fault-tolerant position controllers in hydraulic actuators: methodology and experimental validation
Khadraoui et al. Robust control design method for uncertain system using a set of measurements
Hao et al. A Physical Model based research for fault diagnosis of gear crack
Khireddine et al. Fault tolerant control on robotic manipulator using sliding mode observers

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant