抓取在线工件的机器人位姿及运动轨迹定位系统的制作方法
【技术领域】
[0001] 本实用新型机器人运动控制以及视觉定位领域，特别涉及一种抓取在线工件的机 器人位姿及运动轨迹定位系统。
【背景技术】
[0002] 目前，工业机器人在各工业领域中获得了广泛应用，其可代替人工做出可重复的 精确的运动。机器人要完成三维工件的智能抓取，必须沿特定轨迹、采用相应的位姿及运动 轨迹进行运动。目前在静态三维工件的抓取中，工业机器人抓取位姿及运动轨迹的定位有 在线示教、离线编程；在运动工件的在线实时抓取中，目前有单目视觉引导系统、双目视觉 引导系统以及结构光与视觉结合的引导系统。然而，现有工业机器人三维位姿及运动轨迹 定位技术，存在多方面的不足：
[0003] 1)在线示教不需标定机器人的工具坐标系，机器人的位姿、运动轨迹及夹紧参数 依靠示教工程人员的经验目测获取，系统精度较低、在线编程繁琐、占用生产时间，难以满 足当今快速而多品种变换的柔性生产需求，特别是不能满足自动抓取位姿不确定的在线输 送工件的需求。
[0004] 2)为了获得真实的机器人位置空间模型必须对机器人进行标定。常用的标定设备 有三坐标测量机、关节臂测量机和激光跟踪仪，但用于对工作场景中的机器人标定受限制， 位置标定误差仍较大。
[0005] 3)单目视觉系统通常用于二维平面上的信息提取，无法获取工件在Z轴（深度方 向）上的信息，传递给机器人的只有平面上的位置和角度量。相机光轴必须与工件平面保 持严格垂直，深度位置只能靠经验值人为预先设定固定值。
[0006] 4)结构光与单相机相结合获取工件信息的方式，需进行图形学解码运算。为保证 解算精度，必须保持相机与工件相对位置固定，难以适用于运动工件的抓取，而且涉及三维 点云计算，运算复杂耗时。
[0007] 5)双目立体视觉系统，利用两个相机呈固定角度从不同视角拍摄工件图像，计算 工件的三维坐标。要经过双目视觉标定、深度信息提取等过程，运算比较复杂，耗时较长，成 本较高，而且鲁棒性较差。
[0008] 因此，对于工业机器人自动抓取在线运动的三维工件，有发展工件位姿及运动轨 迹在线快速识别装置的需求，以改善上述缺点与不足。 【实用新型内容】
[0009] 本实用新型的目的在于克服现有技术的缺点与不足，提供一种抓取在线工件的机 器人位姿及运动轨迹定位系统，该系统基于单目视觉系统，适用于利用工业机器人智能、快 速地抓取制造车间最常见的生产输送线上已知形状而位姿不确定的中小型工件（可以不 同形状、规格、材质的多种工件混合）。
[0010] 本实用新型的目的通过以下的技术方案实现：抓取在线工件的机器人位姿及运动 轨迹定位系统，包括用于实时拍摄工件的相机、用于抓取工件的机器人系统、用于根据相机 所拍摄图像得到机器人系统抓取坐标的图像处理器、工作台，所述相机固定在一相机支架 上，相机支架和机器人系统分别设置于工作台的两侧；所述图像处理器分别与相机和机器 人系统中的机器人控制装置相连；所述工作台上设有工件传输带，工件在工件传输带上运 动；所述机器人系统的末端设有用于夹紧及旋转工件的末端执行器；所述相机的光轴与工 件运动的方向垂直，相机用于获取工件的轴侧图像。本实用新型采用单相机获取输送运动 中不确定位姿的工件信息并计算得到其三维坐标，引导机器人采用正确的末端执行器位姿 和运动轨迹智能地对工件进行准确抓取。
[0011] 优选的，在所述工件传输带的两端设有用于探测工件是否进入相机视场的光电传 感器，该光电传感器与相机外接触发头连接。从而可以通过传感器信号触发相机拍照。
[0012] 本实用新型与现有技术相比，具有如下优点和有益效果：
[0013] (1)使机器人智能化自动工作，抓取精度高。本实用新型采用单相机获取输送运动 中不确定位姿的工件信息并计算得到其三维坐标，引导机器人采用正确的末端执行器位姿 和运动轨迹智能地对工件进行准确抓取。
[0014] (2)可多种目标混合识别，适应多品种柔性化生产需求。本实用新型设计单目视觉 获取工件轴侧图像，根据不同的已知形状物体找出其特征，可适应于不同形状、规格、材质 的多种工件混合输送场合的工件识别和机器人抓取引导。
[0015] (3)适应性广，应用条件宽泛。本实用新型对识别对象工件无材质、形状、尺寸的特 定限制（但以中小型物体为佳），对工件随传送带运动的速度以及在传送带上的位置偏差 大小也有比较大的适应性。
[0016] (4)结构简单，成本低廉。本实用新型采用单个普通相机，配用普通PC机，与常规 工业机器人组成智能识别与抓取系统，无需其他辅助器件和软件平台。
【附图说明】
[0017] 图1是本实用新型系统硬件总体结构示意图。
[0018] 图2-1是本实用新型平面点在垂直方向上的深度定位模型原理图。
[0019] 图2-2是本实用新型空间点在垂直方向上的深度定位模型原理图。
[0020] 图2-3是本实用新型平面点在水平方向上的X轴向定位模型原理图。
[0021] 图2-4是本实用新型空间点在水平方向上的X轴向定位模型原理图。
[0022] 图3(a)是本实施例被测工件为立方体的示意图。
[0023] 图3(b)是本实施例被测工件为其他规则体的示意图。
【具体实施方式】
[0024] 下面结合实施例及附图对本实用新型作进一步详细的描述，但本实用新型的实施 方式不限于此。
[0025] 实施例1
[0026] 参阅图1，本实施例抓取在线工件的机器人位姿及运动轨迹定位系统包括相机支 架1、工业相机2、被测工件3、工件传输带4、末端执行器5、机器人系统6、工作台7、图像处 理器8、工作台控制装置9、位移传感器10以及机器人控制装置11。工业相机2安装在相机 支架1上，相机光轴与垂线呈适当下倾角度安装，使其能够获取输送带上工件的轴侧图像 以及初始时的机器人末端执行器所在位置。相机与工业机器人分别安装在运动平台两侧， 保证机器手臂不遮挡相机视野。光电传感器安装在传送带侧旁，用于探测工件是否进入相 机视场。图像处理器分别与相机和机器人系统中的机器人控制装置相连，用于根据相机所 拍摄图像得到机器人系统抓取坐标。末端执行器用于夹紧、旋转及放置工件。
[0027] 下面对本实施例所述系统的工作过程进行具体说明。
[0028] S1、调整相机的安装位置和安装角度，使得工件进入相机视场后相机能获取工件 的轴侧图像。
[0029] S2、将标定板放置于工件传输带上，且位于相机的视场中心，对相机-工件传输 带平面-末端执行器进行几何标定，标定得到相机的内参数f和外参数α
[0030] S3、依据相机的安装空间位置和已知的工件形状尺寸，建立帧坐标系uo〃v中工件 特征图像坐标与绝对坐标系XYZ中工件三维位姿坐标之间的转换数学模型。
[0031] 该数学模型具体包括四个模型，分别是绝对坐标系中的平面点在垂直方向上的深 度定位模型、绝对坐标系中的空间点在垂直方向上的深度定位模型、绝对坐标系中的平面 点在水平方向上的X轴向定位模型与绝对坐标系中的空间点在水平方向上的X轴向定位模 型。根据上述模型，再结合工件的先验知识，从而将所有相机中成像的点的三维坐标求出。 上述4个数学模型，本领域技术人员可以进行推导得到。具体推理过程如下：
[0032] (3-1)建立坐标系：绝对坐标系XYZ以相机镜头的光轴中心在工作台平面的垂直 投影M为原点，以过相机镜头光轴线的垂直平面为参照，垂直于该平面的方向X轴，垂直于 X轴的方向为Y方向，坐标表示为（X，Y)，以长度为单位；像平面坐标系x〇'y原点在CCD成 像平面的中心，坐标表示为（x，y);帧坐标系u〇〃v原点在图像平面的左上角，坐标表示为 (u，v)，以像素为单位，〇'在坐标系u〇〃v下的坐标为（U c^vci);下面所述平面点为绝对坐标 系XYZ中XMY平面上的点。
[0033] (3-2)建立绝对坐标系中的平面点在垂直方向上的深度定位模型。
[0034] 参见图2-1，设绝对坐标系中的平面点P (0, Y，0)，则：
【主权项】
1. 抓取在线工件的机器人位姿及运动轨迹定位系统，其特征在于，包括用于实时拍摄 工件的相机、用于抓取工件的机器人系统、用于根据相机所拍摄图像得到机器人系统抓取 坐标的图像处理器、工作台，所述相机固定在一相机支架上，相机支架和机器人系统分别设 置于工作台的两侧；所述图像处理器分别与相机和机器人系统中的机器人控制装置相连； 所述工作台上设有工件传输带，工件在工件传输带上运动；所述机器人系统的末端设有用 于夹紧及旋转工件的末端执行器；所述相机的光轴与工件运动的方向垂直，相机用于获取 工件的轴侧图像。
2. 根据权利要求1所述的抓取在线工件的机器人位姿及运动轨迹定位系统，其特征在 于，在所述工件传输带的两端设有用于探测工件是否进入相机视场的光电传感器，该光电 传感器与相机外接触发头连接。
【专利摘要】本实用新型公开了一种抓取在线工件的机器人位姿及运动轨迹定位系统，包括用于实时拍摄工件的相机、用于抓取工件的机器人系统、用于根据相机所拍摄图像得到机器人系统抓取坐标的图像处理器、工作台，相机固定在一相机支架上，相机支架和机器人系统分别设置于工作台的两侧；图像处理器分别与相机和机器人系统中的机器人控制装置相连；工作台上设有工件传输带，工件在工件传输带上运动；机器人系统的末端设有用于夹紧及旋转工件的末端执行器；所述相机的光轴与工件运动的方向垂直，相机用于获取工件的轴侧图像。本实用新型采用单相机获取输送运动中不确定位姿的工件信息，引导机器人采用智能地对工件进行准确抓取，具有抓取精度高、结构简单的优点。
【IPC分类】B25J13-08
【公开号】CN204585232
【申请号】CN201520175714
【发明人】全燕鸣, 朱正伟, 郭清达
【申请人】华南理工大学
【公开日】2015年8月26日
【申请日】2015年3月26日