CN111660295A - 工业机器人绝对精度标定系统及标定方法 - Google Patents

Abstract

本发明公开了一种工业机器人绝对精度标定系统及方法。所述标定系统包括三球座装置、末端测量装置、机器人、通讯线缆及计算机等。所述标定方法包括：利用固定的三球座装置建立用于描述机器人基坐标系的世界坐标系；利用安装于机器人法兰的末端测量装置测量机器人末端位置误差信息；利用计算机读取位置误差数据和机器人关节角数据；最后，将测得的所有数据代入计算机中的绝对精度标定算法，进行迭代计算，得到描述于世界坐标系下的精确运动学模型。利用本发明的标定系统和标定方法，可以准确地标定机器人基坐标系的位姿及机器人运动学参数，进而提高机器人绝对定位精度。

Description

工业机器人绝对精度标定系统及标定方法

技术领域

本发明涉及一种机器人标定方法，特别涉及一种工业机器人绝对精度标定系统及标 定方法，至少用于实现对机器人基坐标系位姿和机器人本体运动学参数的标定，属于机器人运动学标定领域。

背景技术

随着机器人应用技术的发展，制造业企业对工业机器人离线编程技术的应用需求越 来越高，尤其是在汽车制造、航空制造等行业。目前，工业机器人通常具有较高重复定位精度，但其绝对定位精度偏低，这主要是由机器人运动学参数存在误差及机器人基坐 标系难以精确定位的问题引起，从而影响了包括离线编程作业在内的一些机器人应用的 可靠性和精度。而机器人运动学标定可以有效地提高机器人绝对定位精度，具有较大的 研究意义。

根据是否标定机器人基坐标系与外界物理环境的转换关系，机器人运动学标定可分 为绝对标定与相对标定。相对标定仅考虑机器人本体运动学参数误差的标定。而绝对标定在标定运动学参数的基础上，同时对机器人基坐标系的位姿进行标定。基坐标系是描 述机器人关节坐标系及末端位置的基准，因此，对机器人基坐标系的准确标定是实现机 器人精确位置控制的重要前提。

传统机器人标定方法通常借助外部测量设备获取机器人位姿误差信息，如激光跟踪 仪等仪器，但存在成本高、设备笨重及操作技术门槛较高的缺点。因此，新型的低成本机器人标定方法被广泛研究。这些标定方法大多利用传感器或物理约束获取机器人末端位姿误差信息，实现机器人运动学参数标定，从而提高机器人绝对定位精度。然而，现 有的新型机器人标定方法，大多针对于机器人本体运动学参数的标定，属于相对标定方 法，故无法对机器人基坐标系进行准确标定。

在机器人运动学标定研究领域，CN107042528A公开了一种工业机器人标定系统及方法，标定系统主要包括一种设于机器人上的末端执行器和球心距固定的两个可移动目标球体，利用两球体之间的名义距离与实际距离之间的误差建立标定算法，实现对机器 人本体运动学参数的标定，但其标定算法采用距离误差模型，属于相对式标定方法，标 定结果的可靠性受限，且无法标定出机器人基坐标系的准确位置。

发明内容

本发明的主要目的在于提供一种工业机器人绝对精度标定系统及标定方法，从而克 服现有技术中得不足。

为实现上述发明目的，本发明提供如下技术方案：

本发明实施例提供了一种工业机器人绝对精度标定系统，其包括：三球座装置、末端测量装置、计数器及数据处理单元；所述三球座装置相对于机器人的基座固定设置， 所述末端测量装置通过机器人法兰与机器人连接，所述末端测量装置还与计数器连接， 所述计数器、机器人分别与数据处理单元连接。

在一些实施方式中，所述三球座装置包括三颗精密钢球和三个锥形球座，所述三个 锥形球座固定在底板上，所述三颗精密钢球分别安装于三个锥形球座上。

在一些实施方式中，所述三颗精密钢球均为具有G5精度等级以上的钢球。

在一些实施方式中，所述锥形球座还与磁性机构配合，所述精密钢球至少是在所述 磁性机构的磁力作用下安装于相应的锥形球座上。

