0 引言

　　工业机器人具有高度柔性、通用性和易操作的特性,广泛应用于汽车、船舶、航空等工业生产领域,特别是因其具有较高的重复定位精度而广泛应用于焊接、喷涂、搬运等工作中.相对于其较高的重复定位精度,机器人绝对定位精度较低.在工业应用中,影响机器人绝对定位精度的因素很多,主要可以分为两大因素:一是机器人运动学模型误差,包括连杆长度误差、连杆距离误差;二是机器人动力学模型误差,主要包括机器人关节传递误差、齿轮传动误差、运动摩擦等.目前提高机器人绝对定位精度的方法主要有两种,一种是对机器人的运动学模型参数进行重新标定.基于运动学模型的参数标定主要包括运动学模型建模、测 量、参数识别和误差补 四个部 分。

　　Veitschegger等在DGH模型的基础上提出了MDGH模型,揭示了机器人连杆参数的微小变化和机器人末端位姿变化之间的线性关系.国内基于模型的参数标定方法普遍是在建立DGH运动学模型的基础上

　　,识别出机器人的几何参数并进行误差补偿.机器人标定技术不仅需要深入研究复杂的机器人正逆运动学模型和参数识别算法,而且存在两方面的显著局限,一是补偿后定位误差为0.2mm,精度几乎没有提升空间。二是并非对测量空间内所有点均能实现有效补偿.另一种提高机器人定位精度的方法是,在工业机器人末端执行器上添加反馈系统,如光学测量系统，视觉测量系统和力检测系统。wang等使用激光跟踪仪实时补偿工业机器人末端三轴动力头的运动误差,但为了降低系统复杂性与成本,该方法只使用在三自由度的机器人上.Vincze等提出了一种采用激光跟踪仪与视觉系统实时测量机器人位姿的方法,其中机器人的位置信息由激光跟踪仪获取,机器人的姿态由激光跟踪仪与视觉系统共同获取.

　　为了提高机器人的定位精度,本文提出一种基于工业机器人末端位置和姿态闭环反馈的定位补偿方法.

　　１ 基于位姿反馈的精度补偿原理　　

　　 １１ 系统组成与集成

　　基于末端位姿反馈的机器人精度补偿系统主要包括工业机器人和 激光跟踪测量系统两个部分.工业机器人作为执行主体,主要是实现对末端执行器或工件的夹持和定位.末端执行器或工件通过法兰盘固定安装在工业机器人的末端法兰上,与工业机器人构成一个整体.机器人通过调整末端的位姿来实现末端执行器或工件的定位.激光跟踪测量系统用于实时地测量机器人末端执行器或工件的位置和姿态，根据刚体的特性,只需要在末端执行器或工件上布置三个以上不在一条直线上的靶标点,就可以实现对位置和姿态的测量.对此,开发了专用的测量软件,可以通过比较靶标点的设计理论值和激光跟踪仪的实际测量值,计算末端执行器或工件的位姿偏差.实际上,激光跟踪仪与工业机器人之间构成了一个基于末端位姿的闭环反馈系统,激光跟踪仪作为机器人的外置传感器,实时监测并返回机器人末端的位姿误差。

　　工业机器人和激光跟踪仪测量系统通过OPC服务器进行数据通信,如图2所示.这些数据包括位姿偏差数据、机器人坐标系数据等.具体而言,测量软件驱动激光跟踪仪完成对靶标点的自动化测量任务,并通过读取 OPC服务器中的机器人法兰坐标系数据来计算机器人的位姿偏差,并将偏差数据写入OPC服务器.机器人在完成定位后需要往OPC服务器中写入当前机器人法兰坐标系,并读取来自测量软件的位姿偏差数据.

　　1.2 位姿补偿方法

　　由于影响机器人本身的定位精度的因素很多,包括运动学模型误差、齿轮传动误差、关节运动摩擦等动力学模型误差和温度、载荷等,机器人在位姿补偿过程中也会带入误差.因此,基于位姿反馈的工业机器人定位精度补偿方法的实现是一个逐渐逼近理论位姿的过程,具体操作流程如下:

