CN103801973A - 基于伺服刀架控制器的伺服电机的优化控制方法 - Google Patents

Abstract

本发明涉及基于伺服刀架控制器的伺服电机的优化控制方法，包括以下步骤：伺服刀架控制器自动生成伺服刀架的最短换刀路径，将该路径作为伺服电机带动刀盘旋转的所需的转位位移，利用速度规划算法得到换刀过程中伺服电机任意时刻的速度及位移，将位移作为伺服电机给定值进行位置闭环控制，带动刀盘进行转位换刀动作；在刀盘转位换刀动作时，采用扭矩输出分时控制算法限定伺服刀架控制器的扭矩输出，使伺服电机控制刀盘完成转位动作。本发明简化上位机刀架控制逻辑的编程难度；缩短了换刀过程的时间，有助于提高换刀效率；有效地解决了电机过流的问题，保护了设备；显著提高了设备的利用率和使用寿命。

Description

基于伺服刀架控制器的伺服电机的优化控制方法

技术领域

本发明属于数控刀架控制领域，特别涉及一种基于伺服刀架控制器的伺服电机的优化控制算法。

背景技术

伺服刀架是机床的高档功能性附件,此类刀架与传统的液压刀架相比具有可靠性高、转位快、刚性好、结构简单、运行平稳等特点。由于国内针对伺服刀架的研发起步要比国外晚，因此在转位时间、转位精度等技术品质上，我国的伺服刀架与世界先进水平相比，仍存在很大的差距，国内还鲜有成熟的针对伺服刀架的专业伺服产品系列，目前国内主流的刀架控制方案有两种：1.以普通伺服为主体，伺服刀架的选刀、定位、锁紧等动作通过数控系统来控制，数控系统将刀位转换成给伺服驱动器的指令脉冲数，来驱动伺服电机带动伺服刀架旋转；2.以普通伺服为主体，外加一个单片机，单片机接收上位机发送的目标刀位等信息，再将目标刀位转换成给伺服驱动器的指令脉冲数，从而驱动伺服电机带动伺服刀架旋转。上述两种控制方案的不足之处在于额外占用系统资源，无端的增加了成本，降低了设备的可靠性。

伺服刀架在锁紧的过程中，由于机械制作工艺、定位精度等原因有时会出现定位销的头部与上刀体的销孔之间存在些许的偏差，使得伺服刀架在锁紧的过程中定位销不能完全被压入销孔中，此时机械力会将定位销强制性地压入到销孔，由于此时电机仍处于通电状态，这样会导致电机出现过流现象，严重的甚至会损坏电机和伺服刀架控制器。

随着先进制造业的发展，机床对数控刀架转位换刀的效率要求越来越高，而要实现快速转位换刀，就必须要面临的一个问题就是在启停的过程中对机械的冲击。传统的刀架控制器对位置的控制方式常用的大都是直线加减速控制、指数加减速控制、S曲线加减速控制，上述控制方式虽然一定程度上解决了启停过程中对机械的冲击问题，但是仍无法解决提高换刀效率和降低机械启停冲击的矛盾，即要想降低机械启停冲击，就无法最大程度的提高换刀效率；要想提高换刀效率，就无法保障最大程度的降低机械启停冲击，尤其是在小惯量电机带动大惯量负载的情况下，伴随着机械启停冲击会出现伺服电机过流的现象。

发明内容

为了克服上述现有技术的缺点与不足，本发明提供了一种基于伺服刀架控制器的伺服电机的优化控制算法，本发明为实现上述目的所采用的技术方案是：

基于伺服刀架控制器的伺服电机的优化控制方法，包括以下步骤：

伺服刀架控制器接收到上位机换刀指令后，自动生成伺服刀架的最短换刀路径，将该路径作为伺服电机带动刀盘旋转的所需的转位位移，利用速度规划算法得到换刀过程中伺服电机任意时刻的速度及位移，将位移作为伺服电机给定值进行位置闭环控制，带动刀盘进行转位换刀动作；

在刀盘转位换刀动作时，采用扭矩输出分时控制算法限定伺服刀架控制器的扭矩输出，伺服刀架控制器将该扭矩输出至伺服电机控制刀盘完成转位动作。

所述自动生成伺服刀架最短换刀路径包括以下步骤：

伺服刀架控制器接收到上位机换刀指令后，将其转换为目标刀号n₁；将目标刀号n₁与当前刀号n₂作差，得到差值e₁；

将刀盘总刀位数n₃与e₁的绝对值|e₁|作差，得到差值e₂；判断|e₁|与e₂的大小关系：若|e₁|大于e₂，则换刀过程所需转过的刀位数

若|e₁|小于等于e₂，则换刀过程所需转过的刀位数e₃＝e₁；

根据

得到转位位移；如果总转位位移s为正，表示电机正转，如果s为负，表示电机反转；其中，m为伺服刀架减速机减速比，encoder为伺服电机编码器线数。

所述速度规划算法采用多段式曲线加减速算法包括以下步骤：

将伺服电机运动过程中的转速随时间变化的加减速曲线分成加速段、匀速段和减速段；加速段和减速段分别分割成多段形状相似但加速度变化率不同的曲线段；其中，加速段中的每个曲线段包括加加速段和减加速段；减速段中的每个曲线段包括加减速段和减减速段；

根据加减速曲线建立由各曲线段组成的数学模型；将自动生成伺服刀架的最短换刀路径与各曲线段的速度指标参数代入该数学模型中，得到伺服电机在各加加速段、减加速段、匀速段、加减速段和减减速段的运行时间；然后将各参数和得到的运行时间再代入上述数学模型中，即得到换刀过程中任意时刻的速度和位移。

所述各曲线段的速度指标参数包括：

加速段的各曲线段中加加速段的加速度变化率依次为JA₁、JA₂、……JA_n+1，减加速段的加速度变化率与对应的加加速段的加速度变化率互为相反数；

减速段的各曲线段中减减速段的加速度变化率依次为JD₁、JD₂、……JD_m+1，加减速段的加速度变化率与对应的减减速段的加速度变化率互为相反数；

加减速曲线的初始速度值为V_s，加减速曲线的末速度值为V_e，匀速段速度为整个加减速曲线最大速度值V_max，加速段中各曲线段的最大速度值依次为VA₁、VA₂……VA_n+1，减速段中各曲线段的最大速度值依次为VD₁、VD₂、VD_m+1。

所述扭矩输出分时控制算法包括以下步骤：

判断当前时刻伺服刀架控制器是否完成转位换刀动作；若处于转位换刀动作状态，则伺服刀架控制器将最大允许扭矩输出输出至伺服电机控制刀盘转位到目标位置；若转位换刀动作结束，则将伺服刀架控制器的扭矩输出保持在自保护范围内输出至伺服电机控制刀盘保持目标位置不动，直至伺服刀架控制器发出刀盘锁紧命令。

所述数学模型为

其中，S(t)为伺服刀架控制器在换刀过程中任意时刻的位移，TA₁、TA₂分别为伺服电机在各加加速段的运行时间，各减加速段运行时间与对应的加加速段的运行时间相等；TD₁、TD₂分别为伺服电机在各减减速段的运行时间，各加减速段运行时间与对应的减减速段的运行时间相等；匀速过程时间为T_y。

本发明具有以下有益效果及优点：

1.本发明控制接口简单方便，简化上位机刀架控制逻辑的编程难度，上位机只需向伺服刀架控制器发送一组换刀指令即可，不需要做任何其他的工作；伺服刀架控制器接收到上位机换刀指令后，能够自动将其转换出目标刀号并按转位路径最短的原则计算出伺服电机的转位位移，进而完成伺服刀架的松开、转位、锁紧功能，不额外占用上位机的任何资源，也省去了单片机计算单元部分，从而节约了成本，同时也提高了设备的可靠性。

2.本发明有效地解决了锁紧刀盘的过程中由于机械制作工艺、定位精度等原因引起的电机过流的问题，从而有效地保护了设备。

