吴乐平 , 顾晟吉,程伟国
(1. 南京旭上数控技术有限公司,江苏 南京 211167; 2. 南京机电职业技术学院,江苏 南京 211135)
随着机器人在各行各业应用的逐渐深入,对机器人性能的要求也在逐渐提高[1]。工具中心点(tool center point,TCP)标定是机器人应用中不可避免的重要环节之一,而且TCP标定精度直接影响机器人的定位精度[2]。因此,就必须要研究一种快速、高精度的TCP标定方法。
机器人TCP标定是计算工具末端点相对于机器人末端坐标系的位置辨识过程,该位置是一个未知的确定位置。文献[3-4]分别采取SVD分解和投影约束的方法求解TCP参数,但都需要人工校准,而且人工校准带来的误差无法消除。文献[5]提出一种基于双目视觉的TCP标定方法,不需要手动校准,标定精度高,但是双目视觉系统的价格昂贵,不适合推广。
本文提出一种基于超声波测距的TCP标定方法,只需要将机器人任意移动到3个不同位置,不需要操作人员人工校准,实施简单,标定速度快,精度高,通用性强。
为了方便操作人员使用,在机器人系统中定义了多种坐标系,如图1所示的坐标系{B}为基坐标系;坐标系{R}为腕部坐标系;坐标系{T}为工具坐标系。TCP标定过程即获得坐标系{T}的原点在坐标系{R}下坐标值(xT,yT,zT)的过程。本文所述方法的标定流程共分为以下5个步骤:
1)如图2所示,首先在需要标定的工具坐标系原点安装超声波发送探头S1,在矩形底座的3个顶点处安装3个超声波接收探头R1、R2、R3,则R13⊥R12(Rij表示由Ri由指向Rj的向量),并且已知|R12|=d1、|R13|=d2,R12、R13分别平行于基坐标x、y轴。……