CN103568012A - 一种弧焊机器人双平面摆弧轨迹的规划方法 - Google Patents
一种弧焊机器人双平面摆弧轨迹的规划方法 Download PDFInfo
- Publication number
- CN103568012A CN103568012A CN201310507312.7A CN201310507312A CN103568012A CN 103568012 A CN103568012 A CN 103568012A CN 201310507312 A CN201310507312 A CN 201310507312A CN 103568012 A CN103568012 A CN 103568012A
- Authority
- CN
- China
- Prior art keywords
- arc
- ratio
- welding robot
- swinging arc
- swinging
- 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.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K9/00—Arc welding or cutting
- B23K9/02—Seam welding; Backing means; Inserts
- B23K9/022—Welding by making use of electrode vibrations
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Abstract
本发明公开了一种弧焊机器人双平面摆弧轨迹的规划方法,其特征在于:所述的规划方法首先确定弧焊机器人摆弧的起点、终点以及上下两个摆弧平面内任意两点,并采集位姿值;通过计算得出摆弧所在的两个平面的坐标系,通过对起点到终点方向的加速度和速度规划,得出两点之间的距离与运动时间之间的函数关系,即运动方向的轨迹规划。根据工艺要求,可以进行三角摆弧和正弦摆弧轨迹等。由于采用上述的方法,本发明方便操作人员设定弧焊机器人的双平面摆弧轨迹,确保焊接的质量。
Description
技术领域
本发明涉及弧焊机器人的控制领域,特别涉及一种弧焊机器人双平面摆弧轨迹的规划方法。
背景技术
随着工业自动化的发展,工业机器人的使用领域越来越大,现场工艺要求越来越严格,这就大大加快了机器人轨迹规划功能研发。
弧焊机器人不仅仅是直线弧焊和圆弧弧焊,在焊缝过大时,特殊的工艺要求会用到摆弧运动,摆弧焊接质量与摆弧轨迹规划有直接关系。如何确定弧焊机器人的摆弧轨迹以提高焊接质量目前还是一个难题。
针对上述问题,提供一种基于时间连续的规划方法来确定弧焊机器人的双平面摆弧轨迹。
发明内容
本发明所要解决的技术问题是,提供一种弧焊机器人双平面摆弧轨迹的规划方法,以达到提高弧焊摆弧焊接质量的目的。
为达到上述目的,本发明的技术方案是,一种弧焊机器人双平面摆弧轨迹的规划方法,其特征在于:所述的规划方法首先确定弧焊机器人摆弧的起点、终点以及上下两个摆弧平面内任意两点,并采集位姿值;确定速度加速段的时间比例ratio,设定最大加速度Amax与最大速度值Vmax,则加速度时间Tacc为Tacc=V/(Amax*(1-ratio));加加速度时间Jerk为Jerk=Amax/(ratio*Tacc);匀速时间Thold计算步骤为:
Distance_Acc=(Jerk*Tacc^3*ratio^3)/6+
(Tacc^2*ratio*(5*Jerk*Tacc*ratio^2-12*Amax*ratio+6*Amax))/6
-(Tacc^2*(2*ratio-1)*(Jerk*Tacc*ratio^2-2*Amax*ratio+Amax))/2
Distance_Vhold=P2-P1-2*Distance_Acc
Thold=Distance+Vhold/V
然后通过积分求出起点到终点方向位置与时间的函数关系,根据正弦函数公式,确定摆弧平面内的位置规划;再经过矩阵变换,将摆弧平面内的位置点转换成机器人基坐标系下的位置点,根据计算出的基坐标系下的位置点,即可控制机器人进行摆弧运动。
所述的速度加速段的时间比例ratio一般设定为0.1。
所述的规划方法设焊枪的进给方向为工具坐标系的Z轴正方向,同时假设整个摆弧过程中工具Z+方向始终与摆弧平面成a角,将欧拉角转变成四元数进行插补,即为摆弧中的姿态规划。
所述的a角的度数为:0°<a≤90°。
所述的规划方法设定弧焊机器人在摆弧过程中工具Z+方向与摆弧切线方向始终垂直。
一种弧焊机器人双平面摆弧轨迹的规划方法,由于采用上述的方法,本发明方便操作人员设定弧焊机器人的双平面摆弧轨迹,确保焊接的质量。
附图说明
下面结合附图和具体实施方式对本发明作进一步详细的说明;
图1为本发明一种弧焊机器人双平面摆弧轨迹的规划方法示意图。
具体实施方式
本发明以六自由度弧焊机器人为例,示教摆弧的起点P1与终点P2,P3、P4分别是上下两个摆弧平面内的任意点,记录四个点的机器人位姿值,通过计算得出摆弧的两个平面的坐标系,通过对起点到终点方向的加速度和速度规划,得出两点时间的距离与运动时间之间的关系,即运动方向的轨迹规划。根据工艺要求,可以进行三角摆弧和正弦摆弧轨迹等。
具体如图1所示,图中P1点是摆弧起始点,P2点是终点,P3是摆弧上平面内的点,P4是摆弧下平面内的点,如果P3,P4均在一个平面内,此方法仍然可行。用户设定摆弧的振幅、频率。图1中是振幅5mm,频率为0.1的正弦摆。
本发明分别记录P1、P2、P3、P4点的位姿(Xi,Yi,Zi,Ai,Bi,Ci)其中i=1,2,3,4,平面P1P2P3为摆弧运动的上平面,平面P1P2P4为下平面。通过计算,上平面和下平面的坐标系已确定,只要确定了机器人末端在这两个平面内的运动轨迹坐标值,通过坐标变换,即可得到机器人在基坐标系下的轨迹坐标值。现说明上下平面内的速度、位置轨迹规划。
首先确定速度加速段的时间比例ratio,一般设定为0.1,设定最大加速度Amax与最大速度值V,P1到P2点方向(定义为X方向)为S型速度曲线规划,X方向加速度时间Tacc由公式(1)确定,加加速度时间Jerk由公式(2)确定,匀速时间Thold由公式(3)、(4)、(5)确定。通过积分求出X方向位置与时间的函数关系,根据正弦函数公式,确定摆弧平面内的位置规划。再经过矩阵变换,将摆弧平面内的位置点转换成机器人基坐标系下的位置点,即可控制机器人进行摆弧运动。
Tacc=V/(Amax*(1-ratio)) (1)
Jerk=Amax/(ratio*Tacc) (2)
Distance_Acc=(Jerk*Tacc^3*ratio^3)/6+(Tacc^2*ratio*(5*Jerk*Tacc*ratio^2-12*Amax*ratio+6*Amax))/6 (3)
-(Tacc^2*(2*ratio-1)*(Jerk*Tacc*ratio^2-2*Amax*ratio+Amax))/2Distance_Vhold=P2-P1-2*Distance_Acc (4)
Thold=Distance_Vhold/V (5)
焊枪的进给方向为工具坐标系的Z轴正方向,假设整个摆弧过程中工具Z+方向始终与摆弧平面成a角(0°<a≤90°),而且摆弧过程中工具Z+方向与摆弧切线方向始终垂直,这样便确定了焊枪在整个运动过程中的姿态。将欧拉角转变成四元数进行插补,即为摆弧中的姿态规划。
上面结合附图对本发明进行了示例性描述,显然本发明具体实现并不受上述方式的限制,只要采用了本发明技术方案进行的各种改进,或未经改进直接应用于其它场合的,均在本发明的保护范围之内。
Claims (5)
1.一种弧焊机器人双平面摆弧轨迹的规划方法,其特征在于:所述的规划方法首先确定弧焊机器人摆弧的起点、终点以及上下两个摆弧平面内任意两点,并采集位姿值;确定速度加速段的时间比例ratio,设定最大加速度Amax与最大速度值V,加速度时间Tacc为Tacc=V/(Amax*(1-ratio));加加速度时间Jerk为Jerk=Amax/(ratio*Tacc);,匀速时间Thold的计算如下:
Distance_Acc=(jerk*Tacc^3*ratio^3)/6+
(Tacc^2*ratio*(5*Herj*Tacc*ratio^2-12*Amax*ratio+6*Amax))/6
-(Tacc^2*(2*ratio-1)*(Jerk*Tacc*ratio^2-2*Amax*ratio+Amax))/2
Distance_Vhold=P2-P1-2*Distabce_Acc
Thold=Distance_Vhold/V
通过积分求出起点到终点位置与时间的函数关系,根据正弦函数公式,确定摆弧平面内的位置规划;再经过矩阵变换,将摆弧平面内的位置点转换成机器人基坐标系下的位置点,即可控制机器人进行摆弧运动。
2.根据权利要求1所述的一种弧焊机器人双平面摆弧轨迹的规划方法,其特征在于:所述的速度加速段的时间比例ratio设定为0.1。
3.根据权利要求1所述的一种弧焊机器人双平面摆弧轨迹的规划方法,其特征在于:所述的规划方法设焊枪的进给方向为工具坐标系的Z轴正方向,同时假设整个摆弧过程中工具Z+方向始终与摆弧平面成a角,将欧拉角转变成四元数进行插补,即为摆弧中的姿态规划。
4.根据权利要求3所述的一种弧焊机器人双平面摆弧轨迹的规划方法,其特征在于:所述的a角的度数为:0°<a≤90°。
5.根据权利要求3所述的一种弧焊机器人双平面摆弧轨迹的规划方法,其特征在于:所述的规划方法设定弧焊机器人在摆弧过程中工具Z+与摆弧切线方向始终垂直。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310507312.7A CN103568012B (zh) | 2013-10-24 | 2013-10-24 | 一种弧焊机器人双平面摆弧轨迹的规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310507312.7A CN103568012B (zh) | 2013-10-24 | 2013-10-24 | 一种弧焊机器人双平面摆弧轨迹的规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103568012A true CN103568012A (zh) | 2014-02-12 |
CN103568012B CN103568012B (zh) | 2015-10-21 |
Family
ID=50041157
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310507312.7A Active CN103568012B (zh) | 2013-10-24 | 2013-10-24 | 一种弧焊机器人双平面摆弧轨迹的规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103568012B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105436661A (zh) * | 2015-11-29 | 2016-03-30 | 上海新时达电气股份有限公司 | 摆弧焊接方法及弧焊机器人 |
CN105665878A (zh) * | 2016-04-11 | 2016-06-15 | 南京埃斯顿机器人工程有限公司 | 一种焊接机器人焊接圆弧焊缝的空间三角摆焊方法 |
CN105773620A (zh) * | 2016-04-26 | 2016-07-20 | 南京工程学院 | 基于倍四元数的工业机器人自由曲线的轨迹规划控制方法 |
CN105834629A (zh) * | 2016-04-11 | 2016-08-10 | 南京埃斯顿机器人工程有限公司 | 一种焊接机器人焊接圆弧焊缝的平面三角摆焊方法 |
CN108153707A (zh) * | 2017-12-28 | 2018-06-12 | 北京工业大学 | 一种基于空间变换原理的弧焊机器人直线摆焊方法 |
CN108941845A (zh) * | 2018-08-28 | 2018-12-07 | 苏州艾利特机器人有限公司 | 一种弧焊机器人空间圆弧摆焊插补方法 |
CN110450170A (zh) * | 2019-09-09 | 2019-11-15 | 北京配天技术有限公司 | 焊接机器人及其摆动轨迹的规划方法 |
CN110465949A (zh) * | 2019-09-09 | 2019-11-19 | 北京配天技术有限公司 | 焊接机器人及其摆动轨迹的规划方法 |
CN110757454A (zh) * | 2019-10-12 | 2020-02-07 | 广州中国科学院先进技术研究所 | 一种双机器人协同旋转的路径规划方法和装置 |
CN113305474A (zh) * | 2021-05-27 | 2021-08-27 | 傲拓科技股份有限公司 | 一种基于plc的焊接机器人摆焊姿态插补方法 |
CN114248052A (zh) * | 2020-09-21 | 2022-03-29 | 配天机器人技术有限公司 | 一种焊接机器人摆焊插补方法、设备及计算机存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6266578B1 (en) * | 1998-05-15 | 2001-07-24 | Firdaus E. Udwadia | Computer based control system |
US20070005179A1 (en) * | 2003-01-31 | 2007-01-04 | Mccrackin Daniel C | Syntactic inferential motion planning method for robotic systems |
CN101359224A (zh) * | 2007-07-31 | 2009-02-04 | 洛克威尔自动控制技术股份有限公司 | 用于轨迹规划的改进的融合算法 |
CN101508113A (zh) * | 2009-03-11 | 2009-08-19 | 哈尔滨工业大学 | 一种基于余弦二阶的机器人轨迹规划方法 |
CN101612734A (zh) * | 2009-08-07 | 2009-12-30 | 清华大学 | 管道喷涂机器人及其作业轨迹规划方法 |
CN103009389A (zh) * | 2012-11-30 | 2013-04-03 | 北京控制工程研究所 | 一种冗余空间机械臂在轨抓捕的轨迹规划方法 |
-
2013
- 2013-10-24 CN CN201310507312.7A patent/CN103568012B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6266578B1 (en) * | 1998-05-15 | 2001-07-24 | Firdaus E. Udwadia | Computer based control system |
US20070005179A1 (en) * | 2003-01-31 | 2007-01-04 | Mccrackin Daniel C | Syntactic inferential motion planning method for robotic systems |
CN101359224A (zh) * | 2007-07-31 | 2009-02-04 | 洛克威尔自动控制技术股份有限公司 | 用于轨迹规划的改进的融合算法 |
CN101508113A (zh) * | 2009-03-11 | 2009-08-19 | 哈尔滨工业大学 | 一种基于余弦二阶的机器人轨迹规划方法 |
CN101612734A (zh) * | 2009-08-07 | 2009-12-30 | 清华大学 | 管道喷涂机器人及其作业轨迹规划方法 |
CN103009389A (zh) * | 2012-11-30 | 2013-04-03 | 北京控制工程研究所 | 一种冗余空间机械臂在轨抓捕的轨迹规划方法 |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105436661A (zh) * | 2015-11-29 | 2016-03-30 | 上海新时达电气股份有限公司 | 摆弧焊接方法及弧焊机器人 |
CN105665878A (zh) * | 2016-04-11 | 2016-06-15 | 南京埃斯顿机器人工程有限公司 | 一种焊接机器人焊接圆弧焊缝的空间三角摆焊方法 |
CN105834629A (zh) * | 2016-04-11 | 2016-08-10 | 南京埃斯顿机器人工程有限公司 | 一种焊接机器人焊接圆弧焊缝的平面三角摆焊方法 |
CN105665878B (zh) * | 2016-04-11 | 2017-10-24 | 南京埃斯顿机器人工程有限公司 | 一种焊接机器人焊接圆弧焊缝的空间三角摆焊方法 |
CN105773620A (zh) * | 2016-04-26 | 2016-07-20 | 南京工程学院 | 基于倍四元数的工业机器人自由曲线的轨迹规划控制方法 |
CN108153707B (zh) * | 2017-12-28 | 2021-04-02 | 北京工业大学 | 一种基于空间变换原理的弧焊机器人直线摆焊方法 |
CN108153707A (zh) * | 2017-12-28 | 2018-06-12 | 北京工业大学 | 一种基于空间变换原理的弧焊机器人直线摆焊方法 |
CN108941845A (zh) * | 2018-08-28 | 2018-12-07 | 苏州艾利特机器人有限公司 | 一种弧焊机器人空间圆弧摆焊插补方法 |
CN108941845B (zh) * | 2018-08-28 | 2021-08-24 | 苏州艾利特机器人有限公司 | 一种弧焊机器人空间圆弧摆焊插补方法 |
CN110465949A (zh) * | 2019-09-09 | 2019-11-19 | 北京配天技术有限公司 | 焊接机器人及其摆动轨迹的规划方法 |
CN110450170A (zh) * | 2019-09-09 | 2019-11-15 | 北京配天技术有限公司 | 焊接机器人及其摆动轨迹的规划方法 |
CN110465949B (zh) * | 2019-09-09 | 2021-11-09 | 北京配天技术有限公司 | 焊接机器人及其摆动轨迹的规划方法 |
CN110757454A (zh) * | 2019-10-12 | 2020-02-07 | 广州中国科学院先进技术研究所 | 一种双机器人协同旋转的路径规划方法和装置 |
CN110757454B (zh) * | 2019-10-12 | 2022-08-16 | 广州中国科学院先进技术研究所 | 一种双机器人协同旋转的路径规划方法和装置 |
CN114248052A (zh) * | 2020-09-21 | 2022-03-29 | 配天机器人技术有限公司 | 一种焊接机器人摆焊插补方法、设备及计算机存储介质 |
CN113305474A (zh) * | 2021-05-27 | 2021-08-27 | 傲拓科技股份有限公司 | 一种基于plc的焊接机器人摆焊姿态插补方法 |
CN113305474B (zh) * | 2021-05-27 | 2022-12-02 | 傲拓科技股份有限公司 | 一种基于plc的焊接机器人摆焊姿态插补方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103568012B (zh) | 2015-10-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103568012B (zh) | 一种弧焊机器人双平面摆弧轨迹的规划方法 | |
CN105922265B (zh) | 一种机械臂的运动轨迹规划方法、装置及机器人 | |
CN106094835B (zh) | 前轮驱动车式移动机器人的动态编队控制方法 | |
CN104384765B (zh) | 基于三维模型与机器视觉的自动焊接方法 | |
CN106462140B (zh) | 用于标定工业机器人系统的工具中心点的方法 | |
US20110282492A1 (en) | Method of controlling a robotic tool | |
CN104029206B (zh) | 封头自动开孔的切割方法 | |
CN106826834B (zh) | 一种机器人焊接自动寻位方法 | |
CN106933223B (zh) | 一种机器人自主导航方法及系统 | |
CN105855672B (zh) | 基于示教机器人的空间圆弧插补焊接方法 | |
CN105537824B (zh) | 一种基于机械臂手眼协调自主焊接控制方法 | |
CN108189034B (zh) | 一种机器人连续轨迹实现方法 | |
CN105522577A (zh) | 一种用于五轴折弯机器人笛卡尔轨迹规划的方法及其装置 | |
CN110802600A (zh) | 一种六自由度关节型机器人的奇异性处理方法 | |
CN110465949A (zh) | 焊接机器人及其摆动轨迹的规划方法 | |
CN105643619A (zh) | 一种采用框架描述的工业机器人工具位姿控制方法 | |
CN109530935A (zh) | 使用激光切割机械臂加工规则孔的方法 | |
CN112405527A (zh) | 工件表面圆弧轨迹加工方法及相关装置 | |
CN104061888A (zh) | 机器人三维激光加工头tcp坐标修正方法及装置 | |
CN115519267A (zh) | 一种切割圆的方法及装置 | |
CN115167429A (zh) | 一种移动机器人位置和姿态同时规划方法 | |
CN214174915U (zh) | 一种用于爬壁机器人的导航控制系统 | |
CN104408226B (zh) | 一种基于离心角变化的管板焊接的椭圆插补方法 | |
CN105345813A (zh) | 一种基于广义坐标的机械手高精度定位方法 | |
CN107363447A (zh) | 一种自动焊接管材加工设备 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C56 | Change in the name or address of the patentee | ||
CP03 | Change of name, title or address |
Address after: 241008 Anhui city of Wuhu province Jiujiang Economic Development Zone Wan Chun Road No. 96 Patentee after: Eft intelligent equipment Limited by Share Ltd Address before: 241008 Anhui city of Wuhu province Jiujiang District Road No. 8 leap Patentee before: Anhui Effort Intelligent Equipment Co., Ltd. |