[发明专利]基于激光跟踪仪的一种工业机器人基坐标系标定方法

摘要

本发明公开了一种基于激光跟踪仪的工业机器人基坐标系标定方法，包括安装测量所需的靶标座，对标定系统进行预处理，建立标定所需各坐标系，得到坐标系位姿关系矩阵的关系式，通过控制机器人和激光跟踪仪对各数据进行采集，求取相关的位姿矩阵，最后求得机器人基坐标系与一可定坐标系之间的位姿关系，以确定机器人基坐标系的具体位姿。本发明仅需使用激光跟踪仪设备即可实现对机器人基坐标系的标定，且标定后无需重复，节约了反复标定的时间，同时激光跟踪仪设备精度较高，求得的基坐标系数据精准度较高。

主权项

基于激光跟踪仪的一种工业机器人基坐标系标定方法，其特征在于步骤如下：(1)调整机器人至适当空间位置，在机器人安装面上安装三个靶标座，靶标座相距一定距离，且不位于一条直线上；将激光跟踪仪放置在固定位置上。将一靶标座安装在机器人末端的定位孔上，将靶标放置于靶标座上；(2)建立各坐标系：{Base}为机器人基坐标系，其位姿固定，需要测量其相对于可测坐标系的关系；{Flange}为机器人末端坐标系，位置位于末端中心，姿态由机器人内部确定；{Ba}为靶标坐标系，位置位于机器人末端靶球的中心，姿态与机器人基坐标系相同；{Laser}为激光跟踪仪坐标系，位姿由激光跟踪仪内部确定；{DB}为安装面靶标坐标系，由安装面上三个靶标所确定；(3)根据各坐标系间的变换关系，可以得到(4)确定位姿矩阵移动机器人至特定位置，得到机器人内部读取的末端{flange}自由度位姿参数，经计算转换为4×4位姿矩阵该矩阵为{Flange}相对于{Base}的位姿矩阵；(5)确定位姿矩阵设靶球中心A在末端坐标系中的齐次坐标^flangeA＝(x_Ba,y_Ba,h,1)^T，其中x_Ba,y_Ba为已知参数，h代表靶球中心到末端法兰平面的距离；靶标坐标系{Ba}相对于末端坐标系{Flange}的位姿矩阵(6)确定位姿矩阵激光跟踪仪读取末端靶球位置信息作为位姿矩阵的平移向量；控制机器人沿其x轴方向运动特定距离，共移动n次，再分别沿y轴，z轴方向按同样方式移动特定距离，分别记录靶球中心的位置数据将所得三组数据分别用最小二乘法进行直线拟合，得到X，Y，Z三个方向向量为n_x＝(a_x,c_x,1)、n_y＝(a_y,c_y,1)、n_z＝(a_z,c_z,1)；经过单位化得到坐标系{Ba}各方向分量，综上得到位姿矩阵中的旋转矩阵；(7)根据各坐标系间的相对位姿关系计算出(8)确定安装面靶球坐标系{DB}相对于{Laser}的位姿矩阵根据得到{DB}相对于基坐标系{Base}的位姿矩阵。其中坐标系{DB}由三个靶标点所确定。