智能循跡避障小車控制系統(tǒng)設計最終版

1、上海大學20162017學年秋季學期研究生課程考試課程名稱：微機接口技術與數(shù)字控制課程編號：09Z077005論文題目：基于STC89C5口片機自動避障循跡小車控制系統(tǒng)的設計研究生姓名：肖青峰、徐鵬、付高峰學號：16721678任課教師:沈林勇論文評語：成績：評閱日期：基于STC89C52$片機自動避障循跡小車控制系統(tǒng)設計肖青峰、徐鵬、付高峰上海大學機電工程與自動化學院，上海200072摘要：本設計是基于STC89C5空片機的自動循跡避障小車的控制系統(tǒng)設計。利用紅外對管檢測黑線與障礙物，并以STC89C52L片機為控制芯片控制電動小汽車的速度及轉向，從而實現(xiàn)自動循跡避障的功能。其中小車驅動由L

2、298N驅動電路完成，速度由單片機輸出的PWM控制。關鍵詞：循跡避障小車；STC89C52單片機；紅外對管；pwm速-25 -1設計目標和任務制定隨著社會水平提高與電子商務的快速發(fā)展，大型化集成化商品多元化的倉儲集散中心應運而生。這些倉庫通常面積巨大，（有的可達上萬平方米，）并且物品種類繁多，倉儲流量大，可是當前大多數(shù)倉儲中心依舊采用傳統(tǒng)的人工管理，工人管理工作繁瑣且工作效率低下，綜上所述，現(xiàn)代倉儲業(yè)正面臨著發(fā)展瓶頸，制約著倉儲行業(yè)的進一步發(fā)展。如果有一種智能倉儲，使得我們能夠在實際的物流活動中提高倉儲的效率，減少倉儲的人力資源成本和倉庫的直接成本，解決絕對人力不能滿足大型物流中心運作的情況，

3、那么我們的倉儲行業(yè)又能向前邁進一個新階。因此，基于上訴當前倉管配貨工作的任務繁忙，減小倉管員工作量,提高倉儲管理工作效率，我們決定制作一智能避障循跡小車，用于倉庫不同貨架間貨物的自動配送。我們的小車能實現(xiàn)循跡移動，在不同工作點之間穿梭。借助我們的小車，倉管員只需輕松輸入目標代碼，就可以實現(xiàn)將貨物自動送達目標貨架或者將不同貨架的貨物收集到配送點。同時為了避免小車在行進過程中撞擊到人員、貨物或者貨架等障礙物，我們的小車具有自動避障和自動停車功能。2設計方案的擬定2.1 整體系統(tǒng)設計該整個系統(tǒng)由控制模塊、光電傳感器檢測模塊、電源模塊、電機及驅動模塊等子模塊組成。如框圖所示:2.2 控制模塊設計針對本

4、設計特點一一多開關量輸入的復雜程序控制系統(tǒng)，需要擅長處理多開關量的標準單片機，而不能用精簡I/O口和程序存儲器的小體積單片機，D/A、A/D功能也不必選用。根據這些分析，我選定了STC89C52I片機作為本設計的主控裝置，52單片機具有功能強大的位操作指令，I/O口均可按位尋址，并具有如下性能優(yōu)點：（1）微處理器該單片機中有一個8位的微處理器，與通用的微處理器基本相同，同樣包括了運算器和控制器兩大部分，只是增加了面向控制的處理功能，不僅可處理數(shù)據，還可以進行位變量的處理。（2）數(shù)據存儲器片內為128個字節(jié)，片外最多可外擴至64k字節(jié)，用來存儲程序在運行期間的工作變量、運算的中間結果、數(shù)據暫存和

