Control method for enhancing robust interference resistance of voice coil motor direct drive system

01-08-2023 дата публикации
Номер:
CN116526928A
Контакты:
Номер заявки: 43-10-20235064.3
Дата заявки: 21-04-2023

一种音圈电机直驱系统增强鲁棒抗干扰的控制方法

附图说明

[0047]

图1是按照本发明的优选实施例所构建的音圈电机直驱式高压电-气压力伺服阀抗干扰控制原理示意图;

[0048]

图2是按照本发明的优选实施例所构建的音圈电机直驱式高压电-气压力伺服阀结构原理图;

[0049]

图3是按照本发明的优选实施例所构建的阶跃响应示意图;

[0050]

图4是按照本发明的优选实施例所构建的系统的跟踪误差随时间变化的曲线图,其中,(a)是ERC-ESO误差曲线示意图,(b)是RISE-RSO误差曲线示意图,(c)是LADRC误差曲线示意图。

技术领域

[0001]

本发明属于电气伺服控制相关技术领域,更具体地,涉及一种音圈电机直驱系统增强鲁棒抗干扰的控制方法。

具体实施方式

[0051]

为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。

[0052]

本发明一种提出了一种新的集成拓展状态抗干扰观测器ESO的增强鲁棒控制方法(ERC-ESO),利用ESO(拓展状态抗干扰观测器)估计系统中未建模动态和外部干扰并将其估计值作为前馈纳入控制器,ERC的提出进一步补偿ESO的干扰估计残差以降低ESO的观测负担。新提出的ERC(增强鲁棒控制器)控制方法能够在传统RISE控制器的基础上,进一步提高控制器的抗干扰能力,并大大降低了非线性鲁棒项的参数选择限制,这保证了当系统对积分鲁棒结构敏感和抗干扰观测器观测能力有限时依旧能够保证良好的系统性能。最后运用李亚普洛夫稳定性理论对音圈电机直驱式高-压电气伺服阀位置伺服系统进行稳定性证明,得到了系统能够在存在明显外部干扰时依然可以达到渐进稳定的结果。

[0053]

如图1所示,本发明提出的一种音圈电机直驱式高压电-气伺服阀的增强鲁棒抗干扰控制算法主要包括两大部分,其一为拓展状态抗干扰观测器的干扰估计,其二为增强鲁棒补偿。两大部分耦合在一起,实现对高压电-气伺服阀的状态调节。目标指令与传感器采集到的位移信息最终会输入到增强鲁棒补偿项中进行运算,增强鲁棒补偿项的计算结果与干扰估计结果组成在一起,经过增益变换后输入到高压电-气伺服阀中,实现对高压电-气伺服阀的在线调整。在这个过程中,传感器的采集与控制算法的计算持续进行,实现对高压电-气伺服阀的持续调节控制。

[0054]

如图2所示,工作原理:高压电-气伺服阀控制系统主要包括三大部分,伺服控制器,伺服驱动器和高压电气伺服阀。伺服控制器为本发明提出的一种音圈电机直驱式高压电-气伺服阀的增强鲁棒抗干扰控制算法,其具体工作过程见图2的相关描述。参考信号输入到伺服控制器中,经过运算,伺服控制器输入响应的控制信号,伺服驱动器放大后,具有驱动能力,实现对音圈电机的驱动,进而实现高压电-气伺服阀阀芯运动的控制。

[0055]

高压电气伺服阀主要由三大部分构成。其一音圈电机、永磁体和磁体壳体构成了伺服阀的驱动部分提供阀芯运动的驱动力。在音圈电机的驱动下,阀芯运动,控制阀口开度的大小。外部伺服阀阀体对阀芯的运动形成约束。在高压电气伺服阀的工作中,始终收到复杂的干扰力,主要包括:磁体外壳体和永磁体之间的摩擦力、阀芯与阀体间的摩擦力以及高压气体在阀芯上产生的高压气动力。因此,需要提出抗干扰控制算法来保证高压电-气压力伺服阀的控制精度。

[0056]

本发明音圈电机直驱式高-压电气伺服阀的增强鲁棒抗干扰控制方法,包括以下步骤:

[0057]

S1建立音圈电机高-压电气伺服阀系统的数学模型

[0058]

S11,本发明所考虑的音圈电机高-压电气伺服阀系统是通过维持音圈电机两端电压保持一直,控制音圈电机两端的电流大小驱动音圈电机平行移动,进而驱动伺服阀阀芯运动,控制伺服阀的开启和关闭。

[0059]

其中,音圈电机的等效电路为:

[0060]

[0061]

式中,R是音圈电机的等效电阻,L是音圈电机的线圈电感,i是电流,em是音圈电机上产生的反电动势。

[0062]

音圈电机的驱动力Fe表达为:

[0063]

Fe=Kei=Bli  (2)

[0064]

其中:Fe为电机的安培力,Ke为电机参数,B为磁场强度,l为音圈电机在磁场中的等效导线总长,i为电流。

[0065]

因此根据力平衡方程,音圈电机直驱式高压电-气伺服阀的动力学方程可得:

[0066]

[0067]

其中,m为未知的被驱动部分准确总质量(包括阀芯质量、音圈电机质量和中间直连机构的质量之和),xsv为阀芯的实际位移,Fe为电机的驱动力,Ftg为瞬态气动力,Fsg为稳态气动力,Ff为系统所受的摩擦力,Fi为内部扰动(驱动信号的波动等),Fud为未知的干扰,Bv为未知的准确系统阻尼系数,t表示时间。

