基于激光跟踪仪的一种工业机器人基坐标系标定方法
【技术领域】
[0001] 本发明涉及工业机器人的标定技术领域，特别是利用激光跟踪仪的一种串联式工 业机器人的基坐标标定方法。
【背景技术】
[0002] 机器人自发明以来，经过多年的发展，其技术取得许多重大的成就，机器人精度的 标定问题是其中不可或缺的一部分，目前许多机器人虽然具有较高的重复定位精度，但它 们的绝对定位精度相对来说却不高，这就使其成为了限制机器人行业发展的瓶颈之一。为 了提高机器人的绝对定位精度，机器人标定技术应运而生。
[0003] 机器人标定技术是使用参数辨识方法去处理通过先进的测量手段得到的机器人 的相关数据来识别出机器人模型的准确参数，从而提高机器人绝对定位精度的过程。国内 外的学者对机器人标定技术从建模、测量方法、等方面进行了广泛深入的研究，其中机器人 基坐标系标定对于机器人实际应用有着很实际的作用。由于机器人基坐标系的原点是不可 达的，因此，不能直接标定机器人的基坐标，这就产生了很多利用不同测量手段及工具对机 器人基坐标进行标定的方法，如利用校准物体进行标定，利用多个机器人握手操作进行标 定等，上述方法都需要安装相应末端器或者使用多个机器人，操作较为复杂；利用校准物体 进行标定，对物体本身有很高要求，精度有待考察；而通过多机器人标定则适用于多个机器 人的开发环境，对于只有单一机器人系统的条件并不适用，因此有必要发明一种采用单一 机器人系统进行标定的简单方法，且该方法一次标定后无需重复标定。
[0004] 本发明即是针对上述情况提供一种基于激光跟踪仪的机器人基坐标标定方法。本 发明涉及串联式工业机器人，这是一种在工业自动化领域应用最广的机器人。该机器人基 坐标位置不可达，为使工业机器人在使用时更加精确，需对其基坐标系进行精确定位。
[0005] 本发明借助激光跟踪仪对机器人基坐标系进行标定，通过工业机器人和激光跟踪 仪相互配合，标定基坐标系。激光跟踪仪具有快速、动态、高精度的特点，是工业测量系统中 一种高精度的大尺寸测量仪器，激光跟踪仪技术在国外航空航天制造业等重要领域中已得 到普遍应用，并发挥了其他测量仪器不可替代的作用。
【发明内容】
[0006] 鉴于以上内容，本发明提供了一种基于激光跟踪仪的工业机器人的基坐标系的标 定方法，精确地标定了基坐标系在激光跟踪仪坐标系下的位姿变换矩阵。
[0007] 为了实现上述目的，本发明采用的技术方案如下：
[0008] 步骤1，调整机器人至适当空间位置，在机器人安装面上安装三个靶标座，靶标座 相距一定距离，且不位于一条直线上；将激光跟踪仪放置在固定位置上，保证可以测量到机 器人末端位置及三个靶标座位置。将一靶标座安装在机器人末端（即6轴末端）的定位孔 上，将靶标放置于靶标座上。
[0009] 步骤2,建立各坐标系{Base}为机器人基坐标系，其位姿固定，需要测量其相对于 可测坐标系的关系；{Flange}为机器人末端坐标系，位置位于末端中心，姿态由机器人内 部确定；{Ba}为靶标坐标系，位置位于机器人末端靶球的中心，姿态与机器人基坐标系相 同；{Laser}为激光跟踪仪坐标系，位姿均由激光跟踪仪确定；{DB}为安装面靶标坐标系， 由安装面上三个靶标所确定。
[0011] 步骤4,确定位姿矩阵移动机器人至一特定位置，得到机器人内部读取的 末端6自由度位姿参数，经计算转换为4X4位姿矩阵该矩阵为{flange}相对于{Base}的位姿矩阵。
[0012] 步骤5,确定位姿矩阵:设靶球中心A在末端坐标系中的齐次坐标flangeA= (xBa，yBa，h，1)T，其中xBa，yBa为已知参数，h代表靶球中心到末端法兰平面的距离；祀标坐标
[0013] 步骤6,确定位姿矩阵，激光跟踪仪读取此时末端靶球位置信息 =JVzP'作为位姿矩阵的平移向量；控制机器人沿其X轴方向运动特定距 离，共移动n次，再分别沿y轴，z轴方向按同样方式移动特定距离，分别记录靶球中心的 位置数据（xXi，yXi，zXi)(i= 1，2, ? ? ?n)、（xYi，yYi，zYi)(i= 1，2, ? ? ?n)、（xZi，yZi，zZi)(i= 1，2,. . .n)，将所得三组数据分别用最小二乘法进行直线拟合，得到X，Y，Z三个方向向量为 nx= (ax，cx，l)、ny= (ay，cy，l)nz= (az，cz，l);经过单位化得到坐标系{Ba}各方向分量， 综上得到位姿矩阵中的旋转矩阵。
[0014] 步骤7，根据各坐标系间的相对位姿关系计算出trr。
[0015] 步骤8,确定地面靶球坐标系{DB}相对于{Laser}的位姿矩阵fL?%根据
三个靶标点确定。
[0016] 步骤5中所述h的求取方法为：使用靶球在末端平面上测量三个点，分别为点B= (xB,yB,zB)T，点C= (xDyc,zc)T、点D= (xD,yD,zD)T，向量与cl):叉乘，得到平面BCD的法 向量》= ("，匕c')7，进而得至Ij平面BCD的方程的表达式为a(x-xB)+b(y-yB)+c(z_zB) = 0,革巴
[0017] 优选的，步骤6中得到的X，Y，Z三个方向向量由于机器人运动时存在误差，并 非严格垂直，因此需经过正交化处理，得到严格垂直且单位化的方向分量，得到的X轴 方向分量为(《fY轴方向分量由表示；z轴方向分量为 /^Basc~Base.~Bas&\T. ("、.. ，'.d戈，、.€1之J：Q
[0018] 步骤6中，最后得到坐标系{Ba}相对于{Laser}的位姿矩阵为：
[0020] 本发明的有益效果为：
[0021] 仅需要激光跟踪仪设备就可实现对机器人基坐标系的标定，且靶标座固定后不需 反复拆卸，节省标定时间，同时，采用激光跟踪仪对机器人进行标定，提高了测量的精度；且 得到基坐标系与地面靶标坐标系之间的关系后，激光跟踪仪可以随意移动，该位姿变换关 系不会随着机器人运动而改变，在机器人进行实际操作时，只需测量地面靶标位置数据， 即可得到基坐标系位置数据，节约了反复标定的时间。
【附图说明】
[0022] 图1为本发明所用6自由度串联式机器人示意图
[0023] 图2为本发明所用激光跟踪仪测量系统及测量工具示意图
[0024] 图3为本发明标定过程中所需各坐标系示意图
【具体实施方式】
[0025] 为了更清楚地说明本次发明中的技术原理，下面将结合附图，对本发明进行更清 楚、完整地描述。
[0026] 典型的串联式工业机器人如图1所示，机器人安装于工作台上，图中标明了机器 人各关节旋转副。所需的测量设备激光跟踪仪采用球坐标系激光跟踪仪测量系统，其示意 图如图2所示，测量工具为靶球，可以固定在靶球座上，实现准确测量。
[0027] 调整机器人至适当空间位置，在机器人安装面上安装三个靶标座，靶标座相距一 定距离，且不位于一条直线上；将激光跟踪仪放置在固定位置上，保证可以测量到机器人末 端位置及三个靶标座位置。将一靶标座安装在机器人末端（即6轴末端）的定位孔上，将 靶标放置于各靶标座上。
[0028] 建立各坐标系如图3所示，{Base}为机器人基坐标系，其位姿固定，本发明任务就 是建立{Base}坐标系与安装面靶标坐标系之间的联系；{Flange}为机器人末端坐标系，位 置位于末端中心，姿态由机器人内部确定；{Ba}为靶标坐标系，位置位于机器人末端靶球 的中心，姿态与机器人基坐标系相同；{Laser}为激光跟踪仪坐标系，位姿均由激光跟踪仪 确定；{DB}为安装面靶标坐标系，由安装面上三个靶标所确定。
[0029] 由以上坐标系关系可以得到激光跟踪仪坐标系{JG}相对于机器人基坐标系 {Base}的位姿矩阵的表达式为
[0030]
[0031] 由于不能保证激光跟踪仪每一次测量固定在同一位置，因此引入安装面靶标坐标 系，建立基坐标系与安装面靶标坐标系的联系，该矩阵不随机器人运动和激光跟踪仪 位置变化而变化，可以准确描述基坐标位置，得到该位姿矩阵后，只需通过激光跟踪仪测量 安装面各靶标即可通过关系式得到基坐标系位置=3%
[0032] 根据上述原理，对表达式中的位姿矩阵tfh和进行求取。如 下所述：
[0033] 位姿矩阵忽fT的确定：控制机器人运动使其末端到达一个方便测量的方位。机 器人内部可以返回此时末端的位姿信息，读取末