在一些实施方式中，所述末端测量装置包括三个位移传感器，所述三个位移传感器 成环形布局且彼此相隔120°，所述位移传感器的测量端安装有具有球形测头的测针，在所述测针接触所述三球座装置中待测的精密钢球时，所述测针的球形测头的球心能产生轴向位移。

在一些实施方式中，所述计数器包括第一采集模块，所述第一采集模块至少用于获 取所述末端测量装置中位移传感器输出的信号。所述信号可以呈现为电压信号。

在一些实施方式中，所述数据处理单元包括第二采集模块、第三采集模块、第一计算模块和第二计算模块，所述第二采集模块至少用于获取机器人的关节角信息，所述第 三采集模块至少用于获取计数器发送的位移测量信息，所述第一计算模块至少用于根据 第二采集模块、第三采集模块采集的信息计算所述三球座装置中精密钢球的理论球心坐 标，所述第二计算模块至少用于依据所述精密钢球的理论球心坐标与所述三球座装置中 精密钢球的实际球心坐标之间的位置误差信息以及绝对精度标定算法进行迭代计算。

在一些实施方式中，所述三球座装置中的三颗精密钢球用于定义外部世界坐标系{w}，所述外部世界坐标系{w}用于描述机器人系统中的所有坐标系，基于所述三颗精密 钢球(4)的球心点位置分布能够确定所述外部世界坐标系{w}的原点、XOY平面及各 坐标轴的位置与方向，所述末端测量装置用于测量所述精密钢球的球心相对于机器人法 兰坐标系{F}的位置坐标，所述外部世界坐标系{w}与基坐标系{0}之间的初始位姿变换 矩阵能够根据两者的位置安装关系获得，以及，在所述世界坐标系{w}下，所述三颗精 密钢球的实际球心坐标分别表示为P₁、P₂、P₃。

本发明实施例还提供了一种工业机器人绝对精度标定方法，所述标定方法是基于所 述工业机器人绝对精度标定系统实施，并且所述标定方法包括：

利用三球座装置建立用于描述机器人基坐标系{0}的世界坐标系{w}；

采用局部指数积法建立描述于所述世界坐标系{w}下的机器人的正向运动学模型， 得到包含理论运动学参数的位姿变换矩阵T_w,n+1；

根据所述机器人的正向运动学模型，建立描述于所述世界坐标系{w}下的机器人位 置误差模型，即所述机器人末端位置误差δP与机器人初始位姿误差δt之间的映射关系，所述映射关系表示为δP＝F(δt_w,δt₁,δt₂...,δt_n,δt_n+1)或δP＝J[δt_w,δt₁,δt₂...,δt_n,δt_n+1]^T，其中误 差雅可比矩阵J是运动学误差δt与机器人末端位置误差之间的误差传递矩阵；

使所述机器人移动至指定位置，并使安装于机器人法兰的末端测量装置内各位移传 感器的测针同时接触三球座装置内的任一精密钢球，且使各位移传感器的测针的球形测 头(如下亦可简称“球头”)均产生位移，采集此时各位移传感器的测量信息K与机器 人关节角信息q；

依据所述测量信息K计算出所述精密钢球的球心相对于机器人法兰坐标系{F}的位 置坐标，再根据所述位姿变换矩阵T_w,n+1与所述机器人关节角信息q，计算出所述精密钢球的球心相对于所述世界坐标系{w}的理论位置坐标

将所述理论位置坐标

与所述精密钢球的球心在所述世界坐标系{w} 下的实际球心坐标(P₁，P₂，P₃)作差，得到机器人末端位置误差信息δP(δP₁，δP₂， δP₃)；

将所述机器人末端位置误差信息(δP₁，δP₂，δP₃)及相应的所述机器人关节角信 息q代入绝对精度标定算法进行迭代计算，实现对机器人基坐标系运动学参数t_w及机器 人连杆运动学参数t_i(i＝1,2,...,n,n+1)的标定，得到描述于所述世界坐标系{w}下的精确 运动学模型。

在一些实施方式中，所述标定方法具体包括：采用局部指数积法，建立机器人在所述世界坐标系{w}下描述的运动学模型，表示为：

其中，^wP、^FP分别为所述精密钢球(4)的球心坐标在所述世界坐标系{w}、所述法兰坐标系{F}下的表示，

代表所述世界坐标系{w}到所述基坐标系{0}的齐次变换矩阵对 应的旋量，

代表相邻连杆坐标系的初始位姿矩阵

所对应的旋量，

为关节i的转轴 旋量在关节坐标系{i-1}下的描述，q_i代表第i个关节变量。

在一些实施方式中，所述机器人位置误差模型所采用的误差参数包含机器人基坐标 系的转换误差δt_w及机器人本体的连杆几何误差δt_i。

在一些实施方式中，所述标定方法还包括：根据所述机器人位置误差模型，利用递归最小二乘法，在数据处理单元中建立绝对精度标定算法。

在一些实施方式中，所述标定方法具体包括：使机器人以不同位姿对所述三球座装 置内的任一精密钢球进行测量，且使所述不同位姿均匀分布于所述三球座装置内3个精密钢球周围的机器人工作空间。

在一些实施方式中，所述标定方法具体包括：使所述三球座装置安装于机器人目标 工作空间附近。

在一些实施方式中，所述标定方法还包括：将所述机器人关节角信息q代入所述相对于世界坐标系{w}的标定后运动学模型，计算标定后的所述精密钢球的球心坐标

并与所述精密钢球的实际球心坐标对比，以验证所述标定方法的有效性。

在一些实施方式中，所述标定方法还包括：将标定计算得到的机器人基坐标系位姿 描述参数t_w及机器人连杆运动学参数t_i(i＝1,2,...,n,n+1)补偿到实际机器人系统，以提高 实际机器人系统的绝对定位精度。

与现有技术相比，本发明实施例提供的机器人绝对精度标定系统及标定方法至少具 有以下优点：

(1)提供的机器人标定系统主要包括发明的三球座装置及末端测量装置，具有便携、低成本、操作方便及测量精度可靠的优点，并且其中的关键部件主要为精密钢球、 测针及高精度位移传感器，其均可从现有成熟商业产品中选择，故所述机器人标定系统 在实际中具有良好的可行性；

(2)利用三球座装置建立了外部世界坐标系{w}，可用于描述机器人基坐标系{0}及机器人工作单元内的其他坐标系，有利于提高机器人系统中各坐标系之间的转换精度；

(3)提供的机器人标定方法属于绝对标定方法，不但对机器人运动学参数误差进行标定，同时可实现机器人基坐标系位姿的准确标定，进而提高了机器人的绝对定位精度。

附图说明

图1a是本发明一实施例提供的工业机器人绝对精度标定系统的结构示意图。

图1b是图1中A部分的局部放大示意图。

图1c图1中B部分的局部放大示意图。

图2是本发明一实施例中三球座装置及末端测量装置的结构示意图。

图3是本发明一实施例中精密钢球与锥形球座的安装示意图。

图4是本发明一实施例中末端测量装置的球心坐标测量算法的流程图。

图5是本发明一实施例中绝对精度标定算法的流程图。

附图标记说明：末端测量装置1、机器人2、三球座装置3、精密钢球4、工作台5、 通讯线缆6、通讯线缆7、计数器8、通讯线缆9、计算机10、锥形球座11、永磁体12、底 板13、测针14、位移传感器15、机器人法兰16。

具体实施方式

如前所述，鉴于现有技术的不足，例如现有机器人标定方法中所采用的测量设备昂 贵且笨重、无法标定机器人基坐标系位姿等问题，本申请发明人经长期研究和实践，得以提出一种具有便携、低成本、精度可靠、操作方便等优点的机器人绝对精度标定系统， 以及一种具备机器人运动学参数标定和机器人基坐标系位姿标定功能的绝对标定方法

以下结合实施例与附图对本发明作进一步详细描述，需要指出的是，以下实施例旨 在便于对本发明的理解，而对其不起任何限定作用。

如图1a-图1c所示，本发明一实施例提供的一种工业机器人绝对精度的运动学标定 系统(如下简称“工业机器人绝对精度标定系统”或者“标定系统”)，包括相对于机器人2(特别是机器人基座及工作台5)固定设置的三球座装置3、安装于机器人法兰16的末 端测量装置1、计数器8和数据处理设备。在本实施例中，数据处理设备采用计算机10， 但其它的一些具有数据处理能力的设备也是适用的。在本实施例中，前述的机器人2、 末端测量装置1、计数器8、计算机10之间是通过通讯线缆6、7、9连接，但也可以采 用其它的无线或有线通讯方式实现这些设备的连接。

