智能小車(chē)原理

《智能小車(chē)原理》由會(huì)員分享，可在線(xiàn)閱讀，更多相關(guān)《智能小車(chē)原理（23頁(yè)珍藏版）》請(qǐng)?jiān)谘b配圖網(wǎng)上搜索。

1、人來(lái)完成。而在機(jī)器人在復(fù)雜地形中行進(jìn)時(shí)自動(dòng)避障是一項(xiàng)必不可少也是最基本的功能。因此，自動(dòng)避障系統(tǒng)的研發(fā)就應(yīng)運(yùn)而生。我們的自動(dòng)避障小車(chē)就是基于這一系統(tǒng)開(kāi)發(fā)而成的。于未知空間和人類(lèi)所不能直接到達(dá)的地域的探索逐步成為熱門(mén)，：Vr V意義隨著科技的發(fā)展，對(duì)這就使機(jī)器人的自動(dòng)避障有了重大的意義。t w r . s. r t. r r t、r r - rrrr t 一 咅 b /_ r a ia r -成員情況本組三位成員均為 2005級(jí)基地班學(xué)生，F(xiàn)TiBb ITA小車(chē)從無(wú)障礙地區(qū)啟動(dòng)前進(jìn)，感應(yīng)前進(jìn)路線(xiàn)上的障礙物后，根據(jù)障礙物的位置選擇下一步行進(jìn)方向。并可通過(guò)兩個(gè)獨(dú)立按鍵對(duì)小車(chē)進(jìn)行控速*LLII*（如右

2、圖所示）。小車(chē)在行進(jìn)過(guò)程中由光電開(kāi)關(guān)向前方發(fā)射岀紅外線(xiàn)，當(dāng)紅外線(xiàn)遇到障礙物時(shí)發(fā)生漫反射,信號(hào)的情況來(lái)判斷前方障礙物的分布并做出相應(yīng)的動(dòng)反射光被光電開(kāi)關(guān)接fc*h*作。光電開(kāi)關(guān)的平均探測(cè)距離為，收。小車(chē)根據(jù)三個(gè)光電開(kāi)關(guān):30cm 。ATT3、模塊方案比較及論證ILLII主控a塊廉軟件模塊) 書(shū)驚? 主控芯片探測(cè)模塊) 光電開(kāi)關(guān)組獨(dú)立按*方案一：自己設(shè)計(jì)制作車(chē)架在設(shè)計(jì)車(chē)體框架時(shí)，我們有兩套起始方案，自己制作和直接購(gòu)買(mǎi)玩具電動(dòng)車(chē)。依靠前輪電機(jī)帶動(dòng)前輪轉(zhuǎn)向完成，精度低。FT考慮到利用玩.心用優(yōu)良的算法來(lái)彌補(bǔ)，故我們選擇方案二。左埶左后自己制作小轉(zhuǎn)、右后轉(zhuǎn)、倒車(chē)等動(dòng)作。減速電機(jī)扭矩大，轉(zhuǎn)速較慢易于控制和

3、調(diào)速，符合避障小車(chē)的耍求。而且自己制作小車(chē)框架，可以根據(jù)電路板及傳案方案二:具電動(dòng)車(chē)制作周期較長(zhǎng)，且費(fèi)用較高，因而我們.玩具電動(dòng)車(chē)價(jià)格低廉，有完整的驅(qū)動(dòng)、傳動(dòng)和控制單元，其中傳動(dòng)裝置是我們所需的，縮短了開(kāi)發(fā)周期。K zjSN 衛(wèi)、 六但玩具電動(dòng)車(chē)采用普通直流電機(jī)驅(qū)動(dòng)，帶負(fù)載能力差，調(diào)速方面對(duì)程序要求較高。同時(shí)，玩具電動(dòng)車(chē)轉(zhuǎn)向/ VJf MM/ VJf M/ , Jf I:具電動(dòng)小車(chē)做車(chē)架開(kāi)發(fā)周期短，可留夠充分的時(shí)間用于系統(tǒng)調(diào)試，且硬件上的不足我們有信 vjff VW vjff VnI4-A*-IIIILII但由于需要電線(xiàn)對(duì)小II方案二Lk他邏輯單元供II715VLLVL低電池:6V壓接一個(gè)Qd

