[发明专利]基于激光跟踪仪的机器人末端执行器坐标系标定方法

摘要

本发明提出了一种基于激光跟踪仪的机器人末端执行器坐标系标定方法，方法中根据制孔等加工工作的实际需要，定义了工具坐标系和相机坐标系；借助于激光跟踪仪和自制的标定板为工具，定义了标定板坐标系；通过标定出在激光跟踪仪坐标系下法兰坐标系、工具坐标系、标定板坐标系的位姿矩阵，在相机坐标系下标定板坐标系的位姿矩阵，来求得工具坐标系和相机坐标系在法兰坐标系下的位姿矩阵，从而得到精确的工具坐标系和相机坐标系。

主权项

一种基于激光跟踪仪的机器人末端执行器坐标系标定方法，其特征在于：包括以下步骤：步骤1：在机器人附近放置激光跟踪仪，预热激光跟踪仪，激光跟踪仪建立默认的激光跟踪仪坐标系xmymzm；进给电机调至零位，缩回机器人末端执行器上的压力鼻，将标定板固定在机器人工作台上，调整机器人使压力鼻距离标定板平面为标准值ltp，并对标定板调平，使机器人末端执行器的主轴轴线垂直于标定板；机器人末端执行器的相机能够同时拍到标定板上呈梅花状分布的5个孔，且安装在主轴刀柄上的激光跟踪仪靶球能够接收到激光跟踪仪的激光束；示教当前点为机器人HOME1点，之后标定过程中机器人都是从HOME1点出发，保证激光跟踪仪在标定坐标系过程中有固定的参考点；所述机器人为六轴关节机器人；步骤2：测量法兰坐标系：步骤2.1：机器人从HOME1点出发，按一个方向绕第六轴旋转，用测量软件记录旋转过程中靶球的坐标，直至靶球接收不到激光跟踪仪的激光束；机器人返回HOME1点，再绕第六轴反方向旋转，用测量软件记录旋转过程中靶球的坐标，直至靶球接收不到激光跟踪仪的激光束；根据记录的靶球坐标拟合出第六轴旋转圆和第六轴旋转平面；机器人返回HOME1点，按一个方向绕第五轴旋转，用测量软件记录旋转过程中靶球的坐标，直至靶球接收不到激光跟踪仪的激光束；机器人返回HOME1点，再绕第五轴反方向旋转，用测量软件记录旋转过程中靶球的坐标，直至靶球接收不到激光跟踪仪的激光束；根据记录的靶球坐标拟合出第五轴旋转圆和第五轴旋转平面；步骤2.2：利用测量软件测得第五轴旋转圆的圆心O5点到第六轴旋转平面的距离D56，进而得到法兰坐标系xFyFzF原点OF到第六轴旋转面的距离DF6为：DF6＝D56‑H其中H为第五轴旋转圆的圆心O5点到法兰坐标系的原点距离；以第六轴旋转圆的圆心O6为中心，以第六轴旋转面的法向方向为偏移方向，向上偏移DF6，得到的点即为法兰坐标系xFyFzF的原点OF(xmF,ymF,zmF)；步骤2.3：机器人从HOME1点出发，使机器人沿着法兰坐标系xFyFzF的xF方向移动，拟合向量再沿着法兰坐标系的yF方向移动，拟合向量将第六轴旋转平面方向向下的法线作为法兰坐标系xFyFzF的zF正方向，分别比较zF正方向和向量向量的夹角：若上述两个夹角均在89.95°～90.05°范围内，则取靠近90°的夹角对应的向量作为准确方向；若只有一个夹角在89.95°～90.05°范围内，则取该夹角对应的向量为准确方向；若两个夹角均不在89.95°～90.05°范围内，则重新进行本步骤；步骤2.4：采用zF正方向和步骤2.3确定的准确方向组建平面，并得到所建平面的法向，从而得到法兰坐标系yF正方向和xF正方向；在激光跟踪仪控制软件中以原点OF、xF正方向、yF正方向构建法兰坐标系xFyFzF，得到其在激光跟踪仪坐标系xmymzm下的位姿矩阵TmF：TmF=nmFomFamFTransmF0001]]>其中omF为单位向量，nmF＝omF×amFTransmF＝(xmF,ymF,zmF)T步骤3：标定工具坐标系：步骤3.1：机器人从HOME1点出发，进给电机直线运动，拟合进给电机的进给直线，方向指向加工方向作为工具坐标系xtytzt的xt正方向；机器人保持在HOME1点不动，用激光跟踪仪标定压力鼻平面，将压力鼻平面沿工具坐标系xtytzt的xt正方向偏移，偏移量为压力鼻长度ltp，模拟出理论工件平面，理论工件平面和拟合的进给电机进给直线交点Ot(xmt,ymt,zmt)为工具中心点；步骤3.2：将法兰坐标系xFyFzF的xF正方向投影到工具坐标系xtytzt的xt正方向的切面上，得到工具坐标系xtytzt的zt正方向，再根据右手定则，得到工具坐标系xtytzt的yt正方向；以工具坐标系xtytzt的工具中心点、xt正方向、yt正方向、zt正方向构建工具坐标系xtytzt，得到其在激光跟踪仪坐标系xmymzm下的位姿矩阵Tmt：Tmt=nmtomtamtTransmt0001]]>nmt=xt→|xt→|]]>amt=yF→×xt→|yF→×xt→|]]>omt＝nmt×amtTransmt＝(xmt,ymt,zmt)T步骤4：构建标定板坐标系xbybzb，并得到标定板坐标系xbybzb在激光跟踪仪坐标系xmymzm下的位姿矩阵Tmb：步骤4.1：将靶球放在靶标座上，分别将靶标座放入到标定板中的五个孔中，保持靶标座下表面和标定板平面贴紧，测量五个孔在激光跟踪仪坐标系xmymzm下的坐标值Pmb10(xmb10,ymb10,zmb10)、Pmb20(xmb20,ymb20,zmb20)、Pmb30(xmb30,ymb30,zmb30)、Pmb40(xmb40,ymb40,zmb40)、Pmb50(xmb50,ymb50,zmb50)；步骤4.2：将标定板固定在机器人工作平台上，用靶球在标定板平面上均匀采集若干个不共线的点，排除靶球的半径尺寸，在激光跟踪仪坐标系下构建标定板平面；利用测量软件将测量的五个孔投影到标定板平面上，得到五个孔的投影点分别为Pmb1(xmb1,ymb1,zmb1)、Pmb2(xmb2,ymb2,zmb2)、Pmb3(xmb3,ymb3,zmb3)、Pmb4(xmb4,ymb4,zmb4)和Pmb5(xmb5,ymb5,zmb5)；步骤4.3：以五个孔中的中心孔的投影Pmb1为原点，以Pmb1指向孔2的投影Pmb2方向为标定板坐标系xbybzb的xb轴正方向，得到单位向量为：以标定板的法向且垂直标定板向下为标定板坐标系xbybzb的zb轴正方向，其单位向量为：由右手定则得到标定板坐标系xbybzb的yb轴正方向，其单位向量为：omb0＝amb0×nmb0标定板坐标系xbybzb在激光跟踪仪坐标系xmymzm下的位姿矩阵为：Tmb=nmbombambTransmb0001]]>其中：nmb＝nmb0omb＝omb0amb＝amb0Transmb＝(xmb1 ymb1 zmb1)T步骤5：标定相机坐标系：步骤5.1：机器人保持在HOME1点不动，打开机器人末端执行器的相机并调节相机焦距，直至在相机中清晰看到标定板上呈梅花状分布的5个孔，记录在相机自带坐标系xp0Oyp0下五个孔中心的坐标值，Ppb01(xpb01,ypb01)、Ppb02(xpb02,ypb02)、Ppb03(xpb03,ypb03)、Ppb04(xpb04,ypb04)、Ppb05(xpb05,ypb05)；步骤5.2：根据步骤4.1得到五个孔中心的坐标值，计算每两个孔之间的像素点距离lpij：lpij=(xpb0i-xpb0j)2+(ypb0i-ypb0j)2]]>其中i、j＝1～5且i≠j，依次得到lp12、lp13、lp14、lp15、lp23、lp24、lp25、lp34、lp35、lp45；步骤5.3：根据Pmb1(xmb1,ymb1,zmb1)、Pmb2(xmb2,ymb2,zmb2)、Pmb3(xmb3,ymb3,zmb3)、Pmb4(xmb4,ymb4,zmb4)和Pmb5(xmb5,ymb5,zmb5)计算对应的两个孔之间的实际距离Lpij：lpij=(xmbi-xmbj)2+(ymbi-ymbj)2+(zmbi-zmbj)2]]>其中i、j＝1～5且i≠j，得到标定板上五个孔之间的实际距离Lp12、Lp13、Lp14、Lp15、Lp23、Lp24、Lp25、Lp34、Lp35、Lp45；依次得到实际每一毫米的像素点数NijNij=lpijLpij]]>求出对应的N12、N13、N14、N15、N23、N24、N25、N34、N35、N45的平均值N；步骤5.4：得到标定板上五个孔在相机坐标系xpypzp下的坐标为Ppb1(xpb1,ypb1,zpb1)、Ppb2(xpb2,ypb2,zpb2)、Ppb3(xpb3,ypb3,zpb3)、Ppb4(xpb4,ypb4,zpb4)、Ppb5(xpb5,ypb5,zpb5)为：xpbi=xpb0i-L0/2N]]>ypbi=ypb0i-B0/2N]]>zpbi＝0其中i＝1～5，L0*B0为相机像素点实际大小；步骤5.5：标定板上五个孔中的中心孔在相机坐标系下的坐标点Ppb1(xpb1,ypb1,zpb1)为原点，为标定板坐标系xbybzb的xb轴正方向，再构建向量按照右手定则从正方向指向xb轴的正方向，得到标定板坐标系xbybzb的zb轴正方向，再以xb轴正方向和zb轴正方向按照右手定则得出yb轴正方向，从而得到标定板坐标系xbybzb在相机坐标系xpypzp中的位姿矩阵Tpb：Tpb=npbopbapbTranspb0001]]>其中：opb＝apb×npbTranspb＝(xpb1ypb1zpb1)T步骤6：依据得到的激光跟踪仪坐标系xmymzm下，法兰坐标系xFyFzF、工具坐标系xtytzt、标定板坐标系xbybzb的位姿矩阵TmF、Tmt、Tmb，和标定板坐标系xbybzb在相机坐标系xpypzp下的位姿矩阵Tpb，利用矩阵转换关系，得到在法兰坐标系xFyFzF下，工具坐标系xtytzt的位姿矩阵TFt和相机坐标系xpypzp的位姿矩阵TFp：TFt＝(TmF)‑1TmtTmp＝Tmb(Tpb)‑1TFp＝(TmF)‑1Tmb(Tpb)‑1步骤7：将工具坐标系xtytzt、相机坐标系xpypzp在法兰坐标系xFyFzF下的位姿矩阵TFt和TFp的对应参数输入到机器人对应的工具坐标系Tool1和Tool2参数表中，定义Tool1为工具坐标系xtytzt，Tool2为相机坐标系xpypzp，机器人识别Tool1和Tool2的参数，从而能够在编程人员指定的坐标系中运行工作。