[发明专利]定位机器人运动轨迹的方法和装置

说明书

技术领域

本发明涉及半导体自动化加工领域，尤指一种工业机器人加减速运动控制中的定位机器人运动轨迹的方法和装置。

背景技术

在机器人控制领域内，如何能让电机按预期的轨迹平稳安全的运行是决定机器人性能的关键问题；控制器对驱动器脉冲发送的时间间隔控制是保证电机平稳运行的先决条件；插补计算是实现机器人高速、高精度轨迹控制的关键技术。

为使机器人能够按照预期的轨迹运行，其运动精度和定位精度能够达到预定的要求，避免由于控制系统、驱动系统以及机器人本体的电气和机械惯性，导致电机的速度突变，产生冲击、震荡、超调或失步等动态误差，造成系统精度降低等问题的出现。国内各大机器人生产企业，通常采取在机器人内部安装美国DALTA TAU Data System公司的PMAC(Programable Multi Axix Controller)控制器提供的PVT模式以产生光滑而精确的轨迹，大大提高了企业的生产成本。

发明内容

本发明针对以上问题提出了一种能够应用于工业机器人，实现高速、高精度定位的定位机器人运动轨迹的方法和装置，能够尽量避免由于控制系统、驱动系统以及机器人本体的电气和机械惯性，使它的速度突变，产生冲击、震荡、超调或失步等动态误差，造成系统精度降低的情况发生。

本发明的技术方案是提供一种定位机器人运动轨迹的方法，包括以下步骤：

一脉冲控制器接收一机器人控制器每周期的指令脉冲数，并对接收的位置点进行S形曲线加减速作为粗插补运算，所述机器人控制器用以控制一机器人本体；

在S形曲线基础上划分为n段，对第n段进行PVT精插补运算，通过第n段内相邻两点间的斜率值可知机器人到达每一位置点的速度，并在S形曲线上确定所属的速度段；

调用所述脉冲控制器的DSP数字信号处理器中的脉冲输出函数进行脉冲发送，并传给一驱动器控制一电机转动，所述电机控制所述机器人本体的运动。

进一步地，所述对第n段进行PVT精插补运算包括：S形曲线划分为n段基础上对其中任意一段进行i等分，其中每一等分点的位置值为K_i；如果为变速运动，即电机运动在加速段、减速段和匀速段中至少2个速度段，则K_i等于第n段起始位置值；如果为非变速运动，即电机运动在加速段或减速段或匀速段，则位置值K_i进行累加；判断位置值K_i是否小于控制周期的位置值，若位置值K_i小于控制周期的位置值，则计算第i段的p、v、t值，将计算得到的PVT值保存到自定的数组中，并进行i++；若位置值K_i大于控制周期的位置值，则程序结束。

进一步地，所述脉冲控制器还包括一FPGA信号处理器、一CAN接口电路、一模拟量输出电路、一数字量输出电路以及一编码器接口电路，所述DSP数字信号处理器通过所述CAN接口电路接收来自所述机器人控制器的指令，所述DSP数字信号处理器将指令发给所述FPGA信号处理器，经所述FPGA信号处理器内部操作将信号经所述模拟量输出电路、所述数字量输出电路、所述编码器接口电路与所述驱动器进行直接的通讯。

进一步地，所述机器人本体具有若干关节，每个关节围绕固定的坐标轴旋转，通过关节值显示当前位置给所述脉冲控制器。