专利名称：一种交流位置伺服系统中干扰的观测和补偿方法
技术领域：
本发明涉及三相异步电机伺服系统，特别涉及矢量控制交流伺服系统中干扰的观测和补偿方法。
背景技术：
在交流位置伺服系统中，干扰是造成系统伺服性能下降的主要因素，必须加以抑制。在位置伺服系统中，干扰主要有以下几个来源(1)辨识得到的名义模型与实际被控对象间的误差、机电伺服系统建模过程忽略的结构性不确定因素；(2)系统在运行过程中受到的诸如负载突变、工作环境变化等外部干扰；(3)由静摩擦和库仑摩擦(非线性摩擦)引起的负载力矩干扰等。
在传统控制系统中，通常采用PID控制方法对上述干扰加以抑制，但这种方法存在对负载变化的适应能力差、抗干扰能力弱和易受系统参数变化影响等弱点。由于积分环节的存在，PID和PI对交变干扰的抑制效果不好，对静摩擦又会出现极限环和低速爬行等。如果采用单纯的PD控制，对阶跃干扰又会存在静差，无法实现精确的位置控制。
发明内容
本发明要解决的技术问题在于，针对现有技术的上述缺陷，提供一种交流位置伺服系统中干扰观测和补偿的方法，对系统中诸如负载突变、模型不确定性和非线性摩擦等干扰进行抑制，提高系统的抗干扰能力和鲁棒性。
本发明解决其技术问题所采用的技术方案是包括采用干扰观测器(DOB)结合PID控制方法对系统中存在的干扰进行抑制，伺服系统采用位置环和电流环的双闭环结构，在位置环内面向电流环设计干扰观测器(DOB)，电流环控制器采用PI控制，位置环采用PD控制。
本发明的有益效果是，本发明采用了干扰观测器(DOB)结合PID可对交流位置伺服系统中的干扰加以抑制，干扰观测器(DOB)具有响应快和可独立调整的特点，能有效抑制干扰，且对系统参数变化具有较强的鲁棒性，无需额外的力或力矩传感器，在设计时可选择阶次、相对阶次和低通滤波器带宽等参数，实现简单，方法灵活，易于控制。
下面结合附图和具体实施方式
对本发明作进一步详细说明。
图1为干扰观测器的基本结构框图。
图2为干扰观测器的等价结构框图。
图3为矢量控制的双闭环位置伺服系统结构框图。
图4为简化后的电流闭环原理框图。
图5为简化后的位置闭环原理框图。
图6为采用面向电流环DOB的双闭环位置伺服系统结构框图。
具体实施例方式
如图1所示，P(s)表示实际系统，Pn(s)表示名义模型，u为系统的外部输入，d为干扰项， 为d的估计值，ξ为测量噪声，Q(s)为低通滤波器，其相对阶次大于或等于Pn(s)的相对阶次。DOB把实际系统输出与名义模型输出的差异作为一个等效的干扰，应用于名义模型。它估计出等效的干扰，并将其作为补偿信号反馈到输入端。
为了理解基于干扰观测器的整个系统的原理，首先可令Q(s)＝1，得到δ^=d^=(1-Pn(s)P(s))u+1P(s)ξ+d.]]>理想条件下，Pn(s)与P(s)相等，则输出可表示为y=P(s)(u-d^+d)=Pn(s)u-ξ.]]>从图2可以看出，y＝Guy(s)u+Gdy(s)d+Gxy(s)ξ，其中Guy=P(s)Pn(s)Pn(s)+(P(s)-Pn(s))Q,]]>Gdy=P(s)Pn(s)(1-Q(s))Pn(s)+(P(s)-Pn(s))Q,]]>Gxy=P(s)Q(s)Pn(s)+(P(s)-Pn(s))Q(s).]]>从上述的方程中，我们可以看出干扰观测器的设计主要依靠Q(s)，它是决定系统鲁棒性和抗干扰能力的重要参数。
如果Q(s)≈1，可以得到Guy≈Pn，Gdy≈0，Gxy≈-1，表明干扰观测器使得实际系统与名义模型相似，同时增强了控制系统的鲁棒性。如果Q(s)≈0，可以得到Guy≈P Gdy≈P Gxy≈0，表明此时系统接近于开环，没有反馈环节，也就没有测量噪声的存在。
综上所述，滤波器Q(s)的设计原则是(1)为使系统能够对干扰进行实时补偿，Q(s)的低频动态特性应该接近于1，使得在DOB的动态过程结束后，δ^≈d^≈d;]]>(2)为抑制测量噪声，应使Q(s)的高频动态特性接近于零，使系统在高频段表现出开环系统的特征。因此Q(s)是低通滤波器。
为了使低通滤波器Q(s)与名义模型的逆组合成Q(s)Pn-1(s)，物理上可实现，同时为了抑制高频的测量噪声，可将图1等价变形成图2所示的形式。
如图3所示，本发明方法设计了由位置环和电流环组成的双闭环位置伺服系统，采用矢量控制原理对三相异步电机进行位置控制。由图3可以看到，电流环分为力矩电流环和励磁电流环，这两个环在控制方式上是相同的。
(1)电流环的设计图4为简化后的电流闭环原理框图。电流环采用PI控制，其控制器用传递函数表示为Gi(s)=Kp_crt+Ki_crts,]]>图中a_crt=1Tel,b_crt=1Tel·Rs,]]>Tel为电机的电气时间常数，Rs为电机的定子电阻。由此可以知道，电流闭环的传递函数即可以表示为G_crt(s)=Kp_crtb_crts+Ki_crtb_crts2+(a_crt+Kp_crtb_crt)s+Ki_crtb_crt,]]>如果令ω_crt表示期望的电流环自然频率，ξ_crt表示期望的电流环阻尼比，由二阶系统的特性ω_crt2＝Ki_crtb_crt和2ω_crtξ_crt＝a_crt+Kp_crtb_crt，选择合适的自然频率和阻尼比，即可得到电流环控制器的两个参数Ki_crt=ω_crt2b_crt]]>和Kp_crt=2ω_crtξ_crt-a_crtb_crt.]]>(2)位置环的设计在设计时，要保证电流环的带宽远远大于位置环的带宽，此时整个电流环的响应时间将远远小于外环的响应时间，在分析时即可将实际力矩电流等同于参考电流，即iq＝iq_ref。
异步电机的运动方程为Jdωdt++Bnpω=Te-TL=Kiq-TL,]]>其中J为电机轴的转动惯量与折算到电机轴上的负载转动惯量之和；B为电机轴的粘性阻尼系数与折算到电机轴上的负载粘性阻尼系数之和；np为电机的极对数；Te为电磁转矩；K为力矩常数；TL为负载力矩，可以视为系统的一个未知干扰。故异步电机调速系统中，从净转矩到转速为一阶惯性环节，用传递函数可表示为G_crt(s)=Ω(s)Iq_ref=KJs+B.]]>为了表达方便，写成G_crt(s)=b_spds+a_spd,]]>其中a_spd＝B/J＝0，b_spd＝K/J。
将速度闭环G_crt(s)=b_spds+a_spd]]>作为被控对象，把测得的速度信号进行积分，然后反馈到位置给定端，即构成了位置闭环，此时位置控制器的输出即为速度控制器的输入。图5为简化后的位置闭环原理框图，位置环采用PD控制，其控制器用传递函数表示为Gθ(s)＝Kp_pos+Kd_poss，则整个双闭环位置伺服系统的传递函数为G_pos(s)=Kd_posb_spds+Kp_posb_spds2+(a_spd+b_spdKd_pos)s+Kp_posb_spd.]]>同样的，令ω_pos表示期望的双闭环系统的自然频率，ξ_pos表示期望的双闭环系统的阻尼比，根据二阶系统的特性ω_pos2＝Kp_posb_spd和2ω_posξ_pos＝a_spd+Kd_posb_spd，选择合适的自然频率和阻尼比，即可得到位置控制器的两个参数Kp_pos=ω_pos2b_spd]]>和Kd_pos=2ω_posξ_pos-a_spdb_spd.]]>(3)干扰观测器的设计在位置环内面向电流闭环设计干扰观测器，其原理图如图6所示。被控对象为图4所示的电流闭环，用P(s)表示，对应的名义模型用Pn(s)来表示；Q(s)表示低通滤波器；θ_ref，θ，ω，d分别表示位置给定值、实际位置输出、电机转速和干扰项。干扰项包括建模时参数的不确定性以及非线性摩擦和负载变化等外部干扰。
在双闭环的位置伺服系统中，设计DOB时，将电流环视为被控对象，它可以简化为一阶惯性环节，此时名义模型的传递函数可以写为Pn(s)=b_spds+a_spd.]]>根据滤波器Q(s)的设计原则，Q(s)应尽可能选择较低阶次，而为了保证Q(s)物理可实现，其相对阶次又必须大于等于被控系统的相对阶次，综合考虑，本设计中选择一阶低通滤波器Q(s)=1τs+1,]]>其中，τ为滤波器的时间常数，大小为位置环采样时间的10倍。
权利要求
1.一种交流位置伺服系统中干扰的观测和补偿方法，包括采用干扰观测器(DOB)结合PID控制方法对系统中存在的干扰进行抑制，其特征是伺服系统采用位置环和电流环的双闭环结构，在位置环内面向电流环设计干扰观测器(DOB)，电流环控制器采用PI控制，位置环采用PD控制。
2.根据权利要求1所述的一种交流位置伺服系统中干扰的观测和补偿方法，其特征是所述电流环的带宽远大于位置环的带宽，整个电流环的响应时间远小于位置环的响应时间。
3.根据权利要求2所述的一种交流位置伺服系统中干扰的观测和补偿方法，其特征是电流环分为力矩电流环和励磁电流环，这两个环都采用PI控制方式。
4.根据权利要求1所述的一种交流位置伺服系统中干扰的观测和补偿方法，其特征是所述干扰观测器包括将名义模型Pn(s)部分接入实际系统P(s)部分、低通滤波器Q(s)一端连接输入端、另一端连接名义模型Pn(s)部分，低通滤波器Q(s)的相对阶次大于或等于名义模型Pn(s)的相对阶次，将实际系统P(s)输出与名义模型Pn(s)输出的差异作为一个等效的干扰，应用于名义模型Pn(s)，可估计出等效的干扰，并将其作为补偿信号反馈到输入端。
5.根据权利要求4所述的一种交流位置伺服系统中干扰的观测和补偿方法，其特征是将低通滤波器Q(s)的低频动态特性设计为接近于1，可使伺服系统对干扰进行实时补偿；将低通滤波器Q(s)的高频动态特性设计为接近于零，使伺服系统在高频段表现出开环系统的特征，抑制系统的测量噪声。
全文摘要
本发明公开了一种三相异步电机矢量控制伺服系统中干扰的观测和补偿方法，包括采用干扰观测器(DOB)结合PID控制方法对系统中存在的干扰进行抑制，伺服系统采用位置环和电流环的双闭环结构，在位置环内面向电流环设计干扰观测器(DOB)，电流环控制器采用PI控制，位置环采用PD控制，本发明可对交流位置伺服系统中的干扰加以抑制，干扰观测器(DOB)具有响应快和可独立调整的特点，能有效抑制干扰，且对系统参数变化具有较强的鲁棒性，无需额外的力或力矩传感器，在设计时可选择阶次、相对阶次和低通滤波器带宽等参数，实现简单，方法灵活，易于控制。
文档编号G05B11/42GK101078910SQ200710024700
公开日2007年11月28日 申请日期2007年6月27日 优先权日2007年6月27日
发明者王永秀, 梅志千, 李向国, 高敏 申请人:河海大学常州校区