基于法向校正的机器人涂胶轨迹生成方法及系统

摘要: 本发明属于机器视觉引导控制,具体涉及一种基于法向校正的机器人涂胶轨迹生成方法及系统。背景技术:1、在航空航天制造领域,胶接与密封工艺是保障结构强度、气密性与环境...
基于法向校正的机器人涂胶轨迹生成方法及系统

本发明属于机器视觉引导控制,具体涉及一种基于法向校正的机器人涂胶轨迹生成方法及系统。

背景技术:

1、在航空航天制造领域,胶接与密封工艺是保障结构强度、气密性与环境适应性的关键制造环节之一。以飞机机身蒙皮、翼盒结构、发动机短舱、复合材料构件及其连接界面为代表的大量关键部位,均依赖高一致性、高可靠性的胶粘剂或密封胶涂覆工艺来实现结构增强、防腐蚀、防泄漏及振动抑制等功能。上述部位通常具有曲率变化大、空间形态复杂、装配精度要求高等特点,对涂胶路径的空间精度、工具姿态稳定性以及胶线一致性提出了极高要求。

2、在航空制造早期,胶接作业长期依赖人工完成,尽管人工操作在灵活性方面具有一定的优势,但其一致性差、劳动强度大,难以满足现代航空制造对质量可重复性与过程可追溯性的要求。随着航空工业自动化水平的提升,机器人涂胶系统逐步被引入航空结构装配与密封工序中,用于替代人工完成长距离、重复性强且精度要求高的涂胶任务。然而,航空制造场景中的工件尺寸大、装夹误差累积明显,实际胶缝位置往往与理论设计模型存在偏差,单纯依赖离线编程或人工示教再现方式生成的机器人涂胶轨迹,难以准确匹配真实胶缝的空间几何形态。尤其在曲面过渡区域、结构拼接缝及局部非理想装配区域,示教轨迹与实际胶缝之间的偏差容易导致胶线偏移、胶量不均或局部漏涂,影响产品质量和服役可靠性。

3、为解决上述问题,航空制造领域逐步引入基于视觉感知的涂胶辅助技术,如利用激光、结构光或视觉相机对胶缝进行检测,并对机器人轨迹进行在线或离线修正。其中,线结构光传感器因对边缘轮廓测量精度高、对环境光变化不敏感等优点,在航空结构胶缝检测与引导中得到了较多应用。但现有多数视觉引导涂胶方法仍主要集中于胶缝位置的检测或离散修正,对胶缝局部空间朝向变化缺乏系统建模,难以在姿态层面对涂胶工具进行连续约束。

4、与此同时,在机器人-视觉融合系统中,传感器坐标系与机器人运动坐标系之间的空间关系标定误差会在长距离轨迹中被逐步放大,进而影响整体涂胶精度。缺乏高精度、稳定的手眼标定机制,传感器采集到的胶缝几何信息便难以可靠映射至机器人基底坐标系,制约了视觉感知在实际涂胶执行中的应用效果。随着航空领域相关技术逐步向汽车制造、轨道交通、工程机械及大型装备制造等工业场景推广,上述问题同样普遍存在于通用工业涂胶作业中,尤其在复杂工件、小批量多品种生产以及对胶线质量一致性要求较高的场景下,传统依赖示教再现的涂胶方式已难以满足实际生产需求。

技术实现思路

1、本发明的目的在于针对上述现有技术中的问题,提供一种基于法向校正的机器人涂胶轨迹生成方法及系统,能够有效补偿工件装夹误差与制造偏差,显著提高复杂曲面及不规则胶缝涂胶作业的精度、一致性与稳定性。

2、为了实现上述目的,本发明有如下的技术方案:

3、第一方面,提供一种基于法向校正的机器人涂胶轨迹生成方法,包括:

4、建立线结构光传感器坐标系与机器人末端坐标系之间的手眼变换矩阵;

5、控制机器人根据预设路径执行空扫运动,使线结构光传感器在机器人运动过程中连续采集工件表面轮廓数据,并实时读取机器人末端位姿和状态变量;所述状态变量包括有效采集触发信号、胶缝编号信号和法向取点阶段信号;当有效采集触发信号达到预设采集触发值时,将当前线结构光轮廓数据与机器人末端位姿和状态变量绑定存储;

6、根据绑定存储的线结构光轮廓数据识别胶缝特征点,利用手眼变换矩阵和对应的机器人末端位姿将胶缝特征点转换至机器人基底坐标系,按照胶缝编号信号分别生成各胶缝的机器人涂胶路径点;

7、根据法向取点阶段信号,在对应的线结构光轮廓帧中提取位于胶缝前方工件表面区域内的三个非共线有效点,将三个非共线有效点分别转换至机器人基底坐标系,根据转换后的三个点构造局部平面并计算对应局部平面的法向量;

8、根据法向量和胶缝路径点的切向量构造机器人末端工具的目标姿态矩阵,将目标姿态矩阵转换为机器人可识别的姿态角,与对应胶缝路径点的位置坐标共同形成机器人涂胶轨迹点。

