当前位置: 首页 > 专利查询>唐国民专利>正文

基于双目式红外传感器件的装配机器人定位装置制造方法及图纸

技术编号:9056218 阅读:240 留言:0更新日期:2013-08-21 19:23
本发明专利技术公开了一种基于双目式红外传感器件的装配机器人定位装置,旨在克服目前装配配机器人用定位装置无法对透明圆柱形及球形物体准确定位,从而导致机械手无法可靠抓住物体或者准确投放物体的缺点,包括安装于控制电路板上的两只红外发射管,一只红外接收头和单片机,两只红外发射管对称设于红外接收头两侧,两只红外发射管的发光中心和红外接收头中心在一个平面上,每只红外发射管均向红外接收头一侧倾斜且与控制电路板之间成一锐角A1,每只红外发射管的发光中心到控制电路板的垂直距离为H1,每只红外发射管的发光中心到红外接收头中心的水平距离为L1;两只红外发射管和红外接收头分别占用单片机的一个I/O端口。

【技术实现步骤摘要】

本专利技术涉及一种定位装置,尤其涉及一种采用双红外发射管进行定位的装置。
技术介绍
目前常见的用于装配机器人障碍物检测或准确定位的红外传感器件,其检测准确率通常受到外部光线、表面形状、表面颜色及透明度的影响,特别是对于透明圆柱形及球形物体等,检测准确率不高;在使用其作为定位传感手段时,随机器人的运动速度不同和检测电路的反应灵敏度不同,定位准确率相差很大。另一方面,很多装配机器人通常要抓取圆球形物体,或者要在圆柱形物体前准确停住,迫切需要解决目前机械手无法可靠抓住物体或者准确投放物体的问题。
技术实现思路
为克服目前装配配机器人用定位装置无法对透明圆柱形及球形物体准确定位,从而导致机械手无法可靠抓住物体或者准确投放物体的缺点,本专利技术提供一种基于双目式红外传感器件的装配机器人定位装置。本专利技术的技术方案是,基于双目式红外传感器件的装配机器人定位装置,包括安装于控制电路板上的两只红外发射管,一只红外接收头和单片机,两只红外发射管对称设于红外接收头两侧,两只红外发射管的发光中心和红外接收头中心在一个平面上,每只红外发射管均向红外接收头一侧倾斜且与控制电路板之间成一锐角Al,每只红外发射管的发光中心到控制电路板的垂直距离为Hl,每只红外发射管的发光中心到红外接收头中心的水平距离为LI ;每只红外发射管的正极性端通过上拉电阻接于电源,负极性端通过一晶体三极管和可调电阻接于单片机的一个I/O端口,晶体三极管的一端接地;红外接收头一端接于电源,一端接地,一端接于 单片机的一个I/O端口,两只红外发射管和红外接收头分别占用单片机的一个I/o端口。还包括安装于所述控制电路板上的三只定位状态指示灯,每只定位状态指示灯的一端接于所述单片机的一个I/o端口,另一端接地;三只定位状态指示灯分别占用单片机的一个I/O端口,且与红外发射管及红外接收头所占用的三个I/O端口不相同。还包括固定于所述控制电路板上的将所述两只红外发射管和红外接收头包围在内的U形防尘遮光罩。本专利技术采用双目式结构,即采用双红外发射管,配合机器人自带巡线传感器进行位置检测,构造新颖,准确分辨本定位装置(本专利技术)与待测透明圆柱形及球形物体的位置偏离情况,使装配机器人精确定位,实现物体准确抓取和投放;定位状态指示灯能实时指示“正对”、“左偏”和“右偏”三种定位情况,利于操作人员及时了解安装有本定位装置的装配机器人的实际运行状态,为人工介入时机提供参考;U形防尘遮光罩可以防尘和遮挡外部杂散光线,有效抑制外部环境对红外信号的干扰。附图说明图1为本专利技术的结构示意图。图2为图1的俯视图。图3为本专利技术的电气原理图。图4为本定位装置对圆柱形透明物体的位置检测示意图。图5为本定位装置对球形物体的位置检测示意图。图6为安装有本定位装置的装配机器人示意图。图中:1.红外发射管,2.红外接收头,3.U形防尘遮光罩,4.定位状态指示灯,5.控制电路板,6.装配机器人,7.本定位装置,8.前排巡线传感器,9.后排巡线传感器。具体实施例方式下面结合附图和实施例,对本专利技术作进一步说明: 图1和图2是基于双目式红外传感器件的定位装置的结构示意图,图3为本专利技术的电气原理图,安装于控制电路板5上的两只红外发射管I在图3原理图上为TRl和TR2,红外接收头2在图3原理图上为RD,单片机采用AT89C51系列,两只红外发射管I对称设于红外接收头2的两侧,两只红外发射管I的发光中心和红外接收头2的中心在一个平面上,每只红外发射管I均向红外接收头2 —侧倾斜且与控制电路板5之间成一锐角Al,每只红外发射管I的发光中心到控制电路板5的垂直距离为H1,每只红外发射管I的发光中心到红外接收头2中心的水平距离为LI,设本定位装置7与待测物体间需要定位的距离为Ds,Al,LI和Rb需要根据待测物体的形状、尺寸大小、颜色及需要定位的距离Ds进行调节;每只红外发射管I的正极性端通过上拉电阻Re接于+5V电源Vcc,负极性端通过一晶体三极管和可调电阻Rb接于单片机的一个I/O端口,晶体三极管的一端接地;红外接收头2 —端接于+5V电源Vcc,一端接地,一端接于单片机的一个I/O端口,两只红外发射管I占用单片机的Pl.0和Pl.1端口,红外接收头2占用单片机的Pl.2端口。为实时指示定位情况,还在控制电路板5上安装三只定位状态指示灯4,在图3原理图上分别为LT1、LT2和LT3,每只定位状态指示灯4的一端接于单片机的一个I/O端口,另一端接地;三只定位状态指示灯4分别占用单片机的P1.3、P1.4和Pl.5端口,分别指示“正对”、“左偏”和“右偏”三种定位状态。38KHz方波调制信号通过单片机端口 P1.0、P1.1分时控制两只红外发射管I各自发射支路中晶体三极管的通断,使两只红外发射管I分时发射红外光,光信号的强弱可以通过可调电阻Rb进行调节,Rb越小,光信号越强;红外光照射待测物体发生反射,反射光照射到红外接收头2,如待测物体上发生光线漫反射的面积足够大,有足够量的反射光被红外接收头2接收,经解调后红外接收头2输出对应的电平信号,从前一状态的OV跳变到+5V,其输出电平由单片机Pl.2端口接收处理后,将装配机器人6与前方物体的位置情况通过单片机Pl.3、Pl.4和Pl.5端口送给定位状态指示灯4和装配机器人6的上位机,装配机器人6据此进行位置调整,直至到达准确的装配位置。为防尘和遮挡外部杂散光线,有效抑制外部环境对红外信号的干扰,还在控制电路板5上安装U形防尘遮光 罩3,将两只红外发射管I和红外接收头2包围在U形防尘遮光罩3内。图4为本定位装置7对圆柱形透明物体的位置检测示意图,由两只红外发射管I分时发射红外线对待测物体进行位置检测。按照本定位装置7与待测物体之间的相对位置关系分六种检测情况: 情况I为本定位装置I与待测物体正对的情形,先由左侧红外发射管I发射红外线,在待测物体的AB弧段内发生漫反射,大部分反射光能被红外接收头2所接收,则红外接收头2占用的单片机Pl.2端口发生一次从OV到5V的电平跳变,再由右侧红外发射管I发射红外线,在待测物体的BC弧段内发生漫反射,大部分反射光也能被红外接收头2所接收,则单片机Pl.2端口又发生一次从OV到5V的电平跳变,即在两次发射占用的时间T内,单片机Pl.2端口连续发生两次电平跳变后,装配机器人6则立刻在该位置停车,能够准确停到预定位置。情况2为本定位装置7与待测物体之间距离较远时的情形,此时由于待测物体上光反射区AB弧段和BC弧段面积较小,红外接收头2不能接收到足够的光信息量,单片机Pl.2端口电平不会发生变化。本定位装置7与待测物体之间距离较近时与情况2相同。情况3为本定位装置7向左偏离待测物体的情形,此时左侧红外发射管I的反射光能被红外接收头2接收,单片机Pl.2端口电平发生一次跳变,右侧红外发射管I的发射光已经偏离待测物体,基本无反射光,单片机Pl.2端口电平不变化,即在两次发射占用的时间T内,仅检测到一次电平跳变,此时装配机器 人6立刻停车,分多步右转,直至转到检测到两次连续电平跳变的正对位置。情况4为本定位装置7向左偏离待测物体过多的情形,此时两只红外发射管I发射的红外光均没有照射到待测物体,两次检测单片机Pl.2端口都没有电平跳变情况发生,此时装配机器人本文档来自技高网...

【技术保护点】
一种基于双目式红外传感器件的装配机器人定位装置,其特征在于:包括安装于控制电路板上的两只红外发射管,一只红外接收头和单片机,两只红外发射管对称设于红外接收头两侧,两只红外发射管的发光中心和红外接收头中心在一个平面上,每只红外发射管均向红外接收头一侧倾斜且与控制电路板之间成一锐角A1,每只红外发射管的发光中心到控制电路板的垂直距离为H1,每只红外发射管的发光中心到红外接收头中心的水平距离为L1;每只红外发射管的正极性端通过上拉电阻接于电源,负极性端通过一晶体三极管和可调电阻接于单片机的一个I/O端口,晶体三极管的一端接地;红外接收头一端接于电源,一端接地,一端接于单片机的一个I/O端口,两只红外发射管和红外接收头分别占用单片机的一个I/O端口;所述单片机控制所述两只红外发射管在时间间隔T内分时发射红外光,重复以下控制过程:当红外接收头占用的单片机I/O端口在时间间隔T内连续发生两次电平跳变时,单片机向装配机器人发出停车信号;当红外接收头占用的单片机I/O端口在时间间隔T内只发生一次电平跳变时,单片机向装配机器人发出停车并转向信号。

【技术特征摘要】

【专利技术属性】
技术研发人员:唐国民邹华东
申请(专利权)人:唐国民
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1