CN104227250A - 基于平面的机器人三维寻位纠偏方法 - Google Patents

基于平面的机器人三维寻位纠偏方法 Download PDF

Info

Publication number
CN104227250A
CN104227250A CN201410472919.0A CN201410472919A CN104227250A CN 104227250 A CN104227250 A CN 104227250A CN 201410472919 A CN201410472919 A CN 201410472919A CN 104227250 A CN104227250 A CN 104227250A
Authority
CN
China
Prior art keywords
coordinate system
robot
plane
play amount
axis side
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
Application number
CN201410472919.0A
Other languages
English (en)
Other versions
CN104227250B (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.)
Guangdong LXD Robotics Co Ltd
Original Assignee
FOSHAN LXD ROBOTICS 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 FOSHAN LXD ROBOTICS CO LTD filed Critical FOSHAN LXD ROBOTICS CO LTD
Priority to CN201410472919.0A priority Critical patent/CN104227250B/zh
Publication of CN104227250A publication Critical patent/CN104227250A/zh
Application granted granted Critical
Publication of CN104227250B publication Critical patent/CN104227250B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

本发明提出采用一种基于平面的机器人三维寻位纠偏方法及就应用该纠偏方法的焊接机器人,目的在于提供新颖的寻边和计算方法以应对产品加工中所造成的偏差,提高产品的焊接质量与合格率。本发明的方法包括如下步骤:在工件上定义工件坐标系与基于所述工件坐标系的用户坐标系;沿工件坐标系XY平面的X轴、Y轴方向,分别间隔相同距离获取两个坐标点值;利用坐标点值中的两个,根据反正切三角函数ATan计算出偏移角度A;利用上述坐标点值,根据直线方程求解基于工件坐标系的X轴偏移量△X与Y轴偏移量△Y偏移角度A转换成可供机器识别的姿态四元数,再将该姿态四元数、X轴偏移量△X和Y轴偏移量△Y赋值至所述用户坐标,以实现机器人的姿态调整。

Description

