工业机器人系统中可旋转工件的测定及基坐标使用方法技术方案

本发明专利技术公开了一种工业机器人系统中可旋转工件的测定及基坐标使用方法，在机器人离线编程过程中能准确地指定可旋转工件的基坐标。包括以下步骤：示教测量可旋转工件上的5个点，测量过程中需两次通过机器人控制系统转动转台。通过外部计算机计算工件与转台的坐标，把基坐标表示为转台旋转角度的一个函数，基坐标数据包括三维坐标与欧拉角。把基坐标写入机器人程序源代码，基坐标数据与转台的旋转角度一一对应。本发明专利技术同时测定工件与转台坐标，简化了示教测定的步骤。在机器人程序源代码中使基坐标真实反映旋转后的工件的坐标，降低了离线编程的复杂性。

The measurement of rotatable workpiece and the use of base coordinate in industrial robot system

【技术实现步骤摘要】
工业机器人系统中可旋转工件的测定及基坐标使用方法
本专利技术属于工业机器人控制领域，尤其涉及一种工业机器人系统中可旋转工件的测定及基坐标使用方法。
技术介绍
工业机器人又称为关节机器人、机械臂，通常有六个旋转关节。工业机器人主要工作步骤包括：(1)使用机器人的示教器，测定工具坐标与基坐标。工具坐标对应于机器人法兰盘上安装的工具，工具坐标描述了工具头(TCP)相对于法兰盘的坐标。基坐标定义了工件相对于机器人世界坐标的位置。(2)对机器人的运行路径进行编程，有两种方式：离线编程或示教编程。离线编程在外部计算机上进行。示教编程在机器人系统上进行。编程的结果均为机器人程序源代码。(3)机器人根据程序源代码进行加工。工业机器人在工作前需要测定工件的位置，称为基坐标，基坐标数据包括三维坐标(x,y,z)和旋转姿态，旋转姿态通常表示为欧拉角(A,B,C)。最常见的基坐标测定法为“3点法”，需通过示教器三次移动工具头到工件的特定位置，机器人系统内部将自动计算基坐标的数据。工业机器人可连接转台(或称变位器)，使转台成为机器人系统的外部轴，可进行外部轴联动加工，通常称为7轴联动。在7轴联动的机器人系统中，机器人程序源代码中的基坐标数据不反映转台旋转的影响，机器人控制系统在内部自动处理转台旋转对工件空间坐标的影响，操作员无法从源代码中获知旋转后的工件的真实坐标。当工件安装在转台上时，需要分别测定转台与工件。首先，机器人系统需要测定转台，通过机器人系统使转台旋转到三个不同的角度，并分别记录基准点的坐标。然后，基于已经测定的转台再测定转台上的工件。这种测定步骤有两个局限：其一，测定转台与测定在转台上的工件是两个关联的步骤，操作比较繁琐；其二，在机器人程序源代码中无法显示转台某一旋转角度下的基坐标数据，该数据隐藏在机器人控制系统中，操作员无法从源代码中获知旋转后的工件的正确坐标，为机器人离线编程带来困难。
技术实现思路
专利技术目的：针对以上问题，本专利技术提出一种工业机器人系统中可旋转工件的测定及基坐标使用方法。技术方案：为实现本专利技术的目的，本专利技术所采用的技术方案是：一种工业机器人系统中可旋转工件的测定及基坐标使用方法，包括以下步骤：步骤1：使用机器人系统，在示教器中选择相应坐标系，分别选定并记录工件上5个点的位置，通过5个点示教测定可旋转工件；步骤2：使用外部计算机，根据步骤1记录的5个点的坐标，计算转台旋转角度θ时的基坐标对应的齐次矩阵；步骤3：根据步骤2所得齐次矩阵转化得到基坐标，该基坐标数据为机器人世界坐标下已旋转角度θ后的工件的坐标；步骤4：在机器人离线编程过程中，根据转台的旋转角度确定机器人程序源代码中的基坐标数据，进而确定工件的加工路径代码。进一步，步骤1所述5点示教测定可旋转工件，方法如下：1-1，在示教器中选择机器人世界坐标，该坐标原点位于机器人基座中央；1-2，在示教器中选择工具坐标，与机器人法兰盘上安装的实际工具相对应；1-3，通过示教器使转台的旋转角度为0；机器人系统的初始状态即为旋转角度为0的状态；1-4，采用传统3点示教法记录工件上三个点的位置，分别记为P，PX，PXy，将其输入外部计算机；其中，点P为工件的原点；点PX为工件的x轴正向上的任一点；点PXY为工件的xy平面上y值为正的一面的任一点；1-5，通过示教器使转台的旋转角度为90度，将工具头与工件原点对齐，当前的工件原点记为Qa；在示教器中读取该点的坐标位置，将其输入外部计算机；1-6，通过示教器使转台的旋转角度为-90度，将工具头与工件原点对齐，当前的工件原点记为Qb；在示教器中读取该点的坐标位置，将其输入外部计算机；1-7，根据上述步骤完成5个点的三维坐标记录后，5点示教测定结束。进一步，步骤2所述计算转台旋转角度θ时的基坐标对应的齐次矩阵，方法如下：转台的坐标原点表示为：其中，V是一个三维向量，表示坐标原点；转台角度为0时的转台坐标对应的矩阵记为片，计算公式为片＝f(P-V，Qa-V)(2)其中，片为3*3正交矩阵，f(*)表示机器人学定义的将x轴向量与xy轴向量转换为3*3正交矩阵的函数；转台角度为0时的基坐标对应的矩阵记为G，计算公式为U＝f(HT(PX-P)，HT(PXY-P))(4)d＝||P-V||(5)其中，U为3*3的正交矩阵，Uij为矩阵U中的元素，i＝1，2，3，j＝1，2，3；矩阵G完整地表达转台角度为0时工件的坐标；当转台旋转角度θ之后，计算一个4*4的齐次矩阵D：其中，V1，V2，V3是三维向量V的三个坐标；W是3*3的矩阵，Wij为矩阵W中的元素，i＝1，2，3，j＝1，2，3；转台旋转角度θ时的基坐标对应的齐次矩阵K为K＝DG。(8)进一步，在步骤3中，根据步骤2所得齐次矩阵转化得到基坐标，即将齐次矩阵K转化为基坐标的三维坐标(x，y，z)与欧拉角(A，B，C)；基坐标的三维坐标的计算方法为(x，y，z)＝(K14，K24，K34)(9)其中，K14，K24，K34为齐次矩阵K的相应元素；基坐标的欧拉角的计算方法为：(A，B，C)＝g(Ksub)(10)其中，Ksub是齐次矩阵K的子矩阵，由矩阵K左上角的3行3列组成；函数g(*)为机器人学定义的将3*3正交矩阵转换为欧拉角A，B，C的函数。进一步，步骤4所述确定工件的加工路径代码，具体如下：4-1，在机器人离线编程过程中，加工路径编程需要使转台旋转一定的角度θ，该角度在整个加工过程中是不断变化的，角度θ作为输入参数；4-2，根据转台的旋转角度确定基坐标，将基坐标的数据写入机器人程序源代码中；4-3，根据输入的基坐标数据与工具头运动路径，确定加工路径的源代码。本专利技术适用于常用工业机器人系统，不限于某一品牌或型号的工业机器人。有益效果：与现有技术相比，本专利技术的技术方案具有以下有益的技术效果：(1)本专利技术同时测定工件与转台坐标，简化了测定的步骤与所需时间。(2)本专利技术将可旋转工件对应的基坐标表示为转台旋转角度的一个函数。(3)本专利技术在机器人程序源代码中写入基坐标数据，该基坐标准确地反映了旋转后的工件的坐标。附图说明图1是本专利技术使用的工业机器人系统示意图；图2是本专利技术的总体工作流程图；图3是示教测定工件与计算基坐标的流程图；图4是本专利技术使用的硬件示意图；图5是转台与测定点的示意图；其中，1：机器人本体，2：机器人控制系统，3：转台(变位器)，4：示教器，5：工件，6：工具头(TCP)；7：外部计算机。具体实施方式下面结合附图和实施例对本专利技术的技术方案作进一步的说明。本专利技术所使用的工业机器本文档来自技高网...