[0068]

考虑系统建模不确定性,则系统的模型误差能够被表示为:

[0069]

[0070]

其中,m为未知的被驱动部分准确总质量、Ke为未知的准确音圈电机参数、R为未知的音圈电机准确等效电阻值和Bv为未知的准确系统阻尼系数,m0为已知的被驱动部分准确的总质量、Ke0为已知的音圈电机参数、R0为已知的音圈电机等效电阻值、Bv0为已知的系统阻尼系数,Δm为被驱动部分已知总质量与未知准确总质量之间的差值、ΔKe为已知音圈电机参数与未知准确音圈电机参数之间的差值、ΔR为已知的音圈电机等效电阻值与未知音圈电机准确等效电阻值之间的差值,ΔBv为已知系统阻尼系数与未知的准确系统阻尼系数之间的差值。

[0071]

根据式(1)-(4),则音圈电机直驱式高压电气伺服阀的系统状态方程能够被表示为:

[0072]

[0073]

其中:系统状态变量和x2为伺服阀运动速度,为伺服阀运动的加速度。a1为已知系统阻尼参数,b0为已知增益参数,Ftd为集总干扰,Fd为外部总干扰,m为未知的被驱动部分准确总质量,m0为已知的被驱动部分准确的总质量,Ke0为已知的音圈电机参数、R0为已知的音圈电机等效电阻值、Bv0为已知的系统阻尼系数,Ke为未知的准确音圈电机参数、R为未知的音圈电机准确等效电阻值,Bv为未知的准确系统阻尼系数,u为音圈电机的输入电压。Ftg为瞬态气动力,Fsg为稳态气动力,Ff为系统所受的摩擦力,Fi为内部扰动(驱动信号的波动等),Fud为未知的干扰。

[0074]

假设1:在工程实践中,虽然很难获得准确的模型信息,但它们的值必须是连续的和有界的。此外,虽然各种扰动可能会发生剧烈的变化,但它们也是连续的和有界的。因此,集总扰动Ftd属于C2,满足和和分别为集总干扰的变化速度值和变化加速度值,中间变量Mf-1,Mf-2为正值,分别表示表示集总干扰的变化速度值和集总干扰的变化速度值和变化加速度值的最大值。

[0075]

S2根据上述音圈电机直驱式高压电气伺服阀的抗干扰控制器的设计;

[0076]

基于带模型信息的拓展状态抗干扰观测器的干扰补偿设计:

[0077]

将集总干扰Ftd拓展为系统的一个额外状态变量x3,即x3=f=Ftd,则式(5)能够被改写为:

[0078]

[0079]

其中,u为系统输入,和x2为伺服阀运动速度,为伺服阀运动的加速度,a1为已知系统阻尼参数,b0为已知增益参数,为伺服阀位移的加速度,为伺服阀位移的速度,Ftd=f为集总干扰,为集总干扰的变化速度。

[0080]

带模型信息的ESO设计如下:

[0081]

[0082]

观测器估计矩阵z=[z1 z2 z3]T,z1,z2,z3为拓展状态抗干扰观测器输出的观测估计值,它们分别对应伺服阀位移xsv,伺服阀位移的速度集总干扰f;a1为系统阻尼;A为观测器状态矩阵;B为观测器增益矩阵(根据系统参数,能够计算得到);C为观测器输出矩阵;L为拓展状态观测器需要设计的反馈矩阵,其包含了系统阻尼a1和观测器带宽(观测器参数)w0

[0083]

反馈矩阵L设计如下:

[0084]

[0085]

其中,a1为已知的系统阻尼和w0为需要设置的观测器带宽(观测器参数)。

[0086]

给出引理如下:当观测器带宽w0满足时ESO的估计误差有界且其上界存在,即φ1为ESO对系统状态和外部干扰估计误差的最大值。此外,干扰估计误差的一阶和二阶导数也是有界的(分别为φ2和φ3)。

[0087]

[0088]

其中:为放缩后的观测器矩阵,λmax(P)为中间矩阵P的最大特征值;w0为观测器带宽;中间变量Mf-1和Mf-2为正值,分别为表示集总干扰f变化速度和集总干扰f变化加速度的最大值;φ23为中间变量,φ2表示ESO对系统状态和外部干扰估计误差的变化速度的最大值,φ3表示ESO对系统状态和外部干扰估计误差变化的加速度最大值。

[0089]

对于上述估计误差的验证过程如下:

[0090]

该引理证明如下:

[0091]

拓展状态抗干扰观测器的状态估计误差矩阵E定义为:

[0092]

[0093]

其中,z1,z2,z3为拓展状态抗干扰观测器观测估计值,xsv为伺服阀位移,为伺服阀位移的速度;f为集总干扰。e1,e2,e3分别为拓展状态抗干扰观测器观测值z1与伺服阀位移xsv的之间的误差,拓展状态抗干扰观测器观测值z2对伺服阀运动速度之间的误差;拓展状态抗干扰观测器观测值z3与集总干扰f之间的误差。

[0094]

定义:拓展状态抗干扰观测器的放缩状态估计误差矩阵e1,e2,e3分别为拓展状态抗干扰观测器观测值z1与伺服阀位移xsv的之间的误差,拓展状态抗干扰观测器观测值z2对伺服阀运动速度之间的误差;拓展状态抗干扰观测器观测值z3与集总干扰f之间的误差。