5、緩沖、標志位等，所以稱為數(shù)據存儲器。（3）程序存儲器由于受集成度限制，片內只讀存儲器一般容量較小，如果片內的只讀存儲器的容量不夠，則需用擴展片外的只讀存儲器，片外最多可外擴至64k字節(jié)。（4）中斷系統(tǒng)具有5個中斷源，2級中斷優(yōu)先權。（5）定時器/計數(shù)器片內有2個16位的定時器/計數(shù)器，具有四種工作方式。（6）串行口1個全雙工的串行口，具有四種工作方式?？捎脕磉M行串行通訊，擴展并行I/O口，甚至與多個單片機相連構成多機系統(tǒng)，從而使單片機的功能更強且應用更廣。（7）P0口、P1口、P2口、P3口為4個并行8位I/O口。（8）特殊功能寄存器共有21個，用于對片內的個功能的部件進行管理、控制、監(jiān)視。實

6、際上是一些控制寄存器和狀態(tài)寄存器，是一個具有特殊功能的RAMK。由上可見，STC89C52單片機的硬件結構具有功能部件種類全，功能強等特點。特別值得一提的是該單片機CPU中的位處理器，它實際上是一個完整的1位微計算機，這個一位微計算機有自己的CPU位寄存器、I/O口和指令集。1位機在開關決策、邏輯電路仿真、過程控制方面非常有效；而8位機在數(shù)據采集，運算處理方面有明顯的長處。對于本設計該單片機綽綽有余，更可貴的是52單片機價格非常低廉。81Pl0JT2PO.OJADOPl1JT2EXPD.1；AD1Pl2P0.2/AD2Pl3P0.S/AD3Pl4P0.4?AD4Pl5P0&AD5Pl6

7、P0.67AD6Pl7P0.77AD7P30/RXDP2.7/A15P3IfTXDP2.6/A14P32/INTOP2.5/A13P33/INT1P24/A12P34fT0P2.3/A11P3VT1P2.2/A10P36tWRP2.1/A9P3.7/WP20/A8PSENEARSTALEVCCXTAL1GMDXTAL2392333743611535163473333：I102?31127123513251424152316221721293L934052011BSTC39C52STC89C52引腳圖2.3 光電傳感檢測模塊循跡方案設計：方案一：采用攝像頭循跡法：利用攝像頭對賽道提取信息，分有數(shù)

8、字式和模擬式。方案二：紅外對管循跡法：利用黑白色對紅外線的吸收作用不同，其由發(fā)射管和接收管配對組成，發(fā)射管發(fā)射出紅外線，當發(fā)射到黑色軌道時，被黑色軌道所吸收，當發(fā)射到白色跑道外時，會發(fā)射回來，接收管接收到光線信號，產生一電壓信號給單片機，從而實現(xiàn)對軌跡信息的讀取。方案三：激光管循跡法：其循跡原理與紅外對管相同，不同的是其測距比較遠。綜上所述，又考慮到成本的原因，本次設計采用紅外對管循跡法。采用脈沖調制的反射式紅外發(fā)射接收器。由于采用帶有交流分量的調制信號，則可大幅度減少外界的干擾；此外紅外發(fā)射接收管的工作電流取決于平均電流，如果采用占空比小的調制信號，在平均電流不變的情況下，瞬時電流很大（50

9、100mA）（ST-188允許的最大輸入電流為50mA,則大大提高了信噪比。避障方案設計：方案一：紅外線避障。方案二：超聲波避障。本次設計本打算利用兩種方案混合使用，但是由于后期制作過程中，超聲波模塊損壞，只能使用紅外線避障。其也是由發(fā)射管和接收管組成，工作原理與循跡的相同，發(fā)射管發(fā)出紅外線，當遇到障礙物時就會反射回來，接收管接收到反射的信號就會產生一電壓信號給單片機，從而實現(xiàn)對障礙物的檢測?！蓖怍⑺╇娮鐻ED狀態(tài)指示燈原裝紅外發(fā)射汽44mm16mmM3螺絲孔紅外線傳感器模塊實物圖2.4 電源模塊電源模塊，用9V的鋅電源給前、后輪電機供電，然后使用7805穩(wěn)壓管來把高電壓穩(wěn)成5V分別給單片機

