基于3D纯视觉与点云实时跟随的板类件免示教切割方法与流程

摘要: 本发明涉及工业机器人视觉引导和板类件自动切割领域,尤其涉及基于3d纯视觉与点云实时跟随的板类件免示教切割方法。背景技术:1、板类件切割下料是装备制造过程中的重要...
基于3D纯视觉与点云实时跟随的板类件免示教切割方法与流程

本发明涉及工业机器人视觉引导和板类件自动切割领域,尤其涉及基于3d纯视觉与点云实时跟随的板类件免示教切割方法。

背景技术:

1、板类件切割下料是装备制造过程中的重要工序;传统方式多采用人工示教或离线编程:操作人员根据工件型号和现场摆放位置对机器人进行示教,或依赖cad模型生成切割程序;然而,人工示教停机时间长、效率低、对操作经验依赖强;离线编程需要精确的工件模型和现场标定,当工件型号更换、来料位姿变化或夹具状态改变时,程序难以直接复用;因此,免示教、柔性化切割成为板类件加工的重要需求。

2、现有板类件机器人切割通常预先为每个型号建立固定程序,由操作者选择cad模板并进行轨迹示教;部分系统利用固定3d相机完成一次定位,或者使用物理校准板、线激光对工件进行校准和沿边寻迹;即使采用一次点云与cad模型配准,通常也只得到扫描时刻的整体位姿,不能直接说明抓取后的实际夹持关系、释放后的最终落台位姿和切割时的局部表面状态。

3、现有方法仍存在以下问题:第一,归一化轮廓相似并不等于绝对尺寸一致,重复孔或对称轮廓还可能产生型号或方向歧义;第二,空中扫描所得工件位姿包含正常机器人搬运,若不解算实际工件—夹具关系,无法区分夹持偏差,且工件释放后仍可能相对预测落台位姿发生变化;第三,切割路径可能包含多个不连续内外轮廓、引入引出和弧开关,单曲线表达不足以保证完整工艺顺序;第四,局部点云可能混入侧壁、夹具、烟尘或已切割废料,且采集、处理和控制时延会转化为跟随误差;第五,仅校验发送前条件而不读取实际tcp、完成位和弧状态,不能证明路径点已经执行;第六,重采时若没有停弧、抬刀、烟尘等待和重新切入动作,流程虽有算法跳转但不具备加工安全闭环。

技术实现思路

1、本发明提供一种基于3d纯视觉与点云实时跟随的板类件免示教切割方法,以克服型号与方向识别存在歧义、工件—夹具关系与落台位姿难以准确解算、复杂切割路径的工艺顺序表达不足、点云污染与时延导致跟随误差、执行反馈与闭环验证缺失以及重采流程缺乏加工安全闭环问题。

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

3、一种基于3d纯视觉与点云实时跟随的板类件免示教切割方法,其特征在于,包括:

4、s1、获取相机的坐标、搬运机器人的坐标、夹具坐标和切割机器人的坐标,并建立坐标变换关系;获取板类件型号、板类件几何特征和板类件切割工艺数据,并构建板类件多轮廓数据化工艺数据库;

5、s2、通过相机采集抓取前的全局点云;根据抓取前的全局点云,通过坐标变换关系进行转换,得到坐标统一的全局点云;根据坐标统一的全局点云,依次通过近邻统计滤波、降采样和支撑面先验约束,得到候选板类件的点云数据;

6、s3、根据候选板类件的点云数据,得到轮廓、尺寸与有向特征;根据轮廓和尺寸,通过板类件多轮廓数据化工艺数据库,得到候选板类件的型号;根据候选板类件的型号和有向特征,通过板类件多轮廓数据化工艺数据库,得到板类件的方向;根据板类件的方向,得到抓取前的位姿;

7、s4、根据候选板类件的型号、板类件的方向和抓取前的位姿,通过板类件多轮廓数据化工艺数据库,得到有序切割路径、抓取位姿和抓取方案;

