循跡小車的追蹤與避障
加入技術(shù)交流群
5 系統(tǒng)軟件實現(xiàn)
5．1 傳感器檢測情況與驅(qū)動電路分段控制
首先，紅外光電開關(guān)檢測前方是否有移動物體，若兩光電開關(guān)都未檢測到物體，此時小車開始循跡。由于實際的循跡黑線的弧度不一樣，所以我們用七個灰度傳感器來反映實際循跡黑線的彎度情況，同時應(yīng)用單片機產(chǎn)生PWM占空比來配合不同的彎度，進而對電機驅(qū)動電路進行控制實現(xiàn)兩電機以不同的速度運行來實現(xiàn)適度轉(zhuǎn)彎。(1)當(dāng)a1和b2檢測到黑線時，此時說明黑線的彎度比較小，單片機輸出PWM占空比為80％，其輸出到電機驅(qū)動電路從而小車實現(xiàn)微小左轉(zhuǎn)彎。(2)當(dāng)a1和b1檢測到黑線時，說明彎度較大，單片機輸出PWM占空比為50％，此時小車實現(xiàn)較大轉(zhuǎn)彎。(3)當(dāng)僅b1檢測到時，說明此時小車彎度很大，這時單片機輸出PWM為300A，進而實現(xiàn)很大的轉(zhuǎn)彎；由于傳感器排布左右對稱，所以右邊情況類似。其次，當(dāng)紅外開關(guān)檢測到前方有移動物體時，此時程序進入追蹤模式，由于物體移動比較快，所以我們不再用PWM進行平緩轉(zhuǎn)彎，而是直接由電機正反轉(zhuǎn)來實現(xiàn)小車的快速轉(zhuǎn)彎。(4)當(dāng)僅左邊紅外檢測到物體時，單片機直接產(chǎn)生0、1信號來讓左電機反轉(zhuǎn)，右電機正轉(zhuǎn)，進而實現(xiàn)快速左轉(zhuǎn)。(5)當(dāng)僅右邊紅外檢測到物體時，單片機直接產(chǎn)生0、1信號來讓右電機反轉(zhuǎn)，左電機正轉(zhuǎn)，進而實現(xiàn)快速右轉(zhuǎn)。(6)當(dāng)左右同時檢測到時即停轉(zhuǎn)，使小車停下，程序流程圖如圖5所示。本文引用地址：http://cafeforensic.com/article/159610.htm
最后，若對程序進行相應(yīng)的更改即能實現(xiàn)避障，即當(dāng)紅外光電開關(guān)檢測到物體時，使小車轉(zhuǎn)相應(yīng)的角度即可實現(xiàn)避障。
6 結(jié)論
本文提出了一種基于單片機控制的智能循跡，追蹤，避障小車的設(shè)計制作方法，它以STC89C52為控制核心，直流減速電機為執(zhí)行元件，IR9909型反射式傳感器作為循跡元件，接近開關(guān)作為避障與追蹤元件。經(jīng)過實驗驗證，該小車能自動循跡，追蹤與避障，并能穩(wěn)定運行。該小車智能化小車的研究不僅具有很大的現(xiàn)實意義，還具有極為廣闊的應(yīng)用前景和市場價值。
評論