3.本发明在保证高换刀效率的同时，最大程度的降低了机械启停冲击，消除了小惯量电机带动大惯量负载在启停过程中产生过流的现象，显著提高了设备的利用率和使用寿命。

4.本发明通过引入自动生成伺服刀架最短换刀路径算法，使得伺服刀架控制器控制接口简单方便，简化上位机刀架控制逻辑的编程难度；为刀架转位换刀提供了一种最短的路径，在一定程度上减少了电力资源的浪费，缩短了换刀过程的时间，有助于提高换刀效率。

5.本发明通过扭矩输出分时控制算法有效地解决了上述锁紧刀盘的过程中由于机械制作工艺、定位精度等原因引起的电机过流的问题，从而有效地保护了设备。

6.本发明通过引入多段式曲线加减速算法，实现了在保证高换刀效率的同时，最大程度的降低了机械启停冲击，消除了小惯量电机带动大惯量负载在启停过程中产生过流的现象，显著提高了设备的利用率和使用寿命。

附图说明

图1为本发明的伺服刀架控制器的工作流程示意图；

图2为本发明的自动生成伺服刀架最短换刀路径算法流程图；

图3为本发明的扭矩输出分时控制算法的结构框图；

图4为本发明的多段式曲线加减速算法的原理图。

具体实施方式

下面结合附图及实施例对本发明做进一步的详细说明。

本发明提供了一种基于伺服刀架控制器的伺服电机的优化控制算法，其主要包含三个部分：（1）自动生成伺服刀架最短换刀路径算法，即在伺服刀架控制器接收到上位机换刀指令后，将其转换为目标刀号，根据预先配置的伺服刀架减速机的减速比以及伺服电机编码器线数，按转位路径最短的原则计算出伺服电机的转位位移；（2）扭矩输出分时控制算法，即在转位换刀动作状态，伺服刀架控制器将最大允许扭矩输出输出至伺服电机控制刀盘转位到目标位置；在转位换刀动作结束后，将伺服刀架控制器的扭矩输出保持在自保护范围内输出至伺服电机控制刀盘保持目标位置不动，直至伺服刀架控制器发出刀盘锁紧命令；（3）多段式曲线加减速算法，即将伺服电机运动过程中的转速随时间变化的加减速曲线分成加速段、匀速段和减速段；加速段和减速段分割成多段形状相似但加速度变化率不同的曲线段；其中，加速段中的每个曲线段包括加加速段和减加速段；减速段中的每个曲线段包括加减速段和减减速段。

上述加加速段是指曲线中加速度为正值同时加速度的变化率也为正值的部分，减加速段是指曲线中加速度为正值同时加速度的变化率为负值的部分，加减速段是指曲线中加速度为负值同时加速度的变化率也为负值的部分，减减速段是指曲线中加速度为负值同时加速度的变化率为正值的部分，匀速段是指曲线中加速度为零同时加速度的变化率也为零的部分。

所述自动生成伺服刀架最短换刀路径算法为在伺服刀架控制器接收到上位机换刀指令后，能够自动将其转换为目标刀号，根据预先配置的伺服刀架减速机的减速比以及伺服电机编码器线数，按转位路径最短的原则计算出伺服电机的转位位移。

所述扭矩输出分时控制算法为在转位换刀动作状态，伺服刀架控制器将最大允许扭矩输出输出至伺服电机控制刀盘转位到目标位置；在转位换刀动作结束后，将伺服刀架控制器的扭矩输出保持在自保护范围内输出至伺服电机控制刀盘保持目标位置不动，直至伺服刀架控制器发出刀盘锁紧命令；

所述多段式曲线加减速算法为将伺服电机运动过程中的转速随时间变化的加减速曲线分成加速段、匀速段和减速段；加速段和减速段分割成多段形状相似但加速度变化率不同的曲线段；其中，加速段中的每个曲线段包括加加速段和减加速段；减速段中的每个曲线段包括加减速段和减减速段；其具体形状如图4中的下图所示。