8、s5、根据抓取方案,控制搬运机器人对板类件进行抓取,并通过搬运机器人的控制器反馈,得到搬运机器人的末端位姿;根据抓取前的位姿和当前抓取位姿,计算并得到名义板类件-夹具关系;根据搬运机器人的末端位姿和名义板类件-夹具关系,计算并得到空中预测板类件位姿;根据空中预测板类件位姿,通过对板类件多轮廓数据化工艺数据库进行扫描,获取实测基准表面点集;根据实测基准表面点集和空中预测板类件位姿,计算实际板类件-夹具关系;根据实际板类件-夹具关系,计算并得到板类件的预测落台位姿;

9、s6、通过相机采集抓取后的板类件落台点云,通过坐标变换关系进行转换,得到坐标统一的落台点云;根据坐标统一的落台点云,通过刚性求解,得到放置后的刚性修正;根据板类件的预测落台位姿和放置后的刚性修正,得到板类件的最终落台位姿;

10、s7、根据板类件的最终落台位姿和有序切割路径,通过局部表面点筛选和高斯加权平面拟合,得到板类件的局部表面数据;根据板类件的局部表面数据,构造坡口tcp姿态;根据坡口tcp姿态,通过满足时间参数化的速度、加速度与关节约束,得到tcp位姿序列和执行时间;

11、s8、通过tcp位姿序列进行预发送门控,以控制切割机器人执行切割操作。

12、有益效果:本发明通过基于3d纯视觉与点云实时跟随实现板类件免示教切割,无需人工示教和专用工装,能够自动完成板类件识别、抓取、落台与切割,换型灵活、通用性强,显著降低对人工经验的依赖;

13、通过坐标变换、近邻统计滤波、降采样和支撑面先验约束,获得坐标统一且质量更高的候选板类件点云,提高复杂背景、堆叠或遮挡场景下的点云处理鲁棒性和识别准确性;

14、通过构建板类件多轮廓数据化工艺数据库,自动匹配板类件型号、方向、抓取前位姿、有序切割路径、抓取位姿和抓取方案,实现工艺知识复用和抓取—搬运—落台—切割一体化协同;

15、通过搬运机器人末端位姿反馈、名义/实际板类件-夹具关系、空中预测板类件位姿以及落台点云刚性修正,形成闭环定位与误差补偿,有效降低搬运和落台过程中的累积误差,提高最终落台位姿精度和一致性;

16、通过局部表面点筛选和高斯加权平面拟合构造坡口tcp姿态,使切割轨迹更好适应板类件实际局部表面,提高坡口切割精度和切割质量。

1.一种基于3d纯视觉与点云实时跟随的板类件免示教切割方法,其特征在于,包括:

2.根据权利要求1所述的一种基于3d纯视觉与点云实时跟随的板类件免示教切割方法,其特征在于,根据轮廓和尺寸,通过板类件多轮廓数据化工艺数据库,得到候选板类件的型号的具体步骤如下:

3.根据权利要求2所述的一种基于3d纯视觉与点云实时跟随的板类件免示教切割方法,其特征在于,所述抓取前的位姿的表达式为:

4.根据权利要求2所述的一种基于3d纯视觉与点云实时跟随的板类件免示教切割方法,其特征在于,所述步骤s4的具体步骤如下:

5.根据权利要求4所述的一种基于3d纯视觉与点云实时跟随的板类件免示教切割方法,其特征在于,所述步骤s5的具体步骤如下:

6.根据权利要求5所述的一种基于3d纯视觉与点云实时跟随的板类件免示教切割方法,其特征在于,所述板类件的最终落台位姿的表达式为:

7.根据权利要求1所述的一种基于3d纯视觉与点云实时跟随的板类件免示教切割方法,其特征在于,所述板类件的局部表面数据包括实际法向、投影表面点和有符号法向残差;

8.根据权利要求7所述的一种基于3d纯视觉与点云实时跟随的板类件免示教切割方法,其特征在于,根据板类件的局部表面数据,构造坡口tcp姿态的具体步骤如下: