CN102764929B - 椭圆轨迹定向切线恒速焊接机器人装置 - Google Patents

椭圆轨迹定向切线恒速焊接机器人装置 Download PDF

Info

Publication number
CN102764929B
CN102764929B CN201210256684.2A CN201210256684A CN102764929B CN 102764929 B CN102764929 B CN 102764929B CN 201210256684 A CN201210256684 A CN 201210256684A CN 102764929 B CN102764929 B CN 102764929B
Authority
CN
China
Prior art keywords
theta
axis
pedestal
elliptical orbit
welding
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
CN201210256684.2A
Other languages
English (en)
Other versions
CN102764929A (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.)
Tsinghua University
Original Assignee
Tsinghua University
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 Tsinghua University filed Critical Tsinghua University
Priority to CN201210256684.2A priority Critical patent/CN102764929B/zh
Publication of CN102764929A publication Critical patent/CN102764929A/zh
Application granted granted Critical
Publication of CN102764929B publication Critical patent/CN102764929B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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轴电机分别与控制器相连;所述控制器与焊接电源相连;待焊工件固定安装在工件安装台上;工件上具有椭圆轨迹的焊缝;
设所述第一滑块相对于第一基座的滑动方向为直线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)的横轴xA与椭圆长轴重合,椭圆坐标系(A)的纵轴yA与椭圆短轴重合,所述椭圆坐标系(A)设置在带椭圆轨迹焊缝的工件上;
点OC在椭圆坐标系(A)中的坐标值为(dx,dy),(dx,dy)为已知常量;
设焊接速度为预设值vw,设工件绕关节轴逆时针转动角速度为ω;设a为所述椭圆轨迹的长轴的一半,b为所述椭圆轨迹的短轴的一半;设所述椭圆轨迹的长轴与xC轴的夹角为θ,0≤θ≤90°;所述焊枪的中心线与yC轴平行,焊枪的中心线与椭圆轨迹的交点为焊点P;所述焊点P在世界坐标系(C)中的坐标为(XC,YC);设焊枪的末端点T在世界坐标系(C)中的坐标为(XTC,YTC);所述焊枪的末端点T与焊点P的距离为预设值La;焊枪的末端点T和焊点P沿xC轴的速度相等,均为v1,相对世界坐标系(C)而言;焊枪的末端点T和焊点P沿yC轴的速度相等,均为v2,相对世界坐标系(C)而言;
控制器控制工件和焊枪满足下列关系:
X C = ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ,
Y C = a 2 tan 2 θ + b 2 cos θ - d x sin θ - d y cos θ ,
XTC=XC,
YTC=YC+La,
β = arctan ( Y C X C ) ,
ω = v w ( M + X C 2 + Y C 2 sin β ) 2 + ( N - X C 2 + Y C 2 cos β ) 2 ,
v1=Mω,
v2=Nω,
其中,
M = ( a 2 - b 2 ) ( b 2 - a 2 tan 4 θ ) cos θ ( a 2 tan 2 θ + b 2 ) a 2 tan 2 θ + b 2 + d x sin θ + d y cos θ ,
N = ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ,
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述X轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述Y轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述Z轴传动机构为减速机。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:还包括送丝机,控制器与送丝机相连,送丝机与焊枪相连。
本发明提供的另一种椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:包括机械臂、Z轴转台、控制器、焊接电源和焊枪;所述机械臂包括依次串联起来的X轴平移组件和Y轴平移组件;待焊工件的焊缝中心线为椭圆轨迹;
所述X轴平移组件包括第一基座、X轴电机、X轴传动机构和第一滑块;所述X轴电机与第一基座固接,所述X轴电机的输出轴与X轴传动机构的输入端相连,所述X轴传动机构的输出端与第一滑块相连,所述第一滑块滑动镶嵌在第一基座上;
所述Y轴平移组件包括第二基座、第二滑块和平面压板;所述第二基座与第一滑块固接;所述第二滑块滑动镶嵌在第二基座上;所述平面压板与第二滑块固接;所述平面压板与工件相接触,平面压板的下表面与椭圆轨迹相切;所述平面压板的下表面为水平面;
所述Z轴转台包括第三基座、Z轴电机、Z轴传动机构、关节轴和工件安装台;所述第三基座与第一基座固接;所述Z轴电机与第三基座固接,所述Z轴电机的输出轴与Z轴传动机构的输入端相连,所述Z轴传动机构的输出端与关节轴相连,所述关节轴活动套设在第三基座中,所述工件安装台固定套接在关节轴上;
所述焊枪安装在第二滑块上,焊枪与焊接电源相连;所述X轴电机和Z轴电机分别与控制器相连;所述控制器与焊接电源相连;待焊工件固定安装在工件安装台上;工件上具有椭圆轨迹的焊缝;
设所述第一滑块相对于第一基座的滑动方向为直线q;设所述第二滑块相对于第二基座的滑动方向为直线s;设所述关节轴的中心线为直线u;直线q、直线s和直线u三者两两垂直;设直线q与直线s构成平面Q1,设工件上焊缝中心线的椭圆轨迹所在平面为平面Q2,平面Q1与平面Q2重合;
控制器控制X轴电机和Z轴电机同时转动;
建立世界坐标系(C),所述世界坐标系(C)的原点为关节轴的中心OC,世界坐标系(C)的横轴xC与直线q平行,xC轴的正方向为离开椭圆轨迹的方向,也是第一滑块相对于第一基座滑动的正方向,世界坐标系(C)的纵轴yC与直线s平行,yC轴的正方向为离开椭圆轨迹的方向,也是第二滑块相对于第二基座滑动的正方向,该世界坐标系(C)设置在第三基座上;
建立椭圆坐标系(A),所述椭圆坐标系(A)的原点为椭圆轨迹的中心OA,椭圆坐标系(A)的横轴xA与椭圆长轴重合,椭圆坐标系(A)的纵轴yA与椭圆短轴重合,所述椭圆坐标系(A)设置在带椭圆轨迹焊缝的工件上;
点OC在椭圆坐标系(A)中的坐标值为(dx,dy),(dx,dy)为已知常量;
设焊接速度为预设值vw,设工件绕关节轴逆时针转动角速度为ω;设a为所述椭圆轨迹的长轴的一半,b为所述椭圆轨迹的短轴的一半;设所述椭圆轨迹的长轴与xC轴的夹角为θ,0≤θ≤90°;所述焊枪的中心线与yC轴平行,焊枪的中心线与椭圆轨迹的交点为焊点P;所述焊点P在世界坐标系(C)中的坐标为(XC,YC);设焊枪的末端点T在世界坐标系(C)中的坐标为(XTC,YTC);所述焊枪的末端点T与焊点P的距离为预设值La;焊枪的末端点T和焊点P沿xC轴的速度相等,均为v1,相对世界坐标系(C)而言;焊枪的末端点T和焊点P沿yC轴的速度相等,均为v2,相对世界坐标系(C)而言;
控制器控制工件和焊枪满足下列关系:
X C = ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ,
Y C = a 2 tan 2 θ + b 2 cos θ - d x sin θ - d y cos θ ,
XTC=XC,
YTC=YC+La,
β = arctan ( Y C X C ) ,
ω = v w ( M + X C 2 + Y C 2 sin β ) 2 + ( N - X C 2 + Y C 2 cos β ) 2 ,
v1=Mω,
v2=Nω,
其中,
M = ( a 2 - b 2 ) ( b 2 - a 2 tan 4 θ ) cos θ ( a 2 tan 2 θ + b 2 ) a 2 tan 2 θ + b 2 + d x sin θ + d y cos θ ,
N = ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ,
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述X轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述Z轴传动机构为减速机。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:还包括送丝机,控制器与送丝机相连,送丝机与焊枪相连。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:还包括簧件,所述簧件的两端分别连接第二滑块和第二基座,所述簧件采用拉簧、压簧、扭簧或片簧。
本发明与现有技术相比,具有以下优点和突出性效果:
该装置采用独立运动的三自由度机构实现了对工件椭圆轨迹焊缝高质量焊接功能,采用该装置进行焊接时,焊枪始终处于椭圆轨迹焊缝上在焊接点处的法线,焊接方向为椭圆轨迹的切线方向,且该切线始终朝向预先设定某个固定方向上,焊接速度保持恒定,焊接质量高,效率高,装置的制造、维修和使用成本低;由于在焊接中的每一点,焊枪与工件上的焊缝焊点均始终保持一种相对位置和姿态,因此可以达到优化的高质量焊接效果;所设定的方向可以是任意方向,例如:当椭圆轨迹处于竖直的立面上时,将焊枪保持在竖直方向上,且焊接方向始终保持在水平方向上,从而获得平焊位置的高质量焊接效果;例如:当椭圆轨迹处于水平面上时,将焊枪和焊接方向均同时始终保持在水平方向上,从而获得横焊位置的高质量焊接效果。
附图说明
图1是本发明的椭圆轨迹定向切线恒速焊接机器人装置的一种实施例的立体视图。
图2是图1所示实施例的正面外观图。
图3是图1所示实施例的侧视图。
图4是图1所示实施例中控制器、焊接电源、焊枪、X轴电机、Y轴电机和Z轴电机的连接关系示意图。
图5是本发明的椭圆轨迹定向切线恒速焊接机器人装置的另一种实施例的立体视图。
图6是图5所示实施例的正面外观图。
图7是图5所示实施例的侧视图。
图8是图5所示实施例中控制器、焊接电源、焊枪、X轴电机和Z轴电机的连接关系示意图。
图9是本发明的椭圆轨迹定向切线恒速焊接机器人装置的两种实施例的坐标系建立情况、各参量几何关系的原理示意图。
图10是具体计算例子中坐标系建立情况示意图,在该例中,世界坐标系的原点刚好在椭圆坐标系的纵轴的正半轴上。
图11是微动分析原理示意图,图中,实线为当前位置,虚线为关节轴转动一个dθ角度后的位置。P1为当前焊点,也是当前椭圆轨迹上的最高点,焊枪的中心线位于该点处椭圆轨迹的法线方向,P1′为工件上的当前焊点在关节轴转动一个dθ角度后的位置,P2为关节轴转动一个dθ角度后的下一个焊点,该新焊点也是椭圆轨迹在下一个位置时的最高点,那一时刻焊枪的中心线依旧位于新焊点处椭圆轨迹的法线方向。
图12、图13、图14、图15分别是通过本发明所述公式和所给逐点计算程序方法计算的一个例子的θ、ω、XC、YC、v1、v2分别与时间t的关系曲线。
在图1至图15中:
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-平面压板,     81-弹簧,        9-送丝机,
q-第一滑块相对于第一基座的滑动方向的直线;
s-第二滑块相对于第二基座的滑动方向的直线;
u-关节轴的中心线的直线;
(C)-世界坐标系,该世界坐标系的原点OC为关节轴的中心,横轴xC为水平向右,纵轴yC为竖直向上,该世界坐标系设置在第三基座上;
(A)-椭圆坐标系,该椭圆坐标系的原点OA为椭圆轨迹的中心,横轴xA为椭圆长轴所在方向,纵轴yA为椭圆短轴所在方向,该椭圆坐标系与带椭圆轨迹的工件固接;
vw-焊接速度,为预设值,是焊枪相对于工件的相对速度;
a-椭圆轨迹的长轴的一半,a为已知常量;
b-椭圆轨迹的短轴的一半,b为已知常量;
(Adx,Ady)-椭圆轨迹的中心与关节轴的中心的距离,d为已知常量;
θ-椭圆轨迹的长轴与xC轴所夹的锐角,也是带椭圆轨迹焊缝的工件随工件安装台、关节轴绕着关节轴的中心线转动的角度(当角度为0时,椭圆轨迹的长轴与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;所述X轴电机12与第一基座11固接,所述X轴电机12的输出轴与X轴传动机构13的输入端相连,所述X轴传动机构13的输出端与第一滑块14相连,所述第一滑块14滑动镶嵌在第一基座11上;
所述Y轴平移组件2包括第二基座21、Y轴电机22、Y轴传动机构23和第二滑块24;所述第二基座21与第一滑块24固接;所述Y轴电机22与第二基座21固接,所述Y轴电机22的输出轴与Y轴传动机构23的输入端相连,所述Y轴传动机构23的输出端与第二滑块24相连,所述第二滑块24滑动镶嵌在第二基座21上;
所述Z轴转台3包括第三基座31、Z轴电机32、Z轴传动机构35、关节轴33和工件安装台34;所述第三基座31与第一基座11固接;所述Z轴电机32与第三基座31固接,所述Z轴电机32的输出轴与Z轴传动机构35的输入端相连,所述Z轴传动机构35的输出端与关节轴33相连,所述关节轴33活动套设在第三基座31中,所述工件安装台34固定套接在关节轴33上;
所述焊枪6固定安装在第二滑块24上,焊枪6与焊接电源5相连;所述X轴电机12、Y轴电机22和Z轴电机32分别与控制器4相连;所述控制器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同时转动;
如图7所示,建立世界坐标系(C),所述世界坐标系(C)的原点为关节轴的中心OC,世界坐标系(C)的横轴xC与直线q平行,xC轴的正方向为离开椭圆轨迹71的方向,也是第一滑块14相对于第一基座11滑动的正方向,世界坐标系(C)的纵轴yC与直线s平行,yC轴的正方向为离开椭圆轨迹71的方向,也是第二滑块24相对于第二基座21滑动的正方向,该世界坐标系(C)设置在第三基座上;
建立椭圆坐标系(A),所述椭圆坐标系(A)的原点为椭圆轨迹的中心OA,椭圆坐标系(A)的横轴xA与椭圆长轴重合,椭圆坐标系(A)的纵轴yA与椭圆短轴重合,所述椭圆坐标系(A)设置在带椭圆轨迹焊缝的工件上;
点OC在椭圆坐标系(A)中的坐标值为(dx,dy),(dx,dy)为已知常量;一种特例是:所述椭圆坐标系(A)的纵轴yA经过所述关节轴的中心OC,则点OC在椭圆坐标系(A)中的坐标值为(0,dy);图10所示为当点OC在椭圆坐标系(A)中的纵轴yA的正半轴上的情况;
设焊接速度为预设值vw,设工件70绕关节轴33逆时针转动角速度为ω;设a为所述椭圆轨迹71的长轴的一半,b为所述椭圆轨迹71的短轴的一半;设所述椭圆轨迹71的长轴与xC轴的夹角为θ,0≤θ≤90°;所述焊枪6的中心线与yC轴平行,焊枪6的中心线与椭圆轨迹71的交点为焊点P;所述焊点P在世界坐标系(C)中的坐标为(XC,YC);设焊枪6的末端点T在世界坐标系(C)中的坐标为(XTC,YTC);所述焊枪6的末端点T与焊点P的距离为预设值La;焊枪6的末端点T和焊点P沿xC轴的速度相等,均为v1,相对世界坐标系(C)而言;焊枪6的末端点T和焊点P沿yC轴的速度相等,均为v2,相对世界坐标系(C)而言;
控制器4控制工件70和焊枪6满足下列关系:
X C = ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ,
Y C = a 2 tan 2 θ + b 2 cos θ - d x sin θ - d y cos θ ,
XTC=XC,
YTC=YC+La,
β = arctan ( Y C X C ) ,
ω = v w ( M + X C 2 + Y C 2 sin β ) 2 + ( N - X C 2 + Y C 2 cos β ) 2 ,
v1=Mω,
v2=Nω,
其中,
M = ( a 2 - b 2 ) ( b 2 - a 2 tan 4 θ ) cos θ ( a 2 tan 2 θ + b 2 ) a 2 tan 2 θ + b 2 + d x sin θ + d y cos θ ,
N = ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ,
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述X轴传动机构13采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
图1所示实施例中,所述X轴传动机构13采用丝杠螺母传动机构。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述Y轴传动机构23采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
图1所示实施例中,所述Y轴传动机构23采用丝杠螺母传动机构。
图1所示实施例中,所述Z轴传动机构35为减速机。
图1所示实施例还包括送丝机9,控制器与送丝机相连,送丝机与焊枪相连。
本发明提供的椭圆轨迹定向切线恒速焊接机器人装置的另一种实施例,如图5、图6、图7、图8所示,包括机械臂、Z轴转台3、控制器4、焊接电源5和焊枪6;所述机械臂包括依次串联起来的X轴平移组件1和Y轴平移组件2;待焊工件70的焊缝中心线为椭圆轨迹71;
所述X轴平移组件1包括第一基座11、X轴电机12、X轴传动机构13和第一滑块14;所述X轴电机12与第一基座11固接,所述X轴电机12的输出轴与X轴传动机构13的输入端相连,所述X轴传动机构13的输出端与第一滑块14相连,所述第一滑块14滑动镶嵌在第一基座11上;
所述Y轴平移组件2包括第二基座21、第二滑块24和平面压板8;所述第二基座21与第一滑块24固接;所述第二滑块24滑动镶嵌在第二基座21上;所述平面压板8与第二滑块24固接;所述平面压板8与工件70上方相接触,平面压板8的下表面与椭圆轨迹71相切;所述平面压板8的下表面为水平面;
所述Z轴转台3包括第三基座31、Z轴电机32、Z轴传动机构35、关节轴33和工件安装台34;所述第三基座31与第一基座11固接;所述Z轴电机32与第三基座31固接,所述Z轴电机32的输出轴与Z轴传动机构35的输入端相连,所述Z轴传动机构35的输出端与关节轴33相连,所述关节轴33活动套设在第三基座31中,所述工件安装台34固定套接在关节轴33上;
所述焊枪6固定安装在第二滑块24上,焊枪6与焊接电源5相连;所述X轴电机12和Z轴电机32分别与控制器4相连;所述控制器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和Z轴电机32同时转动;
如图7所示,建立世界坐标系(C),所述世界坐标系(C)的原点为关节轴的中心OC,世界坐标系(C)的横轴xC与直线q平行,xC轴的正方向为离开椭圆轨迹71的方向,也是第一滑块14相对于第一基座11滑动的正方向,世界坐标系(C)的纵轴yC与直线s平行,yC轴的正方向为离开椭圆轨迹71的方向,也是第二滑块24相对于第二基座21滑动的正方向,该世界坐标系(C)设置在第三基座上;
建立椭圆坐标系(A),所述椭圆坐标系(A)的原点为椭圆轨迹的中心OA,椭圆坐标系(A)的横轴xA与椭圆长轴重合,椭圆坐标系(A)的纵轴yA与椭圆短轴重合,所述椭圆坐标系(A)设置在带椭圆轨迹焊缝的工件上;
点OC在椭圆坐标系(A)中的坐标值为(dx,dy),(dx,dy)为已知常量;一种特例是:所述椭圆坐标系(A)的纵轴yA经过所述关节轴的中心OC,则点OC在椭圆坐标系(A)中的坐标值为(0,dy);图10所示为当点OC在椭圆坐标系(A)中的纵轴yA的正半轴上的情况;
设焊接速度为预设值vw,设工件70绕关节轴33逆时针转动角速度为ω;设a为所述椭圆轨迹71的长轴的一半,b为所述椭圆轨迹71的短轴的一半,d为所述椭圆轨迹71的中心OA与关节轴中心OC的距离;设所述椭圆轨迹71的长轴与xC轴的夹角为θ,0≤θ≤90°;所述焊枪6的中心线与yC轴平行,焊枪6的中心线与椭圆轨迹71的交点为焊点P;所述焊点P在世界坐标系(C)中的坐标为(XC,YC);设焊枪6的末端点T在世界坐标系(C)中的坐标为(XTC,YTC);所述焊枪6的末端点T与焊点P的距离为预设值La;焊枪6的末端点T和焊点P沿xC轴的速度相等,均为v1,相对世界坐标系(C)而言;焊枪6的末端点T和焊点P沿yC轴的速度相等,均为v2,相对世界坐标系(C)而言;
控制器4控制工件70和焊枪6满足下列关系:
X C = ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ,
Y C = a 2 tan 2 θ + b 2 cos θ - d x sin θ - d y cos θ ,
XTC=XC,
YTC=YC+La,
β = arctan ( Y C X C ) ,
ω = v w ( M + X C 2 + Y C 2 sin β ) 2 + ( N - X C 2 + Y C 2 cos β ) 2 ,
v1=Mω,
v2=Nω,
其中,
M = ( a 2 - b 2 ) ( b 2 - a 2 tan 4 θ ) cos θ ( a 2 tan 2 θ + b 2 ) a 2 tan 2 θ + b 2 + d x sin θ + d y cos θ ,
N = ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ,
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
本发明所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述X轴传动机构13采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
图5所示的第二种实施例中,所述X轴传动机构13采用丝杠螺母传动机构。
图5所示的第二种实施例中,所述Z轴传动机构35为减速机。
图5所示的第二种实施例还包括送丝机9,控制器与送丝机相连,送丝机与焊枪相连。
图5所示的第二种实施例还包括簧件81,所述簧件的两端分别连接第二滑块和第二基座;所述簧件可以采用拉簧、压簧、扭簧或片簧。本实施例中采用压簧。该簧件使得与第二滑块固接的平面压板紧靠工件的上表面椭圆轨迹。
结合图1所示第一种实施例说明其工作原理:
最初,工件70的椭圆轨迹的长轴与水平方向重合。工作时,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所示的第二种实施例说明其工作原理:
最初,工件70的椭圆轨迹的长轴与水平方向重合。工作时,X轴电机12和Z轴电机32同时转动:X轴电机12转动,通过X轴传动机构13带动第一滑块在水平方向平移;Z轴电机32转动,通过Z轴传动机构35带动关节轴33转动,带动工件安装台34转动,待焊工件70绕着关节轴33的中心线转动,椭圆轨迹焊缝71绕着关节轴33的中心线转动。由于平面压板始终压在工件的椭圆轨迹上方且平面压板的下表面为水平面,因此无论椭圆如何转动,平面压板始终与椭圆轨迹相切于最高点,因此椭圆轨迹在逆时针转动过程中,工件会抬起平面压板,从而抬起在第二基座上自由滑动的第二滑块,焊枪被抬起,同时由于各参量满足一定的函数关系,焊枪会水平移动到最高点的水平位置,因此焊枪的末端点与焊点的弧长得以保证,且当前焊点就是椭圆轨迹的最高点。因此可以保证焊点的位置始终保持在椭圆轨迹的最高点,此外,焊枪始终位于平焊位置,即焊枪的中心线始终为椭圆轨迹在该点的法线方向。从而获得良好的焊接质量。
公式推导过程结合图7介绍如下。
(1)目标要求:
工件上椭圆轨迹的弧段为焊接弧段,当前焊点为P,P位于上,夹角φ=∠POAG∈[0°,90°]。要求当前焊点P始终在椭圆的最高点水平切线处,焊接速度恒定为预设值vw,焊接速度方向为椭圆在该点的水平切线方向。
(2)求解(XA,YA):
当椭圆轨迹焊缝的工件随关节轴旋转到某一个角度θ时,焊点P在椭圆坐标系(A)中的坐标为(XA,YA)。在(A)坐标系中椭圆方程为:
X A 2 a 2 + Y A 2 b 2 = 1 . - - - ( 1 )
由椭圆坐标系(A)与世界坐标系(C)的平移和旋转关系得到:
X A = X C cos θ + Y C sin θ + d x , Y A = - X C sin θ + Y C cos θ + d y . - - - ( 2 )
将(2)式代入(1)式得:
( X C cos θ + Y C sin θ + d x ) 2 a 2 + ( - X C sin θ + Y C cos θ + d y ) 2 b 2 = 1 . - - - ( 3 )
对(3)式两边对XC微分(此时θ为常量,XC和YC是变量),得:
2 a 2 ( X C cos θ + Y C sin θ + d x ) ( cos θ + dY C d X C sin θ ) + 2 b 2 ( - X C sin θ + Y C cos θ + d y ) ( - sin θ + dY C d X C cos θ ) = 0 . - - - ( 4 )
整理(4)式得
d Y C d X C = - b 2 ( X C cos θ + Y C sin θ + d x ) cos θ + a 2 ( - X C sin θ + Y C cos θ + d y ) sin θ b 2 ( X C cos θ + Y C sin θ + d x ) sin θ + a 2 ( - X C sin θ + Y C cos θ + d y ) cos θ . - - - ( 5 )
由于焊接点与椭圆相切在椭圆的最高点(保证平焊位置),所以:
d Y C d X C = 0 . - - - ( 6 )
将(6)式代入(5)式,得
- b 2 ( X C cos θ + Y C sin θ + d x ) cos θ + a 2 ( - X C sin θ + Y C cos θ + d y ) sin θ b 2 ( X C cos θ + Y C sin θ + d x ) sin θ + a 2 ( - X C sin θ + Y C cos θ + d y ) cos θ . - - - ( 7 )
由(7)式知,(7)式中等号左边部分的分子项为零,即:
-b2(XCcosθ+YCsinθ+dx)cosθ+a2(-XCsinθ+YCcosθ+dy)sinθ=0.       (8)
将(2)式代入(8)式得:
-b2XAcosθ+a2YAsinθ=0.       (9)联立(1)式和(9)式得关于XA、YA两个未知数的二元方程组:
X A 2 a 2 + Y A 2 b 2 = 1 , ( 10 a ) - b 2 X A cos θ + a 2 Y A sin θ = 0 . ( 10 b )
由(10b)式得
X A = a 2 sin θ b 2 cos θ Y A . - - - ( 11 )
将(11)式代入(10a)式得
( a 2 sin θ b 2 cos θ Y A ) 2 a 2 + Y A 2 b 2 = 1 . - - - ( 12 )
因为YA≥0,由(12)式得
Y A = b 2 a 2 tan 2 θ + b 2 . - - - ( 13 )
将(13)式代入(11)式得
Y A = a 2 tan θ a 2 tan 2 θ + b 2 . - - - ( 14 )
将(13)式和(14)式写到一起为:
X A = a 2 tan θ a 2 tan 2 θ + b 2 , Y A = b 2 a 2 tan 2 θ + b 2 . - - - ( 15 )
(3)求解(XC,YC)和(XTC,YTC):
当带椭圆焊缝的工件随关节轴旋转到某一个角度θ时,水平切点(当前焊点)P在世界坐标系(C)中的坐标为(XC,YC)。由(公式2)有:
X A = X C cos θ + Y C sin θ + d x , ( 16 a ) Y A = - X C sin θ + Y C cos θ + d y . ( 16 b )
将(16a)式×sinθ+(16b)式×cosθ,得
YC=XAsinθ+YAcosθ-dxsinθ-dycosθ.       (17)将(17)式代入(16a)式得
XA=XCcosθ+(XAsinθ+YAcosθ-dxsinθ-dycosθ)sinθ+dx
考虑到sin2θ+cos2θ=1,整理上式得
XC=XAcosθ-YAsinθ-dxcosθ+dysinθ       (18)
将(17)式和(18)式写到一起,为:
X C = X A cos θ - Y A sin θ - d x cos θ + d y sin θ , Y C = X A sin θ + Y A cos θ - d x sin θ - d y cos θ . - - - ( 19 )
将(15)式代入(19)式得
X C = ( a 2 tan θ a 2 tan 2 θ + b 2 ) cos θ - ( b 2 a 2 tan 2 θ + b 2 ) sin θ - d x cos θ + d y sin θ , Y C = ( a 2 tan θ a 2 tan 2 θ + b 2 ) sin θ + ( b 2 a 2 tan 2 θ + b 2 ) cos θ - d x sin θ - d y cos θ .
X C = ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ , Y C = a 2 tan 2 θ + b 2 cos θ - d x sin θ - d y cos θ . - - - ( 20 )
由焊枪与焊点的关系可得
X TC = X C , Y TC = Y C + L a . - - - ( 21 )
(4)求解β:
由图可知:
β = arctan ( Y C X C ) . - - - ( 22 )
(5)求解速度v1、v2、ω:
焊接速度是焊枪相对于椭圆轨迹焊缝的相对速度,在世界坐标系下可以分解为沿横轴和纵轴方向的两个分速度。水平切点在世界坐标系下的速度就是需要求解的为
v w = ( v 1 - v x ) 2 + ( v 2 - v y ) 2 .
或写为:
v w 2 = ( v 1 - v x ) 2 + ( v 2 - v y ) 2 . - - - ( 23 )
其中,焊接速度vw为预设值,是已知常量。
注意:(23)式中的速度均为代数量,即当速度方向与世界坐标系(C)中xC轴或yC轴相同时为正数,相反时为负数。
(5.1)关于速度v1
由于不论工件转动到何处,要求那一时刻的当前焊点始终与切点重合,即要求焊枪的中心线始终经过那时刻的当前焊点(即切点),从而获得高质量的焊接效果,因此焊枪的末端点T的xC轴向速度v1必须等于切点P的xC轴向速度,即有:
v 1 = d X C dt , - - - ( 24 )
将(20)式代入(24)式中,得
v 1 = d [ ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ] dt ,
v 1 = [ ( a 2 - b 2 ) a 2 tan 2 θ ( cos θ - sec θ ) + b 2 cos θ ( a 2 tan 2 θ + b 2 ) a 2 tan 2 θ + b 2 + d x sin θ + d y cos θ ] dθ dt ,
或写为:
v 1 = [ ( a 2 - b 2 ) ( b 2 - a 2 tan 4 θ ) cos θ ( a 2 tan 2 θ + b 2 ) a 2 tan 2 θ + b 2 + d x sin θ + d y cos θ ] dθ dt , - - - ( 25 )
为了简便,令
M = ( a 2 - b 2 ) ( b 2 - a 2 tan 4 θ ) cos θ ( a 2 tan 2 θ + b 2 ) a 2 tan 2 θ + b 2 + d x sin θ + d y cos θ . - - - ( 26 )
又因为,
ω = dθ dt , - - - ( 27 )
将(26)式和(27)式代入(25)式,得
v1=Mω.          (28)
(5.2)关于速度v2
此外,由于不论工件转动到何处,要求焊枪的末端点与切点的距离始终要保持恒定,以确保焊接的电弧长度能够恒定,从而获得高质量的焊接效果。因此焊枪的末端点T的yC轴向速度v2必须等于切点P的yC轴向速度,即有:
v 2 = d Y C dt , - - - ( 29 )
将(20)式代入(29)式中,得
v 2 = d [ a 2 tan 2 θ + b 2 cos θ - d x sin θ - d y cos θ ] dt ,
v 2 = [ - a 2 tan 2 θ + b 2 sin θ + a 2 tan θ sec θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ] dθ dt .
化简得
v 2 = [ ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ ] dθ dt . - - - ( 30 )
为了简便,令
N = ( a 2 - b 2 ) sin θ a 2 tan 2 θ + b 2 - d x cos θ + d y sin θ . - - - ( 31 )
将(27)式和(31)式代入(30)式,得
v2=Nω.            (32)
(5.3)关于工件在焊点处的速度vx和vy
由于工件在当前焊点处的速度由关节轴的转动提供,故有:
v x = v 3 sin β = - ω | PO C | sin β = - ω X C 2 + Y C 2 sin β . - - - ( 33 )
v y = v 3 cos β = ω | PO C | cos β = ω X C 2 + Y C 2 cos β . - - - ( 34 )
(5.4)关于关节轴的角速度ω:
将(28)式、(32)式、(33)式和(34)式代入(23)式中,得
v w 2 = ( Mω + ω X C 2 + Y C 2 sin β ) 2 + ( Nω - ω X C 2 + Y C 2 cos β ) 2 .
整理得
ω = v w ( M + X C 2 + Y C 2 sin β ) 2 + ( N - X C 2 + Y C 2 cos β ) 2 . - - - ( 35 )
或写为:
ω = v w M 2 + N 2 + ( X C 2 + Y C 2 ) + 2 X C 2 + Y C 2 ( M sin β - N cos β ) - - - ( 36 )
在求解出ω之后,代入到(28)、(32)即可求出速度v1、v2
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
(6)基于上述公式,利用逐点计算方法计算不同时刻的各参量值:
定义如下向量:
n为正整数,代表控制的点数;Δt为时间步长,即两相邻点之间的时间间隔;
n维向量为不同的时刻,且t(1)=0,t(i)=(i-1)·Δt,其中,i=1,2,...,n;
n维向量为椭圆轨迹的长轴与xC轴所夹的锐角θ序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为椭圆轨迹的长轴与xC轴所夹的锐角差Δθ序列,且Δθ(1)=0,Δθ(j+1)=θ(j+1)-θ(j),其中,j=1,2,...,n-1;
n维向量为焊点P在世界坐标系(C)中的xC轴坐标值序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为焊点P在世界坐标系(C)中的yC轴坐标值序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为焊枪的末端点T在世界坐标系(C)中的xC轴坐标值序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为焊枪的末端点T在世界坐标系(C)中的yC轴坐标值序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为焊点P与关节轴中心OC的连线与xC轴所夹的锐角序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为中间变量M序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为中间变量N序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为椭圆轨迹焊缝绕关节轴中心OC逆时针转动的角速度ω序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为工件在焊点P处的线速度v3在世界坐标系(C)中沿xC轴正方向分解速度vx坐标值序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为工件在焊点P处的线速度v3在世界坐标系(C)中沿yC轴正方向分解速度vy坐标值序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为焊枪和焊点在世界坐标系(C)中沿xC轴正方向线速度v1坐标值序列,分别对应不同时刻t(1),t(2),...,t(n);
n维向量为焊枪和焊点在世界坐标系(C)中沿yC轴正方向线速度v2坐标值序列,分别对应不同时刻t(1),t(2),...,t(n)。
采用如下步骤进行计算:
(a)给定a、b、d、vw、La;给定初始角度θmin∈[0,90°),给定终止角度θmax∈(0,90°],且θmaxmin;给定时间步长Δ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)依次按下列公式计算各参量并赋值给各向量的元素:
X C ( i ) = ( a 2 - b 2 ) sin &theta; ( i ) a 2 tan 2 &theta; ( i ) + b 2 - d x cos &theta; ( i ) + d y sin &theta; ( i ) ,
Y C ( i ) = a 2 tan 2 &theta; ( i ) + b 2 cos &theta; ( i ) - d x sin &theta; ( i ) - d y cos &theta; ( i ) ,
XTC(i)=XC(i),
YTC(i)=YC(i)+La,
&beta; ( i ) = arctan ( Y C ( i ) X C ( i ) ) ,
M ( i ) = ( a 2 - b 2 ) ( b 2 - a 2 tan 4 &theta; ( i ) ) cos &theta; ( i ) ( a 2 tan 2 &theta; ( i ) + b 2 ) a 2 tan 2 &theta; ( i ) + b 2 + d x sin &theta; ( i ) + d y cos &theta; ( i ) ,
N ( i ) = ( a 2 - b 2 ) sin &theta; ( i ) a 2 tan 2 &theta; ( i ) + b 2 - d x cos &theta; ( i ) + d y sin &theta; ( i )
&omega; ( i ) = v w [ M ( i ) + [ X C ( i ) ] 2 + [ Y C ( i ) ] 2 sin &beta; ( i ) ] 2 + [ N ( i ) - [ X C ( i ) ] 2 + [ Y C ( i ) ] 2 cos &beta; ( i ) ] 2 ,
v1(i)=M(i)·ω(i),
v2(i)=N(i)·ω(i),
n=i,继续执行下一步;
(e)如果θ(i)+ω(i)·Δt>θmax,程序结束;如果θ(i)+ω(i)·Δt<=θmax,继续执行下一步;
(f)Δθ(i+1)=ω(i)·Δt,继续执行下一步;
(g)i=i+1,继续执行步骤(c)。
上述计算方法获得了对应在不同时刻的下列各个向量:
t &RightArrow; = [ t ( 1 ) , t ( 2 ) , . . . , t ( n ) ] , &theta; &RightArrow; = [ &theta; ( 1 ) , &theta; ( 2 ) , . . . , &theta; ( n ) ] , &Delta;&theta; &RightArrow; = [ &Delta;&theta; ( 2 ) , &Delta;&theta; ( 3 ) , . . . , &Delta;&theta; ( n ) ] ,
X C &RightArrow; = [ X C ( 1 ) , X C ( 2 ) , . . . , X C ( n ) ] , Y C &RightArrow; = [ Y C ( 1 ) , Y C ( 2 ) , . . . , Y C ( n ) ] ,
X TC &RightArrow; = [ X TC ( 1 ) , X TC ( 2 ) , . . . , X TC ( n ) ] , Y TC &RightArrow; = [ Y TC ( 1 ) , Y TC ( 2 ) , . . . , Y TC ( n ) ] ,
&beta; &RightArrow; = [ &beta; ( 1 ) , &beta; ( 2 ) , . . . , &beta; ( n ) ] , &omega; &RightArrow; = [ &omega; ( 1 ) , &omega; ( 2 ) , . . . , &omega; ( n ) ] ,
v 1 &RightArrow; = [ v 1 ( 1 ) , v 1 ( 2 ) , . . . , v 1 ( n ) ] , v 2 &RightArrow; = [ v 2 ( 1 ) , v 2 ( 2 ) , . . . , v 2 ( n ) ] .
下面给出一组实际数据具体说明。
假设给定a=600mm、b=300mm、dx=0mm、dy=50mm、vw=6mm/s、La=8mm;给定初始角度θmin=10°,给定终止角度θmax=80°,给定时间步长Δt=1s。
则通过上述逐点计算方法可以计算出结果,各变量θ、ω、XC、YC、v1、v2与时间的关系曲线如图12、图13、图14、图15所示。部分数据值如表1所示。
表1各变量θ、ω、XC、YC、v1、v2的计算值(节选)
该装置采用独立运动的三自由度机构实现了对工件椭圆轨迹焊缝高质量焊接功能,采用该装置进行焊接时,焊枪始终处于椭圆轨迹焊缝上在焊接点处的法线,焊接方向为椭圆轨迹的切线方向,且该切线始终朝向预先设定某个固定方向上,焊接速度保持恒定,焊接质量高,效率高,装置的制造、维修和使用成本低;由于在焊接中的每一点,焊枪与工件上的焊缝焊点均始终保持一种相对位置和姿态,因此可以达到优化的高质量焊接效果;所设定的方向可以是任意方向,例如:当椭圆轨迹处于竖直的立面上时,将焊枪保持在竖直方向上,且焊接方向始终保持在水平方向上,从而获得平焊位置的高质量焊接效果;例如:当椭圆轨迹处于水平面上时,将焊枪和焊接方向均同时始终保持在水平方向上,从而获得横焊位置的高质量焊接效果。

Claims (10)

1.一种椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:包括机械臂、Z轴转台(3)、控制器(4)、焊接电源(5)和焊枪(6);所述机械臂包括依次串联起来的X轴平移组件(1)和Y轴平移组件(2);待焊工件的焊缝中心线为椭圆轨迹;
所述X轴平移组件包括第一基座(11)、X轴电机(12)、X轴传动机构(13)和第一滑块(14);所述X轴电机与第一基座固接,所述X轴电机的输出轴与X轴传动机构的输入端相连,所述X轴传动机构的输出端与第一滑块相连,所述第一滑块滑动镶嵌在第一基座上;
所述Y轴平移组件包括第二基座(21)、Y轴电机(22)、Y轴传动机构(23)和第二滑块(24);所述第二基座与第一滑块固接;所述Y轴电机与第二基座固接,所述Y轴电机的输出轴与Y轴传动机构的输入端相连,所述Y轴传动机构的输出端与第二滑块相连,所述第二滑块滑动镶嵌在第二基座上;
所述Z轴转台包括第三基座(31)、Z轴电机(32)、Z轴传动机构(35)、关节轴(33)和工件安装台(34);所述第三基座与第一基座固接;所述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)的横轴xA与椭圆长轴重合,椭圆坐标系(A)的纵轴yA与椭圆短轴重合,所述椭圆坐标系(A)设置在带椭圆轨迹焊缝的工件上;点OC在椭圆坐标系(A)中的坐标值为(dx,dy),(dx,dy)为已知常量;
设焊接速度为预设值vw,设工件绕关节轴逆时针转动角速度为ω;设a为所述椭圆轨迹的长轴的一半,b为所述椭圆轨迹的短轴的一半;设所述椭圆轨迹的长轴与xC轴的夹角为θ,0≤θ≤90°;所述焊枪的中心线与yC轴平行,焊枪的中心线与椭圆轨迹的交点为焊点P;所述焊点P在世界坐标系(C)中的坐标为(XC,YC);设焊枪的末端点T在世界坐标系(C)中的坐标为(XTC,YTC);所述焊枪的末端点T与焊点P的距离为预设值La;焊枪的末端点T和焊点P沿xC轴的速度相等,均为v1,相对世界坐标系(C)而言;焊枪的末端点T和焊点P沿yC轴的速度相等,均为v2,相对世界坐标系(C)而言;
控制器通过控制工件和焊枪满足下列关系:
X C = ( a 2 - b 2 ) sin &theta; a 2 tan 2 &theta; + b 2 - d x cos &theta; + d y sin &theta; ,
Y C = a 2 tan 2 &theta; + b 2 cos &theta; - d x sin &theta; - d y cos &theta; ,
XTC=XC,
YTC=YC+La,
&beta; = arctan ( Y C X C ) ,
&omega; = v w ( M + X C 2 + Y C 2 sin &beta; ) 2 + ( N - X C 2 + Y C 2 cos &beta; ) 2 ,
v1=Mω,
v2=Nω,
其中,
M = ( a 2 - b 2 ) ( b 2 - a 2 tan 4 &theta; ) cos &theta; ( a 2 tan 2 &theta; + b 2 ) a 2 tan 2 &theta; + b 2 + d x sin &theta; + d y cos &theta; ,
N = ( a 2 - b 2 ) sin &theta; a 2 tan 2 &theta; + b 2 - d x cos &theta; + d y sin &theta; ,
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
2.如权利要求1所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述X轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
3.如权利要求1所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述Y轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
4.如权利要求1所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述Z轴传动机构(35)为减速机。
5.如权利要求1所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:还包括送丝机(9),控制器与送丝机相连,送丝机与焊枪相连。
6.一种椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:包括机械臂、Z轴转台(3)、控制器(4)、焊接电源(5)和焊枪(6);所述机械臂包括依次串联起来的X轴平移组件(1)和Y轴平移组件(2);待焊工件的焊缝中心线为椭圆轨迹;
所述X轴平移组件包括第一基座(11)、X轴电机(12)、X轴传动机构(13)和第一滑块(14);所述X轴电机与第一基座固接,所述X轴电机的输出轴与X轴传动机构的输入端相连,所述X轴传动机构的输出端与第一滑块相连,所述第一滑块滑动镶嵌在第一基座上;
所述Y轴平移组件包括第二基座(21)、第二滑块(24)和平面压板(8);所述第二基座与第一滑块固接;所述第二滑块滑动镶嵌在第二基座上;所述平面压板与第二滑块固接;所述平面压板与工件相接触,平面压板的下表面与椭圆轨迹相切;所述平面压板的下表面为水平面;
所述Z轴转台包括第三基座(31)、Z轴电机(32)、Z轴传动机构(35)、关节轴(33)和工件安装台(34);所述第三基座与第一基座固接;所述Z轴电机与第三基座固接,所述Z轴电机的输出轴与Z轴传动机构的输入端相连,所述Z轴传动机构的输出端与关节轴相连,所述关节轴活动套设在第三基座中,所述工件安装台固定套接在关节轴上;
所述焊枪固定安装在第二滑块上,焊枪与焊接电源相连;所述X轴电机和Z轴电机分别与控制器相连;控制器控制X轴电机和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)的横轴xA与椭圆长轴重合,椭圆坐标系(A)的纵轴yA与椭圆短轴重合,所述椭圆坐标系(A)设置在带椭圆轨迹焊缝的工件上;点OC在椭圆坐标系(A)中的坐标值为(dx,dy),(dx,dy)为已知常量;
设焊接速度为预设值vw,设工件绕关节轴逆时针转动角速度为ω;设a为所述椭圆轨迹的长轴的一半,b为所述椭圆轨迹的短轴的一半;设所述椭圆轨迹的长轴与xC轴的夹角为θ,0≤θ≤90°;所述焊枪的中心线与yC轴平行,焊枪的中心线与椭圆轨迹的交点为焊点P;所述焊点P在世界坐标系(C)中的坐标为(XC,YC);设焊枪的末端点T在世界坐标系(C)中的坐标为(XTC,YTC);所述焊枪的末端点T与焊点P的距离为预设值La;焊枪的末端点T和焊点P沿xC轴的速度相等,均为v1,相对世界坐标系(C)而言;焊枪的末端点T和焊点P沿yC轴的速度相等,均为v2,相对世界坐标系(C)而言;
控制器控制工件和焊枪满足下列关系:
X C = ( a 2 - b 2 ) sin &theta; a 2 tan 2 &theta; + b 2 - d x cos &theta; + d y sin &theta; ,
Y C = a 2 tan 2 &theta; + b 2 cos &theta; - d x sin &theta; - d y cos &theta; ,
XTC=XC,
YTC=YC+La,
&beta; = arctan ( Y C X C ) ,
&omega; = v w ( M + X C 2 + Y C 2 sin &beta; ) 2 + ( N - X C 2 + Y C 2 cos &beta; ) 2 ,
v1=Mω,
v2=Nω,
其中,
M = ( a 2 - b 2 ) ( b 2 - a 2 tan 4 &theta; ) cos &theta; ( a 2 tan 2 &theta; + b 2 ) a 2 tan 2 &theta; + b 2 + d x sin &theta; + d y cos &theta; ,
N = ( a 2 - b 2 ) sin &theta; a 2 tan 2 &theta; + b 2 - d x cos &theta; + d y sin &theta; ,
所述θ与时间t的关系是ω的积分;在预设了初始时刻的初始角度后,基于上述公式通过逐点计算方法计算得到θ与时间t的关系。
7.如权利要求6所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述X轴传动机构采用丝杠螺母传动机构、齿轮齿条传动机构、带传动机构、链条传动机构或绳传动机构。
8.如权利要求6所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:所述Z轴传动机构(35)为减速机。
9.如权利要求6所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:还包括送丝机(9),控制器与送丝机相连,送丝机与焊枪相连。
10.如权利要求6所述的椭圆轨迹定向切线恒速焊接机器人装置,其特征在于:还包括簧件(81),所述簧件的两端分别连接第二滑块和第二基座,所述簧件采用拉簧、压簧、扭簧或片簧。
CN201210256684.2A 2012-07-23 2012-07-23 椭圆轨迹定向切线恒速焊接机器人装置 Active CN102764929B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210256684.2A CN102764929B (zh) 2012-07-23 2012-07-23 椭圆轨迹定向切线恒速焊接机器人装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210256684.2A CN102764929B (zh) 2012-07-23 2012-07-23 椭圆轨迹定向切线恒速焊接机器人装置

