[发明专利]一种基于非线性方程组的相贯双管的相贯参数与装夹位姿的四点测量方法

说明书

技术领域

本发明涉及一种基于非线性方程组的相贯双管的相贯参数与装夹位姿的四点测量方法，属于自动焊接控制技术领域。

背景技术

在相贯线自动焊接过程中，相贯管道焊接程序是按照已知的相贯参数和预定的装夹位姿自动生成的。然而在某些情况下，不仅管组的装夹位姿与预定的装夹位姿不同，而且双管的相贯参数也不明确。在自动生成焊接代码前，必须测量双管的相贯参数；在自动焊接之前，必须测定并校正管组的装夹位姿。

双管的相贯参数包括主管半径、支管半径、双管偏心距和支管倾斜角，其中前两者容易测量。对于偏心距和倾斜角的测量，传统方法需要长度测量仪器、角度测量仪器及其他工具的配合，而且过分依赖于测量者的经验，这导致了较大的测量结果不确定性和较低的测量效率。

管组的装夹位姿包括两个参数：一个是管组在主管轴线方向的位移，另一个是管组沿主管轴线的旋转角。由于相贯管组的几何特点，尤其是当两管偏心或斜交时，难以使用现有测量工具对管组位姿进行有效测量。传统方法一般采用“目测调整—试运行—目测调整—试运行—……”的方法，直至焊接轨迹与焊缝偏差满足要求。显然，这种方法过程繁琐、效率低下，而且对操作者的专业水平有较高要求，严重影响了作业效率。

发明内容

针对现有技术的不足，本发明提供一种基于非线性方程组的相贯双管的相贯参数与装夹位姿的四点测量方法，以达到快速生成相贯管道焊接程序的目的，实现相贯线自动焊接过程的高效化。

本发明的技术方案如下：

一种基于非线性方程组的相贯双管的相贯参数与装夹位姿的四点测量方法，包括，

步骤一：测量支管外壁上任意四个点的机床坐标；

步骤二：将测量的四个点的机床坐标代入非线性方程组求得双管的相贯参数和装夹位姿参数。

优选的，在测量支管外壁上任意四个点的机床坐标前，将相贯线焊接机床的机床原点置于卡盘中轴线即主管中轴线上，并用机床坐标系来描述待测四个点的笛卡尔坐标。

优选的，所述测量支管外壁上任意四个点的机床坐标的步骤包括，

(1)在焊枪末端套装一尖锥金属物体作为测量头，或者用一尖头金属棒代替焊枪作为测量头，将测量头与外部数控系统组合成一数控测量系统，该数控测量系统计算并显示测量头尖端的实时机床坐标；

(2)用测量头分别接触支管外壁上的四个测量点，并记录下四个测量点的机床坐标。

进一步优选的，将所述四个测量点分成两组，每组包括两个测量点，其中一组测量点靠近主管，另一组测量点远离主管；且每组的两个测量点沿支管圆周方向的角度差在60°至120°之间。

优选的，确定一个测量点的非线性方程的过程，包括步骤如下，

(1)建立机床坐标系XYZ和支管坐标系X_BY_BZ_B，其中Y_B为支管中轴线，X_B为支管中轴线与主管中轴线的公垂线，Z_B由X_B和Y_B根据右手法则确定，由支管坐标系到机床坐标系的齐次变换矩阵为

其中:e为两管偏心距，α为支管倾斜角，δ为管组在主管中轴线方向的位移，β为管组沿主管中轴线的旋转角；

(2)使用上述方法测得支管外壁上一点在机床坐标系XYZ中的坐标为(x₁,y₁,z₁)，此点在支管坐标系X_BY_BZ_B中的坐标为(x_b,y_b,z_b)，则两组坐标满足以下关系

其中：r为支管外壁的半径；

(3)将齐次变换矩阵T的具体表达式(Ⅰ)代入公式(Ⅱ)的方程组，整理后得到以下方程：

(x₁cosβ-z₁sinβ-e)²+(x₁sinβcosα-y₁sinα+z₁cosβcosa+δsinα)²＝r² (Ⅲ)

其中：e与α为待求解的双管相贯参数，δ与β为待求解的管组装夹位姿参数。

优选的，利用上述方法依次确定四个测量点坐标，并分别得到四个测量点的非线性方程，则四个测量点的非线性方程组的具体表达式为