[0095]

则式(7)可以被改写为:

[0096]

[0097]

其中:ε为放缩状态估计误差矩阵,分别为放缩后的观测器矩阵和放缩后的增益矩阵,为集总干扰变化速度,w0为观测器带宽,a1为已知的系统阻尼。

[0098]

根据赫尔维茨矩阵的判定定理,当矩阵所有特征值位于复平面的复半平面时,矩阵为赫尔维茨矩阵,则取:

[0099]

[0100]

中间变量λ,λ1,λ2,λ3为放缩后的观测器矩阵的矩阵特征值,I为单位矩阵,a1为系统已知的阻尼参数。

[0101]

当观测器带宽观测器矩阵为赫尔维茨矩阵,则存在一个中间矩阵变量P满足其中,I为单位矩阵,。同时定义李雅普诺夫函数Vε

[0102]

Vε=εTPε (12)

[0103]

对其求导可得:

[0104]

[0105]

Vε为李雅普诺夫函数,P为中间矩阵变量,为放缩后的观测器矩阵和放缩后的增益矩阵,ε为放缩状态估计误差矩阵,为放缩状态估计误差矩阵变化速度,为集总干扰Ftd的变化速度,中间变量Mf-1和Mf-2为正值,分别表示表示集总干扰f变化速度和集总干扰f变化加速度的最大值。

[0106]

因此,φ1为中间变量,其表示ESO对系统状态和外部干扰估计误差的最大值;中间变量Mf-1为集总干扰f变化速度;w0为观测器带宽。λmax(P)为中间矩阵P的最大特征值。同时,根据(10)和(12),通过计算可得:

[0107]

[0108]

[0109]

其中:ε为放缩状态估计误差矩阵,为放缩状态估计误差矩阵变化速度,P为中间矩阵变量,为放缩后的观测器矩阵和放缩后的增益矩阵,Ftd为集总干扰。

[0110]

经证明,由和分别为集总干扰的变化速度值和变化加速度值,中间变量Mf-1,Mf-2为正值,分别表示表示集总干扰的变化速度值和集总干扰的变化速度值和变化加速度值的最大值。可以得到如下结论:估计状态总是有界的,且任意时间后,和其中:ε为放缩状态估计误差矩阵;λmax(P)为中间矩阵P的最大特征值;放缩后的观测器矩阵,w0为观测器带宽;中间变量Mf-1和Mf-2为正值,分别表示表示集总干扰f变化速度和集总干扰f变化加速度的最大值;φ123为中间变量,φ1为ESO对系统状态和外部干扰估计误差的最大值,φ2表示ESO对系统状态和外部干扰估计误差的变化速度的最大值,φ3表示ESO对系统状态和外部干扰估计误差变化的加速度最大值。

[0111]

S3增强鲁棒性抗干扰控制器的设计

[0112]

S31定义跟踪误差ec1,ec2和辅助误差信号r如下:

[0113]

ec1=xd-xsv;(16)

[0114]

[0115]

[0116]

其中,xd为目标指令,为速度目标指令,xsv为伺服阀位移,为伺服阀的运动速度,α和kr为控制器参数,为中间变量,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,为高压电-气伺服阀实际运动速度与目标实际运动速度之间的差值,ec2表示修正高压电-气伺服阀运动速度差值,表示修正高压电-气伺服阀运动加速度差值,r表示高压电-气伺服阀速度与其修正加速度之和的辅助中间变量。

[0117]

S32设计增强鲁棒抗干扰控制器控制率如下:

[0118]

[0119]

其中:k1,k2,k3,kr为控制器参数;α和β均为控制器参数且为正实数,b0为已知增益参数,sgn(ec2)为ec2的标准符号函数,tanh(k3ec1)是ec1的双曲正切函数。ec1为高压电-气伺服阀实际位移与目标位移之间的差值,ec2表示修正后的高压电-气伺服阀运动速度差值,为伺服阀的运动速度,t为时间。

[0120]

考虑式(18),得到辅助中间变量r的展开式如下:

[0121]

[0122]

其中:ki(i=1,2,3,r)为控制器参数;α,kr和β均为控制器参数且为正实数,b0为已知增益参数,u为系统输入,sgn(ec2)为ec2的标准符号函数,tanh(k3ec1)是ec1的双曲正切函数。表示目标指令加速度的变化快慢值,为伺服阀运动的加速度值,为伺服阀运动的速度值,为中间变量的变化速度值,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,ec2表示修正高压电-气伺服阀运动速度差值,r表示修正高压电-气伺服阀速度与其修正加速度之和的辅助中间变量;t为时间;w1=f-z3为总扰动误差,f为系统集总干扰,z3为从拓展状态抗干扰观测器中获得的系统集总干扰估计值。

[0123]

然后对式(20)两边求导,可得:

[0124]

[0125]

其中:ki(i=1,2,3,r)为控制器参数;α和β均为控制器参数且为正实数,sgn(ec2)为ec2的标准符号函数,tanh(k3ec1)是ec1的双曲正切函数。表示目标指令加速度的变化快慢值,表示目标指令加速度值,为伺服阀运动的加速度值,α和kr为控制器参数,为中间变量的加速度值,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,为高压电-气伺服阀实际运动速度与目标实际运动速度之间的差值,为高压电-气伺服阀实际运动加速度与目标实际运动加速度之间的差值,ec2表示修正高压电-气伺服阀运动速度差值,表示高压电-气伺服阀修正运动加速度差值,r表示修正高压电-气伺服阀速度与其修正加速度之和的辅助中间变量;t为时间;为中间变量,w1为总扰动误差。