Publications (2)

Publication Number Publication Date
CN102764929A CN102764929A (zh) 2012-11-07
CN102764929B true CN102764929B (zh) 2014-09-24

Family

ID=47092621

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210256684.2A Active CN102764929B (zh) 2012-07-23 2012-07-23 椭圆轨迹定向切线恒速焊接机器人装置

Country Status (1)

Country Link
CN (1) CN102764929B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102962549B (zh) * 2012-11-26 2014-04-02 清华大学 一种沿立面内任意曲线轨迹焊接的机器人控制方法
CN104191068B (zh) * 2014-08-26 2016-04-13 福建省天大精诺信息有限公司 一种焊接路径控制方法、装置及系统
CN105149833B (zh) * 2015-09-29 2017-01-25 清华大学 一种用于空间曲线轨迹稳定位姿恒速焊接的运动规划方法
CN107116341A (zh) * 2017-05-24 2017-09-01 北京白菊汽车零部件有限公司 一种汽车零部件加长改制方法
CN107838546A (zh) * 2017-11-20 2018-03-27 苏州凯尔博精密机械有限公司 一种智能运输焊接生产线

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1223188A (zh) * 1997-12-26 1999-07-21 三星电子株式会社 控制焊接机器人的方法和装置
CN102135776A (zh) * 2011-01-25 2011-07-27 解则晓 基于视觉定位的工业机器人控制系统及其控制方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001252767A (ja) * 2000-03-06 2001-09-18 Kobe Steel Ltd 立向溶接方法
JP2006099474A (ja) * 2004-09-29 2006-04-13 Fanuc Ltd ロボットの軌跡制御方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1223188A (zh) * 1997-12-26 1999-07-21 三星电子株式会社 控制焊接机器人的方法和装置
CN102135776A (zh) * 2011-01-25 2011-07-27 解则晓 基于视觉定位的工业机器人控制系统及其控制方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
JP特开2001-252767A 2001.09.18
张文增等.弧焊机器人工件坐标系快速标定方法.《焊接学报》.2005,第26卷(第7期),
弧焊机器人工件坐标系快速标定方法;张文增等;《焊接学报》;20050731;第26卷(第7期);第1-4页 *

