鄭永濤,葉仕通,張 釗
(1.廣東工業(yè)大學(xué) 華立學(xué)院,廣東 廣州511325;2.深圳視爵光旭電子有限公司 廣東 深圳518108)
基于顏色識別的智能搬運機器人的設(shè)計
鄭永濤1,葉仕通1,張 釗2
(1.廣東工業(yè)大學(xué) 華立學(xué)院,廣東 廣州511325;2.深圳視爵光旭電子有限公司 廣東 深圳518108)
文中研究基于顏色識別技術(shù)進行智能搬運機器人的設(shè)計。搬運機器人系統(tǒng)以STM32芯片為控制核心,利用無線通訊模塊與控制中心通訊,聯(lián)合顏色傳感器、機械臂以及載物小車組成自動引導(dǎo)搬運機器人系統(tǒng),實現(xiàn)對碼垛小型柱狀物料以及不同顏色物體的搬運。通過智能分揀、搬運,以降低生產(chǎn)過程中對人工的使用,同時提高生產(chǎn)效率。
智能搬運機器人;機械手;傳感;無線通訊
智能機器人涉及動力系統(tǒng)、傳感檢測、機械設(shè)計以及人工智能等多方面知識,獨特地成為一門綜合學(xué)科。在現(xiàn)實生活中,智能機器人扮演的角色也越來越多,如機械焊接、農(nóng)場管理、道路交通應(yīng)用等?;陬伾R別的智能搬運機器人,實現(xiàn)了利用傳感器采集模塊采集信息、無線通信傳導(dǎo)信息、單片機控制核心處理命令的一體化功能[1],使用方便,工作效率高,成本低,對生產(chǎn)應(yīng)用具有重大意義。
1.1 系統(tǒng)組成
系統(tǒng)采用STM32單片機作為核心控制模塊,完成對執(zhí)行機構(gòu)的控制和信息的處理;顏色傳感器和機械手分別實現(xiàn)對目標(biāo)物體的識別和獲取、釋放;超聲波傳感器和直流電機分別為運載體提供避障和動力;采用無線通信對整個系統(tǒng)實時監(jiān)控實現(xiàn)自動控制[2-4]。系統(tǒng)總體結(jié)構(gòu)設(shè)計如下:
圖1 系統(tǒng)總體結(jié)構(gòu)設(shè)計圖
1.2 系統(tǒng)硬件設(shè)計
根據(jù)方案設(shè)計和要求,系統(tǒng)可分為單片機控制模塊、超聲波避障模塊、顏色傳感器模塊、電機驅(qū)動模塊、機械手控制模塊、無線通訊與顯示模塊、電源模塊共7個模塊電路。
1.2.1 單片機主控
STM32F103ZET6單片機具有集成度高、功耗控制杰出和實時性能優(yōu)異的優(yōu)點。內(nèi)部集成2通道12位D/A,12通道DMA控制器以及多達112個快速I/ O端口,強干擾場合。單片機最小系統(tǒng)組成(包括I/O接口、晶振、復(fù)位電路等)作為系統(tǒng)的核心控制部分,主要完成對顏色傳感器和超聲波避障數(shù)據(jù)的采集和顯示,通過內(nèi)部處理實現(xiàn)對電機和機械手的驅(qū)動工作。
1.2.2 超聲波避障模塊設(shè)計
超聲波避障選擇HC-SR04模塊進行對障礙物的檢測,通過檢測的距離對比系統(tǒng)設(shè)定的安全距離判定是否啟動自動避障動作[5-6]。模塊中采用IO觸發(fā)測距,自動發(fā)送8個40 khz的方波,自動檢測是否有信號返回;若有信號返回,通過IO輸出一高電平,高電平持續(xù)的時間就是超聲波從發(fā)射到返回的時間,測試距離采用[7]:
測試距離=(高電平時間*聲速(340M/S))/2,測試距離由STM32核心控制器程序運算實現(xiàn)。
1.2.3 顏色傳感器模塊設(shè)計
專用顏色識別傳感器采用以TCS3200D芯片為核心,具有數(shù)字兼容接口的RGB彩色光/頻率轉(zhuǎn)換器,內(nèi)部由硅光電二極管陣列和一個電流/頻率轉(zhuǎn)換器集成,通過測試輸出的頻率便可獲知RGB顏色的值。顏色傳感器模塊電路主要由TCS3200D芯片和白色LED陣列組成,通過電源接口供電,數(shù)據(jù)接口與核心控制器進行連接通信,通過程序算法分離RGB三基色,查表識別[8]。
1.2.4 電機模塊設(shè)計
作為智能搬運機器人的動力源,考慮搬運車車體、各傳感器模塊、搬運目標(biāo)等的重量、電機自重以及工作電壓、控制方式等因素,選擇RF-370直流減速電機作為搬運機器人的驅(qū)動電機,以提高搬運機器人的穩(wěn)定性。采用差速驅(qū)動模式,最大扭力可達4 kg/cm。
基于RF-370直流減速電機與機器人整體考慮,采用單片L298N的H橋芯片實現(xiàn)雙路電機的驅(qū)動,最大輸出驅(qū)動電流4A,7.2 V/6 A鋰電池直接輸出驅(qū)動電機,控制芯片對驅(qū)動芯片5,7,10,12腳輸入控制電平來控制電機的轉(zhuǎn)動;EnA,EnB接控制使能端,控制電機的停轉(zhuǎn)。通過PWM調(diào)速方式可使電機輸入使能脈沖寬度按要求變化,實現(xiàn)小車的前進、后退、左轉(zhuǎn)、右轉(zhuǎn)、停止、調(diào)速的工作[10]。
1.2.5 機械手模塊設(shè)計
充分考慮搬運機器人性能,數(shù)字舵機反應(yīng)更快,變速過程也更迅速、柔和;能在任意脈沖段或者任意角度中進行鎖死,從而提供更大的固定力量。設(shè)計中使用MG996R數(shù)字舵機,最大拉力可達15 kg/cm,共使用3個舵機組成3自由度的機械手。
對數(shù)字舵機的控制,主要采用單片機產(chǎn)生的脈沖信號,即PWM信號來控制。單片機系統(tǒng)的控制信號的變化依靠硬件計數(shù),受外界干擾較小、工作可靠,在脈沖寬度調(diào)節(jié)方面可實現(xiàn)微秒級變化。通過控制3個舵機實現(xiàn)三自由度機械手的控制[11]。
1.2.6 通信與顯示模塊設(shè)計
無線通信主要采用NRF24L01無線收發(fā)器 (包括:頻率發(fā)生器、增強型 Schock Burst TM模式控制器、功率放大器、晶體放大器、調(diào)制器和解調(diào)器)。它具有高速率、多頻點、低功耗的優(yōu)點。通過對輸出功率頻道選擇和協(xié)議的設(shè)置可以實現(xiàn)低電流待機。顯示方面,主要通過NRF24L01無線模塊實現(xiàn)機器人與PC機之間進行通信,從而將機器人工作狀態(tài)體現(xiàn)在PC機顯示屏上[12]。而智能搬運機器人自身搭載LCD12864字符型液晶用于實現(xiàn)機械手對搬運目標(biāo)識別的計數(shù)、實現(xiàn)對工作現(xiàn)場環(huán)境變化的信息提示。
1.2.7 電源模塊設(shè)計
除直接使用鋰電池驅(qū)動直流減速電機外,其余均采用集成穩(wěn)壓器LM2596提供穩(wěn)壓電壓。主要有為單片機提供正常工作的5 V直流電壓;為機械手模塊的數(shù)字舵機提供正常工作的7.2 V直流電壓。
在系統(tǒng)軟件設(shè)計中,主要分析了系統(tǒng)整體的軟件設(shè)計思路以及搬運目標(biāo)顏色識別的軟件設(shè)計思路。
2.1 系統(tǒng)整體軟件設(shè)計思路
進行系統(tǒng)程序設(shè)計時,主要根據(jù)智能搬運機器人工作流程進行程序的編寫[13-16]。系統(tǒng)軟件主要包括主控模塊,控制模塊和檢測模塊3部分。系統(tǒng)主要實現(xiàn):采集引導(dǎo)路徑數(shù)據(jù)、提取里面引導(dǎo)信息、確定搬運設(shè)備自身的位置和尋找搬運目標(biāo)位置、識別搬運目標(biāo)、機械臂獲取搬運目標(biāo)、目標(biāo)的搬運與堆放、搬運目標(biāo)的計數(shù)以及工作現(xiàn)場環(huán)境的監(jiān)控。軟件流程圖如圖2所示。
圖2 系統(tǒng)整體軟件設(shè)計流程圖
2.2 搬運目標(biāo)顏色識別軟件設(shè)計
本設(shè)計利用TCS3200D顏色傳感器模塊對搬運目標(biāo)進行識別[9]。首先需要對傳感器模塊進行初始化,即進行白平衡設(shè)置;然后通過傳感器探頭對搬運目標(biāo)進行反射光線信息的接收;最后經(jīng)過程序進行三基色分離,通過RGB三基色表格查表獲取正確的顏色。該軟件程序流程圖如圖3所示。
圖3 搬運目標(biāo)顏色識別軟件設(shè)計流程圖
基于顏色識別的智能搬運機器人系統(tǒng)通過系統(tǒng)軟件和控制電路協(xié)調(diào)工作,通過采集顏色傳感器數(shù)據(jù)識別確認搬運目標(biāo),利用機械手獲取與釋放,運載體通過超聲波等傳感器自動避開障礙物進行路徑的優(yōu)化選擇,最終將搬運目標(biāo)釋放到目的地。實驗測試結(jié)果表明,該系統(tǒng)性能穩(wěn)定,易于操作,成本低,在工業(yè)自動化中可廣泛采用。
[1]范新南,蘇麗媛,郭建甲.多傳感器信息融合綜述[J].河海大學(xué)常州分校學(xué)報,2005,19(1):1-4.
[2]戶碩.搬運機器人的設(shè)計與制作 [J].煤礦機械,2015,36(8):18-20.
[3]王登貴,于臏.基于MCU的智能搬運車控制系統(tǒng)設(shè)計與研究[J].煤礦機械,2014,35(5):215-218.
[4]蔣嶸,吳晨曦,蔣崢,等.一種智能尋跡與搬運機器人的控制系統(tǒng)設(shè)計[J].計算機測量與控制,2015,23(4):1209-1211.
[5]仇成群胡天云基于單片機的汽車防撞報警系統(tǒng)設(shè)計[J].現(xiàn)代制造工程,2010(12):119-122.
[6]朱宇,屈路,邱增凱,等.基于超聲波傳感器的智能車模型設(shè)計[J].實驗室研究與探索,2013,32(1): 35-38.
[7]郭清.基于STC89C52的超聲波測距防撞系統(tǒng)設(shè)計[J].儀表技術(shù)與傳感器,2011(6):74-76.
[8]段志偉,高丙坤,宋金波.基于RGB顏色傳感器的油品顏色檢測系統(tǒng)設(shè)計[J].化工自動化及儀表,2013,40(8):982-985.
[9]高富強.基于RGB的顏色辨識系統(tǒng)設(shè)計[J].傳感器與微系統(tǒng),2012(10):84-87.
[10]李輝,郭文成,陳浩.基于STM32F107的搬運機器人電機控制系統(tǒng)設(shè)計[J].單片機與嵌入式系統(tǒng)運用,2012,4:36-38.
[11]何躍軍,陳偉,劉先明.搬運機器人驅(qū)動系統(tǒng)的設(shè)計與實現(xiàn)[J].微特電機,2008(4):32-34.
[12]范逸之,陳立元.Visual Basic與RS-232串行通信控制(最新版).[M].北京:清華大學(xué)出版社,2002.
[13]鄭劍春.機器人結(jié)構(gòu)與程序設(shè)計[M].北京:清華大學(xué)出版社,2010.11.
[14]杜樹青.基于Proteus和Keil C51的單片機設(shè)計與仿真[M].北京:電子工業(yè)出版社,2012.
[15]李偉光,許陽釗.一種搬運機器人控制系統(tǒng)的軟件開發(fā)與研究[J].制造技術(shù)與機床,2010,4:84-87.
[16]白志剛.自動調(diào)節(jié)系統(tǒng)解析與PID整定[M].北京:化學(xué)工業(yè)出版社,2012.
[17]張偉,龔嬌龍,張惠芳,等.基于視覺導(dǎo)航的變電站智能巡檢機器人的研究[J].陜西電力,2015(6):63-66,74.
[18]丁思奎,李健.變電站巡檢機器人在實際應(yīng)用中存在的問題分析及解決方案[J].供用電,2016(1):80-82.
[19]劉越凡,葉海彬,劉凱.巡檢機器人在500kV無人值守變電站的應(yīng)用研究[J].供用電,2016(9):69-72.
[20]王欣.搬運機器人在鉆桿生產(chǎn)線物料輸送系統(tǒng)中的應(yīng)用[J].工業(yè)儀表與自動化裝置,2014(3):82-84.
Design color recognition based on intelligent transport robot
ZHENG Yong-tao1,YE Shi-tong1,ZHANG Zhao2
(1.Huali College,Guangdong University of Technology,Guangzhou 511325,China;2.Shenzhen Infiled Electronics Co.,LTD,Shenzhen 518108,China)
On the basis of the color recognition technology,this paper is about the design of intelligent transport robot.The transport robot system has the controlling core of STM32 chip which uses the wireless communication module and controlling center communication,associates the color sensor machine,manipulator arm with loading car to form an automatic handling robot guidance system for stacking small cylindrical objects of different colors and materials handling in order to reduce the utilization of labor in the process of production and improve the productivity by intelligent sorting and handling.
intelligent transport robot;manipulator;sensing;telecommunications
TN99
A
1674-6236(2017)10-0078-03
2016-05-06稿件編號:201605042
2014年度廣東省大學(xué)生創(chuàng)新創(chuàng)業(yè)訓(xùn)練計劃項目(201413656015)
鄭永濤(1991—),男,廣東汕頭人,助理講師。研究方向:電氣工程及其自動化。