10、和電機驅動芯片供電。7805電源模塊2.5 電機及電機驅動模塊電機方案的選擇：方案一：采用直流電機，優(yōu)點在于硬件電路設計簡單。當外加額定直流電壓時，轉速幾乎相等，調速性能較好，且性價比高。對于小車的行駛，能夠很好的控制。方案二：采用步進電機，步進電機可以實現(xiàn)精確的轉角輸出，只要施加合適的脈沖序列，電機可以按照人們的預定的速度或方向進行連續(xù)的轉動，便于控速，但是軟件程序的編寫較直流電機稍顯復雜。表2.1電機性能對比表對比項直流電機步進電機調速性能較好較差位置控制精度較差好控制難易程度簡單較難價格低中綜合考慮，本智能車決定采用直流電機作為只能車的動力電機?？蛇x用減速比為1:電機采用直流減速電機，直

11、流減速電機轉動力矩大，體積小，重量輕，裝配簡單，使用方便。由于其內部由高速電動機提供原始動力，帶動變速（減速）齒輪組，可以產生較大扭力。74的直流電機，減速后電機的轉速為100r/min。若車輪直徑為6cm,則小車的最大速度可以達到0.314m/s能夠較好的滿足系統(tǒng)的要求。下圖為電機的實物圖直流減速電機電機驅動方案的選擇：方案一：采用繼電器對電動機的開或關進行控制，通過開關的切換對小車的速度進行調整.此方案的優(yōu)點是電路較為簡單，缺點是繼電器的響應時間慢，易損壞，壽命較短，可靠性不高。萬案一：采用電阻網絡或數(shù)字電位器調節(jié)電動機的分壓，從而達到分壓的目的。但電阻網絡只能實現(xiàn)有級調速，而數(shù)字電阻的元

12、器件價格比較昂貴。更主要的問題在于一般的電動機電阻很小，但電流很大，分壓不僅回降低效率，而且實現(xiàn)很困難。方案二:采用功率三極管作為功率放大器的輸出控制直流電機。線性型驅動的電路結構和原理簡單，加速能力強，采用由達林頓管組成的H型橋式電路（如圖2.1）。用單片機控制達林頓管使之工作在占空比可調的開關狀態(tài)下，精確調整電動機轉速。這種電路由于工作在管子的飽和截止模式下，效率非常高，H型橋式電路保證了簡單的實現(xiàn)轉速和方向的控制，電子管的開關速度很快，穩(wěn)定性也極強，是一種廣泛采用的PWM調速技術。現(xiàn)市面上有很多此種芯片，我選用了L293專用驅動器。所用芯片L293屬于H橋集成電路，其輸出電流為1000m

13、A最高電流2A,最高工作電壓36V,可以驅動感性負載，特別是其輸入端可以與單片機直接相聯(lián)，從而很方便地受單片機控制。當驅動小型直流電機時，可以直接控制兩路電機，并可以實現(xiàn)電機正轉與反轉，實現(xiàn)此功能只需改變輸入端的邏輯電平。本模塊具有體積小，控制方便的特點。采用此模塊定會使您的電機控制自如，應對小車題目輕松自如。L293D電機驅動模塊電機調速系統(tǒng)的設計：方案一：串電阻調速系統(tǒng)。方案二：靜止可控整流器。簡稱V-M系統(tǒng)。方案三：脈寬調速系統(tǒng)。旋轉變流系統(tǒng)由交流發(fā)電機拖動直流電動機實現(xiàn)變流，由發(fā)電機給需要調速的直流電動機供電，調節(jié)發(fā)電機的勵磁電流即可改變其輸出電壓，從而調節(jié)電動機的轉速。改變勵磁電流的

