一种基于非线性方程组的相贯双管装夹位姿的两点测定方法技术

本发明专利技术涉及一种基于非线性方程组的相贯双管装夹位姿的两点测定方法，本发明专利技术综合了数控测量、数学模型建立以及非线性方程求解。通过机床本身测量支管外壁上的两个任意点的机床坐标，并结合管组已知的相贯参数便可以求得管组的装夹位姿。此方法具有无需外部测量工具、所需测量点少、测定精度高等特点，大大缩短了相贯线自动焊接前的管组姿态调整准备时间，提高了作业效率。大大缩短了相贯线自动焊接前各未知参数测量的准备时间，以达到快速生成相贯管道焊接程序的目的，实现相贯线自动焊接过程的高效化。

【技术实现步骤摘要】
一种基于非线性方程组的相贯双管装夹位姿的两点测定方法
本专利技术涉及一种基于非线性方程组的相贯双管装夹位姿的两点测定方法，属于自动焊接控制

技术介绍
在相贯线自动焊接过程中，相贯管道焊接程序是按照已知的相贯参数和预定装夹位姿自动生成的。然而在实际中，管组的装夹位姿与预定的装夹位姿之间存在较大差距，容易导致焊接轨迹与焊缝偏离。在自动焊接之前，首先需要测定管组的初始装夹位姿，然后将管组校正到预定装夹位姿。管组的装夹位姿包括两个参数，一个是管组在主管轴线方向的位移，另一个是管组沿主管轴线的旋转角。由于相贯管组的几何特点，尤其是当两管偏心或斜交时，难以使用现有测量工具对管组位姿进行有效测量。传统方法一般采用“目测调整—试运行—目测调整—试运行—……”的方法，直至焊接轨迹与焊缝偏差满足要求。这种方法过程繁琐、效率低下，而且对操作者的专业水平有较高要求，严影响了作业效率。
技术实现思路
针对现有技术的不足，本专利技术提供一种基于非线性方程组的相贯双管装夹位姿的两点测定方法，以达到快速生成相贯管道焊接程序的目的，实现相贯线自动焊接过程的高效化。本专利技术的技术方案如下：一种基于非线性方程组的相贯双管装夹位姿两点测定方法，包括，步骤一：测量支管外壁上任意两个点的机床坐标；步骤二：将测量的两个点的机床坐标代入非线性方程组求得双管的装夹位姿参数。优选的，在测量支管外壁上任意两个点的机床坐标前，将相贯线焊接机床的机床原点置于卡盘中轴线即主管中轴线上，并用机床坐标系来描述待测两个点的笛卡尔坐标。优选的，所述测量支管外壁上任意两个点的机床坐标的步骤包括，(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)，则两组坐标满足以下关系其中r为支管外壁的半径。代入齐次变换矩阵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程序求解此非线性方程组得到四组实解，四组实解中δ和β均只有符号的差异(++、-+、+-、--四种组合)。目测支管位置，若支管本文档来自技高网...

【技术保护点】
一种基于非线性方程组的相贯双管装夹位姿两点测定方法，其特征在于，包括，步骤一：测量支管外壁上任意两个点的机床坐标；步骤二：将测量的两个点的机床坐标代入非线性方程组求得双管的装夹位姿参数。

【技术特征摘要】
1.一种基于非线性方程组的相贯双管装夹位姿两点测定方法，其特征在于，包括，步骤一：测量支管外壁上任意两个点的机床坐标；步骤二：将测量的两个点的机床坐标代入非线性方程组求得双管的装夹位姿参数；所述测量支管外壁上任意两个点的机床坐标的步骤包括，（1）在焊枪末端套装一尖锥金属物体作为测量头，或者用一尖头金属棒代替焊枪作为测量头，将测量头与外部数控系统组合成一数控测量系统，该数控测量系统计算并显示测量头尖端的实时机床坐标；（2）用测量头分别接触支管外壁上的两个测量点，并记录下两个测量点的机床坐标；所述两个测量点沿支管圆周方向的角度差在60°至120°之间；确定一个测量点的非线性方程的过程，包括步骤如下，（1）建立机床坐标系XYZ和支管坐标系XBYBZB，其中YB为支管中轴线，XB为支管中轴线与主管中轴线的公垂线，ZB由XB和YB根据右手法则确定，由支管坐标系到机床坐标系的齐次变换矩阵为（Ⅰ）其中:e为两管偏心距，α为支管倾斜角，δ为管组在主管轴线方向的位移，β为管组沿主管轴线的旋转角；（2）测得的支管外壁上一点在机床坐标系XYZ中的坐标为(x1,y1,z1)，该点在支管坐标系XBYBZB中的坐...

【专利技术属性】
技术研发人员：田新诚，石磊，
申请(专利权)人：山东大学，
类型：发明
国别省市：山东;37