[发明专利]一种基于激光焊缝跟踪传感器的机器人焊接运动控制方法

说明书

技术领域

本发明基于激光扫描式焊缝跟踪传感器，根据机器人运动学原理，智能控制焊接机器人跟踪焊缝轨迹进行焊接。

背景技术

焊接在工业生产中占有非常重要地位。随着国家经济水平的不断提高，人们对生产中焊接质量提出了更高的要求。在现有自动焊接工艺过程中，往往是机器人通过示教方式按照固定焊缝轨迹进行焊接。该模式已无法满足工业焊接所需精度要求，并且不具备焊接未知轨迹的能力。通过焊缝检测传感器实时检测焊缝位置并跟踪、引导机器人持焊枪按照检测到的焊缝实际轨迹进行焊接，使焊枪顶点始终位于焊缝的中心位置。智能化焊接可确保焊接轨迹的准确性、焊接质量的一致性和稳定性，是实现机器人焊接大规模应用的关键技术。激光扫描式焊缝跟踪传感器的使用，是当前智能化焊接技术的发展趋势，具有高精度、高速度、强适应性等优点。

发明内容

针对现有基于示教编程模式的自动焊接工艺的不足，本发明以激光扫描式焊缝跟踪传感器获取的焊缝轨迹数据为依据，结合机器人运动学算法及基因遗传算法，提出一种基于激光扫描式焊缝跟踪传感器的机器人焊接运动控制方法，实现工业机器人智能化焊接。

本发明的技术方案的步骤如下：

(1)设定初始焊接机器人的世界坐标系、机器人末端工具坐标系、焊枪起始点、激光三角平面参数、焊接速度和运动时间。

(2)根据激光扫描式焊缝跟踪传感器的测量数据，从数据点集中搜索下一控制周期时的焊枪顶端位置点。

(3)运用遗传算法搜索焊枪的最优姿态。约束条件一：下一周期时的焊缝与激光三角平面的交点靠近激光三角平面的中心位置；约束条件二：焊枪的方向矢量与焊缝切线方向矢量所成角度在一定的范围内。

本发明的有益效果：本发明提出的焊接机器人运动控制方法具有焊接精度高、执行效率快、通用性好等特点，可以广泛用于各种空间未知直线或者曲线焊缝的焊接。

附图说明

图1激光焊缝传感器末端坐标系下的激光三角平面；

图2焊接运动与控制周期关系图；

图3激光焊缝传感器与焊缝关系图；

图4遗传算法约束条件一；

图5遗传算法约束条件二。

具体实施方式

下面结合附图和具体实施方式对本发明做进一步的描述。

(1)机器人运动算法初始参数设置

根据机器人运动学理论，设定机器人传感器世界坐标系{W}，机器人末端工具坐标系{T}。

机器人世界坐标系{W}：该坐标系O_w-X_wY_wZ_w用于对机器人、焊枪、焊缝等各个对象的位姿和坐标进行统一描述。

机器人末端坐标系{T}：焊枪顶点坐标为P_TT，焊枪方向矢量为 V_TT。如图1所示，激光三角平面顶点为P_LT，三角平面两条边界的方向矢量分别为V_1T，V_2T。并设置焊接速度为v，控制系统运动周期为 t，传感器与焊枪导前距离

(2)搜索下一周期焊枪顶点位置(X，Y，Z)

如图2所示，由于激光焊缝传感器和焊枪之间存在一定的导前距离，所以当焊接时间t＝0，即焊接的初始周期，传感器激光平面位于焊缝的起始点位置，而焊枪落后于传感器，当焊枪处于导前距离范围内并不需要焊接。此时将焊枪顶点(X₀，Y₀，Z₀)和焊缝起始点(X₁， Y₁，Z₁)拟合练成一条直线，让焊枪沿着该直线前进。焊枪总位移s＝v×t。根据直线方程比例式：

焊枪位于直线过程中，下一焊接点坐标为(X₀+d_xt,Y₀+d_yt,Z₀+d_zt)。当时，焊枪结束导前距离，进入曲线焊缝的焊接过程。此时在传感器测量得到的离散焊缝数据集中，依次计算相邻2个焊缝与激光平面交点之间的距离并进行累加。累加之和记为S_all。当时，取此时的焊缝与激光平面交点即为焊枪下一步行进点P_n(X，Y，Z)。

(3)遗传算法求解下一周期焊枪的空间姿态(Φ，θ，)

约束条件一：下一周期焊缝与激光平面的交点靠近激光三角平面中心位置。