[发明专利]一种基于双目视觉的工件定位与抓取方法

说明书

本发明公开了一种基于双目视觉的工件定位与抓取方法，通过双目相机采集的左、右两张工件图片，进行特征检测，根据特征提取工件抓取位姿信息，将工件的位置及姿态发送给机器人，引导机器人末端夹具抓取工件并搬运至仓储区，提高生产的自动化程度，替代人工操作，提高生产效率，减少工人劳动强度。

技术领域

本发明属于工件搬运领域，尤其涉及一种基于双目视觉的工件定位与抓取 方法。

背景技术

在实现本发明的过程中，发明人发现现有技术至少存在以下问题：

工厂内工件一般需要人工进行搬运，这些工作重复度高，工作环境恶劣， 同时工人劳动强度较大，导致生产效率较低。现有技术为人工搬运，工人劳动 强度大，生产效率低；基于单目视觉的定位丧失了部分空间信息，对于高度定 位精度低。

发明内容

本发明所要解决的技术问题是提供一种基于视觉搬运系统，实现工件卸车 后的自动仓储及过筛时工件的自动供料，提高生产的自动化程度，替代人工操 作，提高生产效率，减少工人劳动强度的基于双目视觉的工件定位与抓取方法

为了解决上述技术问题，本发明所采用的技术方案是：一种基于双目视觉 的工件定位与抓取方法，包括如下步骤：

1)工件抓取位姿检测：抓取位置为矩形工件中心所在位置，抓取位姿为矩 形工件旋转角度的修正值；工件模型中标记点为定制标准圆，其圆心连接成的 轮廓中心与矩形工件中心重合，因此对矩形工件的中心提取可转换为对标记点 圆心连接成的轮廓中心提取；

1.1)使用最小圆拟合对标记点进行圆心提取；

1.2)将4个圆心坐标连接成一个轮廓特征；

1.3)对轮廓拟合最小旋转矩形；

1.4)提取旋转矩形中心坐标(x，y)和旋转角度α；

2)姿态示教：

将工件任意放置，相机采集工件图片，使用步骤1)算法进行中心坐标及旋 转角度检测，此时旋转角度为αr；示教机器人位姿，使其末端夹具工件凹槽内， 记录此时机器人的姿态角度u，此时工件旋转角度αr对应机器人姿态角度u；

3)双目视觉模型求解工件抓取高度z：

4)引导机器人抓取工件；

5)将工件搬运至仓储区。

所述步骤3)包括如下步骤：

3.1)提取左相机中图像标记圆的中心像素坐标(x_l,y_l)，提取右相机中图像标 记圆的中心像素坐标(x_r,y_r)；

3.2)计算左右相机的视差d；d＝x_l-x_r；

3.3)根据双目模型计算工件在相机坐标系下的高度z；其中f为 相机焦距，左右相机的焦距相差较小，默认为相等，则左相机焦距等于右相机 焦距f＝f_左＝f_右。

所述第4)步包括如下步骤：

4.1)重新任意放置工件，使用步骤1算法检测并提取工件中心坐标(x，y) 及旋转姿态β；

4.2)提取到的像素坐标系下的工件中心坐标(x，y)和工件在相机坐标系下 的高度z通过转换矩阵H转换到机器人基坐标系下坐标(x_b,y_b,z_b)；此处H矩阵 为相机坐标系与机器人基坐标系的转换矩阵，通过手眼标定可得到；

4.3)计算此时工件旋转角度β与示教工件旋转角度αr的角度差：