[发明专利]一种基于线结构光的立体定位方法

说明书

本发明的一种基于线结构光的立体定位方法，包括：步骤1：将线结构光视觉系统的视觉坐标系与机器人的机械手坐标系手眼标定，求出视觉坐标系与机械手坐标系之间的坐标系转换矩阵；步骤2：由机械手带着线结构光扫描初始位置零件，得到3D点云图像，制作零件模板；步骤3：将零件在视觉坐标系下沿x，y，z轴旋转平移，通过零件模板对变换位置后的零件进行模板匹配，计算视觉坐标系下初始位置与变换后位置之间的视觉坐标系位置转换矩阵；步骤4：根据坐标转换矩阵与位置转换矩阵，计算零件在机械手坐标系中初始位置和变换后位置之间的机械手坐标系位置转换矩阵。本发明定位方法简单、定位精确、易于推广等优点，能有效满足立体定位的需要。

技术领域

本发明属于机器视觉技术领域，涉及一种基于线结构光的立体定位方法。

背景技术

随着我国制造业的不断发展，工业机器人已经成为先进制造业中不可或缺的重要装备，随着机器视觉技术的应用与发展，越来越多的机器人将机器视觉作为其自主导航的重要工具。机器视觉系统与工业机器人的结合，相当于给机器人装上了眼睛，从此机器人不再只能运动到事先示教好的位置。但传统的机器视觉只能进行平面识别，对于有角度、高度等姿态变化的物体不能进行实时定位。

发明内容

为解决上述技术问题，本发明的目的是提供种基于线结构光的立体定位方法，该方法具有运算简单、匹配精度高、定位准确、易推广等特点，并能有效满足机器人定位抓取的需要。

本发明提供一种基于线结构光的立体定位方法，包括如下步骤：

步骤1：将线结构光视觉系统的视觉坐标系与机器人的机械手坐标系手眼标定，求出视觉坐标系与机械手坐标系之间的坐标系转换矩阵M₀；

步骤2：由机械手带着线结构光扫描初始位置零件，得到3D点云图像，制作零件模板；

步骤3：将零件在视觉坐标系下沿x，y，z轴旋转平移，通过零件模板对变换位置后的零件进行模板匹配，计算视觉坐标系下初始位置与变换后位置之间的视觉坐标系位置转换矩阵T₀；

步骤4：根据坐标转换矩阵M₀与位置转换矩阵T₀，计算零件在机械手坐标系中初始位置和变换后位置之间的机械手坐标系位置转换矩阵T₁；

步骤5：根据械手坐标系位置转换矩阵T₁计算零件变换位置后在机械手坐标系下坐标。

在本发明的基于线结构光的立体定位方法中，所述步骤1包括：

步骤1.1：在线结构光视觉传感器视场范围内用自制靶标标记四个点，该四个点之间任意三点不共线，四点不共面；

步骤1.2：由固定在机械手上的线结构光视觉传感器扫描靶标得到四个点的点云信息，得到视觉坐标系下四个点的三维坐标值；

步骤1.3：采用三维动态测量得到相对于机械手坐标系下的四个点的三维坐标；

步骤1.4：计算视觉坐标系与机械手坐标系之间的坐标系转换矩阵M₀。

在本发明的基于线结构光的立体定位方法中，所述步骤2包括中采用GeomagicStudio 12软件制作零件模板。

在本发明的基于线结构光的立体定位方法中，所述步骤3中通过零件模板对变换位置后的零件进行模板匹配具体为：

将零件模板和实际场景的3D描述子匹配后，以点至点的对应关系找到实际场景中与零件模板相似的实例，得到视觉坐标系下转换关系。

在本发明的基于线结构光的立体定位方法中，所述步骤4具体为：

零件在机械手坐标系下从初始位置到变换后位置的机械手坐标系位置转换矩阵为