智能機器人迷宮車控制系統(tǒng)設計方案

【W(wǎng)ord版本下載可任意編輯】智能機器人迷宮車控制系統(tǒng)設計方案機器人應當具有幾個特征：移動功能，執(zhí)行功能、感覺和智能。目前全世界各國舉辦的涉及硬件，軟件仿真的機器人大賽不下20余類。各種各樣的機器人比賽都有一個共同的宗旨：培養(yǎng)科學創(chuàng)新精神，激發(fā)思維的想象力，鼓勵理論與實踐的結合。不僅如此，現(xiàn)在已經(jīng)有越來越多的自動控制產(chǎn)品已經(jīng)介入生產(chǎn)，在農(nóng)業(yè)、工業(yè)上都有廣泛的應用。新的工作方式將大大的縮短了人工作業(yè)的時間，并且減輕了人的體力勞動的支出。走迷宮的微型機器鼠主要是基于自動引導小車(AutoGuidedVehicle，AGV)的原理，實現(xiàn)機器鼠識別路線，判斷并自動躲避障礙，選擇正確的行進路線走出迷宮。在此選擇制作一個簡易的行進裝置，使其能順利的走避障或是迷宮。為了實現(xiàn)小車識別路線，判斷并自動躲避障礙，選擇正確的行進路線，障礙判斷采用單光束反射取樣紅外傳感器，驅(qū)動電機采用直流電機，控制采用MCS-51單片機。控制上采用分時復用技術，僅用一塊單片機實現(xiàn)了信號采集、線路判斷、電機控制等功能。迷宮由16×16個區(qū)組成。起點設在拐角處，終點設在中央，占4個區(qū)。每個區(qū)為180mm×180mm大小，間壁高為50mm，厚度為12mm，側面涂白色，底面涂黑色，如圖1所示。

1迷宮車控制系統(tǒng)的總體設計方案

迷宮車由墻壁傳感器、單片機控制板、動力及轉(zhuǎn)向系組成的，控制框圖如圖2所示。

迷宮車采用輪式移動方式。優(yōu)點是：構造和控制簡單而且技術成熟。從選定電動機轉(zhuǎn)速和輪胎直徑，可以簡單地計算出小車的速度。但是，有關路面的阻力或上坡的驅(qū)動轉(zhuǎn)矩等成為重要的因素。考慮這點，在輪胎上使用無線遙控車的塑膠輪胎。如圖3所示，前輪1為萬向腳輪或球形輪，后輪2和后輪3為獨立驅(qū)動輪，利用它們的轉(zhuǎn)速差實現(xiàn)轉(zhuǎn)向。這種組合的特點是機樞組合容易，而且當2個驅(qū)動輪以相同速度、相反方向轉(zhuǎn)動時車體能繞2個驅(qū)動輪連線的中點自轉(zhuǎn)，值得注意的是自轉(zhuǎn)中心與車體中心不一致。

迷宮車車身材料的選擇。迷宮車使用的材料大部分用于構造，一般應采用金屬材料。迷宮車承載和運動不應產(chǎn)生嚴重的變形和斷裂，從力學角度講即具有足夠的強度。迷宮車負載小，自重輕，對壽命的要求不高。因此，選用鐵皮。

1.1迷宮車控制電路的設計

控制電路主要由電機驅(qū)動電路，單片機接口電路，電源電路和傳感器電路組成?？刂瓶驁D如圖4所示。

(1)紅外線光感電路傳感器通過發(fā)光二極管發(fā)出紅外線，若有障礙物在前方，紅外線會被反射回來，被感光三極管接收，單片機程序?qū)π盘栭_展比較處理，按設定的動作要求向后輪的兩個電機發(fā)出控制命令，控制小車行進。

(2)電機驅(qū)動電路采用89S51單片機，通過L293D芯片來控制兩個驅(qū)動電機動作。89S51根據(jù)紅外傳感器對外界開展探測后反應回來的信號，依據(jù)迷宮車探路算法，判定迷宮車行進方向，分別向左右兩個驅(qū)動電機發(fā)出控制指令，該信號經(jīng)L293D芯片驅(qū)動后，直接控制相應電機動作，使迷宮車按既定動作開展前進、后退、轉(zhuǎn)向。

1.2迷宮車控制程序設計

控制算法：

迷宮車一般有四種控制算法：

(1)靠左算法

①默認靠左走法。即一直沿著左墻壁走，左邊有墻時一直沿著左邊墻壁前進，當左邊沒有墻時左轉(zhuǎn)，然后繼續(xù)靠左邊墻壁運行。該算法使用于簡單的迷宮走法。如圖5所示，其中虛線表示小車前進的路線。

②算法流程圖如圖6所示。

③靠左算法的弊端。按照該算法，小車在走第二遍迷宮的時候，可以性的走出迷宮，但是這條道路不一定是短的道路;如果迷宮本身存在“孤島”，那么小車很有可能走不出迷宮。如圖7所示。圖7中兩個圓點分別表示入口和出口，小車從入口進入迷宮，靠左前進則會導致小車一直按照虛線所描繪出的路線一直在迷宮里循環(huán)，終走不出迷宮。

(2)靠前算法

①靠前算法即一直沿著前方道路前行(前方?jīng)]有任何障礙時一直前進)，當前邊沒有墻時判斷左邊，左邊沒墻左轉(zhuǎn)，左邊有墻則判斷右邊。然后重復該循環(huán)。該算法使用于簡單的迷宮走法。

②算法流程圖如圖8所示。