[0126]

中间变量N中,xd为指令信号,因此均是连续且有界的,对于任意系统而言系统状态的变化也是连续且有界的,因此也是连续且有界的,为高压电-气伺服阀实际运动加速度与目标实际运动加速度之间的差值,为高压电-气伺服阀修正运动加速度差值。则定义中间变量δ1为中间变量δ2为为高压电-气伺服阀实际运动加速度与目标实际运动加速度之间的差值,为高压电-气伺服阀实际运动加速度与目标实际运动加速度之间差值的变化快慢,表示高压电-气伺服阀修正运动加速度差值,表示高压电-气伺服阀修正运动加速度差值的变化速度,xd为目标指令,为速度目标指令,表示目标指令加速度的变化快慢的中间变量,表示中间变量的变化快慢。

[0127]

结合式(14)和式(15),中间变量和满足和因此,中间变量N和中间变量满足以下不等式:

[0128]

[0129]

[0130]

式中,γ1和γ2为中间变量。表示目标指令加速度的变化快慢值,表示目标指令加速度值,δ1为中间变量和δ2为中间变量,w0为观测器带宽(观测器参数)。

[0131]

要保证被控系统能够在存在干扰和系统不确定性的情况下实现渐进稳定,控制器参数β需要满足以下条件:

[0132]

β≥γ11(ec2)且

[0133]

[0134]

χ1(ec2)和χ2(ec1)为关于ec2和ec1参数选择限制函数,ki(i=2,3)为控制器参数;kr,α和β为控制器参数;ec1为高压电-气伺服阀实际位移与目标位移之间的差值;为高压电-气伺服阀实际运动速度与目标运动速度之间的差值;ec2表示修正高压电-气伺服阀运动速度差值。tanh(·)是双曲正切函数。

[0135]

S4运用李雅普诺夫稳定性理论对音圈电机直驱式高-压电气伺服阀闭环控制系统进行稳定性证明,并运用Barbalat引理得到系统能够达到渐进稳定的结果,具体如下:

[0136]

先给出如下定理:

[0137]

定义辅助函数L(t):

[0138]

[0139]

ki(i=2,3)为控制器参数,kr,α和β为控制器参数,sgn(ec2)为e2的标准符号函数,tanh(k3ec1)是ec1的双曲正切函数,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,为高压电-气伺服阀实际运动速度与目标实际运动速度之间的速度变化差值,ec2表示修正后的高压电-气伺服阀运动速度差值,表示高压电-气伺服阀修正运动加速度差值,r表示修正高压电-气伺服阀速度与其修正加速度之和的辅助中间变量;N为中间变量,t为时间。

[0140]

其中,分别将计算可得:

[0141]

[0142]

②≤∫kr|ec2|Ndt≤∫kr|ec21dt (28)

[0143]

③=β(|ec2(t)|-|ec2(0)|) (29)

[0144]

④=∫βkr|ec2(t)|dt (30)

[0145]

[0146]

其中:

[0147]

[0148]

ki(i=2,3)为控制器参数,kr,α和β为控制器参数,sgn(ec2)为e2的标准符号函数,tanh(k3ec1)是ec1的双曲正切函数,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,为高压电-气伺服阀实际运动速度与目标实际运动速度之间的速度变化差值,ec2表示修正高压电-气伺服阀运动速度差值,表示高压电-气伺服阀修正运动加速度差值,r表示修正高压电-气伺服阀速度与其修正加速度之和的辅助中间变量;N为中间变量,γ1和γ2为中间变量,t为时间。

[0149]

因此:

[0150]

[0151]

其中,ki(i=2,3)为控制器参数,kr和α为控制器参数,tanh(k3ec1)是k3ec1的双曲正切函数,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,为高压电-气伺服阀实际运动速度与目标实际运动速度之间的差值,ec2表示修正后的高压电-气伺服阀运动速度差值,表示高压电-气伺服阀修正运动加速度差值,c1为与积分初始状态有关的常数,t为时间。

[0152]

定义:

[0153]

[0154]

[0155]

其中:χ1(ec2)和χ2(ec1)为参数选择限制函数,ki(i=2,3)为控制器参数,α为控制器参数,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,为高压电-气伺服阀实际运动速度与目标实际运动速度之间的差值,ec2表示修正后的高压电-气伺服阀运动速度差值,c1为与积分初始状态有关的常数,tanh(k3ec1)是k3ec1的双曲正切函数。

[0156]

联立式(33-35),⑤能够被改写为:

[0157]

⑤=χ1(ec2)|ec2|+∫krχ2(ec1)|ec2|dt (36)

[0158]

其中:χ1(ec2)和χ2(ec1)为参数选择限制函数,kr为控制器参数,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,ec2表示修正后的高压电-气伺服阀运动速度差值,t为时间。

[0159]

联立①-⑤,式(26)能够被改写为:

[0160]

[0161]

L(t)为辅助函数;kr和β为控制器参数;ec1为高压电-气伺服阀实际位移与目标位移之间的差值;ec2表示修正后的高压电-气伺服阀运动速度差值;ec1(0)为初始时刻高压电-气伺服阀实际位移与目标位移之间的差值;ec2(0)表示初始时刻修正后的高压电-气伺服阀运动速度差值;N和为中间变量;N(0)为中间变量N的初始时刻值;γ1和γ2为中间变量,χ1(ec2)和χ2(ec1)为参数选择限制函数,t为时间。