在本实施例中，所述三球座装置包括3颗安装于锥型球座11上的精密钢球4，基于各钢球的位置布置关系，即各球心的位置分布，可建立外部世界坐标系{w}，用于描述 机器人系统中的所有坐标系。

在本实施例中，所述末端测量装置包括3个均布的位移传感器15与测针3组成， 利用所述位移传感器15与测针3，可以测量前述精密钢球4的球心相对于机器人法兰坐 标系{F}的位置坐标。

在本实施例中，所述计数器8包括用于获取所述3个位移传感器输出的电压信号的第一采集模块。

在本实施例中，所述计算机10包括：

用于获取机器人2关节角信息的第二采集模块，

用于获取计数器8发送的位移测量信息的第三采集模块，

用于根据第二、第三采集模块采集的信息计算前述钢球4理论球心坐标的第一计算 模块，以及

用于利用计算得到的前述钢球4的理论球心坐标与前述钢球4的实际球心坐标之间 的位置误差信息和绝对精度标定算法进行迭代计算的第二计算模块。

在本实施例中，所述通信线缆6将位移传感器15的电压信号传输给计数器8；所述通信线缆7将所述机器人关节角信息传输至计算机10，而所述通信线缆9将计数器8 处理得到的位移信息传输至计算机10。

进一步的，请参阅图2所示，本实施例中所述三球座装置2包括底板13、3颗精密 钢球4、3个锥形球座11以及3个永磁体12。其中，所述永磁体12及锥形球座11固定 于底板13，利用所述永磁体12的磁吸力，各精密钢球4被安装于相应锥形球座11。

在本实施例中，所述三球座装置2中的3颗钢球4定义了外部世界坐标系{w}，利 用该3颗钢球4的三个球心点的位置分布可确定坐标系{w}的原点、XOY平面及各坐标 轴的位置与方向。其中，所述世界坐标系{w}与基坐标系{0}之间的初始位姿变换矩阵可 以根据两者的位置安装关系得到，并且在所述世界坐标系{w}下，3颗钢球4的实际球 心坐标分别表示为P₁、P₂、P₃。

进一步的，请参阅图4，本实施例中，所述末端测量装置1安装于机器人法兰16， 所述末端测量装置1包括3个相隔120°均匀分布的位移传感器15以及3个具有球形测 头的测针14。所述测针14安装于相应位移传感器15的测量端，通过接触待测钢球4， 所述测针14的球形测头的球心可产生轴向位移。

本实施例提供的以上标定系统具有便携、低成本、精度可靠、操作方便等优点，且所采用的组成元件或设备均可从现有成熟商业产品中选择，在实际中具有良好的可行性。

基于所述的标定系统，本发明实施例还提供了一种工业机器人绝对精度标定方法(如下简称“标定方法”)，其主要包括以下步骤：利用固定的三球座装置建立用于描述 机器人基坐标系{0}的世界坐标系{w}；利用安装于机器人法兰的末端测量装置测量机器 人末端位置误差信息；利用计算机读取位置误差数据和机器人关节角数据；最后，将测 得的所有数据代入计算机中的绝对精度标定算法，进行迭代计算，得到一个描述于世界 坐标系{w}下的精确运动学模型。

具体而言，其中的一种工业机器人绝对精度标定方法包括如下步骤：

S1：采用局部指数积(LocalPOE)法建立描述于世界坐标系{w}下的机器人2的正向运动学模型，得到包含理论运动学参数的位姿变换矩阵T_w,n+1。

S2：根据机器人2的运动学模型，引入位置伴随变换矩阵T_pi，建立描述于世界坐 标系{w}下的机器人位置误差模型，即末端位置误差δP与机器人初始位姿误差δt之间的 映射关系：δP＝F(δt_w,δt₁,δt₂...,δt_n,δt_n+1)，可进一步写作一种线性形式：

δP＝J[δt_w,δt₁,δt₂...,δt_n,δt_n+1]^T (1)