③程序思路：前邊沒墻靠前走，前面有墻判斷左邊，左邊沒墻靠左轉(zhuǎn)，左邊前邊都有墻再判斷右邊，右邊沒有墻靠右轉(zhuǎn)，三面都墻直接后退轉(zhuǎn)180°，繼續(xù)靠前走。0表示有墻，1表示沒墻，p3.0表示左傳感器;p3.1表示前傳感器;p3.2表示右傳感器。

轉(zhuǎn)角控制思路：計算輪子的轉(zhuǎn)速，測出小車轉(zhuǎn)90°時每個輪子所行的路程，用路程來除速度，求出一個時間作為小車轉(zhuǎn)彎時的延遲時間，再通過調(diào)試進一步轉(zhuǎn)角。

(3)洪水算法

洪水算法即使用256B額外內(nèi)存，會大幅提高性能。該算法比一般迷宮算法的有效率高20～50倍。同時可以在內(nèi)存**立一個區(qū)域，與實際中的迷宮格數(shù)一一對應。在實際使用時算法并不太復雜。該額外內(nèi)存區(qū)域稱為“浪頭”，它將表達在內(nèi)存區(qū)域的實際狀況中如圖9所示。當迷宮被淹沒的時候，一個波浪的前頭從目標格向外擴展。在內(nèi)存區(qū)域中這種單元格是惟一需要處理的，當浪頭到達開始的單元格子，機器人已經(jīng)被淹沒。通常來說，開始的單元格可以是任何一個格子。但是為了方便起見，把開始點設在迷宮的個單元格，終點任意。反過來也可以把出口放在個單元格，把開始點設在中間或希望的位置。一旦到達了起點即搜索完成，短的路徑可以使機器老鼠移動到周圍的格子中數(shù)值比較小的那個格子去，依次類推機器老鼠就能走到終點。

洪水算法的優(yōu)缺點：

①按照該算法小車在次走迷宮的時候，必須把迷宮中所有的道路都走一遍。但是該算法可以讓小車走任何迷宮，即使迷宮本身有“孤島”小車一樣可以順利的走出迷宮。

②當小車再走第二遍迷宮的時候小車可以1次性走正確的路線走出迷宮，并且該路線一定為短的路線。

(4)鋪路算法

在內(nèi)存**立一個區(qū)域與實際中的迷宮格數(shù)一一對應，并將所有走過的路開展記憶，如果發(fā)現(xiàn)前方是死胡同或走過的路就轉(zhuǎn)回前一個岔道口;在行走過程中遇岔道口默認靠左。因為有了記憶功能，就可以走第二遍。

鋪路算法的優(yōu)缺點：

①運用該算法可以走復雜的迷宮，不存在走不出來的問題。

②運用該算法在小車第二次走迷宮的時候可以性的走出迷宮，但是不能保此條道路走的是短的線路。

這幾種算法各有優(yōu)缺點，經(jīng)權衡比較，終選擇靠前算法。

1.3系統(tǒng)運行及調(diào)試

程序運行時遇到的問題及解決方法：

(1)小車的外殼及輪子是純手工安裝的，精度不是很高，小車在行駛過程中不能一直走直線，很容易發(fā)生擦墻事故影響小車走迷宮。若是手工制作時所引起的，可通過給行駛時較落后的輪子上繞一些膠帶來增加輪子的周長來解決。也可通過在電路中參加A/D轉(zhuǎn)換器，對程序開展相對的改良，不斷的測小車與周圍墻壁的距離，保持小車與周圍墻壁保持一定距離來解決。

(2)采用ST188型紅外線傳感器，易受外界干擾不能準確地檢測墻壁信號，尤其是在強光下無法正常運行，對某些材料反射的光無法接收，易受陽光干擾，導致小車不能無誤地走出迷宮。引起干擾的原因是陽光所發(fā)出的紅外線與紅外傳感器所發(fā)出的紅外線是一樣的，都是連續(xù)的，無法區(qū)別，所以易受周圍光線的干擾。對于該問題的解決方法是利用無線遙控基本原理使紅外傳感器所發(fā)出的紅外是一種有固定頻率有別于周圍紅外的信號。對于接收方也開展電路處理，使有區(qū)分能力直接收有固定頻率的紅外信號。這兩處的改良都是通過改良電路來實現(xiàn)的。若是反射面所引起的，通過限制反射面的材料可以解決。根據(jù)555定時器原理，改良傳感器電路如圖10所示。其工作原理是555電路發(fā)出頻率為100Hz的方波，驅(qū)動ST188放射端發(fā)光二極管以100Hz的頻率閃動，發(fā)出閃爍的光波，當有障礙物接近時，反射光引起ST188接收端的光敏電阻以相同的頻率變化，使得圖10中A點的電壓值VA發(fā)生相應變化。VA中包含有直流成分V直和頻率為100Hz的交流成分V變，其中后者反映了障礙物的接近情況。為了保存有用的交流信號V交，去除直流成分V直，用隔直電容C1來完成隔直通交的功能，并由個運放電路完成對V交開展放大，由第二個運放實現(xiàn)直流到交流的轉(zhuǎn)換。具體來說，當遠離障礙物時，運放的輸出VO為高電平;當傳感器接近障礙物時，VO輸出低電平。

(3)小車的速度很難控制，通過程序控制很難把握小車的旋轉(zhuǎn)時間，小車在轉(zhuǎn)90°和180°時，經(jīng)常轉(zhuǎn)過規(guī)定的角度，以至影響小車不能直線走出迷宮。一種解決方法是接入調(diào)壓電路，在給小車轉(zhuǎn)彎時間一定的情況，調(diào)節(jié)馬達上的電壓來改變車輪速度，不斷實踐直到到達預定的標準。另一種解決方法是，在小車速度一定的情況下，不斷通過改變程序中的小車轉(zhuǎn)角時間來改變小車的轉(zhuǎn)角，多次實