CN103568012B - 一种弧焊机器人双平面摆弧轨迹的规划方法 - Google Patents
一种弧焊机器人双平面摆弧轨迹的规划方法 Download PDFInfo
- Publication number
- CN103568012B CN103568012B CN201310507312.7A CN201310507312A CN103568012B CN 103568012 B CN103568012 B CN 103568012B CN 201310507312 A CN201310507312 A CN 201310507312A CN 103568012 B CN103568012 B CN 103568012B
- Authority
- CN
- China
- Prior art keywords
- arc
- swinging
- swinging arc
- ratio
- welding robot
- 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
Links
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计算步骤为:
Dis tan ce_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
Dis tan ce_Vhold=|P2-P1|-2*Dis tan ce_Acc
Thold=Dis tan ce_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)
Dis tan ce_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 (3)
Dis tan ce_Vhold=|P2-P1|-2*Dis tan ce_Acc (4)
Thold=Dis tan ce_Vhold/V (5)
焊枪的进给方向为工具坐标系的Z轴正方向,假设整个摆弧过程中工具Z轴正方向始终与摆弧平面成a角(0°<a≤90°),而且摆弧过程中工具Z轴正方向与摆弧切线方向始终垂直,这样便确定了焊枪在整个运动过程中的姿态。将欧拉角转变成四元素进行插补,即为摆弧中的姿态规划。
上面结合附图对本发明进行了示例性描述,显然本发明具体实现并不受上述方式的限制,只要采用了本发明技术方案进行的各种改进,或未经改进直接应用于其它场合的,均在本发明的保护范围之内。
Claims (5)
1.一种弧焊机器人双平面摆弧轨迹的规划方法,其特征在于:所述的规划方法首先确定弧焊机器人摆弧的起点、终点以及上下两个摆弧平面内任意两点,起点设为P1、终点设为P2,采集位姿值;确定速度加速度的时间比例ratio,设定最大加速度Amax与最大速度值V,加速度时间Tacc为Tacc=V/(Amax*(1-ratio));加加速度的时间Jerk为Jerk=Amax/(ratio*Tacc);匀速时间Thold的计算如下:
Dis tan ce_Acc=(Jerk*Tacc^3*ratio^3)/6+
(Tacc^2*ratio*(5*Jerk*Tacc*ratio^2-12*A max*ratio+6*A max))/6
-(Tacc^2*(2*ratio-1)*(Jerk*Tacc*ratio^2-2*A max*ratio+A max))/2
Dis tan ce_Vhold=[P2-P1]-2*Dis tan ce_Acc
Thold=Dis tan ce_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 CN103568012A (zh) | 2014-02-12 |
CN103568012B true 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) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105436661B (zh) * | 2015-11-29 | 2017-09-12 | 上海新时达电气股份有限公司 | 摆弧焊接方法及弧焊机器人 |
CN105665878B (zh) * | 2016-04-11 | 2017-10-24 | 南京埃斯顿机器人工程有限公司 | 一种焊接机器人焊接圆弧焊缝的空间三角摆焊方法 |
CN105834629B (zh) * | 2016-04-11 | 2017-07-21 | 南京埃斯顿机器人工程有限公司 | 一种焊接机器人焊接圆弧焊缝的平面三角摆焊方法 |
CN105773620B (zh) * | 2016-04-26 | 2017-09-12 | 南京工程学院 | 基于倍四元数的工业机器人自由曲线的轨迹规划控制方法 |
CN108153707B (zh) * | 2017-12-28 | 2021-04-02 | 北京工业大学 | 一种基于空间变换原理的弧焊机器人直线摆焊方法 |
CN108941845B (zh) * | 2018-08-28 | 2021-08-24 | 苏州艾利特机器人有限公司 | 一种弧焊机器人空间圆弧摆焊插补方法 |
CN110450170B (zh) * | 2019-09-09 | 2021-04-06 | 北京配天技术有限公司 | 焊接机器人及其摆动轨迹的规划方法 |
CN110465949B (zh) * | 2019-09-09 | 2021-11-09 | 北京配天技术有限公司 | 焊接机器人及其摆动轨迹的规划方法 |
CN110757454B (zh) * | 2019-10-12 | 2022-08-16 | 广州中国科学院先进技术研究所 | 一种双机器人协同旋转的路径规划方法和装置 |
CN114248052A (zh) * | 2020-09-21 | 2022-03-29 | 配天机器人技术有限公司 | 一种焊接机器人摆焊插补方法、设备及计算机存储介质 |
CN113305474B (zh) * | 2021-05-27 | 2022-12-02 | 傲拓科技股份有限公司 | 一种基于plc的焊接机器人摆焊姿态插补方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6266578B1 (en) * | 1998-05-15 | 2001-07-24 | Firdaus E. Udwadia | Computer based control system |
CA2514204C (en) * | 2003-01-31 | 2015-12-15 | Thermo Crs Ltd. | Syntactic inferential motion planning method for robotic systems |
US7979158B2 (en) * | 2007-07-31 | 2011-07-12 | Rockwell Automation Technologies, Inc. | Blending algorithm for trajectory planning |
CN101508113B (zh) * | 2009-03-11 | 2010-10-27 | 哈尔滨工业大学 | 一种基于余弦二阶的机器人轨迹规划方法 |
CN101612734B (zh) * | 2009-08-07 | 2011-01-26 | 清华大学 | 管道喷涂机器人及其作业轨迹规划方法 |
CN103009389B (zh) * | 2012-11-30 | 2015-07-08 | 北京控制工程研究所 | 一种冗余空间机械臂在轨抓捕的轨迹规划方法 |
-
2013
- 2013-10-24 CN CN201310507312.7A patent/CN103568012B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN103568012A (zh) | 2014-02-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103568012B (zh) | 一种弧焊机器人双平面摆弧轨迹的规划方法 | |
CN105922265B (zh) | 一种机械臂的运动轨迹规划方法、装置及机器人 | |
CN107608344B (zh) | 基于轨迹规划的车辆运动控制方法、装置及相关设备 | |
CN105127551B (zh) | 一种基于可移动式厚板的自动焊接系统及其焊接方法 | |
CN106094835B (zh) | 前轮驱动车式移动机器人的动态编队控制方法 | |
CN102662350B (zh) | 主从式多机器人协作系统的轨迹示教与规划方法 | |
CN106826834B (zh) | 一种机器人焊接自动寻位方法 | |
CN104029206B (zh) | 封头自动开孔的切割方法 | |
CN102886592B (zh) | 双曲线轨迹定向切线恒速焊接机器人装置 | |
CN107322597A (zh) | 一种基于激光测距的角焊缝焊接轨迹检测装置和方法 | |
CN110465949A (zh) | 焊接机器人及其摆动轨迹的规划方法 | |
CN104236456A (zh) | 一种基于两自由度3d视觉传感器的机器人手眼标定方法 | |
CN105522577A (zh) | 一种用于五轴折弯机器人笛卡尔轨迹规划的方法及其装置 | |
CN110802600A (zh) | 一种六自由度关节型机器人的奇异性处理方法 | |
CN112127630A (zh) | 一种布料机系统及其控制方法 | |
CN109530935A (zh) | 使用激光切割机械臂加工规则孔的方法 | |
CN204603570U (zh) | 一种机器人三维激光自动切割系统 | |
CN104988497A (zh) | 面向复杂回转体表面的激光熔覆轨迹规划方法 | |
Zhuang et al. | Mobile robot hybrid path planning in an obstacle-cluttered environment based on steering control and improved distance propagating | |
CN104827481B (zh) | 一种基于运动控制器的scara机械手控制方法 | |
CN104061888A (zh) | 机器人三维激光加工头tcp坐标修正方法及装置 | |
CN111179632B (zh) | 一种停车机器人定位导航方法 | |
CN103737603B (zh) | 一种流水线上机械臂精确控制系统及控制方法 | |
CN104408226B (zh) | 一种基于离心角变化的管板焊接的椭圆插补方法 | |
CN102385386A (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. |