伺服刀架控制器工作流程如图1所示，上位机只需发送换刀指令信号，不需要任何其他的计算过程，即可完成换刀动作。具体过程如下：当上位机（或CNC系统）发出换刀指令后，伺服刀架控制器进行逻辑运算处理，按自动生成伺服刀架最短换刀路径算法计算出伺服电机的转位位移；伺服刀架控制器发出刀盘松开信号控制液压电磁阀转位，实现刀盘松开动作；当伺服刀架控制器检测到刀盘松开动作完成信号后，伺服刀架控制器采用位置、速度、电流三闭环全数字控制方式控制伺服电机转位；当伺服电机转位完成后，伺服刀架控制器发出刀盘锁紧信号控制液压电磁阀转位，实现刀盘锁紧动作；当伺服刀架控制器检测到锁紧动作完成信号后，伺服刀架控制器向上位机（或CNC系统）发送换刀动作完成信号以及当前的工位号；如果检测到报警，伺服刀架控制器立即将报警信息上传给上位机(或CNC系统)。

上述方法使得控制接口简单方便，简化上位机刀架控制逻辑的编程难度，上位机只需向伺服刀架控制器发送一组换刀指令信号即可，不需要做任何其他的工作；伺服电机控制板接收到上位机换刀指令信号后，能够自动将其转换为目标刀号并按转位路径最短的原则计算出伺服电机的转位位移，进而完成伺服刀架的松开、转位、锁紧操作，不额外占用上位机的任何资源，也省去了单片机计算单元部分，从而节约了成本，同时也提高了设备的可靠性。

自动生成伺服刀架最短换刀路径算法流程如图2所示，所述算法如下：

(1)伺服刀架控制器接收到上位机换刀指令信号后，自动将其转换为目标刀号n₁。

(2)将目标刀号n₁与当前刀号n₂作差，得到差值e₁。

(3)将刀盘总刀位数n₃与上步得到的差值的绝对值|e₁|作差，得到差值e₂。

(4)判断|e₁|与e₂的大小关系：

①|e₁|大于e₂：则换刀过程所需转过的刀位数

②|e₁|小于等于e₂：则换刀过程所需转过的刀位数e₃＝e₁；

(5)根据(4)中的计算结果e₃，伺服刀架减速机减速比m，以及伺服电机编码器线数encoder，可得转位位移

其单位为脉冲指令单位，如果总转位位移s为正，表示电机正转，如果s为负，表示电机反转。

通过引入自动生成伺服刀架最短换刀路径算法，使得伺服刀架控制器控制接口简单方便，简化上位机刀架控制逻辑的编程难度；为刀架转位换刀提供了一种最短的路径，在一定程度上减少了电力资源的浪费，缩短了换刀过程的时间，有助于提高换刀效率。

伺服刀架在锁紧的过程中，由于机械制作工艺、定位精度等原因有时会出现定位销的头部与上刀体的销孔之间会有些许的偏差，使得伺服刀架在锁紧的过程中定位销不能完全被压入销孔中，此时机械力会将定位销强制性地压入到销孔，由于此时电机还处于通电状态，这样就会使电机出现过流的现象，严重的甚至损坏电机和伺服刀架控制器。针对上述问题，本发明提出一种扭矩输出分时控制算法,其结构如图3所示，判断当前时刻伺服刀架控制器是否完成转位换刀动作；若处于转位换刀动作状态，则伺服刀架控制器将最大允许扭矩输出输出至伺服电机控制刀盘转位到目标位置；若转位换刀动作结束，则将伺服刀架控制器的扭矩输出保持在自保护范围内输出至伺服电机控制刀盘保持目标位置不动，直至伺服刀架控制器发出刀盘锁紧命令。

通过扭矩输出分时控制算法有效地解决了上述锁紧刀盘的过程中由于机械制作工艺、定位精度等原因引起的电机过流的问题，从而有效地保护了设备。

多段式曲线加减速算法原理如图4所示，其上图为加减速曲线算法中加速度随时间的变化规律，其下图为加减速曲线算法中速度随时间的变化规律，所述算法如下：

