一种基于嵌入式裁床控制器的多轴联动运动控制方法技术

一种基于嵌入式裁床控制器的多轴联动运动控制方法，包括以下步骤：1)求得加速度表、速度表、阶梯步长表、裁床允许的最大加速度以及最大非抬刀旋转角度；2)连续线段的速度规划以及加减速过程如下：计算各个拐点处的最大速度、目标速度及C轴所需要旋转的角度；3)在拐点处转刀时，若拐角Δθi小于θ，采用直接转刀方式；若Δθi大于θ，采用转角抬刀方式；4)裁割轨迹为连续小线段时，拐点处转刀采用三轴联动方式。本发明专利技术提供了一种能有效减少裁床抖动、提升裁床稳定性和裁割精度的基于嵌入式裁床控制器的多轴联动运动控制方法。

【技术实现步骤摘要】

本专利技术涉及一种运动控制方法，尤其是一种基于嵌入式裁床控制器的多轴联动运动控制方法，属于运动控制领域。
技术介绍
目前我国服装，鞋子、床上用品、等相关产业发展迅速，用于对布料、皮革等原材料裁割的裁床种类繁多。传统自动化程度低、功能单一、控制精度低的裁床逐渐被淘汰，自动化程度较高、多功能、高精度的新型裁床受到越来越广泛的关注。裁床主要是由伺服电机(分别为X轴、Y轴和C轴以及D轴伺服电机)、X轴导轨、Y轴导轨、移动横梁、传动带、裁割机头、机头刀具、复位信号传感器等组成。裁床控制器根据上位机下发的轨迹文件，通过控制X轴和Y轴伺服电机，带动横梁上的裁割机头及机头刀具沿X轴导轨和Y轴导轨进行平面运动；通过C轴伺服电机控制机头刀具的旋转，使机头刀具的方向随着机头运动方向的改变而改变；通过D轴伺服电机控制机头刀具的抬落，从而完成轨迹文件的裁割操作。然而，以伺服电机为控制对象的嵌入式裁床控制器在高速运行及裁割连续小线段时仍然存在着控制精度较低、抖动比较严重等问题。这不仅会影响裁床生产出的产品的质量，而且会降低裁床使用寿命。
技术实现思路
为了解决现有嵌入式裁床控制器在高速运行及裁割连续小线段时存在的抖动比较严重、稳定性较差、精度不高等问题，本专利技术提供了一种能有效减少裁床抖动、提升裁床稳定性和裁割精度的基于嵌入式裁床控制器的多轴联动运动控制方法。本专利技术解决其技术问题所采用的技术方案如下：一种基于嵌入式裁床控制器的多轴联动运动控制方法，所述方法包括以下步骤：1)求得加速度表、速度表、阶梯步长表、裁床允许的最大加速度以及最大非抬刀旋转角度采用S曲线型加减速控制算法，得到控制裁床X轴和Y轴伺服电机运动的加速度表(a1,...,aj)；然后根据所用X轴和Y轴伺服电机的速度特性建立X轴和Y轴伺服电机运动所需的速度表(v1，...，vj)；伺服电机每一次的速度变化都需要运行一定步数作缓冲，不同速度下所需要运行的缓冲步数也不同，结合伺服电机的运动特性计算出对应的阶梯步长表(l1,...,lj)；根据裁床机械结构特性及X轴和Y轴伺服电机参数，通过调试确定裁床工作所允许的最大加速度amax；上位机下发的轨迹文件由离散后的坐标点组成，相邻坐标点相连形成的密集线段即为裁床所需运行的轨迹，相邻线段之间的点称为拐点；在拐点处转刀时，若C轴所需旋转角度比预设角度小，采用直接转刀方式，在到达拐点处时通过C轴伺服电机直接控制刀具旋转相应的角度；若所需旋转角度比预设角度大，C轴伺服电机控制刀具旋转时会引起裁床抖动从而降低裁床裁割精度，因此采用转角抬刀方式，此时将该拐点速度降为零并通过D轴伺服电机抬起刀具，将刀具旋转相应角度后再落下刀具继续裁割；根据裁床机械结构特性通过测试得出C轴所允许的最大非抬刀旋转角度θ；若裁割轨迹是连续小线段，则采用三轴联动方式，处理连续小线段的裁割过程；2)连续线段的速度规划以及加减速过程如下：n+1个坐标点(x0,y0),(x1,y1),...,(xn,yn)组成了n条线段；由相邻两个坐标点坐标，分别计算出n条线段与X轴方向的夹角θ1,θ2...,θn，由θ1,θ2...,θn分别计算得到各个拐点处C轴所需要旋转的角度即拐角Δθ1,...,Δθn-1；2.1)结合步骤1)中的加速度表(a1,...,aj)和速度表(v1，...，vj)，设裁床启动速度为vq并将起点和终点速度设为启动速度，在满足X轴方向和Y轴方向上速度变化不超过amax的条件下，计算得到在各个拐点处的最大速度(vx1,vy1)max,...,(vx(n-1),vy(n-1))max；2.2)采用速度回溯法计算得到各拐点目标速度，过程如下：将各个拐点处的最大速度(vx1,vy1)max,...,(vx(n-1),vy(n-1))max作为裁割轨迹上各个拐点的初始目标速度(v'x1,v'y1),...,(v'x(n-1),v'y(n-1))。设n-1点的初始目标速度的合速度为ν'n-1，终点n的速度的合速度为νn；根据步骤(1)中阶梯步长表从n点进行加速计算，算得运动到点n-1时的速度为(v″x(n-1),v″y(n-1))，合速度为ν″n-1。若满足ν'n-1＞ν″n-1，则选取(v″x(n-1),v″y(n-1))作为在n-1点的目标速度(vx(n-1),vy(n-1))；反之若ν'n-1≤ν″n-1，则将(v'x(n-1),v'y(n-1))作为在n-1点的目标速度(vx(n-1),vy(n-1))。以此类推，得到所有拐点的目标速度(vx1,vy1),...,(vx(n-1),vy(n-1))；2.3)采用定插补周期的插补方式，加减速过程如下：根据相邻两点坐标计算得到轨迹线段在X轴和Y轴上投影长度，选取较长的轴为插补计算的主轴，另一轴为副轴。结合两点目标速度、速度表和阶梯步长表可计算得到主轴加速、匀速、减速阶段所走的脉冲数N1、N2、N3。选择固定的插补周期T，计算主轴在第m个插补周期中所需的脉冲数并将其放入主轴脉冲缓冲区；然后根据主轴所需脉冲数计算得到副轴在第m个插补周期中所需脉冲数并将其放入副轴脉冲缓冲区。在计算下一个插补周期时，将此之前每一个插补周期主轴走的脉冲数之和与N1、N2、N3相比较，以确定下一个插补周期主轴所处的运动阶段。进一步，所述多轴联动运动控制方法还包括以下步骤：3)在拐点处转刀时，若拐角Δθi小于θ，采用直接转刀方式；若拐角Δθi大于θ，采用转角抬刀方式，过程如下：3.1)判断在某一拐点(xi,yi)处拐角Δθi的大小，在拐点处转刀时，若拐角Δθi小于θ，则在到达拐点处时采用直接转刀方式，通过C轴伺服电机直接控制刀具旋转相应的角度；若拐角Δθi大于θ，则在步骤(2)中将该拐点处的最大速度设为零，因此求得该拐点的目标速度(vxi,vyi)也为零；当裁床运行到拐点(xi,yi)时先通过D轴伺服电机将刀具抬起，再通过C轴伺服电机以速度vc驱动刀具旋转角度Δθi，最后通过D轴伺服电机驱动刀具落下继续裁割操作；3.2)采用直接转刀和转角抬刀方式时，C轴伺服电机在控制机头刀具旋转时根据伺服电机特性选择一固定速度即可；结合伺服电机特性并经过测试，得到C轴伺服电机在直接转刀和转角抬刀时的运行速度vc；在裁割过程中，D轴伺服电机控制刀具起落时，裁割机头运行速度为零，同样只需要根据伺服电机特性选择一固定速度vd即可。再进一步，所述多轴联动运动控制方法还包括以下步骤：4)当裁割轨迹为连续小线段时，在拐点处转刀采用三轴联动方式，过程如下：4.1)在对连续小线段裁割时，在步骤2)中对主轴和副轴进行插补计算的同时同步计算每个插补周期中C轴所需要旋转的角度及脉冲数，并将其放入C轴脉冲缓冲区，实现三轴联动插补，从而实现小线段的快速裁割。4.2)采用三轴联动方式时，C轴伺服电机跟随X轴和Y轴同步运动，需要根据X轴、Y轴在每个插补周期内的速度以及脉冲数和拐角大小计算出C轴在对应插补周期内的速度以及脉冲个数。本专利技术的优点在于：(1)根据S曲线型加减速控制算法，采用相应的加速度表、速度表以及阶梯步长表的速度控制方法，使裁床加减速过程中运行更加平稳高效；(2)采用回溯法计算到各拐点的目标速度，使得裁床在各拐点既能以较高的速度运行又能避免过切，速度规划更加的合理；(3)本文档来自技高网...