[0162]

结合式(24-25)中所需满足的条件,则有:

[0163]

L(t)≤β|ec2(0)|-N(0)ec2(0) (38)

[0164]

其中:L(t)为辅助函数,β为控制器参数,N(0)为中间变量N的初始时刻值,ec2(0)表示初始时刻修正高压电-气伺服阀运动速度差值。

[0165]

定义辅助函数P,当β满足式(24)中条件时,则有

[0166]

P=β|ec2(0)|-N(0)ec2(0)-L(t)≥0  (39)

[0167]

其中:L(t)为辅助函数,β为控制器参数,N(0)为中间变量N的初始时刻值,ec2(0)表示初始时刻修正后的高压电-气伺服阀运动速度差值。

[0168]

定义李亚普洛夫函数V如下:

[0169]

[0170]

其中:P为辅助函数,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,ec2表示修正后的高压电-气伺服阀运动速度差值,r表示修正高压电-气伺服阀速度与其修正加速度之和的辅助中间变量。

[0171]

对式(40)求导,并联立(17-18)(39),可得:

[0172]

[0173]

其中:为李亚普洛夫函数V的变化速度值;为辅助函数P的变化速度值;ki(i=1,2,3)为控制器参数;kr,α和β为控制器参数;ec1为高压电-气伺服阀实际位移与目标位移之间的差值;ec2表示修正后的高压电-气伺服阀运动速度差值;r表示修正高压电-气伺服阀速度与其修正加速度之和的辅助中间变量;为高压电-气伺服阀实际运动速度与目标实际运动速度之间的速度变化差值;表示高压电-气伺服阀修正运动加速度差值;表示辅助中间变量r的变化速度值;N为中间变量。

[0174]

定义中间变量矩阵η和Λ如下:

[0175]

η=[ec1 ec2 r]T (42)

[0176]

[0177]

其中:k1为控制器参数;kr和α为控制器参数;ec1为高压电-气伺服阀实际位移与目标位移之间的差值;ec2表示修正后的高压电-气伺服阀运动速度差值;r表示修正高压电-气伺服阀速度与其修正加速度之和的辅助中间变量。

[0178]

通过调整参数控制器参数α,kr,k1使得中间变量矩阵Λ正定,则有:

[0179]

[0180]

其中:为李亚普洛夫函数V的变化速度值,η和Λ为中间变量矩阵,λmin(Λ)为中间变量矩阵Λ的最小特征值,ec1为高压电-气伺服阀实际位移与目标位移之间的差值;ec2表示修正后的高压电-气伺服阀运动速度差值;r表示修正高压电-气伺服阀速度与其修正加速度之和的辅助中间变量,W为中间变量。

[0181]

对式(44)左右两边积分,则有:

[0182]

[0183]

其中:W为中间变量,为李亚普洛夫函数V的变化速度值,τ为中间变量,V(0)为李亚普洛夫函数V在初始时刻的确切值;V(t)为李亚普洛夫函数V在时间t时刻的确切值。

[0184]

由于高压电-气伺服阀实际位移与目标位移之间的差值ec1,修正后的高压电-气伺服阀运动速度差值ec2,辅助中间变量r均属于L2范数,且根据假设,高压电-气伺服阀实际运动速度与目标实际运动速度之间的差值高压电-气伺服阀修正运动加速度差值辅助中间变量r的变化速度值属于L范数,因此中间变量W是一致连续的,由Barbalat引理可知:当时间t→∞时,高压电-气伺服阀实际位移与目标位移之间的差值ec1→0。

[0185]

因此:

[0186]

结论1:针对音圈电机直驱式高压电-气压力伺服阀(5)设计的增强鲁棒抗干扰控制能够使系统得到渐进稳定的结果,调节增益α,kr,k1能够使系统的跟踪误差在时间趋近于无穷时趋于零;针对音圈电机直驱式高压电-气压力伺服阀(5)设计的增强鲁棒抗干扰控制原理图如图2所示。

[0187]

下面结合具体的实施例进一步说明本发明。

[0188]

实施例

[0189]

为考核所设计的控制器性能,采用以下实物进行实验对比分析,表1伺服阀相关参数。

[0190]

表1

[0191]

参数值/单位描述
<![CDATA[K<sub>e</sub>]]>23.5N/A电机参数
I4A音圈电机最大电流
R音圈电机电阻
L1Mh@1kHz音圈电机电感
<![CDATA[x<sub>vmax</sub>]]>±1.5mm阀芯最大运动范围
<![CDATA[x<sub>max</sub>]]>±1mm阀芯有效运动范围
M0.6kg音圈电机驱动的总质量

[0192]

实施方法:由于针对伺服阀而言,阶跃响应速度和稳态跟踪误差是最重要的性能指标,因此采取考核方式为:在外部施加相同交变干扰力的情况下,对比不同控制器的阶跃响应速度和稳态跟踪误差。

[0193]

如图3所示,对在不同控制方法控制下高压电-气伺服阀输入相同的阶跃信号控制指令,对比其对应的阶跃响应曲线,实现对控制算法的响应性能的对比。实验结果显示,增强鲁棒控制器算法能够使得高压电-气伺服阀在最短时间内跟踪上目标指令,并保持稳定,取得了最佳的响应性能。

[0194]