设S为总位移，V为加减速曲线速度值，a为加减速曲线加速度值；JA₁、JA₂、……JA_n+1依次为加速段的各曲线段中加加速段的加速度变化率，其为一恒值；减加速段的加速度变化率与对应的加加速段的加速度变化率互为相反数；JD₁、JD₂、……JD_m+1依次为减速段的各曲线段中减减速段的加速度变化率，其为一恒值；加减速段的加速度变化率与对应的减减速段的加速度变化率互为相反数；V_s为加减速曲线的初始速度值，V_e为加减速曲线的末速度值；V_max为匀速段速度值，同时也是整个加减速曲线最大速度值；VA₁、VA₂……VA_n+1依次为加速段中各曲线段的最大速度值，VD₁、VD₂……VD_m+1依次为减速段中各曲线段的最大速度值；其中TA₁、TA₂……TA_n+1为伺服电机在各加加速段的运行时间，各减加速段运行时间与对应的加加速段的运行时间相等；TD₁……TD_m+1分别为伺服电机在各减减速段的运行时间，各加减速段运行时间与对应的减减速段的运行时间相等；匀速过程时间为T_y。

下面以n＝1，m＝1为例，建立多段式加减速曲线的数学模型：

各段曲线段加速度公式如下：

(1)

各段曲线段速度公式如下：

各段曲线段位移公式如下：

由式(1)、(2)、(3)可知，已知初始速度值V_s、末速度值V_e，设定加速段的各曲线段中加加速段的加速度变化率JA₁、JA₂,减加速段的加速度变化率与对应的加加速段的加速度变化率互为相反数；减速段的各曲线段中减减速段的加速度变化率JD₁、JD₂,加减速段的加速度变化率与对应的减减速段的加速度变化率互为相反数；加减速曲线的最大速度V_max、加速段中各曲线段的最大速度值VA₁，减速段中各曲线段的最大速度值VD₁，进而确定TA₁、TA₂、T_y、TD₁、TD₂。确定了这五个参数也就确定了加速度、速度、位移三条曲线，于是问题就转化为求TA₁、TA₂、T_y、TD₁、TD₂。以下分两种情况求解TA₁、TA₂、T_y、TD₁、TD₂。

(一)假设伺服电机转位的总位移S≥S(2TA₁+2TA₂+T_y+2TD₁+2TD₂)，即速度曲线包含匀速段区，则由式(2)可得

${\mathrm{VA}}_1=V_s+{\mathrm{JA}}_1{\mathrm{TA}}_1^2---\left(4\right)$

则

${\mathrm{TA}}_1=\sqrt{\frac{{\mathrm{VA}}_1-V_s}{{\mathrm{JA}}_1}}$

$V_{\max }={\mathrm{VA}}_1+{\mathrm{JA}}_2{\mathrm{TA}}_2^2---\left(5\right)$

则

${\mathrm{TA}}_2=\sqrt{\frac{V_{\max }-{\mathrm{VA}}_1}{{\mathrm{JA}}_2}}$

${\mathrm{VD}}_1=V_{\max }-{\mathrm{JD}}_1{\mathrm{TD}}_1^2---\left(6\right)$

则

${\mathrm{TD}}_1=\sqrt{\frac{V_{\max }-{\mathrm{VD}}_1}{{\mathrm{JD}}_1}}$

${\mathrm{VD}}_1={\mathrm{JD}}_2{\mathrm{TD}}_2^2+V_e---\left(7\right)$

则

${\mathrm{TD}}_2=\sqrt{\frac{{\mathrm{VD}}_1-V_e}{{\mathrm{JD}}_2}}$

由式(3)得：

当t＝2TA₁+2TA₂+T_y+2TD₁+2TD₂时，

$S\left(t\right)=(V_s+{\mathrm{JA}}_1{\mathrm{TA}}_1^2+{\mathrm{JA}}_2{\mathrm{TA}}_2^2-{\mathrm{JD}}_1{\mathrm{TD}}_1^2-{\mathrm{JD}}_2{\mathrm{TD}}_2^2)({2\mathrm{TA}}_1+{2\mathrm{TA}}_2+T_y+{2\mathrm{TD}}_1+{2\mathrm{TD}}_2)$

