为了解决刀架在横梁位置变化所引起的立柱两边等效惯量的变化破坏输出的动态同步性能,采用负载动态补偿方法调整比例增益,使两电机保持同步。近年来,智能控制发展十分迅速,特别是模糊控制不完全依赖对象的数学模型,适于对具有不确定性的系统和非线性系统进行控制,有利于解决许多经典控制难以解决的问题。本文引入模糊pid控制器作为速度调节器,有效的利用了模糊控制的优点,从而提高了同步控制精度。
龙门移动式镗铣床的结构及耦合
图1 直线电机驱动的龙门移动式镗铣床结构
图1是双直线电机驱动的龙门移动式镗铣床结构示意图。两台直线电机分别驱动两个立柱,一个控制回路的输入通过机械耦合作用影响另一个控制回路的输出,任一单回路的干扰,不仅影响本回路的输出,也会通过横梁影响另一回路的输出,即干扰互相耦合,两台驱动电机输出端存在机械耦合。
直线永磁伺服电机(lpmsm)数学模型
lpmsm的d-q轴模型电压方程及磁链方程为:
(1)
式中,rs为动子电阻;ud,uq,id,iq,ld,lq,分别为d、q轴动子电压、电流、电感和磁链; 为动子速度; 为极距;为定子永磁体励磁磁链。
对lpmsm进行矢量控制,使动子电流矢量与定子永磁体磁场在空间正交,即使id=0,则:
式中,rs为动子电阻;ud,uq,id,iq,ld,lq,分别为d、q轴动子电压、电流、电感和磁链; 为动子速度; 为极距;为定子永磁体励磁磁链。
对lpmsm进行矢量控制,使动子电流矢量与定子永磁体磁场在空间正交,即使id=0,则:
(2)
其中,kt为推力系数
运动方程
其中,kt为推力系数
运动方程
(3)
其中fl为负载阻力;fe为端部效应产生的等效阻力;d为粘滞摩擦系数;m为动子及其所带负载的质量。
其中fl为负载阻力;fe为端部效应产生的等效阻力;d为粘滞摩擦系数;m为动子及其所带负载的质量。
系统的控制结构
在龙门移动式镗铣床的同步伺服系统中,两个伺服子系统按同一速度给定信号运动,定义其中一个伺服系统为主动轴,另一个为从动轴,就构成了独立的主—从驱动方式。通过对直线电机进行推力控制,使两轴保持同步。本文采用主从控制结构,仅对主动电机使用位置控制。主动电机的位置控制器输出当作从动电机的速度命令信号,当主动电机受到外界干扰产生位置反馈的变化,从动电机的参考速度与主动电机的参考速度一样也随之变化,这样将提高控制系统耦合结构的安全系数。同步控制系统结构原理图如图2所示。其中,p2为位置前馈控制器;p1为位置比例控制器;模糊pid控制器为速度控制器,以实现对输入信号的快速精确响应;pi控制器对动态变形力补偿,防止高速运行下,过大的双轴同步误差对系统造成危害。
图2 同步控制系统结构原理图
负载动态补偿设计
当龙门移动式镗铣加工中心实现二维运动控制时,y轴直线电机驱动的刀架位置变化往往会导致x轴直线电机等效惯量的改变,其中,从动电机由于不具有独立的定位控制,容易受到等效惯量的改变而影响输出,进而影响两个x轴的输出同步。这就要求采用负载动态补偿的方法,调整比例增益并给x轴从动电机以控制补偿,使得系统能够保持同步运行。当电机等效惯量增加的时候,它的电流输入与速度输出之间的传递函数将会产生变化,即。负载动态补偿的原理正是利用一个权重调整电流输入与速度输出间的传递函数,使其保持
的恒定关系,则。即为负载动态调变增益。其中w只是一个比例值,可定义为1。设计w`只需要求得△m即可。如图3所示,定义长度e、f、g、h、及诸质量重心m1、m2、m3和a、b两点。利用力矩平衡原理可以计算出b点承受结构(含m1、m2)等效质量△m的大小。
通过负载动态调变增益的补偿,即使从动电机等效惯量产生变化,其速度输出影响也不会因此受到影响,使系统仍维持良好的同步响应。
图3 力矩平衡示意图
模糊pid控制器的设计
根据模糊控制理论设计模糊控制器。定义系统误差|e|和误差的变化率|ec|作为模糊控制器的输入量,其中
e=yd-y (4)
(5)
kp,ki,kd为输出,即此模糊控制器为两输入三输出形式。输入语言变量 和 的论域均为{-6, -5, -4, -3, -2, -l, 0, l, 2, 3, 4, 5, 6},输出语言变量kp,ki,kd的论域均为{ 0, l, 2, 3, 4, 5, 6}。通过总结以往工程实际操作经验得到e、ec的隶属度函数和pid参数kp,ki,kd的控制规则表。并设计出模糊pid控制器。kp,ki,kd的控制规则如表1-3所示:
系统的仿真
采用两台参数完全相同的直线电机进行仿真研究,参数如下:
m=11.0kg
d=2.0n.s/m
kt=27.5n/a
fe=200n
控制器参数:p1=12、p2=1、pi=0.0583+0.213/s。当时间为0.5s时,在x轴输入幅值为0.4m的阶跃信号为位置信号。针对y轴负载重心的变化,本研究以负载动态补偿消除从动电机因为等效惯量的变化而造成的影响,并加上模糊pid控制器进行调节。图4为无负载动态补偿和模糊pid控制时系统的位置误差响应曲线,图5为加入负载动态补偿和模糊pid控制之后的位置误差响应曲线,可以看出模糊pid控制和负载动态补偿的加入大大提高了两直线电机的同步精度。
图4 无负载动态补偿和模糊pid控制的位置误差响应曲线
图5 有负载动态补偿和模糊pid控制后位置误差响应曲线
结语
本文在分析龙门移动式镗铣床中双直线电机驱动的x轴上两直线电机间不同步的主要原因的基础上,提出了模糊pid和负载动态补偿的控制方法。由仿真曲线可以看到,模糊pid控制和负载动态补偿的加入大大提高了两直线电机的同步精度。