首页> 中国专利> 伺服系统的主动容错控制方法

伺服系统的主动容错控制方法

摘要

本发明涉及一种伺服系统的主动容错控制方法,包括:步骤1,将电机伺服系统建模为带有未知输入和执行器故障的线性模型;步骤2,设计鲁棒故障估计器,估计系统故障;步骤3,根据所述估计的系统故障设计输出反馈容错控制器。根据本发明的伺服系统的主动容错控制方法,通过故障估计器得到系统的故障信息,使得电机伺服系统能够根据故障情况来对控制器的参数和结构重新调整从而保证故障后系统的稳定性,实现对发生的故障进行主动处理,具有很高的灵活性。

著录项

  • 公开/公告号CN105700351A

    专利类型发明专利

  • 公开/公告日2016-06-22

    原文格式PDF

  • 申请/专利权人 北京理工大学;

    申请/专利号CN201610040709.3

  • 申请日2016-01-21

  • 分类号G05B13/04;

  • 代理机构

  • 代理人

  • 地址 100081 北京市海淀区中关村南大街5号

  • 入库时间 2023-12-18 15:41:19

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2018-11-06

    授权

    授权

  • 2016-07-20

    实质审查的生效 IPC(主分类):G05B13/04 申请日:20160121

    实质审查的生效

  • 2016-06-22

    公开

    公开

说明书

技术领域

本发明涉及机电控制技术领域,具体而言,涉及一种伺服系统的主动容错控制方 法。

背景技术

伺服电机作为现代工业的主要能源动力设备,广泛地应用在生活中的各个领域, 如机床、印刷、安防和通信等。随着科学技术的不断进步和发展,伺服控制系统的复杂程度 变得越来越高。一些大型的伺服控制系统,如火炮位置伺服系统、雷达天线的主动跟踪系 统、航空炮塔伺服系统等,由于工作环境和工作条件的特殊性,一旦发生故障,便会造成巨 大的财产损失和人员伤亡,甚至导致整个系统的瘫痪。因此,现代工业领域和军事领域对伺 服控制系统的安全性、可靠性和可用性提出了更高的要求。为了改进伺服控制系统的安全 性和可靠性,传统的方法主要集中于如何增进系统的鲁棒性。然而,大量的实践表明即便如 此,系统运行过程中仍不可避免故障的发生。因此,有效地减少故障对系统带来的影响是非 常重要的。

容错控制技术是一种提高系统安全性和可靠性的非常重要方法。容错控制思想起 源于Niederlinski于1971年提出的完整性控制,是指如果系统的执行器、传感器或者其他 元部件发生故障时,系统仍然稳定而且具有较理想的特性。容错控制可以分为被动容错控 制和主动容错控制。被动容错控制是指在不改变控制器结构和参数的条件下,利用鲁棒技 术使系统对某些故障具有不敏感性。主动容错控制是指系统在故障发生后根据故障情况来 对控制器的参数和结构重新调整从而保证故障后系统的稳定性,它能够实现对发生的故障 进行主动处理,具有很高的灵活性。

发明内容

本发明旨在提供一种提高鲁棒性的伺服系统的主动容错控制方法。

为了达到上述目的,本发明提供了伺服系统的主动容错控制方法,步骤包括步骤 1,将电机伺服系统建模为带有未知输入和执行器故障的线性模型;步骤2,设计鲁棒故障估 计器,估计系统故障;步骤3,根据估计的系统故障建立输出反馈容错控制器。

进一步地,步骤11,建立电机伺服系统的动力学模型:

Rt+LI·-Ceθm·=UKdI=Jmθm··+bmθm·+k(θm-imθd)imk(θm-imθd)=Jdθd··+bdθd·---(1)