$-{\mathrm{JA}}_1{\mathrm{TA}}_1^3-{\mathrm{JA}}_2{\mathrm{TA}}_2^3-{2\mathrm{JA}}_2{\mathrm{TA}}_2^2{\mathrm{TA}}_1+{\mathrm{JD}}_1{\mathrm{TD}}_1^2({2\mathrm{TA}}_1+{2\mathrm{TA}}_2+T_y+{\mathrm{TD}}_1)$

$+{\mathrm{JD}}_2{\mathrm{TD}}_2^2({2\mathrm{TA}}_1+{2\mathrm{TA}}_2+T_y+{2\mathrm{TD}}_1+{\mathrm{TD}}_2)$

(8)

将由式(4)-(7)所得计算结果带入式(8)得：

$T_y=\frac{S\left(t\right)-(V_s+{\mathrm{VA}}_1)\sqrt{\frac{{\mathrm{VA}}_1-V_s}{{\mathrm{JA}}_1}}-(V_{\max }+{\mathrm{VA}}_1)\sqrt{\frac{V_{\max }-{\mathrm{VA}}_1}{{\mathrm{JA}}_2}}-(V_{\max }+{\mathrm{VD}}_1)\sqrt{\frac{V_{\max }-{\mathrm{VD}}_1}{{\mathrm{JD}}_1}}-(V_e+{\mathrm{VD}}_1)\sqrt{\frac{{\mathrm{VD}}_1-V_e}{{\mathrm{JD}}_2}}}{V_{\max }}---\left(9\right)$

将伺服电机旋转过程的总位移代入式(9)中的S(t)，即可得到匀速段时间T_y，若此时求得的T_y>=0，则说明上述假设成立，即加减速曲线包含匀速区，且各段时间求解完全按照式(4)、(5)、(6)、(7)、(9)求解即可。

(二)若按(一)中的方式所求T_y值为负值，则说明此时加减速曲线中不包含匀速段，即T_y＝0；并且电机实际最大速度值达不到选取值V_max，假设此种情况电机实际速度最大值为V_max1，则由式(2)可得：

${\mathrm{VA}}_1=V_s+{\mathrm{JA}}_1{\mathrm{TA}}_1^2---\left(10\right)$

则

${\mathrm{TA}}_1=\sqrt{\frac{{\mathrm{VA}}_1-V_s}{{\mathrm{JA}}_1}}$

$V_{\max 1}={\mathrm{VA}}_1+{\mathrm{JA}}_2{\mathrm{TA}}_2^2---\left(11\right)$

${\mathrm{VD}}_1=V_{\max 1}-{\mathrm{JD}}_1{\mathrm{TD}}_1^2---\left(12\right)$

则

${\mathrm{TD}}_1=\sqrt{\frac{V_{\max 1}-{\mathrm{VD}}_1}{{\mathrm{JD}}_1}}=\sqrt{\frac{{\mathrm{VA}}_1-{\mathrm{VD}}_1+{\mathrm{JA}}_2{\mathrm{TA}}_2^2}{{\mathrm{JD}}_1}}$

${\mathrm{VD}}_1-V_e={\mathrm{JD}}_2{\mathrm{TD}}_2^2---\left(13\right)$

则

${\mathrm{TD}}_2=\sqrt{\frac{{\mathrm{VD}}_1-V_e}{{\mathrm{JD}}_2}}$

由式(3)得：

当t＝2TA₁+2TA₂+T_y+2TD₁+2TD₂时，

$S\left(t\right)=(V_s+{\mathrm{JA}}_1{\mathrm{TA}}_1^2+{\mathrm{JA}}_2{\mathrm{TA}}_2^2-{\mathrm{JD}}_1{\mathrm{TD}}_1^2-{\mathrm{JD}}_2{\mathrm{TD}}_2^2)({2\mathrm{TA}}_1+{2\mathrm{TA}}_2+T_y+{2\mathrm{TD}}_1+{2\mathrm{TD}}_2)$

