一种用于物流拆垛的机器人控制方法及系统技术方案

本发明专利技术涉及一种用于物流拆垛的机器人控制方法及系统，该方法包括如下步骤：建立吸盘手的第一二维模型；根据机器人的基坐标系建立第一三维坐标系，根据3D相机拍摄的图像建立第二三维坐标系，基于第一三维坐标系对第二三维坐标系进行标定，得到标定后的第二三维坐标系；基于3D相机拍摄的待抓取物体的图像和标定后的第二三维坐标系获取待抓取物体中位于最上层的物体的角点，构建最上层物体的第二二维模型；确定最上层物体的抓取顺序，依据抓取顺序获得至少一个抓取目标；模拟第一二维模型与抓取目标的第二二维模型的位置关系，进行吸盘手和抓取目标的碰撞检测；基于碰撞检测的结果对吸盘手进行抓取规划。本发明专利技术能够实不同规格的物体的多目标抓取。的物体的多目标抓取。的物体的多目标抓取。

【技术实现步骤摘要】
一种用于物流拆垛的机器人控制方法及系统


[0001]本专利技术涉及物流拆垛
，尤其涉及一种用于物流拆垛的机器人控制方法及系统。

技术介绍

[0002]随着劳动力成本的不断增加和自动化技术的提高，机器人设备在工厂中越来越普及。物流拆垛是物流行业非常常见的一道工序，其工作繁重乏味，越来越少的人愿意从事这一工作，且物流行业相比一般生产制造企业，在垛型上又更加不规则。现有的应用于物流拆垛的控制方法主要包括视觉抓取方法和吸盘抓取方法，其中视觉抓取方法只能提供不同规格情况下，单一目标的抓取，抓取效率较低；而吸盘抓取方法只能提供单一规格下，固定垛型的抓取，抓取灵活性较低。
[0003]因此，如何提供一种能够实现不同规格目标的多目标抓取的用于物流拆垛的机器人控制方法及系统是本领域技术人员亟待解决的一个技术问题。

技术实现思路