14、方向則輸出電壓的極性和電動機的轉向都隨著改變，所以G-M系統(tǒng)的可逆運行是很容易實現(xiàn)的。該系統(tǒng)需要旋轉變流機組，至少包含兩臺與調速電動機容量相當?shù)男D電機，還要一臺勵磁發(fā)電機，設備多、體積大、費用高、效率低、維護不方便等缺點。且技術落后，因此擱置不用。V-M系統(tǒng)是當今直流調速系統(tǒng)的主要形式。它可以是單相、三相或更多相數(shù)，半波、全波、半控、全控等類型，可實現(xiàn)平滑調速。V-M系統(tǒng)的缺點是晶閘管的單向導電性，它不允許電流反向，給系統(tǒng)的可逆運行造成困難。它的另一個缺點是運行條件要求高，維護運行麻煩。最后，當系統(tǒng)處于低速運行時，系統(tǒng)的功率因數(shù)很低，并產生較大的諧波電流危害附近的用電設備。PWM調速系統(tǒng)：其

15、實現(xiàn)方式有兩種，一是采用晶閘管的直流斬波器基本原理，將晶閘管處在開關狀態(tài)，當晶閘管被觸發(fā)導通時，電源電壓加到電機上，當晶閘管關斷時，直流電源與電機斷開，電動機經二極管續(xù)流，兩端電壓接近于零，脈沖周期不變，只改變晶閘管的導通時間，即通過改變脈沖寬度來進行直流調速；二是利用軟件方式實現(xiàn)，采用兩個定時器，其中一個用來控制脈沖頻率，另一個控制占空比，這種實現(xiàn)方式快捷且有效。與V-M系統(tǒng)相比，PW蜩速系統(tǒng)有下列優(yōu)點：（1）由于PW硼速系統(tǒng)的開關頻率較高，僅靠電樞電感的濾波作用就可以獲得脈動很小的直流電流，電樞電流容易連續(xù)，系統(tǒng)的低速運行平穩(wěn)，調速范圍較寬，可達1:10000左右。由于電流波形比V-M系統(tǒng)

16、好，在相同的平均電流下，電動機的損耗和發(fā)熱都比較小。（2）同樣由于開關頻率高，若與快速響應的電機相配合，系統(tǒng)可以獲得很寬的頻帶，因此快速響應性能好，動態(tài)抗擾能力強。（3）由于電力電子器件只工作在開關狀態(tài)，主電路損耗較小，裝置效率較高。根據以上綜合比較，以及本設計中受控電機的容量和直流電機調速的發(fā)展方向，本設計采用了采用了程序的方法實現(xiàn)PWM（沖寬度調試。3硬件系統(tǒng)的設計3.1 總體設計智能小車采用前輪驅動，前輪左右兩邊各用一個電機驅動，調制前面兩個輪子的轉速起停從而達到控制轉向的目的，后輪是萬象輪，起支撐的作用。將循跡光電對管分別裝在車體下的左右。當車身下左邊的傳感器檢測到黑線時，主控芯片控制

17、左輪電機停止，車向左修正，當車身下右邊傳感器檢測到黑線時，主控芯片控制右輪電機停止，車向右修正。避障的原理和循線一樣，在車身右邊裝一個光電對管，當其檢測到障礙物時，主控芯片給出信號報警并控制車子倒退，轉向，從而避開障礙物。表3.1元件清單元件數(shù)量元件數(shù)量元件數(shù)量直流電機2只電阻八集成電路芯片單片機1塊二極管八電容紅外對管3只蜂鳴器1只電位器12M晶振P1只杜邦線玩具小車1個排針3.2 光電傳感檢測模塊采用四路紅外對管傳感器，其中兩路置于小車中間，用于循跡檢測，另外兩路用于避障信號檢測，置于小車兩側。其工作原理如下：小車循跡原理是小車在畫有黑線的白紙“路面”上行駛，由于黑線和白紙對光線的反射系數(shù)

