智能尋跡小車及程序

1、+尋跡小車在歷屆全國大學(xué)生電子設(shè)計競賽中多次出現(xiàn)了集光、機(jī)、電于一體的簡易智能小車題目。筆者通過論證、比較、實驗之后，制作出了簡易小車的尋跡電路系統(tǒng)。整個系統(tǒng)基于普通玩具小車的機(jī)械結(jié)構(gòu)，并利用了小車的底盤、 前后輪電機(jī)及其自動復(fù)原裝置，能夠平穩(wěn)跟蹤路面 黑色軌跡運行?？傮w方案整個電路系統(tǒng)分為檢測、 控制、驅(qū)動三個模塊。首先利用光電對管對路面信號進(jìn)行檢測，經(jīng)過比較器處理之后， 送給軟件控制模塊進(jìn)行實時控制，輸出相應(yīng)的信號給驅(qū)動芯片驅(qū)動電1所示。機(jī)轉(zhuǎn)動，從而控制整個小車的運動。系統(tǒng)方案方框圖如圖檢測（黑線）軟件控制一驅(qū)動電機(jī)控制小車圖1智能小車尋跡系統(tǒng)框圖傳感檢測單元小車循跡原理該智能小車在畫有黑

2、線的白紙“路面”上行駛，由于黑線和白紙對光線的反射系數(shù)不 同，可根據(jù)接收到的反射光的強(qiáng)弱來判斷“道路”一黑線。筆者在該模塊中利用了簡單、應(yīng) 用也比較普遍的檢測方法一一紅外探測法。在小車紅外探測法，即利用紅外線在不同顏色的物理表面具有不同的反射性質(zhì)的特點。行駛過程中不斷地向地面發(fā)射紅外光，當(dāng)紅外光遇到白色地面時發(fā)生漫發(fā)射，反射光被裝在 小車上的接收管接收；如果遇到黑線則紅外光被吸收，則小車上的接收管接收不到信號。傳感器的選擇市場上用于紅外探測法的器件較多，可以利用反射式傳感器外接簡單電路自制探頭,可以使用結(jié)構(gòu)簡單、工作性能可靠的集成式紅外探頭。ST系列集成紅外探頭價格便宜、體2所示:積小、使用方

3、便、性能可靠、用途廣泛，所以該系統(tǒng)中最終選擇了ST168反射傳感器作為紅 外光的發(fā)射和接收器件，其內(nèi)部結(jié)構(gòu)和外接電路均較為簡單，如圖+2XX圖2 ST168檢測電路ST168采用高發(fā)射功率紅外光、電二極管和高靈敏光電晶體管組成，采用非接觸式檢測方式。ST168的檢測距離很小，一般為 815毫米，因為8毫米以下是它的檢測盲區(qū)，而大于15毫米則很容易受干擾。筆者經(jīng)過多次測試、比較，發(fā)現(xiàn)把傳感器安裝在距離檢測物表面10毫米時，檢測效果最好。R1限制發(fā)射二極管的電流，發(fā)射管的電流和發(fā)射功率成正比，但受其極限輸入正向電流50mA的影響，用R1=150的電阻作為限流電阻，Vcc=5V作為電源電壓，測試發(fā)現(xiàn)

4、發(fā)射功率完全能滿足檢測需要；可變電阻R2可限制接收電路的電流，一方面保護(hù)接收紅外管；另方面可調(diào)節(jié)檢測電路的靈敏度。因為傳感器輸出端得到的是模擬電壓信號，所以在輸出端增加了比較器，先將 ST168輸出電壓與2.5V進(jìn)行比較，再送給單片機(jī)處理和控制。傳感器的安裝正確選擇檢測方法和傳感器件是決定循跡效果的重要因素,而且正確的器件安裝方法也是循跡電路好壞的一個重要因素。從簡單、方便、可靠等角度出發(fā),同時在底盤裝設(shè) 4個紅外探測頭，進(jìn)行兩級方向糾正控制， 將大大提高其循跡的可靠性,具體位置分布如圖 3所示。左X左X右Y+圖3紅外探頭的分布圖圖中循跡傳感器全部在一條直線上。其中X1與丫1為第一級方向控制傳

5、感器，X2與丫2 為第二級方向控制傳感器，并且黑線同一邊的兩個傳感器之間的寬度不得大于黑線的寬度。小車前進(jìn)時，始終保持（如圖3中所示的行走軌跡黑線）在X1和丫1這兩個第一級傳感器之間， 當(dāng)小車偏離黑線時，第一級傳感器就能檢測到黑線，把檢測的信號送給小車的處理、控制系統(tǒng)，控制系統(tǒng)發(fā)出信號對小車軌跡予以糾正。第二級方向探測器實際是第一級的后備保護(hù),它的存在是考慮到小車由于慣性過大會依舊偏離軌道,再次對小車的運動進(jìn)行糾正，從而提高了小車循跡的可靠性。軟件控制單元單片機(jī)選型及程序流程此部分是整個小車運行的核心部件，起著控制小車所有運行狀態(tài)的作用?？刂品椒ㄓ泻芏?，大部分都采用單片機(jī)控制。由于51單片機(jī)具