【技术保护点】
一种基于嵌入式裁床控制器的多轴联动运动控制方法，其特征在于：所述方法包括以下步骤：1)求得加速度表、速度表、阶梯步长表、裁床允许的最大加速度以及最大非抬刀旋转角度；采用S曲线型加减速控制算法，得到控制裁床X轴和Y轴伺服电机运动的加速度表(a1,...,aj)；然后根据所用X轴和Y轴伺服电机的速度特性建立X轴和Y轴伺服电机运动所需的速度表(v1,...,vj)；伺服电机每一次的速度变化都需要运行一定步数作缓冲，不同速度下所需要运行的缓冲步数也不同，结合伺服电机的运动特性计算出对应的阶梯步长表(l1,...,lj)；根据裁床机械结构特性及X轴和Y轴伺服电机参数，通过调试确定裁床工作所允许的最大加速度amax；上位机下发的轨迹文件由离散后的坐标点组成，相邻坐标点相连形成的密集线段即为裁床所需运行的轨迹，相邻线段之间的点称为拐点；在拐点处转刀时，若C轴所需旋转角度比预设角度小，采用直接转刀方式，在到达拐点处时通过C轴伺服电机直接控制刀具旋转相应的角度；若所需旋转角度比预设角度大，C轴伺服电机控制刀具旋转时会引起裁床抖动从而降低裁床裁割精度，因此采用转角抬刀方式，此时将该拐点速度降为零并通过D轴伺服电机抬起刀具，将刀具旋转相应角度后再落下刀具继续裁割；根据裁床机械结构特性通过测试得出C轴所允许的最大非抬刀旋转角度θ；若裁割轨迹是连续小线段，则采用三轴联动方式，处理连续小线段的裁割过程；2)连续线段的速度规划以及加减速过程如下：n+1个坐标点(x0,y0),(x1,y1),...,(xn,yn)组成了n条线段；由相邻两个坐标点坐标，分别计算出n条线段与X轴方向的夹角θ1,θ2...,θn，由θ1,θ2...,θn分别计算得到各个拐点处C轴所需要旋转的角度即拐角Δθ1,...,Δθn‑1；2.1)结合步骤1)中的加速度表(a1,...,aj)和速度表(v1,...,vj)，设裁床启动速度为vq并将起点和终点速度设为启动速度，在满足X轴方向和Y轴方向上速度变化不超过amax的条件下，计算得到在各个拐点处的最大速度(vx1,vy1)max,...,(vx(n‑1),vy(n‑1))max；2.2)采用速度回溯法计算得到各拐点目标速度，过程如下：将各个拐点处的最大速度(vx1,vy1)max,...,(vx(n‑1),vy(n‑1))max作为裁割轨迹上各个拐点的初始目标速度(v'x1,v'y1),...,(v'x(n‑1),v'y(n‑1))，设n‑1点的初始目标速度的合速度为ν'n‑1，终点n的速度的合速度为νn；根据步骤(1)中阶梯步长表从n点进行加速计算，算得运动到点n‑1时的速度为(v'x'(n‑1),v'y'(n‑1))，合速度为ν″n‑1，若满足ν'n‑1＞ν″n‑1，则选取(v″x(n‑1),v″y(n‑1))作为在n‑1点的目标速度(vx(n‑1),vy(n‑1))；反之若ν'n‑1≤ν″n‑1，则将(v'x(n‑1),v'y(n‑1))作为在n‑1点的目标速度(vx(n‑1),vy(n‑1))，以此类推，得到所有拐点的目标速度(vx1,vy1),...,(vx(n‑1),vy(n‑1))；2.3)采用定插补周期的插补方式，加减速过程如下：根据相邻两点坐标计算得到轨迹线段在X轴和Y轴上投影长度，选取较长的轴为插补计算的主轴，另一轴为副轴；结合两点目标速度、速度表和阶梯步长表可计算得到主轴加速、匀速、减速阶段所走的脉冲数N1、N2、N3，选择固定的插补周期T，计算主轴在第m个插补周期中所需的脉冲数并将其放入主轴脉冲缓冲区；然后根据主轴所需脉冲数计算得到副轴在第m个插补周期中所需脉冲数并将其放入副轴脉冲缓冲区，在计算下一个插补周期时，将此之前每一个插补周期主轴走的脉冲数之和与N1、N2、N3相比较，以确定下一个插补周期主轴所处的运动阶段。...

