一种3D视觉系统辅助机械手定位抓取钢铁试样的方法及系统与流程

摘要: 本发明涉及工业自动化,特别是涉及一种3d视觉系统辅助机械手定位抓取钢铁试样的方法及系统。背景技术:1、目前,工业机器人技术已广泛应用于各类实验室及工厂的自动化制...
一种3D视觉系统辅助机械手定位抓取钢铁试样的方法及系统与流程

本发明涉及工业自动化,特别是涉及一种3d视觉系统辅助机械手定位抓取钢铁试样的方法及系统。

背景技术:

1、目前,工业机器人技术已广泛应用于各类实验室及工厂的自动化制样与检测环节。例如在钢铁分析实验室中,通常采用机械手配合夹具对试样进行抓取和搬运。然而在实际工作过程中,由于试样类型多样、现场取样摆放水平参差不齐、取样器质量波动以及机器人末端长期运行产生的机械磨损等原因,导致试样的实际位姿与机械手预设的固定抓取程序存在偏差。

2、传统的“固定位置盲抓”模式无法适应这种无序或动态变化的场景,极易发生抓空、碰撞或损坏夹具等问题。此外,机械臂在高速运动后直接刚性接触表面不平整或带有毛刺的试样时,巨大的刚性冲击力不仅会损伤试样表面,还会加速机械手关节和末端夹具的磨损,降低了自动化系统的运行稳定性和使用寿命。

技术实现思路

1、本发明所要解决的技术问题是,克服现有技术的缺点,提供一种3d视觉系统辅助机械手定位抓取钢铁试样的方法及系统。

2、为了解决以上技术问题,本发明的技术方案如下:

3、一方面,本发明提供了一种3d视觉系统辅助机械手定位抓取钢铁试样的方法,该方法包括以下步骤:

4、获取多组标定数据,基于多组标定数据确定3d视觉系统与机械手之间的坐标转换矩阵,每组标定数据包括机械手处于预设位姿时的末端位姿数据以及3d视觉系统在机械手处于预设位姿时对应采集的传感器测量点坐标;

5、获取3d视觉系统实时采集的目标试样的三维位姿数据,利用坐标转换矩阵将三维位姿数据转换至机械手基坐标系,生成动态抓取目标点;

6、基于动态抓取目标点生成安全过渡点,并控制机械手移动至安全过渡点;

7、生成用于执行从安全过渡点至动态抓取目标点的直线下降运动的运动控制指令,并为运动控制指令配置软伺服控制参数集,软伺服控制参数集包括预设的直线下降速度值和预设的直线下降加速度值;

8、控制机械手根据运动控制指令执行直线下降运动,并在接触目标试样时执行抓取操作。

9、另一方面,本发明还提供了一种3d视觉系统辅助机械手定位抓取试样的系统,该系统包括:

10、3d视觉设备,用于采集标定数据以及目标试样的三维位姿数据;

11、机械手,用于执行标定移动以及抓取操作;

12、控制设备,与3d视觉设备和机械手通信连接,控制设备包括存储器和处理器,存储器存储有计算机程序,处理器执行计算机程序时实现上述的3d视觉系统辅助机械手定位抓取钢铁试样的方法。

13、本发明的有益效果是:

14、(1)本发明通过3d视觉系统实时获取目标试样的三维位姿数据,并利用高精度的坐标转换矩阵生成动态抓取目标点,打破了传统机械手“固定坐标盲抓”的局限,有效克服了因试样摆放不齐或机械磨损导致的抓空问题。

15、(2)本发明在获取标定数据时,控制机械手到达预设标定点位后静止预设时间再触发采集,建立了严格的数据时间同步机制,消除了机械臂运动抖动对传感器采集的干扰;配合非线性最小二乘算法最小化重投影误差,使得坐标转换矩阵的求解更加精准。

16、(3)本发明基于动态抓取目标点在z轴正方向上叠加安全偏移距离生成安全过渡点,引导机械手先移动至目标正上方再垂直下降,有效防止了机械臂在斜向移动过程中与周边设备或试样发生干涉碰撞。

17、(4)本发明在直线下降接触试样的阶段,为运动控制指令配置包含预设直线下降速度值和加速度值的软伺服控制参数集。该机制允许机械手在接触表面不平整或带有毛刺的试样时降低刚性冲击力,产生受力退让,从而有效保护了末端夹具和试样不受损坏。

18、(5)本发明在解析目标位姿数据包时引入了识别状态判断逻辑,若3d视觉系统受反光或遮挡影响未能识别出有效试样,系统将输出警告并等待下一次循环,杜绝了机械手的盲目下压动作,提升了整体系统的安全性和容错能力。

1.一种3d视觉系统辅助机械手定位抓取钢铁试样的方法,其特征在于,包括:

2.根据权利要求1所述的3d视觉系统辅助机械手定位抓取钢铁试样的方法,其特征在于,所述获取多组标定数据,包括:

3.根据权利要求1所述的3d视觉系统辅助机械手定位抓取钢铁试样的方法,其特征在于,所述基于所述多组标定数据确定所述3d视觉系统与所述机械手之间的坐标转换矩阵,包括:

4.根据权利要求1所述的3d视觉系统辅助机械手定位抓取钢铁试样的方法,其特征在于,所述获取所述3d视觉系统实时采集的目标试样的三维位姿数据,利用所述坐标转换矩阵将所述三维位姿数据转换至机械手基坐标系,生成动态抓取目标点,包括:

5.根据权利要求1所述的3d视觉系统辅助机械手定位抓取钢铁试样的方法,其特征在于,所述基于所述动态抓取目标点生成安全过渡点,包括:

6.根据权利要求1所述的3d视觉系统辅助机械手定位抓取钢铁试样的方法,其特征在于,所述控制所述机械手根据所述运动控制指令执行所述直线下降运动,包括:

7.根据权利要求1所述的3d视觉系统辅助机械手定位抓取钢铁试样的方法,其特征在于,在所述基于所述多组标定数据确定所述3d视觉系统与所述机械手之间的坐标转换矩阵之后,还包括:

8.一种3d视觉系统辅助机械手定位抓取试样的系统,其特征在于,包括: