阅读说明：本技术 一种基于扰动观测器的机械数控机床自身振动抑制方法 (Mechanical numerical control machine tool self-vibration suppression method based on disturbance observer ) 是由 顾贤 马继光 刘鹏 朱慧江 于 2020-12-21 设计创作，主要内容包括：本发明提出的一种基于扰动观测器的机械数控机床振动抑制控制方法,首先,永磁同步伺服电机驱动机床某部件后,通过给定转速ω-m～(ref)和编码器采集的电机实际转速ω-m,得到q轴电流的参考值i-q～*并给定d轴电流参考为0；再分别通过编码器和电流传感器得到的电角度θ与电机的三相定子电流i-s(k),从而计算得到q轴的定子电流分量i-q(k),进而可计算电机转矩T-e；确定选取的名义模型G-n(-s)和低通滤波器G-q(-s)结构,计算扭转力矩估计值T-c；再将其与经过低通滤波器之后的电机转矩输入减法器,得到力矩观测值T-(cc)；从而将观测值经过负反馈,进行力矩补偿,达到调节系统的等效惯量,以此实现机械数控机床振动抑制的目的。(The invention provides a mechanical numerical control machine tool vibration suppression control method based on a disturbance observer m ref And the actual rotating speed omega of the motor acquired by the encoder m Obtaining a reference value i of the q-axis current q * And giving the d-axis current reference as 0; and the electrical angle theta and the three-phase stator current i of the motor are obtained by an encoder and a current sensor respectively s (k) Thereby calculating the stator current component i of the q axis q (k) And further can calculate the motor torque T e (ii) a Determining a selected nominal model G n ( s ) And a low-pass filter G q ( s ) Structure for calculating estimated value T of torsional moment c (ii) a Then the sum is low-pass filteredThe motor torque after the device is input into a subtracter to obtain a torque observed value T cc (ii) a Therefore, the observed value is subjected to negative feedback to perform moment compensation, and the equivalent inertia of the system is adjusted, so that the aim of suppressing the vibration of the mechanical numerical control machine tool is fulfilled.)

一种基于扰动观测器的机械数控机床自身振动抑制方法

技术领域

本发明涉及一种基于扰动观测器的机械数控机床振动抑制控制方法，可应用于机械数控机床应用控制场合。

背景技术

数控机床是目前应用最广泛的机床之一，直接关系我国工业领域的发展，随着数控机床的不断更新和发展，原始的动力方式已经无法满足现在市场的需求，逐渐发展到现今的伺服系统。当前永磁同步伺服电机由于其优越的控制性能被越来越多的应用到数控机床进给系统中。为了控制机床位置的控制精准度，已经提出了基于视觉传导的传统自动控制方法，结合光电参数进行数控齿轮控制，准确修正齿轮转动惯量，但在加工过程中，仍易受到机床自身振动因素，如滑台振动的影响，不利于高精准度的要求。

针对这一问题，提出了一种基于扰动观测器的机械数控机床振动抑制控制方法。首先，永磁同步伺服电机驱动滑台后，将给定转速ω_m ^ref和编码器采集的电机实际转速ω_m之间的偏差量输入转速PI控制器，得到q轴电流的参考值i_q ^*并给定d轴电流参考i_d ^*＝0；再根据编码器中得到的电角度θ，通过电流传感器测量电机的三相定子电流i_s(k)，计算得到q轴的定子电流分量i_q(k)，进而可计算得到电机转矩T_e；选取名义模型G_n(_s)，确定低通滤波器G_q(_s)结构，得到扭转力矩估计值T_c；再将其与经过低通滤波器之后的电机转矩输入减法器，得到力矩观测值T_cc；再加入负载力矩补偿模块Q(s)和前向增益模块F(s)，调节系统的等效惯量，以此实现机械数控机床振动抑制的目的。

发明内容

技术问题：针对上述说明，提出的一种基于扰动观测器的机械数控机床自身振动抑制方法，达到机械振动抑制目的，从而实现数控机床高精准度的要求，振动抑制算法简单，易于在实际系统中实现。

技术方案：一种基于扰动观测器的机械数控机床振动抑制控制方法，包括如下步骤：首先，永磁同步伺服电机驱动机床某部件后，将给定转速ω_m ^ref和编码器采集的电机实际转速ω_m之间的偏差量输入转速PI控制器，得到q轴电流的参考值i_q ^*并给定d轴电流参考i_d ^*＝0；再根据编码器中得到的电角度θ，通过电流传感器测量电机的三相定子电流i_s(k)，计算得到q轴的定子电流分量i_q(k)，进而可计算得到电机转矩T_e；选取名义模型G_n(_s)，确定低通滤波器G_q(_s)结构，得到扭转力矩估计值T_c；再将其与经过低通滤波器之后的电机转矩输入减法器，得到力矩观测值T_cc；再加入负载力矩补偿模块Q(s)和前向增益模块F(s)，调节系统的等效惯量，以此实现机械数控机床振动抑制的目的。

作为优化，所述的q轴电流的参考值i_q ^*获取方法为：将参考转速ω_m ^ref与编码器所测得的实际转速ω_m之间的差值e_n输入如式(1)所示的转速PI控制器G_PI(s)，再经过式(2)所示的转矩给定值的等效低通滤波器G_f(s)，从而获得所述的q轴电流的参考值i_q ^*。

其中，k_p和k_i分别为转速PI控制器的比例增益和积分增益，s为复变量。