基于平面的机器人三维寻位纠偏方法
技术领域
本发明涉及机器人技术,具体是涉及一种基于平面的机器人三维寻位纠偏方法,以及应用该纠偏方法的焊接机器人。 
背景技术
在焊接领域,激光焊接工艺对产品的定位精度有着较高要求。在焊接加工时,一般是通过产品外部边缘进行定位的,而产品在成形过程中需经过冲压、折弯等多道工序,不可避免地会产生累积误差。因此,对产品进行激光焊接的时候,就需要对焊接路径x轴、y轴方向以及z轴的旋转角度进行纠偏。 
对此,现有的焊接机器人一般会设有寻边机构,通过寻边机构与产品边缘的多次接触而获取位置坐标,再通过预设程序计算出偏差值,继而自动调整焊缝位置。然而,现有技术方案通常仅能计算获得x轴、y轴单一方向的偏差,而不能获得z轴旋转角度的偏差。 
发明内容
针对背景技术中提及的问题,本发明提出采用一种基于平面的机器人三维寻位纠偏方法及就应用该纠偏方法的焊接机器人,目的在于提供新颖的寻边和计算方法以应对产品加工中所造成的偏差,正确纠正机器人焊接路径在平面位置和旋转角度的偏移,提高产品的焊接质量与合格率。本发明是通过如下技术方案实现的: 
一种基于平面的机器人三维寻位纠偏方法,包括如下步骤: 
1)在工件上定义工件坐标系,并定义基于所述工件坐标系的用户坐标系; 
2)沿所述工件坐标系XY平面的X轴方向,间隔相同距离获取两个坐标点值(X1,Y1)和(X2,Y2);沿所述工件坐标系XY平面的Y轴方向,间隔相同距离获取两个坐标点值(X3,Y3)和(X4,Y4); 
3)利用上述坐标点值中的两个,根据反正切三角函数ATan计算出基于工件坐标系的偏移角度A; 
4)利用上述坐标点值,根据直线方程求解基于工件坐标系的X轴偏移量△X与Y轴偏移量△Y; 
直线K1的方程是,K1=(Y1-Y2)/(X1-X2); 
直线K2的方程是,K2=(Y3-Y4)/(X3-X4); 
X轴偏移量,△X=(K1*X1-K2*X3-Y1)/(K1-K2); 
Y轴偏移量,△Y=Y1+(△X-X1)*K1; 
5)将上述偏移角度A转换成可供机器识别的姿态四元数,再将该姿态四元数、X轴偏移量△X和Y轴偏移量△Y赋值至所述用户坐标,以实现机器人的姿态调整。 
进一步的,所述偏移角度A的计算为 
A=-(arctan((X4-X3)/(Y4-Y3)))或 
A=-(arctan((X2-X1)/(Y2-Y1)))。 
进一步的,所述姿态四元数的转换通过机器人编译工具中的OrientZYX函数实现。 
本发明还对应提出一种基于上述三维寻位纠偏方法的焊接机器人,其包括一具有寻边探头的机械臂,所述寻边探头包括弹簧、探针以及与焊枪连接的固定支架;所述探针通过导线与机器人的I/O模块连接,该导线上串联有继电器。 
附图说明
图1为三维寻边纠偏方法的流程图。 
图2为焊接实例中坐标建立示意图。 
图3为坐标系偏角A示意图。 
图4为焊接机器人及焊接实例示意图。 
具体实施方式
如下结合附图,对本申请方案作进一步描述: 
如图1-4所示,一种基于平面的机器人三维寻位纠偏方法,包括如下步骤: 
S01:在工件上定义工件坐标系wobjA,并定义基于所述工件坐标系wobjA的用户坐标系wobjB; 
SO2:沿所述工件坐标系wobjA的XY平面的X轴方向,间隔相同距离获取两个坐标点值P1(X1,Y1)和P2(X2,Y2); 
S03:沿所述工件坐标系wobjA的XY平面的Y轴方向,间隔相同距离获取两个坐标点值P3(X3,Y3)和P4(X4,Y4); 
S04:利用上述坐标点值中的两个,根据反正切三角函数ATan计算出基于工件坐标系wobjA的偏移角度A;本实施例中取坐标点值P3(X3,Y3)和P4(X4,Y4)进行计算,A=-(arctan((X4-X3)/(Y4-Y3))); 
S05:利用上述坐标点值P1(X1,Y1)、P2(X2,Y2)、P3(X3,Y3)和P4(X4,Y4),根据直线方程求解基于工件坐标系的X轴偏移量△X与Y轴偏移量△Y; 
直线K1的方程是,K1=(Y1-Y2)/(X1-X2); 
直线K2的方程是,K2=(Y3-Y4)/(X3-X4); 
X轴偏移量,△X=(K1*X1-K2*X3-Y1)/(K1-K2); 
Y轴偏移量,△Y=Y1+(△X-X1)*K1; 
S06:将上述偏移角度A转换成可供机器识别的姿态四元数; 
S07:将该姿态四元数、X轴偏移量△X和Y轴偏移量△Y赋值至所述用户坐标wobjB,以实现机器人的姿态调整。 
在本实施例中,上述取点、计算、姿态四元数转换由机器人编译工具实现,具体代码如下: 
一、坐标点值获取: 
MoveL pA1,v1000,fine,Tooldata_2\WObj:=wobjA; 
注:MoveL机器人直线运动指令,直线运动到pA1点,v1000是速度,find是准确到达该点,tooldata_2\WObj:=wobjA是工具坐标\工件坐标; 
SearchL\Stop,Di1Find,target_base{1},pA2,v5,Tooldata_2\WObj:=wobjA; 
注:SearchL\Stop机器人直线寻边指令,从上一个点以v5的速度运行到pA2,当信号DiFind=1时停止,并将当前位置坐标(x,y,z)储存在target_base{1},tooldata_2\WObj:=wobjA是工具坐标\工件坐标; 
MoveL pC1,v1000,fjne,Tooldata_2\WObj:=wobjA; 
SearchL\Stop,Di1Find,target_base{3},pC2,v5,Tooldata_2\WObj:=wobjA; 
MoveL pD1,v1000,fine,Tooldata_2\WObj:=wobjA; 
SearchL\Stop,DI10_3,target_base{4},pD2,v5,Tooldata_2\WObj:=wobjA; 
注:利用上述指令获取的4个点(target_base{1}、target_base{2}、 target_base{3}、target_base{4}) 
Y{1}:=target_base{1}.trans.y-wobjA,uframe.tran.y; 
X{1}:=target_base{1}.trans.x-wobjA,uframe.tran.x; 
Y{2}:=target_base{2}.trans.y-wobjA,uframe.tran.y; 
X{2}:=target_base{2}.trans.x-wobjA,uframe.tran.x; 
y{3}:=target_base{3}.trans.y-wobjA,uframe.tran.y; 
X{3}:=target_base{3}.trans.x-wobjA,uframe.tran.x; 
Y{4}:=target_base{4}.trans.y-wobjA,uframe.tran.y; 
X{4}:=target_base{4}.trans.x-wobjA,uframe.tran.x; 
注:分别将4个点的X、Y值赋值到变量里用于计算。 
二、偏角计算: 
angle:=-(ATan((X{4}-X{3})/(Y{4}-Y{3}))); 
注:使用机器人函数Atan,用其中P3和P4的数据求出相对wobjA的角度储存在变量angle中; 
三、X轴偏移量△X与Y轴偏移量△Y计算: 
K1:=(Y{1}-Y{2})/(X{1}-X{2}); 
K2:=(Y{3}-Y{4})/(X{3}-X{4}); 
X{5}:=(K1*X{1}-K2*X{3}+Y{3}-Y{1})/(K1-K2); 
Y{5}:=Y{1}+(X{5}-X{1})*K1; 
四、姿态四元数转换: 
wobjB:=wobjA; 
wobjB.oframe.rot:=OrientZYX(angle,0,0); 
wobjB.oframe.trans.x:=X{5}; 
wobjB.oframe.trans.y:=Y{5}; 
注:将wobjA复制到wobjB;将求出的角度变量angle通过机器人编译工具中的OrientZYX函数转换为姿态四元数后赋值到wobjB的姿态值上;将求出的变量X{5}、Y{5},赋值到wobjB上; 
一种基于上述三维寻位纠偏方法的焊接机器人,其包括一具有寻边探头11的机械臂1,所述寻边探头11包括弹簧、探针111以及与焊枪连接的固定支架13;所述探针通过导线与机器人的I/O模块连接,该导线上串联有继电器。所述焊接机器人由数控程序控制,并以上述纠偏方案减少误差。 
以焊接厨房用水槽为例,具体操作是将水槽的槽体2与桌子3焊接。 
首先,在产品上建立工件坐标系wobjA,通过使用寻边探头11在相对于建立在产品上坐标系wobjA的x轴、y轴方向分别隔固定距离获得两个位置,并记录所获物4个位置值P1(X1,Y1)、P2(X2,Y2)、P3(X3,Y3)和P4(X4,Y4)。然后由上述程序利用4点坐标数据计算得到一组偏差数(△X、△Y和偏角A),再赋值至用户坐标系以纠正焊接路径。 
上述优选实施方式应视为本申请方案实施方式的举例说明,凡与本申请方案雷同、近似或以此为基础作出的技术推演、替换、改进等,均应视为本专利的保护范围。 