【技术特征摘要】
1.一种基于嵌入式裁床控制器的多轴联动运动控制方法，其特征在于：所述方法包括以下步骤：1)求得加速度表、速度表、阶梯步长表、裁床允许的最大加速度以及最大非抬刀旋转角度；采用S曲线型加减速控制算法，得到控制裁床X轴和Y轴伺服电机运动的加速度表(a1,...,aj)；然后根据所用X轴和Y轴伺服电机的速度特性建立X轴和Y轴伺服电机运动所需的速度表(v1,...,vj)；伺服电机每一次的速度变化都需要运行一定步数作缓冲，不同速度下所需要运行的缓冲步数也不同，结合伺服电机的运动特性计算出对应的阶梯步长表(l1,...,lj)；根据裁床机械结构特性及X轴和Y轴伺服电机参数，通过调试确定裁床工作所允许的最大加速度amax；上位机下发的轨迹文件由离散后的坐标点组成，相邻坐标点相连形成的密集线段即为裁床所需运行的轨迹，相邻线段之间的点称为拐点；在拐点处转刀时，若C轴所需旋转角度比预设角度小，采用直接转刀方式，在到达拐点处时通过C轴伺服电机直接控制刀具旋转相应的角度；若所需旋转角度比预设角度大，C轴伺服电机控制刀具旋转时会引起裁床抖动从而降低裁床裁割精度，因此采用转角抬刀方式，此时将该拐点速度降为零并通过D轴伺服电机抬起刀具，将刀具旋转相应角度后再落下刀具继续裁割；根据裁床机械结构特性通过测试得出C轴所允许的最大非抬刀旋转角度θ；若裁割轨迹是连续小线段，则采用三轴联动方式，处理连续小线段的裁割过程；2)连续线段的速度规划以及加减速过程如下：n+1个坐标点(x0,y0),(x1,y1),...,(xn,yn)组成了n条线段；由相邻两个坐标点坐标，分别计算出n条线段与X轴方向的夹角θ1,θ2...,θn，由θ1,θ2...,θn分别计算得到各个拐点处C轴所需要旋转的角度即拐角Δθ1,...,Δθn-1；2.1)结合步骤1)中的加速度表(a1,...,aj)和速度表(v1,...,vj)，设裁床启动速度为vq并将起点和终点速度设为启动速度，在满足X轴方向和Y轴方向上速度变化不超过amax的条件下，计算得到在各个拐点处的最大速度(vx1,vy1)max,...,(vx(n-1),vy(n-1))max；2.2)采用速度回溯法计算得到各拐点目标速度，过程如下：将各个拐点处的最大速度(vx1,vy1)max,...,(vx(n-1),vy(n-1))max作为裁割轨迹上各个拐点的初始目标速度(v'x1,v'y1),...,(v'x(n-1),v'y(n-1))，设n-1点的初始目标速度的合速度为ν'n-1，终点n的速度的合速度为νn；根据步骤(1)中阶梯步长表从n点进行加速计算，算得运动到点n-1时的速度为(v'x'(n-1),v'y'(n-1))，合速度为ν″n-1，若满足ν'n-1＞ν″n-1，则选取(v″x(n-1),v″y(n-1))作为在...

【专利技术属性】
技术研发人员：董辉，宋文超，江丽林，崔玉启，刘家林，
申请(专利权)人：义乌朝晖智能科技有限公司，
类型：发明
国别省市：浙江;33