6、有價格低廉是使用簡單的特點，這里選擇4所示。了 ATMEL公司的AT89S51作為控制核心部件，其程序控制方框圖如圖I/O 口，一旦檢測到某小車進(jìn)入循跡模式后，即開始不停地掃描與探測器連接的單片機(jī) 個I/O 口有信號變化，程序就進(jìn)入判斷程序， 把相應(yīng)的信號發(fā)送給電動機(jī)從而糾正小車的狀 態(tài)。車速的控制車速調(diào)節(jié)的方法有兩種： 一是用步進(jìn)電機(jī)代替小車上原有的直流電機(jī);二是在原有直流電機(jī)的基礎(chǔ)上，采用pwm調(diào)速法進(jìn)行調(diào)速。 考慮到機(jī)械裝置不便于修改等因素，這里選擇后者，利用單片機(jī)輸出端輸出高電平的脈寬及其占空比的大小來控制電機(jī)的轉(zhuǎn)速,從而控制小車的速度。經(jīng)過多次試驗，最終確定合適的脈寬和占空比，基本能

7、保證小車在所需要的速度范圍內(nèi)平穩(wěn)前行。電機(jī)驅(qū)動單元從單片機(jī)輸出的信號功率很弱，即使在沒有其它外在負(fù)載時也無法帶動電機(jī),所以在實際電路中我們加入了電機(jī)驅(qū)動芯片提高輸入電機(jī)信號的功率,從而能夠根據(jù)需要控制電機(jī)轉(zhuǎn)動。根據(jù)驅(qū)動功率大小以及連接電路的簡化要求選擇L298N,其外形、管腳分 布如圖5所示。Ol/TPu- 1flT'JT 5Ltacj： swOL'y隹 tis2= 1 £時虹土VT 1"叫心心OTFUT ；HE屮1從圖中可以知道，一塊L298N芯片能夠驅(qū)動兩個電機(jī)轉(zhuǎn)動，它的使能端可以外接高低電平,也可以利用單片機(jī)進(jìn)行軟件控制，極大地滿足各種復(fù)雜電路需要。另

8、外,L298N的驅(qū)動功率較大，能夠根據(jù)輸入電壓的大小輸出不同的電壓和功率，解決了負(fù)載能力不夠這個問題。結(jié)語此方案選擇的器件比較簡單，實際中也很容易實現(xiàn)。經(jīng)過多次測試，結(jié)果表明在一定的不足之處，由于小車采用直流弧度范圍內(nèi)，小車能夠沿著黑線軌跡行進(jìn)，達(dá)到了預(yù)期目標(biāo)。電機(jī)，其速度控制不夠精確和穩(wěn)定，不能實現(xiàn)急轉(zhuǎn)和大弧度的拐彎。+程序#in cludevreg51.h>左右占空比標(biāo)志#defi ne uchar un sig ned char #defi ne uint un sig ned int uchar pro_left,pro _right,i,j; / sbit left1= PO;

9、sbit left2=P2A1;sbit right仁卩2八2;sbit right2=卩2八3;sbit en仁P MO;三個紅外傳感器 白線位置黑線位置白線位置sbit en2=P 1八1;/循跡口sbit left_red=卩1八2; /sbit mid_red=卩1八3; /sbit right_red=PIM; / void delay( uint z)uchar i;while(z-)for(i=0;iv121;i+); void ini t()left_red=O; /白線位置mid_red=1; / 黑線位置 right_red=O;TMOD=0X01;THO=(65536-1

10、OO)/256;TLO=(65536-1OO)%256;EA=1;ETO=1;TRO=1;en1=1;en 2=1;void timeO(void)i nterru pt 1 i+； j+；+if(i<=pro _right) en 1=1; else en 1=0;if(i=40) en 1=e n1;i=0; if(j<=pro_left) en 2=1; else en 2=0;if(j=40) en 2=e n2;j=0;TH0=(65536-100)/256;TL0=(65536-100)%256; void straight() / p ro_right=39; pro

11、_left=39; left1=0;left2=1;right1=1;right2=0;走直線函數(shù)void turn_left() / " p ro_nght=5; pro_left=39;Ieft1=0;left2=1;right1=1; right2=0;左轉(zhuǎn)彎函數(shù)void turn _right() / "p ro_right=39;p ro_left=5;left1=0;left2=1;right1=1;right2=0;右轉(zhuǎn)彎函數(shù)void turn _back() / "后退（反轉(zhuǎn)）函數(shù)+Ieft1=1; left2=0; right1=0; right2=1;p ro_right=39; pro_left=39;void in frared() /循跡uchar flag;if(left_red=1)flag=1;elseif(right_red=1)flag=2;elseif(left_red=0)&( mid_red=0)&(right_red=0)flag=3;else flag=0;switch (flag)case 0: straight。； break;case 1: tur