其中,U是电压,R是定子电阻,I是定子电流,L是定子电感,θm是电机转角,是电 机转速,Jm是电机转动惯量,θd是负载转角,是负载转速,Jd表示负载转动惯量,Ce是反电 动势系数,Kd是电磁力矩系数,bm是等效粘性阻尼系数,im是传动比,k是刚度系数;步骤12, 令x1=i,x2=θm,x4=θd,u=U,将动力学模型转化为以下状态空间表达式:

x·(t)Ax(t)+Bu(t)y(t)=Cx(t)---(2)

其中,x(t)是状态向量,u(t)是输入向量,y(t)是输出向量,

A=-RL0-CeL0000100KdJm-kJm-bmJmkimJm0000010kimJd0-kim2Jd-bdJdB=1L0000,C=0001000001;步骤13,假 设w(t)为未知输入向量,f(t)为执行器故障,得到故障系统模型为:

x·(t)=Ax(t)+Bu(t)+Eww(t)+Eff(t)y(t)=Cx(t)---(3)

其中,Ew是已知的适维矩阵,Ef是故障矩阵表示执行器故障对系统的影响。

进一步地,步骤21,设计基于观测器的鲁棒故障估计器,状态空间方程如下:

x^·(t)=Ax^(t)+Bu(t)+Eff^(t)L(y^(t)-y(t))y^(t)=Cx^(t)---(4)

其中,是估计器的状态向量,是估计器的输出向量,是故障估计向 量,L是估计器矩阵;步骤22,当ex(t)=x^(t)-x(t),ey(t)=y^(t)-y(t),ef(t)=f^(t)-f(t),得到ex·(t)=(A-LC)ex(t)+Efef(t)-Eww(t)---(5)

ey(t)=Cex(t)(6)步骤23,建立故障估计策略:

f^·(t)=-Fey(t)---(7)

得到e·f(t)=f^·(t)-f·(t)=-FCex(t)-f·(t)---(8)

根据公式(5)和(8),则误差系统为:

e·(t)=(A-LC)e(t)-Ewv(t)ef(t)=Ie(t)---(9)

其中e(t)=ex(t)ef(t),v(t)=w(t)f·(t),A=AEf00,L=LF,C=C0,Ew=Ew00I,I=0I.

进一步地设计输出反馈的容错控制器:

ζ·(t)=Akζ(t)+Bky(t)u(t)=Ckζ(t)+Dky(t)+r(t)-B*Ef^(t)---(15)

其中ζ(t)∈Rn是控制器的状态向量,r(t)是参考输入,Ck=(C-DkCX)M-T,Bk=N-1(B-YBDk),Ak=N-1(A-Y(A+BDkC)X)M-T-BkCXM-1-N-1YBCk,且M,N∈Rn×n满足MNT=I-XY。

根据本发明的伺服系统的主动容错控制方法,通过故障估计器得到系统的故障信 息,使得电机伺服系统能够根据故障情况来对控制器的参数和结构重新调整从而保证故障 后系统的稳定性,实现对发生的故障进行主动处理,具有很高的灵活性。

附图说明

构成本申请的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实 施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:

图1为电机伺服系统的结构简图;

图2为电机伺服系统的容错控制结构图;

图3为故障信号f(t)和故障估计信号

图4为输出y1(t)响应曲线;

图5为输出y2(t)响应曲线。

具体实施方式

下面将参考附图并结合实施例来详细说明本发明。

步骤1,系统的建模

根据机理建模的方法,结合电机的结构和物理定理,建立电机伺服系统的动力学 模型:

RI+LI·-Ceθm·=UKdI=Jmθm··+bmθm·+k(θm-imθd)imk(θm-imθd)=Jdθd··+bdθd·---(1)

其中,U是电压,R是定子电阻,I是定子电流,L是定子电感,θm是电机转角,是电 机转速,Jm是电机转动惯量,θd是负载转角,是负载转速,Jd表示负载转动惯量,Ce是反电 动势系数,Kd是电磁力矩系数,bm是等效粘性阻尼系数,im是传动比,k是刚度系数。