【技术保护点】
1.一种工业机器人系统中可旋转工件的测定及基坐标使用方法，其特征在于：该方法包括以下步骤：/n步骤1：使用机器人系统，在示教器中选择相应坐标系，分别选定并记录工件上5个点的位置，通过5个点示教测定可旋转工件；/n步骤2：使用外部计算机，根据步骤1记录的5个点的坐标，计算转台旋转角度θ时的基坐标对应的齐次矩阵；/n步骤3：根据步骤2所得齐次矩阵转化得到基坐标，该基坐标数据为机器人世界坐标下已旋转角度θ后的工件的坐标；/n步骤4：在机器人离线编程过程中，根据转台的旋转角度确定机器人程序源代码中的基坐标数据，进而确定工件的加工路径代码。/n

【技术特征摘要】
1.一种工业机器人系统中可旋转工件的测定及基坐标使用方法，其特征在于：该方法包括以下步骤：
步骤1：使用机器人系统，在示教器中选择相应坐标系，分别选定并记录工件上5个点的位置，通过5个点示教测定可旋转工件；
步骤2：使用外部计算机，根据步骤1记录的5个点的坐标，计算转台旋转角度θ时的基坐标对应的齐次矩阵；
步骤3：根据步骤2所得齐次矩阵转化得到基坐标，该基坐标数据为机器人世界坐标下已旋转角度θ后的工件的坐标；
步骤4：在机器人离线编程过程中，根据转台的旋转角度确定机器人程序源代码中的基坐标数据，进而确定工件的加工路径代码。


