服务于两台数控机床上下料移动机器人的控制方法技术

一种服务于两台数控机床上下料移动机器人的控制方法，属于工业机器人上下料控制系统技术领域，采用安装在机器人末端执行器上的无线２Ｄ－ＣＣＤ采集工件的位置和形状视频信息，将所采集到的视频信息经过视频采集、压缩后，通过无线传输，由无线ＵＳＢ接收机接收处理后的视频信号，并将信号通过ＵＳＢ接口传送给主控计算机，嵌入式微处理器，处理器依据识别算法控制末端执行器抓取工件。本发明专利技术通过识别算法可以准确识别工件并抓取工件，并能实现准确上下料，提高了工作效率，并节省了人工。

【技术实现步骤摘要】

本专利技术属于工业机器人上下料控制系统
，其突出的特点是将机器人视 觉、无线通信技术以及传感器技术引入到机器人控制系统中，使得工业机器人实现智能抓 取任意放置在料箱中的工件以及智能上下料的操作。
技术介绍
现有智能机器人用直流电机作为驱动时，一般都采用单片机或者高速的DSP等进行控制， 而且同一机器人往往需用多个CPU来实现各自的功能。但随着对智能机器人的集成化程度 要求越来越高，需要使用单个CPU的控制器来满足机器人的各种行为要求，例如视频采集、 无线通信。随着现代计算机技术和互联网技术的飞速发展，嵌入式系统成为当前IT行业最 热门的技术之一。ARM微处理器以其高性能低功耗的特性成为目前应用最广泛的32位嵌入 式处理器，嵌入式Linux也凭借其强大的开源功能及多任务实时性等优点占据了嵌入式操 作系统的主导地位。目前国内的上下料机器人大都采用PLC控制，如上海发那科机器人有限公司设计 的一台服务于五台数控机床上下料的机器人就是采用PLC来控制，且取料位置固定。当取 料位置不固定时，且工件放置位置杂乱无章时，就需要采用机器视觉技术和传感器技术来 引导末端执行器抓取工件。
技术实现思路
本专利技术是要解决末端执行器自动抓取料箱中任意放置的工件以及准确上下料的 控制问题，本专利技术为实现上述目的所采用的技术方案是在两台数控机床的旁边各固定设置一个视觉支架，支架上各安装一个相同型号的有线 2D-CCD ；在机器人末端执行器上安装一个无线2D-CCD和一个传输时间激光距离传感器，无 线通信标准为802. Ilb或802. Ilg ；采用嵌入式微处理器作为控制器，嵌入式操作系统为 Linux系统；无线USB接收机与微处理器通过USB连接，无线USB接收机和嵌入式微处理器 安装在机器人控制柜中。两台数控机床上各安装一个相同型号的无线信号发射机，用于发 送数控机床上下料指令，采用串口通信协议，接收端口为RS-232，嵌入式微处理器配有该端当机器人收到数控机床的上料请求信号后，沿行走轴移动到料箱旁停下，机械手 运动到料箱的上方，无线2D-CCD由红外线启动开始垂直拍摄工件，同时启动传输时间激光 距离传感器，将所拍摄到的工件图片与标准库中工件图片的形状和面积进行比对，相似度 达到80%即可作为抓取目标，若所拍摄的图片中没有一个工件的相似度达80%，则控制机 械手运动到另一位置继续拍摄；若所拍摄的图片中只有一个工件的相似度达80%，则机器 手移动到该工件处并抓取该工件；若有多个工件的相似度达80%，则由传输时间激光距离传感器测量各工件与末端执行器之间的距离，以距离最小的工件作为抓取对象。确定好抓 取对象后，末端执行器调整好姿态，在工件的质心位置处抓取工件。通过以上技术方案，很 好地解决了料箱中任意放置的工件的准确抓取问题。因为工件是毛坯，在同一型号批次的毛坯中，毛坯的尺寸大小有误差，当末端执行 器抓取工件后，定位位置以及工件的平面度发生变化，将出现误差。为了实现精确上料，在 三爪卡盘的表面用油漆涂上两组不同直径的圆，每组两个圆，且直径相等，直径较大的两个 圆用于有线2D-CCD的图像画面的标定，直径较小的两个圆用于传输时间激光距离传感器 的标定。工作原理如下在正式上料之前，选一个毛坯作为初始工件，通过有线2D-C⑶和传 输时间激光距离传感器对该工件在摄像头中画面点位与机器人的示教点位的关系进行标 定，同时完成初始工件的特征标定，示教完成的上料程序为初始工件初始位置的上料位置， 此时工件上料偏差值为零。当机器人抓取其它工件后，定位圆的位置以及工件的平面度发 生变化，通过有线2D-CCD和传输时间激光距离传感器，机器人能够计算出位置变化量，机 器人把偏差值存入位置寄存器中。此时机器人可以通过把偏差值补偿到初始位置来实现工 件的上料。本专利技术的有益效果是，工件杂乱放置在料箱中，本专利技术通过识别算法可以准确识 别工件并抓取工件，并能实现准确上下料，提高了工作效率，并节省了人工。附图说明 图1所示为现场布置简图。图2所示为待加工工件抓取流程。图3所示为下料流程。图4所示为系统原理结构图。图中，1-机床A，2-机床B，3-料箱，4-机器人行走轴，5_机器人，6-护栏，7-无 线2D-CXD，8-传输时间激光距离传感器，9-视觉支架A，10-视觉支架B，11-机器人控制柜， 12-主控计算机。具体实施例方式如图1现场布置图所示，两台数控机床排列在机器人行走轴的一侧，两台数控机 床的中间位置安放上下料台，机器人安装在行走轴上，无线2D-CCD相机和传输时间激光距 离传感器安装在末端执行器上，行走轴的两端各设置一个安全护栏，在两台数控机床的三 爪卡盘附近各安装了一个视觉支架。嵌入式微处理器采用三星S3C2440 ARM9，嵌入式操作 系统为Linux系统，无线2D-CCD采用美国原装Linksys WVC210 Remote-controlled，其无 线通信标准为802. Ilb或802. llg，具体实施方式包括待加工工件的抓取、上料和下料。待加工工件的抓取。数控机床1 (或2)发出上料信号，该信号通过串口通信协议 传送到无线接收机，无线接收机将上料信号通过串口端传送到三星S3C2440 ARM9处理器， 控制器控制机器人沿行走轴运动到料箱旁停下，机械手移动到料箱的上方，由红外线触发 无线2D-CCD开始垂直拍摄工件，将拍摄到的图片经过压缩处理后通过无线通信传送给无 线接收机，无线接收机将压缩好的图片通过USB接口传送到控制器，控制器根据上述算法 控制末端执行器抓待加工工件，当抓取完毕后，通过红外线触发，无线2D-CCD停止拍摄，同时传输时间激光距离传感器停止工作。机器人沿行走轴移动到数控机床1 (或2)上下料位 置，如图2所示。上料。机器人末端执行器抓取工件后沿行走轴运动到发出上料信号的数控机床1 (或2)上下料位置，安装在视觉支架1 (或2)上的有线2D-CXD由红外线触发开始拍摄，同 时传输时间激光距离传感器工作，通过视频和传感器对工件的特征进行标定，计算出工件 实际位置与示教位置的偏差值，机器人可以通过把偏差值补偿到初始上料位置来实现工件 的上料，当机器人完成上料任务后，相机停止拍摄，传输时间激光距离传感器停止工作。下料。当数控机床1 (或2)发出无线下料信号时，该信号通过串口通信协议传送 给无线接收机，无线接收机与三星S3C2440 ARM9处理器的串口端连接，三星S3C2440 ARM9 处理器再发送下料信号给 机器人，机器人沿行走轴运动到该机床处，末端执行器按规划好 的轨迹抓取加工好的工件，机器人移动到下料台处，末端执行器把抓取的工件放置在下料 台上，然后返回原点，如图3所示。权利要求1.，其特征在于，采用安装在机器 人末端执行器上的无线2D-CCD采集工件的位置和形状视频信息，将所采集到的视频信息 经过视频采集、压缩后，通过无线传输，由无线USB接收机接收处理后的视频信号，并将信 号通过USB接口传送给主控计算机，嵌入式微处理器，处理器依据识别算法控制末端执行 器抓取工件。2.如权利要求1所述的，其特征 在于，具体步骤为A)待加工工件的抓取；数控机床发出上料信号，上料信号通过串口通信协议传送到无 线接收机，无线接收机将本文档来自技高网...

【技术保护点】
服务于两台数控机床上下料移动机器人的控制方法，其特征在于，采用安装在机器人末端执行器上的无线２Ｄ－ＣＣＤ采集工件的位置和形状视频信息，将所采集到的视频信息经过视频采集、压缩后，通过无线传输，由无线ＵＳＢ接收机接收处理后的视频信号，并将信号通过ＵＳＢ接口传送给主控计算机，嵌入式微处理器，处理器依据识别算法控制末端执行器抓取工件。

【技术特征摘要】

【专利技术属性】
技术研发人员：顾寄南，胡典传，沈跃，陈四杰，师二产，牛军燕，许可诚，王君，谢娟娟，
申请(专利权)人：江苏大学，
类型：发明
国别省市：32[]