令x1=i,x2=θm,x4=θd,u=U。则系统(1)可以转化为以下状态空 间表达式:

x·(t)Ax(t)+Bu(t)y(t)=Cx(t)---(2)

其中,x(t)是状态向量,u(t)是输入向量,y(t)是输出向量,

A=-RL0-CeL0000100KdJm-kJm-bmJmkimJm0000010kimJd0-kim2Jd-bdJdB=1L0000,C=0001000001.

考虑到实际系统会受到外界干扰和噪声的影响,而且这些影响通常被建模为系统 的未知输入。另外,由于执行器故障会引起执行器的异变,在系统模型中考虑执行器故障。 令w(t)和f(t)分别表示未知输入向量和执行器故障,从而可以得到故障系统模型为:

x·(t)=Ax(t)+Bu(t)+Eww(t)+Eff(t)y(t)=Cx(t)---(3)

其中,Ew是已知的适维矩阵,Ef是故障矩阵表示执行器故障对系统的影响。

步骤2,基于观测器的鲁棒故障估计器的设计

为了估计出系统的故障,设计一个基于观测器的鲁棒故障估计器,其状态空间方 程如下:

x^·(t)=Ax^(t)+Bu(t)+Eff^(t)L(y^(t)-y(t))y^(t)=Cx^(t)---(4)

其中,是估计器的状态向量,是估计器的输出向量,是故障估计向 量,L是估计器矩阵。

ex(t)=x^(t)-x(t),ey(t)=y^(t)-y(t),ef(t)=f^(t)-f(t),

ex·(t)=(A-LC)ex(t)+Efef(t)-Eww(t)---(5)

ey(t)=Cex(t)(6)

设计如下的故障估计策略:

f^·(t)=-Fey(t)---(7)

e·f(t)=f^·(t)-f·(t)=-FCex(T)-f·(t)---(8)

根据公式(5)和(8),则误差系统为:

e·(t)=(A-LC)e(t)-Ewv(t)ef(t)=Ie(t)---(9)

其中

e(t)=ex(t)ef(t),v(t)=w(t)f·(t),A=AEf00,L=LF,C=C0,Ew=Ew00I,I=0I.

根据圆盘区域极点配置引理和连续系统的有界实引理,对于给定的H性能指标γ 和圆盘区域D(α,τ),如果存在一个对称正定矩阵和矩阵R满足:

-PPA-RC-αP*-τ2P<0---(13)

PA+ATP-RCTRTRFw-PEwI*-γI0**-γI<0---(14)

则的特征值位于圆盘区域D(α,τ)内,且误差系统(9)满足H性能||ef(t)| |2<γ||v(t)||2,增益矩阵

步骤3,输出反馈容错控制器的设计

假设rank(B,Ef)=rank(B),其等价于存在一个矩阵B*∈Rp×n满足:(I-BB*)Ef=0。

设计如下的输出反馈的容错控制器:

ζ·(t)=Akζ(t)+Bky(t)u(t)=Ckζ(t)+Dky(t)+r(t)-B*Ef^(t)---(15)

其中ζ(t)∈Rn是控制器的状态向量,r(t)是参考输入,Ak,Bk,Ck,Dk是需要求解的未 知矩阵。

令r(t)=0,把(15)带入(1)可得:

x·(t)=Ax(t)+BCkζ(t)+BDkCx(t)-BB*Eff^(t)+Ef(t)+Eww(t)=(A+BDkC)x(t)+BCkζ(t)-Efef(t)+Eww(t)---(16)

根据式(15)和(16)可得:

x~·(t)=A~x~(t)+D~υ(t)---(17)

其中x~(t)=x(t)ζ(t),A~=A+BDkCBCkBkCAk,υ(t)=w(t)ef(t),D~=Ew-EfBkFw0.

根据连续系统的有界实引理可知,当且仅当存在一个对称正定矩阵使得