18、不同，可根據接收到的反射光的強弱來判斷“道路”一黑線。筆者在該模塊中利用了簡單、應用也比較普遍的檢測方法一一紅外探測法。紅外探測法，即利用紅外線在不同顏色的物理表面具有不同的反射性質的特點。在小車行駛過程中不斷地向地面發(fā)射紅外光，當紅外光遇到白色地面時發(fā)生漫發(fā)射，反射光被裝在小車上的接收管接收；如果遇到黑線則紅外光被吸收，則小車上的接收管接收不到信號，再通過LM324作比較器來采集高低電平，從而實現(xiàn)信號的檢測。避障亦是此原理。電路圖如圖，我們將其接于單片機P3 口。4路傳感器模塊r.Ln二 EL 目我3.3 電源模塊電路設計采用7805穩(wěn)壓模塊為系統(tǒng)提供5V的穩(wěn)定電壓，并設計有電源指示二極管，

19、用以提示電源是否供電正常。電源指示vcc|(iihGND電裨開關 KlU7VCCVLCVCCvcc7- 4 6 8Hck-r 4X2 wGNDJt ICjND1470uF220uFGNU Tad tiSDHJ17GND電源供電系統(tǒng)3.4 電機驅動模塊設計電機驅動模塊采用專用驅動器L293D,所用芯片L293屬于H橋集成電路，其輸出電流為1000mA最高電流2A,最高工作電壓36V,可以驅動感性負載，特別是其輸入端可以與單片機直接相聯(lián)，從而很方便地受單片機控制。其工作電路如下圖所示，其中EN1、EN2為左右電機使能端，IN1、IN2、IN3、IN4為電機正反轉引腳端，它們分別與P1口各引腳相連。

20、Oil3GND«|kOT21t_IN27JV1-QMIN1IN4OLTTIOUT4GNDGNPGNDGNDDLT2OUT31N2IN3VCC2EN2U1L293DVCCiT卞14OT411*|bGNDOT310LN23.5主控電路電機驅動模塊主控電路復位電路的設計，采用上拉電復位，設計有按鈕，按下即可實現(xiàn)復位。ccGND51單片機紅M復位電路時鐘電路的設計，采用DS1302時鐘模塊，接于單片機P2.0 和 P2.1 口。rCC2P2,17CLKVCC1OSC1P2.06I/ORSTOSC2VSS8；T 32.76KKBl I1302.4 一DS1302時鐘模塊GND蜂鳴器電路，接于單

21、片機P2.3口VCCT一FM接到P2.3IOP1,對應該PCB網絡編號FM報警器模塊4軟件系統(tǒng)的設計4.1主程序的設計初始化SP、標志位、內部RAMA蜂鳴器嘀的一聲啟動定時器T0定時器初始化初始化電機顯示初始化i=0i+顯示子程序否判斷左側是、否有障贈,停車、報警、降速、后退判斷右側是否有礙物是W停車、報警降速、后退/是否有軌j循跡子程序停車主程序流程圖如主程序流程框圖所示，主程序主包括了系統(tǒng)的初始化，小車的啟動，和循跡避障動作實現(xiàn)程序。這里需要說明一點：之所以將避障程序放在主程序內而將循跡作為一子程序這樣設計，一是為了方便實現(xiàn)小車在自動循跡的基礎上實現(xiàn)自動避障并能夠在避障后自動找回軌跡繼續(xù)循

22、跡移動；二是實現(xiàn)程序模塊化，以便以后再開發(fā)。具體算法思路是小車啟動后，首先判斷軌跡前方有無障礙物。無障礙物時直接執(zhí)行循跡移動。有障礙物時，判斷是那一側有障礙物，然后根據傳感器采集的障礙物信息作出指令，比如右側有障礙物時，先執(zhí)行停止、報警、降速、后退等指令，其次先左轉再直行左轉、直行直至繞開障礙物，然后右轉、直行再右轉、直行直至重新回到軌跡上，循跡移動。左側或者前方有障礙物時程序算法類似于前者，不同在于執(zhí)行的動作順序不同。在程序的最后又補充添加了一紅外遙控控制，以方便人為地控制隨時停車。詳細程序設計如下：#include<AT89X52.H>#defineucharunsignedc

23、har#defineuintunsignedintsbitIN1=P1A2;定義電機驅動控制引腳sbitIN2=P1A3;sbitIN3=P1A6;sbitIN4=P1A7；sbitEN1=P1A4;sbitEN2=P1A5;sbitBUZZ=P2A3;sbitDU=P2A6;sbitWE=P2A7；#defineleft_xP3_4#defineright_xP3_3#defineleft_bP3_6定義蜂鳴器接線定義顯示控制引腳傳感器引腳# defineright_bP3_5# defineleft_moto_pwmP1_4# defineright_moto_pwmunsignedint

24、pwmsd;unsignedintcount;unsignedinti;unsignedcharcodetable尸0x3f,0x06,0x5b,0x4f,0x66,0x6d,0x7d,0x07,0x7f,0x6f,0x77,0x7c,0x39,0x5e,0x79,0x71;voiddelay_nms(unsignedintn)延日nnms/PWM信號端P1_5定義pwm轉速變量0,123,4,5,6,7,8,9,A,B,C,D,E,Funsignedinti,j;for(i=0;i<n;i+)for(j=0;j<125;j+)voidmingdi(void)/蜂鳴器嘀的一聲響B(tài)U

25、ZZ=0;delay_nms(50);BUZZ=1;voiddisp(unsignedintj)voidqianjin(void)前進voidturnleft(void)左轉voidturnright(void)右轉voidhoutui(void)后退voidstop(void)停止voidtimer0_Int()interrupt1定時器中斷voidTimer1_Int()interrupt2voidxunji(void)voidmain(void)P0=0X00;關數(shù)碼管關電機P1=0XF0;B:for(i=0;i<50;i+)delay_nms(1);if(P3_7!=1)goto

26、B;判斷啟動開關是否按卜mingdi();啟動小車，鳴笛pwmsd=6;TMOD=0X11;設置初速度TH0=0Xfc;TL0=0X18;TR0=1;ET0=1;/1ms定時EA=1;開總中斷TH1=0xff;/0.5ms定時TL1=0xce;ET1=0;TR1=0;while(1)無限循環(huán)disp(pwmsd);調顯示if(left_b=1)判斷左面是否有障礙物if(right_b=1)判斷右面是否有障礙物xunji();兩面都沒有障礙物，繼續(xù)循跡移動elsestop();右面有障礙物，先停車delay_nms(1000);mingdi();再報警delay_nms(50);mingdi()

27、；houtui();其次后退delay_nms(500);pwmsd=3;降速do左轉、直行、左轉、直行一直到沒有障礙物;turnleft();delay_nms(100);qianjin();delay_nms(500);while(left_b&&right_b=1);do繞開障礙物后，右轉、直行、右轉、直行直到找到軌道；turnright();delay_nms(100);qianjin();delay_nms(500);while(lef_x=0|right_x=0);xunji();繼續(xù)循跡移動；else左側有障礙物；stop();先停車，delay_nms(1000

28、);mingdi();再報警；delay_nms(50);mingdi()；houtui();其次后退；delay_nms(500);pwmsd=3;降速，do右轉、直行一直到繞開障礙物，turnright();delay_nms(100);qianjin();delay_nms(500);while(left_b|right_b=1);do繞開障礙物后，左轉、直行一直到找到軌跡;turnleft();delay_nms(100);qianjin();delay_nms(500); while(left_x|right_x=0);xunji();繼續(xù)循跡移動;4.2循跡子程序的設計循跡子程序流

29、程圖:開始.)判斷傳感器狀態(tài)L:1; R: 00; R: 1J右轉直行循跡子程序流程圖根據前一節(jié)介紹的紅外對管循跡原理，設計了如上圖所示的循跡算法，首先判斷兩路循跡傳感器的狀態(tài)，根據傳感器狀態(tài)做出相應的指令，驅動電機轉動，以實現(xiàn)小車循跡移動?；驹O計如下：當左右循跡傳感器狀態(tài)為1、1時，即未偏出軌跡，直行移動；當傳感器狀態(tài)為兩側均偏出，但是為了保障主程序能夠自我找回軌跡，而不對其運行造成指令干擾，這里就將這一狀態(tài)給屏蔽，不將其視為控制狀態(tài)信息。詳細程序設計如下：0、1時，左側偏出，微右轉；當傳感器狀態(tài)為1、0時，右側偏出，微左轉；當傳感器狀態(tài)為0、0時,voidxunji(void)if(le

30、ft_x=1&&right_x=1)qianjin();調用前進函數(shù)delay_nms(20);if(left_x=0&&right_x=1)左邊檢測到黑線turnright();調用小車右轉函數(shù)delay_nms(20);if(right_x=0&&left_x=1)右邊檢測到黑線turnleft();調用小車左轉函數(shù)delay_nms(20);4.3 電機驅動子程序的設計電機動作實現(xiàn)，前進：左電機往前轉，右電機往前轉；左轉：左電機往后轉，右電機往前轉；右轉：左電機往前轉，右電機往后轉；后退：左右電機都往后轉；停止：電機使能端為零。具體程序設計

