CN106276285B - 组料垛位自动检测方法 - Google Patents
组料垛位自动检测方法 Download PDFInfo
- Publication number
- CN106276285B CN106276285B CN201510290538.5A CN201510290538A CN106276285B CN 106276285 B CN106276285 B CN 106276285B CN 201510290538 A CN201510290538 A CN 201510290538A CN 106276285 B CN106276285 B CN 106276285B
- Authority
- CN
- China
- Prior art keywords
- transfer robot
- group material
- optoelectronic switch
- group
- collecting machine
- 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
Abstract
组料垛位自动检测方法,在搬运机器人末端法兰安装的端拾器上安装一个测距传感器和两个光电开关,其中测距传感器用于端拾器与组料之间限定高度距离测量,光电开关用于检测组料的X、Y方向的边部位置并产生输出信号。本发明使用安装在搬运机器人末端的端拾器上的测距传感器和光电开关测定组料相对于搬运机器人基坐标系下位置和角度偏移量,以此提高搬运机器人搬运组料作业精度。
Description
技术领域
本发明涉及搬运机器人领域,特别涉及组料垛位自动检测方法,即组料相对于搬运机器人基坐标系的位置标定。
背景技术
在机器人技术领域,可将视觉(CCD相机或者COMS相机)传感器安装在机械人末端执行机构上,用来测量组料的空间位置、形状等三维或二维信息用于获取组料的位置、形状、空间分布等信息。当将视觉传感器用于组料的信息检测时,需要进行摄像机标定、图像采集、特征提取、立体匹配、3D信息恢复、后处理等过程,会耗时很多并需要专用的摄像机、图像采集卡、高速运算模块和CPU模块等或集成一体的智能工业相机,针对不同的组料都需要重新标定,光照条件引入的误差也不可忽视。同时,当组料尺寸较大时,可能由于图像失真、像素分辨低等原因,影响最终的测量精度。
中国专利CN201420343094公开了一种车身外覆盖件视觉检测自动定位装置,整个装置中用到了4个摄像机,通过此种视觉检测方式,能够得到较为全面的组料信息,适用范围比较广泛。但针对一些特定情况,例如只需测定少量参数时,这种检测方式成本高、整个过程耗时长,如针对不同尺寸的组料需要重新标定。
中国专利CN201310678018公开了一种基于SURF算法进行定位的方法及机器人,提供了一种采用SURF作为单目视觉SLAM的特征检测算子,分别从感兴趣点的检测、SURF描述子的生成及SURF点匹配等三个方面进行了创新和改进,提出了基于区域增长的SURF特征匹配方法完成机器人的同时定位与地图创建,使得在SURF描述子匹配过程中,某一描述子仅与最可能与之匹配的描述子进行比对,从而显著的减少了单目视觉SLAM问题中的比对次数,提高了匹配速度。从中可知视觉检测效果及实现一定程度依赖于软件的复杂底层算法。
发明内容
本发明的目的在于提供一种组料垛位自动检测方法,通过在搬运机器人端拾器上安装光电开关检测组料位置,用于组料的位置检测及其确认,以此提高搬运机器人搬运堆垛的作业精度。
为达到上述目的,本发明的技术方案是:
组料垛位自动检测方法,其包括:
a)对应组料垛位的搬运机器人末端法兰上安装的端拾器上安装一个用于端拾器与组料之间限定高度距离测量的测距传感器和两个用于检测组料的X、Y方向的边部位置并产生输出信号的光电开关,X、Y方向两个光电开关相对于搬运机器人末端工具中心点TCP(Tool Centre Position)的位置固定;为了限定组料在组料垛位的位置,在组料垛位的X、Y方向分别做限定标记线Xlim1、Xlim2和Ylim1、Ylim2,每次作业前需将组料运输至垛位限定标记线内;对测距传感器设定其触发高度H1,即距离测距传感器光束正下方H1有物体时,测距传感器将输出信号;在搬运机器人控制器内设置组料边部检测的高度值H2(H2<H1);
b)搬运机器人携带端拾器按预设位置到达组料正上方,垂直下降,一旦到达测距传感器的限定高度时H1,转入步骤(c);
c)为了提高搬运机器人对组料X、Y边部位置的测量精度,搬运机器人末端端拾器继续垂直下降至限定高度H2,以下测量过程搬运机器人末端高度保持在限定高度H2进行;
d)搬运机器人携带端拾器到达组料垛位限定标记线Xlim1位置,沿Y轴方向移动,直至X方向光电开关第一次扫描到组料X方向边部(此时光电开关光束将会被组料遮挡并产生输出信号),在光电开关产生输出信号的同时搬运机器人控制器内部将记录此时搬运机器人末端工具中心点TCP位置值(X1,Y1),结合X方向光电开关与工具中心点TCP的相对位置关系可求得此时X方向光电开关的位置值(X′1,Y′1),此值同时也是组料X方向边部一点的水平面内的坐标值,然后搬运机器人将携带端拾器沿Y轴方向回到Xlim1位置;
e)搬运机器人携带端拾器沿标记线Xlim1方向移动规定距离L1,再次沿Y轴方向移动,直至X方向光电开关再次扫描到组料X方向边部(此时光电开关光束将会被组料遮挡并产生输出信号),在光电开关产生输出信号的同时搬运机器人控制器内部将记录此时搬运机器人末端工具中心点TCP位置值(X2,Y2),结合X方向光电开关与工具中心点TCP的相对位置关系可求得此时光电开关的位置值(X′2,Y′2)此值同时也是组料X方向边部一点的水平面内的坐标值,然后搬运机器人将携带端拾器沿Y轴方向回到Xlim1位置;
f)搬运机器人携带端拾器沿标记线Xlim1方向移动规定距离L2,沿X轴反方向移动,直至Y方向光电开关扫描到组料Y方向边部(此时光电开关光束将会被组料遮挡并产生输出信号),在光电开关产生输出信号的同时搬运机器人控制器内部将记录此时搬运机器人末端工具中心点TCP位置值(X3,Y3),结合Y方向光电开关与工具中心点TCP的相对位置关系可求得此时Y方向光电开关的位置值(X′3,Y′3),此值同时也是组料X方向边部一点的水平面内的坐标值,然后搬运机器人将携带端拾器沿X轴方向回到Ylim1位置;
g)通过以上获得组料边部的X方向两点数据(X′1,Y′1)、(X′2,Y′2)和Y方向一点数据(X′3,Y′3)可以求得在搬运机器人基坐标系下组料长边所在直线的斜率和组料被测长边宽边交点的位置,与已知组料长度l和宽度w进而可以求得在半月板机器人基坐标系下的组料中心位置和组料偏转角度的具体数值,从而修正搬运机器人末端端拾器位置,进行精确组料搬运作业;
h)测量完毕后搬运机器人携带端拾器回到待机位。
在本发明方法中:
在端拾器X、Y二个方向各设置一个光电开关用于组料的边部位置检测,其中光电开关的测量方向、发射接收方向与测量边垂直;为了保证测量精度和测量过程的安全性,在搬运机器人末端端拾器上安装测距传感器,其中测距传感器的测量方向、发射接收方向与组料水平面垂直,此测距传感器在测量到规定距离时会触发一输出信号。传感器的位置固定,且每组组料只需标定一次即可。
本发明的优点在于:
本发明通过在端拾器的X、Y二个方向固定光电开关,对每一组组料进行一次测量,即可获得组料在搬运机器人基坐标系的位置。使用这种方法,搬运机器人搬运堆垛作业可靠性、作业精度更高且过程更为方便。
附图说明
图1为本发明X、Y方向光电开关和测距传感器的布置示意图。
图2为本发明组料原垛垛位台面标线和组料的相对位置关系图。
图3~图18为本发明测量过程示意图。
具体实施方式
参见图1、图2,本发明在端拾器1的中间位置安装一个测距传感器2用于测量端拾器与组料之间的距离,并在X、Y二个方向各布置一个光电开关3和光电开关4用于组料100的边部检测;搬运机器人携带端拾器1在测距传感器2的测量规定高度下并在组料100的X、Y二个方向分别运动,光电开关3、4的测量方向、发射接收方向与组料边部垂直,测距传感器2的测量方向、发射接收方向与组料的上表面垂直,通过测量获得组料X方向和Y方向的不同点的坐标值,以此计算获得组料100的位置。
在测量实施之前应首先在组料的堆垛台面200用标记笔等作出四条标记线,具体的位置参见图2。
参见图3~图18,本发明的测量过程,包括:
首先,X方向光电开关3在组料100的X方向上沿Y轴方向相距L1的两个位置分别做往返运动,在往返运动过程中,光电开关一旦检测到其垂直下方有组料时,光电开关的发射光束将会被阻挡,此时光电开关将会产生输出信号,在光电开关的产生输出信号的同时搬运机器人控制器将会记录此时搬运机器人末端工具中心点TCP位置值(X1,Y1)和(X2,Y2),并通过光电开关3与工具中心点TCP的相对位置可求得光电开关3输出信号时的光电开关的其水平面内的位置即产生信号的组料边部X方向两点的坐标(X′1,Y′1)和(X′2,Y′2),从而可以求得在搬运机器人基坐标系下的组料100沿X方向的边部所在直线的代数表达式。
然后,Y方向光电开关4在组料100的Y方向上沿X轴方向做一次往返运动,光电开关一旦检测到其垂直下方有组料时,光电开关的发射光束将会被阻挡,此时光电开关将会产生输出信号,在光电开关的产生输出信号的同时搬运机器人控制器将会记录此时搬运机器人末端工具中心点TCP位置值(X3,Y3),并通过Y方向光电开关4与工具中心点TCP的相对位置求得触发信号时光电开关的位置值同时也是产生信号的组料100沿Y方向边部一点的坐标(X′3,Y′3)。
以上获得的同一平面不共线的组料边部上的三点(参见图18)可以确定组料在搬运机器人基坐标系的具体位置。
Claims (1)
1.组料垛位自动检测方法,其特征是,包括:
a)对应组料垛位的搬运机器人末端法兰安装的端拾器上安装一个用于端拾器与组料之间限定高度距离测量的测距传感器和两个用于检测组料的X、Y方向的边部位置并产生输出信号的光电开关,X、Y方向两个光电开关相对于搬运机器人末端工具中心点TCP的位置固定;为了限定组料在组料垛位的位置,在组料垛位的X、Y方向分别做限定标记线Xlim1、Xlim2和Ylim1、Ylim2,每次作业前需将组料运输至垛位限定标记线内;对测距传感器设定其触发高度H1,即距离测距传感器光束正下方H1有物体时,测距传感器将输出信号;在搬运机器人控制器内设置组料边部检测的高度值H2,H2<H1;
b)搬运机器人携带端拾器按预设位置到达组料正上方,垂直下降,一旦到达测距传感器的限定高度时H1,转入步骤(c);
c)为了提高搬运机器人对组料X、Y边部位置的测量精度,搬运机器人末端端拾器继续垂直下降至限定高度H2,以下测量过程搬运机器人末端高度保持在限定高度H2进行;
d)搬运机器人携带端拾器到达组料垛位限定标记线Xlim1位置,沿Y轴方向移动,直至X方向光电开关第一次扫描到组料X方向边部,此时光电开关光束将会被组料遮挡并产生输出信号;在光电开关产生输出信号的同时搬运机器人控制器内部将记录此时搬运机器人末端工具中心点TCP位置值(X1,Y1),结合X方向光电开关与工具中心点TCP的相对位置关系可求得此时X方向光电开关的水平面内的位置值(X′1,Y′1),此值也是组料X方向边部一点的水平面内的坐标值,然后搬运机器人将携带端拾器沿Y轴方向回到Xlim1位置;
e)搬运机器人携带端拾器沿标记线Xlim1方向移动规定距离L1,再次沿Y轴方向移动,直至X方向光电开关再次扫描到组料X方向边部,此时光电开关光束将会被组料遮挡并产生输出信号,在光电开关产生输出信号的同时搬运机器人控制器内部将记录此时搬运机器人末端工具中心点TCP位置值(X2,Y2),结合X方向光电开关与工具中心点TCP的相对位置关系可求得此时光电开关的位置值(X′2,Y′2),此值同时也是组料X方向边部一点的水平面内的坐标值,然后搬运机器人将携带端拾器沿Y轴方向回到Xlim1位置;
f)搬运机器人携带端拾器沿标记线Xlim1方向移动规定距离L2,沿X轴反方向移动,直至Y方向光电开关扫描到组料Y方向边部,此时光电开关光束将会被组料遮挡并产生输出信号,在光电开关产生输出信号的同时搬运机器人控制器内部将记录此时搬运机器人末端工具中心点TCP位置值(X3,Y3),结合Y方向光电开关与工具中心点TCP的相对位置关系可求得此时Y方向光电开关的位置值(X′3,Y′3),此值同时为组料Y方向边部一点的水平面坐标值,然后搬运机器人将携带端拾器沿X轴方向回到Ylim1位置;
g)通过以上获得数据(X′1,Y′1)、(X′2,Y′2)和(X′3,Y′3),即为组料沿X方向边部的两点的坐标值(X′1,Y′1)、(X′2,Y′2)和沿Y方向边部一点的坐标值(X′3,Y′3),从而可以求得在搬运机器人基坐标系下组料长边所在直线的斜率和组料被测长边宽边交点的位置,然后联合已知组料长度l和宽度w进而可以求得在搬运机器人基坐标系下的组料中心位置和组料偏转角度的具体数值,从而修正搬运机器人末端端拾器位置,进行精确组料搬运作业;
h)测量完毕后搬运机器人携带端拾器回到待机位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510290538.5A CN106276285B (zh) | 2015-05-29 | 2015-05-29 | 组料垛位自动检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510290538.5A CN106276285B (zh) | 2015-05-29 | 2015-05-29 | 组料垛位自动检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106276285A CN106276285A (zh) | 2017-01-04 |
CN106276285B true CN106276285B (zh) | 2018-07-06 |
Family
ID=57656320
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510290538.5A Active CN106276285B (zh) | 2015-05-29 | 2015-05-29 | 组料垛位自动检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106276285B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109324616B (zh) * | 2018-09-20 | 2021-06-18 | 同济大学 | 基于车载传感器的无人泊车搬运机器人的对位方法 |
CN111928787B (zh) * | 2020-08-04 | 2022-03-25 | 歌尔光学科技有限公司 | 高度测量方法、测量设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101100061A (zh) * | 2006-07-03 | 2008-01-09 | 发那科株式会社 | 测量装置以及校准方法 |
CN101308015A (zh) * | 2008-07-09 | 2008-11-19 | 北京理工大学 | 基于光幕式激光器的高精度位姿检测方法与装置 |
CN103107121A (zh) * | 2013-01-30 | 2013-05-15 | 福建省威诺数控有限公司 | 一种基于视觉的晶圆角度偏差自动校正方法 |
CN103293867A (zh) * | 2012-03-05 | 2013-09-11 | 上海微电子装备有限公司 | 一种方形基板预对准装置及方法 |
CN104634372A (zh) * | 2015-02-15 | 2015-05-20 | 易测智能科技(天津)有限公司 | 移动终端测试用的终端定位装置及定位方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06219556A (ja) * | 1993-01-22 | 1994-08-09 | Sekisui Chem Co Ltd | ロボットパレタイザ |
JPH09194036A (ja) * | 1996-01-17 | 1997-07-29 | Canon Inc | トレー移載装置および方法 |
-
2015
- 2015-05-29 CN CN201510290538.5A patent/CN106276285B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101100061A (zh) * | 2006-07-03 | 2008-01-09 | 发那科株式会社 | 测量装置以及校准方法 |
CN101308015A (zh) * | 2008-07-09 | 2008-11-19 | 北京理工大学 | 基于光幕式激光器的高精度位姿检测方法与装置 |
CN103293867A (zh) * | 2012-03-05 | 2013-09-11 | 上海微电子装备有限公司 | 一种方形基板预对准装置及方法 |
CN103107121A (zh) * | 2013-01-30 | 2013-05-15 | 福建省威诺数控有限公司 | 一种基于视觉的晶圆角度偏差自动校正方法 |
CN104634372A (zh) * | 2015-02-15 | 2015-05-20 | 易测智能科技(天津)有限公司 | 移动终端测试用的终端定位装置及定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106276285A (zh) | 2017-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110322457B (zh) | 一种2d与3d视觉结合的拆垛方法 | |
CN110497187B (zh) | 基于视觉引导的太阳花模组装配系统 | |
CN108177143B (zh) | 一种基于激光视觉引导的机器人定位抓取方法及系统 | |
CN102735166B (zh) | 三维扫描仪和机器人系统 | |
JP5282717B2 (ja) | ロボットシステム | |
JP5469216B2 (ja) | バラ積みされた物品をロボットで取出す装置 | |
US8310539B2 (en) | Calibration method and calibration device | |
KR102056664B1 (ko) | 센서를 이용한 작업 방법 및 이를 수행하는 작업 시스템 | |
CN104786226A (zh) | 抓取在线工件的机器人位姿及运动轨迹定位系统与方法 | |
CN108592816B (zh) | 一种用于大尺寸表面的三维测量装置和方法 | |
CN102853786A (zh) | 平整度检测装置和方法 | |
EP3910593A1 (en) | Image processing device, work robot, substrate inspection device, and specimen inspection device | |
CN106097316A (zh) | 激光划片机图像识别系统的基板位置识别处理方法 | |
WO2021163219A1 (en) | Composite three-dimensional blob tool and method for operating the same | |
CN106276285B (zh) | 组料垛位自动检测方法 | |
CN105783710B (zh) | 一种位置标定的方法及装置 | |
CN109352646B (zh) | 纱线自动装卸方法及系统 | |
CN103600353A (zh) | 一种端拾器对组料边部检测的方法 | |
CN108180825B (zh) | 一种基于线结构光的长方体形物体三维识别与定位方法 | |
CN113198691A (zh) | 一种基于3d线激光和ccd的高精度大视野点胶方法及装置 | |
CN102069821B (zh) | 非接触式钢轨中垂面的测量方法 | |
CN209342062U (zh) | 3d视觉引导拆垛测量系统 | |
CN114918723B (zh) | 基于表面检测的工件定位控制系统及方法 | |
CN110726402A (zh) | 非正交轴系激光全站仪的激光点视觉引导方法 | |
CN206224038U (zh) | 提供检查与量测的自动对焦装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |