[发明专利]一种工业机器人末端夹具安装位置的标定方法

说明书

技术领域

本发明涉及一种先进制造技术和装备领域内各种类型工业机器人，是一种减小现场施工中末端设备的安装位置及姿态误差的标定方法，具体涉及一种工业机器人末端夹具安装位置的标定方法。

背景技术

随着工业自动化的发展，工业机器人的使用领域越来越大，对机器人使用效率的要求越来越严格，然而，施工现场与控制环境必然存在着位置相对误差，因此如何尽量减小这些误差，对控制方法的实用性将是一个很大的考验。本方法就是根据现场数据测量来标定机器人末端夹具安装位置。

发明内容

本发明的目的在于提供一种工业机器人末端夹具安装位置的标定方法，减小施工现场与控制环境之间误差，具体技术方案如下：

一种工业机器人末端夹具安装位置的标定方法，包括如下步骤：

(1)现场采集机器人关节角度及位置数据；

(2)将步骤(1)所述数据处理并得到机器人末端夹具相对于机器人法兰盘末端坐标系的安装位置及安装姿态；

(3)对步骤(2)中所述的安装位置及安装姿态进行重新定位。

进一步地，步骤(3)所述定位是在离线仿真系统中进行。

进一步地，进一步包括步骤(4)根据仿真结果重新定位机器人安装位置及安装姿态，保证与现实安装的一致性。

进一步地，所述机器人为6轴串联型机器人。

进一步地，步骤(1)具体包括

(1-1)在现场手动操作机器人将末端夹具上3点分别运动到某一固定空间位置点；

(1-2)记录下三次的机器人6轴关节角度J1～J6；

(1-3)记录下此固定点在机器人基坐标系下的空间位置Pg(x,y,z)。

进一步地，步骤(2)具体包括，记录夹具模型上对应的3点在夹具原点坐标系下的空间位置P1(x,y,z)、P2(x,y,z)、P3(x,y,z)，该步骤优选在3D仿真环境中完成。

进一步地，步骤(2)中数据处理采用如下算法：计算公式由⁶T_t＝⁶T_e*^eT_t得出⁶T_e＝⁶T_t*[^eT_t]^-1，其中，⁶T_t为法兰末端坐标系到夹具上3点确定的坐标系的转换矩阵，⁶T_e为法兰末端坐标系到夹具原点坐标系的转换矩阵，^eT_t为夹具原点坐标系到夹具上3点确定的坐标系的转换矩阵。

进一步地，⁶T_t通过三组J1～J6及Xg，Yg，Zg可以根据下列步骤计算得出：

a.根据机器人正运动学方程分别求出三组关节坐标对应的法兰盘末端坐标系4*4矩阵M1,M2,M3)；

b.计算空间固定点Pg(x,y,z)分别在M1、M2、M3矩阵所表示空间坐标系下的空间位置，分别表示为Pａ、Pｂ、Pｃ；

c.使用上述3点根据空间3点法确定一坐标系，使用4*4矩阵表示即⁶T_t。

进一步地，根据步骤(2)得出的₆T^e，重新对夹具的安装位置和安装角度进行调整：记录三组J1～J6；

确定此固定点在机器人坐标系下坐标Pg；

确定3点在夹具坐标系下坐标P1、P2、P3，计算次三点确定的坐标矩阵^eT_t；

采用DH法正运动学计算矩阵，计算⁶T_t；

根据公式⁶T_e＝⁶T_t*[^eT_t]^-1，根据⁶T_e调整在仿真里夹具的位置到点P；

姿态根据前3*3的数值得到是单位矩阵，姿态保持原始姿态。

附图说明

图1为T6到Te之间的位置及姿态差；