如图4所示,当音圈电机直驱式高压电-气伺服阀稳定时,向其施加相同的交变干扰,然后根据高压电-气伺服阀在不同控制方法控制下的跟踪误差大小,对控制算法的抗干扰性能进行对比。实验结果显示,在相同干扰下,增强鲁棒控制器算法能够保证最好的抗干扰性能,稳态跟踪误差最小。

[0195]

图4中,音圈电机直驱式高压电-气伺服阀受到相同的干扰下,采用本发明所提出的增强鲁棒抗干扰控制方法时,如图4中(a)所示,其跟踪误差最小,误差范围在±0.005mm左右。当采用RISE-ESO的控制方法时,如图4中(b)所示,音圈电机直驱式高压电-气伺服阀在相同干扰下,跟踪误差较大,误差范围接近±0.01mm.当采用LADRC的控制方法时,如图4中(c)所示,音圈电机直驱式高压电-气伺服阀在相同干扰下,跟踪误差最大,误差范围超过了±0.015mm。

[0196]

本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。

背景技术

[0002]

高压电-气伺服控制技术是来流体传动技术领域中的非常重要组成部分,也是机电一体化技术中的重要代表。近年来,随着制造领域的需求不断朝向高响应、高精度、高功率(重量比)、环境友好的方向发展,我国电-气伺服控制技术也逐步取得飞跃的进步。

[0003]

高压电-气伺服控制技术是备受关注的技术热点,广泛应用于航空、航天、军事、冶金、工程机械等领域。在气动控制领域,高压电-气伺服控制系统相较于传统的低压气动控制系统而言,具有能量密度高、瞬间输出能量大、响应速度快等优点,但气体压力的升高会在伺服阀阀芯处产生极强的气动力干扰,极大的影响了高压电气伺服阀的控制精度,进而制约高压电-气伺服控制的进一步发展。传统控制方法难以应对如此剧烈的干扰,进而导致伺服阀性能下降、响应速度降低、跟踪误差难以消除。因此,探索能够快速补偿外部强扰动的增强鲁棒控制方法成为实际工程应用中的迫切需求。

发明内容

[0004]

针对现有技术的以上缺陷或改进需求,本发明提供了一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,解决音圈电机直驱系统快速补偿外部强扰动的增强鲁棒控制的问题。

[0005]

为实现上述目的,按照本发明的一个方面,提供了一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,该方法包括下列步骤:

[0006]

S1建立音圈电机直驱系统的动力学方程、模型误差和状态方程;

[0007]

S2将集总干扰拓展为额外的状态变量更新所述状态方程,在该更新后的状态方程的基础上设定拓展状态抗干扰观测器和其估计误差满足的条件,利用该抗拓展状态抗干扰观测器计算集总干扰的估计;

[0008]

S3设定跟踪误差和辅助误差信号,构建增强鲁棒抗干扰的控制器对集总干扰的估计和集总误差的差值进行补偿,以此实现对音圈电机直驱系统的控制。

[0009]

进一步优选地,在步骤S1中,所述动力学方程按照下列关系式进行:

[0010]

[0011]

其中,m为被驱动部分总质量(包括阀芯质量、音圈电机质量和中间直连机构的质量之和),xsv为阀芯的实际位移,Fe为电机的驱动力,Ftg为瞬态气动力,Fsg为稳态气动力,Ff为系统所受的摩擦力,Fi为内部扰动(驱动信号的波动等),Fud为未知的干扰,Bv为粘性阻尼系数,t表示时间。

[0012]

进一步优选地,在步骤S1中,所述模型误差按照下列关系式进行:

[0013]

[0014]

其中,m为未知的被驱动部分准确总质量、Ke为未知的准确音圈电机参数、R为未知的音圈电机准确等效电阻值和Bv为未知的准确系统阻尼系数,m0为已知的被驱动部分准确的总质量、Ke0为已知的音圈电机参数、R0为已知的音圈电机等效电阻值、Bv0为已知的系统阻尼系数,Δm为被驱动部分已知总质量与未知准确总质量之间的差值、ΔKe为已知音圈电机参数与未知准确音圈电机参数之间的差值、ΔR为已知的音圈电机等效电阻值与未知音圈电机等效电阻值之间的差值和ΔBv为已知系统阻尼系数与未知的准确系统阻尼系数之间的差值。

[0015]

进一步优选地,在步骤S1中,所述状态方程按照下列关系式进行:

[0016]

[0017]

其中,u为系统输入,系统状态变量x1和x2表示为系统阻尼参数a1、和增益参数b0

[0018]

集总干扰Ftd表示为:

[0019]

[0020]

Fd=Ftg+Fsg+Ff+Fi+Fud

[0021]

其中:m为未知的被驱动部分准确总质量,m0为已知的被驱动部分准确的总质量,Ke0为已知的音圈电机参数、R0为已知的音圈电机等效电阻值、Bv0为已知的系统阻尼系数,Ke为未知的准确音圈电机参数、R为未知的音圈电机准确等效电阻值,Bv为未知的准确系统阻尼系数,u为音圈电机的输入电压,Ftg为瞬态气动力,Fsg为稳态气动力,Ff为系统所受的摩擦力,Fi为内部扰动(驱动信号的波动等),Fud为未知的干扰,Fd为外部总干扰。

[0022]

进一步优选地,在步骤S2中,所述更新后的状态方程按照下列关系式:

[0023]

[0024]