4、TTTI直流電機(jī)供電I光電幣關(guān)供電ffIJJ起9Vi電源VI同時(shí)，由于 mega16綜合考慮，我們采用方案三course project ,我們直接選用了課程主要介紹的，機(jī)及其他邏輯單元供電，另取六節(jié)供電。而電機(jī)和光電h上h之并不苛刻，故我們將的勺電源不做穩(wěn)壓處理。這樣給電機(jī)供電.方案三：采用干電池組進(jìn)行供電電池為電機(jī)及電線(xiàn)識(shí)別為障礙物，人為增加了不必要的障礙以安裝四節(jié)干電池故我們放棄了這一方案。蓄電池具有較強(qiáng)的電流驅(qū)動(dòng)能力和較好的電壓穩(wěn)定性能，且成本低廉?？刹捎眯铍姵亟?jīng)3.3主控模塊始時(shí)考慮使用7805芯片對(duì)6V的電池電壓進(jìn)行降壓穩(wěn)壓。但考慮到這樣使得7805采用交流電提供直流穩(wěn)壓電源，電流

5、驅(qū)動(dòng)能力及供電，極大影響了壁障小車(chē)行動(dòng)的靈活性及地形的適應(yīng)能力*LIl重量較小，同V I經(jīng)過(guò)降壓接 7805芯片給單片機(jī)作為單片機(jī)原理與接口技術(shù)課程的而且壁障小車(chē)極易把拖在地上的采用四節(jié)樣電機(jī)啟動(dòng)及制動(dòng)時(shí)的短暫電壓干擾不會(huì)影響到邏輯單元和單片機(jī)的工作。干電池用電池盒封裝，體積和Tht芯片消耗大量能量，降穩(wěn)定性最好，且負(fù)載對(duì)電源影響也最小。且重量過(guò)7812芯片穩(wěn)壓后3.2電源及穩(wěn)壓模塊方案一：采用交流電經(jīng)直流穩(wěn)壓處理后供電只需在小車(chē)主板上加兩個(gè)調(diào)速按鈕，根據(jù)電池電量選擇合適功率即可，甚至于可直接在軟件里設(shè)置自動(dòng)換 擋。ff V科亠 7W V科亠 7久護(hù)* vW V耳 *采用Mega16L作為主控

6、芯片，采用E3F-DS30C47Q用單片機(jī)的使能端，方便*L-昭經(jīng)過(guò)測(cè)量，一般四節(jié)新南孚電池串聯(lián)帶負(fù)載后可提供 5.8V電壓。經(jīng)過(guò)二極管穩(wěn)壓至5.15.2VTA后給邏輯器AP1-5.3V件供電并給系統(tǒng)提供高電平標(biāo)準(zhǔn)。4/使用Mega 16L的PBOPB2接經(jīng)過(guò)電平轉(zhuǎn)換的探測(cè)器信號(hào)線(xiàn)，實(shí)現(xiàn)對(duì)障礙物信息的采集。PC1接受獨(dú)立按鍵信號(hào)，實(shí)現(xiàn)對(duì)小車(chē)行進(jìn)過(guò)程中速度的控制。由于我們小車(chē)電機(jī)A/ 1使用 Mega 16L 的 PCO、 r -幺幺電源沒(méi)有經(jīng)過(guò)穩(wěn)壓，隨著電池電量的消耗，電機(jī)電池組的電壓逐漸降低，因而小車(chē)速度會(huì)發(fā)生變化。我們mXi FT,i就可以通過(guò)獨(dú)立按鍵對(duì)憶 T *n , *.速度進(jìn)行提前設(shè)