9、作为一种优选的方案,所述状态变量为机器人控制系统的pos_act状态数组,所述pos_act状态数组中:

10、pos_act[0]作为所述有效采集触发信号,用于判断当前线结构光轮廓帧是否需要与机器人末端位姿绑定并参与后续轨迹生成;

11、pos_act[7]作为所述胶缝编号信号,用于标识当前有效采集数据所属的胶缝序号;

12、pos_act[8]作为所述法向取点阶段信号,用于标识当前有效采集帧是否用于局部平面参考点采集,以及所述有效采集帧在三点法向计算过程中的取点角色。

13、作为一种优选的方案,所述将当前线结构光轮廓数据与机器人末端位姿和状态变量绑定存储的步骤中,数据单元表示为:

14、

15、式中,表示第

k个有效采集数据单元,表示第

k帧线结构光轮廓数据,表示采集第

k帧线结构光轮廓数据时机器人末端位姿;

16、表示与第

k帧线结构光轮廓数据对应的状态变量信息,表示为:

17、

18、式中,表示有效采集触发状态,表示胶缝编号状态,表示法向取点阶段状态。

19、作为一种优选的方案,所述根据法向取点阶段信号,在对应的线结构光轮廓帧中提取位于胶缝前方工件表面区域内的三个非共线有效点包括:当法向取点阶段信号为第一预设值时,在当前线结构光轮廓帧中提取位于胶缝前方工件表面区域内的两个有效点,且提取的两个有效点在当前轮廓点序列中的索引间隔为预设间隔值;当所述法向取点阶段信号为第二预设值时,在当前线结构光轮廓帧中提取位于胶缝前方工件表面区域内的一个有效点;由所提取的两个有效点和一个有效点共同构造所述三个非共线有效点。

20、作为一种优选的方案,将三个非共线有效点分别转换至机器人基底坐标系的转换关系式如下:

21、

22、其中,表示线结构光传感器坐标系下的点,表示由手眼标定获得的传感器坐标系到机器人末端坐标系的变换矩阵,表示机器人末端坐标系到机器人基坐标系的实时位姿变换矩阵,表示转换后的机器人基坐标系下的空间点。

23、作为一种优选的方案,根据转换后的三个点构造局部平面并计算对应局部平面的法向量时,根据三个非共线有效点构造两个方向向量,由两个方向向量的叉乘获得所述局部平面的法向量,并对所述法向量进行归一化处理;当所述两个方向向量叉乘的模长小于设定阈值时,舍弃本次法向量计算结果。

24、作为一种优选的方案,根据转换后的三个点构造局部平面并计算对应局部平面的法向量时,将当前法向量与上一有效法向量进行点乘判别,当点乘结果小于0时,将当前法向取反以保证连续轨迹中的法向方向一致。

25、作为一种优选的方案,根据法向量和胶缝路径点的切向量构造机器人末端工具的目标姿态矩阵时,使机器人末端工具的工具轴方向与局部平面的法向量建立约束关系,根据相邻胶缝路径点计算路径切向量,根据法向量和切向量构造第三个正交方向,并对三个方向进行正交化修正,得到目标姿态矩阵。

26、作为一种优选的方案,所述基于法向校正的机器人涂胶轨迹生成方法还包括计算当前目标姿态与上一有效目标姿态之间的角度差,当所述角度差超过设定阈值时,以插值姿态或平滑后的姿态替代当前姿态,并对连续轨迹段的姿态序列进行平滑处理。

27、第二方面,提供一种基于法向校正的机器人涂胶轨迹生成系统,包括:

28、手眼标定模块,用于建立线结构光传感器坐标系与机器人末端坐标系之间的手眼变换矩阵;

29、空扫采集模块,用于控制机器人根据预设路径执行空扫运动,使线结构光传感器在机器人运动过程中连续采集工件表面轮廓数据,并实时读取机器人末端位姿和状态变量;所述状态变量包括有效采集触发信号、胶缝编号信号和法向取点阶段信号;当有效采集触发信号达到预设采集触发值时,将当前线结构光轮廓数据与机器人末端位姿和状态变量绑定存储;

30、胶缝路径生成模块,用于根据绑定存储的线结构光轮廓数据识别胶缝特征点,利用手眼变换矩阵和对应的机器人末端位姿将胶缝特征点转换至机器人基底坐标系,按照胶缝编号信号分别生成各胶缝的机器人涂胶路径点;

31、法向估计模块,用于根据法向取点阶段信号,在对应的线结构光轮廓帧中提取位于胶缝前方工件表面区域内的三个非共线有效点,将三个非共线有效点分别转换至机器人基底坐标系,根据转换后的三个点构造局部平面并计算对应局部平面的法向量;

32、姿态生成模块,用于根据法向量和胶缝路径点的切向量构造机器人末端工具的目标姿态矩阵,将目标姿态矩阵转换为机器人可识别的姿态角,与对应胶缝路径点的位置坐标共同形成机器人涂胶轨迹点。

