基于管道插接的相贯线焊缝提取算法及数值模拟

李湘文，黄宏亮，洪波，李然，马秀萍，王英俊

(1.湘潭大学,焊接机器人及其应用湖南省重点实验室,湘潭,411105；2.中国航发南方工业有限公司,株洲,412000)

0 序言

管道插接形成的相贯线焊缝在航天航空、石油化工、建筑、船舶等工程领域广泛存在，是一种典型的焊缝形式[1].但管管相贯结构所形成的焊缝为空间曲线焊缝，坡口形状不规则且有不均匀的变化[2].为实现其焊接自动化，国内外学者进行了大量的研究工作.早期的管管焊接设备的研究主要是针对大型的管道对接焊接，通过使用周向运动的焊接小车，环绕焊缝运动实现大型管道的相贯线焊接[3].或者采用分段的方式将圆周焊道细分为小段，再平滑过渡分段函数拟合为连续函数[4]，以此来研究管道对接全位置焊接.康少杰等人[5]开发了一种可变式圆弧轨道的焊接机器人装置，能进行相贯线焊缝全方位不同宽度焊缝的焊接.随着管管焊接的需求趋于复杂化、差异化，管管焊接设备的研究也朝着精细化智能化发展.高利军等人[6]设计了一种新型钢制暖气片相贯线焊缝专用焊机，并建立了相贯线焊缝数学模型，推导出了基于此模型的焊机自步角算法.刘永滨等人[7]则采用MSC.Marc 软件对天然气管道在役修补焊接过程进行数值模拟，其管道残余变形峰值出现在焊缝的收弧区域，最大收缩变形量为1.79 mm.上述关于管道插接的相贯线焊接的研究，多是针对于单一管道或者同一类型的多个不同管道插接焊缝，对于同时需要焊接两个及以上不同直径乃至不同插接形式的焊接任务，相关研究并不多见.

针对筒体内壁的管道插接焊接任务，设计了一种能提取支管空间位置和尺寸信息的传感器，并在此基础上建立管道插接焊缝位置模型和焊缝特征与焊枪姿态矩阵，最后利用MATLAB 结合初值对该数学模型进行了数值模拟验证.

1 管道插接焊缝位置识别传感器

管道插接有管-板插接、管-管插接、管-锥插接和管-球插接等种类，其中每个种类有各种插接形式，例如管-管插接又包含有管管正交、管管斜交、管管正交偏置、管管斜交偏置4 种形式，所以管道插接焊缝不仅曲线复杂，而且种类繁多.然而，在大部分管道插接焊缝的焊接任务中，其主件(即主板、主管、锥体或球体)位置均为已知，只需确定支管位置及尺寸，便能得到焊缝位置.

如图1 所示，焊缝位置识别传感器通过提取支管开口截面内圆的空间位置和尺寸(即图1a 加粗的空间圆)，来确定支管空间位置，提取方法为图1b所示通过传感器获取过支管开口截面内圆的同轴的两锥面A 和 B，联立两锥面得到的空间圆即为支管开口截面内圆.实际操作时，通过获取锥面A 和锥面B 上各4 条相同方位的母线，取交点达到相同效果.此传感器对于不同支管直径，不同管道插接种类和管道插接形式具有通用性.焊缝位置识别传感器如图1c 所示，由支架、曲柄、连杆、滑块、角度传感器和铰链底座组成，共含有4 组曲柄滑块机构.

图1 传感器识别目标、方法和三维模型Fig.1 Sensor identification target,identification and 3D model. (a) open section inner circle; (b)identification method;(c) sensor 3D model

如图2 所示，当进行采样识别工作时，传感器整体沿支架轴线下降伸入支管内部，由于受支管对曲柄的反作力，4 组曲柄滑块机构将分别运动到某一位置，此时进行第一次采样，由4 个角度传感器获取此时曲柄对支架的夹角，由编码器反馈此时传感器高度，每组曲柄滑块的位置和角度信息可以得到一条空间直线；采集完毕后，传感器继续下降一定位置，进行第二次采样.将第二次采样得到的空间直线与第一次采样得到的空间直线联立，可以得到4 个交点，所得的交点均在支管开口截面内圆上.空间上三点可确定空间圆的尺寸与位置，第4 点用来防止干扰点与减小误差.

图2 传感器信号采集Fig.2 Sensor signal acquisition.(a) first sampling;(b)second sampling

2 管道插接焊缝的数学模型

以圆筒内壁的管道插接为研究对象，包含管管正交、管管斜交、管管正交偏置、管管斜交偏置等插接形式，建立基于焊缝位置识别传感器的焊缝数学模型，及焊缝焊枪特征矩阵.如图3 所示，传感器增加小车支架、小车移动副、转盘转动副、电动缸移动副，并移动到图3 所示的初始位置，以转盘转动副轴线与传感器支架轴线交点为原点O1，重力方向为z1轴，圆筒轴线方向为x1轴，建立O1x1y1z1初始坐标系，其中小车移动副的移动方向与x1轴方向重合，转盘轴线方向与x1轴重合，在初始位置传感器轴线与z1轴重合.

图3 传感器初始坐标系Fig.3 Initial coordinate system of sensor

2.1 管道插接焊缝位置模型

如图4 所示，小车从初始位置沿x1轴方向平移l，转盘以x1轴为轴线顺时针旋转α角,得到O2x2y2z2工作坐标系，则坐标系O1x1y1z1到坐标系O2x2y2z2的变换矩阵.