　　(1)根据 CAD 模型,确定机器人末端的理论工作位置和姿态,规划机器人运动路径,并编制相应的机器人控制程序.根据机器人末端的理论位姿,获得机器人末端执行器或工件上靶标点的理论坐标.

　　(2)运行机器人控制程序,实现机器人在自身精度条件下的初定位.

　　(3)机器人完成定位后,激光跟踪仪测量靶标点的实际坐标.通过与其理论坐标进行匹配,计算当前机器人末端执行器或工件的位姿偏差.

　　(4)进行姿态偏差评判,若位姿偏差满足工艺要求,流程跳转执行(6);若位姿偏差超出工艺要求,则需要对机器人的位姿进行修正,继续执行(4).

　　(5)通过工业局域网络,激光跟踪仪将位姿偏差数据传输给工业机器人控制系统.工业机器人根据位姿偏差数 据对机器人末端的位姿进行调整.机器人调整完成后,流程返回(3).

　　(6)机器人定位结束.

　　２　机器人末端位姿误差评价　　

　　 ２.１机器人位姿误差描述

　　机器人位姿误差包括机器人末端在机器人坐标系下的位置偏差和姿态偏差.末端执行器或工件通过法兰固定安装在机器人末端后,与机器人法兰构成一个整体.因此,机器人末端执行器或工件的位姿误差问题可以转换为机器人末端法兰的位姿误差问题.机器人位姿反馈补偿流程如图3所示.

　　 ２.1.1 机器人末端位置误差

　　机器人末端的位置误差表示机器人末端的实际位置和理论位置之间的差值,即：ΔT=T-To。式中,T 和To分别为机器人末端的实际位置和理论位置.

　　 ２.１.２ 机器人末端姿态误差

　　机器人末端姿态误差用四元数表示:Δq=[q0 q1 q2 q3]=[cos(θ/2) axsin(θ/2) aysin(θ/2) azsin(θ/2)]式中,[ax　ay　ax]是对应的欧拉旋转轴;θ是欧拉旋转角.

　　该四元数表示机器人末端的当前姿态和理论姿态的差值,即在当前机器人末端姿态下,机器人末端通过围绕[ax　ay　az]T旋转θ角度后即可得到理论姿态.

　　一个刚体的位置和姿态可以通过不共线的三个点的位置来确定.工件通过法兰安装在机器人末端后,可将工件与机器人末端看作是一个刚体.在工件上布置三个以上的靶标点,通过这些靶标点的位置就可以确定当前机器人末端的实际位姿.进一步通过比较靶标点的理论值和实际值,运用刚性匹配算法可以得到机器人末端的位姿偏差.

　　假设靶标点在机器人坐标系 W 下的理论位置为WPai,实际测量值为WPbi.首先,需要将靶标点的理论值和测量值都转换到工业机器人的工具坐标系(与机器人末端法兰坐标系F 重合)下:公式4 5式中,WFT 为机器人末端法兰坐标系F 到机器人基坐标系W 的齐次矩阵;FTT 为机器人末端执行器或工件坐标系T到机器人末端法兰坐标系F 的齐次矩阵.

　　根据刚性匹配原理,靶标点的理论坐标和实际坐标之间满足如下关系:Pbi=ΔRPai+ΔT+ξi式中,ΔR 和ΔT 分别为姿态偏差和位置偏差;ξi 为第i个靶标点的测量误差.

　　为了求解位姿偏差,构建如下最小二乘模型:Σ =∑Ni=||Pbi- (ΔRPai+ΔT)||2

　　式中,N 为靶标点的数量.令则最小二乘模型可以表示为：

　　最后,位置误差矩阵可以通过下式计算得到:ΔT =P′bi-ΔRP′ai

　　３ 实验