Claims (4)

1.一种基于平面的机器人三维寻位纠偏方法,其特征在于包括如下步骤:
1)在工件上定义工件坐标系,并定义基于所述工件坐标系的用户坐标系;
2)沿所述工件坐标系XY平面的X轴方向,间隔相同距离获取两个坐标点值(X1,Y1)和(X2,Y2);沿所述工件坐标系XY平面的Y轴方向,间隔相同距离获取两个坐标点值(X3,Y3)和(X4,Y4);
3)利用上述坐标点值中的两个,根据反正切三角函数ATan计算出基于工件坐标系的偏移角度A;
4)利用上述坐标点值,根据直线方程求解基于工件坐标系的X轴偏移量△X与Y轴偏移量△Y;
直线K1的方程是,K1=(Y1-Y2)/(X1-X2);
直线K2的方程是,K2=(Y3-Y4)/(X3-X4);
X轴偏移量,△X=(K1*X1-K2*X3-Y1)/(K1-K2);
Y轴偏移量,△Y=Y1+(△X-X1)*K1;
5)将上述偏移角度A转换成可供机器识别的姿态四元数,再将该姿态四元数、X轴偏移量△X和Y轴偏移量△Y赋值至所述用户坐标,以实现机器人的姿态调整。
2.根据权利要求1所述的基于平面的机器人三维寻位纠偏方法,其特征在于:所述偏移角度A的计算为
A=-(arctan((X4-X3)/(Y4-Y3)))或
A=-(arctan((X2-X1)/(Y2-Y1)))。
3.根据权利要求1所述的基于平面的机器人三维寻位纠偏方法,其特征在于:所述姿态四元数的转换通过机器人编译工具中的OrientZYX函数实现。
4.一种基于权利要求1-3所述三维寻位纠偏方法的焊接机器人,其特征在于:包括一具有寻边探头的机械臂,所述寻边探头包括弹簧、探针以及与焊枪连接的固定支架;所述探针通过导线与机器人的I/O模块连接,该导线上串联有继电器。
CN201410472919.0A 2014-09-16 2014-09-16 基于平面的机器人三维寻位纠偏方法及焊接机器人 Expired - Fee Related CN104227250B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410472919.0A CN104227250B (zh) 2014-09-16 2014-09-16 基于平面的机器人三维寻位纠偏方法及焊接机器人

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410472919.0A CN104227250B (zh) 2014-09-16 2014-09-16 基于平面的机器人三维寻位纠偏方法及焊接机器人

Publications (2)

Publication Number Publication Date
CN104227250A true CN104227250A (zh) 2014-12-24
CN104227250B CN104227250B (zh) 2016-06-22

Family

ID=52216624

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410472919.0A Expired - Fee Related CN104227250B (zh) 2014-09-16 2014-09-16 基于平面的机器人三维寻位纠偏方法及焊接机器人

Country Status (1)

Country Link
CN (1) CN104227250B (zh)

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107175406A (zh) * 2017-05-19 2017-09-19 大族激光科技产业集团股份有限公司 焊接轨迹的控制方法和系统
CN107442953A (zh) * 2017-09-14 2017-12-08 武汉唯拓光纤激光工程有限公司 一种激光切管机加工偏差的补偿方法
CN107462154A (zh) * 2017-07-28 2017-12-12 深圳市圆梦精密技术研究院 机器人末端工具的位姿测量方法
CN108000522A (zh) * 2017-12-21 2018-05-08 金翰阳科技(大连)股份有限公司 一种基于单机器人对工件偏移后误差检测补偿方法
CN108890079A (zh) * 2018-08-07 2018-11-27 特变电工集团衡阳电气装备有限公司 一种自动缝焊机及其自动缝焊方法
CN109128482A (zh) * 2018-10-31 2019-01-04 芜湖常瑞汽车部件有限公司 一种机器人焊接超声波焊缝跟踪检测方法
CN109396921A (zh) * 2018-11-19 2019-03-01 广东长盈精密技术有限公司 Y向位置度与四轴旋转角度的同步校正方法
CN109631851A (zh) * 2019-01-31 2019-04-16 电子科大科园股份有限公司 一种平粮机器人的同步计算方法
CN111015664A (zh) * 2019-12-26 2020-04-17 重庆盟讯电子科技有限公司 一种基于ccd相机的智能化识别方法
CN111080720A (zh) * 2019-12-26 2020-04-28 重庆盟讯电子科技有限公司 一种模组矫正方法
CN111596613A (zh) * 2020-05-18 2020-08-28 北京创想智控科技有限公司 焊接偏差确定方法、装置、电子设备及存储介质
CN114670193A (zh) * 2022-03-22 2022-06-28 佛山市科莱机器人有限公司 游艇机器人切割装置及高精度游艇切割方法
CN115476092A (zh) * 2022-08-10 2022-12-16 浙江九龙厨具集团有限公司 一种自动焊接平台及焊缝定位方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06187021A (ja) * 1992-12-15 1994-07-08 Citizen Watch Co Ltd 視覚付きロボットの座標補正方法
CN1117906A (zh) * 1994-09-02 1996-03-06 叶洪源 修正定位焊接机器人系统
CN101630409A (zh) * 2009-08-17 2010-01-20 北京航空航天大学 一种用于机器人制孔系统的手眼视觉标定方法
CN102012571A (zh) * 2010-10-13 2011-04-13 苏州凯蒂亚半导体制造设备有限公司 平板显示器的显示屏基板上贴敷acf膜的对位方法
CN202539769U (zh) * 2011-11-30 2012-11-21 佛山市利迅达机器人系统有限公司 一种机器人寻边机构及探头
EP2631868A2 (en) * 2012-02-21 2013-08-28 Mitutoyo Corporation Image processing device and method for image processing
US20130304249A1 (en) * 2012-05-14 2013-11-14 Yamaha Hatsudoki Kabushiki Kaisha Working apparatus for component or board and component mounting apparatus

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06187021A (ja) * 1992-12-15 1994-07-08 Citizen Watch Co Ltd 視覚付きロボットの座標補正方法
CN1117906A (zh) * 1994-09-02 1996-03-06 叶洪源 修正定位焊接机器人系统
CN101630409A (zh) * 2009-08-17 2010-01-20 北京航空航天大学 一种用于机器人制孔系统的手眼视觉标定方法
CN102012571A (zh) * 2010-10-13 2011-04-13 苏州凯蒂亚半导体制造设备有限公司 平板显示器的显示屏基板上贴敷acf膜的对位方法
CN202539769U (zh) * 2011-11-30 2012-11-21 佛山市利迅达机器人系统有限公司 一种机器人寻边机构及探头
EP2631868A2 (en) * 2012-02-21 2013-08-28 Mitutoyo Corporation Image processing device and method for image processing
US20130304249A1 (en) * 2012-05-14 2013-11-14 Yamaha Hatsudoki Kabushiki Kaisha Working apparatus for component or board and component mounting apparatus

