CN111376239B - 机器人的抓取方法及系统 - Google Patents
机器人的抓取方法及系统 Download PDFInfo
- Publication number
- CN111376239B CN111376239B CN201811644025.XA CN201811644025A CN111376239B CN 111376239 B CN111376239 B CN 111376239B CN 201811644025 A CN201811644025 A CN 201811644025A CN 111376239 B CN111376239 B CN 111376239B
- Authority
- CN
- China
- Prior art keywords
- product
- coordinate
- point
- grabbed
- image
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1612—Programme controls characterised by the hand, wrist, grip control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Abstract
本发明公开了一种机器人的抓取方法及系统,抓取方法包括:S1、将标定块放置到产品放置位置;S2、打开相机,通过相机获取包括标定块的图像,移动相机使相机的图像中心与标定点重合;S3、取走标定块,在产品放置位置放入一样本产品;S4、控制相机拍摄样本产品的图像,根据样本产品的图像获取样本产品的产品抓取点和位置识别点的相对位置关系;S5、控制相机拍摄一待抓取产品的图像,根据待抓取产品的图像获取待抓取产品相对于产品放置位置的偏转角度;S6、根据相对位置关系和偏转角度获取待抓取产品的产品抓取点,控制机器人手臂移动至待抓取产品的产品抓取点的位置处,并抓取待抓取产品。本发明不仅节省了人力,还提高了抓取的正确率。
Description
技术领域
本发明涉及自动控制领域,特别涉及一种机器人的抓取方法及系统。
背景技术
在现在的工业中,由于工业自动化的出现,现在许多工厂都使用机器人来代替人力,并且在使用机器人生产的过程中,通常使用视觉位置识别点来引导机器人抓取产品,但是在实际的生产过程中,视觉位置识别点的位置往往不是机器人所要抓取产品的抓取点的位置,在通常的做法下,需要对机器人在其坐标系下进行手动的补偿,通过调整该坐标系的X轴、Y轴,将视觉位置识别点的位置补偿到产品抓取点的位置。
发明内容
本发明要解决的技术问题是为了克服现有技术中对机器人在其坐标系下进行手动补偿的缺陷,提供一种机器人的抓取方法及系统。
本发明是通过下述技术方案来解决上述技术问题:
一种机器人的抓取方法,所述机器人包括相机和机器人手臂,所述抓取方法包括:
S1、将标定块放置到产品放置位置;
所述标定块与所述产品的尺寸相同,所述标定块上有标定点,所述标定点在所述标定块上的位置与产品抓取点在所述产品上的位置相同;
S2、打开所述相机,通过所述相机获取包括所述标定块的图像,移动所述相机使相机的图像中心与所述标定点重合;
S3、取走所述标定块,在所述产品放置位置放入一样本产品,所述样本产品上设有位置识别点;
S4、控制所述相机拍摄所述样本产品的图像,根据所述样本产品的图像获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系;
S5、控制所述相机拍摄一待抓取产品的图像,根据所述待抓取产品的图像获取所述待抓取产品相对于所述产品放置位置的偏转角度;
S6、根据所述相对位置关系和所述偏转角度获取所述待抓取产品的产品抓取点,控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
较佳地,所述机器人还包括图像处理器;步骤S2包括:
S21、所述相机将所述标定块的图像发送至所述图像处理器,所述图像处理器根据所述标定块的图像生成相机移动路线并发送至所述机器人;
S22、所述机器人在接收到所述相机移动路线后控制所述相机移动,使所述相机的图像中心与所述标定点重合。
较佳地,步骤S4包括:
S41、所述相机将所述样本产品的图像发送至所述图像处理器,所述图像处理器根据所述样本产品的图像建立直角坐标系;
S42、根据所述样本产品的图像获取所述样本产品的尺寸,并根据所述样本产品的尺寸获取所述样本产品的产品抓取点在所述直角坐标系中的第一坐标;
S43、根据所述样本产品的图像获取所述样本产品的位置识别点在所述直角坐标系中的第二坐标;
S44、根据所述第一坐标和所述第二坐标获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系。
较佳地,步骤S6包括:
S61、所述相机将所述待抓取产品的图像发送至所述图像处理器,所述图像处理器根据所述待抓取产品的图像获取所述待抓取产品的位置识别点在所述直角坐标系中的第三坐标;
S62、判断所述第二坐标和所述第三坐标是否相同且所述偏转角度是否为0度,若是,则所述第一坐标为所述待抓取产品的产品抓取点的坐标,执行步骤S64,若否,则执行步骤S63;
S63、根据所述第一坐标、所述第三坐标、所述偏转角度和所述相对位置关系获取所述待抓取产品的产品抓取点的坐标;
S64、控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
较佳地,步骤S63包括:
S631、根据所述第一坐标、所述第三坐标和所述偏转角度获取偏转位置识别点在所述直角坐标系中的第四坐标;
所述偏转位置识别点为由所述待抓取产品的位置识别点出发,沿着以所述第一坐标为圆心,以所述第一坐标至所述第三坐标的长度为半径的圆上旋转所述偏转角度后得到的点;
旋转方向与所述待抓取产品相对于所述产品放置位置的偏转方向相反;
S632、根据所述第四坐标和所述相对位置关系获取偏转产品抓取点在所述直角坐标系中的第五坐标;
所述偏转产品抓取点和所述偏转位置识别点的相对位置关系与所述样本产品的产品抓取点和位置识别点的相对位置关系相同;
S633、根据所述第一坐标、所述第五坐标和所述偏转角度获取在所述直角坐标系中的第六坐标;
所述第六坐标为所述待抓取产品的产品抓取点的坐标。
较佳地,步骤S64包括:
S641、所述图像处理器根据所述待抓取产品的产品抓取点的坐标生成机器人手臂移动路线并发送至所述机器人;
S642、所述机器人在接收到所述机器人手臂移动路线后控制所述机器人手臂移动至所述待抓取产品的位置。
一种机器人的抓取系统,所述机器人包括相机和机器人手臂,所述机器人的抓取系统包括:
放置单元,用于将标定块放置到产品放置位置;所述标定块与所述产品的尺寸相同,所述标定块上有标定点,所述标定点在所述标定块上的位置与产品抓取点在所述产品上的位置相同;
相机定位单元,用于打开所述相机,通过所述相机获取包括所述标定块的图像,移动所述相机使相机的图像中心与所述标定点重合;
所述放置单元还用于取走所述标定块,在所述产品放置位置放入一样本产品,所述样本产品上设有位置识别点;
相对位置关系获取单元,用于控制所述相机拍摄所述样本产品的图像,根据所述样本产品的图像获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系;
偏转角度获取单元,用于控制所述相机拍摄一待抓取产品的图像,根据所述待抓取产品的图像获取所述待抓取产品相对于所述产品放置位置的偏转角度
产品抓取单元,用于根据所述相对位置关系和所述偏转角度获取所述待抓取产品的产品抓取点,控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
较佳地,所述机器人还包括图像处理器;所述相机定位单元包括:
相机移动路线生成模块,用于所述相机将所述标定块的图像发送至所述图像处理器,所述图像处理器根据所述标定块的图像生成相机移动路线并发送至所述机器人;
相机移动模块,用于所述机器人在接收到所述相机移动路线后控制所述相机移动,使所述相机的图像中心与所述标定点重合。
较佳地,所述相对位置关系获取单元包括:
直角坐标系建立模块,用于所述相机将所述样本产品的图像发送至所述图像处理器,所述图像处理器根据所述样本产品的图像建立直角坐标系;
第一坐标获取模块,用于根据所述样本产品的图像获取所述样本产品的尺寸,并根据所述样本产品的尺寸获取所述样本产品的产品抓取点在所述直角坐标系中的第一坐标;
第二坐标获取模块,用于根据所述样本产品的图像获取所述样本产品的位置识别点在所述直角坐标系中的第二坐标;
相对位置关系获取模块,用于根据所述第一坐标和所述第二坐标获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系。
较佳地,所述产品抓取单元包括第三坐标获取模块、判断模块、产品抓取点获取模块和产品抓取模块;
所述第三坐标获取模块,用于所述相机将所述待抓取产品的图像发送至所述图像处理器,所述图像处理器根据所述待抓取产品的图像获取所述待抓取产品的位置识别点在所述直角坐标系中的第三坐标;
所述判断模块,用于判断所述第二坐标和所述第三坐标是否相同且所述偏转角度是否为0度,若是,则所述第一坐标为所述待抓取产品的产品抓取点的坐标,调用所述产品抓取模块;若否,则调用所述产品抓取点获取模块;
所述产品抓取点获取模块,用于根据所述第一坐标、所述第三坐标、所述偏转角度和所述相对位置关系获取所述待抓取产品的产品抓取点的坐标;
所述产品抓取模块,用于控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
较佳地,所述产品抓取点获取模块包括:
第四坐标获取子模块,用于根据所述第一坐标、所述第三坐标和所述偏转角度获取偏转位置识别点在所述直角坐标系中的第四坐标;
所述偏转位置识别点为由所述待抓取产品的位置识别点出发,沿着以所述第一坐标为圆心,以所述第一坐标至所述第三坐标的长度为半径的圆上旋转所述偏转角度后得到的点;
旋转方向与所述待抓取产品相对于所述产品放置位置的偏转方向相反;
第五坐标获取子模块,用于根据所述第四坐标和所述相对位置关系获取偏转产品抓取点在所述直角坐标系中的第五坐标;
所述偏转产品抓取点和所述偏转位置识别点的相对位置关系与所述样本产品的产品抓取点和位置识别点的相对位置关系相同;
第六坐标获取子模块,用于根据所述第一坐标、所述第五坐标和所述偏转角度获取在所述直角坐标系中的第六坐标;
所述第六坐标为所述待抓取产品的产品抓取点的坐标。
较佳地,所述产品抓取模块包括:
机器人手臂移动路线生成子模块,用于所述图像处理器根据所述待抓取产品的产品抓取点的坐标生成机器人手臂移动路线并发送至所述机器人;
机器人手臂移动子模块,用于所述机器人在接收到所述机器人手臂移动路线后控制所述机器人手臂移动至所述待抓取产品的位置。
在符合本领域常识的基础上,上述各优选条件,可任意组合,即得本发明各较佳实例。
本发明的积极进步效果在于:在视觉图像上获取产品的位置识别点之后自动将图像上的位置识别点补偿到产品抓取点的位置,并引导机器人手臂直接移动至产品抓取点位置进行抓取,不仅节省了人力,还提高了抓取的正确率。
附图说明
图1为本发明实施例1的机器人的抓取方法的流程图。
图2为本发明的样本产品在直角坐标系中的示意图。
图3为本发明的待抓取产品在直角坐标系中的示意图。
图4为本发明实施例2的机器人的抓取系统的结构示意图。
具体实施方式
下面通过实施例的方式进一步说明本发明,但并不因此将本发明限制在的实施例范围之中。
实施例1
如图1所示,本实施例的机器人的抓取方法的流程图,所示机器人的抓取方法包括以下步骤:
步骤101、将标定块放置到产品放置位置。
所述标定块与所述产品的尺寸相同,所述标定块上有标定点,所述标定点在所述标定块上的位置与产品抓取点在所述产品上的位置相同。
产品的位置为机器人将要抓取产品所在的位置。
在本实施例中,标定点在标定块的中心位置,故产品抓取点在产品的中心位置。
步骤102、打开所述相机,通过所述相机获取包括标定块的图像,移动所述相机使相机的图像中心与所述标定点重合。
所述机器人还包括图像处理器。
所述相机将所述标定块的图像发送至所述图像处理器,所述图像处理器根据所述标定块的图像生成相机移动路线并发送至所述机器人。
所述机器人在接收到所述相机移动路线后控制所述相机移动,使相机的图像中心与所述标定点重合。
步骤103、取走所述标定块,在所述产品放置位置放入一样本产品。
所述样本产品上设有位置识别点,样本产品与步骤101中的产品的尺寸相同。此时相机的图像中心与样本产品的产品抓取点也同样重合。
步骤104、控制所述相机拍摄所述样本产品的图像,根据所述样本产品的图像获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系。
所述相机将所述样本产品的图像发送至所述图像处理器,所述图像处理器根据所述样本产品的图像建立直角坐标系。
如图2所示,本发明的样本产品在直角坐标系中的示意图。
在本实施例中,以产品的左下角为直角坐标系的原点,水平方向为X轴,竖直方向为Y轴。
根据所述样本产品的图像获取所述样本产品的尺寸,并根据所述样本产品的尺寸获取所述样本产品的产品抓取点在所述直角坐标系中的第一坐标。
在本实施例中,样本产品的尺寸:长为h,宽为w,因为产品抓取点在样本产品的中心,即A点,故可获取样本产品的产品抓取点在直角坐标系中的坐标A(w/2,h/2),此坐标也是相机的图像中心的坐标。
根据所述样本产品的图像获取所述样本产品的位置识别点在所述直角坐标系中的第二坐标。
在本实施例中,B点为样本产品的位置识别点,其坐标为B(xM,yM),样本产品在直角坐标系中的角度为样品产品的竖中线相对于Y轴的夹角,在本实施例中,样本产品在直角坐标系中的角度为angleM,angleM为0度。
根据所述第一坐标和所述第二坐标获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系,用坐标的形式表示为(xM-w/2,yM-h/2,angleM)。
步骤105、控制所述相机拍摄一待抓取产品的图像,根据所述待抓取产品的图像获取所述待抓取产品相对于所述产品放置位置的偏转角度。
如图3所示,本发明的待抓取产品在直角坐标系中的示意图。
待抓取产品和样本产品相同。
待抓取产品在直角坐标系中的角度为待抓取产品的竖中线相对于Y轴的夹角,在本实施例中,待抓取产品在直角坐标系中的角度为angleM',所述待抓取产品的图像获取所述待抓取产品相对于所述产品放置位置的偏转角度为(angleM'-angleM)。
步骤106、根据所述相对位置关系和所述偏转角度获取所述待抓取产品的产品抓取点。
所述相机将所述待抓取产品的图像发送至所述图像处理器,所述图像处理器根据所述待抓取产品的图像获取所述待抓取产品的位置识别点在所述直角坐标系中的第三坐标。
在本实施例中,待抓取产品的位置识别点为C点,其坐标为(xM',yM')。
判断所述第二坐标和所述第三坐标是否相同且所述偏转角度是否为0度,若是,说明待抓取产品和样本产品在直角坐标系中重合,所述第一坐标为所述待抓取产品的产品抓取点的坐标,若否,需要根据所述第一坐标、所述第三坐标、所述偏转角度和所述相对位置关系获取所述待抓取产品的产品抓取点的坐标。
首先,根据所述第一坐标、所述第三坐标和所述偏转角度获取偏转位置识别点在所述直角坐标系中的第四坐标。
所述偏转位置识别点为由所述待抓取产品的位置识别点出发,沿着以图像中心坐标,即所述第一坐标为圆心,以所述第一坐标至所述第三坐标的长度为半径的圆上旋转所述偏转角度后得到的点,偏转角度为(angleM'-angleM)度。
旋转方向与所述待抓取产品相对于所述产品放置位置的偏转方向相反。
故在本实施例中,旋转方向和偏转方向可以顺时针也可以逆时针,在本步骤中,当偏转方向为顺时针时,旋转方向为逆时针;当偏转方向为逆时针时,旋转方向为顺时针。
在本实施例中,偏转位置识别点为D点,其坐标为D(xM”,yM”)。
接着,根据所述第四坐标和所述相对位置关系获取偏转产品抓取点在所述直角坐标系中的第五坐标。
所述偏转产品抓取点和所述偏转位置识别点的相对位置关系与所述样本产品的产品抓取点和位置识别点的相对位置关系相同。
在本实施例中,偏转产品抓取点为E点,其坐标为E(resultX',resultY'),其中:
resultX'=xM”-(xM-w/2);
resultY'=yM”-(yM-h/2)。
最后,根据所述第一坐标、所述第五坐标和所述偏转角度获取在所述直角坐标系中的第六坐标;
所述第六坐标为所述待抓取产品的产品抓取点的坐标。
所述待抓取产品的产品抓取点为由所述偏转产品抓取点出发,沿着以图像中心坐标,即所述第一坐标为圆心,以所述第一坐标至所述第五坐标的长度为半径的圆上旋转所述偏转角度后得到的点,偏转角度为(angleM'-angleM)度。
此处旋转方向与所述待抓取产品相对于所述产品放置位置的偏转方向相同。
在本实施例中,待抓取产品的产品抓取点为F,其坐标为F(resultX,resultY)。
步骤107、控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
所述图像处理器根据所述待抓取产品的产品抓取点的坐标生成机器人手臂移动路线并发送至所述机器人。
在本实施例中,图像处理器根据F点的坐标(resultX,resultY)生成机器人手臂移动路线。
所述机器人在接收到所述机器人手臂移动路线后控制所述机器人手臂移动至所述待抓取产品的位置。
本实施例的机器人的抓取方法为在视觉图像上获取产品的位置识别点之后自动将图像上的位置识别点补偿到产品抓取点的位置,并引导机器人手臂直接移动至产品抓取点位置进行抓取,不仅节省了人力,还提高了抓取的正确率。
实施例2
如图4所示,本实施例的机器人的抓取系统的结构示意图,所示机器人的抓取系统包括放置单元20、相机定位单元30、相对位置关系获取单元40、偏转角度获取单元50和产品抓取单元60。
放置单元20,用于将标定块放置到产品放置位置;所述标定块与所述产品的尺寸相同,所述标定块上有标定点,所述标定点在所述标定块上的位置与产品抓取点在所述产品上的位置相同,产品的位置为机器人将要抓取产品所在的位置。
在本实施例中,标定点在标定块的中心位置,故产品抓取点在产品的中心位置。
相机定位单元30用于打开所述相机,通过所述相机获取包括标定块的图像,移动所述相机使相机的图像中心与所述标定点重合;
所述机器人还包括图像处理器;所述相机定位单元30包括:
相机移动路线生成模块301,用于所述相机将所述标定块的图像发送至所述图像处理器,所述图像处理器根据所述标定块的图像生成相机移动路线并发送至所述机器人;
相机移动模块302,用于所述机器人在接收到所述相机移动路线后控制所述相机移动,使相机的图像中心与所述标定点重合。
所述放置单元20还用于取走所述标定块,在所述产品放置位置放入一样本产品,所述样本产品上设有位置识别点。
样本产品与产品的尺寸相同,此时相机的图像中心与样本产品的产品抓取点也同样重合。
相对位置关系获取单元40用于控制所述相机拍摄所述样本产品的图像,根据所述样本产品的图像获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系。
所述相对位置关系获取单元40包括:
直角坐标系建立模块401,用于所述相机将所述样本产品的图像发送至所述图像处理器,所述图像处理器根据所述样本产品的图像建立直角坐标系。
如图2所示,本发明的样本产品在直角坐标系中的示意图。
在本实施例中,以产品的左下角为直角坐标系的原点,水平方向为X轴,竖直方向为Y轴。
第一坐标获取模块402,用于根据所述样本产品的图像获取所述样本产品的尺寸,并根据所述样本产品的尺寸获取所述样本产品的产品抓取点在所述直角坐标系中的第一坐标。
在本实施例中,样本产品的尺寸:长为h,宽为w,因为产品抓取点在样本产品的中心,即A点,故可获取样本产品的产品抓取点在直角坐标系中的坐标A(w/2,h/2),此坐标也是相机的图像中心的坐标。
第二坐标获取模块403,用于根据所述样本产品的图像获取所述样本产品的位置识别点在所述直角坐标系中的第二坐标。
在本实施例中,B点为样本产品的位置识别点,其坐标为B(xM,yM),样本产品在直角坐标系中的角度为样品产品的竖中线相对于Y轴的夹角,在本实施例中,样本产品在直角坐标系中的角度为angleM,angleM为0度。
相对位置关系获取模块404,用于根据所述第一坐标和所述第二坐标获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系,用坐标的形式表示为(xM-w/2,yM-h/2,angleM)。
偏转角度获取单元50用于控制所述相机拍摄一待抓取产品的图像,根据所述待抓取产品的图像获取所述待抓取产品相对于所述产品放置位置的偏转角度。
如图3所示,本发明的待抓取产品在直角坐标系中的示意图。
待抓取产品和样本产品相同。
待抓取产品在直角坐标系中的角度为待抓取产品的竖中线相对于Y轴的夹角,在本实施例中,待抓取产品在直角坐标系中的角度为angleM',所述待抓取产品的图像获取所述待抓取产品相对于所述产品放置位置的偏转角度为(angleM'-angleM)。
产品抓取单元60用于根据所述相对位置关系和所述偏转角度获取所述待抓取产品的产品抓取点,控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
所述产品抓取单元60包括第三坐标获取模块601、判断模块602、产品抓取点获取模块603和产品抓取模块604;
所述第三坐标获取模块601,用于所述相机将所述待抓取产品的图像发送至所述图像处理器,所述图像处理器根据所述待抓取产品的图像获取所述待抓取产品的位置识别点在所述直角坐标系中的第三坐标;
在本实施例中,待抓取产品的位置识别点为C点,其坐标为(xM',yM')。
所述判断模块602,用于判断所述第二坐标和所述第三坐标是否相同且所述偏转角度是否为0度,若是,说明待抓取产品和样本产品在直角坐标系中重合,所述第一坐标为所述待抓取产品的产品抓取点的坐标,调用所述产品抓取模块604;若否,则调用所述产品抓取点获取模块。
所述产品抓取点获取模块用于根据所述第一坐标、所述第三坐标、所述偏转角度和所述相对位置关系获取所述待抓取产品的产品抓取点的坐标;
所述产品抓取点获取模块包括:
第四坐标获取子模块6031,用于根据所述第一坐标、所述第三坐标和所述偏转角度获取偏转位置识别点在所述直角坐标系中的第四坐标。
所述偏转位置识别点为由所述待抓取产品的位置识别点出发,沿着以图像中心坐标,即所述第一坐标为圆心,以所述第一坐标至所述第三坐标的长度为半径的圆上旋转所述偏转角度后得到的点,偏转角度为(angleM'-angleM)度。
旋转方向与所述待抓取产品相对于所述产品放置位置的偏转方向相反。
故在本实施例中,旋转方向和偏转方向可以顺时针也可以逆时针,此处,当偏转方向为顺时针时,旋转方向为逆时针;当偏转方向为逆时针时,旋转方向为顺时针。
在本实施例中,偏转位置识别点为D点,其坐标为D(xM”,yM”)。
第五坐标获取子模块6032,用于根据所述第四坐标和所述相对位置关系获取偏转产品抓取点在所述直角坐标系中的第五坐标。
所述偏转产品抓取点和所述偏转位置识别点的相对位置关系与所述样本产品的产品抓取点和位置识别点的相对位置关系相同。
在本实施例中,偏转产品抓取点为E点,其坐标为E(resultX',resultY'),其中:
resultX'=xM”-(xM-w/2);
resultY'=yM”-(yM-h/2)。
第六坐标获取子模块6033,用于根据所述第一坐标、所述第五坐标和所述偏转角度获取在所述直角坐标系中的第六坐标。
所述第六坐标为所述待抓取产品的产品抓取点的坐标。
所述待抓取产品的产品抓取点为由所述偏转产品抓取点出发,沿着以图像中心坐标,即所述第一坐标为圆心,以所述第一坐标至所述第五坐标的长度为半径的圆上旋转所述偏转角度后得到的点,偏转角度为(angleM'-angleM)度。
此处旋转方向与所述待抓取产品相对于所述产品放置位置的偏转方向相同。
在本实施例中,待抓取产品的产品抓取点为F,其坐标为F(resultX,resultY)。
所述产品抓取模块604,用于控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
所述产品抓取模块604包括:
机器人手臂移动路线生成子模块6041,用于所述图像处理器根据所述待抓取产品的产品抓取点的坐标生成机器人手臂移动路线并发送至所述机器人。
在本实施例中,图像处理器根据F点的坐标(resultX,resultY)生成机器人手臂移动路线。
机器人手臂移动子模块6042,用于所述机器人在接收到所述机器人手臂移动路线后控制所述机器人手臂移动至所述待抓取产品的位置。
本实施例的机器人的抓取系统为在视觉图像上获取产品的位置识别点之后自动将图像上的位置识别点补偿到产品抓取点的位置,并引导机器人手臂直接移动至产品抓取点位置进行抓取,不仅节省了人力,还提高了抓取的正确率。
虽然以上描述了本发明的具体实施方式,但是本领域的技术人员应当理解,这仅是举例说明,本发明的保护范围是由所附权利要求书限定的。本领域的技术人员在不背离本发明的原理和实质的前提下,可以对这些实施方式做出多种变更或修改,但这些变更和修改均落入本发明的保护范围。
Claims (12)
1.一种机器人的抓取方法,其特征在于,所述机器人包括相机和机器人手臂,所述抓取方法包括:
S1、将标定块放置到产品放置位置;
所述标定块与所述产品的尺寸相同,所述标定块上有标定点,所述标定点在所述标定块上的位置与产品抓取点在所述产品上的位置相同;
S2、打开所述相机,通过所述相机获取包括所述标定块的图像,移动所述相机使相机的图像中心与所述标定点重合;
S3、取走所述标定块,在所述产品放置位置放入一样本产品,所述样本产品上设有位置识别点;
S4、控制所述相机拍摄所述样本产品的图像,根据所述样本产品的图像获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系;
S5、控制所述相机拍摄一待抓取产品的图像,根据所述待抓取产品的图像获取所述待抓取产品相对于所述产品放置位置的偏转角度;
S6、根据所述相对位置关系和所述偏转角度获取所述待抓取产品的产品抓取点,控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
2.如权利要求1所述的机器人的抓取方法,其特征在于,所述机器人还包括图像处理器;步骤S2包括:
S21、所述相机将所述标定块的图像发送至所述图像处理器,所述图像处理器根据所述标定块的图像生成相机移动路线并发送至所述机器人;
S22、所述机器人在接收到所述相机移动路线后控制所述相机移动,使所述相机的图像中心与所述标定点重合。
3.如权利要求2所述的机器人的抓取方法,其特征在于,步骤S4包括:
S41、所述相机将所述样本产品的图像发送至所述图像处理器,所述图像处理器根据所述样本产品的图像建立直角坐标系;
S42、根据所述样本产品的图像获取所述样本产品的尺寸,并根据所述样本产品的尺寸获取所述样本产品的产品抓取点在所述直角坐标系中的第一坐标;
S43、根据所述样本产品的图像获取所述样本产品的位置识别点在所述直角坐标系中的第二坐标;
S44、根据所述第一坐标和所述第二坐标获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系。
4.如权利要求3所述的机器人的抓取方法,其特征在于,步骤S6包括:
S61、所述相机将所述待抓取产品的图像发送至所述图像处理器,所述图像处理器根据所述待抓取产品的图像获取所述待抓取产品的位置识别点在所述直角坐标系中的第三坐标;
S62、判断所述第二坐标和所述第三坐标是否相同且所述偏转角度是否为0度,若是,则所述第一坐标为所述待抓取产品的产品抓取点的坐标,执行步骤S64,若否,则执行步骤S63;
S63、根据所述第一坐标、所述第三坐标、所述偏转角度和所述相对位置关系获取所述待抓取产品的产品抓取点的坐标;
S64、控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
5.如权利要求4所述的机器人的抓取方法,其特征在于,步骤S63包括:
S631、根据所述第一坐标、所述第三坐标和所述偏转角度获取偏转位置识别点在所述直角坐标系中的第四坐标;
所述偏转位置识别点为由所述待抓取产品的位置识别点出发,沿着以所述第一坐标为圆心,以所述第一坐标至所述第三坐标的长度为半径的圆上旋转所述偏转角度后得到的点;
旋转方向与所述待抓取产品相对于所述产品放置位置的偏转方向相反;
S632、根据所述第四坐标和所述相对位置关系获取偏转产品抓取点在所述直角坐标系中的第五坐标;
所述偏转产品抓取点和所述偏转位置识别点的相对位置关系与所述样本产品的产品抓取点和位置识别点的相对位置关系相同;
S633、根据所述第一坐标、所述第五坐标和所述偏转角度获取在所述直角坐标系中的第六坐标;
所述第六坐标为所述待抓取产品的产品抓取点的坐标。
6.如权利要求4所述的机器人的抓取方法,其特征在于,步骤S64包括:
S641、所述图像处理器根据所述待抓取产品的产品抓取点的坐标生成机器人手臂移动路线并发送至所述机器人;
S642、所述机器人在接收到所述机器人手臂移动路线后控制所述机器人手臂移动至所述待抓取产品的位置。
7.一种机器人的抓取系统,其特征在于,所述机器人包括相机和机器人手臂,所述机器人的抓取系统包括:
放置单元,用于将标定块放置到产品放置位置;所述标定块与所述产品的尺寸相同,所述标定块上有标定点,所述标定点在所述标定块上的位置与产品抓取点在所述产品上的位置相同;
相机定位单元,用于打开所述相机,通过所述相机获取包括所述标定块的图像,移动所述相机使相机的图像中心与所述标定点重合;
所述放置单元还用于取走所述标定块,在所述产品放置位置放入一样本产品,所述样本产品上设有位置识别点;
相对位置关系获取单元,用于控制所述相机拍摄所述样本产品的图像,根据所述样本产品的图像获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系;
偏转角度获取单元,用于控制所述相机拍摄一待抓取产品的图像,根据所述待抓取产品的图像获取所述待抓取产品相对于所述产品放置位置的偏转角度
产品抓取单元,用于根据所述相对位置关系和所述偏转角度获取所述待抓取产品的产品抓取点,控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
8.如权利要求7所述的机器人的抓取系统,其特征在于,所述机器人还包括图像处理器;所述相机定位单元包括:
相机移动路线生成模块,用于所述相机将所述标定块的图像发送至所述图像处理器,所述图像处理器根据所述标定块的图像生成相机移动路线并发送至所述机器人;
相机移动模块,用于所述机器人在接收到所述相机移动路线后控制所述相机移动,使所述相机的图像中心与所述标定点重合。
9.如权利要求8所述的机器人的抓取系统,其特征在于,所述相对位置关系获取单元包括:
直角坐标系建立模块,用于所述相机将所述样本产品的图像发送至所述图像处理器,所述图像处理器根据所述样本产品的图像建立直角坐标系;
第一坐标获取模块,用于根据所述样本产品的图像获取所述样本产品的尺寸,并根据所述样本产品的尺寸获取所述样本产品的产品抓取点在所述直角坐标系中的第一坐标;
第二坐标获取模块,用于根据所述样本产品的图像获取所述样本产品的位置识别点在所述直角坐标系中的第二坐标;
相对位置关系获取模块,用于根据所述第一坐标和所述第二坐标获取所述样本产品的产品抓取点和所述位置识别点的相对位置关系。
10.如权利要求9所述的机器人的抓取系统,其特征在于,所述产品抓取单元包括第三坐标获取模块、判断模块、产品抓取点获取模块和产品抓取模块;
所述第三坐标获取模块,用于所述相机将所述待抓取产品的图像发送至所述图像处理器,所述图像处理器根据所述待抓取产品的图像获取所述待抓取产品的位置识别点在所述直角坐标系中的第三坐标;
所述判断模块,用于判断所述第二坐标和所述第三坐标是否相同且所述偏转角度是否为0度,若是,则所述第一坐标为所述待抓取产品的产品抓取点的坐标,调用所述产品抓取模块;若否,则调用所述产品抓取点获取模块;
所述产品抓取点获取模块,用于根据所述第一坐标、所述第三坐标、所述偏转角度和所述相对位置关系获取所述待抓取产品的产品抓取点的坐标;
所述产品抓取模块,用于控制所述机器人手臂移动至所述待抓取产品的产品抓取点的位置处,并抓取所述待抓取产品。
11.如权利要求10所述的机器人的抓取系统,其特征在于,所述产品抓取点获取模块包括:
第四坐标获取子模块,用于根据所述第一坐标、所述第三坐标和所述偏转角度获取偏转位置识别点在所述直角坐标系中的第四坐标;
所述偏转位置识别点为由所述待抓取产品的位置识别点出发,沿着以所述第一坐标为圆心,以所述第一坐标至所述第三坐标的长度为半径的圆上旋转所述偏转角度后得到的点;
旋转方向与所述待抓取产品相对于所述产品放置位置的偏转方向相反;
第五坐标获取子模块,用于根据所述第四坐标和所述相对位置关系获取偏转产品抓取点在所述直角坐标系中的第五坐标;
所述偏转产品抓取点和所述偏转位置识别点的相对位置关系与所述样本产品的产品抓取点和位置识别点的相对位置关系相同;
第六坐标获取子模块,用于根据所述第一坐标、所述第五坐标和所述偏转角度获取在所述直角坐标系中的第六坐标;
所述第六坐标为所述待抓取产品的产品抓取点的坐标。
12.如权利要求10所述的机器人的抓取系统,其特征在于,所述产品抓取模块包括:
机器人手臂移动路线生成子模块,用于所述图像处理器根据所述待抓取产品的产品抓取点的坐标生成机器人手臂移动路线并发送至所述机器人;
机器人手臂移动子模块,用于所述机器人在接收到所述机器人手臂移动路线后控制所述机器人手臂移动至所述待抓取产品的位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811644025.XA CN111376239B (zh) | 2018-12-29 | 2018-12-29 | 机器人的抓取方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811644025.XA CN111376239B (zh) | 2018-12-29 | 2018-12-29 | 机器人的抓取方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111376239A CN111376239A (zh) | 2020-07-07 |
CN111376239B true CN111376239B (zh) | 2023-06-27 |
Family
ID=71219436
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811644025.XA Active CN111376239B (zh) | 2018-12-29 | 2018-12-29 | 机器人的抓取方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111376239B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1873572A (zh) * | 2005-05-31 | 2006-12-06 | 本田汽车研究学院欧洲股份有限公司 | 操纵装置轨迹的控制 |
FR2896441A1 (fr) * | 2006-01-23 | 2007-07-27 | Jerome Grosbois | Procede et systeme permettant la prehension automatisee de piece(s) |
CN101896321A (zh) * | 2007-12-15 | 2010-11-24 | Abb股份公司 | 对象的位置获取 |
CN102202837A (zh) * | 2008-10-06 | 2011-09-28 | Abb股份公司 | 用于操作安装在操作器械处的工具的装置和方法 |
CN107148639A (zh) * | 2015-09-15 | 2017-09-08 | 深圳市大疆创新科技有限公司 | 确定跟踪目标的位置信息的方法及装置、跟踪装置及系统 |
CN107243897A (zh) * | 2017-06-23 | 2017-10-13 | 昆明理工大学 | 一种工业机器人的标定系统及方法 |
CN108122257A (zh) * | 2016-11-28 | 2018-06-05 | 沈阳新松机器人自动化股份有限公司 | 一种机器人手眼标定方法及装置 |
-
2018
- 2018-12-29 CN CN201811644025.XA patent/CN111376239B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1873572A (zh) * | 2005-05-31 | 2006-12-06 | 本田汽车研究学院欧洲股份有限公司 | 操纵装置轨迹的控制 |
FR2896441A1 (fr) * | 2006-01-23 | 2007-07-27 | Jerome Grosbois | Procede et systeme permettant la prehension automatisee de piece(s) |
CN101896321A (zh) * | 2007-12-15 | 2010-11-24 | Abb股份公司 | 对象的位置获取 |
CN102202837A (zh) * | 2008-10-06 | 2011-09-28 | Abb股份公司 | 用于操作安装在操作器械处的工具的装置和方法 |
CN107148639A (zh) * | 2015-09-15 | 2017-09-08 | 深圳市大疆创新科技有限公司 | 确定跟踪目标的位置信息的方法及装置、跟踪装置及系统 |
CN108122257A (zh) * | 2016-11-28 | 2018-06-05 | 沈阳新松机器人自动化股份有限公司 | 一种机器人手眼标定方法及装置 |
CN107243897A (zh) * | 2017-06-23 | 2017-10-13 | 昆明理工大学 | 一种工业机器人的标定系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111376239A (zh) | 2020-07-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10980606B2 (en) | Remote-control manipulator system and method of operating the same | |
CN110125926B (zh) | 自动化的工件取放方法及系统 | |
JP2022028672A (ja) | ロボットモーション用のビジョンシステムの自動ハンドアイ校正のためのシステム及び方法 | |
WO2017015898A1 (zh) | 用于机器人拆垛设备的控制系统和用于控制机器人拆垛的方法 | |
CN109052180B (zh) | 一种基于机器视觉的集装箱自动对位方法及系统 | |
CN106945047A (zh) | 焊接机器人误差补偿控制系统及其控制方法 | |
US20140277694A1 (en) | Robot system and method for producing to-be-processed material | |
CN109926817B (zh) | 基于机器视觉的变压器自动装配方法 | |
JP2014180720A (ja) | ロボットシステム及びキャリブレーション方法 | |
CN108269322B (zh) | 一种巡检方法 | |
WO1987000310A1 (en) | Robot control system | |
CN106695784A (zh) | 一种机器人视觉控制系统 | |
CN112775975A (zh) | 一种视觉引导的多工位机器人焊接纠偏装置及方法 | |
CN110303474B (zh) | 使用图像处理修正机器人的示教的机器人系统 | |
JP5428922B2 (ja) | ハンガーラインへのワーク供給装置及び方法 | |
CN111390910A (zh) | 机械手目标抓取定位方法、计算机可读存储介质及机械手 | |
CN111376239B (zh) | 机器人的抓取方法及系统 | |
CN113084793A (zh) | 一种采用视觉引导的多关节机器人及引导方法 | |
CN106926241A (zh) | 一种基于视觉引导的双臂机器人装配方法及系统 | |
CN114347015A (zh) | 一种机器人抓取控制方法、系统、装置及介质 | |
JPH089151B2 (ja) | 無人搬送車搭載ロボツトの位置補正方法 | |
CN113015604B (zh) | 机器人控制系统及机器人控制方法 | |
JP5428921B2 (ja) | ハンガーラインからのワーク回収装置及び方法 | |
JP2015003348A (ja) | ロボット制御システム、制御装置、ロボット、ロボット制御システムの制御方法及びロボットの制御方法 | |
CN116000942A (zh) | 一种基于多轴协作机器人的半导体制造系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |