指尖视觉棱线识别自适应机器人手装置转让专利
申请号 : CN201610640748.7
文献号 : CN106182054B
文献日 : 2018-11-30
发明人 : 曾宝莹 , 张文增 , 蔡基锋 , 梁伟东 , 杨沛 , 袁晨峰
申请人 : 广州市轻工职业学校
摘要 :
权利要求 :
1.一种指尖视觉棱线识别自适应机器人手装置,包括基座、第一电机、第一传动机构、第一关节轴、手掌、第一手指和第二手指;所述第一电机固接在基座上,所述第一电机的输出轴与第一传动机构的输入端相连,所述第一传动机构的输出端与第一关节轴相连,所述第一关节轴套设在基座中,所述手掌套固在第一关节轴上;所述手掌分别与第一手指、第二手指相连;所述第一手指与第二手指对称布置,其对称轴为第一关节轴的中心线;所述第一手指、第二手指分别具有至少一个平动关节;抓取物体时,所述第一手指、第二手指分别沿着第一关节轴垂直方向移动,所述第二手指和第一手指相向运动;其特征在于:该指尖视觉棱线识别自适应机器人手装置还包括第一摄像机、第二摄像机、第一图像处理模块、第二图像处理模块、控制器、第一驱动模块、第二驱动模块和第三驱动模块;所述第一手指包括第一手指基座、第二电机、第一手指末端指段、第一远关节轴和第二传动机构;所述第二手指包括第二手指基座、第三电机、第二手指末端指段、第二远关节轴和第三传动机构;所述第二电机固接在第一手指基座上,所述第二电机的输出轴与第二传动机构的输入端相连,所述第二传动机构的输出端与第一远关节轴相连,所述第一远关节轴套设在第一手指基座上,所述第一手指末端指段套接在第一远关节轴上;所述第一手指基座固接在手掌上,所述第一摄像机安装在第一手指末端指段上,设第一手指末端指段与物体接触的表面为Q1,第一摄像机的镜头光轴垂直于Q1;所述第三电机固接在第二手指基座上,所述第三电机的输出轴与第三传动机构的输入端相连,所述第三传动机构的输出端与第二远关节轴相连,所述第二远关节轴套设在第二手指基座上,所述第二手指末端指段套接在第二远关节轴上;
所述第二手指基座固接在手掌上,所述第二摄像机安装在第二手指末端指段上,设第二手指末端指段与物体接触的表面为Q2,第二摄像机的镜头光轴垂直于Q2;所述控制器分别与第一图像处理模块、第二图像处理模块相连;所述控制器分别与第一驱动模块、第二驱动模块和第三驱动模块相连;所述第一摄像机的信号引出端与第一图像处理模块的信号输入端连接,所述第二摄像机的信号引出端与第二图像处理模块的信号输入端连接;所述第一摄像机采集待抓物体的一侧图像,所述第二摄像机采集待抓物体的另一侧图像;所述控制器接收到抓取信号后执行抓取方法;所述第一图像处理模块运行第一图像处理程序,所述第二图像处理模块运行第二图像处理程序;
所述第一图像处理程序包括顺序执行如下步骤:
a1:拍摄得到图像I11,对I11进行图像边缘提取,获取含有边缘点的结果图像I12;
b1:针对I12,进行棱线检测,获取待抓物体棱线K1在图像上的位置和方向,则进行下一步;若在I12中未发现棱线K1,则设定标志位P1=0,执行d1步骤;
c1:当I12中棱线K1穿过预设的可抓区域H1,设定标志位P1=1;否则,设定标志位P1=
0;
d1:计算I11的平均灰度值T1,当T1低于预设阈值T,则设定标志位S1=1,否则设定标志位S1=0,第一图像处理程序结束;
所述第二图像处理程序包括顺序执行如下步骤:
a2:拍摄得到图像I21,对I21进行图像边缘提取,获取含有边缘点的结果图像I22;
b2:针对I22,进行棱线检测,获取待抓物体棱线K2在图像上的位置和方向,则进行下一步;若在I22中未发现棱线K2,则设定标志位P2=0,执行d2步骤;
c2:当I22中棱线K2穿过预设的可抓区域H2,设定标志位P2=1;否则,设定标志位P2=
0;
d2:计算I21的平均灰度值T2,当T2低于预设阈值T,则设定标志位S2=1,否则设定标志位S2=0,第二图像处理程序结束;
所述抓取方法包括顺序执行如下步骤:
a3:执行第一图像处理程序和第二图像处理程序,获取P1、P2、S1和S2;
b3:若P1=0且P2=0,执行步骤d3,否则执行下一步;
c3:发出指令驱动第一电机转动小角度,返回步骤a3;
d3:驱动第一电机停转,驱动第二电机、第三电机转动;
e3:若S1=1,执行下一步,否则执行步骤g3;
f3:发出指令驱动第二电机停转;
g3:若S2=1,执行下一步,否则执行步骤i3;
h3:发出指令驱动第三电机停转;
i3:若S1=1,S2=1,执行步骤k3,否则执行下一步;
j3:返回步骤a3;
k3:抓取结束。
2.如权利要求1所述的指尖视觉棱线识别自适应机器人手装置,其特征在于:所述第二传动机构和第三传动机构均为杆轮式直线平夹机构;所述杆轮式直线平夹机构包括第一连杆、第二连杆、第三连杆、第一轴、第二轴、第三轴、第四轴、第一传动轮、第一柔性传动件、第二传动轮、第三传动轮、第二柔性传动件、第四传动轮;所述第一轴、第二轴、第三轴、第四轴的中心线与第一远关节轴的中心线平行;在第二传动机构中,所述第一远关节轴套设在第三连杆中;在第三传动机构中,所述第二远关节轴套设在第三连杆中;所述远关节轴套设在第三连杆中;所述第三连杆套接在第四轴上;所述第二电机的输出轴与第一轴相连,所述第一轴套设在手掌中;所述第一连杆套固在第一轴上;所述第二轴套设在第一连杆上,所述第三连杆的一端套接在第二轴上;所述第三轴套设在手掌中,所述第二连杆的一端套接在第三轴上,第二连杆的另一端套接在第四轴上;所述第四轴套设在第三连杆的中部;设第一轴的中心为点A,第二轴的中心为点B,第四轴的中心为点C,在第二传动机构中,第一远关节轴的中心为点D,在第三传动机构中,第二远关节轴的中心为点D,第三轴的中心为点E,线段BC的长度、线段CD的长度和线段CE的长度三者相等,线段AE的长度等于线段AB的长度的2倍,线段CE的长度是线段AB的长度的2.5倍;所述第一传动轮套接在第三轴上,所述第一传动轮固接在手掌上,所述第一柔性传动件分别连接第一传动轮、第二传动轮,所述第一柔性传动件呈“O”字形,所述第一柔性传动件、第一传动轮、第二传动轮三者构成传动关系,所述第二传动轮套接在第四轴上;所述第三传动轮套接在第四轴上,所述第二传动轮与第三传动轮固接,所述第二柔性传动件分别连接第三传动轮、第四传动轮,所述第二柔性传动件呈“O”字形,所述第二柔性传动件、第三传动轮、第四传动轮三者构成传动关系,在第二传动机构中,所述第四传动轮套固在第一远关节轴上,在第三传动机构中,所述第四传动轮套固在第二远关节轴上。
3.如权利要求2所述的指尖视觉棱线识别自适应机器人手装置,其特征在于:所述第一柔性传动件采用传动带、链条或绳,所述第一传动轮采用带轮、链轮或绳轮,所述第二传动轮采用带轮、链轮或绳轮,所述第一柔性传动件、第一传动轮、第二传动轮三者构成带轮传动关系、链轮传动关系或绳轮传动关系。
4.如权利要求2所述的指尖视觉棱线识别自适应机器人手装置,其特征在于:所述第二柔性传动件采用传动带、链条或绳,所述第三传动轮采用带轮、链轮或绳轮,所述第四传动轮采用带轮、链轮或绳轮,所述第二柔性传动件、第三传动轮、第四传动轮三者构成带轮传动关系、链轮传动关系或绳轮传动关系。
说明书 :
指尖视觉棱线识别自适应机器人手装置
技术领域
背景技术
力,部分具有感知能力的机器人手主要是利用触觉来实现,以及利用多个传感器检测各关
节的位置,从而达到手指各关节位置或速度的闭环反馈的稳定控制和控制精度。
作中的智能性。为了更好地抓取物体,传统的物体识别技术需要对物体进行复杂的图像处
理,包括视觉不变量图像处理算法(SIFT等)、特征角点检测方法(Harris等)、边缘点提取方法(Sobel、Canney、Robert、Prewits等)、直线检测方法(最小二乘拟合、Hough、GPI等)、侵蚀或膨胀等等。复杂的算法在不同的光照环境下,往往可靠性不高,成功率比较低,难以适用于更广泛的物体集合。
发明内容
该指尖视觉棱线识别自适应机器人手装置还包括第一摄像机、第二摄像机、第一图像处理
模块、第二图像处理模块、控制器、第一驱动模块、第二驱动模块和第三驱动模块;所述第一手指包括第一手指基座、第二电机、第一手指末端指段、第一远关节轴和第二传动机构;所述第二手指包括第二手指基座、第三电机、第二手指末端指段、第二远关节轴和第三传动机构;所述第二电机固接在第一手指基座上,所述第二电机的输出轴与第二传动机构的输入
端相连,所述第二传动机构的输出端与第一远关节轴相连,所述第一远关节轴套设在第一
手指基座上,所述第一手指末端指段套接在第一远关节轴上;所述第一手指基座固接在手
掌上,所述第一摄像机安装在第一手指末端指段上,设第一手指末端指段与物体接触的表
面为Q1,第一摄像机的镜头光轴垂直于Q1;所述第三电机固接在第二手指基座上,所述第三电机的输出轴与第三传动机构的输入端相连,所述第三传动机构的输出端与第二远关节轴
相连,所述第二远关节轴套设在第二手指基座上,所述第二手指末端指段套接在第二远关
节轴上;所述第二手指基座固接在手掌上,所述第二摄像机安装在第二手指末端指段上,设第二手指末端指段与物体接触的表面为Q2,第二摄像机的镜头光轴垂直于Q2;所述控制器
分别与第一图像处理模块、第二图像处理模块相连,所述控制器分别与第一驱动模块、第二驱动模块和第三驱动模块相连;所述第一摄像机的信号引出端与第一图像处理模块的信号
输入端连接,所述第二摄像机的信号引出端与第二图像处理模块的信号输入端连接;所述
第一摄像机采集待抓物体的一侧图像,所述第二摄像机采集待抓物体的另一侧图像;所述
控制器接收到抓取信号后执行抓取方法;所述第一图像处理模块运行第一图像处理程序,
所述第二图像处理模块运行第二图像处理程序;
杆、第二连杆、第三连杆、第一轴、第二轴、第三轴、第四轴、第一传动轮、第一柔性传动件、第二传动轮、第三传动轮、第二柔性传动件、第四传动轮;所述第一轴、第二轴、第三轴、第四轴的中心线与第一远关节轴的中心线平行;在第二传动机构中,所述第一远关节轴套设在第
三连杆中;在第三传动机构中,所述第二远关节轴套设在第三连杆中;所述远关节轴套设在第三连杆中;所述第三连杆套接在第四轴上;所述第二电机的输出轴与第一轴相连,所述第一轴套设在手掌中;所述第一连杆套固在第一轴上;所述第二轴套设在第一连杆上,所述第三连杆的一端套接在第二轴上;所述第三轴套设在手掌中,所述第二连杆的一端套接在第
三轴上,第二连杆的另一端套接在第四轴上;所述第四轴套设在第三连杆的中部;设第一轴的中心为点A,第二轴的中心为点B,第四轴的中心为点C,在第二传动机构中,第一远关节轴的中心为点D,在第三传动机构中,第二远关节轴的中心为点D,第三轴的中心为点E,线段BC的长度、线段CD的长度和线段CE的长度三者相等,线段AE的长度等于线段AB的长度的2倍,线段CE的长度是线段AB的长度的2.5倍;所述第一传动轮套接在第三轴上,所述第一传动轮固接在手掌上,所述第一柔性传动件分别连接第一传动轮、第二传动轮,所述第一柔性传动件呈“O”字形,所述第一柔性传动件、第一传动轮、第二传动轮三者构成传动关系,所述第二传动轮套接在第四轴上;所述第三传动轮套接在第四轴上,所述第二传动轮与第三传动轮
固接,所述第二柔性传动件分别连接第三传动轮、第四传动轮,所述第二柔性传动件呈“O”字形,所述第二柔性传动件、第三传动轮、第四传动轮三者构成传动关系,在第二传动机构中,所述第四传动轮套固在第一远关节轴上,在第三传动机构中,所述第四传动轮套固在第二远关节轴上。
结果自动调整手掌与手指的抓取方位;并根据是否接触的视觉反馈,自动控制不同手指的
运动,从而满足不居中物体的良好抓取。
附图说明
具体实施方式
入端相连,所述第一传动机构12的输出端与第一关节轴13相连,所述第一关节轴13套设在
基座1中,所述手掌14套固在第一关节轴13上;所述手掌14分别与第一手指2、第二手指3相连;所述第一手指2与第二手指3对称布置,其对称轴为第一关节轴13的中心线;所述第一手指2、第二手指3分别具有至少一个平动关节;抓取物体8时,所述第一手指2、第二手指3分别沿着第一关节轴13垂直方向移动,所述第二手指3和第一手指2相向运动;该指尖视觉棱线
识别自适应机器人手装置还包括第一摄像机41、第二摄像机42、第一图像处理模块51、第二图像处理模块52、控制器6、第一驱动模块71、第二驱动模块72和第三驱动模块73;所述第一手指2包括第一手指基座21、第二电机24、第一手指末端指段22、第一远关节轴23和第二传动机构25;所述第二手指3包括第二手指基座31、第三电机34、第二手指末端指段32、第二远关节轴33和第三传动机构;所述第二电机24固接在第一手指基座21上,所述第二电机24的
输出轴与第二传动机构25的输入端相连,所述第二传动机构25的输出端与第一远关节轴23
相连,所述第一远关节轴23套设在第一手指基座21上,所述第一手指末端指段22套接在第
一远关节轴23上;所述第一手指基座21固接在手掌14上,所述第一摄像机41安装在第一手
指末端指段22上,设第一手指末端指段22与物体8接触的表面为Q1,第一摄像机41的镜头光轴垂直于Q1;所述第三电机34固接在第二手指基座31上,所述第三电机34的输出轴与第三
传动机构的输入端相连,所述第三传动机构的输出端与第二远关节轴33相连,所述第二远
关节轴33套设在第二手指基座31上,所述第二手指末端指段32套接在第二远关节轴33上;
所述第二手指基座31固接在手掌14上,所述第二摄像机42安装在第二手指末端指段32上,
设第二手指末端指段32与物体8接触的表面为Q2,第二摄像机42的镜头光轴垂直于Q2;所述控制器6分别与第一图像处理模块51、第二图像处理模块52相连,如图10所示,所述控制器6分别与第一驱动模块71、第二驱动模块72和第三驱动模块73相连;所述第一摄像机41的信
号引出端与第一图像处理模块51的信号输入端连接,所述第二摄像机42的信号引出端与第
二图像处理模块52的信号输入端连接;所述第一摄像机41采集待抓物体8的一侧图像,所述第二摄像机42采集待抓物体8的另一侧图像;所述控制器6接收到抓取信号后执行抓取方
法;所述第一图像处理模块51运行第一图像处理程序,所述第二图像处理模块52运行第二
图像处理程序;
212、第三轴213、第四轴214、第一传动轮231、第一柔性传动件241、第二传动轮232、第三传动轮233、第二柔性传动件242、第四传动轮234;所述第一轴211、第二轴212、第三轴213、第四轴214的中心线与第一远关节轴23的中心线平行;在第二传动机构中,所述第一远关节轴套设在第三连杆223中;在第三传动机构中,所述第二远关节轴套设在第三连杆223中;所述第三连杆223套接在第四轴214上;所述第二电机24的输出轴与第一轴211相连,所述第一轴
211套设在手掌14中;所述第一连杆221套固在第一轴211上;所述第二轴212套设在第一连
杆221上,所述第三连杆223的一端套接在第二轴212上;所述第三轴213套设在手掌14中,所述第二连杆222的一端套接在第三轴213上,第二连杆222的另一端套接在第四轴214上;所
述第四轴214套设在第三连杆223的中部;设第一轴211的中心为点A,第二轴212的中心为点B,第四轴214的中心为点C,在第二传动机构中,第一远关节轴的中心为点D,在第三传动机构中,第二远关节轴的中心为点D,第三轴213的中心为点E,如图7和图8所示,线段BC的长度、线段CD的长度和线段CE的长度三者相等,线段AE的长度等于线段AB的长度的2倍,线段CE的长度是线段AB的长度的2.5倍;所述第一传动轮231套接在第三轴213上,所述第一传动轮231固接在手掌14上,所述第一柔性传动件241分别连接第一传动轮231、第二传动轮232,所述第一柔性传动件241呈“O”字形,所述第一柔性传动件241、第一传动轮231、第二传动轮
232三者构成传动关系,所述第二传动轮232套接在第四轴214上;所述第三传动轮233套接
在第四轴214上,所述第二传动轮232与第三传动轮233固接,所述第二柔性传动件242分别
连接第三传动轮233、第四传动轮234,所述第二柔性传动件242呈“O”字形,所述第二柔性传动件242、第三传动轮233、第四传动轮234三者构成传动关系;在第二传动机构中,所述第四传动轮234套固在第一远关节轴上;在第三传动机构中,所述第四传动轮234套固在第二远
关节轴上;如图3至图8所示。图9是本实施例平行夹持的初始状态和终止状态(双点划线)。
232三者构成带轮传动关系、链轮传动关系或绳轮传动关系。本实施例中,所述第一柔性传动件241采用传动带,所述第一传动轮231采用带轮,所述第二传动轮232采用带轮,所述第一柔性传动件241、第一传动轮231、第二传动轮232三者构成带轮传动关系。
234三者构成带轮传动关系、链轮传动关系或绳轮传动关系。本实施例中,所述第二柔性传动件242采用传动带,所述第三传动轮233采用带轮,所述第四传动轮234采用带轮,所述第二柔性传动件242、第三传动轮233、第四传动轮234三者构成带轮传动关系。
驱动第一电机11转动一小角度,再拍摄图像;第二摄像机42拍图与第一摄像机41拍图处理
程序相似。直到第一摄像机41和第二摄像机42反馈的图像都未在各自的可抓区域存在棱
线,则进入下一环节;
(GPI)方法,参考文献为:
结果自动调整手掌与手指的抓取方位;并根据是否接触的视觉反馈,自动控制不同手指的
运动,从而满足不居中物体的良好抓取。