CN106863303A - 一种焊接机械手及其路径学习方法 - Google Patents
一种焊接机械手及其路径学习方法 Download PDFInfo
- Publication number
- CN106863303A CN106863303A CN201710140460.8A CN201710140460A CN106863303A CN 106863303 A CN106863303 A CN 106863303A CN 201710140460 A CN201710140460 A CN 201710140460A CN 106863303 A CN106863303 A CN 106863303A
- Authority
- CN
- China
- Prior art keywords
- theta
- welding
- cos
- sin
- joint
- 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.)
- Pending
Links
- 238000003466 welding Methods 0.000 title claims abstract description 44
- 238000000034 method Methods 0.000 title claims description 9
- 239000012636 effector Substances 0.000 claims abstract description 13
- 238000006073 displacement reaction Methods 0.000 claims abstract description 9
- 238000005259 measurement Methods 0.000 claims description 2
- 238000005070 sampling Methods 0.000 claims description 2
- 238000004519 manufacturing process Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000008676 import Effects 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
Classifications
-
- 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
-
- 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
- B23K37/00—Auxiliary devices or processes, not specially adapted to a procedure covered by only one of the preceding main groups
- B23K37/02—Carriages for supporting the welding or cutting element
- B23K37/0252—Steering means
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Physics & Mathematics (AREA)
- Optics & Photonics (AREA)
- Numerical Control (AREA)
Abstract
发明了一种焊接机械手,该机械手由5个关节构成,其中3个关节用于跟踪末端执行器的位置,另外2个关节用于调整末端执行器的姿态。第5个关节和末端执行器之间通过可伸缩的杆件连接,以保证焊条和焊缝之间的紧密接触。焊接之前,夹在机械手末端执行器上的焊条依照焊接时的姿态,端点从焊缝的始点移动到终点,同时,安装在关节处的编码器采集各关节的角位移,并将采集数据送计算机处理,计算机依据各关节角位移数据规划出机械手路径,并控制机械手沿此路径完成焊缝的焊接。
Description
技术领域
本发明涉及一种焊接机械手及其路径学习方法。
背景技术
焊接机器人具有焊接质量稳定,改善工人劳动条件,提高劳动生产率等特点,广泛应用于汽车、通用机械、工程机械、兵器工业和金属结构等行业。据不完全统计,全世界在役的工业机器人中大约有一半用于各种形式的焊接加工领域。目前我国应用的焊接机器人90%以上是从世界各知名机器人厂家生产的,主要应用在汽车制造业。预计未来几年,国内企业对焊接机器人的需求量将以30%以上的速度增长。从国外进口的焊接机械手品牌功能强大,精确度高,但是价格昂贵,在一些焊接车间,焊接机械手只是反复完成一个简单、单一的动作。采用昂贵的焊接机器人显然成本过高,根据所从事的具体工作,有针对性地研制一种既可以降低生产成本,又可以提高焊接精度的机械手十分必要。
发明内容
发明了一种焊接机械手,该机械手由5个关节构成,其中3个关节用于跟踪末端执行器的位置,另外2个关节用于调整末端执行器的姿态。第5个关节和末端执行器之间通过可伸缩的杆件连接,以保证焊条和焊缝之间的紧密接触。焊接之前,夹在机械手末端执行器上的焊条依照焊接时的姿态,端点从焊缝的始点移动到终点,同时,安装在关节处的编码器采集各关节的角位移,并将采集数据送计算机处理,计算机依据各关节角位移数据规划出机械手路径,并控制机械手沿此路径完成焊缝的焊接。
附图说明
图1是5关节机械臂结构及其各关节坐标系示意图,图中,各坐标系均为右手系;Z1,Y2,Y3,Y4,Z5与相应的转轴平行;Y1,X2,X3,Y4,X5与相应的链杆平行;图2是前端带有滑动伸缩杆的末端执行器示意图。
标号说明:
1滑动箱,2滑动块,3滑动杆,4弹簧,5末端执行器
具体实施方式
机械臂的结构如图1所示。以O表示坐标系X0Y0Z0的原点,O1,…,O5分别表示第1,2,…,5个坐标系的原点,若无特别申明,长度、时间、角度、速度和角速度分别以毫米、秒、弧度、毫米/秒和弧度/秒为单位,且假定
|OO1|=d1,|O2O3|=a1,|O3O4|=a2
O5在X1Z1平面内,O5与夹在末端执行器(5)上的焊条端点的距离为a3。
5个关节上安装电机和编码器,编码器用于测量关节转动角度,测量结果通过数据线送计算机记录。第5个关节带有滑动伸缩杆以保证焊条与工件的接触。滑动箱(1)是一个带有立方体空腔的圆柱,一端与电机转轴固连,另一端与滑动杆(3)滑动连接;滑动杆(3)的一端与滑动箱(1)空腔内的滑动块(2)连接,另一端穿过弹簧(4)与末端执行器(5)连接。
以θ1,θ2,…,θ5分别表示第1,2,…,5个关节的角位移,则O5在坐标系X0Y0Z0中的坐标为
焊条端点在坐标系X5Y5Z5中的坐标为
记关节角向量Θ=(θ1,θ2,…,θ5)T,则焊条端点在坐标系X0Y0Z0中的坐标为
对于每一条焊缝,只要在其上采集足够稠密的点及其对应的坐标向量,通过各关节角在相邻的两个坐标向量的对应分量之间的均匀变化就可以足够精确地确定一条焊缝路径。为此,依照焊接时的姿态,将焊条端点从焊缝的始点移动到终点,同时各关节上的编码器以采样周期T采集关节角位移向量,可以得到
i=0,1,…,n
其中n+1为样本个数。因此对于i=0,1,…,n
以||·||表示向量模,则焊缝可表示为
以v表示焊接过程中焊条相对于焊缝的移动速度,则焊条从焊缝的始点移动到终点的时间为l/v,从点A(Θi-1)移动到点A(Θi)的时间为||A(Θi)-A(Θi-1)||/v,因此对于j=1,2,…,5,第j个关节从变化到的时间是||A(Θi)-A(Θi-1)||/v,关节角位移速度为
i=1,2,…,n
焊条从始点移动到点A(Θi)的时间为
以t表示当前时刻,θj(t)表示t时刻第j个关节的角位移。为了避免误差积累,在t1,t2,…,tn时刻对关节角位移向量进行校正,以保证用表示变量赋值号,焊接过程的程序为:
(1)焊条端点对准焊缝始点;对i=1,2,…,n,j=1,2,…,5,计算
(2)t=0,i=1;
(3)若对t<ti,对j=1,2,…,5,第j个关节以角速度ωij旋转,否则
(4)若i<n,转(3);
(5)停止。
Claims (2)
1.一种焊接机械手及其路径学习方法,其特征在于:第1和第5个关节的转轴始终共面,5个关节上安装电机和编码器,编码器用于测量关节转动角度,测量结果通过数据线送计算机记录;第5个关节带有滑动伸缩杆以保证焊条与工件的接触;滑动伸缩杆由滑动箱(1)、滑动块(2)、滑动杆(3)和弹簧(4)组成;滑动箱(1)是一个带有立方体空腔的圆柱,一端与电机转轴固连,另一端与滑动杆(3)滑动连接;滑动杆(3)的一端与滑动箱(1)空腔内的滑动块(2)连接,另一端穿过弹簧(4)与末端执行器(5)连接。
2.根据权利要求1所述的一种焊接机械手及其路径学习方法,其特征在于:以O表示坐标系X0Y0Z0的原点,O1,…,O5分别表示第1,2,…,5个坐标系的原点,长度、时间、角度、速度和角速度分别以毫米、秒、弧度、毫米/秒和弧度/秒为单位,且记
|OO1|=d1,|O2O3|=a1,|O3O4|=a2
O5与夹在末端执行器(5)上的焊条端点的距离为a3,T表示各关节上的编码器的采样周期,分别表示第1,2,…,5个关节在第i个采样时刻的角位移,n+1为样本个数,||·||表示向量模,v表示焊接过程中焊条相对于焊缝的移动速度,对于i=0,1,…,n,记
以t表示当前时刻,θj(t)表示t时刻第j个关节的实际角位移,表示变量赋值号,路径规划和焊接过程的程序为:
(1)焊条端点对准焊缝始点;对i=1,2,…,n,j=1,2,…,5,计算
(2)t=0,i=1;
(3)若对t<ti,对j=1,2,…,5,第j个关节以角速度ωij旋转,否则
(4)若i<n,转(3);
(5)停止
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710140460.8A CN106863303A (zh) | 2017-03-04 | 2017-03-04 | 一种焊接机械手及其路径学习方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710140460.8A CN106863303A (zh) | 2017-03-04 | 2017-03-04 | 一种焊接机械手及其路径学习方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106863303A true CN106863303A (zh) | 2017-06-20 |
Family
ID=59169983
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710140460.8A Pending CN106863303A (zh) | 2017-03-04 | 2017-03-04 | 一种焊接机械手及其路径学习方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106863303A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107443356A (zh) * | 2017-09-12 | 2017-12-08 | 厦门市图巴机器人有限公司 | 一种可实时显示机器人形态的***及方法 |
CN107598363A (zh) * | 2017-09-22 | 2018-01-19 | 惠州市洛玛科技有限公司 | 焊接***及焊接产品的方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007069275A (ja) * | 2005-09-05 | 2007-03-22 | Yachiyo Industry Co Ltd | タッチセンサ |
CN101514886A (zh) * | 2009-03-10 | 2009-08-26 | 东南大学 | 电弧传感器焊枪位置偏差信息提取方法 |
CN102886592A (zh) * | 2012-09-27 | 2013-01-23 | 清华大学 | 双曲线轨迹定向切线恒速焊接机器人装置 |
CN103351177A (zh) * | 2013-07-02 | 2013-10-16 | 佛山市新鹏陶瓷机械有限公司 | 一种自动化喷釉无动力测量关节臂 |
CN103692433A (zh) * | 2013-12-23 | 2014-04-02 | 厦门理工学院 | 可模型解耦的三臂杆五自由度平移焊接机器人及其解耦方法 |
CN104816113A (zh) * | 2015-04-21 | 2015-08-05 | 郑州职业技术学院 | 一种三自由度焊接机器人及其控制*** |
CN204545731U (zh) * | 2015-04-16 | 2015-08-12 | 长安大学 | 一种接触式板间焊缝余高测量装置 |
CN105081664A (zh) * | 2015-09-17 | 2015-11-25 | 中航电测仪器股份有限公司 | 焊接翻转机导电装置及焊接翻转机 |
CN205032852U (zh) * | 2015-09-23 | 2016-02-17 | 北京石油化工学院 | 一种激光焊接头位置调节装置 |
CN105773623A (zh) * | 2016-04-29 | 2016-07-20 | 江南大学 | 基于预测型间接迭代学习的scara机器人轨迹跟踪控制方法 |
EP2692488A3 (en) * | 2012-07-31 | 2017-04-12 | Seiko Epson Corporation | Control device and control method for robot and the robot |
-
2017
- 2017-03-04 CN CN201710140460.8A patent/CN106863303A/zh active Pending
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007069275A (ja) * | 2005-09-05 | 2007-03-22 | Yachiyo Industry Co Ltd | タッチセンサ |
CN101514886A (zh) * | 2009-03-10 | 2009-08-26 | 东南大学 | 电弧传感器焊枪位置偏差信息提取方法 |
EP2692488A3 (en) * | 2012-07-31 | 2017-04-12 | Seiko Epson Corporation | Control device and control method for robot and the robot |
CN102886592A (zh) * | 2012-09-27 | 2013-01-23 | 清华大学 | 双曲线轨迹定向切线恒速焊接机器人装置 |
CN103351177A (zh) * | 2013-07-02 | 2013-10-16 | 佛山市新鹏陶瓷机械有限公司 | 一种自动化喷釉无动力测量关节臂 |
CN103692433A (zh) * | 2013-12-23 | 2014-04-02 | 厦门理工学院 | 可模型解耦的三臂杆五自由度平移焊接机器人及其解耦方法 |
CN204545731U (zh) * | 2015-04-16 | 2015-08-12 | 长安大学 | 一种接触式板间焊缝余高测量装置 |
CN104816113A (zh) * | 2015-04-21 | 2015-08-05 | 郑州职业技术学院 | 一种三自由度焊接机器人及其控制*** |
CN105081664A (zh) * | 2015-09-17 | 2015-11-25 | 中航电测仪器股份有限公司 | 焊接翻转机导电装置及焊接翻转机 |
CN205032852U (zh) * | 2015-09-23 | 2016-02-17 | 北京石油化工学院 | 一种激光焊接头位置调节装置 |
CN105773623A (zh) * | 2016-04-29 | 2016-07-20 | 江南大学 | 基于预测型间接迭代学习的scara机器人轨迹跟踪控制方法 |
Non-Patent Citations (1)
Title |
---|
安凯等: "六关节机械臂逆运动学的快速求解算法", 《光电工程》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107443356A (zh) * | 2017-09-12 | 2017-12-08 | 厦门市图巴机器人有限公司 | 一种可实时显示机器人形态的***及方法 |
CN107598363A (zh) * | 2017-09-22 | 2018-01-19 | 惠州市洛玛科技有限公司 | 焊接***及焊接产品的方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108748159B (zh) | 一种机械臂工具坐标系自标定方法 | |
US20190176325A1 (en) | An Error Modeling Method For End-Effector Space-Curve Trajectory Of Six Degree-of-Freedom Robots | |
CN107717993B (zh) | 一种高效便捷的简易机器人标定方法 | |
CN103459102B (zh) | 机器人控制装置、机器人控制方法、程序和记录介质 | |
CN105773609A (zh) | 一种基于视觉测量及距离误差模型的机器人运动学标定方法 | |
CN107336230B (zh) | 一种基于投影和距离判断的工业机器人碰撞预测方法 | |
CN107639635B (zh) | 一种机械臂位姿误差标定方法及*** | |
KR20180035172A (ko) | 동시적인 운동성 및 핸드-아이 교정 | |
CN101823260B (zh) | 机器人的动作路径生成方法 | |
JPH0820894B2 (ja) | 産業用ロボツトの動作制御方法 | |
JP7109161B2 (ja) | 多関節ロボットの機構モデルパラメータ推定方法 | |
CN105522577B (zh) | 一种用于五轴折弯机器人笛卡尔轨迹规划的方法及其装置 | |
CN111002306B (zh) | 一种基于电子凸轮的机器人运动控制方法及控制*** | |
CN103692433A (zh) | 可模型解耦的三臂杆五自由度平移焊接机器人及其解耦方法 | |
CN111347431A (zh) | 一种手持工具示教的机器人示教喷涂方法和装置 | |
CN112589797B (zh) | 一种非球形手腕机械臂奇异点规避方法和*** | |
CN111002304B (zh) | 用于获取机械手的末端执行器的位置和定位的装置 | |
CN106863303A (zh) | 一种焊接机械手及其路径学习方法 | |
CN107186753B (zh) | 工业机器人性能测试的工作空间确定方法 | |
CN110722562B (zh) | 一种用于机器人参数辨识的空间雅克比矩阵构造方法 | |
CN104236543A (zh) | 用于工业机器人空间位姿精度和轨迹测量的拉线式测量***和测量方法 | |
CN109623811B (zh) | 四自由度的自动装甑机器人的投料方法 | |
CN110181558A (zh) | 一种变臂关节式坐标测量机标定机器人的装置及其方法 | |
CN110193816B (zh) | 工业机器人示教方法、手柄及*** | |
CN114012730A (zh) | 一种scara机器人本体标定及参数辨识方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20190202 Address after: 830000 384 Science 1 Street, Urumqi high tech Zone, the Xinjiang Uygur Autonomous Region Applicant after: Wei Xue Address before: 264670 Aerospace Road 513, Yantai High-tech Zone, Shandong Province Applicant before: An Kai |
|
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170620 |