图4 传感器工具坐标系Fig.4 Sensor tool coordinate system

圆筒内壁半径为R，轴线在x1O1z1面内，与x1轴平行且距离为l0.圆筒内壁在坐标系O2x2y2z2下的方程为

在O2x2y2z2坐标系下，已知传感器铰链底座的4 个铰链轴线所在平面到x2O2y2面距离为Z0，4 组曲柄的方位角为

第一次采样得到的直线参数方程为

第二次采样得到的直线参数方程为

式中：r0为 铰链轴线到支架轴线距离；β1i，β2i分别为第一次采样和第二次采样得到的曲柄与传感器轴线夹角的角度数据；Z1为第一次采样时电动缸移动距离；Z2为第一次采样移动到第二次采样时电动缸移动距离，联立(4)和(5)，可得

代入式(4)得到两组直线的4 个交点，此4 点即为支管开口截面内圆上4 点，设Pi=(xi,yi,zi),i=1,2,3,4，则

取支管开口截面内圆所在平面内的两个向量为

则支管开口截面内圆所在平面的法向量为

由于直线l12与 直线l13的中垂线都经过空间圆的圆心c，有Pc=(xc,yc,zc)，即

设x2轴单位矢量为i=(1,0,0)，支管开口截面与y2O2z2面的交线的单位矢量为a，则

由圆心c、圆上正交单位矢量a和b、半径r可得空间圆参数方程.

式(18)为支管开口截面内圆所在空间位置方程，参数 θ取值范围为[ 0,2π]，此时参数 θ的物理意义为圆上一点到圆心c连成的直线与a的夹角.

支管内壁曲面参数方程为

式中：x，y，z为空间圆参数方程联立支管内壁曲面参数方程与主管方程.

带入(20)得到焊缝方程，即

2.2 管道插接焊缝特征模型

图5 管道插接坐标系示意图Fig.5 Schematic diagram of the pipe socket coordinate system

由于相贯线上任意点的切线,始终与过该点的两个圆柱切平面的交线重合，因此XW(XW1)坐标轴向量为

坐标系O2x2y2z2到坐标系Ow1xW1yW1zW1变换矩阵为

坐标系Ow1xW1yW1zW1绕xW1轴顺时针旋转φ/2，得焊缝坐标系OwxWyWzW，即

焊缝坐标系相对于初始坐标系的特征矩阵为

2.3 焊枪姿态模型

焊缝坐标系到焊枪坐标系为

通过焊枪坐标系相对焊缝坐标系的位姿矩阵，可以用数学算法计算出焊枪的3 个角.

由式(34)和式(35)可得

3 仿真试验

在Creo 平台上搭建筒体内壁管管插接焊缝自动焊接机器人的三维模型，并模拟工作环境，采集传感器角度信息，将数据带入上述模型与算法当中，获得管管插接焊缝空间位置数学模型.利用MATLAB 软件对数学模型进行仿真验证，并与设定的工件焊缝曲线进行对比分析.设定同一空间坐标点为起始点，以相同的比例将工件焊缝曲线和传感器得到的数据曲线划分为64 等份，得到各点的坐标值，部分数据如表1 所示.

表1 实际坐标点与采样坐标点(mm)Table 1 Actual coordinate point and the sampling coordinate point

对全部64 个坐标数据进行分析比较，可得标定坐标点与采样坐标点在x轴和y轴方向的误差较小，其最大值为0.12 mm，而z轴方向的偏差较大，所以主要分析z轴方向的误差.图6 为z轴方向的焊缝偏差图，最大的焊缝偏差为0.25 mm，其精度满足实际焊接精度要求.

图6 z轴焊缝偏差图Fig.6 z-axis weld deviation chart

图7 为传感器识别曲线与工件焊缝曲线整体对比图.从图7 可以看到，虽然二者存在一定偏差，但是整体偏差不大，传感器数据曲线基本接近工件焊缝曲线，证明了传感器模型和焊缝轨迹算法的准确性.

图7 传感器识别曲线与工件焊缝曲线图Fig.7 Sensor identification curve and workpiece weld curve

基于ABB 公司开发的机器人仿真软件RobotStudio为平台，建立ABB 机器人仿真系统.通过通讯的方式将传感器所采集的焊缝位置，作为机器人运动轨迹传输给仿真平台，结合焊缝姿态模型与焊枪姿态模型，由运动学逆解求出机械臂关节量，再把求得的变量带入运动学求正解，进行轨迹与姿态仿真.仿真结果如图8 所示，焊枪的运动轨迹与焊缝的特征完全重合，焊枪运动姿态也始终位于焊点两切面的夹角平分线上，验证了传感器所建立的数学模型正确性.

图8 ABB 机器人仿真系统Fig.8 ABB robot simulation system

4 结论

(1) 设计了适用于筒体内壁的管-管、管-板、管-球和管-锥等管道插接焊缝任务的焊缝位置识别传感器，该传感器能识别管道插接焊缝的空间位置，具有很强的实用性，为管道插接焊接任务的智能化提供支持.

(2) 提出了基于此传感器的针对筒体内壁管-管插接焊接任务的焊缝位置计算方法，并给出了焊缝特征矩阵与焊枪姿态矩阵，利用MATLAB 软件对该方法获得的管管插接焊缝空间位置数学模型进行仿真验证，标定坐标点与采样坐标点在x轴和y轴方向的误差最大值仅为0.12 mm，在z轴方向上最大的焊缝偏差为0.25 mm，其精度满足实际焊接精度要求，表明了该方法的有效性和准确性.