智能尋跡小車以及程序

歐陽(yáng)家百創(chuàng)編尋跡小車歐陽(yáng)家百(2021.03.07)在歷屆全國(guó)大學(xué)生電子設(shè)計(jì)競(jìng)賽中多次出現(xiàn)了集光.機(jī)、電于一體的簡(jiǎn)易智能小車題目。筆者通過(guò)論證、比較、實(shí)驗(yàn)之后，制作出了簡(jiǎn)易小車的誣電路系統(tǒng)。整個(gè)系統(tǒng)基于普通玩具小車的機(jī)械結(jié)構(gòu)，并利用了小車的底盤、前后輪電機(jī)及其自動(dòng)復(fù)原裝置，能夠平穩(wěn)跟蹤路廁黑色軌跡運(yùn)行?？傮w方案整個(gè)電路系統(tǒng)分為檢測(cè)、控制、驅(qū)動(dòng)三個(gè)模塊。首先利用光電對(duì)管對(duì)路面信號(hào)講行檢測(cè).經(jīng)過(guò)比較器處理之后，送給軟件控制模塊進(jìn)行實(shí)時(shí)控制，輸出相應(yīng)的信號(hào)給驅(qū)動(dòng)芯片驅(qū)動(dòng)電機(jī)轉(zhuǎn)動(dòng)，從而控制整個(gè)小車的運(yùn)動(dòng)。系統(tǒng)方案方框圖如圖1所示。圖1智能小車尋跡系統(tǒng)框圖傳感檢測(cè)單元小車循跡原理該智能小車在畫有黑線的白紙“路⑥”上行駛，由于黑線和白紙對(duì)光線的反射系數(shù)不同，可根據(jù)接收到的反射光的強(qiáng)弱來(lái)判斷“道路”一黑線。筆者在該模塊中利用了簡(jiǎn)單、應(yīng)用也比較普遍的檢測(cè)方法一一紅外探測(cè)法。歐陽(yáng)家百創(chuàng)編紅外探測(cè)法，即利用紅外線在不同顏色的物理表面具有不同的反射性質(zhì)的特點(diǎn)。在小車行駛過(guò)程中不斷地向地廂發(fā)射紅外光，當(dāng)紅外光遇到白色地面時(shí)發(fā)生漫發(fā)射，反射光被裝在小車上的接收管接收；如果遇到黑線則紅外光被吸收，則小車上的接收管接收不到信號(hào)。傳感器的選擇市場(chǎng)上用于紅外探測(cè)法的器件較多，可以利用反射式傳感器外接簡(jiǎn)單電路自制探頭，也可以使用結(jié)構(gòu)簡(jiǎn)單、工作性能可靠的集成式紅外探頭。ST系列集成紅外探頭價(jià)格便宜、體積小、使用方便、性能可靠.用途廣泛，所以該系統(tǒng)中最終選擇了ST168反射傳感器作為紅外光的發(fā)射和接收器件，其內(nèi)部結(jié)構(gòu)和外接電路均較為簡(jiǎn)單，如圖2所示：圖2ST168檢測(cè)電路ST168采用高發(fā)射功率紅外光、電二極管和高靈敏光電晶體管組成，采用非接觸式檢測(cè)方式。ST168的檢測(cè)距離很小，一般為8?15毫米，因?yàn)?毫米以下是它的檢測(cè)盲區(qū)，而大于15毫米則很容易受干擾。筆者經(jīng)過(guò)多次測(cè)試.比較，發(fā)現(xiàn)把傳感器安裝在距離檢測(cè)物表廂10毫米時(shí)，檢測(cè)效果最好。R1限制發(fā)射二極管的電流，發(fā)射管的電流和發(fā)射功率成正比，但受其極限輸入正向電流50mA的影響，用RU150的電阻作為限流電阻Vcc=5V作為電源電氐測(cè)試發(fā)現(xiàn)發(fā)射功率完全能滿足歐陽(yáng)家百創(chuàng)編檢測(cè)需要；◎變電阻R2可限制接收電路的電流，一方直保護(hù)接收紅外管；號(hào)一方廁可調(diào)節(jié)檢測(cè)電路的靈敏度。因?yàn)閭鞲衅鬏敵龆说玫降氖悄M電壓信號(hào)，所以在輸出端增加了比較器，先將ST168輸出電壓與2.5V逬行比較，再送給單片機(jī)處理和控制。傳感器的安裝正確選擇檢測(cè)方法和傳感器件是決定循跡效果的重要因素，而且正確的器件安裝方法也是循跡電路好壞的一個(gè)重要因素。從簡(jiǎn)單、方便.可靠等角度出發(fā)，同時(shí)在底盤裝設(shè)4個(gè)紅外探測(cè)頭，進(jìn)行兩級(jí)方向糾正控制，將大大提高其循跡的可靠性，具體位置分布如圖3所示。圖3紅外探頭的分布圖圖中循跡傳感器全部在一條直線上。其中XI與Y1為第一級(jí)方向控制傳感器，X2與Y2為第二級(jí)方向控制傳感器，并且黑線同一邊的兩個(gè)傳感器之間的寬度不得大于黑線的寬度。小車前進(jìn)時(shí)，始終保持（如圖3中所示的行走軌跡黑線）在XI和Y1這兩個(gè)第一級(jí)傳感器之間，當(dāng)小車偏離黑線時(shí)，第一級(jí)傳感器就能檢測(cè)到黑線，把檢測(cè)的信號(hào)送給小車的處理、控制系統(tǒng)，控制系統(tǒng)發(fā)出信號(hào)對(duì)小車軌跡予以糾正。第二級(jí)方向探測(cè)器實(shí)際是第一級(jí)的后備保護(hù)，它的存在是考慮到小車由于慣性過(guò)大會(huì)依舊偏離軌道，再次對(duì)小車的運(yùn)動(dòng)進(jìn)行糾正，從而提高了小車循跡的可靠性。歐陽(yáng)家百創(chuàng)編軟件控制單元單片機(jī)選型及程序流程此部分杲整個(gè)小車運(yùn)行的核心部件，起著控制小車所有運(yùn)行狀態(tài)的作用。控制方法有很多，大部分都采用單片機(jī)控制。由于51單片機(jī)具有價(jià)格低廉杲使用簡(jiǎn)單的特點(diǎn)，這里選擇了ATMEL公司的AT89S51作為控制核心部件，其程序控制方框圖如圖4所Z]\o圖4系統(tǒng)的程序流程圖小車進(jìn)入循跡模式后，即開始不停地掃描與探測(cè)器連接的單片機(jī)I/O口，一旦檢測(cè)到某個(gè)I/O□有信號(hào)變化，程序就進(jìn)入判斷程序，把相應(yīng)的信號(hào)發(fā)送給電動(dòng)機(jī)從而糾正小車的狀態(tài)。車速的控制車速調(diào)節(jié)的方法有兩種：一杲用步進(jìn)電機(jī)代替小車上原有的直流電機(jī)；二是在原有直流電機(jī)的基礎(chǔ)上，采用史辿調(diào)速法進(jìn)行調(diào)速?？紤]到機(jī)械裝置不便于修改等因素，這里選擇后者，利用單片機(jī)輸出端輸出高電平的脈寬及其占空比的大小來(lái)控制電機(jī)的轉(zhuǎn)速，從而控制小車的速度。經(jīng)過(guò)多次試驗(yàn)，最終確定合適的脈寬和占空比，基本能保證小車在所需要的速度范圍內(nèi)平穩(wěn)前行。電機(jī)驅(qū)動(dòng)單元?dú)W陽(yáng)家百創(chuàng)編從單片機(jī)輸出的信號(hào)功率很弱，即使在沒有其它外在負(fù)載時(shí)也無(wú)法帶動(dòng)電機(jī)，所以在實(shí)際電路中我們加入了電機(jī)驅(qū)動(dòng)芯片提高輸入電機(jī)信號(hào)的功率，從而能夠根據(jù)需要控制電機(jī)轉(zhuǎn)動(dòng)。根據(jù)驅(qū)動(dòng)功率大小以及連接電路的簡(jiǎn)化要求選擇L298N,其外形、管腳分布如圖5所示。圖5L298N管腳分布圖從圖中可以知道，一塊L298N芯片能夠驅(qū)動(dòng)兩個(gè)電機(jī)轉(zhuǎn)動(dòng)，它的使能端可以外接高低電平，也可以利用單片機(jī)逬行軟件控制，極大地滿足各種復(fù)雜電路需要。號(hào)外，L298N的驅(qū)動(dòng)功率較大，能夠根據(jù)輸入電壓的大小輸出不同的電壓和功率，解決了負(fù)載能力不夠這個(gè)冋題。結(jié)語(yǔ)此方案選擇的器件比較簡(jiǎn)單，實(shí)際中也很容易實(shí)現(xiàn)。經(jīng)過(guò)多次測(cè)試，結(jié)果表明在一定的弧度范圍內(nèi)，小車能夠沿著黑線軌跡行進(jìn)，達(dá)到了預(yù)期目標(biāo)。不足之處，由于小車采用直流電機(jī)，其速度控制不夠精確和穩(wěn)定，不能實(shí)現(xiàn)急轉(zhuǎn)和大弧度的拐彎。程序#include<reg51.h>#defineucharunsignedchar#defineuintunsignedintucharpro_left,pro_right,ij;〃左右占空比標(biāo)志 sbitleftl=P2A0;sbitleft2=P2Al;sbitrightl=P2A2;sbitright2=P2A3;sbitenl=PlA0;sbiten2=PlAl; 〃循跡口三個(gè)紅外傳感器sbit歐陽(yáng)家百創(chuàng)編歐陽(yáng)家百創(chuàng)編left_red=PlA2;〃白線位置sbitmid_red=PlA3;〃黑線位置sbitright_red=PlA4;〃白線位置voiddelay(uintz){uchari;while(z—){for(i=0;i<121;i++);}}voidinit(){left_red=O;〃白線位置mid_red=l;〃黑線位置right_red=0;TMOD=0X01;TH0=(65536-l00)/256;TL0=(65536-100)%256;EA=1;ET0=1;TR0=l;enl=l;en2=1;}voidtimeO(void)interrupt1{i++;j++;if(i<=pro_right){enl=l;} elseen1=0;if(i==40){enl=~en1;i=0;}if(j<=pro_left){en2=1;} elseen2=0;if(j==40){en2=~en2;j=0;}TH0=(65536-100)/256;TL0=(65536-100)%256;}voidstraight()〃走直線函數(shù){pro_right=39;pro_left=39;left1=0;left2=1;right1=1;right2=0;}voidturn_left()〃左轉(zhuǎn)彎函數(shù){pro」ight=5;pro_left=39;left1=O;left2=1;rightl=1;right2=0;}voidturn_right()〃右轉(zhuǎn)彎函數(shù){pro_right=39;pro_left=5;left1=0;left2=1;right1=1;right2=0;}歐陽(yáng)家百創(chuàng)編voidUim_bQck()//后退(反轉(zhuǎn))函數(shù){left1=1;left2=0;rightl=0;right2=1;pro_right=39;pro_left=39;}void infrared() 〃循跡{ ucharflag;if(left_red==1){flag=l;}elseif(right_red==1){flag=2;}elseif((left_red==O)&(mid_red==0)&(right_red==O)) {flag=3;)elseflag=O;switch(flag){case0:straight();break;case1:turn