P~A~+A~TP~P~D~I*-γI0**-γI<0---(22)

成立,则有||x~(t)||2<γ||μ(t)||2.

P~=YNBTW,P~-1=XMMTZ

其中X,Y∈Rn×n是正定对称矩阵,其他矩阵是适维的。由可得:

P~XIMT0=IY0NT

定义

F1=XIMT0,F2=IY0NT

则可得由于可知

E1TP~F1=F2TF1=XIIY>0---(23)

这样就得到

XIIY>0---(24)

对不等式(22)的两边分别左乘和右乘diag{F1,I,I},同时令 A=Y(A+BDkC)X+NBkCX+YBCkMT+NAkMT,B=YBDk+NBk,C=DkCX+CkMT,D=Dk,则可得到下式:

T11T12Ew-EfX*T22YEw-YEfI**-γI00***-γI0****-γI<0---(25)

其中矩阵T11=AX+XAT+BC+CTBT,T12=AT+A+BDC,T22=YA+AT+BC+CTBT.

进一步地可知对于给定的γ>0,当且仅当存在对称正定矩阵X,Y∈Rn×n和矩阵 ARn×n,BRn×n,CRp×n,DRp×n,满足式(24)和(25),则系统(17)是鲁棒渐进 稳定的,且满足进而可得输出反馈容错控制器的参数矩阵为:

Dk=D,Ck=(C-DkCX)M-T,Bk=N-1(B-YBDk),

Ak=N-1(A-Y(A+BDkC)X)M-T-BkCXM-1-N-1YBCk,

其中M,N∈Rn×n满足MNT=I-XY。

为了求出容错控制器的系数矩阵,首先要确定矩阵M和N。由于可得MNT= I-XY。进而可以通过I-XY的奇异值分解或者正交三角分解来得到满秩矩阵M和N。

为更清晰的对本发明的技术方案进行表述,考虑如下的电机参数:L=50mH,R= 2.6Ω,Ce=67.2V/KRPM,k=5.6Nm/rad,Kd=1.066N·m·s/A,im=1,Jm=0.003kg·m2,Jd= 0.0026kg·m2,bm=0.015Nm·s/rad,bd=0.02Nm·s/rad。假设Ew=0.1*[1;1;1;1;1],Ef= [20;0;0;0;0],r(t)=10,采样周期为h=0.01。

假设执行器故障信号为:

f(t)=0,0st<35s5(1-e0.5(t-35)),35st<60s5-10(1-e0.5(t-65)),65st<100s

图3表示故障信号f(t)和故障估计信号从图3中可以看出所提出的估计方 法能够实现对故障的准确估计。

根据圆盘区域极点配置引理和连续系统的有界实引理,选取H性能指标γ=2.5 和圆盘区域D(-4.6,4.6),可求得故障估计器的增益矩阵为:

L=103×1.01701.25140.01620.0046-0.1578-0.13320.01940.0010-0.03750.0124,F=[-165.914119.6621]。

根据定理2,选取H性能指标γ=6.2,可得输出反馈容错控制器的参数矩阵为:

Ak=-42.3819259.090332.7553100.2476185.68621.5216-2.244825.820770.148420.8774-0.15294.01546.028019.093820.40060.0030-3.8770-6.7846-17.33723.6168-0.0189-2.0185-3.6650-8.7004-10.1247,Bk=1.8626-1.0862-6.63335.05858.09792.6601-1.85406.35963.48229.1496,Ck=[-0.0014-0.01830.07210.4150-0.5883],Dk=[- 0.2690-0.1460]。

图4和图5给出了系统的输出响应曲线。从仿真结果可以看出,基于在线的故障估 计,设计的输出反馈容错控制器能使系统在出现故障时保持良好的性能。

以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技 术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修 改、等同替换、改进等,均应包含在本发明的保护范围之内。

去获取专利,查看全文>

相似文献

  • 专利
  • 中文文献
  • 外文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号