[发明专利]由自动伺服控制器控制的电脑横机的防抖动控制方法

摘要

本发明公开了一种由自动伺服控制器控制的电脑横机的防抖动控制方法，首先对伺服电机加速度控制，对加速度的上升斜率和下降斜率进行限制，使加速度不产生阶跃；低速时伺服电机加减速控制，保证机头在低速时具有良好的机械性能；而在高速减速时进行加快减速处理，其在伺服控制器中增加一个减速前馈，在PI调节器中增加减速前馈处理标志，当速度大于某一值时并且在进行减速时，设置该标志位，由PI调节器根据减速前馈标志来增加相应的减速前馈；同时对输入伺服控制器的速度指令进行可变频率的低通滤波控制，使输入信号平滑并减少干扰；本方法减少了电脑横机在作往复运动过程中的抖动，增加了机头的调头反应速度，提高了电脑横机运行的稳定性和可靠性。

主权项

一种由自动伺服控制器控制的电脑横机的防抖动控制方法，其特征在于本方法包括如下步骤：步骤一、对电脑横机的伺服电机加速度控制，对加速度的上升斜率和下降斜率进行限制，使加速度不产生阶跃，保证机头在加减速运动时的加速度是一个可控的理想曲线，在控制系统中设定当前的速度给定与上一次速度给定之差不大于C1，当V2-V2(n-1)＞C1     则V2(n)＝V2(n-1)+C1当V2-V2(n-1)＜-C1    则V2(n)＝V2(n-1)-C1式中：V2为电脑横机当前的速度给定，V2(n)为伺服控制器当前的速度设定，V2(n-1)为伺服控制器上一次的速度设定，C1为根据电脑横机设定的一个常数；步骤二、电脑横机低速时，伺服电机加减速控制，保证机头在低速时具有良好的机械性能，当速度低于某一值时，计算此时的最大加减速度差，用该最大加减速度差对电脑横机速度进行限幅，当电脑横机速度的绝对值小于V1时，速度差C2＝V2*V2/C3式中：V2为电脑横机当前速度，C3为根据控制系统设定的常数，V1为根据控制系统设置的速度常量，当电脑横机速度的绝对值大于等于V1时，C2为根据控制系统和伺服电机速度设定的常量，根据上述所得C2，计算出伺服控制器当前的速度设定当V3-V3(n-1)＞C2     则V3(n)＝V3(n-1)+C2当V3-V3(n-1)＜-C2    则V3(n)＝V3(n-1)-C2式中：V3为电脑横机当前的速度给定，V3(n)为伺服控制器当前的速度设定，V3(n-1)为伺服控制器上一次的速度设定；步骤三、当电脑横机高速减速时进行加快减速处理，在伺服控制器中增加一个减速前馈，在PI调节器中增加减速前馈处理标志，当速度大于某一值时并且在进行减速时，设置该标志位，由PI调节器根据减速前馈标志来增加相应的减速前馈，当伺服控制器的速度反馈Vfbk大于V1时并且电机减速时，设定运算开关量Flag＝1，则伺服控制器速度环的速度输出V4(n)设定为：V4(n)＝V4(n-1)+Kp*(E-E0)+Ki*E+k2*(V4-V4(n-1))当伺服控制器的速度反馈Vfbk小于等于V1时或Vfbk大于V1且电机不减速时，设定运算开关量Flag＝0，则伺服控制器速度环的速度输出V4(n)设定为：V4(n)＝V4(n-1)+Kp*(E-E0)+Ki*E+k1*(V4-V4(n-1))上述两式中：V4为电脑主机通过脉冲给伺服控制器的频率速度给定，E＝V4-Vfbk，E0为E的上一次值，Kp和Ki为积分器常量，K1和K2为前馈比例因子，V4(n-1)为伺服控制器速度环的上一次速度输出设定；步骤四、对输入伺服控制器的速度指令进行可变频率的低通滤波控制，使输入信号平滑，减少外部信号干扰和传输干扰，当电脑横机速度低于某一个值时，对低通滤波的低通频率进行变化，改变低通滤波器的通过频率，减缓电脑横机低速或转向调头时的启动振动，当伺服控制器的速度反馈Vfbk大于等于C时，C为系统设定的一个速度常量，设定伺服控制器速度环的速度输出V5(n)为：V5(n)＝Ka*V5+Kb*V5(n-1)式中Ka和Kb为常数，V5为电脑主机通过脉冲给伺服控制器的频率速度给定，V5(n-1)为伺服控制器速度环的上一次速度输出设定；当伺服控制器的速度反馈Vfbk小于C时，C为系统设定的一个速度常量，，设定伺服控制器速度环的速度输出V5(n)为：V5(n)＝Kc*V5+(1-Kc)*V5(n-1)式中：Kc＝K3+abs(Vfbk)*K4(K3，K4为常数，abs()为取绝对数函数)V5为电脑主机通过脉冲给伺服控制器的频率速度给定，V5(n-1)为伺服控制器速度环的上一次速度输出设定。