31、如下：voidqianjin(void)前進IN1=1;IN2=0;IN3=1;IN4=0;voidturnleft(void)左轉IN1=0;IN2=1;IN3=1;IN4=0;voidturnright(void)右轉IN1=1;IN2=0;IN3=0;IN4=1;voidhoutui(void)后退IN1=0;IN2=1;IN3=0;IN4=1;voidstop(void)/停止EN1=0;EN2=0;-# -4.4 中斷子程序的設計用于控制占空比。具體思路是設有兩個定時器中斷T0、T1,用來實現(xiàn)電機的PWM調速，其中定時器T0用于控制頻率，定時器T1中斷讓這個IO 口輸出低電平，這樣改

32、變定時器T0中斷讓一個IO口輸出高電平，并在這個T0中斷中啟動定時器T1,T1T0的初值就可以改變頻率，改變定時器T1的初值就可以改變占空比。詳見如下流程圖:清零countT0中斷流程圖T1中斷流程圖-29 -根據上述流程圖設計程序如下voidtimer0_Int()interrupt1TH0=0xfc ;TL0=0x18;count=0 ;ET1=1;TR1= 1;left_moto_pwm=1;/定時1ms清零脈沖計數(shù)啟動定時器T1電機使能端置1right_moto_pwm=1;voidTimer1_Int()interrupt2TH1=0xff;定時0.05msTL1=0xce;coun