作为优化，所述的电机转矩T_e的计算方法为：从编码器中获取永磁同步电机的电角度θ，通过电流传感器测量电机的三相定子电流i_s(k)，经公式(3)的Clark变换后得到定子电流的αβ轴分量i_α(k)、i_β(k)，再经公式(4)的Park变换后得到k时刻定子电流的dq轴分量i_d(k)、i_q(k)，最后由式(5)可计算得到电机转矩T_e。

其中p_n表示极对数；ψ_f则表示永磁同步伺服电机永磁体磁链。

作为优化，所述的扭转力矩观测值T_cc获取方法为：选取名义模型G_n(_s)和低通滤波器G_q(_s)分别如式(6)和式(7)所示，通过式(8)得到扭转力矩估计值T_c，再将力矩估计值T_c与经过低通滤波器G_q(_s)之后的电机转矩输入减法器，得到力矩观测值T_cc。

式中J_m电机转轴的转动惯量。

式中T_q为滤波器的时间常数。

作为优化，所述的力矩补偿的实现方法为：将力矩观测值T_cc经过力矩补偿模块Q(s)后，与输入q轴电流的参考值i_q ^*的前向增益模块F(s)进入减法器，反馈至电机转矩，达到增加系统阻尼的目的，从而实现振动抑制的效果。

式中，K为反馈系数，

F(s)＝K(J_L+J_L/K) (11)。

有益效果：本发明是基于扰动观测器的机械振动抑制方法，从消除负载力矩对系统转速调节的影响的角度出发，将扭转力矩进行反馈，即将通过电机转矩与扭转力矩估计值所得的负载力矩进行反馈，补偿到电机转矩给定端，就能够使被控对象特性同刚性连接负载时一样，达到较好的转速响应，以此实现机械数控机床振动抑制的目的。

附图说明

图1为机械臂的柔性连杆系统模型图；

图2为一种基于扰动观测器的机械数控机床振动抑制方法控制框图；

图3为永磁同步伺服电机驱动等效机械臂的柔性关节后的三相电流波形及转速响应波形；

图4为应用振动抑制策略后的系统转速响应波形。

具体实施方式

下面结合附图并通过实施例对本发明作进一步的详细说明，以下实施例是对本发明的解释而本发明并不局限于以下实施例。

数控机床中永磁同步伺服电机驱动滑台的柔性连杆系统模型图如图1所示经过简化分析，可以将实际系统转变为一个电机-弹簧-负载的二质量系统。

如图2所示，本方法包括如下步骤：

步骤1：获取q轴电流的参考值i_q ^*：

将参考转速ω_m ^ref与编码器所测得的实际转速ω_m之间的差值e_n输入如式(1)所示的转速PI控制器G_PI(s)，再经过式(2)所示的转矩给定值的等效低通滤波器G_f(s)，从而获得所述的q轴电流的参考值i_q ^*。

其中，k_p和k_i分别为转速PI控制器的比例增益和积分增益，s为复变量。

步骤2：获取电机转矩T_e的方法：

从编码器中获取永磁同步电机的电角度θ，通过电流传感器测量电机的三相定子电流i_s(k)，经公式(3)的Clark变换后得到定子电流的αβ轴分量i_α(k)、i_β(k)，再经公式(4)的Park变换后得到k时刻定子电流的dq轴分量i_d(k)、i_q(k)，最后由式(5)可计算得到电机转矩T_e。

其中p_n表示极对数；ψ_f则表示永磁同步伺服电机永磁体磁链。

步骤3：获取扭转力矩观测值T_cc：

选取名义模型G_n(_s)和低通滤波器G_q(_s)分别如式(6)和式(7)所示，通过式(8)得到扭转力矩估计值T_c，再将力矩估计值T_c与经过低通滤波器G_q(_s)之后的电机转矩输入减法器，得到力矩观测值T_cc。

式中J_m电机转轴的转动惯量。

式中T_q为滤波器的时间常数。

步骤4：力矩补偿的实现方法：

将力矩观测值T_cc经过力矩补偿模块Q(s)后，与输入q轴电流的参考值i_q ^*的前向增益模块F(s)进入减法器，反馈至电机转矩，达到增加系统阻尼的目的，从而实现振动抑制的效果。

式中，K为反馈系数，

F(s)＝K(J_L+J_L/K) (11)

本发明方法首先，永磁同步伺服电机驱动滑台后，将给定转速ω_m ^ref和编码器采集的电机实际转速ω_m之间的偏差量输入转速PI控制器，得到q轴电流的参考值i_q ^*并给定d轴电流参考i_d ^*＝0；再根据编码器中得到的电角度θ，通过电流传感器测量电机的三相定子电流i_s(k)，计算得到q轴的定子电流分量i_q(k)，进而可计算得到电机转矩T_e；选取名义模型G_n(_s)，确定低通滤波器G_q(_s)结构，得到扭转力矩估计值T_c；再将其与经过低通滤波器之后的电机转矩输入减法器，得到力矩观测值T_cc；再加入负载力矩补偿模块Q(s)和前向增益模块F(s)，调节系统的等效惯量，以此实现机械数控机床振动抑制的目的。

永磁同步伺服电机驱动等效滑台的柔性关节后的三相电流波形及转速响应波形如图3所示，三相电流正弦度较好，而转速有明显的振荡现象，上升时间约为0.7s，超调σ％＝20.4％。图4为设置K＝0.3，T_q＝0.002时应用该控制策略后的系统转速波形，可以看出此时系统的抖动现象基本消除，上升时间减小为0.03s，基本无超调现象，体现了该控制策略的良好的振动抑制性能。

以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。