33、相较于现有技术,本发明的第一方面至少具有如下的有益效果:

34、通过建立线结构光传感器坐标系与机器人末端坐标系之间的手眼变换矩阵,为视觉感知数据向机器人运动坐标系的可靠映射提供了统一的坐标变换基础;通过控制机器人根据预设路径执行空扫运动,使线结构光传感器在机器人运动过程中连续采集工件表面轮廓数据,并实时读取机器人末端位姿和状态变量,状态变量包括有效采集触发信号、胶缝编号信号和法向取点阶段信号,将当前线结构光轮廓数据与机器人末端位姿和状态变量绑定存储,实现由实际工艺步骤触发,建立视觉数据、机器人运动数据和工艺状态数据之间的确定性对应关系;在此基础上,根据胶缝编号信号分别生成各胶缝的机器人涂胶路径点,根据法向取点阶段信号提取胶缝前方工件表面的三个非共线点计算局部平面的法向量,并将法向量和路径切向量引入姿态生成,形成同时包含位置坐标和姿态角的机器人涂胶轨迹点。由此,抑制传感器坐标系与机器人运动坐标系之间的标定误差在长距离轨迹中的累积放大效应,降低因系统间周期差异或通信延迟造成的数据错配风险,使机器人涂胶轨迹同时满足位置跟踪精度、姿态适应性和工艺稳定性要求,显著提高复杂曲面及不规则胶缝涂胶作业的精度、一致性与稳定性。

35、进一步的,状态变量为机器人控制系统的pos_act状态数组,pos_act[0]、pos_act[7]、pos_act[8]分别作为有效采集触发信号、胶缝编号信号和法向取点阶段信号,可使原本独立的机器人运动、视觉采集和工艺步骤组织为同一套时序控制逻辑,pos_act[8]还进一步标识当前有效采集帧在三点法向计算过程中的取点角色,增强了法向估计过程的可控性和可追溯性。

36、进一步的,绑定存储的数据单元包含线结构光轮廓数据、机器人末端位姿和状态变量信息,并将状态变量分解为有效采集触发状态、胶缝编号状态和法向取点阶段状态,使每一帧有效采集数据均包含完整的视觉信息、空间位姿信息和工艺语义信息,为后续胶缝路径生成和法向估计提供了结构化、可追溯的数据基础,增强了数据关联的确定性和处理效率。

37、进一步的,通过法向取点阶段信号区分第一预设值和第二预设值,分别触发在当前轮廓帧中提取两个有效点或一个有效点,由两个不同触发阶段获取的点共同构造三个非共线有效点,使三点中的两点取自同一轮廓帧且保持足够间距,另一点取自不同触发阶段,能够更加稳定地表征胶缝附近工件表面的局部空间姿态,同时避免三点因采集时刻过近而趋于共线,提高了法向估计的可靠性。通过将两个有效点在当前轮廓点序列中的索引间隔设置为预设间隔值,确保两个点之间具有足够的空间分布距离,避免因两点距离过近导致构造的方向向量长度过小,进而影响法向量计算精度,提高了局部平面拟合的数值稳定性。

38、进一步的,通过将三个有效点由线结构光传感器坐标系经手眼变换矩阵和机器人实时末端位姿变换矩阵转换至机器人基坐标系,建立了从传感器局部测量到机器人全局坐标的统一映射链路,使视觉感知数据能够精确映射至机器人执行空间,为后续平面构造和法向量计算提供了空间基准一致的坐标数据。

39、进一步的,通过由三个非共线有效点构造两个方向向量并采用叉乘方式获取局部平面法向量,并在两个方向向量叉乘的模长小于设定阈值时舍弃本次法向量计算结果,可有效避免因三点近似共线导致法向量计算失真的问题,确保参与姿态生成的法向量均来自稳定、可靠的局部平面构造,提高了法向估计的鲁棒性。

40、进一步的,通过将当前法向量与上一有效法向量进行点乘判别,并在点乘结果小于0时将当前法向量反向,以能够保证连续轨迹中的法向方向一致,避免机器人末端姿态因法向符号翻转而发生突变,保证了涂胶过程中姿态的连续性和稳定性。

41、进一步的,通过使机器人末端工具的工具轴方向与局部平面的法向量建立约束关系,并结合胶缝路径切向量构造第三个正交方向,之后对三个方向进行正交化修正,能够得到精确正交的目标姿态矩阵,使机器人末端姿态既满足胶枪与工件表面的角度工艺要求,又保持与胶缝走向的一致性,实现位置跟踪与姿态适应的协同控制。

42、进一步的,通过在姿态生成过程中引入姿态优化步骤,计算当前目标姿态与上一有效目标姿态之间的角度差,当角度差超过设定阈值时以插值姿态或平滑后的姿态替代当前姿态,并对连续轨迹段的姿态序列进行平滑处理,可有效抑制因局部法向突变或测量噪声引起的姿态抖动,使机器人末端在涂胶过程中保持平稳运行,进一步提高胶线的一致性和表面质量。