[0004]本专利技术提供一种用于物流拆垛的机器人控制方法及系统，以解决上述技术问题。
[0005]为解决上述技术问题，本专利技术提供一种用于物流拆垛的机器人控制方法，包括如下步骤：
[0006]根据安装于机器人末端的吸盘手的形状和尺寸建立吸盘手的第一二维模型；
[0007]根据所述机器人的基坐标系建立第一三维坐标系，根据3D相机拍摄的图像建立第二三维坐标系，基于所述第一三维坐标系对所述第二三维坐标系进行标定，得到标定后的第二三维坐标系；
[0008]基于所述3D相机拍摄的待抓取物体的图像和标定后的第二三维坐标系获取所述待抓取物体中位于最上层的物体的角点，构建最上层物体的第二二维模型，所述角点定义为：放置在水平面上的长方体物体在水平面上的投影得到的长方形的四个顶点；
[0009]确定所述最上层物体的抓取顺序，依据所述抓取顺序获得至少一个抓取目标；
[0010]模拟所述第一二维模型与所述抓取目标的第二二维模型的位置关系，进行所述吸盘手和所述抓取目标的碰撞检测；
[0011]基于碰撞检测的结果对所述吸盘手进行抓取规划。
[0012]较佳地，所述第一二维模型与所述抓取目标的第二二维模型的位置关系包括包含关系、分离关系和部分重合关系，
[0013]所述包含关系是指：所述抓取目标的四个角点都在所述第一二维模型的框选范围内；
[0014]所述分离关系是指：所述抓取目标的四个角点都不在所述第一二维模型的框选范围内，且所述第一二维模型也不在所述抓取目标的四个角点围成的长方形空间内；
[0015]所述部分重合关系是指：所述抓取目标的四个角点都不在所述第一二维模型的框
选范围内，但所述第一二维模型与所述抓取目标有重叠；或者所述抓取目标有1至3个角点在所述第一二维模型的框选范围内；
[0016]当所述第一二维模型的框选范围内，只存在与其存在包含关系和分离关系的抓取目标时，则碰撞检测的结果为“通过”；所述第一二维模型的框选范围内，存在与其存在部分重合关系的抓取目标时，则碰撞检测的结果为“失败”。
[0017]较佳地，判断所述角点是否在所述第一二维模型的框选范围内的方法包括：
[0018]从该角点引一条射线，若该射线与所述第一二维模型的框选范围的四条边的交点个数为奇数，则该角点位于所述第一二维模型的框选范围内；若该射线与所述第一二维模型的框选范围的四条边的交点个数为偶数，则该角点不在所述第一二维模型的框选范围内。
[0019]较佳地，判断所述第一二维模型与所述抓取目标是否有重叠的方法包括：
[0020]在两个所述角点之间，沿所述抓取目标的边长的方向增加若干插补点，判断所述插补点与所述第一二维模型的位置关系，若有至少一个所述插补点位于所述第一二维模型的框选范围内，则所述第一二维模型与所述抓取目标有重叠；若所有插补点均不在所述第一二维模型的框选范围内，则所述第一二维模型与所述抓取目标没有重叠。
[0021]较佳地，所述抓取目标的四个角点围成的长方形的长为L，宽为K，则相邻两个所述插补点之间的间隔小于等于2K。
[0022]较佳地，若L≤2K时，则无需增加插补点；若L＞2K时，则相邻两个所述插补点之间的间隔为
[0023]较佳地，确定所述最上层物体的抓取顺序，依据所述抓取顺序获得至少一个抓取目标的方法包括：
[0024]将所述第一二维模型和所述抓取目标的第二二维模型放入二维坐标系中，计算各个最上层物体的中心点到坐标原点的欧氏距离，按照欧氏距离由小到大的顺序依次获取所述抓取目标；
[0025]针对某一个抓取目标，在对其四个角点进行排序之后，按排序的顺序以所述角点为原点，所述角点延伸出的两条边为方向，确定所述第一二维模型的框选范围；
[0026]若所述第一二维模型的框选范围内与其有包含关系的抓取目标大于一个，则取其中与所述坐标原点的欧氏距离最远的一个抓取目标，对该抓取目标的角点重新确定所述第一二维模型的框选范围。
[0027]本专利技术还提供了一种用于物流拆垛的机器人控制系统，包括信息采集单元和抓取单元，其中所述信息采集单元包括：相机架和固定安装于所述相机架上的3D相机，所述相机架设于固定高度的相机架上，所述3D相机水平安装，且镜头垂直向下照射；所述抓取单元包括：机器人、固定于所述机器人末端的吸盘手以及用于盛放待抓取物体的托盘；
[0028]所述用于物流拆垛的机器人控制系统采用如上所述的控制方法对所述吸盘手进行抓取规划。
[0029]较佳地，所述吸盘手采用真空式吸盘手，所述吸盘手的底部接触面为一个平面，在贴合所述待抓取物体时进行抽真空处理。
[0030]与现有技术相比，本专利技术提供的用于物流拆垛的机器人控制方法及系统具有如下优点：
[0031]1、本专利技术通过对复杂的3D环境进行抽象及简化，建立简化的二维模型，经过坐标系变换进行碰撞检测和抓取规划，减少了繁琐的模型制作与导入流程，能够快速地模拟出碰撞检测的结果，继而快速实现避障；
[0032]2、本专利技术能够在实现避障的前提下，通过变换第一二维模型的框选范围实现多个抓取目标的同时抓取；
[0033]3、本专利技术能够适用于不同规格的物体的抓取，适用于物流拆垛中对于多件大小不一的物体的抓取。
附图说明
[0034]图1为本专利技术一具体实施方式中用于物流拆垛的机器人控制方法的流程示意图；
[0035]图2a和2b分别为本专利技术一具体实施方式中针对某一抓取目标的某一角点确定的第一二维模型的框选范围的示意图；
[0036]图3a至3d分别为本专利技术一具体实施方式中第一二维模型与抓取目标的第二二维模型的位置关系的示意图。
[0037]图中：10
‑
框选范围。
具体实施方式
[0038]为了更详尽的表述上述专利技术的技术方案，以下列举出具体的实施例来证明技术效果；需要强调的是，这些实施例用于说明本专利技术而不限于限制本专利技术的范围。
[0039]本专利技术提供的用于物流拆垛的机器人控制系统，包括信息采集单元和抓取单元，其中所述信息采集单元包本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于物流拆垛的机器人控制方法，其特征在于，包括如下步骤：根据安装于机器人末端的吸盘手的形状和尺寸建立吸盘手的第一二维模型；根据所述机器人的基坐标系建立第一三维坐标系，根据3D相机拍摄的图像建立第二三维坐标系，基于所述第一三维坐标系对所述第二三维坐标系进行标定，得到标定后的第二三维坐标系；基于所述3D相机拍摄的待抓取物体的图像和标定后的第二三维坐标系获取所述待抓取物体中位于最上层的物体的角点，构建最上层物体的第二二维模型，所述角点定义为：放置在水平面上的长方体物体在水平面上的投影得到的长方形的四个顶点；确定所述最上层物体的抓取顺序，依据所述抓取顺序获得至少一个抓取目标；模拟所述第一二维模型与所述抓取目标的第二二维模型的位置关系，进行所述吸盘手和所述抓取目标的碰撞检测；基于碰撞检测的结果对所述吸盘手进行抓取规划。2.如权利要求1所述的用于物流拆垛的机器人控制方法，其特征在于，所述第一二维模型与所述抓取目标的第二二维模型的位置关系包括包含关系、分离关系和部分重合关系，所述包含关系是指：所述抓取目标的四个角点都在所述第一二维模型的框选范围内；所述分离关系是指：所述抓取目标的四个角点都不在所述第一二维模型的框选范围内，且所述第一二维模型也不在所述抓取目标的四个角点围成的长方形空间内；所述部分重合关系是指：所述抓取目标的四个角点都不在所述第一二维模型的框选范围内，但所述第一二维模型与所述抓取目标有重叠；或者所述抓取目标有1至3个角点在所述第一二维模型的框选范围内；当所述第一二维模型的框选范围内，只存在与其存在包含关系和分离关系的抓取目标时，则碰撞检测的结果为“通过”；所述第一二维模型的框选范围内，存在与其存在部分重合关系的抓取目标时，则碰撞检测的结果为“失败”。3.如权利要求2所述的用于物流拆垛的机器人控制方法，其特征在于，判断所述角点是否在所述第一二维模型的框选范围内的方法包括：从该角点引一条射线，若该射线与所述第一二维模型的框选范围的四条边的交点个数为奇数，则该角点位于所述第一二维模型的框选范围内；若该射线与所述第一二维模型的框选范围的四条边的交点个数为偶数，则该角点不在所述第一二维模型的框选范围内。4.如权利要求2所述的用于物流拆垛的机器人控制方...

【专利技术属性】
技术研发人员：白国超，黄唯淳，
申请(专利权)人：知行高科北京科技有限公司，
类型：发明
国别省市：