CN109648230B - 基于六自由度机器人扩展双旋转协同功能轴的摆焊方法 - Google Patents

基于六自由度机器人扩展双旋转协同功能轴的摆焊方法 Download PDF

Info

Publication number
CN109648230B
CN109648230B CN201811636888.2A CN201811636888A CN109648230B CN 109648230 B CN109648230 B CN 109648230B CN 201811636888 A CN201811636888 A CN 201811636888A CN 109648230 B CN109648230 B CN 109648230B
Authority
CN
China
Prior art keywords
coordinate system
shaft
axis
robot
point
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201811636888.2A
Other languages
English (en)
Other versions
CN109648230A (zh
Inventor
朱路生
邓璨宇
罗雷雨
杨金桥
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Chengdu Kanop Robot Technology Co ltd
Original Assignee
Chengdu Crp Automation Control Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Chengdu Crp Automation Control Technology Co ltd filed Critical Chengdu Crp Automation Control Technology Co ltd
Priority to CN201811636888.2A priority Critical patent/CN109648230B/zh
Publication of CN109648230A publication Critical patent/CN109648230A/zh
Application granted granted Critical
Publication of CN109648230B publication Critical patent/CN109648230B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23KSOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
    • B23K37/00Auxiliary devices or processes, not specially adapted to a procedure covered by only one of the preceding main groups
    • B23K37/02Carriages for supporting the welding or cutting element
    • B23K37/0252Steering means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1687Assembly, peg and hole, palletising, straight line, weaving pattern movement

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Physics & Mathematics (AREA)
  • Optics & Photonics (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

本发明公开了一种基于六自由度机器人扩展双旋转协同功能轴的摆焊方法,包括机器人本体、用于扩展外部工位翻转面的回转轴和用于扩展外部工位回转面的翻转轴,所述回转轴和翻转轴共同组成外部工位全方位球形工作位置的拓展,所述方法包括:步骤A:机器人本体与所述回转轴和翻转轴建立外部旋转轴协同功能;步骤B:将外部旋转轴协同功能与焊接摆焊功能结合。本发明主要实现了扩展外部协同功能轴,增加机器人自由度,协同功能可以改善机器人本体限制范围,增加运动范围内任意姿态的可操作性,可最大限度的避开机器人奇异点,更方便的完成复杂轨迹的示教与在线和对动作连续性的硬性要求。

Description

基于六自由度机器人扩展双旋转协同功能轴的摆焊方法
技术领域
本发明涉及六自由度机器人技术领域,具体的说,是一种基于六自由度机器人扩展双旋转协同功能轴的摆焊方法。
背景技术
现有工业机器人基本都为六自由度关节型机器人,六个自由度已经能表达机器人末端法兰在空间中的理论位置和姿态,但由于机器人本体结构设计中存在的缺陷,部分特殊姿态无法通过本体六自由度来表达,机器人算法中奇异点真实存在,以及实际工作场合中的一部分复杂运行轨迹与特殊行业动作连续性的要求。越来越多的应用现场需要更大的自由度来实现功能需求。特别是在机器人自动焊接领域,焊接工艺要求高,运动轨迹复杂,焊缝成型连续性要求高。由于机器人带焊枪后大部分机器人本体类型的动作范围将会受到限制,不能完成6轴法兰360°旋转的要求,而焊接作业中,整圆焊接、腰圆焊接、相贯线焊接等场合,都需要6轴法兰范围在360°甚至以上。但凭机器人本身的六个自由度关节,已经无法满足日益高端、功能复杂、工艺进步的工业自动化生产现场的相关要求。
发明内容
本发明的目的在于提供一种基于六自由度机器人扩展双旋转协同功能轴的摆焊方法,用于解决现有技术中机器人带焊枪后大部分机器人本体类型的动作范围将会受到限制,机器人本身的六个自由度关节不能完成6轴法兰360°旋转的要求的问题。
本发明通过下述技术方案解决上述问题:
一种基于六自由度机器人扩展双旋转协同功能轴的摆焊方法,包括机器人本体、用于扩展外部工位翻转面的回转轴和用于扩展外部工位回转面的翻转轴,所述回转轴和翻转轴共同组成外部工位全方位球形工作位置的拓展,所述方法包括:
步骤A:机器人本体与所述回转轴和翻转轴建立外部旋转轴协同功能;
步骤B:将外部旋转轴协同功能与焊接摆焊功能结合。
本发明主要实现了扩展外部协同功能轴,增加机器人自由度,协同功能可以改善机器人本体限制范围,增加运动范围内任意姿态的可操作性,可最大限度的避开机器人奇异点,更方便的完成复杂轨迹的示教与在线和对动作连续性的硬性要求。
进一步地,所述步骤A具体包括:
步骤A2:打开机器人控制系统内部协同功能,计算翻转面、回转面的范围与路径,并将回转轴与翻转轴纳入协同轨迹算法;
步骤A3:转动回转轴和翻转轴,机器人本体进行插补动作,增加前进插补轨迹算法,用于保证机器人本体末端法兰或者机器人本体末端待工具控制点相对于回转轴、翻转轴处于静止状态。
进一步地,所述步骤B为在所述协同轨迹算法、前进插补轨迹算法基础上叠加摆焊轨迹算法。
进一步地,所述步骤A1具体包括:
步骤A11:确定双协同坐标系,所述双协同坐标系包括:机器人基坐标系b,工具坐标系t,翻转轴坐标系j7,回转轴坐标系j8和目标坐标系o,得到在机器人协同运动前翻转轴坐标系j7在机器人基坐标系b的位姿
Figure BDA0001930252680000023
回转轴坐标系j8在机器人基坐标系b的位姿
Figure BDA0001930252680000024
回转轴坐标系j8在翻转轴坐标系j7的位姿
Figure BDA0001930252680000025
以及翻转轴坐标系j7在回转轴坐标系j8的位姿
Figure BDA0001930252680000026
计算公式为:
Figure BDA0001930252680000021
Figure BDA0001930252680000022
其中,
Figure BDA0001930252680000033
Figure BDA0001930252680000034
的逆矩阵,
Figure BDA0001930252680000035
Figure BDA0001930252680000036
的逆矩阵;
步骤A12:示教时,将工具移动至目标点,得到目标点新坐标系o’在j8轴旋转之后得到的回转轴新坐标系j8’下的位姿
Figure BDA0001930252680000037
以及目标点新坐标系o’在j7轴旋转之后的翻转轴新坐标系j7’下的位姿
Figure BDA0001930252680000038
计算公式为:
Figure BDA0001930252680000031
Figure BDA0001930252680000032
其中,
Figure BDA0001930252680000039
表示绕着j8轴旋转θ8角度后的变化矩阵,
Figure BDA00019302526800000311
Figure BDA00019302526800000310
的逆矩阵;
Figure BDA00019302526800000312
表示绕着j7轴旋转θ7角度后的变化矩阵,
Figure BDA00019302526800000314
Figure BDA00019302526800000313
的逆矩阵,当工具坐标系t与回转轴、翻转轴旋转后的目标点新坐标系o’重合,则
Figure BDA00019302526800000315
为单位矩阵。
进一步地,所述步骤A2具体包括:
步骤A21:在机器人本体协同运动轨迹o1点到o2点之间的任意一点o,分别对o1点进行示教,记此时j7轴和j8轴的旋转角度分别为θ7'和θ8',工具在基坐标系t下的位置为t';对o2点的位置示教,记此时翻转轴和回转轴的旋转角度分别为θ7”和θ8”,工具在基坐标系t下的位置为t”;
步骤A22:按照公式(3)和(4)计算得到
Figure BDA00019302526800000316
Figure BDA00019302526800000317
得到o1和o2的位置在回转轴新坐标系j8’下的位姿以及在翻转轴新坐标系j7’下的位姿。
进一步地,所述步骤A3具体包括:
步骤A31:根据直线插补方法,插补出o点在回转轴坐标系j8下的位置,并按照等效轴旋转插补方法,插补出o点在j8轴坐标系下的姿态,得到o点在j8轴坐标系下的位姿
Figure BDA00019302526800000318
其中j8协同轨迹算法轴坐标系是j8轴原坐标系,j8”'坐标系是根据j8'坐标系和j8”坐标系插补得到的新坐标系,它们的参考坐标系均为j8协同轨迹算法轴坐标系。
步骤A32:由j7轴分别在o1点和o2点时的角度θ7'、θ7”以及j8轴分别在o1点和o2点时的角度θ8'、θ8”,根据线性插补方法,插补得到j7轴的角度θ7”'和和j8轴的角度θ8”',并计算出
Figure BDA0001930252680000043
Figure BDA0001930252680000041
其中,
Figure BDA0001930252680000044
Figure BDA0001930252680000045
为公式(1)中计算得到的标定
Figure BDA0001930252680000046
Figure BDA0001930252680000047
Figure BDA0001930252680000048
为单位矩阵;
步骤A33:协同轨迹算法得到
Figure BDA0001930252680000049
后,根据
Figure BDA00019302526800000410
可得到法兰盘坐标系f在基坐标系b下的位姿,
Figure BDA00019302526800000411
Figure BDA00019302526800000412
的逆矩阵,
Figure BDA00019302526800000413
已通过标定得到,根据
Figure BDA00019302526800000414
和机器人的DH参数,可反解得到机器人的关节角度j1~j6的值。
进一步地,所述步骤B具体包括:
步骤B1:根据步骤A31可插补得到轨迹点坐标系O在j8轴坐标系下的位姿,建立摆焊坐标系O':以轨迹点坐标系O的原点为圆心,轨迹的前进方向作为摆弧坐标系O'的x轴,焊枪的z轴叉乘摆弧坐标系O'的x轴可得到摆弧坐标系O'的y轴,摆弧坐标系O'的z轴通过右手定则确定;
步骤B2:得到摆弧轨迹上任意一点P在摆焊坐标系O'下的位姿
Figure BDA00019302526800000415
按照如下公式计算
Figure BDA00019302526800000416
Figure BDA0001930252680000042
其中,
Figure BDA00019302526800000417
为单位矩阵;
得到
Figure BDA00019302526800000418
后,根据
Figure BDA00019302526800000419
可得到法兰盘坐标系f在基坐标系b下的位姿,
Figure BDA00019302526800000420
Figure BDA00019302526800000421
的逆矩阵,
Figure BDA00019302526800000422
已通过标定得到,根据
Figure BDA00019302526800000423
和机器人的DH参数,可反解得到机器人的关节角度j1~j6的值。
本发明与现有技术相比,具有以下优点及有益效果:
(1)本发明实现了扩展外部协同功能轴,增加机器人自由度,协同功能可以改善机器人本体限制范围,增加运动范围内任意姿态的可操作性,可最大限度的避开机器人奇异点,更方便的完成复杂轨迹的示教与在线和对动作连续性的硬性要求。
(2)本发明旋转协同功能结合焊接摆动功能,满足机器人自动焊接领域的特殊专业需求,特别是厚板大件整圆、腰圆、相贯线、宽焊缝、大填充量等焊接中的摆焊需求。填补机器人自动焊接领域的技术空白,完善机器人自动焊接工艺,使机器人自动焊接可推广到更多领域,完成更多应用。
附图说明
图1为本发明的机器人本体+双旋转协同功能轴的结构示意图;
图2为本发明中协同坐标系的示意图;
图3为本发明中摆焊轨迹坐标系的示意图;
其中,1-机器人本体;2-回转轴;3-翻转轴。
具体实施方式
下面结合实施例对本发明作进一步地详细说明,但本发明的实施方式不限于此。
实施例1:
结合附图1所示,一种基于六自由度机器人扩展双旋转协同功能轴的摆焊方法,包括机器人本体1、用于扩展外部工位翻转面的回转轴3和用于扩展外部工位回转面的翻转轴2,机器人本体1为主要载体,主要承担再现运动轨迹功能,回转轴3为图1中翻转角度面旋转工位,主要是扩展外部工位翻转面的范围,翻转轴2为图1中回转角度面旋转工位,主要是扩展外部工位回转面的范围,回转轴3和翻转轴2,共同组成外部工位全方位球形工作位置的拓展范围,所述回转轴3和翻转轴2共同组成外部工位全方位球形工作位置的拓展。
所述方法包括:
步骤A:机器人本体1与所述回转轴3和翻转轴2建立外部旋转轴协同功能:
步骤A1:机器人本体1分别在回转轴3、翻转轴2的旋转过程中进行定点,确定协同坐标系,具体包括:
翻转轴2往正方向翻转到位,机器人本体1末端或带工具控制点在翻转轴2上定点;
翻转轴2回程到图示位置,机器人本体1末端或带工具控制点在翻转轴上定点;
翻转轴2往反方向翻转到位,机器人本体1末端或带工具控制点在翻转轴上定点;
回转轴3往正方向回转到位,机器人本体1末端或带工具控制点在回转轴上定点;
回转轴3回程到图示位置,机器人本体1末端或带工具控制点在回转轴上定点;
回转轴3往反方向回转到位,机器人本体1末端或带工具控制点在回转轴上定点。
步骤A2:打开机器人控制系统内部协同功能,计算翻转面、回转面的范围与路径,并将回转轴与翻转轴纳入协同轨迹算法;
步骤A3:转动回转轴和翻转轴,机器人本体进行插补动作,增加前进插补轨迹算法,用于保证机器人本体末端法兰或者机器人本体末端待工具控制点相对于回转轴、翻转轴处于静止状态。
所述步骤B为在所述协同轨迹算法、前进插补轨迹算法基础上叠加摆焊轨迹算法。
实施例2:
在实施例1的基础上,结合图2所示,所述步骤A1具体包括:
步骤A11:确定双协同坐标系,所述双协同坐标系包括:机器人基坐标系b,工具坐标系t,翻转轴坐标系j7,回转轴坐标系j8和目标坐标系o,得到在机器人协同运动前翻转轴坐标系j7在机器人基坐标系b的位姿
Figure BDA0001930252680000075
回转轴坐标系j8在机器人基坐标系b的位姿
Figure BDA0001930252680000076
回转轴坐标系j8在翻转轴坐标系j7的位姿
Figure BDA0001930252680000077
以及翻转轴坐标系j7在回转轴坐标系j8的位姿
Figure BDA0001930252680000078
计算公式为:
Figure BDA0001930252680000071
Figure BDA0001930252680000072
其中,
Figure BDA0001930252680000079
Figure BDA00019302526800000710
的逆矩阵,
Figure BDA00019302526800000711
Figure BDA00019302526800000712
的逆矩阵;
步骤A12:示教时,将工具移动至目标点,得到目标点新坐标系o在j8轴旋转之后得到的回转轴新坐标系j8下的位姿
Figure BDA00019302526800000713
以及目标点新坐标系o在j7轴旋转之后的翻转轴新坐标系j7下的位姿
Figure BDA00019302526800000714
计算公式为:
Figure BDA0001930252680000073
Figure BDA0001930252680000074
其中,
Figure BDA00019302526800000715
表示绕着j8轴旋转θ8角度后的变化矩阵,
Figure BDA00019302526800000717
Figure BDA00019302526800000716
的逆矩阵;
Figure BDA00019302526800000718
表示绕着j7轴旋转θ7角度后的变化矩阵,
Figure BDA00019302526800000719
Figure BDA00019302526800000720
的逆矩阵,当工具坐标系t与回转轴3、翻转轴2旋转后的目标点新坐标系o’重合,则
Figure BDA00019302526800000721
为单位矩阵。
所述步骤A2具体包括:
步骤A21:在机器人本体1协同运动轨迹o1点到o2点之间的任意一点o,分别对o1点进行示教,记此时j7轴和j8轴的旋转角度分别为θ7'和θ8',工具在基坐标系t下的位置为t';对o2点的位置示教,记此时翻转轴2和回转轴3的旋转角度分别为θ7”和θ8”,工具在基坐标系t下的位置为t”;
步骤A22:按照公式(3)和(4)计算得到
Figure BDA0001930252680000082
Figure BDA0001930252680000083
得到o1和o2的位置在回转轴新坐标系j8’下的位姿以及在翻转轴新坐标系j7’下的位姿。
所述步骤A3具体包括:
步骤A31:根据直线插补方法,插补出o点在回转轴坐标系j8下的位置,并按照等效轴旋转插补方法,插补出o点在j8轴坐标系下的姿态,得到o点在j8轴坐标系下的位姿
Figure BDA0001930252680000084
其中j8协同轨迹算法轴坐标系是j8轴原坐标系,j8”'坐标系是根据j8'坐标系和j8”坐标系插补得到的新坐标系,它们的参考坐标系均为j8协同轨迹算法轴坐标系。
步骤A32:由j7轴分别在o1点和o2点时的角度θ7'、θ7”以及j8轴分别在o1点和o2点时的角度θ8'、θ8”,根据线性插补方法,插补得到j7轴的角度θ7”'和和j8轴的角度θ8”',并计算出
Figure BDA0001930252680000085
Figure BDA0001930252680000081
其中,
Figure BDA0001930252680000086
Figure BDA0001930252680000087
为公式(1)中计算得到的标定
Figure BDA0001930252680000088
Figure BDA0001930252680000089
Figure BDA00019302526800000810
为单位矩阵;
步骤A33:得到
Figure BDA00019302526800000811
后,根据
Figure BDA00019302526800000812
可得到法兰盘坐标系f在基坐标系b下的位姿,
Figure BDA00019302526800000813
Figure BDA00019302526800000814
的逆矩阵,
Figure BDA00019302526800000815
已通过标定得到,根据
Figure BDA00019302526800000816
和机器人的DH参数,可反解得到机器人的关节角度j1~j6的值。
实施例4:
在实施例3的基础上,所述步骤B具体包括:
步骤B1:根据步骤A31可插补得到轨迹点坐标系O在j8轴坐标系下的位姿,摆弧坐标系的建立方法如下:以轨迹点坐标系O的原点为圆心,轨迹的前进方向作为摆弧坐标系O'的x轴,焊枪的z轴叉乘摆弧坐标系O'的x轴可得到摆弧坐标系O'的y轴,摆弧坐标系O'的z轴通过右手定则确定,如图3所示,摆弧的轨迹位于轨迹点坐标系O的xy平面内,以sin曲线摆弧为例,摆弧周期为X,摆弧的幅值为A,可得到y关于x的表达式y=A*sin(2*pi/X*x),给定p点的x的坐标,可求出y的值,协同轨迹算法z恒定为0,到摆弧点p点相对于摆弧坐标系O'的位置,p点的姿态与O点的姿态相同,可得到p点在摆弧坐标系O'下的位姿,即
Figure BDA0001930252680000092
按照如下公式计算
Figure BDA0001930252680000093
Figure BDA0001930252680000091
其中,
Figure BDA0001930252680000094
为单位矩阵;
得到
Figure BDA0001930252680000095
后,根据
Figure BDA0001930252680000096
可得到法兰盘坐标系f在基坐标系b下的位姿,
Figure BDA0001930252680000097
Figure BDA0001930252680000098
的逆矩阵,
Figure BDA0001930252680000099
已通过标定得到,根据
Figure BDA00019302526800000910
和机器人的DH参数,可反解得到机器人的关节角度j1~j6的值。
值得说明的是,实施例3和实施例4中的等效轴旋转插补方法和直线插补方法均采用现有技术(见机器人学导论(John J Craig,第三版),第2.8节、第7.4节和第7.6节),根据
Figure BDA00019302526800000911
和机器人的DH参数,可反解得到机器人的关节角度j1~j6的值(见机器人学导论(John JCraig,第三版,第三章和第四章))也为现有技术,在此不再详述。
尽管这里参照本发明的解释性实施例对本发明进行了描述,上述实施例仅为本发明较佳的实施方式,本发明的实施方式并不受上述实施例的限制,应该理解,本领域技术人员可以设计出很多其他的修改和实施方式,这些修改和实施方式将落在本申请公开的原则范围和精神之内。

Claims (5)

1.一种基于六自由度机器人扩展双旋转协同功能轴的摆焊方法,其特征在于,包括机器人本体、用于扩展外部工位翻转面的回转轴和用于扩展外部工位回转面的翻转轴,所述回转轴和翻转轴共同组成外部工位全方位球形工作位置的拓展,所述方法包括:
步骤A:机器人本体与所述回转轴和翻转轴建立外部旋转轴协同功能,具体包括:
步骤A1:机器人本体分别在回转轴、翻转轴的旋转过程中进行定点,确定协同坐标系;
步骤A2:打开机器人控制系统内部协同功能,计算翻转面、回转面的范围与路径,并将回转轴与翻转轴纳入协同轨迹算法;
步骤A3:转动回转轴和翻转轴,机器人本体进行插补动作,增加前进插补轨迹算法,用于保证机器人本体末端法兰或者机器人本体末端待工具控制点相对于回转轴、翻转轴处于静止状态;
所述步骤A1具体包括:
步骤A11:确定双协同坐标系,所述双协同坐标系包括:机器人基坐标系b,工具坐标系t,翻转轴坐标系j7,回转轴坐标系j8和目标坐标系o,得到在机器人协同运动前翻转轴坐标系j7在机器人基坐标系b的位姿
Figure FDA0002605616400000011
回转轴坐标系j8在机器人基坐标系b的位姿
Figure FDA0002605616400000012
回转轴坐标系j8在翻转轴坐标系j7的位姿
Figure FDA0002605616400000013
以及翻转轴坐标系j7在回转轴坐标系j8的位姿
Figure FDA0002605616400000014
计算公式为:
Figure FDA0002605616400000015
Figure FDA0002605616400000016
其中,
Figure FDA0002605616400000017
Figure FDA0002605616400000018
的逆矩阵,
Figure FDA0002605616400000019
Figure FDA00026056164000000110
的逆矩阵;
步骤A12:示教时,将工具移动至目标点,得到目标点新坐标系o’在j8轴旋转之后得到的回转轴新坐标系j8’下的位姿
Figure FDA0002605616400000021
以及目标点新坐标系o’在j7轴旋转之后的翻转轴新坐标系j7’下的位姿
Figure FDA0002605616400000022
计算公式为:
Figure FDA0002605616400000023
Figure FDA0002605616400000024
其中,
Figure FDA0002605616400000025
表示绕着j8轴旋转θ8角度后的变化矩阵,
Figure FDA0002605616400000026
Figure FDA0002605616400000027
的逆矩阵;
Figure FDA0002605616400000028
表示绕着j7轴旋转θ7角度后的变化矩阵,
Figure FDA0002605616400000029
Figure FDA00026056164000000210
的逆矩阵,当工具坐标系t与回转轴、翻转轴旋转后的目标点新坐标系o’重合,则
Figure FDA00026056164000000211
为单位矩阵;
步骤B:将外部旋转轴协同功能与焊接摆焊功能结合。
2.根据权利要求1所述的基于六自由度机器人扩展双旋转协同功能轴的摆焊方法,其特征在于,所述步骤B为在所述协同轨迹算法、前进插补轨迹算法基础上叠加摆焊轨迹算法。
3.根据权利要求1或2所述的基于六自由度机器人扩展双旋转协同功能轴的摆焊方法,其特征在于,所述步骤A2具体包括:
步骤A21:在机器人本体协同运动轨迹o1点到o2点之间的任意一点o,分别对o1点进行示教,记此时j7轴和j8轴的旋转角度分别为θ7'和θ8',工具在基坐标系t下的位置为t';对o2点的位置示教,记此时翻转轴和回转轴的旋转角度分别为θ7”和θ8”,工具在基坐标系t下的位置为t”;
步骤A22:按照公式(3)和(4)计算得到
Figure FDA00026056164000000212
Figure FDA00026056164000000213
得到o1和o2的位置在回转轴新坐标系j8’下的位姿以及在翻转轴新坐标系j7’下的位姿。
4.根据权利要求3所述的基于六自由度机器人扩展双旋转协同功能轴的摆焊方法,其特征在于,所述步骤A3具体包括:
步骤A31:根据直线插补方法,插补出o点在回转轴坐标系j8下的位置,并按照等效轴旋转插补方法,插补出o点在j8轴坐标系下的姿态,得到o点在j8轴坐标系下的位姿
Figure FDA0002605616400000031
步骤A32:由j7轴分别在o1点和o2点时的角度θ7'、θ7”以及j8轴分别在o1点和o2点时的角度θ8'、θ8”,根据线性插补方法,插补得到j7轴的角度θ7”'和和j8轴的角度θ8”',并计算出
Figure FDA0002605616400000032
Figure FDA0002605616400000033
其中,
Figure FDA0002605616400000034
Figure FDA0002605616400000035
为公式(1)中计算得到的标定
Figure FDA0002605616400000036
Figure FDA0002605616400000037
Figure FDA0002605616400000038
为单位矩阵;
步骤A33:协同轨迹算法得到
Figure FDA0002605616400000039
后,根据
Figure FDA00026056164000000310
可得到法兰盘坐标系f在基坐标系b下的位姿,
Figure FDA00026056164000000311
Figure FDA00026056164000000312
的逆矩阵,
Figure FDA00026056164000000313
已通过标定得到,根据
Figure FDA00026056164000000314
和机器人的DH参数,可反解得到机器人的关节角度j1~j6的值。
5.根据权利要求4所述的基于六自由度机器人扩展双旋转协同功能轴的摆焊方法,其特征在于,所述步骤B具体包括:
步骤B1:根据步骤A31可插补得到轨迹点坐标系O在j8轴坐标系下的位姿,建立摆焊坐标系O':以轨迹点坐标系O的原点为圆心,轨迹的前进方向作为摆弧坐标系O'的x轴,焊枪的z轴叉乘摆弧坐标系O'的x轴可得到摆弧坐标系O'的y轴,摆弧坐标系O'的z轴通过右手定则确定;
步骤B2:得到摆弧轨迹上任意一点P在摆焊坐标系O'下的位姿
Figure FDA00026056164000000315
按照如下公式计算
Figure FDA00026056164000000316
Figure FDA00026056164000000317
其中,
Figure FDA00026056164000000318
为单位矩阵;
得到
Figure FDA00026056164000000319
后,根据
Figure FDA00026056164000000320
可得到法兰盘坐标系f在基坐标系b下的位姿,
Figure FDA00026056164000000321
Figure FDA00026056164000000322
的逆矩阵,
Figure FDA00026056164000000323
已通过标定得到,根据
Figure FDA00026056164000000324
和机器人的DH参数,可反解得到机器人的关节角度j1~j6的值。
CN201811636888.2A 2018-12-29 2018-12-29 基于六自由度机器人扩展双旋转协同功能轴的摆焊方法 Active CN109648230B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811636888.2A CN109648230B (zh) 2018-12-29 2018-12-29 基于六自由度机器人扩展双旋转协同功能轴的摆焊方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811636888.2A CN109648230B (zh) 2018-12-29 2018-12-29 基于六自由度机器人扩展双旋转协同功能轴的摆焊方法

Publications (2)

Publication Number Publication Date
CN109648230A CN109648230A (zh) 2019-04-19
CN109648230B true CN109648230B (zh) 2020-10-16

Family

ID=66116918

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811636888.2A Active CN109648230B (zh) 2018-12-29 2018-12-29 基于六自由度机器人扩展双旋转协同功能轴的摆焊方法

Country Status (1)

Country Link
CN (1) CN109648230B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110303217B (zh) * 2019-07-18 2021-03-26 湘潭大学 一种多机器人自动线缆焊锡装配单元
CN110328475B (zh) * 2019-07-19 2021-04-27 上海中巽科技股份有限公司 一种具有除湿功能的焊接智能示教机器人
CN111872920A (zh) * 2020-07-22 2020-11-03 成都卡诺普自动化控制技术有限公司 一种离线免示教激光定位方法及系统
CN112318491A (zh) * 2020-09-11 2021-02-05 深圳市启玄科技有限公司 一种带有多个协同轴控制的机器人
CN115249267B (zh) * 2022-09-22 2022-12-30 海克斯康制造智能技术(青岛)有限公司 一种基于转台及机器人位姿解算的自动检测方法及装置

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1604791A1 (en) * 2003-02-06 2005-12-14 HONDA MOTOR CO., Ltd. Control system using working robot, and work processing method using this system
CN105562973A (zh) * 2016-02-29 2016-05-11 华南理工大学 一种激光识别焊缝8轴机器人空间曲线焊接系统及方法
CN105676642A (zh) * 2016-02-26 2016-06-15 同济大学 一种六自由度机器人工位布局与运动时间协同优化方法
CN206105214U (zh) * 2016-09-18 2017-04-19 长沙长泰机器人有限公司 机器人焊接工作装置
CN106671079A (zh) * 2015-11-06 2017-05-17 中国科学院沈阳计算技术研究所有限公司 一种实现变位机协同的焊接机器人运动控制方法
CN107378324A (zh) * 2017-08-18 2017-11-24 华南理工大学 一种基于视觉提取的异型工件的焊接系统及方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1604791A1 (en) * 2003-02-06 2005-12-14 HONDA MOTOR CO., Ltd. Control system using working robot, and work processing method using this system
CN106671079A (zh) * 2015-11-06 2017-05-17 中国科学院沈阳计算技术研究所有限公司 一种实现变位机协同的焊接机器人运动控制方法
CN105676642A (zh) * 2016-02-26 2016-06-15 同济大学 一种六自由度机器人工位布局与运动时间协同优化方法
CN105562973A (zh) * 2016-02-29 2016-05-11 华南理工大学 一种激光识别焊缝8轴机器人空间曲线焊接系统及方法
CN206105214U (zh) * 2016-09-18 2017-04-19 长沙长泰机器人有限公司 机器人焊接工作装置
CN107378324A (zh) * 2017-08-18 2017-11-24 华南理工大学 一种基于视觉提取的异型工件的焊接系统及方法

Also Published As

Publication number Publication date
CN109648230A (zh) 2019-04-19

Similar Documents

Publication Publication Date Title
CN109648230B (zh) 基于六自由度机器人扩展双旋转协同功能轴的摆焊方法
CN110421547B (zh) 一种基于估计动力学模型的双臂机器人协同阻抗控制方法
CN104384765B (zh) 基于三维模型与机器视觉的自动焊接方法
CN103942427B (zh) 一类六自由度机械臂运动学逆解的快速简便求法
CN104965517B (zh) 一种机器人笛卡尔空间轨迹的规划方法
CN109648229B (zh) 基于六自由度机器人扩展双直线协同功能轴的摆焊方法
CN106671079A (zh) 一种实现变位机协同的焊接机器人运动控制方法
CN111230866B (zh) 一种六轴机器人末端跟随目标物实时位姿的计算方法
CN109702751A (zh) 一种七自由度串联机械臂的位置级逆解方法
CN112405519A (zh) 上下料机器人运动轨迹规划方法
CN107598919A (zh) 一种基于五点标定法的两轴变位机标定方法
CN109773376B (zh) 一种焊接机器人的正弦摆焊方法
CN110465949A (zh) 焊接机器人及其摆动轨迹的规划方法
CN115229786B (zh) 一种带肘部偏置的七自由度机械臂的几何逆解方法
CN112318508A (zh) 一种水下机器人-机械手系统受海流扰动强弱评估方法
CN113199475B (zh) 一种适用于非标准圆弧的圆形摆弧路径的规划算法
CN109129469B (zh) 机械臂运动学逆解方法、装置及机械臂
JPS5815801B2 (ja) 工業用ロボツトの軌跡制御方式
JP2008137143A (ja) 塗装ロボットの教示方法
CN112356032A (zh) 一种姿态平滑过渡方法及系统
CN113199476B (zh) 可快速调整焊枪姿态的圆弧8字形摆弧路径的规划算法
CN112974153B (zh) 五轴联动点胶轨迹转轴最优路径插补方法及应用
Zhang et al. A new analytical inverse kinematics model for seven degrees of freedom redundant manipulators
CN108068108B (zh) 平面内摆动伸缩型机器人运动控制方法
JPS60217406A (ja) 溶接ロボツトのト−チ保持姿勢決定方式

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address
CP03 Change of name, title or address

Address after: 610000 No. 42, Huatai Road, Chenghua District, Chengdu, Sichuan

Patentee after: Chengdu kanop Robot Technology Co.,Ltd.

Address before: No.199, Huaguan Road, Longtan Industrial Park, Chenghua District, Chengdu, Sichuan 610000

Patentee before: CHENGDU CRP AUTOMATION CONTROL TECHNOLOGY Co.,Ltd.