[发明专利]多排列框架结构焊件的快速寻位方法

权利要求书

1.一种多排列框架结构焊件的快速寻位方法，其特征在于，包括如下步骤：以框架的两条边建立工件坐标系，设定各个工件所在方框的初始长宽及排列间距；选取框架结构的底框四边作为寻位对象，一个方框需要寻找8个位置，采取从零到整的方法，完成一个方框的寻位和焊接后再对下一个方框进行寻位和焊接，每一个方框的偏移误差自动累积到下一个方框的寻位中，消除累积误差和变形影响；对于方框上下两条边错开时，单独增加一次寻位，满足对异形框的寻位要求；框架结构焊件为带有斜坡的方框结构，其寻位方法包括如下步骤：

方框的两条边建立工件坐标系，选取底框四条边作为寻位对象，分别在四个顶点附近设置两个寻位点，当上下边错开时，在上侧也设置一个寻位点；

确定激光寻位的初始偏差值，首先操作机器人末端移动，令焊丝尖端对准焊缝，然后沿工件坐标系Z向远离指定高度，工件坐标系的Z向与焊枪平行，使激光线垂直照射在焊缝上，记录此时寻位的偏差值；

确定寻位位置和姿态，按照预先规划好的8个点的位置，机器人末端远离同样的指定高度，并使激光线垂直照射焊缝；

调用激光寻位指令，分别对这9个位置点进行寻位，新的寻位结果与初始偏差值自动求差，可以得到9个偏移数组；

由于方框的底边理论上再同一个平面上，因此，底框8个点寻位的Z向偏差理论上应当相同，假定Z向8个点的寻位值分别为Hi，i=0~7，对这组数进行分析，首先计算每一个变量的权重系数：

其中: ，，

a=，b=，c=，d=，

指定偏差阈值大小，当某个数据的权重Ri超过指定值后，报警提示，清理表面后对该点重新进行寻位计算；

通过四个顶点决定方框的偏移值，分别得到顶点1和2偏移值，顶点5和6的偏移值，顶点7的偏移值，顶点3的偏移值，顶点8的偏移值，顶点4的偏移值；

第一个框寻位完成后调用焊接程序。

2.根据权利要求1所述多排列框架结构焊件的快速寻位方法，其特征在于: 偏移数组及各个顶点偏移值具体获得方法如下：

1）对顶点2进行初步定位，用接触寻位对X向进行粗略定位，操作机器人末端移动到寻位起点M1处，调整机器人的姿态，保证移动时不会碰到跟踪器，且焊丝优先接触到零件竖直面，调用接触寻位指令，使机器人末端朝M2点已指定速度运动，机器人越过M2点一直接触到M3点后快速返回至M1点，记录M2与M3的差值到指定数组A1(dx0,0,0)中；

2）转动机器人末端的姿态，对顶点2的第二个面进行寻位，首先加上数组A1的偏移后令机器人移动，用接触寻位对Y向进行粗略定位，采用同上一步相同的寻位方法，得到偏差数组A2(0, dy0,0)；

3）将数组A1与A2相加，得到顶点2的初步偏移值(dx0, dy0,0)；

4）调用平移指令，使机器人末端平移初步偏移值(dx0, dy0,0)，并且移动到指定位置M1点，调整机器人末端姿态，令激光线垂直照射在焊缝上，调用激光寻位指令，开启激光跟踪功能，新的寻位结果与初始偏差值自动求差，读取该点与初始点的偏差到数组A1中，得到焊缝起点在Y、Z两个方向的偏移值A1(dx1,0,dz1)；

5）转动机器人末端，在第二个寻位点寻位，采用相同的激光寻位方法，得到第二个点的偏移数组A2(0, dy2,dz2)；

6）将数组A1数组A2进行求和，并加上接触寻位得到偏移数组，得到新的偏移数组A11(dx1+ dx0，dy2+ dy0，(dz1+ dz2)/2.0)，此偏移数组则为顶点1和2的精确偏移值；

7）调用平移指令，使末端平移数组A11，调用接触寻位指令，对方框的长度a进行长度寻位，得到长度方向的变化数组(dLx,0,0)；

8）再次调用平移指令，加上长度方向的偏移数组(dLx,0,0)，对顶点6两个方向采用激光跟踪寻位，得到偏移数组A3(0, dy3,dz3)，A4(dx4, 0,dz4)，累积相加得到顶点5和6的精确偏移数组A12(dx4+ dx1+dx0+dLx，dy3+dy2+dy0，(dz3+ dz4)/2.0+(dz1+ dz2)/2.0)；

9）调用平移指令，使末端平移数组A12，调用接触寻位指令，对方框的宽度b进行宽度寻位，得到宽度方向的变化数组(0,dLy, 0)；

10）再次调用平移指令，加上宽度方向的变化数组(0,dLy,0)，对顶点7两个方向采用激光跟踪寻位，得到偏移数组A5(dx5, 0,dz5), A6(0, dy6,dz6)，累积相加得到顶点7的精确偏移数组A13(dx4+dx1+dx0+dx5+dLx，dy3+dy2+dy0+dy6+dLy，(dz3+ dz4)/2.0+(dz1+dz2)/2.0+(dz5+ dz6)/2.0)；

11）当方框为斜板时，对上侧的边单独采用激光寻位，得到寻位数组A9(dx9, 0,dz9)，则顶点8的偏移值为A15 (dx4+dx1+dx0+dx5+dLx，dy3+dy2+dy0+dy9+dLy， (dz3+ dz4)/2.0+(dz1+ dz2)/2.0+dz9)；

12）选择偏移数组A11，并加上宽度方向的变化数组(0,dLy, 0)，调用平移指令，对顶点3进行激光寻位，得到两个方向的偏移数组A7(0, dy7,dz7)，A8(dx8, 0,dz8)，加上偏移数组，得到顶点3的偏移数组A14(dx1+dx0+dx8，dy2+dy0+dy7+dLy，(dz1+dz2)/2.0+(dz7+dz8)/2.0)以及顶点4的偏移数组A16(dx1+dx0+dx8，dy2+dy0+dy9+dLy，(dz1+dz2)/2.0+dz9)。