張樹偉 李穎
摘 要:該文以MCS-51單片機(jī)為控制核心設(shè)計(jì)了一個能夠完成自動排除可疑爆炸物的機(jī)器人裝置,該設(shè)計(jì)結(jié)構(gòu)簡單,采用模塊化的設(shè)計(jì)方法,像搭積木一樣完成了機(jī)器人的硬件制作,同時應(yīng)用順序控制方法實(shí)現(xiàn)了在規(guī)定區(qū)域內(nèi)尋找可疑物品并將其帶離危險區(qū),設(shè)計(jì)構(gòu)思新穎,具有較強(qiáng)的實(shí)際應(yīng)用價值。
關(guān)鍵詞:自動控制 循跡 單片機(jī)
中圖分類號:TP242 文獻(xiàn)標(biāo)識碼:A 文章編號:1674-098X(2012)12(a)-00-02
電子技術(shù)的發(fā)展為人類活動開辟了廣闊的空間,使人們可以探索許多未知的領(lǐng)域,未知領(lǐng)域的危險性是不可預(yù)料的,應(yīng)用電子技術(shù)研究制造某些使之具有人類的某些感覺和知覺功能的機(jī)器人,可以為人類活動的安全提供保障。該文設(shè)計(jì)并制作了一個能自動進(jìn)入危險現(xiàn)場排除危險品的簡易排爆機(jī)器人,能夠在感全區(qū)檢測機(jī)器人的活動,找到可疑的危險物品,并帶離危險區(qū)。
1 設(shè)計(jì)要求
(1)機(jī)器人從安全區(qū)域啟動,按指定路線運(yùn)行,自動區(qū)分直線軌道和彎路軌道,在指定彎路處拐彎,實(shí)現(xiàn)靈活前進(jìn)、轉(zhuǎn)彎、倒退等功能。進(jìn)入直徑為1 m的圓形危險區(qū)找到任意放置的可疑鐵磁材料薄片。整個搜索和轉(zhuǎn)移過程中機(jī)器人除探頭和機(jī)械手外均不得接觸邊線和可疑鐵磁材料薄片。
(2)機(jī)器人完成運(yùn)行任務(wù)后,將其搬移自動返回出發(fā)起點(diǎn)。整個過程不超過5 min。搜索路線如圖1所示。
(3) 具有聲、光報訊功能,用以區(qū)分運(yùn)行狀態(tài)。
(4) 具有無線數(shù)據(jù)傳送功能,將機(jī)器人運(yùn)行狀態(tài)及計(jì)時數(shù)據(jù)傳送到自制的接受顯示裝置放置在現(xiàn)場便于觀察處。
圖1 現(xiàn)場示意圖
2 可疑物品搜尋的算法研究
通過對設(shè)計(jì)題目的分析,要求排爆機(jī)器人能夠在直徑為1 m的圓內(nèi)搜尋可疑物品,這對機(jī)器人的搜尋路線提出了要求,即能夠在規(guī)定的時間內(nèi)完成整個危險區(qū)的搜尋,不能有死角,找到可疑物品,并且把它拾起來送到起點(diǎn)。由于對機(jī)器人的尺寸限制,在圓內(nèi)又無軌跡可循,因此要求對機(jī)器人行走的路徑進(jìn)行分析運(yùn)算,以便按要求完成任務(wù)。
采用定式搜索法檢測可疑鐵磁材料。如圖2所示(箭頭部分為機(jī)器人小車中心線),在小車通過安全通道后,先沿著圓形區(qū)域掃描一圈。車身寬度為18 cm,所以先掃描此扇形區(qū)域,回到圓形區(qū)域起點(diǎn)后車身轉(zhuǎn)動90 °直線掃描指定剩余半徑為32 cm的圓形區(qū)域,考慮到車身的長度先轉(zhuǎn)90 °后行走一段距離,再轉(zhuǎn)90 °以防其車身超出邊界,搜索四圈左右,場地內(nèi)所有區(qū)域全部掃描完后尋邊線出現(xiàn)場。若在掃描過程中發(fā)現(xiàn)可疑物體便攜帶其尋邊線回到起始點(diǎn)。當(dāng)整個區(qū)域掃描完畢后沒有發(fā)現(xiàn)可疑物品,也沿著邊線返回到起點(diǎn)。該方案的優(yōu)點(diǎn)是安全性高,可實(shí)現(xiàn)全面掃描即效率高,保證能夠?qū)⒄麄€危險區(qū)域掃描完整而不留死角。
圖2 算法示意圖
3 機(jī)器人硬件電路設(shè)計(jì)
該文采用ATMEL公司的89S51為主控芯片,完成對各路信號的采集和處理,并且按照預(yù)先設(shè)定的控制算法,控制執(zhí)行機(jī)構(gòu)完成機(jī)器人的整個排爆過程。輔助設(shè)計(jì)主要包括電源電路、循跡電路、行走電路、無線收發(fā)電路、危險物品檢測與拾起機(jī)構(gòu)和顯示等。系統(tǒng)結(jié)構(gòu)框圖如圖3所示。
圖3 系統(tǒng)結(jié)構(gòu)框圖
3.1 循跡電路設(shè)計(jì)
循跡采用紅外對管傳感器。它是一種一體化反射型紅外探測器,其發(fā)射器是一個砷化鎵紅外發(fā)光二極管,而接收器是一個高靈敏度,硅平面光電三極管。RPR220采用DIP4封裝,當(dāng)發(fā)光二極管發(fā)出的光反射回來時,三極管導(dǎo)通輸出低電平。紅外對管檢測到信號后通過電壓比較器LM324調(diào)節(jié)靈敏度后輸出到單片機(jī)I/O口。
3.2 行走機(jī)構(gòu)設(shè)計(jì)
采用直流減速電機(jī)帶動輪子轉(zhuǎn)動實(shí)現(xiàn)機(jī)器人的行走。直流減速電機(jī)轉(zhuǎn)動力矩大,體積小,重量輕,裝配簡單,使用方便。由于其內(nèi)部由高速電動機(jī)提供原始動力,帶動變速(減速)齒輪組,可以產(chǎn)生較大扭力。
本設(shè)計(jì)選用的直流電機(jī)減速比為1∶74,減速后電機(jī)的轉(zhuǎn)速為100 r/min。我們的車輪直徑為6cm,因此我們的小車的最大速度可以達(dá)到
V=2πr·v=2×3.14×0.03×100/60=0.314 m/s
能夠較好的滿足設(shè)計(jì)題目速度的要求。電機(jī)驅(qū)動模塊采用電機(jī)驅(qū)動模塊采用專用芯片L293作為電機(jī)驅(qū)動芯片。L293是一個四大功率管分為兩組,交替導(dǎo)通截止,以保證小車完成前進(jìn)和后退、左、右轉(zhuǎn)彎等運(yùn)行動作,有控制使能端。用該芯片作為電機(jī)驅(qū)動,操作方便,穩(wěn)定性好,性能優(yōu)良。
3.3 其他電路設(shè)計(jì)
①顯示電路設(shè)計(jì):應(yīng)用數(shù)碼管來分段顯示搜索時間、返回時間和總時間,由于在5 min內(nèi)完成,所以應(yīng)用4個數(shù)碼管就足夠了,采用P0口低位BCD碼輸出,接74ls47驅(qū)動7段數(shù)碼管,再用74ls138控制4位數(shù)碼管動態(tài)顯示。
②無線收發(fā)電路設(shè)計(jì):采用無線通信編解碼芯片PT2262/PT2272再配以外電路來實(shí)現(xiàn)。
③危險物品檢測與拾起電路:采用干簧管來檢測鐵磁性材料,當(dāng)干簧管檢測到鐵磁性材料后,電路接通,單片機(jī)的一個I/O口輸出高電平,從而給電磁鐵通電,拾起鐵磁性物品。
④電源電路:由于采用直流減速電機(jī)作為機(jī)器人的行走驅(qū)動,消耗電能較大,一般的高性能電池只能運(yùn)行幾次電能就消耗掉了,而且電壓的降低對電機(jī)的轉(zhuǎn)速影響極大,因此采用高性能、大容量的手機(jī)電池串聯(lián)在一起,通過穩(wěn)壓電路提供給整機(jī),效果顯著。
4 軟件設(shè)計(jì)
通過對機(jī)器人行走軌跡的算法研究,將機(jī)器人完成整個運(yùn)行分成三部分,第一部分為通過光電傳感器對邊界的循跡,完成半徑為18 cm的外圓掃描;第二部分走蛇形路線完成內(nèi)徑32 cm圓內(nèi)掃描,第三部分利用光電傳感器尋找邊界并找到出口。
在這三部分運(yùn)行的過程中,還要完成可疑物品的尋找、拾起并發(fā)出聲、光報警和無線數(shù)據(jù)的收發(fā)。具體程序流程如圖4
所示。
圖4 主程序流程圖
5 結(jié)語
該文應(yīng)用MCS-51單片機(jī)為主控制芯片,輔以電源電路、循跡電路、行走電路、無線收發(fā)電路、危險物品檢測與拾起機(jī)構(gòu)和顯示等完成了排爆機(jī)器人由安全區(qū)通道進(jìn)入危險區(qū),并且在危險區(qū)內(nèi)搜尋可疑物品,通過無線數(shù)據(jù)通訊,能夠?qū)⑽kU現(xiàn)場的情況發(fā)送給接收機(jī),使操作者在安全區(qū)以外的現(xiàn)場了解排爆小車的運(yùn)行情況,以便及時進(jìn)行處理。在很長一段時間的測試過程中,都達(dá)到了設(shè)計(jì)題目的要求。此設(shè)計(jì)電路簡單,構(gòu)思新穎,應(yīng)用單片機(jī)順序控制技術(shù)完成復(fù)雜的運(yùn)算,具有較強(qiáng)的實(shí)際應(yīng)用價值。
參考文獻(xiàn)
[1] 張毅剛.單片機(jī)原理及應(yīng)用[M].北京:高等教育出版社,2006.
[2] 王毓銀.數(shù)字電路邏輯設(shè)計(jì)[M].高等教育出版社,2004.
[3] 王化祥,張淑英.傳感器原理及應(yīng)用[M].天津大學(xué)出版社,1997.
[4] 王毅.單片機(jī)器件應(yīng)用手冊[M].北京人民郵電出版社,1995.
[5] 王新賢.通用集成電路速查手冊[M].山東科學(xué)技術(shù)出版社,2002.
[6] 黃惟公.單片機(jī)原理及應(yīng)用[M].西安電子科技大學(xué)出版社,2007.