$-{\mathrm{JA}}_1{\mathrm{TA}}_1^3-{\mathrm{JA}}_2{\mathrm{TA}}_2^3-{2\mathrm{JA}}_2{\mathrm{TA}}_2^2{\mathrm{TA}}_1+{\mathrm{JD}}_1{\mathrm{TD}}_1^2({2\mathrm{TA}}_1+{2\mathrm{TA}}_2+T_y+{\mathrm{TD}}_1)$

$+{\mathrm{JD}}_2{\mathrm{TD}}_2^2({2\mathrm{TA}}_1+{2\mathrm{TA}}_2+T_y+{2\mathrm{TD}}_1+{\mathrm{TD}}_2)---\left(14\right)$

将式(10)-(13)所得计算结果，带入式(14)得

当t＝2TA₁+2TA₂+T_y+2TD₁+2TD₂时，

$S\left(t\right)=(V_s+{\mathrm{VA}}_1)\sqrt{\frac{{\mathrm{VA}}_1-V_s}{{\mathrm{JA}}_1}}+(V_e+{\mathrm{VD}}_1)\sqrt{\frac{{\mathrm{VD}}_1-V_e}{{\mathrm{JD}}_2}}+{2\mathrm{VA}}_1{\mathrm{TA}}_2+{\mathrm{JA}}_2{\mathrm{TA}}_2^3$

$+({\mathrm{VA}}_1+{\mathrm{VD}}_1+{\mathrm{JA}}_2{\mathrm{TA}}_2^2)\sqrt{\frac{{\mathrm{VA}}_1-{\mathrm{VD}}_1+{\mathrm{JA}}_2{\mathrm{TA}}_2^2}{{\mathrm{JD}}_1}}---\left(15\right)$

将上式中TA₂作为自变量，则S(t)可以看做关于TA₂的函数，且相对于TA₂∈[0，+∞)为单调递增函数，由式(5)得TA₂取值上限为

①当VA₁>VD₁时，TA₂下限为0，则其取值范围为

因此，若伺服电机转位的总位移:

$S\≥(V_s+{\mathrm{VA}}_1)\sqrt{\frac{{\mathrm{VA}}_1-V_s}{{\mathrm{JA}}_1}}+(V_e+{\mathrm{VD}}_1)\sqrt{\frac{{\mathrm{VD}}_1-V_e}{{\mathrm{JD}}_2}}+({\mathrm{VA}}_1+{\mathrm{VD}}_1)\sqrt{\frac{{\mathrm{VA}}_1-{\mathrm{VD}}_1}{{\mathrm{JD}}_1}},$ 则TA₂存在有效解，采用二分法对式(15)求解TA₂，将求得的TA₂代入式(12)即可求得TD₁。

②当VA₁≤VD₁时，由于TD₁>=0才有实际意义，因此由式(12)可得，TA₂下限为

则其取值范围为

因此，若伺服电机转位的总位移:

$S\≥(V_s+{\mathrm{VA}}_1)\sqrt{\frac{{\mathrm{VA}}_1-V_s}{{\mathrm{JA}}_1}}+(V_e+{\mathrm{VD}}_1)\sqrt{\frac{{\mathrm{VD}}_1-V_e}{{\mathrm{JD}}_2}}+({\mathrm{VA}}_1+{\mathrm{VD}}_1)\sqrt{\frac{{\mathrm{VD}}_1-{\mathrm{VA}}_1}{{\mathrm{JA}}_2}},$ 则TA₂存在有效解，采用二分法对式(15)求解TA₂，将求得的TA₂代入式(12)即可求得TD₁。

③如果上述两种情况都不满足，则说明参数VA₁、VD₁、V_max的配置不合理，需要重新调整上述三个参数，例如可以将参数VA₁、VD₁、V_max按比例减小或只将参数VA₁、VD₁按比例减小，之后再重新对加减速曲线模型进行计算，直至满足上述的两种情况之一为止。

Claims (6)

1.基于伺服刀架控制器的伺服电机的优化控制方法，其特征在于包括以下步骤：

伺服刀架控制器接收到上位机换刀指令后，自动生成伺服刀架的最短换刀路径，将该路径作为伺服电机带动刀盘旋转的所需的转位位移，利用速度规划算法得到换刀过程中伺服电机任意时刻的速度及位移，将位移作为伺服电机给定值进行位置闭环控制，带动刀盘进行转位换刀动作；