　　本文通过实验对基于位姿闭环反馈的机器人定位精度和重复定位精度进行了验证.实验中,工 业 机 器 人 采 用 库 卡 公 司 的 重 载 机 器 人KR360L280G2(最大载荷2800N),标称重复定位精度为0.08mm.测量设备采用徕卡公司的激光跟踪仪ATG901LR.该仪器在全量程范围内(水平方 向360°,垂 直 方 向 正 负 45°,最 大 测 量 距 离80m)对单点的测量不确定度为基础值15μm与增量值(每米增量值为6μm)之和.在机器人末端安装三个靶标点作为位姿检测点.

　　为了对机器人在经过位姿闭环反馈补偿前后的末端位姿精度和重复定位精度进行比较,在整个机器人的作业空间内随机选择了若干位姿作为理论参考位姿.整个实验过程可以按如下步骤进行:首先,通过机器人运动程序驱动机器人自行运动到目标位姿.在机器人定位完成后,通过激光跟踪仪测量末端靶标点的坐标,来计算当前的位姿偏差.接着,运用本文提出的基于位姿闭环反馈的位姿精度补偿方 法对机器人的末端进行补偿,然后记录补偿以后的机器人位姿误差.最后对补偿前后机器人的定位精度进行比较.以其中某个参考位姿的补偿过程为例进行说明,图4记录了整个位姿补偿过程中机器人末端位姿偏差的缩减情况.从图4可以看出,在经过仅仅三次位姿误差补偿后,机器人的末端位姿便得到了明显的 提 高,其中 位 置 误 差 从 1.4 mm 减 少 到0.081mm,角度误差从0.712°减少到0.013°.显然,基于位姿闭环反馈的机器人末端位姿补偿方法具有很好的收敛性和较高的位姿补偿效率.

　　实验中,为了获得经过位姿闭环反馈补偿后的机器人的定位精度和重复定位精度,对于每一个参考位姿,重复多次从同一个方向对机器人的位姿进行补偿和定位,记录每次机器人最终实际定位位姿与参考位姿的偏差值.然后计算位姿偏差的均值作为位姿闭环反馈系统的定位精度,同时计算位姿偏差的标准差作为位姿闭环反馈系统的重复定位精度.最后,对工业机器人在位姿反馈补偿前后位姿定位精度和重复定位精度进行比较.图5是工业机器人补偿前后的位姿定位精度对比图,图中横坐标为对应的参考位姿编号.从图中可以非常明显地看出,经过位姿闭环反馈补偿后,工业机器人的末端位姿精度得到了明显的提高.总体来说,经过补偿后工业机器人的末端位置误差可降低到0.09mm以下,最大幅度可降低到0.05mm,姿态误差降低0.015°以下,最大幅度可降低到0.012°.相比于补偿前,机器人末端位置 误 差 最 大 幅 度 降 低95%,姿 态 误 差 降 低92%.图6是工业机器人补偿前后的位姿的重复定位精度对比图,图中横坐标为对应的参考位姿编号.从图中可以看出,经过位姿补偿后,工业机器人的重复定位精度也有了很大的提高,其中位置误差 从 补 偿 之 前 的0.08~0.14mm降 低 到 了0.02~0.05mm,姿态误差从补偿之前的0.015°~0.03°降低到了0.003°~0.005°.显然,实验结果证明，本文提出的基于位姿闭环反馈的工业机器人定位补偿方法可以同时显著提高机器人的绝对定位精度和重复定位精度.

　　４ 结论

　　本文提出了一种基于末端位置和姿态闭环反馈的工业机器人绝对定位补偿方法.该方法使用激光跟踪系统来测量机器人末端上的靶标点来获得机器人的当前位姿,并通过与靶标点的理论位置匹配来计算机器人末端位姿偏差.工业机器人则根据位姿偏差数据对末端的位姿进行修正.激光跟踪测量系统与机器人系统通过工业局域网和OPC服务进行数据通信.最后通过实验验证了基于位姿闭环反馈的机器人绝对定位补偿方法的有效性,实验结果证明该方法可以显著降低工业机器人的定位误差.