2.根据权利要求1所述的一种工业机器人系统中可旋转工件的测定及基坐标使用方法，其特征在于：步骤1所述5点示教测定可旋转工件，方法如下：
1-1，在示教器中选择机器人世界坐标，该坐标原点位于机器人基座中央；
1-2，在示教器中选择工具坐标，与机器人法兰盘上安装的实际工具相对应；
1-3，通过示教器使转台的旋转角度为0；机器人系统的初始状态即为旋转角度为0的状态；
1-4，采用传统3点示教法记录工件上三个点的位置，分别记为P,Px,Pxy，将其输入外部计算机；其中，点P为工件的原点；点Px为工件的x轴正向上的任一点；点Pxy为工件的xy平面上y值为正的一面的任一点；
1-5，通过示教器使转台的旋转角度为90度，将工具头与工件原点对齐，当前的工件原点记为Qa；在示教器中读取该点的坐标位置，将其输入外部计算机；
1-6，通过示教器使转台的旋转角度为-90度，将工具头与工件原点对齐，当前的工件原点记为Qb；在示教器中读取该点的坐标位置，将其输入外部计算机；
1-7，根据上述步骤完成5个点的三维坐标记录后，5点示教测定结束。


3.根据权利要求2所述的一种工业机器人系统中可旋转工件的测定及基坐标使用方法，其特征在于：步骤2所述计算转台旋转角度θ时的基坐标对应的齐次矩阵，方法如下：
转台的坐标原点表示为：



其中，V是一个三维向量，表示坐标原点；
转台角度为0时的转台坐标对应的矩阵记...

【专利技术属性】
技术研发人员：华好，唐芃，李飚，
申请(专利权)人：东南大学，
类型：发明
国别省市：江苏;32