一种焊接机器人焊枪姿态智能调控系统的制作方法

摘要: 本发明涉及机器人电弧焊接控制领域,具体为一种焊接机器人焊枪姿态智能调控系统。背景技术:1、机器人电弧焊中,线激光轮廓传感器常安装于焊枪前方,采集焊缝轮廓并提取焊...
一种焊接机器人焊枪姿态智能调控系统的制作方法

本发明涉及机器人电弧焊接控制领域,具体为一种焊接机器人焊枪姿态智能调控系统。

背景技术:

1、机器人电弧焊中,线激光轮廓传感器常安装于焊枪前方,采集焊缝轮廓并提取焊缝中心、坡口边缘等特征,再结合机器人实际位姿调整焊枪位置及姿态。常见做法是示教轨迹并固定焊枪工作角与行进角,焊接过程中以位置纠偏为主。部分激光跟踪系统按固定采样帧数、固定延迟时间或空间最近邻关系调用前视检测数据,并将其用于轨迹修正。

2、按固定帧数或固定时延调用时,行进速度变化后,同一时延对应的焊缝区段会发生偏移;按空间最近邻匹配时,空间邻近的不同焊缝段会发生数据串用。检测截面与焊枪工具中心点未建立沿同一活动焊缝分支的弧长对应关系时,前视检测数据难以按焊缝弧长位置调用。

3、焊枪姿态变化会改变扫描平面与焊缝的交线位置,从而使后续激光落点对应的焊缝区段发生变化。现有方法通常在获得新轮廓后直接用于位置或姿态修正,缺少对候选姿态扫描覆盖区段的预估,也缺少姿态切换前后对同一焊缝区段的重复观测与一致性比较。检测数据未经同址复核即参与更新时,位置修正与姿态修正的数据来源容易混淆。

4、目标位姿序列提交至机器人控制器后进入执行缓冲。远端依据新检测结果重算时,若未区分已提交区段与可更新区段,近端已提交轨迹会被改写。位置检测有效而姿态检测不足时,现有方法缺少分别约束近端提交范围的机制。

技术实现思路

1、针对现有技术的不足,本发明提供了一种焊接机器人焊枪姿态智能调控系统,解决了现有技术难以在焊枪姿态变化引起扫描落点变化时,按焊缝弧长位置组织检测数据、经同址复核后再分级更新,并在不改写已提交近端轨迹的条件下完成提交的问题。

2、为实现以上目的,本发明通过以下技术方案予以实现:

3、本发明提供一种焊接机器人焊枪姿态智能调控系统,包括标定建轨模块、同步感知模块、姿态规划模块和复核提交模块。

4、具体地,标定建轨模块,其用于由示教或标定作业取得标定结果,建立当前有效引导曲线与活动分支,得到初始目标位姿序列并向机器人控制器提交,得到起弧允许并启动焊接运动;

5、同步感知模块,其用于依据当前有效引导曲线与活动分支形成检测记录,得到测点弧长地址与焊枪弧长地址,由测点弧长地址和焊枪弧长地址得到预视量,按预视量将检测记录写入预视缓存;

6、姿态规划模块,其用于划分近端冻结段、近端准入段与远端更新段,依据预视缓存在远端更新段生成候选焊枪姿态,按扫描式对候选焊枪姿态计算预测扫描地址区间,建立预测重叠观测区间与重叠观测约束,求取姿态区段;

7、复核提交模块,其用于取得预测重叠观测区间对应的实际重叠观测区间,按复核式得到跨姿态同址复核结果并分配更新权限和更新权限等级,按覆盖式建立位置覆盖边界与姿态覆盖边界,以将姿态区段写入近端准入段形成目标位姿序列,并发送至机器人控制器后形成已提交轨迹,按焊枪弧长地址从已提交轨迹中确定目标位姿,发送至机器人控制器以控制焊枪运动。

8、优选的,标定建轨模块包括:

9、标定配置单元,其用于由示教或标定作业完成标定并得到标定结果;

10、分支建轨单元,其用于获取工件cad,生成引导轨迹,建立分支拓扑,由分支拓扑确定活动分支,将引导曲线设为当前有效引导曲线;

11、起弧复核单元,其用于取得参考扫描数据和验证扫描数据并确定共同扫描区段,对共同扫描区段形成初始跨姿态同址复核结果,以初始化位置覆盖边界与姿态覆盖边界;

12、当位置覆盖边界和姿态覆盖边界均连续覆盖至预设的起始覆盖长度时,形成初始目标位姿序列;

13、当初始目标位姿序列向机器人控制器提交成功且近端冻结段非空时,得到起弧允许。

14、优选的,同步感知模块包括:

15、同步采集单元,其用于依据标定结果形成同步轮廓;

16、特征提取单元,其用于在建轨预扫描阶段从同步轮廓提取焊缝中心作为检测点,自寻址复核预扫描阶段起提取焊缝中心、局部焊缝切线和左右母材法向量并写入检测记录。