Cited By (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107175406A (zh) * 2017-05-19 2017-09-19 大族激光科技产业集团股份有限公司 焊接轨迹的控制方法和系统
CN107462154B (zh) * 2017-07-28 2019-08-30 深圳市圆梦精密技术研究院 机器人末端工具的位姿测量方法
CN107462154A (zh) * 2017-07-28 2017-12-12 深圳市圆梦精密技术研究院 机器人末端工具的位姿测量方法
US11072078B2 (en) 2017-07-28 2021-07-27 Yuanmeng Precision Technology (Shenzhen) Institute Method for measuring pose of robotic end tool
CN107442953A (zh) * 2017-09-14 2017-12-08 武汉唯拓光纤激光工程有限公司 一种激光切管机加工偏差的补偿方法
CN108000522A (zh) * 2017-12-21 2018-05-08 金翰阳科技(大连)股份有限公司 一种基于单机器人对工件偏移后误差检测补偿方法
CN108000522B (zh) * 2017-12-21 2021-02-02 金翰阳科技(大连)股份有限公司 一种基于单机器人对工件偏移后误差检测补偿方法
CN108890079A (zh) * 2018-08-07 2018-11-27 特变电工集团衡阳电气装备有限公司 一种自动缝焊机及其自动缝焊方法
CN108890079B (zh) * 2018-08-07 2021-02-23 湖南省国创电力有限公司 一种自动缝焊机及其自动缝焊方法
CN109128482A (zh) * 2018-10-31 2019-01-04 芜湖常瑞汽车部件有限公司 一种机器人焊接超声波焊缝跟踪检测方法
CN109396921B (zh) * 2018-11-19 2020-05-05 广东长盈精密技术有限公司 Y向位置度与四轴旋转角度的同步校正方法
CN109396921A (zh) * 2018-11-19 2019-03-01 广东长盈精密技术有限公司 Y向位置度与四轴旋转角度的同步校正方法
CN109631851A (zh) * 2019-01-31 2019-04-16 电子科大科园股份有限公司 一种平粮机器人的同步计算方法
CN111015664A (zh) * 2019-12-26 2020-04-17 重庆盟讯电子科技有限公司 一种基于ccd相机的智能化识别方法
CN111080720A (zh) * 2019-12-26 2020-04-28 重庆盟讯电子科技有限公司 一种模组矫正方法
CN111596613A (zh) * 2020-05-18 2020-08-28 北京创想智控科技有限公司 焊接偏差确定方法、装置、电子设备及存储介质
CN114670193A (zh) * 2022-03-22 2022-06-28 佛山市科莱机器人有限公司 游艇机器人切割装置及高精度游艇切割方法
CN115476092A (zh) * 2022-08-10 2022-12-16 浙江九龙厨具集团有限公司 一种自动焊接平台及焊缝定位方法

Also Published As

Publication number Publication date
CN104227250B (zh) 2016-06-22

Similar Documents

Publication Publication Date Title
CN104227250B (zh) 基于平面的机器人三维寻位纠偏方法及焊接机器人
EP3091405B1 (en) Method, device and system for improving system accuracy of x-y motion platform
CN103713579B (zh) 一种工业机器人作业方法
JPWO2015083722A1 (ja) 液体材料塗布装置
CN109029453B (zh) 熔覆头姿态路径规划方法、装置、终端、存储介质及系统
CN106457571A (zh) 离线示教装置
WO2015018562A1 (en) Printing system for three-dimensional objects
KR840008601A (ko) 공업용로보트의 동작교시방법 및 장치
JP7120512B2 (ja) 軌跡制御装置
CN104858575A (zh) 一种带三维焊缝识别的集装箱顶加强板自动焊接设备
CN106313057A (zh) 一种码垛机器人控制系统及其实现方法
JP2016101644A (ja) 加工動作をロボットに教示するロボットプログラミング装置
CN104723338A (zh) 机器人、机器人的控制方法及机器人的控制程序
CN112405527A (zh) 工件表面圆弧轨迹加工方法及相关装置
JP4888374B2 (ja) ロボットの動作制御装置及びその動作制御方法
CN107457793A (zh) 利用多机器人动态用户框进行动态激光触摸感测
US20120109361A1 (en) Program converting module for multi-axis coordinated machines and program-converting method
US10452051B2 (en) Numerical control device
CN104907208A (zh) 一种喷漆机器人的计算机控制系统
CN113442133B (zh) 机器人的工具中心点校准方法及校准系统、存储介质
CN204997332U (zh) 用于智能手机功能检测系统的装配误差校正装置
CN107645979B (zh) 用于使机器人手臂的运动同步的机器人系统
CN106597990B (zh) 数控机床换刀点快速定位方法
CN108748150A (zh) 面向机器人加工的低成本实时补偿装置及方法
CN203444480U (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
CP03 Change of name, title or address
CP03 Change of name, title or address

Address after: 528300, No. 2, No. three, Xian Yong Avenue, Chencun Industrial Park, Chencun Town, Shunde District, Guangdong, Foshan

Patentee after: GUANGDONG LXD ROBOTICS Co.,Ltd.

Address before: 528000, No. 2, No. three, Chung Yong Road, Chencun Industrial Park, Chencun Town, Foshan District, Guangdong, Shunde

Patentee before: Foshan LXD Robotics Co.,Ltd.

CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20160622