在刀盘转位换刀动作时，采用扭矩输出分时控制算法限定伺服刀架控制器的扭矩输出，伺服刀架控制器将该扭矩输出至伺服电机控制刀盘完成转位动作。

2.根据权利要求1所述的基于伺服刀架控制器的伺服电机的优化控制方法，其特征在于：

所述自动生成伺服刀架最短换刀路径包括以下步骤：

伺服刀架控制器接收到上位机换刀指令后，将其转换为目标刀号n₁；将目标刀号n₁与当前刀号n₂作差，得到差值e₁；

将刀盘总刀位数n₃与e₁的绝对值|e₁|作差，得到差值e₂；判断|e₁|与e₂的大小关系：若|e₁|大于e₂，则换刀过程所需转过的刀位数

若|e₁|小于等于e₂，则换刀过程所需转过的刀位数e₃＝e₁；

根据得到转位位移；如果总转位位移s为正，表示电机正转，如果s为负，表示电机反转；其中，m为伺服刀架减速机减速比，encoder为伺服电机编码器线数。

3.根据权利要求1所述的基于伺服刀架控制器的伺服电机的优化控制方法，其特征在于：

所述速度规划算法采用多段式曲线加减速算法包括以下步骤：

将伺服电机运动过程中的转速随时间变化的加减速曲线分成加速段、匀速段和减速段；加速段和减速段分别分割成多段形状相似但加速度变化率不同的曲线段；其中，加速段中的每个曲线段包括加加速段和减加速段；减速段中的每个曲线段包括加减速段和减减速段；

根据加减速曲线建立由各曲线段组成的数学模型；将自动生成伺服刀架的最短换刀路径与各曲线段的速度指标参数代入该数学模型中，得到伺服电机在各加加速段、减加速段、匀速段、加减速段和减减速段的运行时间；然后将各参数和得到的运行时间再代入上述数学模型中，即得到换刀过程中任意时刻的速度和位移。

4.根据权利要求1所述的基于伺服刀架控制器的伺服电机的优化控制方法，其特征在于：

所述各曲线段的速度指标参数包括：

加速段的各曲线段中加加速段的加速度变化率依次为JA₁、JA₂、……JA_n+1，减加速段的加速度变化率与对应的加加速段的加速度变化率互为相反数；

减速段的各曲线段中减减速段的加速度变化率依次为JD₁、JD₂、……JD_m+1，加减速段的加速度变化率与对应的减减速段的加速度变化率互为相反数；

加减速曲线的初始速度值为V_s，加减速曲线的末速度值为V_e，匀速段速度为整个加减速曲线最大速度值V_max，加速段中各曲线段的最大速度值依次为VA₁、VA₂……VA_n+1，减速段中各曲线段的最大速度值依次为VD₁、VD₂、VD_m+1。

5.根据权利要求1所述的基于伺服刀架控制器的伺服电机的优化控制方法，其特征在于：

所述扭矩输出分时控制算法包括以下步骤：

判断当前时刻伺服刀架控制器是否完成转位换刀动作；若处于转位换刀动作状态，则伺服刀架控制器将最大允许扭矩输出输出至伺服电机控制刀盘转位到目标位置；若转位换刀动作结束，则将伺服刀架控制器的扭矩输出保持在自保护范围内输出至伺服电机控制刀盘保持目标位置不动，直至伺服刀架控制器发出刀盘锁紧命令。

6.根据权利要求1所述的基于伺服刀架控制器的伺服电机的优化控制方法，其特征在于：

所述数学模型为

其中，S(t)为伺服刀架控制器在换刀过程中任意时刻的位移，TA₁、TA₂分别为伺服电机在各加加速段的运行时间，各减加速段运行时间与对应的加加速段的运行时间相等；TD₁、TD₂分别为伺服电机在各减减速段的运行时间，各加减速段运行时间与对应的减减速段的运行时间相等；匀速过程时间为T_y。

Images