CN102886591A - 抛物线轨迹定向切线恒速焊接机器人装置 - Google Patents
抛物线轨迹定向切线恒速焊接机器人装置 Download PDFInfo
- Publication number
- CN102886591A CN102886591A CN2012103701729A CN201210370172A CN102886591A CN 102886591 A CN102886591 A CN 102886591A CN 2012103701729 A CN2012103701729 A CN 2012103701729A CN 201210370172 A CN201210370172 A CN 201210370172A CN 102886591 A CN102886591 A CN 102886591A
- Authority
- CN
- China
- Prior art keywords
- theta
- axis
- welding
- parabolic
- pedestal
- 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
- 238000003466 welding Methods 0.000 title claims abstract description 159
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 claims description 57
- 230000005540 biological transmission Effects 0.000 claims description 50
- 229910000679 solder Inorganic materials 0.000 claims description 48
- 229920000535 Tan II Polymers 0.000 claims description 14
- 230000001154 acute effect Effects 0.000 claims description 8
- 238000000034 method Methods 0.000 claims description 7
- 230000010354 integration Effects 0.000 claims description 4
- 230000000694 effects Effects 0.000 abstract description 10
- 238000012423 maintenance Methods 0.000 abstract description 5
- 238000004519 manufacturing process Methods 0.000 abstract description 5
- 238000006467 substitution reaction Methods 0.000 description 11
- 238000010586 diagram Methods 0.000 description 3
- 230000033001 locomotion Effects 0.000 description 3
- 238000005457 optimization Methods 0.000 description 3
- 238000000354 decomposition reaction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000004804 winding Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000003795 chemical substances by application Substances 0.000 description 1
- 238000000205 computational method Methods 0.000 description 1
- 238000009472 formulation Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
- Resistance Welding (AREA)
Abstract
抛物线轨迹定向切线恒速焊接机器人装置,属于焊接机器人技术领域。该装置包括X轴平移组件和Y轴平移组件形成的机械臂、Z轴转台、控制器、焊接电源和焊枪等;带有抛物线轨迹焊缝的工件随工件安装台受控转动,焊枪随X轴、Y轴平移组件受控移动。本发明采用独立运动的三自由度机构实现了对工件抛物线轨迹焊缝高质量焊接功能;进行焊接时,焊枪始终处于抛物线轨迹焊缝焊接点处的法线上,焊接方向为抛物线轨迹的切线方向,且该切线始终朝向预先设定某个固定方向上,焊接速度保持恒定,焊接质量高,效率高,且制造、维修和使用成本低;由于在焊接中的每一点,焊枪与工件上的焊缝焊点均始终保持一种相对位置和姿态,因此可以达到优化的焊接效果。
Description
技术领域
本发明属于焊接机器人技术领域,特别涉及一种抛物线轨迹定向切线恒速焊接机器人装置的结构设计。
背景技术
在航天、航空、船舶和石油化工等领域,大量存在各种具有抛物线弧形的设备。在设备的生产过程中,需要将工件沿抛物线弧轨迹焊接起来。为了获得高质量的焊缝,工件焊接时需要同时达到如下多个目标:焊接时焊枪要求始终处于平焊位置,焊枪始终竖直向下,且焊接方向与抛物线形轨迹在该点的切线方向一致,该切线必须为水平线,焊接速度保持恒定。目前,抛物线轨迹的焊接多采用人工焊接方式,少数也有采用6轴垂直关节型工业机器人进行焊接。前者对工人的技术水平要求高且工人的劳动强度大、焊接效率低,焊接质量不易保证;后者设备复杂,生产和维护成本高。
发明内容
本发明的目的是针对已有技术的不足之处,提供一种抛物线轨迹定向切线恒速焊接机器人装置,该装置可方便实现对工件抛物线轨迹焊缝的焊接,采用该装置进行焊接时,焊枪始终处于抛物线轨迹焊缝上在焊接点处的法线,焊接方向为抛物线轨迹的切线方向,且该切线始终朝向预先设定某个固定方向上以保证获得优化的焊接质量,焊接速度保持恒定,焊接质量高,效率高,装置的制造、维修和使用成本低。
本发明的技术方案如下:
本发明提供的一种抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:包括机械臂、Z轴转台、控制器、焊接电源和焊枪;所述机械臂包括依次串联起来的X轴平移组件和Y轴平移组件;待焊工件的焊缝中心线为抛物线轨迹;
所述X轴平移组件包括第一基座、X轴电机、X轴传动机构和第一滑块;所述第一基座与底座固接,所述X轴电机与第一基座固接,所述X轴电机的输出轴与X轴传动机构的输入端相连,所述X轴传动机构的输出端与第一滑块相连,所述第一滑块滑动镶嵌在第一基座上;
所述Y轴平移组件包括第二基座、Y轴电机、Y轴传动机构和第二滑块;所述第二基座与第一滑块固接;所述Y轴电机与第二基座固接,所述Y轴电机的输出轴与Y轴传动机构的输入端相连,所述Y轴传动机构的输出端与第二滑块相连,所述第二滑块滑动镶嵌在第二基座上;
所述Z轴转台包括第三基座、Z轴电机、Z轴传动机构、关节轴和工件安装台;所述第三基座与底座固接;所述Z轴电机与第三基座固接,所述Z轴电机的输出轴与Z轴传动机构的输入端相连,所述Z轴传动机构的输出端与关节轴相连,所述关节轴活动套设在第三基座 中,所述工件安装台固定套接在关节轴上;
所述焊枪安装在第二滑块上;所述控制器通过控制线路分别与X轴电机、Y轴电机和Z轴电机相连,控制X轴电机、Y轴电机和Z轴电机同时转动;所述控制器与焊接电源相连;需要焊接的工件固定安装在工件安装台上;工件上具有抛物线轨迹的焊缝;
设所述第一滑块相对于第一基座的滑动方向为直线q;设所述第二滑块相对于第二基座的滑动方向为直线s;设所述关节轴的中心线为直线u;直线q、直线s和直线u三者两两垂直;设直线q与直线s构成平面Q1,设工件上焊缝中心线的抛物线轨迹所在平面为平面Q2,平面Q1与平面Q2重合;
控制器控制X轴电机、Y轴电机和Z轴电机同时转动;
建立世界坐标系{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),(dx,dy)为已知常量;
设焊接速度为预设值vw,设工件绕关节轴逆时针转动角速度为ω;抛物线上任意一点坐标(XA,YA)均满足抛物线在抛物线坐标系中的轨迹方程XA 2=-2pYA,p>0为一常数;设所述抛物线坐标系的xA轴与xC轴的夹角为θ,0≤θ≤90°;所述焊枪的中心线与yC轴平行,焊枪的中心线与抛物线轨迹的交点为焊点P;所述焊点P在世界坐标系{C}中的坐标为(XC,YC);设焊枪的末端点T在世界坐标系{C}中的坐标为(XTC,YTC);β为焊点P与关节轴中心OC的连线与xC轴所夹的锐角;所述焊枪的末端点T与焊点P的距离为预设值La;焊枪的末端点T和焊点P沿xC轴的速度相等,均为v1,相对世界坐标系{C}而言;焊枪的末端点T和焊点P沿yC轴的速度相等,均为v2,相对世界坐标系{C}而言;
控制器控制工件和焊枪满足下列关系:
XTC=XC,
YTC=YC+La,
v1=Mω,
v2=Nω,
其中,
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,可以基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
本发明所述的抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:所述X轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
本发明所述的抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:所述Y轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
本发明所述的抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:所述Z轴传动机构为减速机。
本发明所述的抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:还包括送丝机,控制器与送丝机相连,送丝机与焊枪相连。
本发明与现有技术相比,具有以下优点和突出性效果:
该装置采用独立运动的三自由度机构实现了对工件抛物线轨迹焊缝高质量焊接功能,采用该装置进行焊接时,焊枪始终处于抛物线轨迹焊缝上在焊接点处的法线,焊接方向为抛物线轨迹的切线方向,且该切线始终朝向预先设定某个固定方向上,焊接速度保持恒定,焊接质量高,效率高,装置的制造、维修和使用成本低;由于在焊接中的每一点,焊枪与工件上的焊缝焊点均始终保持一种相对位置和姿态,因此可以达到优化的高质量焊接效果;所设定的方向可以是任意方向,例如:当抛物线轨迹处于竖直的立面上时,将焊枪保持在竖直方向上,且焊接方向始终保持在水平方向上,从而获得平焊位置的高质量焊接效果;例如:当抛物线轨迹处于水平面上时,将焊枪和焊接方向均同时始终保持在水平方向上,从而获得横焊位置的高质量焊接效果。
附图说明
图1是本发明的抛物线轨迹定向切线恒速焊接机器人装置的一种实施例的立体视图。
图2是图1所示实施例的正面外观图。
图3是图1所示实施例的侧视图。
图4是图1所示实施例中控制器、焊接电源、焊枪、X轴电机、Y轴电机和Z轴电机的连接关系示意图。
图5是本发明的抛物线轨迹定向切线恒速焊接机器人装置的实施例的坐标系建立情况、各参量几何关系的原理示意图。
图6是具体计算例子中坐标系建立情况示意图,在该例中,世界坐标系的原点刚好在抛物线坐标系的纵轴的负半轴上。
图7是微动分析原理示意图,图中,实线为当前位置,虚线为关节轴转动一个dθ角度后的位置。P1为当前焊点,也是当前抛物线轨迹上的最高点,焊枪的中心线位于该点处抛物线轨迹的法线方向,P1′为工件上的当前焊点在关节轴转动一个dθ角度后的位置,P2为关节轴转动一个dθ角度后的下一个焊点,该新焊点也是抛物线轨迹在下一个位置时的最高点,那一时刻焊枪的中心线依旧位于新焊点处抛物线轨迹的法线方向。
图8、图9、图10、图11分别是通过本发明所述公式和所给逐点计算程序方法计算的一个例子的θ、ω、XC、YC、v1、v2分别与时间t的关系曲线。
在图1至图11中:
1-X轴平移组件, 11-第一基座, 12-X轴电机,
13-X轴传动机构,14-第一滑块,
2-Y轴平移组件, 21-第二基座, 22-Y轴电机,
23-Y轴传动机构,24-第二滑块,
3-Z轴转台, 31-第三基座, 32-Z轴电机,
33-关节轴, 34-工件安装台,35-Z轴传动机构,
4-控制器, 5-焊接电源, 6-焊枪,
61-焊枪中心线, 70-工件, 71-抛物线轨迹焊缝,
8-底座 9-送丝机,
q-第一滑块相对于第一基座的滑动方向的直线;
s-第二滑块相对于第二基座的滑动方向的直线;
u-关节轴的中心线的直线;
{C}-世界坐标系,该世界坐标系的原点OC为关节轴的中心,横轴xC为水平向右,纵轴yC为竖直向上,该世界坐标系与第三基座固接;
{A}-抛物线坐标系,该抛物线坐标系的原点OA为抛物线轨迹的顶点,纵轴yA为抛物线对称轴所在方向,横轴xA过抛物线坐标系的原点与纵轴yA垂直且与抛物线轨迹在同一平面上,该抛物线坐标系与带抛物线轨迹的工件固接;
vw-焊接速度,为预设值,是焊枪相对于工件的相对速度;
p-抛物线在抛物线坐标系中的轨迹方程的常量;
(Adx,Ady)-抛物线轨迹的顶点与关节轴的中心的距离,d为已知常量;
θ-抛物线坐标系的xA轴与xC轴所夹的锐角,也是带抛物线轨迹焊缝的工件随工件安装台、关节轴绕着关节轴的中心线转动的角度(当角度为0时,抛物线坐标系的xA轴与xC轴平行);
P-当前焊点,或称为当前切点,是焊枪的中心线与工件上抛物线轨迹焊缝的交点,也是抛物线轨迹在当前转动位置下的最大YC值点;
T-焊枪的末端点;
La-焊枪的末端点T与焊点P的距离(近似于弧长,将影响弧长),La为预设值;
(XC,YC)-焊点P在世界坐标系{C}中的坐标值;
(XTC,YTC)-焊枪的末端点T在世界坐标系{C}中的坐标值;
β-焊点P与关节轴中心OC的连线与xC轴所夹的锐角,在图7中,β=∠POCxC;
v1-焊枪的末端点T和切点P沿xC轴正方向的运动速度,相对于世界坐标系{C}而言;
v2-焊枪的末端点T和切点P沿yC轴正方向的运动速度,相对于世界坐标系{C}而言;
ω-带抛物线轨迹焊缝的工件绕关节轴的中心OC逆时针转动的角速度,相对于世界坐标系{C}而言;
v3-工件在焊点P处的线速度,相对于世界坐标系{C}而言;
vx、vy-工件在焊点P处的线速度v3分别沿xC轴和yC轴分解的速度,相对于世界坐标系{C}而言;
M、N-为了简便公式书写,采用的中间变量。
具体实施方式
下面结合附图及实施例进一步详细介绍本发明的具体结构、工作原理的内容。
本发明提供的抛物线轨迹定向切线恒速焊接机器人装置的一种实施例,如图1、图2、图3和图4所示,包括机械臂、Z轴转台3、控制器4、焊接电源5和焊枪6;所述机械臂包括依次串联起来的X轴平移组件1和Y轴平移组件2;待焊工件70的焊缝中心线为抛物线轨迹71;
所述X轴平移组件1包括第一基座11、X轴电机12、X轴传动机构13和第一滑块14;所述第一基座11与底座8固接,所述X轴电机12与第一基座11固接,所述X轴电机12的输出轴与X轴传动机构13的输入端相连,所述X轴传动机构13的输出端与第一滑块14相连,所述第一滑块14滑动镶嵌在第一基座11上;
所述Y轴平移组件2包括第二基座21、Y轴电机22、Y轴传动机构23和第二滑块24;所述第二基座21与第一滑块14固接;所述Y轴电机22与第二基座21固接,所述Y轴电机22的输出轴与Y轴传动机构23的输入端相连,所述Y轴传动机构23的输出端与第二滑块24相连,所述第二滑块24滑动镶嵌在第二基座21上;
所述Z轴转台3包括第三基座31、Z轴电机32、Z轴传动机构35、关节轴33和工件安装台34;所述第三基座31与底座8固接;所述Z轴电机32与第三基座31固接,所述Z轴电机32的输出轴与Z轴传动机构35的输入端相连,所述Z轴传动机构35的输出端与关节轴33相连,所述关节轴33活动套设在第三基座31中,所述工件安装台34固定套接在关节轴33上;
所述焊枪6固定安装在第二滑块24上;所述控制器4通过控制线路分别与X轴电机12、Y轴电机22和Z轴电机32相连,控制X轴电机12、Y轴电机22和Z轴电机32同时转动;所述控制器4与焊接电源5相连;需要焊接的工件70固定安装在工件安装台34上;工件上具有抛物线轨迹的焊缝71;
设所述第一滑块14相对于第一基座11的滑动方向为直线q;设所述第二滑块24相对于第二基座21的滑动方向为直线s;设所述关节轴33的中心线为直线u;直线q、直线s和直线u三者两两垂直;设直线q与直线s构成平面Q1,设工件70上焊缝中心线的抛物线轨迹71所在平面为平面Q2,平面Q1与平面Q2重合;
控制器4控制X轴电机12、Y轴电机22和Z轴电机32同时转动;
如图5所示,建立世界坐标系{C},所述世界坐标系{C}的原点为关节轴的中心OC,世界坐标系{C}的横轴xC与直线q平行,xC轴的正方向为离开抛物线轨迹71的方向,也是第一滑块14相对于第一基座11滑动的正方向,世界坐标系{C}的纵轴yC与直线s平行,yC轴的正方向为离开抛物线轨迹71的方向,也是第二滑块24相对于第二基座21滑动的正方向,该世界坐标系{C}与第三基座固接;
建立抛物线坐标系{A},所述抛物线坐标系{A}的原点为抛物线轨迹的顶点OA,抛物线坐标系{A}的纵轴yA与抛物线对称轴重合,抛物线坐标系{A}的横轴xA过抛物线坐标系{A}的原点与纵轴垂直且和抛物线在同一平面内,所述抛物线坐标系{A}与带抛物线轨迹焊缝的工件固接;
点OC在抛物线坐标系{A}中的坐标值为(dx,dy),(dx,dy)为已知常量;一种特例是:所述抛物线坐标系{A}的纵轴yA经过所述关节轴的中心OC,则点OC在抛物线坐标系{A}中的坐标值为(0,dy);图6所示为当点OC在抛物线坐标系{A}中的纵轴yA的负半轴上的情况;
设焊接速度为预设值vw,设工件70绕关节轴33逆时针转动角速度为ω;抛物线上任意一点坐标(XA,YA)均满足抛物线在抛物线坐标系中的轨迹方程XA 2=-2pYA,p>0为一常数;设所述抛物线坐标系的xA轴与xC轴的夹角为θ,0≤θ≤90°;所述焊枪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}而言;
控制器4控制工件70和焊枪6满足下列关系:
XTC=XC,
YTC=YC+La,
v1=Mω,
v2=Nω,
其中,
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,可以基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
本发明所述的抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:所述X轴传动机构13采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
图1所示实施例中,所述X轴传动机构13采用丝杠螺母传动机构。
本发明所述的抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:所述Y轴传动机构23采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
图1所示实施例中,所述Y轴传动机构23采用丝杠螺母传动机构。
图1所示实施例中,所述Z轴传动机构35为减速机。
图1所示实施例还包括送丝机9,控制器与送丝机相连,送丝机与焊枪相连。
结合图1所示实施例说明其工作原理:
最初,工件70的抛物线轨迹所在的抛物线坐标系{A}的xA轴与水平方向重合。工作时, X轴电机12、Y轴电机22和Z轴电机32同时转动:X轴电机12转动,通过X轴传动机构13带动第一滑块在水平方向平移;Y轴电机22转动,通过Y轴传动机构23带动第二滑块在竖直方向平移;Z轴电机32转动,通过Z轴传动机构35带动关节轴33转动,带动工件安装台34转动,工件70绕着关节轴33的中心线转动,抛物线轨迹焊缝71绕着关节轴33的中心线转动。由于各参量满足一定的函数关系,因此可以保证焊点的位置始终保持在抛物线轨迹的最高点,此外,焊枪始终位于平焊位置,即焊枪的中心线始终为抛物线轨迹在该点的法线方向。从而获得良好的焊接质量。
公式推导过程结合图5介绍如下。
(1)目标要求:
工件上抛物线轨迹的 弧段为焊接弧段,当前焊点为P,P位于 上,夹角φ=∠POAG∈[0°,90°]。要求当前焊点P始终在抛物线的最高点水平切线处,焊接速度恒定为预设值vw,焊接速度方向为抛物线在该点的水平切线方向。
(2)求解(XA,YA):
当双曲线轨迹焊缝的工件随关节轴旋转到某一个角度θ时,焊点P在双曲线坐标系{A}中的坐标为(XA,YA)。在{A}坐标系中双曲线方程为:
XA 2=-2pYA,p>0 (1)
由双曲线坐标系{A}与世界坐标系{C}的平移和旋转关系得到:
将(2)式代入(1)式得:
(XC cosθ+YC sinθ+dx)2=-2p(-XC sinθ+YC cosθ+dy). (3)
对(3)式两边对XC微分(此时θ为常量,XC和YC是变量),得:
整理(4)式得
由于焊接点与双曲线相切在双曲线的最高点(保证平焊位置),所以:
将(6)式代入(5)式,得
由(7)式知,(7)式中等号左边部分的分子项为零,即:
(XCcosθ+YCsinθ+dx)cosθ-psinθ=0. (8)
将(2)式代入(8)式得:
XAcosθ-psinθ=0. (9)
联立(1)式和(9)式得关于XA、YA两个未知数的二元方程组:
由(10b)式得
XA=ptanθ. (11)
将(11)式代入(10a)式得
(ptanθ)2=-2pYA. (12)
由(12)式得
将(11)式和(13)式写到一起为:
(3)求解(XC,YC)和(XTC,YTC):
当带双曲线焊缝的工件随关节轴旋转到某一个角度θ时,水平切点(当前焊点)P在世界坐标系{C}中的坐标为(XC,YC)。由公式(2)有:
将(15a)式×sinθ+(15b)式×cosθ,得
YC=XAsinθ+YA cosθ-dxsinθ-dycosθ. (16)
将(16)式代入(15a)式得
XA=XC cosθ+(XAsinθ+YAcosθ-dxsinθ-dy cosθ)sinθ+dx (17)
考虑到sin2+cos2θ=1,整理上式得
XC=XA cos θ-YAsin θ-dxcosθ+dysinθ (18)
将(16)式和(18)式写到一起,为:
将(14)式代入(19)式得
由焊枪与焊点的关系可得
(4)求解β:
由图可知:
(5)求解速度v1、v2、ω:
焊接速度是焊枪相对于双曲线轨迹焊缝的相对速度,在世界坐标系下可以分解为沿横轴和纵轴方向的两个分速度。水平切点在世界坐标系下的速度就是需要求解的为
或写为:
其中,焊接速度vw为预设值,是已知常量。
注意:(23)式中的速度均为代数量,即当速度方向与世界坐标系{C}中xC轴或yC轴相同时为正数,相反时为负数。
(5.1)关于速度v1
由于不论工件转动到何处,要求那一时刻的当前焊点始终与切点重合,即要求焊枪的中心线始终经过那时刻的当前焊点(即切点),从而获得高质量的焊接效果,因此焊枪的末端点T的xC轴向速度v1必须等于切点P的xC轴向速度,即有:
将(20)式代入(24)式中,得
为了简便,令
又因为,
将(26)式和(27)式代入(25)式,得
v1=Mω. (28)
(5.2)关于速度v2
此外,由于不论工件转动到何处,要求焊枪的末端点与切点的距离始终要保持恒定,以确保焊接的电弧长度能够恒定,从而获得高质量的焊接效果。因此焊枪的末端点T的yC轴向速度v2必须等于切点P的yC轴向速度,即有:
将(20)式代入(29)式中,得
为了简便,令
将(27)式和(31)式代入(30)式,得
v2=Nω. (32)
(5.3)关于工件在焊点处的速度vx和vy:
由于工件在当前焊点处的速度由关节轴的转动提供,故有:
(5.4)关于关节轴的角速度ω:
将(28)式、(32)式、(33)式和(34)式代入(23)式中,得
整理得
或写为:
在求解出ω之后,代入到(28)、(32)即可求出速度v1、v2。
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,可以基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
(6)基于上述公式,利用逐点计算方法计算不同时刻的各参量值:
定义如下向量:
n为正整数,代表控制的点数;Δt为时间步长,即两相邻点之间的时间间隔;
n维向量 为焊枪和焊点在世界坐标系{C}中沿xC轴正方向线速度v1坐标值序列,分别对应不同时刻t(1),t(2),...,t(n);
采用如下步骤进行计算:
(a)给定p、d、vw、La;给定初始角度θmin∈[0,90°),给定终止角度θmax∈(0,90°],且θmax>θmin;给定时间步长Δt;继续执行下一步;
(b)i=1;t(1)=0;θ(1)=θmin;Δθ(1)=0;继续执行下一步;
(c)如果i≥2,t(i)=t(i-1)+Δt,θ(i)=θ(i-1)+Δθ(i),继续执行下一步;如果i<2,直接执行下一步;
(d)依次按下列公式计算各参量并赋值给各向量的元素:
XTC=XC,
YTC=YC+La,
v1=Mω,
v2=Nω,
n=i,继续执行下一步;
(e)如果θ(i)+ω(i)·Δt>θmax,程序结束;如果θ(i)+ω(i)·Δt<=θmax,继续执行下一步;
(f)Δθ(i+1)=ω(i)·Δt,继续执行下一步;
(g)i=i+1,继续执行步骤(c)。
上述计算方法获得了对应在不同时刻的下列各个向量:
下面给出一组实际数据具体说明。
假设给定p=100mm、dx=0mm、dy=50mm、vw=6mm/s、La=8mm;给定初始角度θmin=10°,给定终止角度θmax=80°,给定时间步长Δt=1s。
则通过上述逐点计算方法可以计算出结果,各变量θ、ω、XC、YC、v1、v2与时间的关系曲线如图8、图9、图10、图11所示。部分数据值如表1所示。
表1各变量θ、ω、XC、YC、v1、v2的计算值(节选)
该装置采用独立运动的三自由度机构实现了对工件抛物线轨迹焊缝高质量焊接功能,采用该装置进行焊接时,焊枪始终处于抛物线轨迹焊缝上在焊接点处的法线,焊接方向为抛物线轨迹的切线方向,且该切线始终朝向预先设定某个固定方向上,焊接速度保持恒定,焊接质量高,效率高,装置的制造、维修和使用成本低;由于在焊接中的每一点,焊枪与工件上 的焊缝焊点均始终保持一种相对位置和姿态,因此可以达到优化的高质量焊接效果;所设定的方向可以是任意方向,例如:当抛物线轨迹处于竖直的立面上时,将焊枪保持在竖直方向上,且焊接方向始终保持在水平方向上,从而获得平焊位置的高质量焊接效果;例如:当抛物线轨迹处于水平面上时,将焊枪和焊接方向均同时始终保持在水平方向上,从而获得横焊位置的高质量焊接效果。
Claims (5)
1.一种抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:包括机械臂、Z轴转台(3)、控制器(4)、焊接电源(5)和焊枪(6);所述机械臂包括依次串联起来的X轴平移组件(1)和Y轴平移组件(2);待焊工件的焊缝中心线为抛物线轨迹;
所述X轴平移组件包括第一基座(11)、X轴电机(12)、X轴传动机构(13)和第一滑块(14);所述第一基座与底座(8)固接,所述X轴电机与第一基座固接,所述X轴电机的输出轴与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轴传动机构的输入端相连,所述Z轴传动机构的输出端与关节轴相连,所述关节轴活动套设在第三基座中,所述工件安装台固定套接在关节轴上;
所述焊枪固定安装在第二滑块上;所述控制器通过控制线路分别与X轴电机、Y轴电机和Z轴电机相连,控制X轴电机、Y轴电机和Z轴电机同时转动;所述控制器与焊接电源相连;需要焊接的工件固定安装在工件安装台上;工件上具有抛物线轨迹的焊缝;设所述第一滑块相对于第一基座的滑动方向为直线q;设所述第二滑块相对于第二基座的滑动方向为直线s;设所述关节轴的中心线为直线u;直线q、直线s和直线u三者两两垂直;设直线q与直线s构成平面Q1,设工件上焊缝中心线的抛物线轨迹所在平面为平面Q2,平面Q1与平面Q2重合;
建立世界坐标系{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),(dx,dy)为已知常量;
设焊接速度为预设值vw,设工件绕关节轴逆时针转动角速度为ω;抛物线上任意一点坐标(XA,YA)均满足抛物线在抛物线坐标系中的轨迹方程XA 2=-2pYA,p>0为一常数;设所述抛物线坐标系的xA轴与xC轴的夹角为θ,0≤θ≤90°;所述焊枪的中心线与yC轴平行,焊枪的中心线与抛物线轨迹的交点为焊点P;所述焊点P在世界坐标系{C}中的坐标为(XC,YC);设焊枪的末端点T在世界坐标系{C}中的坐标为(XTC,YTC);β为焊点P与关节轴中心OC的连线与xC轴所夹的锐角;所述焊枪的末端点T与焊点P的距离为预设值La;焊枪的末端点T和焊点P沿xC轴的速度相等,均为v1,相对世界坐标系{C}而言;焊枪的末端点T和焊点P沿yC轴的速度相等,均为v2,相对世界坐标系{C}而言;
控制器通过控制工件和焊枪满足下列关系:
XTC=XC,
YTC=YC+La,
v1=Mω,
v2=Nω,
其中,
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,可以基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
2.如权利要求1所述的抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:所述X轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
3.如权利要求1所述的抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:所述Y轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
4.如权利要求1所述的抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:所述Z轴传动机构(35)为减速机。
5.如权利要求1所述的抛物线轨迹定向切线恒速焊接机器人装置,其特征在于:还包括送丝机(9),控制器与送丝机相连,送丝机与焊枪相连。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210370172.9A CN102886591B (zh) | 2012-09-27 | 2012-09-27 | 抛物线轨迹定向切线恒速焊接机器人装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210370172.9A CN102886591B (zh) | 2012-09-27 | 2012-09-27 | 抛物线轨迹定向切线恒速焊接机器人装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102886591A true CN102886591A (zh) | 2013-01-23 |
CN102886591B CN102886591B (zh) | 2014-12-24 |
Family
ID=47530378
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210370172.9A Expired - Fee Related CN102886591B (zh) | 2012-09-27 | 2012-09-27 | 抛物线轨迹定向切线恒速焊接机器人装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102886591B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104625445A (zh) * | 2014-12-12 | 2015-05-20 | 付建生 | 一种自动焊接机的焊接方法 |
CN105414981A (zh) * | 2015-12-23 | 2016-03-23 | 华中科技大学 | 一种电弧增材和铣削加工装置 |
CN106272429A (zh) * | 2016-09-14 | 2017-01-04 | 上海大学 | 一种龙门式吊装机器人工作单元中附加轴运动规划方法 |
CN109158730A (zh) * | 2018-10-29 | 2019-01-08 | 清华大学 | 一种电弧增材制造中焊道的横向连接形貌预测方法 |
CN110480129A (zh) * | 2019-08-05 | 2019-11-22 | 苏州热工研究院有限公司 | 一种轨道式多轴焊接机器人 |
CN110695490A (zh) * | 2019-09-12 | 2020-01-17 | 中国第一重型机械集团大连加氢反应器制造有限公司 | 一种筒节内壁凸台不锈钢层双枪气保护焊自动堆焊装置 |
CN112828463A (zh) * | 2020-12-30 | 2021-05-25 | 广东利元亨智能装备股份有限公司 | 多面体结构的激光焊接方法 |
CN117182246A (zh) * | 2023-11-08 | 2023-12-08 | 徐州巴特工程机械股份有限公司 | 一种挖机回转平台结构件焊接设备 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2613265A1 (fr) * | 1987-04-01 | 1988-10-07 | Havre Chantiers | Dispositif mecanique permettant la reconnaissance automatique de profils de type en v notamment de lignes de soudure devant constituer des joints a souder |
JP2001252767A (ja) * | 2000-03-06 | 2001-09-18 | Kobe Steel Ltd | 立向溶接方法 |
JP2006099474A (ja) * | 2004-09-29 | 2006-04-13 | Fanuc Ltd | ロボットの軌跡制御方法 |
CN101456182A (zh) * | 2007-12-12 | 2009-06-17 | 中国科学院自动化研究所 | 大型工件焊接智能机器人装置 |
CN102091851A (zh) * | 2011-01-07 | 2011-06-15 | 广东中宝炊具制品有限公司 | 一种三轴联动数控焊接机 |
CN202062167U (zh) * | 2010-12-08 | 2011-12-07 | 柳州高华机械有限公司 | 直角坐标五自由度焊接机械手 |
-
2012
- 2012-09-27 CN CN201210370172.9A patent/CN102886591B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2613265A1 (fr) * | 1987-04-01 | 1988-10-07 | Havre Chantiers | Dispositif mecanique permettant la reconnaissance automatique de profils de type en v notamment de lignes de soudure devant constituer des joints a souder |
JP2001252767A (ja) * | 2000-03-06 | 2001-09-18 | Kobe Steel Ltd | 立向溶接方法 |
JP2006099474A (ja) * | 2004-09-29 | 2006-04-13 | Fanuc Ltd | ロボットの軌跡制御方法 |
CN101456182A (zh) * | 2007-12-12 | 2009-06-17 | 中国科学院自动化研究所 | 大型工件焊接智能机器人装置 |
CN202062167U (zh) * | 2010-12-08 | 2011-12-07 | 柳州高华机械有限公司 | 直角坐标五自由度焊接机械手 |
CN102091851A (zh) * | 2011-01-07 | 2011-06-15 | 广东中宝炊具制品有限公司 | 一种三轴联动数控焊接机 |
Non-Patent Citations (2)
Title |
---|
康艳军 等: ""曲线焊缝弧焊机器人和变位机之间协调运动的研究"", 《机械制造与自动化》 * |
张文增 等: ""弧焊机器人工件坐标系快速标定方法"", 《焊接学报》 * |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104625445A (zh) * | 2014-12-12 | 2015-05-20 | 付建生 | 一种自动焊接机的焊接方法 |
CN105414981A (zh) * | 2015-12-23 | 2016-03-23 | 华中科技大学 | 一种电弧增材和铣削加工装置 |
CN105414981B (zh) * | 2015-12-23 | 2018-05-25 | 华中科技大学 | 一种电弧增材和铣削加工装置 |
CN106272429A (zh) * | 2016-09-14 | 2017-01-04 | 上海大学 | 一种龙门式吊装机器人工作单元中附加轴运动规划方法 |
CN106272429B (zh) * | 2016-09-14 | 2018-12-07 | 上海大学 | 一种龙门式吊装机器人工作单元中附加轴运动规划方法 |
CN109158730A (zh) * | 2018-10-29 | 2019-01-08 | 清华大学 | 一种电弧增材制造中焊道的横向连接形貌预测方法 |
CN110480129A (zh) * | 2019-08-05 | 2019-11-22 | 苏州热工研究院有限公司 | 一种轨道式多轴焊接机器人 |
CN110480129B (zh) * | 2019-08-05 | 2021-08-17 | 苏州热工研究院有限公司 | 一种轨道式多轴焊接机器人 |
CN110695490A (zh) * | 2019-09-12 | 2020-01-17 | 中国第一重型机械集团大连加氢反应器制造有限公司 | 一种筒节内壁凸台不锈钢层双枪气保护焊自动堆焊装置 |
CN110695490B (zh) * | 2019-09-12 | 2021-10-22 | 中国第一重型机械集团大连加氢反应器制造有限公司 | 一种筒节内壁凸台不锈钢层双枪气保护焊自动堆焊装置 |
CN112828463A (zh) * | 2020-12-30 | 2021-05-25 | 广东利元亨智能装备股份有限公司 | 多面体结构的激光焊接方法 |
WO2022142355A1 (zh) * | 2020-12-30 | 2022-07-07 | 广东利元亨智能装备股份有限公司 | 多面体结构的激光焊接方法 |
CN117182246A (zh) * | 2023-11-08 | 2023-12-08 | 徐州巴特工程机械股份有限公司 | 一种挖机回转平台结构件焊接设备 |
CN117182246B (zh) * | 2023-11-08 | 2024-02-09 | 徐州巴特工程机械股份有限公司 | 一种挖机回转平台结构件焊接设备 |
Also Published As
Publication number | Publication date |
---|---|
CN102886591B (zh) | 2014-12-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102886592A (zh) | 双曲线轨迹定向切线恒速焊接机器人装置 | |
CN102886591A (zh) | 抛物线轨迹定向切线恒速焊接机器人装置 | |
CN102962549B (zh) | 一种沿立面内任意曲线轨迹焊接的机器人控制方法 | |
CN206326287U (zh) | 一种焊接机器人 | |
CN107042507B (zh) | 一种多自由度驱动手臂及采用该手臂的双臂机器人 | |
US9383741B2 (en) | Mobile robot, positioning system of mobile robot, and positioning method of mobile robot | |
CN107116540B (zh) | 一种基于scs包围结构的机器人碰撞检测方法 | |
CN102764929B (zh) | 椭圆轨迹定向切线恒速焊接机器人装置 | |
CN106041941A (zh) | 一种机械臂的轨迹规划方法及装置 | |
CN109278048B (zh) | 五轴焊接机器人的焊接路径规划方法及五轴焊接机器人 | |
CN103433168A (zh) | 一种五自由度混联喷涂机器人 | |
CN102672311A (zh) | 一种气电立焊自主移动式机器人系统 | |
CN108637553B (zh) | 一种多面焊接机器人 | |
CN202752728U (zh) | 一种气电立焊自主移动式机器人系统 | |
CN101965250A (zh) | 机器人系统 | |
CN203726040U (zh) | 汽车车身数控组合焊装夹具 | |
CN107221247A (zh) | 用于教学的焊接模拟工作站 | |
CN104999463B (zh) | 一种基于构形平面的冗余机械臂运动控制方法 | |
US20230103159A1 (en) | A High-Precision Mobile Robot Management and Scheduling System | |
CN207997306U (zh) | 一种适用于球面加工的三自由度并联机器人 | |
CN110743736A (zh) | 一种悬挂式六自由度混联喷涂机器人 | |
CN113359614B (zh) | 一种并联机器人及其圆弧运动轨迹插补方法 | |
CN206854872U (zh) | 移载平台与库位模块化集成与智能控制装置 | |
CN212265839U (zh) | 一种基于双目视觉定位的双臂机器人 | |
CN105509814B (zh) | 汽车仪表盘检测台 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20141224 |
|
CF01 | Termination of patent right due to non-payment of annual fee |