陸春雨 王琰

【摘要】介紹了一種基于AT89S52單片機的智能避障小車。系統(tǒng)以AT89S52 為控制核心，采用3組紅外傳感器完成障礙物檢測。通過I/O口控制360°伺服舵機實現(xiàn)小車前進、倒退、轉(zhuǎn)向、避障等動作，利用PWM（脈寬調(diào)制）方法可精確控制小車運行速度。系統(tǒng)電路結(jié)構(gòu)簡單，響應(yīng)速度快，實踐證明小車能夠成功實現(xiàn)自動避障。

【關(guān)鍵詞】AT89S52;紅外傳感器;伺服舵機;避障

Abstract：This paper introduces an intelligent obstacle avoidance car based on SCMC.The system uses AT89S52 as the control core，using 3 groups of infrared sensors for obstacle detection.Through the I/O port control 360 °servo realize the cars forward，backwards，steering，obstacle avoidance action ect，and using the Pulse-Width Modulation（PWM）method can control the speed of the car accuracy.This system has the advantages of simple structure，fast response speed and test proved that the car could keep away from the obstacle successfully.

Key words：AT89S52;Infrared sensor;Servo steering gear;Obstacle avoidance

引言

智能小車作為輪式機器人的一個重要分支，隨著機器人研究的深入受到越來越多人的關(guān)注。國內(nèi)很多高校和研究院所在機器人小車項目上都取得了成績，也有多家公司在開發(fā)和研制教學及比賽用機器人小車。本設(shè)計以AT89S52單片機作為系統(tǒng)控制核心，單片機根據(jù)紅外避障傳感器檢測到的不同信號，控制小車左右兩個伺服舵機的轉(zhuǎn)速和方向，完成正常行駛和自動避障功能。實踐證明，此方案可行并且可靠。

1.系統(tǒng)總體設(shè)計

小車車體結(jié)構(gòu)俯視圖[1]如圖1所示，循跡小車主要由控制電路板、電機、傳感器模塊、底盤部件等結(jié)構(gòu)組成。系統(tǒng)總體框圖如圖2所示，總體設(shè)計方案如下：

圖1 車體結(jié)構(gòu)俯視圖

圖2 系統(tǒng)總體框圖

①控制電路板以AT89S52為控制核心，外接紅外避障傳感器和控制電機信號;②電機采用伺服舵機驅(qū)動小車實現(xiàn)基本巡航動作（前進、后退、左轉(zhuǎn)、右轉(zhuǎn)、停止、掉頭）;③傳感器選擇三只E18-D80NK紅外光電開關(guān)檢測小車前方障礙物，單片機根據(jù)三個傳感器接收信號的情況判斷前方障礙物的分布，控制小車自動避障。④小車底盤部件包括了底盤本體、電池盒 、左右輪子和尾輪等部件。選用三輪結(jié)構(gòu)車體，車體前方兩側(cè)為驅(qū)動輪，后方中心裝有尾輪，起支撐作用，這樣可以保證小車能夠靈活循跡。

2.系統(tǒng)硬件設(shè)計

2.1 伺服電機模塊

采用可以按照指令連續(xù)控制位置或速度的360度伺服舵機。舵機的控制信號為周期是20ms的脈寬調(diào)制（PWM）信號。舵機內(nèi)部有一個基準電路，產(chǎn)生周期20ms，寬度1.5ms的基準信號，有一個比較器，將外加信號與基準信號相比較，判斷出方向和大小，從而產(chǎn)生電機的轉(zhuǎn)動信號。圖3所示是高電平持續(xù)1.5ms 低電平持續(xù)20ms，然后不斷重復(fù)的控制脈沖序列。該脈沖序列發(fā)給經(jīng)過零點標定后的伺服電機，伺服電機不會旋轉(zhuǎn)。如果此時電機旋轉(zhuǎn)，表明電機需要標定。

圖3 電機轉(zhuǎn)速為零的控制信號時序圖

圖4 控制伺服電機順時針全速旋轉(zhuǎn)的時序

圖5 控制伺服電機逆時針全速旋轉(zhuǎn)的時序

圖6 電機與單片機的接口原理

從圖3、圖4和圖5可知[2]，控制電機運動轉(zhuǎn)速的是高電平持續(xù)的時間，當高電平持續(xù)時間為1.3ms時，電機順時針全速旋轉(zhuǎn)，當高電平持續(xù)時間1.7ms時，電機逆時針速旋轉(zhuǎn)。舵機的輸入線共有三條，紅色是電源線，黑色是地線，另外一根白線是控制信號線。選擇P1_0專門控制右輪伺服電機;P1_1專門控制左輪伺服電機。電機與單片機的接口連接如圖6所示。

2.2 紅外避障模塊

