[发明专利]工业机器人动态六维参数测量方法

说明书

本发明公开了一种工业机器人动态六维参数测量方法，包括激光跟踪仪，计算机，六维测量仪，设于机器人上的示教器，六维测量仪包括六维靶球和处理器，六维靶球包括激光靶球、三向光纤陀螺仪和三轴加速度计，激光靶球、三向光纤陀螺仪和三轴加速度计均与处理器电连接，计算机分别与激光跟踪仪、示教器和处理器电连接。本发明具有运算量更小，支持更好的动态测量测量精度高的特点。

技术领域

本发明涉及电子测量和数据处理技术领域，特别涉及一种测量精度高、动态性好的工业机器人动态六维参数测量方法。

背景技术

工业机器人是现代化生产和流水线作业的核心设备。《GB/T12642-2013工业机器人性能规范及试验方法》对工业机器人的各项性能指标进行了明确详细的阐述，规定了工业机器人14项需要进行测量的性能指标及其测试方法，对机器人末端位姿的测量是工业机器人性能测量的核心内容，机器人的位姿是指工业机器人的TCP点相对基座坐标系的位置(x、y、z)和以TCP点为原点的坐标系相对基座坐标系的空间姿态(a、b、c)，同时对位置和姿态进行测量合称为六维参数测量。

现有技术中包括基于摄像机的图像法和基于多激光靶球的多靶球法。前者受限于图像分辨率因素，难以做到高精度。多靶球方案基于激光跟踪仪和多个靶球，在静态时通过激光的切换实现姿态测量，但运动时无法对多靶球进行同一位姿下的测量，无法实现六维测量的动态性。

发明内容

本发明的发明目的是为了克服现有技术中的方法精度低或无法实现动态性的不足，提供了一种测量精度高、动态性好的工业机器人动态六维参数测量方法。

为了实现上述目的，本发明采用以下技术方案：

一种工业机器人动态六维参数测量方法，包括激光跟踪仪，计算机，六维测量仪，设于机器人上的示教器，六维测量仪包括六维靶球和处理器，六维靶球包括激光靶球、三向光纤陀螺仪和三轴加速度计，激光靶球、三向光纤陀螺仪和三轴加速度计均与处理器电连接，计算机分别与激光跟踪仪、示教器和处理器电连接；包括如下步骤：

(1-1)确定测量前的六维靶球基准姿态，获得机器人姿态和六维靶球的测量姿态转换矩阵T₁；

(1-2)获得测量坐标系的位置转换矩阵T₂；

(1-3)计算机获得激光跟踪仪输出的实时位置信号(x(t)，y(t)，z(t))，三向光纤陀螺仪输出的实时转速信号(vx(t)，vy(t)，vz(t))，三轴加速度计输出的加速度信号(ax(t)，ay(t)，az(t))；

(1-4)计算机将位置信号(x(t)，y(t)，z(t))从测量坐标系转换到机器人基座坐标系下的位置数据Pr(t)；

(1-5)计算机将陀螺仪的3个转速信号积分到角度信号，三个角度值即为测量坐标系下的姿态数据，将姿态数据从测量坐标系转换到机器人基座坐标系下的姿态数据；

(1-6)对位置数据和姿态数据按时间戳进行合并，获得高精度、动态六维数据。

无论现有方法还是本发明方法，基本过程都包括测量坐标系下六维参数测量和将测量坐标系下参数通过转换矩阵转换到机器人基座坐标系下。六维参数测量是指测量系统通过特定的传感识别装置，获得机器人TCP点在空间中的位置以及TCP坐标系的姿态，此时的位置数据和姿态数据都是基于测量坐标系，是完成六维测量的基础，对机器人六维测量，关注的焦点是测量精度、能否动态测量、动态测量的数据输出率是多少，不同的测量方法差异极大。将测量数据从测量坐标转换到机器人坐标本质上是一组规则下的数学运算，不同的测量方法实现原理基本相同，都是基于机器人运动学的理论进行数学变换来实现。