17、进一步的,同步感知模块还包括弧长寻址单元;

18、弧长寻址单元用于按弧址式在当前有效引导曲线上计算弧长地址,将检测点投影得到测点弧长地址,将焊枪工具中心点投影得到焊枪弧长地址,由测点弧长地址和焊枪弧长地址得到预视量;

19、当预视量属于由预设的预视量下界和预设的预视量上界组成的闭区间时,将检测记录写入预视缓存。

20、优选的,姿态规划模块包括冻结划分单元;

21、冻结划分单元用于将预设的采集时延、预设的处理时延、预设的通信时延和预设的执行时延相加得到总执行时延,按冻结式由机器人控制器确认的预测行进速度、总执行时延和预设的冻结余量计算冻结长度,并由焊枪弧长地址与冻结长度之和得到冻结边界;

22、弧长地址不大于冻结边界且已提交的部分构成近端冻结段,已通过预设的冻结准入条件但尚未发送的部分构成近端准入段,弧长地址大于冻结边界且不大于预设的远端规划窗口上端的部分构成远端更新段。

23、进一步的,姿态规划模块还包括姿态生成单元;

24、姿态生成单元用于将远端更新段划分为规划区段,依据预视缓存生成候选焊枪姿态,按扫描式对候选焊枪姿态计算连续扫描观测带和预测扫描地址区间;

25、当相邻规划区段的预测扫描地址区间存在非空交集时形成预测重叠观测区间;

26、当预测重叠观测区间非空且预测重叠观测区间下端大于焊枪弧长地址时,建立重叠观测约束并求取姿态区段。

27、优选的,复核提交模块包括提交获取单元;

28、提交获取单元用于将目标位姿序列或初始目标位姿序列发送至机器人控制器,提交成功后将近端准入段变更为近端冻结段并形成已提交轨迹;

29、还用于划分切换前检测数据、切换中检测数据和切换后检测数据并得到切换前地址区间、切换中地址区间和切换后地址区间;

30、当切换中地址区间非空且与切换前地址区间、切换后地址区间的相邻端点间隔均不大于预设的最大允许采样间隔时,由切换前地址区间与切换后地址区间的非空交集得到实际重叠观测区间。

31、进一步的,复核提交模块还包括同址复核单元;

32、同址复核单元用于在实际重叠观测区间按复核式计算中心复核残差、切线复核残差、左法向残差和右法向残差,并与对应的复核判定阈值比较;

33、当姿态复核通过时赋予联合更新权限且更新权限等级为2;

34、当仅位置复核通过且不存在表面复核冲突时赋予仅位置更新权限且更新权限等级为1;

35、当位置复核不通过时,或者当存在表面复核冲突时,赋予禁止更新权限且更新权限等级为0;

36、将更新权限与更新权限等级写回切换后检测数据,形成跨姿态同址复核结果。

37、进一步的,复核提交模块还包括覆盖提交单元;

38、覆盖提交单元用于获取形成位置实际覆盖区间和姿态实际覆盖区间,按覆盖式建立位置覆盖边界和姿态覆盖边界;

39、当姿态区段的区段上端地址不大于位置覆盖边界和姿态覆盖边界中的较小者,且满足预设的冻结准入条件时,将姿态区段写入近端准入段形成目标位姿序列。

40、进一步的,覆盖提交单元还用于:

41、依据更新权限区分联合更新数据、位置更新数据和禁止更新数据;

42、联合更新数据更新焊缝中心、局部焊缝切线、左右母材法向量、工作角和行进角,位置更新数据仅更新焊缝中心及候选工具中心点位置,禁止更新数据不参与更新,再由焊枪弧长地址形成目标弧长地址,按目标弧长地址从已提交轨迹确定目标位姿,并发送至机器人控制器。

43、本发明提供了一种焊接机器人焊枪姿态智能调控系统。具备以下有益效果:

44、1、本发明在活动分支的当前有效引导曲线上按弧址式计算弧长地址,由测点弧长地址与焊枪弧长地址得到预视量,并按预视量将检测记录写入预视缓存,使前视检测数据按焊缝弧长位置调用,而不依赖固定采样时延或空间最近邻关系。

45、2、本发明按扫描式计算候选焊枪姿态对应的连续扫描观测带与预测扫描地址区间,并建立重叠观测约束,姿态切换后在实际重叠观测区间按复核式完成跨姿态同址复核并分配更新权限,使检测数据经同址复核后再用于位置或姿态更新。

46、3、本发明按冻结式划分近端冻结段、近端准入段与远端更新段,按覆盖式建立位置覆盖边界与姿态覆盖边界,姿态区段仅在满足双边界与冻结准入条件时写入近端准入段并提交形成已提交轨迹,使远端重算不改写近端已提交内容。