其中,u为系统输入,和为系统状态变量x1、系统状态变量x2和系统状态变量x3的变化速度,a1为已知系统阻尼参数,b0为已知增益参数,为伺服阀位移的加速度,为伺服阀位移的速度,Ftd=f为集总干扰,为集总干扰的变化速度。

[0025]

进一步优选地,在步骤S2中,所述抗拓展状态抗干扰观测器按照下列关系式进行:

[0026]

[0027]

[0028]

[0029]

其中,观测器估计矩阵z=[z1 z2 z3]T,z1,z2,z3为拓展状态观测器输出的观测估计值,它们分别对应伺服阀位移xsv,伺服阀位移的速度集总干扰f,a1为系统阻尼,b0为已知增益参数,A为系统状态矩阵,B为观测器增益矩阵,C为观测器输出矩阵;L为拓展状态观测器需要设计的反馈矩阵,其包含了系统阻尼a1和观测器带宽w0

[0030]

进一步优选地,在步骤S2中,所述误差估计满足的条件如下:

[0031]

当观测器带宽w0满足时ESO的估计误差有界且其上界存在,即其中,φ1为ESO对系统状态和外部干扰估计误差的最大值,λmax(P)为中间矩阵变量P的最大特征值,Mf-1表示集总干扰f变化速度的最大值,w0为观测器带宽(观测器参数),a1为已知系统阻尼参数。

[0032]

进一步优选地,在步骤S3中,所述跟踪误差和辅助误差信号按照下列关系进行:

[0033]

ec1=xd-xsv

[0034]

[0035]

[0036]

其中,xd为目标指令,为速度目标指令,xsv为伺服阀位移,为伺服阀的运动速度,α和kr为控制器参数,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,为高压电-气伺服阀实际运动速度与目标实际运动速度之间的差值,ec2为修正后的高压电-气伺服阀运动速度差值,为修正高压电-气伺服阀运动加速度差值,r为修正高压电-气伺服阀速度差值ec2与其修正加速度差值之和的辅助中间变量。

[0037]

进一步优选地,所述增强鲁棒抗干扰的控制器按照下列关系式进行:

[0038]

[0039]

其中,k1,k2,k3,kr为控制器参数;b0为已知增益参数;α和β均为控制器参数且为正实数,sgn(ec2)为ec2的标准符号函数,tanh(k3ec1)是ec1的双曲正切函数,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,ec2表示修正高压电-气伺服阀运动速度差值,z3为拓展状态抗干扰观测器输出的集总干扰估计值。

[0040]

进一步优选地,所述控制参数β满足下列关系式:

[0041]

β≥γ11(ec2)且

[0042]

其中,γ1和γ2为中间变量,χ1(ec2)和χ2(ec1)为发明中所提出的参数选择限制函数,kr为控制器参数。

[0043]

总体而言,通过本发明所构思的以上技术方案与现有技术相比,具备下列有益效果:

[0044]

1.本发明将基于干扰抑制(ERC)与干扰估计补偿(ESO)有效结合,ERC的使用进一步保证了在ESO存在估计残差时,进一步补偿外部干扰,使得控制性能得到提升,同时,改进后ERC的非线性鲁棒反馈增益项能够对外部干扰进行多重补偿,降低鲁棒增益参数的选择限制,参数选择与干扰估计误差导数和强扰动补偿增益参数相关,比原先RISE-ESO的条件更容易满足,控制器跟踪性能相比传统鲁棒控制LADRC和RIES-ESO都有了很大改进。实验结果验证了其有效性;

[0045]

2.本发明运用李亚普洛夫稳定性理论对音圈电机直驱式高压电-气伺服阀的附加拓展状态抗干扰观测器的复合增强鲁棒控制方法进行稳定性证明,得到系统大范围渐进稳定的理论结果和具有抗干扰性能的结论。本发明能够在系统遭受强干扰的情况下,保证系统的控制精度和鲁棒性;

[0046]

3.本发明在系统模型参数变化和存在极强外部干扰的情况下,保证系统的大范围渐进稳定和快速恢复系统稳定状态;实现了很好的跟踪性能和抗干扰能力,实验验证了发明的有效性;控制器结构新颖清晰明确、控制方法可靠稳定,有广泛的应用前景。



The invention belongs to the technical field related to electric-pneumatic servo control, and discloses a control method for enhancing robust interference resistance of a voice coil motor direct drive system. S1, establishing a kinetic equation, a model error and a state equation of the voice coil motor direct drive system; s2, the lumped interference is expanded into an additional state variable to update the state equation, an expanded state anti-interference observer and conditions met by estimation errors of the expanded state anti-interference observer are set on the basis of the updated state equation, and estimation of the lumped interference is calculated through the expanded state anti-interference observer; and S3, a tracking error signal and an auxiliary error signal are set, and a robust anti-interference enhancing controller is constructed to compensate the estimation of the lumped interference and the difference value of the lumped error, so that the control of the voice coil motor direct drive system is realized. According to the invention, the selection limitation of the robust gain parameter is reduced, and the control precision and robustness of the system are ensured under the condition that the system is subjected to strong interference.



1.一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,其特征在于,该方法包括下列步骤:

S1建立音圈电机直驱系统的动力学方程、模型误差和状态方程;

S2将集总干扰拓展为额外的状态变量更新所述状态方程,在该更新后的状态方程的基础上设定拓展状态抗干扰观测器和其估计误差满足的条件,利用该抗拓展状态抗干扰观测器计算集总干扰的估计;