33、t+;if(count>=pwmsd)與設定轉速(占空比)比較left_moto_pwm=0;電機使能端清0right_moto_pwm=0;4.5顯示子程序的設計這里只使用一個數(shù)碼管，用以顯示轉速，子程序設計如下：unsignedcharcodetable尸0x3f,0x06,0x5b,0x4f,0x66,0x6d,0x7d,0x07,0x7f,0x6f,0x77,0x7c,0x39,0x5e,0x79,0x71;/0,1,2,3,4,5,6,7,8,9,A,B,C,D,E,Fvoiddisp(unsignedintj)DU=1;:P0=tablej;DU=0;WE=1;P0=0xff

34、;WE=0;5制作安裝與調試5.1小車的制作與安裝采用DXP2004繪制原理圖與PCB板，布線的過程中必須注意焊盤的大小與銅線的寬度。我選取的焊盤內徑為0.8mm,外徑2mm;銅線寬1mm。從做板的情況來看基本達到制作得要求。采用螺絲將循跡板安裝在車頭，主板與電機驅動安裝在車尾。5.2小車調試通過改變循跡板滑動變阻器器的大小來調試紅外對管的靈敏度，通過改變延時程序來改變速度的大小。下表為小車運行的情況：表5.1小車調試情況小車運行次數(shù)成功循跡次數(shù)成功避障次數(shù)1112213324425546總結整個系統(tǒng)的設計以單片機為核心，利用了多種傳感器，將軟件和硬件相結合。本系統(tǒng)能實現(xiàn)如下功臺匕目匕：(1)自動沿預設軌道行駛小車在行駛過程中，能夠自動檢測預先設好的軌道，實現(xiàn)直道和弧形軌