[发明专利]多轴插补方法

说明书

技术领域

本发明涉及数控机器的插补方法技术领域，尤其是涉及运动机器的多轴插补方法。

背景技术

工业机器人实时插补是工业机器人运动核心技术之一，工业机器人的位置控制，通常采用示教再现的方法，即让机器人记住之前示教过的位置点，然后再重复这些位置点，因此，示教的位置点数越多，机器人运动越精确，但效率越低。为了解决这一问题，引入了工业机器人实时插补方法。

工业机器人实时插补方法包括空间直线插补、平面圆弧插补、空间圆弧插补，其方法的优劣直接影响工业机器人执行精度和效率，并且对工业机器人运动轨迹规划有很大的影响。工业机器人通常需要多轴、多关节联动，而多轴、多关节联动算法涉及到多坐标轴系统，属于高科技范畴，算法非常复杂，并且国外对我国技术上是封锁的，目前国内对于如何建立多坐标轴系统研究不多，由于算法复杂，难以应用到实际的工业机器人开发中，并且算法执行效率低、精度差，因此，如何找到一种既简单又高效的多坐标轴插补实现方法，成为了很重要的科研命题。

当前，运动控制领域，插补运算是一种常用的运算，一般采用逐点比较法或数字积分法，通常FPGA或专用运动控制来实现，价格高，实现3轴以上的插补较为困难，随着微电子技术的发展，ARM，DSP器件的主频越来越高，价格越来越低，分时插补的时间周期会越来越小，低成本，高性能的插补运算方案成为可能。

发明内容

为了克服现有技术的不足，本发明的目的是提供一种实现快速、低成本、高效率的多轴插补方法。

为了解决上述的技术问题，本发明提出的基本技术方案为：一种多轴插补方法，包括基于ARM或者DSP芯片的计数器、脉冲发生器和或门，所述或门连接连接所述计数器和脉冲发生器；通过计数器、脉冲发生器和或门实现脉冲发生的控制，具体步骤如下：

S1：插补软件根据输入的控制指令计算得到轨迹轮廓数据；

S2：将轨迹轮廓数据转化为多轴直线插补控制指令或者多轴螺旋插补控制指令；

S3：多轴直线插补控制指令或者多轴圆弧插补控制指令传输到脉冲发生器，由脉冲发送器发出脉冲信号，脉冲信号和计数器的设定信号匹配，经过或门最终将该脉冲信号输出；

S4：输出的脉冲信号传输到相应的伺服驱动器从而带动各电机实现多轴插补运动控制。

进一步的，本发明所述的多轴插补方法中，脉冲信号的插补周期为4轴125μs或者8轴250μs。

进一步的，本发明所述的多轴插补方法中，脉冲发生器的频率大于最大插补脉冲频率。

进一步的，本发明所述的多轴插补方法中，在直线插补时将直线长度作为各轴的参照量，在螺旋插补时将总弧长作为各轴参照量。

进一步的，本发明所述的多轴插补方法中，在进行插补处理之前要进行加减速处理。

进一步的，本发明所述的多轴插补方法，所述加减速处理包括如下步骤，

A1：求得减速点；

A2：若当前位置的速度大于减速点的速度则做减速处理并以此求解下一段坐标位置；若当前位置的速度大于设定最高速度则做匀速处理。

A3：求下一段的位置。

进一步的，加减速处理具体计算如下，

减速点为：

Ld=(Ci2-L2)×T2H-L]]>

当并且C_i＜H时，加速运动，下一周期速度：