![机器人智能运动规划技术](https://wfqqreader-1252317822.image.myqcloud.com/cover/78/41865078/b_41865078.jpg)
2.2 机器人接触式测量
2.2.1 测量加工一体化机器人
加工对象的几何非确定性是机器人高精度加工的难点。通常的方法是由操作者标定机器人与其加工对象之间的几何关系,精确地测量加工对象,再进行空间坐标变换,将测量坐标系下的坐标变换为机器人坐标系下的坐标。这种传统方法效率较低、过程复杂,为了简化工作流程、提高工作效率,采用测量加工一体化方法,在机器人末端执行器上安装测量装备,在机器人坐标空间内直接测量其加工对象的几何形状和机器人与其加工对象的空间几何关系,从而使机器人在对非确定性因素进行认知的基础上进行智能轨迹规划。
搅拌摩擦焊接机器人与大型复杂曲面薄壁零件如图2-1所示。机器人装配体与关节坐标示意图如图2-2所示。机器人本体具有三个平动自由度和两个转动自由度,共五个自由度。放置工件的工作台具有一个旋转自由度,加工回转零件时,转台能够辅助机器人进行焊接工位转换。
搅拌摩擦焊接机器人测量系统只包括X、Y、Z、A、B、W 六个主体部分的运动轴,不包含转台部分,其运动学DH参数见下页表,其中ai-1是从zi-1到zi沿xi-1测量的距离;αi-1是从zi-1到zi绕xi-1旋转的角度;di是从xi-1到xi沿zi测量的距离;θi是从xi-1到xi绕zi旋转的角度。DH基准坐标系如图2-3所示。
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_26_01.jpg?sign=1739362423-GVFx10VCBdaAbjHUKg8yapX7xLhwALEm-0-0076b2b9c81dbb02d0ccad5948637344)
图2-1 搅拌摩擦焊接机器人与大型复杂曲面薄壁零件
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_26_02.jpg?sign=1739362423-1bD4jFpDWmQwG2xqmztSvHBxcuyk86HN-0-772b6d9efdc6cf5bb4dd549fd4ef6d1a)
图2-2 机器人装配体与关节坐标示意图
搅拌摩擦焊接机器人DH参数表
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_26_03.jpg?sign=1739362423-eYUkd46ltyvkoTUVZfTm7k4SzXwegiCX-0-b1105b587e5196f3ed2de62bff381986)
整个工件是一个放置在转台上的大型回转体,工件与工装示意图如图2-4所示。理想焊缝应该与工件旋转轴轴心处于同一个平面内。但是,由于单个薄壁工件是冲压成形的,其本身加工精度不高,装夹时也存在变形和误差。因此,很难通过理想模型确定加工轨迹,需要在规划焊接加工轨迹前进行焊缝测量。
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_27_01.jpg?sign=1739362423-IMDBn48KCH3V3SURRUB5JTkozIWFwGz4-0-889438f18c71f573fb48f1b89c439416)
图2-3 搅拌摩擦焊接机器人DH基准坐标系
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_27_02.jpg?sign=1739362423-m9ppdl5VL5qDB8KYpezSdXBWi6ahqOIH-0-50abcf561c146dcdc14b9cf34fc67d52)
图2-4 工件与工装示意图
2.2.2 接触式测量原理
接触式测头采用海德汉高精度触发式TP230测头,测量原理如图2-5所示,测头碰触工件表面时后会立即输出高电平TTL信号。机器人控制器在收到触发信号上升沿后实时读取各关节坐标位置,保存在寄存器中。对于第i个测量点Mi,可以表示为
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_27_03.jpg?sign=1739362423-rW8BtQ8MwXHxI3zk43SHCIBZ82cOnDc1-0-e60c632057968fe1de7a5282ecab1b67)
式中,分别为X轴、Y轴、Z轴、A轴、B轴、W轴在测头上升沿触发时的位置。将P C作为上位机,在VC平台上建立机器人轨迹规划与仿真系统,通过以太网和机器人控制器协议读取机器人控制器寄存器中的各轴位置。在上位机轨迹规划系统中利用机器人运动学方法由各轴位置计算出测头末端球心空间坐标,测量过程示意图如图2-6所示。
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_27_05.jpg?sign=1739362423-lC6ChIrgp00z4vqkeEF6Cq1QdyvXFtFi-0-71b4dfc45497bb876e956b75f304afaa)
图2-5 接触式测量原理
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_28_01.jpg?sign=1739362423-DVnu2fkTYJ8nWstEpfLjq791yWdWfSrP-0-85c750f27a5b191a7aa907533976ae53)
图2-6 测量过程示意图
根据机器人运动学,可以得到各关节坐标变换矩阵分别为
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_28_02.jpg?sign=1739362423-qnYsig6uEeajnYl88PYx7EMc52DlTM1j-0-2a519bd2c7d5be136bfbf4e216a031e9)
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_28_03.jpg?sign=1739362423-hsX9sEGHGXHYw7jYzz5BRyOOSpEGKUKI-0-9bcdedc70b1ac7a66070dae324f241ff)
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_28_04.jpg?sign=1739362423-qGNZ43IMd37a9Hi8vFcOLYNi6S7RPVIO-0-910d5092354ab27f8274dc5eeaa7b6b9)
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_28_05.jpg?sign=1739362423-zcmTyIR2BaqplYdsuwG9qFx1TVlvUIWW-0-509c82ea84558b8b8848fb45765e4792)
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_28_06.jpg?sign=1739362423-zLPoJwVKdagFHItZgEcZ1DhsGLiJCVu6-0-138e95f29127bda07ee289e01b791e82)
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_28_07.jpg?sign=1739362423-gMp2kAzZHQGgtElsg0kNnbNYM4IlOuSG-0-9406add48eb8d5052dcadc4f7fa71c91)
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_28_08.jpg?sign=1739362423-v2Qv19LYI2WYCiICe5wM81ADwCk75sbi-0-edecad5fc402daf4e04acd3b2baa1bd6)
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_29_01.jpg?sign=1739362423-7XNB9UvfrXesMDzJ4jIxS6ORUO4zfitl-0-aa97dfb48fbdcb61509d8fe29ddfd756)
由式(2-1)可知,被测点在机器人全局坐标系中的空间坐标[px;py;pz]与关节空间的映射关系为
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_29_02.jpg?sign=1739362423-Z49GdfE7mMEpRi76S3WzuNIxQVJcsTiF-0-86bc83e01e8441f0ea45b40764b490be)
由于机器人各轴位置与末端坐标位置存在多对一的映射关系,而且该测量方法只是对空间位置进行测量,然后再进行刀具姿态的估计,因此,测量过程中FSW机器人可以以任意姿态碰触焊缝。
根据如上过程计算得到的焊缝位置是测头球心的位置。这些测量点与实际焊缝之间存在一个测头半径的偏置距离。偏置方向是被测工件在焊缝测量接触点处的曲面法向矢量方向。为了得到实际焊缝位置,需要对测量点位置进行反向偏置。
2.2.3 测量适应性分析
利用接触式测头对焊缝进行离散点随机测量的实际过程如图2-7所示。理想状态下,测头应该精确地碰触焊缝位置,如图2-8中情况一所示。但在实际测量过程中,测头不可能恰好碰触焊缝位置。这是因为一方面,测头是一个球体,焊缝是非理想加工状态下的装夹缝隙,操作者的视觉误差致使测头与焊缝
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_29_03.jpg?sign=1739362423-xnWIupTdLkDkDpGUmsrcMdNXMWUPHLhK-0-b1d6d4d4703430e7033b776fb8b764d4)
图2-7 实际焊缝测量
实际位置之间存在微小偏移,如图2-8中情况二所示;另一方面,由于工件变形和装夹误差致使装夹后的焊缝存在高度差,这种情况下应选择高度较低的工件一侧进行测量,如图2-8中情况三所示。
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_30_01.jpg?sign=1739362423-VDQtABPpVTd2Yx8IfmJUK4uGG5qxdUZG-0-791ae3c07e7110002c20f436738fbddf)
图2-8 焊缝测量情况
尽管测量过程中在工件表面垂直于焊缝的方向上不可避免地存在测量误差,但只要能够保证垂直于工件表面方向的测量精度,则该测量误差对搅拌摩擦焊接质量的影响较小。这是因为搅拌摩擦焊接工艺为了保证焊接质量,避免出现焊缝压深过大或轴肩离开焊缝表面的情况,在垂直于工件表面方向对精要要求较高。如图2-9所示,在工件表面垂直于焊缝的方向上,搅拌头的高速旋转产生的热量会形成一个较宽的塑性区,只要测量误差小于塑性区宽度,焊接质量就能够得到保证。
![](https://epubservercos.yuewen.com/08023D/21889223108628106/epubprivate/OEBPS/Images/978-7-111-67745-1_30_02.jpg?sign=1739362423-0P08JadMnPBhjMjR67Z8PU4YaktP26ph-0-55ba7feda6ec4366da02637d3c038807)
图2-9 测量偏移焊缝的焊接过程示意图