[发明专利]一种基于嵌入式裁床控制器的多轴联动运动控制方法

摘要

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

主权项

一种基于嵌入式裁床控制器的多轴联动运动控制方法，其特征在于：所述方法包括以下步骤：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相比较，以确定下一个插补周期主轴所处的运动阶段。