CN104655068A - 一种基于非线性方程组的相贯双管装夹位姿的两点测定方法 - Google Patents
一种基于非线性方程组的相贯双管装夹位姿的两点测定方法 Download PDFInfo
- Publication number
- CN104655068A CN104655068A CN201510115392.0A CN201510115392A CN104655068A CN 104655068 A CN104655068 A CN 104655068A CN 201510115392 A CN201510115392 A CN 201510115392A CN 104655068 A CN104655068 A CN 104655068A
- Authority
- CN
- China
- Prior art keywords
- beta
- cos
- sin
- alpha
- arm
- 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
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000005259 measurement Methods 0.000 claims abstract description 33
- 238000003466 welding Methods 0.000 claims abstract description 22
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 6
- 239000002184 metal Substances 0.000 claims description 5
- 238000010586 diagram Methods 0.000 description 2
- 238000013178 mathematical model Methods 0.000 description 2
- 238000003556 assay Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003801 milling Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
-
- 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
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Optics & Photonics (AREA)
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Butt Welding And Welding Of Specific Article (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本发明涉及一种基于非线性方程组的相贯双管装夹位姿的两点测定方法,本发明综合了数控测量、数学模型建立以及非线性方程求解。通过机床本身测量支管外壁上的两个任意点的机床坐标,并结合管组已知的相贯参数便可以求得管组的装夹位姿。此方法具有无需外部测量工具、所需测量点少、测定精度高等特点,大大缩短了相贯线自动焊接前的管组姿态调整准备时间,提高了作业效率。大大缩短了相贯线自动焊接前各未知参数测量的准备时间,以达到快速生成相贯管道焊接程序的目的,实现相贯线自动焊接过程的高效化。
Description
技术领域
本发明涉及一种基于非线性方程组的相贯双管装夹位姿的两点测定方法,属于自动焊接控制技术领域。
背景技术
在相贯线自动焊接过程中,相贯管道焊接程序是按照已知的相贯参数和预定装夹位姿自动生成的。然而在实际中,管组的装夹位姿与预定的装夹位姿之间存在较大差距,容易导致焊接轨迹与焊缝偏离。在自动焊接之前,首先需要测定管组的初始装夹位姿,然后将管组校正到预定装夹位姿。
管组的装夹位姿包括两个参数,一个是管组在主管轴线方向的位移,另一个是管组沿主管轴线的旋转角。由于相贯管组的几何特点,尤其是当两管偏心或斜交时,难以使用现有测量工具对管组位姿进行有效测量。传统方法一般采用“目测调整—试运行—目测调整—试运行—……”的方法,直至焊接轨迹与焊缝偏差满足要求。这种方法过程繁琐、效率低下,而且对操作者的专业水平有较高要求,严影响了作业效率。
发明内容
针对现有技术的不足,本发明提供一种基于非线性方程组的相贯双管装夹位姿的两点测定方法,以达到快速生成相贯管道焊接程序的目的,实现相贯线自动焊接过程的高效化。
本发明的技术方案如下:
一种基于非线性方程组的相贯双管装夹位姿两点测定方法,包括,
步骤一:测量支管外壁上任意两个点的机床坐标;
步骤二:将测量的两个点的机床坐标代入非线性方程组求得双管的装夹位姿参数。
优选的,在测量支管外壁上任意两个点的机床坐标前,将相贯线焊接机床的机床原点置于卡盘中轴线即主管中轴线上,并用机床坐标系来描述待测两个点的笛卡尔坐标。
优选的,所述测量支管外壁上任意两个点的机床坐标的步骤包括,
(1)在焊枪末端套装一尖锥金属物体作为测量头,或者用一尖头金属棒代替焊枪作为测量头,将测量头与外部数控系统组合成一数控测量系统,该数控测量系统计算并显示测量头尖端的实时机床坐标;
(2)用测量头分别接触支管外壁上的两个测量点,并记录下两个测量点的机床坐标。
进一步优选的,所述两个测量点沿支管圆周方向的角度差在60°至120°之间。
优选的,确定一个测量点的非线性方程的过程,包括步骤如下,
(1)建立机床坐标系XYZ和支管坐标系XBYBZB,其中YB为支管中轴线,XB为支管中轴线与主管中轴线的公垂线,ZB由XB和YB根据右手法则确定,由支管坐标系到机床坐标系的齐次变换矩阵为
其中:e为两管偏心距,α为支管倾斜角,δ为管组在主管轴线方向的位移,β为管组沿主管轴线的旋转角;
(2)测得的支管外壁上一点在机床坐标系XYZ中的坐标为(x1,y1,z1),该点在支管坐标系XBYBZB中的坐标为(xb,yb,zb),则两组坐标满足以下关系
其中:r为支管外壁的半径;
(3)将齐次变换矩阵T的具体表达式(Ⅰ)代入公式(Ⅱ)的方程组,整理后得到以下方程:
(x1cosβ-z1sinβ-e)2+(x1sinβcosα-y1sinα+z1cosβcosα+δsinα)2=r2 (Ⅲ)
其中,δ与β为待求解的管组装夹位姿参数,其余参数均为常量。
优选的,利用上述方法确定两个测量点坐标,并分别得到两个测量点的非线性方程,则两个测量点的非线性方程组的具体表达式为
其中:(x1,y1,z1)和(x2,y2,z2)分别为两个测量点的机床坐标,r为支管外壁的半径,e为两管偏心距,α为支管倾斜角,δ为管组在主管轴线方向的位移,β为管组沿主管轴线的旋转角,δ和β为待求解参数。
优选的,使用MATLAB程序求解此非线性方程组得到四组实解,四组实解中δ和β均只有符号的差异,目测管组装夹位姿δ与β的符号,从四组实解中确定唯一的一组期望解。
本发明的有益效果在于:
本发明综合了数控测量、数学模型建立以及非线性方程求解。通过机床本身测量支管外壁上的两个任意点的机床坐标,并结合管组已知的相贯参数便可以求得管组的装夹位姿。此方法具有无需外部测量工具、所需测量点少、测定精度高等特点,大大缩短了相贯线自动焊接前的管组姿态调整准备时间,提高了作业效率。
附图说明
图1为本发明方法中相贯线焊接机床示意图;
图2为本发明方法中相贯管道参数定义示意图。
具体实施方式
下面通过实施例并结合附图对本发明做进一步说明,但不限于此。
实施例1:
如图1和图2所示,本实施例提供一种基于非线性方程组的相贯双管装夹位姿的两点测定方法,该方法综合了数控测量、数学模型建立以及非线性方程求解,通过在机床本身测量支管外壁上的两个任意点的机床坐标,并结合预估的待解参数求解初值,便可以求得双管的装夹位姿参数。
相贯线焊接机床的结构类似于五轴铣床,由三个直线轴和两个旋转轴组成,具体结构如图1所示,旋转轴用来调整焊枪的姿态,直线轴用来调整焊枪的位置。该测定方法具体的操作步骤如下:
(1)调整机床坐标系原点位于卡盘中轴线上,即主管中轴线上;将焊枪末端套装一尖锥金属物体作为测量头,利用现有技术将该测量头与外部的数控系统相连组合成一数控测量系统。对该数控测量系统做相应调整,使其实时计算并显示出测量头在机床坐标系中的笛卡尔坐标。
(2)将待焊接管组夹到机床卡盘上,并在测量过程中保持管组位姿固定;设定机床坐标系为XYZ,其中X轴、Y轴与地面平行,Z轴与地面垂直,设定支管坐标系为XBYBZB。
具体坐标系的设定关系如图2所示,由支管坐标系到机床坐标系的齐次变换矩阵为
其中:e为两管偏心距(主管中轴线与支管中轴线之间公垂线的距离称为两管偏心距);
α为支管倾斜角(主管中轴线与支管中轴线的夹角称为支管倾斜角);
δ为管组在主管中轴线方向的位移,即管组中心点与机床坐标系原点的距离(主管中轴线与支管中轴线的公垂线在主管中轴线上的垂足称为管组中心点);
β为管组沿主管中轴线的旋转角,即支管中轴线在XOZ平面上的投影与Z轴的夹角。
(3)通过机床的手动操作模式,移动测量头并调整测量头的姿态,使测量头轻微接触到支管外表面的任一点,并记录下此时该点的机床坐标为(x1,y1,z1),相应地此点在支管坐标系XBYBZB中的坐标为(xb,yb,zb),则两组坐标满足以下关系
代入齐次变换矩阵T的具体表达式,进一步整理可以得到以下非线性方程:
(x1cosβ-z1sinβ-e)2+(x1sinβcosα-y1sinα+z1cosβcosα+δsinα)2=r2,其中δ与β为待求解的管组装夹位姿,其余参数均为常量,e为两管偏心距,α为支管倾斜角,由于支管切割和主管开孔一般是利用数控切割设备自动加工的,所以插接到一块的管组的偏心距e和支管倾斜角α是已知的。
(4)按照步骤(3)所述方法再测量支管外表面上的第二点的机床坐标,记为(x2,y2,z2),同理,得到第二点的非线性方程
(x2cosβ-z2sinβ-e)2+(x2sinβcosα-y2sinα+z2cosβcosα+δsinα)2=r2
由此两点的非线性方程所确定的二元非线性方程组,即为:
其中,参数r为已知的支管外壁半径,参数e为已知的两管偏心距,参数α为已知的支管倾斜角;其余为待求解参数:参数δ为管组中心点(主管中轴线和支管中轴线的公垂线在主管中轴线上的垂足称为管组中心点)与机床坐标系原点的距离,参数β为支管中轴线在XOZ平面上的投影与Z轴的夹角。
(5)使用MATLAB程序求解此非线性方程组得到四组实解,四组实解中δ和β均只有符号的差异(++、-+、+-、--四种组合)。目测支管位置,若支管处于机床坐标系原点的Y+方向,则δ大于0,反之则δ小于0;若支管向机床坐标系的X+方向倾斜,则β大于0,反之则β小于0。根据目测得到的装夹位姿δ与β的符号,从四组实解中确定唯一的一组期望解。
通过以上步骤,可以求得管组的装夹位姿参数。根据δ和β的值,利用相贯线焊接机床的数控系统旋转卡盘,并将机床坐标系沿其Y轴平移得到工件坐标系,可以使得管组在工件坐标系中的装夹位姿等于预定装夹位姿,进而可以执行按照预定装夹位姿编写的相贯管道焊接程序。
实施例2:
本实施例提供一种基于非线性方程组的相贯双管装夹位姿两点测定方法,该方法步骤如实施例1所述,其不同之处在于:在进行两个测量点的位置选取时,使两个测量点沿支管圆周方向的角度差为90°±30°。
依照此分布规律选择的两个测量点,相比起任意选取的两个测量点而言,能最大限度的降低测量误差对待解参数求解准确度的影响。
Claims (7)
1.一种基于非线性方程组的相贯双管装夹位姿两点测定方法,其特征在于,包括,
步骤一:测量支管外壁上任意两个点的机床坐标;
步骤二:将测量的两个点的机床坐标代入非线性方程组求得双管的装夹位姿参数。
2.如权利要求1所述的基于非线性方程组的相贯双管装夹位姿两点测定方法,其特征在于,在测量支管外壁上任意两个点的机床坐标前,将相贯线焊接机床的机床原点置于卡盘中轴线即主管中轴线上,并用机床坐标系来描述待测两个点的笛卡尔坐标。
3.如权利要求1所述的基于非线性方程组的相贯双管装夹位姿两点测定方法,其特征在于,所述测量支管外壁上任意两个点的机床坐标的步骤包括,
(1)在焊枪末端套装一尖锥金属物体作为测量头,或者用一尖头金属棒代替焊枪作为测量头,将测量头与外部数控系统组合成一数控测量系统,该数控测量系统计算并显示测量头尖端的实时机床坐标;
(2)用测量头分别接触支管外壁上的两个测量点,并记录下两个测量点的机床坐标。
4.如权利要求3所述的基于非线性方程组的相贯双管装夹位姿两点测定方法,其特征在于,所述两个测量点沿支管圆周方向的角度差在60°至120°之间。
5.如权利要求4所述的基于非线性方程组的相贯双管装夹位姿两点测定方法,其特征在于,确定一个测量点的非线性方程的过程,包括步骤如下,
(1)建立机床坐标系XYZ和支管坐标系XBYBZB,其中YB为支管中轴线,XB为支管中轴线与主管中轴线的公垂线,ZB由XB和YB根据右手法则确定,由支管坐标系到机床坐标系的齐次变换矩阵为
其中:e为两管偏心距,α为支管倾斜角,δ为管组在主管轴线方向的位移,β为管组沿主管轴线的旋转角;
(2)测得的支管外壁上一点在机床坐标系XYZ中的坐标为(x1,y1,z1),该点在支管坐标系XBYBZB中的坐标为(xb,yb,zb),则两组坐标满足以下关系
其中:r为支管外壁的半径;
(3)将齐次变换矩阵T的具体表达式(Ⅰ)代入公式(Ⅱ)的方程组,整理后得到以下方程:
(x1cosβ-z1sinβ-e)2+(x1sinβcosα-y1sinα+z1cosβcosα+δsinα)2=r2 (Ⅲ)
其中,δ与β为待求解的管组装夹位姿参数,其余参数均为常量。
6.如权利要求5所述的基于非线性方程组的相贯双管装夹位姿两点测定方法,其特征在于,利用上述方法确定两个测量点坐标,并分别得到两个测量点的非线性方程,则两个测量点的非线性方程组的具体表达式为
其中:(x1,y1,z1)和(x2,y2,z2)分别为两个测量点的机床坐标,r为支管外壁的半径,e为两管偏心距,α为支管倾斜角,δ为管组在主管轴线方向的位移,β为管组沿主管轴线的旋转角,δ和β为待求解参数。
7.如权利要求6所述的基于非线性方程组的相贯双管装夹位姿两点测定方法,其特征在于,使用MATLAB程序求解此非线性方程组得到四组实解,四组实解中δ和β均只有符号的差异,目测管组装夹位姿δ与β的符号,从四组实解中确定唯一的一组期望解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510115392.0A CN104655068B (zh) | 2015-03-17 | 2015-03-17 | 一种基于非线性方程组的相贯双管装夹位姿的两点测定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510115392.0A CN104655068B (zh) | 2015-03-17 | 2015-03-17 | 一种基于非线性方程组的相贯双管装夹位姿的两点测定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104655068A true CN104655068A (zh) | 2015-05-27 |
CN104655068B CN104655068B (zh) | 2017-08-25 |
Family
ID=53246477
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510115392.0A Expired - Fee Related CN104655068B (zh) | 2015-03-17 | 2015-03-17 | 一种基于非线性方程组的相贯双管装夹位姿的两点测定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104655068B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104908977A (zh) * | 2015-05-29 | 2015-09-16 | 江西洪都航空工业集团有限责任公司 | 一种时变非线性高柔性装夹方法 |
CN105509640A (zh) * | 2015-07-23 | 2016-04-20 | 中国电子科技集团公司第四十一研究所 | 小尺寸相贯结构相对位置精确测量方法 |
CN110542396A (zh) * | 2019-10-11 | 2019-12-06 | 北京铁科工程检测有限公司 | 一种异形钢塔节段姿态快速定位测量方法 |
CN111612848A (zh) * | 2020-04-30 | 2020-09-01 | 重庆见芒信息技术咨询服务有限公司 | 机器人弧焊轨迹自动生成方法及系统 |
CN113400318A (zh) * | 2021-07-16 | 2021-09-17 | 四川成焊宝玛焊接装备工程有限公司 | 机器人用户坐标系补偿方法、汽车在线滚边系统及方法 |
CN112719379B (zh) * | 2020-12-21 | 2022-04-22 | 中国兵器工业集团江山重工研究院有限公司 | 一种方管多复合斜面的铣削方法 |
CN114662184A (zh) * | 2022-02-18 | 2022-06-24 | 福建工程学院 | 一种t/k/y相贯结构的坡口建模方法 |
-
2015
- 2015-03-17 CN CN201510115392.0A patent/CN104655068B/zh not_active Expired - Fee Related
Non-Patent Citations (4)
Title |
---|
尹萍: "自动焊接机床运动控制算法研究与软件系统开发", 《中国优秀博硕士学位论文全文数据库(硕士)工程科技I辑》 * |
李宝清_等: "多管、板相贯坡口切割的数学模型", 《天津大学学报》 * |
汪苏_等: "大型相贯线埋弧焊接工艺研究及焊枪姿态建模", 《焊接技术》 * |
赫英磊: "基于逆向工程技术的焊接路径离线识别方法", 《中国优秀硕士学位论文全文数据库工程科技I辑》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104908977A (zh) * | 2015-05-29 | 2015-09-16 | 江西洪都航空工业集团有限责任公司 | 一种时变非线性高柔性装夹方法 |
CN105509640A (zh) * | 2015-07-23 | 2016-04-20 | 中国电子科技集团公司第四十一研究所 | 小尺寸相贯结构相对位置精确测量方法 |
CN105509640B (zh) * | 2015-07-23 | 2018-06-08 | 中国电子科技集团公司第四十一研究所 | 小尺寸相贯结构相对位置精确测量方法 |
CN110542396A (zh) * | 2019-10-11 | 2019-12-06 | 北京铁科工程检测有限公司 | 一种异形钢塔节段姿态快速定位测量方法 |
CN111612848A (zh) * | 2020-04-30 | 2020-09-01 | 重庆见芒信息技术咨询服务有限公司 | 机器人弧焊轨迹自动生成方法及系统 |
CN111612848B (zh) * | 2020-04-30 | 2023-10-10 | 湖北煌朝智能自动化装备有限公司 | 机器人弧焊轨迹自动生成方法及系统 |
CN112719379B (zh) * | 2020-12-21 | 2022-04-22 | 中国兵器工业集团江山重工研究院有限公司 | 一种方管多复合斜面的铣削方法 |
CN113400318A (zh) * | 2021-07-16 | 2021-09-17 | 四川成焊宝玛焊接装备工程有限公司 | 机器人用户坐标系补偿方法、汽车在线滚边系统及方法 |
CN114662184A (zh) * | 2022-02-18 | 2022-06-24 | 福建工程学院 | 一种t/k/y相贯结构的坡口建模方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104655068B (zh) | 2017-08-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104655068A (zh) | 一种基于非线性方程组的相贯双管装夹位姿的两点测定方法 | |
CN104759945B (zh) | 基于高精度工业相机的移动制孔机器人基准找正方法 | |
CN106679533B (zh) | 用于lng船液货舱三向板cm节点的检测工装系统及检测方法 | |
CN105159228B (zh) | 五轴联动数控机床实现rtcp功能的五轴标定方法 | |
US7123990B2 (en) | Gap welding process | |
CN105487481B (zh) | 离线示教机器人的机器人示教装置 | |
CN103777570B (zh) | 基于nurbs曲面的加工误差快速检测补偿方法 | |
CN110411338B (zh) | 机器人电弧增材修复的焊枪工具参数三维扫描标定方法 | |
CN105404238A (zh) | 一种在机激光测量中测头位姿的线性化标定方法 | |
CN102266958B (zh) | 基于制孔设备坐标系确定的柔性导轨孔群加工方法 | |
CN104289748A (zh) | 一种大型薄壁蒙皮自适应等壁厚铣削系统及其加工方法 | |
CN103706945A (zh) | 一种工业机器人工具中心点的校正方法及装置 | |
EP2835702B1 (de) | Verfahren zur Vermessung wenigstens einer Rundachse einer Werkzeugmaschine | |
CN103592893A (zh) | 一种光学元件加工中自动补偿位姿误差的方法 | |
CN104476330A (zh) | 一种基于7点探测循环的五坐标加工中心坐标系确定方法 | |
CN106141810B (zh) | 机器人操作下筒状工件内腔加工壁厚的保证方法 | |
CN203792101U (zh) | 导向模板的找正组件 | |
CN100501109C (zh) | 异形构件的虚拟四面体顶点测量定位方法 | |
CN110421393B (zh) | 一种数控铣削工件快速二次找正的方法 | |
CN104729440A (zh) | 一种基于非线性方程组的相贯双管的相贯参数与装夹位姿的四点测量方法 | |
KR101664163B1 (ko) | 펀칭 기능을 갖는 공작물 셋업 공구 및 그것을 이용한 공작물 셋업 및 펀칭 방법 | |
CN109590640A (zh) | 汽车部件焊接夹具位置校准装置 | |
TWM490934U (zh) | 應用多自由度機械手臂的鏟花裝置 | |
CN205808304U (zh) | 钢结构对接焊缝宽度及错边深度检测装置 | |
CN108895977A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170825 |
|
CF01 | Termination of patent right due to non-payment of annual fee |