S3设定跟踪误差和辅助误差信号,构建增强鲁棒抗干扰的控制器对集总干扰的估计和集总误差的差值进行补偿,以此实现对音圈电机直驱系统的控制。

2.如权利要求1所述的一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,其特征在于,在步骤S1中,所述动力学方程按照下列关系式进行:

其中,m为被驱动部分总质量(包括阀芯质量、音圈电机质量和中间直连机构的质量之和),xsv为阀芯的实际位移,Fe为电机的驱动力,Ftg为瞬态气动力,Fsg为稳态气动力,Ff为系统所受的摩擦力,Fi为内部扰动(驱动信号的波动等),Fud为未知的干扰,Bv为粘性阻尼系数,t表示时间。

3.如权利要求2所述的一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,其特征在于,在步骤S1中,所述模型误差按照下列关系式进行:

其中,m为未知的被驱动部分准确总质量、Ke为未知的准确音圈电机参数、R为未知的音圈电机准确等效电阻值和Bv为未知的准确系统阻尼系数,m0为已知的被驱动部分准确的总质量、Ke0为已知的音圈电机参数、R0为已知的音圈电机等效电阻值、Bv0为已知的系统阻尼系数,Δm为被驱动部分已知总质量与未知准确总质量之间的差值、ΔKe为已知音圈电机参数与未知准确音圈电机参数之间的差值、ΔR为已知的音圈电机等效电阻值与未知音圈电机等效电阻值之间的差值和ΔBv为已知系统阻尼系数与未知的准确系统阻尼系数之间的差值。

4.如权利要求3所述的一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,其特征在于,在步骤S1中,所述状态方程按照下列关系式进行:

其中,u为系统输入,系统状态变量x1和x2表示为系统阻尼参数a1、和增益参数b0

集总干扰Ftd表示为:

Fd=Ftg+Fsg+Ff+Fi+Fud

其中:m为未知的被驱动部分准确总质量,m0为已知的被驱动部分准确的总质量,Ke0为已知的音圈电机参数、R0为已知的音圈电机等效电阻值、Bv0为已知的系统阻尼系数,Ke为未知的准确音圈电机参数、R为未知的音圈电机准确等效电阻值,Bv为未知的准确系统阻尼系数,u为音圈电机的输入电压,Ftg为瞬态气动力,Fsg为稳态气动力,Ff为系统所受的摩擦力,Fi为内部扰动(驱动信号的波动等),Fud为未知的干扰,Fd为外部总干扰。

5.如权利要求1或4所述的一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,其特征在于,在步骤S2中,所述更新后的状态方程按照下列关系式:

其中,u为系统输入,和为系统状态变量x1、系统状态变量x2和系统状态变量x3的变化速度,a1为已知系统阻尼参数,b0为已知增益参数,为伺服阀位移的加速度,为伺服阀位移的速度,Ftd=f为集总干扰,为集总干扰的变化速度。

6.如权利要求5所述的一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,其特征在于,在步骤S2中,所述抗拓展状态抗干扰观测器按照下列关系式进行:

其中,观测器估计矩阵z=[z1 z2 z3]T,z1,z2,z3为拓展状态观测器输出的观测估计值,它们分别对应伺服阀位移xsv,伺服阀位移的速度集总干扰f,a1为系统阻尼,b0为已知增益参数,A为系统状态矩阵,B为观测器增益矩阵,C为观测器输出矩阵;L为拓展状态观测器需要设计的反馈矩阵,其包含了系统阻尼a1和观测器带宽w0

7.如权利要求6所述的一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,其特征在于,在步骤S2中,所述误差估计满足的条件如下:

当观测器带宽w0满足时ESO的估计误差有界且其上界存在,即其中,φ1为ESO对系统状态和外部干扰估计误差的最大值,λmax(P)为中间矩阵变量P的最大特征值,Mf-1表示集总干扰f变化速度的最大值,w0为观测器带宽(观测器参数),a1为已知系统阻尼参数。

8.如权利要求1或4所述的一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,其特征在于,在步骤S3中,所述跟踪误差和辅助误差信号按照下列关系进行:

ec1=xd-xsv

其中,xd为目标指令,为速度目标指令,xsv为伺服阀位移,为伺服阀的运动速度,α和kr为控制器参数,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,为高压电-气伺服阀实际运动速度与目标实际运动速度之间的差值,ec2为修正后的高压电-气伺服阀运动速度差值,为修正高压电-气伺服阀运动加速度差值,r为修正高压电-气伺服阀速度差值ec2与其修正加速度差值之和的辅助中间变量。

9.如权利要求8所述的一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,其特征在于,所述增强鲁棒抗干扰的控制器按照下列关系式进行:

其中,k1,k2,k3,kr为控制器参数;b0为已知增益参数;α和β均为控制器参数且为正实数,sgn(ec2)为ec2的标准符号函数,tanh(k3ec1)是ec1的双曲正切函数,ec1为高压电-气伺服阀实际位移与目标位移之间的差值,ec2表示修正高压电-气伺服阀运动速度差值,z3为拓展状态抗干扰观测器输出的集总干扰估计值。

10.如权利要求9所述的一种音圈电机直驱系统增强鲁棒抗干扰的控制方法,其特征在于,所述控制参数β满足下列关系式:

β≥γ11(ec2)且

其中,γ1和γ2为中间变量,χ1(ec2)和χ2(ec1)为发明中所提出的参数选择限制函数,kr为控制器参数。