Also Published As

Publication number Publication date
CN102764929A (zh) 2012-11-07

Similar Documents

Publication Publication Date Title
CN102886591B (zh) 抛物线轨迹定向切线恒速焊接机器人装置
CN102886592B (zh) 双曲线轨迹定向切线恒速焊接机器人装置
CN102764929B (zh) 椭圆轨迹定向切线恒速焊接机器人装置
CN102962549B (zh) 一种沿立面内任意曲线轨迹焊接的机器人控制方法
CN103706517B (zh) 六轴联动点胶机
CN103692433B (zh) 可模型解耦的三臂杆五自由度平移焊接机器人及其解耦方法
KR101558676B1 (ko) 리스폿 지그
CN203726040U (zh) 汽车车身数控组合焊装夹具
CN201366595Y (zh) 多轴联动机构
CN203992878U (zh) 四轴焊接机械手
CN101585109A (zh) 全自动高速四轴双工位回转式焊接设备
CN111515926B (zh) 一种并联机器人
CN103495971A (zh) 一种五自由度组合式机器人平台
US20140107837A1 (en) Robot joint and robot arm using the same
CN107052624A (zh) 多工位智能焊接机器人
CN113127989A (zh) 一种六自由度机械臂逆运动学解析求解控制方法
CN107221247A (zh) 用于教学的焊接模拟工作站
CN110919638A (zh) 一种3+4新构型双臂协作机器人加工系统及方法
CN207806959U (zh) 一种数控机器人自动焊接设备
CN108380706B (zh) 一种自动化钣金折弯生产线
CN204868868U (zh) 一种新型混联五轴联动智能焊接平台
CN105690379A (zh) 一种四轨道龙门悬挂式双机械臂协同加工系统
CN206854872U (zh) 移载平台与库位模块化集成与智能控制装置
CN113359614B (zh) 一种并联机器人及其圆弧运动轨迹插补方法
CN203945364U (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