《抛物线轨迹定向切线恒速焊接机器人装置.pdf》由会员分享，可在线阅读，更多相关《抛物线轨迹定向切线恒速焊接机器人装置.pdf（21页珍藏版）》请在专利查询网上搜索。
1、(10)申请公布号 CN 102886591 A(43)申请公布日 2013.01.23CN102886591A*CN102886591A*(21)申请号 201210370172.9(22)申请日 2012.09.27B23K 9/12(2006.01)B23K 9/133(2006.01)B23K 9/028(2006.01)(71)申请人清华大学地址 100084 北京市海淀区100084信箱82分箱清华大学专利办公室(72)发明人都东 潘际銮 王力 张文增陈强 刘洪冰 邹怡蓉(74)专利代理机构北京鸿元知识产权代理有限公司 11327代理人邸更岩(54) 发明名称抛物线轨迹定向切线恒速。
2、焊接机器人装置(57) 摘要抛物线轨迹定向切线恒速焊接机器人装置，属于焊接机器人技术领域。该装置包括X轴平移组件和Y轴平移组件形成的机械臂、Z轴转台、控制器、焊接电源和焊枪等；带有抛物线轨迹焊缝的工件随工件安装台受控转动，焊枪随X轴、Y轴平移组件受控移动。本发明采用独立运动的三自由度机构实现了对工件抛物线轨迹焊缝高质量焊接功能；进行焊接时，焊枪始终处于抛物线轨迹焊缝焊接点处的法线上，焊接方向为抛物线轨迹的切线方向，且该切线始终朝向预先设定某个固定方向上，焊接速度保持恒定，焊接质量高，效率高，且制造、维修和使用成本低；由于在焊接中的每一点，焊枪与工件上的焊缝焊点均始终保持一种相对位置和姿态，因此。
3、可以达到优化的焊接效果。(51)Int.Cl.权利要求书2页 说明书13页 附图5页(19)中华人民共和国国家知识产权局(12)发明专利申请权利要求书 2 页 说明书 13 页 附图 5 页1/2页21.一种抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：包括机械臂、Z轴转台（3）、控制器（4）、焊接电源（5）和焊枪（6）；所述机械臂包括依次串联起来的X轴平移组件（1）和Y轴平移组件（2）；待焊工件的焊缝中心线为抛物线轨迹；所述X轴平移组件包括第一基座（11）、X轴电机（12）、X轴传动机构（13）和第一滑块（14）；所述第一基座与底座（8）固接，所述X轴电机与第一基座固接，所述X轴电机的输。
4、出轴与X轴传动机构的输入端相连，所述X轴传动机构的输出端与第一滑块相连，所述第一滑块滑动镶嵌在第一基座上；所述Y轴平移组件包括第二基座（21）、Y轴电机（22）、Y轴传动机构（23）和第二滑块（24）；所述第二基座与第一滑块固接；所述Y轴电机与第二基座固接，所述Y轴电机的输出轴与Y轴传动机构的输入端相连，所述Y轴传动机构的输出端与第二滑块相连，所述第二滑块滑动镶嵌在第二基座上；所述Z轴转台包括第三基座（31）、Z轴电机（32）、Z轴传动机构（35）、关节轴（33）和工件安装台（34）；所述第三基座与底座（8）固接；所述Z轴电机与第三基座固接，所述Z轴电机的输出轴与Z轴传动机构的输入端相连，所述。
5、Z轴传动机构的输出端与关节轴相连，所述关节轴活动套设在第三基座中，所述工件安装台固定套接在关节轴上；所述焊枪固定安装在第二滑块上；所述控制器通过控制线路分别与X轴电机、Y轴电机和Z轴电机相连，控制X轴电机、Y轴电机和Z轴电机同时转动；所述控制器与焊接电源相连；需要焊接的工件固定安装在工件安装台上；工件上具有抛物线轨迹的焊缝；设所述第一滑块相对于第一基座的滑动方向为直线q；设所述第二滑块相对于第二基座的滑动方向为直线s；设所述关节轴的中心线为直线u；直线q、直线s和直线u三者两两垂直；设直线q与直线s构成平面Q1，设工件上焊缝中心线的抛物线轨迹所在平面为平面Q2，平面Q1与平面Q2重合；建立世界。
6、坐标系C，所述世界坐标系C的原点为关节轴的中心OC，世界坐标系C的横轴xC与直线q平行，xC轴的正方向为离开抛物线轨迹的方向，也是第一滑块相对于第一基座滑动的正方向，世界坐标系C的纵轴yC与直线s平行，yC轴的正方向为离开抛物线轨迹的方向，也是第二滑块相对于第二基座滑动的正方向，该世界坐标系C与第三基座固接；建立抛物线坐标系A，所述抛物线坐标系A的原点为抛物线轨迹的顶点OA，抛物线坐标系A的纵轴yA与抛物线对称轴重合，抛物线坐标系A的横轴xA过抛物线坐标系A的原点与纵轴垂直且和抛物线在同一平面内，所述抛物线坐标系A与带抛物线轨迹焊缝的工件固接；点OC在抛物线坐标系A中的坐标值为(dx,dy)，。
7、(dx,dy)为已知常量；设焊接速度为预设值vw，设工件绕关节轴逆时针转动角速度为；抛物线上任意一点坐标(XA，YA)均满足抛物线在抛物线坐标系中的轨迹方程XA2=-2pYA，p0为一常数；设所述抛物线坐标系的xA轴与xC轴的夹角为，090；所述焊枪的中心线与yC轴平行，焊枪的中心线与抛物线轨迹的交点为焊点P；所述焊点P在世界坐标系C中的坐标为(XC,YC)；设焊枪的末端点T在世界坐标系C中的坐标为(XTC,YTC)；为焊点P与关节轴中心OC的连线与xC轴所夹的锐角；所述焊枪的末端点T与焊点P的距离为预设值La；焊枪的末端点T和焊点P沿xC轴的速度相等，均为v1，相对世界坐标系C而言；焊枪的末。
8、端点T和焊点P沿yC轴的速度相等，均为v2，相对世界坐标系C而言；控制器通过控制工件和焊枪满足下列关系：权 利 要 求 书CN 102886591 A2/2页3XTC=XC,YTC=YC+La,v1=M，v2=N，其中，所述与时间t的关系是的积分；在预设了初始时刻的初始角度后，可以基于上述公式通过逐点计算方法计算得到与时间t的关系。2.如权利要求1所述的抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：所述X轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。3.如权利要求1所述的抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：所述Y轴传动机构采用丝杠螺母。
9、传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。4.如权利要求1所述的抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：所述Z轴传动机构（35）为减速机。5.如权利要求1所述的抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：还包括送丝机（9），控制器与送丝机相连，送丝机与焊枪相连。权 利 要 求 书CN 102886591 A1/13页4抛物线轨迹定向切线恒速焊接机器人装置 技术领域0001 本发明属于焊接机器人技术领域，特别涉及一种抛物线轨迹定向切线恒速焊接机器人装置的结构设计。 背景技术0002 在航天、航空、船舶和石油化工等领域，大量存在各种具有抛物线弧形的设备。在设。
10、备的生产过程中，需要将工件沿抛物线弧轨迹焊接起来。为了获得高质量的焊缝，工件焊接时需要同时达到如下多个目标：焊接时焊枪要求始终处于平焊位置，焊枪始终竖直向下，且焊接方向与抛物线形轨迹在该点的切线方向一致，该切线必须为水平线，焊接速度保持恒定。目前，抛物线轨迹的焊接多采用人工焊接方式，少数也有采用6轴垂直关节型工业机器人进行焊接。前者对工人的技术水平要求高且工人的劳动强度大、焊接效率低，焊接质量不易保证；后者设备复杂，生产和维护成本高。 发明内容0003 本发明的目的是针对已有技术的不足之处，提供一种抛物线轨迹定向切线恒速焊接机器人装置，该装置可方便实现对工件抛物线轨迹焊缝的焊接，采用该装置进行。
11、焊接时，焊枪始终处于抛物线轨迹焊缝上在焊接点处的法线，焊接方向为抛物线轨迹的切线方向，且该切线始终朝向预先设定某个固定方向上以保证获得优化的焊接质量，焊接速度保持恒定，焊接质量高，效率高，装置的制造、维修和使用成本低。 0004 本发明的技术方案如下： 0005 本发明提供的一种抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：包括机械臂、Z轴转台、控制器、焊接电源和焊枪；所述机械臂包括依次串联起来的X轴平移组件和Y轴平移组件；待焊工件的焊缝中心线为抛物线轨迹； 0006 所述X轴平移组件包括第一基座、X轴电机、X轴传动机构和第一滑块；所述第一基座与底座固接，所述X轴电机与第一基座固接，所述X。
12、轴电机的输出轴与X轴传动机构的输入端相连，所述X轴传动机构的输出端与第一滑块相连，所述第一滑块滑动镶嵌在第一基座上； 0007 所述Y轴平移组件包括第二基座、Y轴电机、Y轴传动机构和第二滑块；所述第二基座与第一滑块固接；所述Y轴电机与第二基座固接，所述Y轴电机的输出轴与Y轴传动机构的输入端相连，所述Y轴传动机构的输出端与第二滑块相连，所述第二滑块滑动镶嵌在第二基座上； 0008 所述Z轴转台包括第三基座、Z轴电机、Z轴传动机构、关节轴和工件安装台；所述第三基座与底座固接；所述Z轴电机与第三基座固接，所述Z轴电机的输出轴与Z轴传动机构的输入端相连，所述Z轴传动机构的输出端与关节轴相连，所述关节轴。
13、活动套设在第三基座 中，所述工件安装台固定套接在关节轴上； 0009 所述焊枪安装在第二滑块上；所述控制器通过控制线路分别与X轴电机、Y轴电机说 明 书CN 102886591 A2/13页5和Z轴电机相连，控制X轴电机、Y轴电机和Z轴电机同时转动；所述控制器与焊接电源相连；需要焊接的工件固定安装在工件安装台上；工件上具有抛物线轨迹的焊缝； 0010 设所述第一滑块相对于第一基座的滑动方向为直线q；设所述第二滑块相对于第二基座的滑动方向为直线s；设所述关节轴的中心线为直线u；直线q、直线s和直线u三者两两垂直；设直线q与直线s构成平面Q1，设工件上焊缝中心线的抛物线轨迹所在平面为平面Q2，平面。
14、Q1与平面Q2重合； 0011 控制器控制X轴电机、Y轴电机和Z轴电机同时转动； 0012 建立世界坐标系C，所述世界坐标系C的原点为关节轴的中心OC，世界坐标系C的横轴xC与直线q平行，xC轴的正方向为离开抛物线轨迹的方向，也是第一滑块相对于第一基座滑动的正方向，世界坐标系C的纵轴yC与直线s平行，yC轴的正方向为离开抛物线轨迹的方向，也是第二滑块相对于第二基座滑动的正方向，该世界坐标系C与第三基座固接； 0013 建立抛物线坐标系A，所述抛物线坐标系A的原点为抛物线轨迹的顶点OA，抛物线坐标系A的纵轴yA与抛物线对称轴重合，抛物线坐标系A的横轴xA过抛物线坐标系A的原点与纵轴垂直且和抛物线。
15、在同一平面内，所述抛物线坐标系A与带抛物线轨迹焊缝的工件固接； 0014 点OC在抛物线坐标系A中的坐标值为(dx,dy)，(dx,dy)为已知常量； 0015 设焊接速度为预设值vw，设工件绕关节轴逆时针转动角速度为；抛物线上任意一点坐标(XA，YA)均满足抛物线在抛物线坐标系中的轨迹方程XA2=-2pYA，p0为一常数；设所述抛物线坐标系的xA轴与xC轴的夹角为，090；所述焊枪的中心线与yC轴平行，焊枪的中心线与抛物线轨迹的交点为焊点P；所述焊点P在世界坐标系C中的坐标为(XC,YC)；设焊枪的末端点T在世界坐标系C中的坐标为(XTC,YTC)；为焊点P与关节轴中心OC的连线与xC轴所夹。
16、的锐角；所述焊枪的末端点T与焊点P的距离为预设值La；焊枪的末端点T和焊点P沿xC轴的速度相等，均为v1，相对世界坐标系C而言；焊枪的末端点T和焊点P沿yC轴的速度相等，均为v2，相对世界坐标系C而言； 0016 控制器控制工件和焊枪满足下列关系： 0017 0018 0019 XTC=XC, 0020 YTC=YC+La, 0021 0022 0023 v1=M， 0024 v2=N， 0025 其中， 说 明 书CN 102886591 A3/13页60026 0027 0028 所述与时间t的关系是的积分；在预设了初始时刻的初始角度后，可以基于上述公式通过逐点计算方法计算得到与时间t的关。
17、系。 0029 本发明所述的抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：所述X轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。 0030 本发明所述的抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：所述Y轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。 0031 本发明所述的抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：所述Z轴传动机构为减速机。 0032 本发明所述的抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：还包括送丝机，控制器与送丝机相连，送丝机与焊枪相连。 0033 本发明与现有技术相比，。
18、具有以下优点和突出性效果： 0034 该装置采用独立运动的三自由度机构实现了对工件抛物线轨迹焊缝高质量焊接功能，采用该装置进行焊接时，焊枪始终处于抛物线轨迹焊缝上在焊接点处的法线，焊接方向为抛物线轨迹的切线方向，且该切线始终朝向预先设定某个固定方向上，焊接速度保持恒定，焊接质量高，效率高，装置的制造、维修和使用成本低；由于在焊接中的每一点，焊枪与工件上的焊缝焊点均始终保持一种相对位置和姿态，因此可以达到优化的高质量焊接效果；所设定的方向可以是任意方向，例如：当抛物线轨迹处于竖直的立面上时，将焊枪保持在竖直方向上，且焊接方向始终保持在水平方向上，从而获得平焊位置的高质量焊接效果；例如：当抛物线轨。
19、迹处于水平面上时，将焊枪和焊接方向均同时始终保持在水平方向上，从而获得横焊位置的高质量焊接效果。 附图说明0035 图1是本发明的抛物线轨迹定向切线恒速焊接机器人装置的一种实施例的立体视图。 0036 图2是图1所示实施例的正面外观图。 0037 图3是图1所示实施例的侧视图。 0038 图4是图1所示实施例中控制器、焊接电源、焊枪、X轴电机、Y轴电机和Z轴电机的连接关系示意图。 0039 图5是本发明的抛物线轨迹定向切线恒速焊接机器人装置的实施例的坐标系建立情况、各参量几何关系的原理示意图。 0040 图6是具体计算例子中坐标系建立情况示意图，在该例中，世界坐标系的原点刚好在抛物线坐标系的纵。
20、轴的负半轴上。 0041 图7是微动分析原理示意图，图中，实线为当前位置，虚线为关节轴转动一个d角度后的位置。P1为当前焊点，也是当前抛物线轨迹上的最高点，焊枪的中心线位于该点处说 明 书CN 102886591 A4/13页7抛物线轨迹的法线方向，P1为工件上的当前焊点在关节轴转动一个d角度后的位置，P2为关节轴转动一个d角度后的下一个焊点，该新焊点也是抛物线轨迹在下一个位置时的最高点，那一时刻焊枪的中心线依旧位于新焊点处抛物线轨迹的法线方向。 0042 图8、图9、图10、图11分别是通过本发明所述公式和所给逐点计算程序方法计算的一个例子的、XC、YC、v1、v2分别与时间t的关系曲线。 。
21、0043 在图1至图11中： 0044 1X轴平移组件， 11第一基座， 12X轴电机， 0045 13X轴传动机构，14第一滑块， 0046 2Y轴平移组件， 21第二基座， 22Y轴电机， 0047 23Y轴传动机构，24第二滑块， 0048 3Z轴转台， 31第三基座， 32Z轴电机， 0049 33关节轴， 34工件安装台，35Z轴传动机构， 0050 4控制器， 5焊接电源， 6焊枪， 0051 61焊枪中心线， 70工件， 71抛物线轨迹焊缝， 0052 8底座 9送丝机， 0053 q第一滑块相对于第一基座的滑动方向的直线； 0054 s第二滑块相对于第二基座的滑动方向的直线； 。
22、0055 u关节轴的中心线的直线； 0056 C世界坐标系，该世界坐标系的原点OC为关节轴的中心，横轴xC为水平向右，纵轴yC为竖直向上，该世界坐标系与第三基座固接； 0057 A-抛物线坐标系，该抛物线坐标系的原点OA为抛物线轨迹的顶点，纵轴yA为抛物线对称轴所在方向，横轴xA过抛物线坐标系的原点与纵轴yA垂直且与抛物线轨迹在同一平面上，该抛物线坐标系与带抛物线轨迹的工件固接； 0058 vw焊接速度，为预设值，是焊枪相对于工件的相对速度； 0059 p抛物线在抛物线坐标系中的轨迹方程的常量； 0060 (Adx,Ady)抛物线轨迹的顶点与关节轴的中心的距离，d为已知常量； 0061 抛物线。
23、坐标系的xA轴与xC轴所夹的锐角，也是带抛物线轨迹焊缝的工件随工件安装台、关节轴绕着关节轴的中心线转动的角度（当角度为0时，抛物线坐标系的xA轴与xC轴平行）； 0062 P当前焊点，或称为当前切点，是焊枪的中心线与工件上抛物线轨迹焊缝的交点，也是抛物线轨迹在当前转动位置下的最大YC值点； 0063 T焊枪的末端点； 0064 La焊枪的末端点T与焊点P的距离（近似于弧长，将影响弧长），La为预设值； 0065 (XC,YC)焊点P在世界坐标系C中的坐标值； 0066 (XTC,YTC)焊枪的末端点T在世界坐标系C中的坐标值； 0067 焊点P与关节轴中心OC的连线与xC轴所夹的锐角，在图7中。
24、，=POCxC； 0068 v1焊枪的末端点T和切点P沿xC轴正方向的运动速度，相对于世界坐标系C而言； 0069 v2焊枪的末端点T和切点P沿yC轴正方向的运动速度，相对于世界坐标系C说 明 书CN 102886591 A5/13页8而言； 0070 带抛物线轨迹焊缝的工件绕关节轴的中心OC逆时针转动的角速度，相对于世界坐标系C而言； 0071 v3工件在焊点P处的线速度，相对于世界坐标系C而言； 0072 vx、vy工件在焊点P处的线速度v3分别沿xC轴和yC轴分解的速度，相对于世界坐标系C而言； 0073 M、N为了简便公式书写，采用的中间变量。 具体实施方式0074 下面结合附图及实施。
25、例进一步详细介绍本发明的具体结构、工作原理的内容。 0075 本发明提供的抛物线轨迹定向切线恒速焊接机器人装置的一种实施例，如图1、图2、图3和图4所示，包括机械臂、Z轴转台3、控制器4、焊接电源5和焊枪6；所述机械臂包括依次串联起来的X轴平移组件1和Y轴平移组件2；待焊工件70的焊缝中心线为抛物线轨迹71； 0076 所述X轴平移组件1包括第一基座11、X轴电机12、X轴传动机构13和第一滑块14；所述第一基座11与底座8固接，所述X轴电机12与第一基座11固接，所述X轴电机12的输出轴与X轴传动机构13的输入端相连，所述X轴传动机构13的输出端与第一滑块14相连，所述第一滑块14滑动镶嵌在。
26、第一基座11上； 0077 所述Y轴平移组件2包括第二基座21、Y轴电机22、Y轴传动机构23和第二滑块24；所述第二基座21与第一滑块14固接；所述Y轴电机22与第二基座21固接，所述Y轴电机22的输出轴与Y轴传动机构23的输入端相连，所述Y轴传动机构23的输出端与第二滑块24相连，所述第二滑块24滑动镶嵌在第二基座21上； 0078 所述Z轴转台3包括第三基座31、Z轴电机32、Z轴传动机构35、关节轴33和工件安装台34；所述第三基座31与底座8固接；所述Z轴电机32与第三基座31固接，所述Z轴电机32的输出轴与Z轴传动机构35的输入端相连，所述Z轴传动机构35的输出端与关节轴33相连，。
27、所述关节轴33活动套设在第三基座31中，所述工件安装台34固定套接在关节轴33上； 0079 所述焊枪6固定安装在第二滑块24上；所述控制器4通过控制线路分别与X轴电机12、Y轴电机22和Z轴电机32相连，控制X轴电机12、Y轴电机22和Z轴电机32同时转动；所述控制器4与焊接电源5相连；需要焊接的工件70固定安装在工件安装台34上；工件上具有抛物线轨迹的焊缝71； 0080 设所述第一滑块14相对于第一基座11的滑动方向为直线q；设所述第二滑块24相对于第二基座21的滑动方向为直线s；设所述关节轴33的中心线为直线u；直线q、直线s和直线u三者两两垂直；设直线q与直线s构成平面Q1，设工件7。
28、0上焊缝中心线的抛物线轨迹71所在平面为平面Q2，平面Q1与平面Q2重合； 0081 控制器4控制X轴电机12、Y轴电机22和Z轴电机32同时转动； 0082 如图5所示，建立世界坐标系C，所述世界坐标系C的原点为关节轴的中心OC，世界坐标系C的横轴xC与直线q平行，xC轴的正方向为离开抛物线轨迹71的方向，也是第一滑块14相对于第一基座11滑动的正方向，世界坐标系C的纵轴yC与直线s平行，yC说 明 书CN 102886591 A6/13页9轴的正方向为离开抛物线轨迹71的方向，也是第二滑块24相对于第二基座21滑动的正方向，该世界坐标系C与第三基座固接； 0083 建立抛物线坐标系A，所述。
29、抛物线坐标系A的原点为抛物线轨迹的顶点OA，抛物线坐标系A的纵轴yA与抛物线对称轴重合，抛物线坐标系A的横轴xA过抛物线坐标系A的原点与纵轴垂直且和抛物线在同一平面内，所述抛物线坐标系A与带抛物线轨迹焊缝的工件固接； 0084 点OC在抛物线坐标系A中的坐标值为(dx,dy)，(dx,dy)为已知常量；一种特例是：所述抛物线坐标系A的纵轴yA经过所述关节轴的中心OC，则点OC在抛物线坐标系A中的坐标值为(0,dy)；图6所示为当点OC在抛物线坐标系A中的纵轴yA的负半轴上的情况； 0085 设焊接速度为预设值vw，设工件70绕关节轴33逆时针转动角速度为；抛物线上任意一点坐标(XA，YA)均满。
30、足抛物线在抛物线坐标系中的轨迹方程XA2=-2pYA，p0为一常数；设所述抛物线坐标系的xA轴与xC轴的夹角为，090；所述焊枪6的中心线与yC轴平行，焊枪6的中心线与抛物线轨迹71的交点为焊点P；所述焊点P在世界坐标系C中的坐标为(XC,YC)；设焊枪6的末端点T在世界坐标系C中的坐标为(XTC,YTC)；为焊点P与关节轴中心OC的连线与xC轴所夹的锐角；所述焊枪6的末端点T与焊点P的距离为预设值La； 焊枪6的末端点T和焊点P沿xC轴的速度相等，均为v1，相对世界坐标系C而言；焊枪6的末端点T和焊点P沿yC轴的速度相等，均为v2，相对世界坐标系C而言； 0086 控制器4控制工件70和焊枪。
31、6满足下列关系： 0087 0088 0089 XTC=XC, 0090 YTC=YC+La, 0091 0092 0093 v1=M， 0094 v2=N， 0095 其中， 0096 0097 0098 所述与时间t的关系是的积分；在预设了初始时刻的初始角度后，可以基于上述公式通过逐点计算方法计算得到与时间t的关系。 0099 本发明所述的抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：所述X轴说 明 书CN 102886591 A7/13页10传动机构13采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。 0100 图1所示实施例中，所述X轴传动机构13采用。
32、丝杠螺母传动机构。 0101 本发明所述的抛物线轨迹定向切线恒速焊接机器人装置，其特征在于：所述Y轴传动机构23采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。 0102 图1所示实施例中，所述Y轴传动机构23采用丝杠螺母传动机构。 0103 图1所示实施例中，所述Z轴传动机构35为减速机。 0104 图1所示实施例还包括送丝机9，控制器与送丝机相连，送丝机与焊枪相连。 0105 结合图1所示实施例说明其工作原理： 0106 最初，工件70的抛物线轨迹所在的抛物线坐标系A的xA轴与水平方向重合。工作时， X轴电机12、Y轴电机22和Z轴电机32同时转动：X轴电机1。
33、2转动，通过X轴传动机构13带动第一滑块在水平方向平移；Y轴电机22转动，通过Y轴传动机构23带动第二滑块在竖直方向平移；Z轴电机32转动，通过Z轴传动机构35带动关节轴33转动，带动工件安装台34转动，工件70绕着关节轴33的中心线转动，抛物线轨迹焊缝71绕着关节轴33的中心线转动。由于各参量满足一定的函数关系，因此可以保证焊点的位置始终保持在抛物线轨迹的最高点，此外，焊枪始终位于平焊位置，即焊枪的中心线始终为抛物线轨迹在该点的法线方向。从而获得良好的焊接质量。 0107 公式推导过程结合图5介绍如下。 0108 （1）目标要求： 0109 工件上抛物线轨迹的 弧段为焊接弧段，当前焊点为P，。
34、P位于 上，夹角=POAG0 ,90 。要求当前焊点P始终在抛物线的最高点水平切线处，焊接速度恒定为预设值vw，焊接速度方向为抛物线在该点的水平切线方向。 0110 （2）求解(XA,YA)： 0111 当双曲线轨迹焊缝的工件随关节轴旋转到某一个角度时，焊点P在双曲线坐标系A中的坐标为(XA,YA)。在A坐标系中双曲线方程为： 0112 XA2=-2pYA,p0 （1） 0113 由双曲线坐标系A与世界坐标系C的平移和旋转关系得到： 0114 0115 将（2）式代入（1）式得： 0116 (XCcos+YCsin+dx)2=-2p(-XCsin+YCcos+dy). （3） 0117 对（3）式两边对XC微分（此时为常量，XC和YC是变量），得： 0118 0119 整理（4）式得 0120 0121 由于焊接点与双曲线相切在双曲线的最高点（保证平焊位置），所以： 说 明 书CN 102886591 A10。