其中，误差雅可比矩阵J是运动学误差δt与机器人末端位置误差之间的的误差传递矩阵。 根据以上位置误差模型，并利用递归最小二乘法

在计算机10中建立一种 流程如图5所示的绝对精度标定算法。

S3：控制机器人移动至指定位置，使末端测量装置的3个测针14同时接触三球座装置3的任一钢球4，确保传感器上的3个测针14的球形测头均产生位移，采集此时的 位移传感器15的测量信息K与机器人关节角信息q。

S4：根据传感器15的测量信息K计算出钢球4的球心相对于机器人法兰坐标系{F}的位置坐标，再根据建立的运动学模型T_w,n+1与采集的机器人关节角信息q，计算出3个 钢球4的球心相对于世界坐标系{w}的理论位置坐标

作为第一计算 模块输出值。

进一步的，依据如图4所示的球心坐标测量算法流程，该步骤S4中利用测量信息K计算钢球4的球心相对于机器人法兰坐标系{F}的位置坐标的方法包括：

设定末端测量装置1中3个测针14的球形测头的球心相对于机器人法兰坐标系的初始坐标为s_0i＝[a_i,b_i,c_i],i＝1,2,3，设定测针14接触钢球4时位移传感器的测量值为 K＝[k₁,k₂,k₃]，则此时3个球形测头的球心坐标可以分别写作s_i＝[a_i,b_i,c_i-k_i],i＝1,2,3；因此，三球座装置3中待测钢球4的球心坐标p_T＝[x,y,z]可以通过求解如下三元二次 方程组得到

(a_i-x)²+(b_i-y)²+(c_i-k_i-z)²＝(r+R)²,i＝1,2,3 (1)

其中，R为精密钢球4的半径；r为测针14球形测头的半径。对式(1)进行求解，可 得到p_T的2组解：p_T1＝[x₁,y₁,z₁]、p_T2＝[x₂,y₂,z₂]。最后，再根据3个球形测头的球心 坐标s₁、s₂、s₃，可建立3个球形测头球心点所在的平面的方程：

Ax+By+Cz+D＝0 (2)

其中，根据三点确定平面的准则，可得

将求得的2组解p_T1、p_T2分别代入式(3)，选择其中Ax+By+Cz+D＞0的1组解，该解 即代表钢球4球心在机器人法兰坐标系{F}下的准确坐标。

S5：将钢球4的理论球心坐标

与钢球4的实际球心坐标(P₁，P₂， P₃)作差，可得到机器人末端的位置误差信息δP(δP₁，δP₂，δP₃)。

S6：将机器人末端位置误差信息δP及相应的机器人关节角信息q代入计算机10中的绝对精度标定算法，进行迭代计算，实现对机器人基坐标系运动学参数t_w及机器人连 杆运动学参数t_i(i＝1,2,...,n,n+1)的标定，得到一个描述于世界坐标系{w}下的精确运动学模型。

S7：将采集的机器人关节角信息q代入标定后的运动学模型，计算标定后的钢球4的球心坐标

与钢球4的实际球心坐标对比，验证标定方法的有效性。

S8：将标定计算得到的运动学参数补偿到实际机器人系统，提高其绝对定位精度。

进一步的，在本实施例的步骤S1中，采用局部指数积法建立机器人(2)在世界坐标系{w}下描述的运动学模型，表示为：

其中，^wP与^FP分别代表球心坐标在世界坐标系{w}与基坐标系{0}下的表示，

代表世 界坐标系{w}到基坐标系{0}的齐次变换矩阵对应的旋量，

代表相邻连杆坐标系的初始 位姿矩阵

对应的旋量，

为关节i的转轴旋量在关节坐标系{i-1}下的描述，q_i代表第i个关节变量。

进一步的，在本实施例的步骤S2中，所述位置误差模型的误差参数包含机器人基坐标系的转换误差δt_w及机器人本体的连杆初始位姿误差δt_i；误差雅克比矩阵如下所示：

其中，R_0,i代表坐标系{i}相对于坐标系{0}的姿态，T_pi代表位置伴随变换矩阵。