選擇光電開關(guān)E18-D80NK-N進行障礙物信息采集，E18-D80NK-N是一種集發(fā)射與接收于一體的光電傳感器，平均有效探測距離0～80cm可調(diào)，發(fā)射光經(jīng)過調(diào)制后發(fā)出，接收頭對反射光進行解調(diào)輸出。有效的避免了可見光的干擾。E18-D80NK-N是NPN型光電開關(guān)，檢測到目標物體時輸出低電平，正常狀態(tài)時高電平輸出。其外部接線是三線制，紅色接+5V電源，綠色線接地，黃色是輸出信號，輸出時外加一個1K的上拉電阻接到單片機I/O口上。光電開關(guān)內(nèi)部原理和外部接線圖如圖7所示[3]。小車車頭安裝3個E18-D80NK，中間一個對向正前方，左右兩側(cè)傳感器向兩邊分開約30度，分別探測正前方，前右側(cè)，前左側(cè)障礙物信息。三個光電開關(guān)輸出信號分別連接到了P2_1，P2_2，P2_3引腳上。

圖7 傳感器內(nèi)部原理及外部接線圖

2.3 電源模塊

采用2節(jié)3.7V可充電式鋰電池串聯(lián)共7.4V電源，經(jīng)三端穩(wěn)壓器7805經(jīng)C6、C7濾波，在電源電路里起到抑制紋波電壓，濾除高頻干擾的作用，7.4V電壓經(jīng)7805的電壓變換后使得輸出得到一個穩(wěn)定平滑的邏輯數(shù)字5V直流電壓給伺服舵機、單片機芯片以及傳感器供電。電源系統(tǒng)的電路圖如圖8所示。

圖8 邏輯5V電壓產(chǎn)生電路

圖9 move函數(shù)體

3.系統(tǒng)軟件設(shè)計

3.1 小車基本動作實現(xiàn)

小車向前走時，從小車的左邊看，它向前走時輪子是逆時針旋轉(zhuǎn)的;從右邊看另一個輪子則是順時針旋轉(zhuǎn)的。同理，小車其他動作左右輪子的運動方向也可以分析出來，結(jié)合圖3、圖4、圖5電機控制時序圖，可分析出小車運行方向和速度控制情況，如表1所示。在表1中，無論是參數(shù)tleft還是tright，其值越接近1500?s，小車速度越低。因此，可通過改變參數(shù)大小實現(xiàn)小車的加減速控制。發(fā)給單片機控制引腳的高電平持續(xù)時間決定了伺服電機旋轉(zhuǎn)的速度和方向。實際上兩個輪子的不同速度組合控制著機器人的運動速度和方向，因此在C語言程序設(shè)計中，可以直接用兩個車輪的速度作為形式參數(shù)，定義left為左輪參數(shù)，定義right為右輪參數(shù)，這樣可以將小車所有運動用一個函數(shù)（move）來實現(xiàn)。for循環(huán)的參數(shù)counter控制了發(fā)送給電機的脈沖數(shù)量。由于每個脈沖的時間是相同的，因而for循環(huán)的參數(shù)也控制了伺服電機運行的時間。move函數(shù)的定義如圖9所示。

表2 小車自動避障策略表

3.2 小車避障功能的實現(xiàn)

圖10為自動避障程序流程圖，該流程圖中小車的7個避障動作函數(shù)內(nèi)容與表2所給出的避障策略表一致。采用T1定時器作為小車周期性探測和動作的時鐘，每隔0.1s響應(yīng)T1定時中斷，在T1的中斷服務(wù)程序中判斷三個光電開關(guān)的返回值，控制小車完成相應(yīng)的避障動作。

圖10 小車自動避障程序流程

4.結(jié)論

實際測試證明，該系統(tǒng)控制下的小車具有很好的自動避障能力，經(jīng)過多次測試和調(diào)試，總結(jié)如下幾點經(jīng)驗：①注意調(diào)整紅外傳感器的角度，使傳感器不會受桌面等非障礙物的影響。②小車全速行駛突然停下時，小車會有翻車或向前沖的可能，導(dǎo)致后續(xù)動作出現(xiàn)偏差。這個問題的有效解決方法是：停止程序后執(zhí)行一個停頓脈沖和200毫秒的延時。這樣就很好的增加了小車運行的穩(wěn)定性。③程序中發(fā)送脈沖給電機之前檢查障礙物，可大大改善小車行走性能。

參考文獻

[1]劉開緒，韓志友.基于AT89C51的尋跡小車掉頭運動系統(tǒng)設(shè)計與實現(xiàn)[J].長春工業(yè)大學學報（自然科學版），2009， 30（1）：79-81.

[2]秦志強.C51單片機應(yīng)用與C語言程序設(shè)計[M].電子工業(yè)出版社，2011.8.

[3]向楠，鄒華東.基于STC89C52RC單片機智能搬運電動小車設(shè)計[J].湖南工程學院學報（自然科學版），2014， 24（1）：19-21.

基金項目：2013江蘇省高等學校大學生實踐創(chuàng)新訓練計劃項目（編號：201312920004Y）。

作者簡介：

陸春雨（1993—），男，現(xiàn)就讀于南京化工職業(yè)技術(shù)學院機電一體化技術(shù)專業(yè)。

王琰（1980—），女，工學碩士，講師，主要研究方向：機電控制技術(shù)。