7、定，使得即使電池組電量變化，小車(chē)也能按預(yù)定速度行進(jìn)5使用Mega 16L的PD2、PD3接收中斷信息。在軟件部分我們可以看到,Tr的 INTO，V31接地。，即PD2并沒(méi)有使用。使用引腳10為單片機(jī)供電，引腳隨著程序的不斷完善，最終我們7 “Figure 1. ATmega16 的引腰(XCK/TO) PBO 匸(T1) PB1 匚(INT2/A1N0J PB2 匚 (OCO/AJN1J PB3 匚 JPB4CMOSn PB5 匚PB6 C (SCK) PB7 匚 RESET 匚VCC CGND匚XTAL2 CXTAL1 匚(RXD) PtXl 匚(TXDJ PD1 匚 (INTO) PD2

8、匚 (INT1J PD3 匚 (OC1B PD4 匚 (OC1AJ PD5 匚 (ICP1) PD6 匚O1234567B&C12 3 4 5 8 7 B 9 1 1111111112Dfp0987664321 o*va7B5432143333333233222222 222nnnnnnnnnnnnnnnrmnnnPAO (ADCO) PA1 (ADC1) PA2 (ADC2) PA3 (ADC3) PA4 (ADC4) PAS (ADC5) PA6 (ADC6) FV7 (ADC7) AREFGNDAVCCPC7 (TOSC2J PC6 (TOSC1J PCS (TDI) PC4 (TOO)

9、 PCS (TMS) PC2 (TCK) PC1 (SDA)PCD (SCLPD7 (OC2)我們還是給以闡釋?zhuān)?。所述，最終我們用定時(shí)器中斷代替了這個(gè)外部中斷， 但作為硬件設(shè)計(jì)和焊接的一部分， 兩個(gè)獨(dú)立按鍵分別控制提速和減速，沒(méi)有按下時(shí)一一一亠，F(xiàn) 亠一亠一 電平，同時(shí)給出一個(gè)低電平給 INT1。任務(wù)實(shí)現(xiàn)：i ”W-，信號(hào)線(xiàn)給岀高電平。當(dāng)任意一鍵按下時(shí)，信號(hào)線(xiàn)給岀低J * c r * 我們用74HC08的一卡1 、第一個(gè)任務(wù)的實(shí)現(xiàn)原本想采用三輸入或非門(mén)甲丁 - /74HC27 實(shí)現(xiàn)。*3/T：1 JJTT第二個(gè)任務(wù)邏輯的實(shí)現(xiàn)使用任務(wù)邏輯X按鍵與邏輯高電平（I 4F1XJTTVLII光電開(kāi)餐組*

10、kTiM1742T任務(wù)實(shí)現(xiàn)rfT回的信號(hào)是非標(biāo)發(fā)射極電壓小于+5V反1i_ V hi變化。若前方有障礙物2.光電* L1.光電TE h 7將光電開(kāi)關(guān)傳回的非標(biāo)準(zhǔn)的開(kāi)關(guān)電平信號(hào)轉(zhuǎn)換成這對(duì)于 Mega16芯片是不適用的。T設(shè)計(jì)任務(wù)：I寸出的紅外線(xiàn)在經(jīng)障礙物漫反射后會(huì)由光電開(kāi)關(guān)再接則光電開(kāi)關(guān)傳回低電平；若前方無(wú)障礙物但這并不影響前方障礙物的探測(cè)。型光電開(kāi)關(guān)傳回的電平I個(gè) 5K1的電阻上拉，使輸出的高0。這樣輸出電平已經(jīng)轉(zhuǎn)化為 CMOS標(biāo)準(zhǔn)電平。不過(guò)，這N h1*10K1：-:的變化可以實(shí)現(xiàn)對(duì)前方障礙物的探測(cè)。p-f豐 bCMOS標(biāo)準(zhǔn)電平（即將 09V轉(zhuǎn)換成05V）8050三極管來(lái)實(shí)現(xiàn)電平的轉(zhuǎn)換。由三

11、極管的電氣特性，當(dāng)其基極為低電平時(shí)，即基極T時(shí)傳回到Mega16的電平信號(hào)已經(jīng)和原來(lái)光電攵到，這會(huì)引則光電開(kāi)關(guān)傳回的是高電平。有電平導(dǎo)通壓降，其輸岀電平為高電平，在其輸岀端有 極為高電平時(shí)，三極管發(fā)射極正偏，輸出電平為lULI電機(jī)驅(qū)動(dòng)模塊的電路圖DIOIvLLI6vIviLL4148T4k4148QTOVOA*4148414S+5Vj關(guān)閉時(shí)泄流之用nTA控制轉(zhuǎn)向電制其實(shí)現(xiàn)前進(jìn)對(duì)于后置電量不1OCO)連接T7IL?9fi ,WL298N芯片的SENSOLT4 0UT3 DWENBINS 再安+5VCKD ECENA IN;VSS 0LT2 OLT： SEsA電機(jī)驅(qū)動(dòng)模塊主要功能是將主控芯片發(fā)岀的

12、信號(hào)通/irp _ 1 /If1 _ 1 /Itocryoury7?ZTVOUT/頁(yè)過(guò)L298N由于我們足而產(chǎn)生的小車(chē)變慢的問(wèn)題。所以，我們將HIM動(dòng)電機(jī)，我們不僅:電機(jī)控制芯片轉(zhuǎn)化為小車(chē)實(shí)際的動(dòng)作。雅L298N芯片有兩個(gè)電源引腳 VDD引腳和VCC引腳。VDD弓I腳接+9V電源用來(lái)給電機(jī)供電，VCC弓I腳接15L298N芯片通過(guò)一個(gè)有四個(gè) 4148二極管組成的保護(hù)電路與電機(jī)相連，保護(hù)電路主要是用來(lái)在電機(jī)開(kāi)啟和呂退和停止，還要能夠控制其轉(zhuǎn)速以解-*vHENB引腳與 Mega16的PB3引腳機(jī)的輸岀功率，所以 ENA引腳（即轉(zhuǎn)向電機(jī)使能引腳）直接接+5 V，即讓轉(zhuǎn)向電機(jī)一直使能。Al /QA1

13、/QAI ?功率使能從而獲得最大的扭矩，保證小車(chē)轉(zhuǎn)向成功，而不用來(lái)實(shí)現(xiàn)PWM調(diào)速。T，驅(qū)動(dòng)模塊爾LTJlJU brJiIbILVtIT后退Vv1LLLLIIILI所用全部硬件資源2TATMega 16L/32LLLLLLLLL2983只8IL5K1電阻散熱(12)UU(13)40(15)y7*T目前程TA,*L，和調(diào)試過(guò)程VHTJ單片機(jī)1片.機(jī)驅(qū)動(dòng)芯片1片的PA3和PA2引腳連接用來(lái)接收主控芯片輸岀的驅(qū)動(dòng)電機(jī)J* L四、程序簡(jiǎn)版JTAG仿真器（程序的下載和仿真）7TLr和PA0引腳連接用來(lái)接收主控芯片輸岀的轉(zhuǎn)向電的動(dòng)作指令，并通過(guò) 0UT1和0UT2來(lái)控制轉(zhuǎn)向電機(jī)的正轉(zhuǎn)與反轉(zhuǎn)，最終功能的實(shí)現(xiàn)表

14、現(xiàn)在小車(chē)的左轉(zhuǎn)與寧的IN1和NT0中斷觸發(fā)LJ1F檢測(cè)傳感器端口的反饋值1fTTTTTTTT的，不能根據(jù)環(huán)境自動(dòng)調(diào)整，前進(jìn)后退都太沖；因?yàn)閯?dòng)作都是用延時(shí)函數(shù)實(shí)現(xiàn)的，動(dòng)作中要禁用全局中斷，導(dǎo)致發(fā)現(xiàn)障TjT發(fā)現(xiàn)前方有大障礙（111）:發(fā)現(xiàn)右方有大障礙（110 ）:后退并右轉(zhuǎn);交大的后退并右轉(zhuǎn)發(fā)現(xiàn)左方有大障礙（011 ）:后退并左轉(zhuǎn)；發(fā)現(xiàn)兩邊有障礙但中間無(wú)障礙T 101）：較大的后退并右轉(zhuǎn);按照這樣常常一頭撞上去:后退態(tài)，經(jīng)常撞上后面的物體。礙物不及時(shí)，時(shí)動(dòng)作無(wú)法調(diào)整，即使已經(jīng)避開(kāi)了障礙物還是無(wú)法及時(shí)轉(zhuǎn)換成前進(jìn)狀巳整,鑒于以上發(fā)現(xiàn)的問(wèn)題，我們又修改寫(xiě)成了第二版程序，流程圖與第一版大致 相同，所不同的

15、r &反饋值，然后根據(jù)反饋值選擇下一步動(dòng)作。也就是說(shuō)，理函數(shù)形成了循環(huán)，循環(huán)的唯一岀口在前進(jìn)函數(shù)里，只有可的是每次動(dòng)作的時(shí)間都被改得非常短（約幾個(gè)毫秒），在每個(gè)動(dòng)作結(jié)束后都在此檢測(cè)探測(cè)器8個(gè)動(dòng)作函數(shù)（加了一個(gè)前進(jìn)）和一個(gè) INTO中斷處已無(wú)障礙物時(shí)才能退nr vn vnr vn 器 Vnr v望通過(guò)縮短每次動(dòng)作的時(shí)間、縮短兩次探測(cè)之間的間隔時(shí)間來(lái)達(dá)到變行進(jìn)邊探測(cè)效果，使小車(chē)的動(dòng)作更加檢測(cè)到前方斷。我們希?TF靈敏。1.2miT1r01I前方無(wú)障礙物前方有障礙物L(fēng)仃障/L刖進(jìn)1/等待下次中斷觸發(fā)7種）斷端口值但隨之而來(lái)又出現(xiàn)了新TTT檢測(cè)判斷端口侑T個(gè)動(dòng)作函數(shù)中選擇一個(gè)執(zhí)行h V iff V v

16、障礙物情況很拡檢測(cè)別的障礙物怙況（分7種）*從7個(gè)動(dòng)作函數(shù)中選擇一個(gè)執(zhí)疔有障礙 無(wú)障礙INTO中斷觸發(fā) 端口值是多少？檢測(cè)傳感器端口的反饋值前方有障礙物 根據(jù)檢測(cè)到的等待下次中斷觸發(fā) t卜 * TV 對(duì)于這一版程序，我們?cè)谡{(diào)試過(guò)程中發(fā)現(xiàn)小車(chē)四處亂撞的問(wèn)題已經(jīng)基本能解決了端I r俏足 多少？前方無(wú)障礙物檢測(cè)判INTO 中1斷觸發(fā)1r檢測(cè)傳感器端口的反饋價(jià)1L問(wèn)題的具VILI改為用觸發(fā)溢岀T1LI1III4LLT4T4前方無(wú)障礙物前方仃障円物I等待下次中斷觸發(fā)T1T端口俏足 多少？體表現(xiàn)為：端口值有規(guī)律根掘檢測(cè)到的陽(yáng)礙物情況（分 7種），從7個(gè)動(dòng)作函效中選擇 一個(gè)執(zhí)行有一個(gè)動(dòng)作，動(dòng)作完成后不再1.

17、3第三版程序的主流程圖：等待下次中斷再修改控制端口值。（分 7同時(shí)節(jié)省CPU時(shí)間，我們對(duì)程序進(jìn)行了較大調(diào)整 中進(jìn)行檢測(cè)和行動(dòng)。iflr ；地閃動(dòng)，大約0.2秒閃一次，出現(xiàn)一個(gè)極短的脈沖，其值恰好是 前進(jìn)TA因造成了這種現(xiàn)象，是退岀中斷服務(wù)程序時(shí)的一個(gè)脈沖。IlA* LIITH前進(jìn)和轉(zhuǎn)向的端Tr溢岀中斷 端口值是多少？ 檢測(cè)傳感器端口的反饋值 前方有障礙物 根據(jù)檢測(cè)到的障礙物情況為了解決端口電平不穩(wěn)定的問(wèn)題，也為了定時(shí)更加準(zhǔn)確 金器來(lái)控制動(dòng)作和檢測(cè)。這時(shí)的行動(dòng)只是改變控制端口值，不需要延時(shí)函數(shù)，這就大大節(jié)約了 CPU時(shí)間。每個(gè)動(dòng)作函數(shù)都精簡(jiǎn)到只r1T1溢出中斷1檢測(cè)傳感器端口的反慣值1FfLLL

18、I1種）另外在啟I自動(dòng)變速I(mǎi)NT1LI在測(cè)試中I暢了許多71LLVvLLLLL第四版程序中新增添了防卡死機(jī)實(shí)現(xiàn)1.4LL!Vn1VirnVII*T7,r IkIkT1 Jv4 i動(dòng)作，從Jl j VJl j VhV “_L為了解決這個(gè)問(wèn)題，我們?cè)诘?制，結(jié)合定時(shí)器控制和延時(shí)函尋物Zu%比較慢，沒(méi);V .而卡死。后退，后退到光常靈敏，能1 .V我們發(fā)現(xiàn)這樣的改變收到了良好的效果。小等待下次不過(guò)，在測(cè)試中我們還是發(fā)現(xiàn)了新的問(wèn)題：小車(chē)在碰上前方的障*L擊、&2/“二，、&kh. . |lhIt障礙的地方改變方向前進(jìn)，這是程序設(shè)計(jì)的動(dòng)作；但是如果小車(chē)在光電開(kāi)關(guān)檢測(cè)距離閾值的地方正好速度連續(xù)動(dòng)作的進(jìn)行時(shí)

19、間，由程序* L第四版程序的主流程圖動(dòng)和制動(dòng)時(shí)給小車(chē)較大的動(dòng)力能夠保證小車(chē)在改變方向時(shí)有足夠的1/X1夕j J7個(gè)動(dòng)作函數(shù)中選從這一流程圖可以看出的速度不再由各個(gè)動(dòng)作函數(shù)直接指定，而是通過(guò)計(jì)算一個(gè). TA Z .的OCRO值。這樣做主要是為了配合小車(chē)的啟動(dòng)和制動(dòng),tLIl在前方障礙物的檢測(cè)和避過(guò)上已經(jīng),U 丁亠即 ff V在隨意放置的障礙物陣中迅速找到前進(jìn)的路線(xiàn)穿過(guò)陣列。由于加上了自動(dòng)變速程序，小車(chē)的動(dòng)作也變得流J*，亠riJ*，亠riJ*斷觸發(fā)我們盡可能的精簡(jiǎn)了小車(chē)的動(dòng)作過(guò)程而在一般行進(jìn)時(shí)使用普通功率，這樣就可以既有效的控制小車(chē)的速度，又 E們還修改丨兩個(gè)按鍵的功能，不再是控制起始速度，而是

20、控制普通行進(jìn)時(shí)的速度，使這兩個(gè)控制按鍵更加實(shí)用。使得整個(gè)判斷處理過(guò)程簡(jiǎn)潔而迅速。1eVEl*TJ LrJt4/端口值是多少？詢(xún)力無(wú)障礙物T1溢出中斷記錄上一次釣動(dòng)作持續(xù)時(shí)間檢測(cè)傳感器端口的反饋（311前方有障倚物根據(jù)檢測(cè)到的障筒物帖況（分 7種人從7個(gè)動(dòng)作函數(shù)中選擇 個(gè)執(zhí)行T1等待下次中斷觸發(fā)溢岀中斷端口值是多少？反饋值種），從否卡死?7個(gè)動(dòng)作函數(shù)中選擇一個(gè)執(zhí)行等待 I執(zhí)行卡死 處理函數(shù) 清空歷史記錄 否是次中斷觸發(fā)執(zhí)行卡死 處理函數(shù)清空歷史記錄前方有障礙物根據(jù)檢測(cè)到前方無(wú)障礙物記錄上（分 7次的動(dòng)作持續(xù)時(shí)間是尋物情況ILI寸是一個(gè)有7t8次動(dòng)作中有7次以上持續(xù)時(shí)間在V中間沒(méi)有時(shí)LLI行從障礙

21、物中間穿過(guò)比較靈敏了IIL此外有兩函數(shù)。fLLLLILLI*共有J,r IkTO定時(shí):timerO_init();PINB端口值判斷前方障礙物情況。I勺問(wèn)題，小車(chē)對(duì)OCRO1LLAisr_timerO_isr_INTO();mid_power個(gè)輔助軟件3L期間禁用了T17種設(shè)定的障礙物情況，詳T相關(guān)函數(shù):從啟動(dòng)開(kāi)始，利用變量防卡死機(jī)制有效地解決了小車(chē)程序設(shè)計(jì)了 3擋自動(dòng)調(diào)速探測(cè)到障礙物需要障礙探測(cè)模塊：如前所述，通過(guò)讀取T0.4秒以下，就認(rèn)為小車(chē)被卡住了，這時(shí)執(zhí)行卡死處理函數(shù)，讓小車(chē)退岀卡死區(qū)域。LjV1 Ljd* IlL障礙物的躲避也行進(jìn)方向 ymid_power 值加1卡死處理函數(shù)使用了延

22、ax_power, fast_poWer,間，使用最大功率連續(xù)前進(jìn)或后退0.3秒以克服摩擦阻力，接下來(lái) 0.3秒時(shí)用較大功率，以后使用普通功I/n時(shí)重新計(jì)時(shí)。通過(guò)兩個(gè)獨(dú)立按鍵可以調(diào)整普通功率 q視障礙物情況執(zhí)行1-3次倒退轉(zhuǎn)向動(dòng)作。此外我們改變了一個(gè)動(dòng)作函數(shù)yrixl穴1氣1穴VXI孑相關(guān)函數(shù)：- 1作為小車(chē)周期性探測(cè)和動(dòng)作的時(shí)鐘。，片f定時(shí)器產(chǎn)生0.1秒間隔的溢岀中斷每次行進(jìn)方向改變，即由后退轉(zhuǎn)為前進(jìn)或由前進(jìn)轉(zhuǎn)為后退時(shí)率。其間如果：V直計(jì)算按鍵的時(shí)間，每個(gè)時(shí)間單位count moVe來(lái)計(jì)算連續(xù)行動(dòng)的時(shí)這一版程序?yàn)槲覀冃≤?chē)的最終定型程序。set_OCRO()trap_handler();del

23、ay100us(n); fjdelay10ms(n);動(dòng)作歷史記錄隊(duì)列為基礎(chǔ)的s亠timer1_init();.Iisr_timer1_ovf(); y/Tl|histoid，Hr *PWM波形來(lái)控制驅(qū)動(dòng)電機(jī)的輸出功率。F1程序模塊構(gòu)成J 1系統(tǒng)時(shí)鐘模塊：通過(guò)T1亍h *7718個(gè)元素的數(shù)組個(gè)八即認(rèn)為一次連續(xù)動(dòng)作結(jié)束，記錄這個(gè)動(dòng)作的1IIIIAtII常規(guī)動(dòng)作模塊:1V10LLIrVLI110LLLhistory 8LL曰./若有改變則歷動(dòng)V1相關(guān)函數(shù)Itrap_handler();V*且保芻f相關(guān)函數(shù):V下（括號(hào)內(nèi)現(xiàn)端口值不穩(wěn)定的問(wèn)題，該函數(shù)使用100(A JLa jL每次T1move_fro

24、nt_bigobj()V I）3次T在行進(jìn)中對(duì)障礙* Ik相關(guān)函數(shù):T1定時(shí)器，這樣設(shè)計(jì)是因?yàn)檐浖訒r(shí)對(duì)時(shí)間間隔的控制更為靈活。為了防止像以前版本中的軟件延時(shí)動(dòng)作73層嵌套判斷結(jié)構(gòu)）8次連續(xù)動(dòng)作所經(jīng)過(guò)的時(shí)間。初始值都設(shè)定為HrI111）:較大的后退并右轉(zhuǎn)說(shuō)明小車(chē)在（通過(guò) isforward變量標(biāo)志）isr timer1 ovf()_別足以使小車(chē)退到安全區(qū)域move_front_obj()史記錄自動(dòng)清空為初始狀態(tài)。%L%Lmove_right_obj()move_left_obj()函數(shù)一樣判斷，若中間有一次探測(cè)發(fā)現(xiàn)障礙物消失，則退岀函數(shù)繼續(xù)執(zhí)行常規(guī)動(dòng)作。這樣就可以使函數(shù)的最大動(dòng)作 動(dòng)作的流暢性

25、。record_history();發(fā)現(xiàn)右方有小障礙（100 ）:前進(jìn)并左轉(zhuǎn)VV 乂If V發(fā)現(xiàn)左方有小障礙（001 ）:前進(jìn)并右轉(zhuǎn)“7/ - &7/*發(fā)現(xiàn)前方有小障礙（010）:后退并右轉(zhuǎn)閾值的位置上且一 LtJ*1 L*dB1 ktJ01等于4 （連續(xù)動(dòng)作持續(xù)時(shí)間小于或等于0.4秒），則變量recorder加1；若最終recorder值大于或等于 7賣(mài)多次改變了行進(jìn)方向，則認(rèn)為小車(chē)處在探根據(jù)障礙探測(cè)模塊的返回值，由8個(gè)動(dòng)作函數(shù)控制小車(chē)的各種動(dòng)作。修改后的動(dòng)作列表如THAI E發(fā)現(xiàn)兩邊有障礙時(shí)間達(dá)到0.9秒history數(shù)組的各個(gè)元素值行卡死處理函數(shù)trap_handler（）。trap_h

26、andler（）是一個(gè)使用軟件延時(shí)作為計(jì)時(shí)方法的函數(shù)，執(zhí)行期間禁用isr_timer1 ovf( trap_handler();進(jìn)穿過(guò)；（move_double_obj（） i/V其值代表之前后退并右轉(zhuǎn)；（move_rjght_bigobj（）“發(fā)現(xiàn)左方有大障礙（011 ）:后退并左轉(zhuǎn)；（move_left_bigobj（）V_LFlTf r1、系統(tǒng)實(shí)現(xiàn)功能：AA對(duì)于前方任意放置的障礙物的靈活規(guī)避；3檔自動(dòng)變速；正常行進(jìn)速度的手動(dòng)連續(xù)調(diào)節(jié)；防卡死機(jī)制，可以有效地退岀夾縫、通過(guò)在小車(chē)前方擺放不同顏色的障礙物來(lái)測(cè)試小車(chē)的制動(dòng)距離。該項(xiàng)測(cè)量在小車(chē)行進(jìn)中進(jìn)行?！?T1 匕T2、系統(tǒng)主要參數(shù)測(cè)試：角落等區(qū)域。給光電開(kāi)關(guān)供電，前側(cè)放置不同顏色障礙物，通過(guò)尾部指示燈觀(guān)察探測(cè)距離。淺色：30cm深色：20cm韋 1八；L