进一步的，在本实施例的步骤S2中，位置误差模型可以写作y＝Jx的形式，为了 获取足够的信息，以辨识所有运动学误差参数t，需要对3个钢球4进行m(m＞2n+4) 次测量实验，当测得m组数据时，可得到扩展后的误差模型

进一步的，在本实施例的步骤S3中，机器人2对钢球4进行测量的位姿应尽量不同，且均匀分布于3个钢球4周围的机器人工作空间，以提高机器人测量结构的多样性， 进而提高标定结果的可靠性。

进一步的，在本实施例的步骤S3中，待测三球座装置3应尽量安装于机器人目标工作空间附近，以保证标定后机器人的实际作业精度。

进一步的，在本实施例中，为了进一步提高上述步骤S5中的误差测量精度，研制后的三球座装置在初次投入使用之前，其中各钢球4的实际球心坐标(P₁，P₂，P₃) 的精确值可由精密测量设备测得，如光学三坐标测量仪、激光扫描仪等仪器，但不限于 此。

利用本实施例的标定方法可以提高机器人本体的定位精度，同时可以实现机器人基 坐标系的准确定位，有利于提高机器人离线编程等应用的可靠性和准确性。

应当理解，本发明的技术方案不限于上述具体实施案例的限制，凡是在不脱离本发 明宗旨和权利要求所保护的范围情况下，根据本发明的技术方案做出的技术变形，均落于本发明的保护范围之内。

Claims (10)

1.一种工业机器人绝对精度标定系统，其特征在于包括：三球座装置(3)、末端测量装置(1)、计数器(8)及数据处理单元；所述三球座装置(3)相对于机器人(2)的基座固定设置，所述末端测量装置(1)通过机器人法兰(16)与机器人(2)连接，所述末端测量装置(1)还与计数器(8)连接，所述计数器(8)、机器人(2)分别与数据处理单元连接。

2.根据权利要求1所述的工业机器人绝对精度标定系统，其特征在于：所述三球座装置(3)包括三颗精密钢球(4)和三个锥形球座(11)，所述三个锥形球座(11)固定在底板(13)上，所述三颗精密钢球(4)分别安装于三个锥形球座(11)上；

优选的，所述锥形球座(11)还与磁性机构配合，所述精密钢球(4)至少是在所述磁性机构的磁力作用下安装于相应的锥形球座(11)上；

和/或，所述末端测量装置包括三个位移传感器(15)，所述三个位移传感器(15)成环形布局且彼此相隔120°，所述位移传感器(15)的测量端安装有具有球形测头的测针(14)，在所述测针(14)接触所述三球座装置(3)中待测的精密钢球(4)时，所述测针(14)的球形测头的球心能产生轴向位移。

3.根据权利要求1或2所述的工业机器人绝对精度标定系统，其特征在于：

所述计数器(8)包括第一采集模块，所述第一采集模块至少用于获取所述末端测量装置中位移传感器输出的信号；

所述数据处理单元包括第二采集模块、第三采集模块、第一计算模块和第二计算模块，所述第二采集模块至少用于获取机器人(2)的关节角信息，所述第三采集模块至少用于获取计数器(8)发送的位移测量信息，所述第一计算模块至少用于根据第二采集模块、第三采集模块采集的信息计算所述三球座装置(3)中精密钢球(4)的理论球心坐标，所述第二计算模块至少用于依据所述精密钢球(4)的理论球心坐标与所述三球座装置(3)中精密钢球(4)的实际球心坐标之间的位置误差信息以及绝对精度标定算法进行迭代计算；

优选的，所述三球座装置中的三颗精密钢球(4)用于定义外部世界坐标系{w}，所述外部世界坐标系{w}用于描述机器人系统中的所有坐标系，基于所述三颗精密钢球(4)的球心点位置分布能够确定所述外部世界坐标系{w}的原点、XOY平面及各坐标轴的位置与方向，所述末端测量装置用于测量所述精密钢球(4)的球心相对于机器人法兰坐标系{F}的位置坐标，所述外部世界坐标系{w}与基坐标系{0}之间的初始位姿变换矩阵能够根据两者的位置安装关系获得，以及，在所述世界坐标系{w}下，所述三颗精密钢球(4)的实际球心坐标分别表示为P₁、P₂、P₃。

4.一种工业机器人绝对精度标定方法，其特征在于，所述标定方法是基于权利要求1-3中任一项所述的工业机器人绝对精度标定系统实施，并且，所述标定方法包括：

利用三球座装置(3)建立用于描述机器人基坐标系{0}的世界坐标系{w}；

采用局部指数积法建立描述于所述世界坐标系{w}下的机器人(2)的正向运动学模型，得到包含理论运动学参数的位姿变换矩阵T_w，n+1；

根据所述机器人(2)的正向运动学模型，建立描述于所述世界坐标系{w}下的机器人位置误差模型，即所述机器人末端位置误差δP与机器人初始位姿误差δt之间的映射关系，所述映射关系表示为δP＝F(δt_w，δt₁，δt₂...，δt_n，δt_n+1)或δP＝J[δt_w，δt₁，δt₂...，δt_n，δt_n+1]^T，其中误差雅可比矩阵J是运动学误差δt与机器人末端位置误差之间的误差传递矩阵；

使所述机器人(2)移动至指定位置，并使安装于机器人法兰(16)的末端测量装置(1)内各位移传感器(15)的测针(14)同时接触三球座装置(3)内的任一精密钢球(4)，且使各位移传感器(15)的测针(14)的球形测头均产生位移，采集此时各位移传感器(15)的测量信息K与机器人关节角信息q；

依据所述测量信息K计算出所述精密钢球(4)的球心相对于机器人法兰坐标系{F}的位置坐标，再根据所述位姿变换矩阵T_w，n+1与所述机器人关节角信息q，计算出所述精密钢球(4)的球心相对于所述世界坐标系{w}的理论位置坐标

将所述理论位置坐标

与所述精密钢球(4)的球心在所述世界坐标系{w}下的实际球心坐标(P₁，P₂，P₃)作差，得到机器人末端位置误差δP(δP₁，δP₂，δP₃)；

将所述机器人末端位置误差信息(δP₁，δP₂，δP₃)及相应的所述机器人关节角信息q代入绝对精度标定算法进行迭代计算，实现对机器人基坐标系运动学参数t_w及机器人连杆运动学参数t_i(i＝1，2，...，n，n+1)的标定，得到描述于所述世界坐标系{w}下的精确运动学模型。

5.根据权利要求4所述的标定方法，其特征在于具体包括：采用局部指数积法，建立机器人(2)在所述世界坐标系{w}下描述的运动学模型，表示为：

其中，^wP、^FP分别为所述精密钢球(4)的球心坐标在所述世界坐标系{w}、所述机器人法兰坐标系{F}下的表示，

代表所述世界坐标系{w}到所述基坐标系{0}的齐次变换矩阵对应的旋量，

代表相邻连杆坐标系的初始位姿矩阵

所对应的旋量，

为关节i的转轴旋量在关节坐标系{i-1}下的描述，q_i代表第i个关节变量。

6.根据权利要求4所述的标定方法，其特征在于：所述机器人位置误差模型所采用的误差参数包含机器人基坐标系的转换误差δt_w及机器人本体的连杆几何误差δt_i。

7.根据权利要求4所述的标定方法，其特征在于还包括：根据所述机器人位置误差模型，利用递归最小二乘法，在数据处理单元中建立绝对精度标定算法。

8.根据权利要求4所述的标定方法，其特征在于还包括：使机器人(2)以不同位姿对所述三球座装置(3)内的任一精密钢球(4)进行测量，且使所述不同位姿均匀分布于所述三球座装置(3)内3个精密钢球(4)周围的机器人工作空间；和/或，使所述三球座装置(3)安装于机器人目标工作空间附近。

9.根据权利要求4所述的标定方法，其特征在于还包括：将所述机器人关节角信息q代入相对于世界坐标系{w}的标定后运动学模型，计算标定后的所述精密钢球(4)的球心坐标

并与所述精密钢球(4)的实际球心坐标对比，以验证所述标定方法的有效性。

10.根据权利要求4所述的标定方法，其特征在于还包括：将标定计算得到的机器人基坐标系位姿描述参数t_w及机器人连杆运动学参数t_i(i＝1，2，...，n，n+1)补偿到实际机器人系统，以提高实际机器人系统的绝对定位精度。

Images