采用光電傳感器的智能車控制研究

在程序中建立兩個數(shù)組，一個存儲每次檢測到的信號，另一個存儲實施控制后的當(dāng)前信號作為歷史數(shù)據(jù)。加入這種帶歷史紀(jì)錄判斷的思想后，使得控制更為精確[4]。

除了以上判斷法則之外，還有兩種情況需要考慮。即只有一個傳感器檢測到黑線的情況以及交叉賽道的情況。對于只有一個傳感器檢測到黑線的情況，同樣需要檢查上一時刻的傳感器信號，例如，某一時刻只有s6檢測到黑線，若上一時刻s5檢測到黑線，則車模左轉(zhuǎn)，若上一時刻s7檢測到黑線，則車模右轉(zhuǎn)。

對于交叉賽道的情況，則利用一種“濾波”的思想將其“濾”除掉。遇到交叉賽道時，必然會出現(xiàn)同一排幾個傳感器同時檢測到黑線的情況，此時就給模型車一個命令使其直線前進(jìn)，將交叉賽道排除掉。

這就是本系統(tǒng)基于經(jīng)驗邏輯判斷的循線控制算法，在此基礎(chǔ)上通過不斷實驗調(diào)整各個參數(shù)可達(dá)到較好的控制效果。

實驗結(jié)果

硬件設(shè)計

電機(jī)驅(qū)動電路

電機(jī)驅(qū)動采用mc33886作為驅(qū)動芯片，其原理如圖6所示。通過向in1、in2口送出pwm波來控制電機(jī)的正轉(zhuǎn)和反轉(zhuǎn)，正轉(zhuǎn)為智能車加速，反轉(zhuǎn)減速。改變pwm波的占空比，可控制電機(jī)的轉(zhuǎn)動速率[5]。

速度檢測電路

本文采用增量式光電編碼器來測量車速，其輸出脈沖的頻率正比于轉(zhuǎn)速，可以通過測量單位周期內(nèi)脈沖個數(shù)或者脈沖周期得到脈沖的頻率，具有較高的精度。

電源變換電路

智能車系統(tǒng)配有7.2v的蓄電池，可直接為直流電機(jī)供電。單片機(jī)、光電傳感器和光電編碼器所需電壓為5v，伺服舵機(jī)為6v。這些電壓則由7.2v蓄電池調(diào)節(jié)得來。

單片機(jī)和光電編碼器通過穩(wěn)壓芯片7805穩(wěn)壓輸出5v電壓供電。光電傳感器數(shù)目多、功耗大，對電源穩(wěn)定性要求更高，故單獨采用效率較高的芯片lm2575對它供電。給舵機(jī)供電的芯片選用的是低壓差可調(diào)輸出三端線性穩(wěn)壓器lm1117，片上提供安全操作保護(hù)等功能。

軟件設(shè)計

軟件設(shè)計分模塊實現(xiàn)，其中主程序包括時鐘初始化、i/o口初始化、舵機(jī)電機(jī)初始化、采集信號和控制算法，程序流程見圖7。

實驗結(jié)果及其分析

程序開發(fā)過程中完全采用了組委會提供的s12核心開發(fā)板，它是由mc9s12dg128單片機(jī)構(gòu)成的最小系統(tǒng)。mc9s12dg128屬于hcs12系列單片機(jī)，是motorola推出的高性能16位微控制器。它能夠提供32-512kb的第三代快閃嵌入式存儲器，總線速度可達(dá)50mhz，外圍時鐘可達(dá)25mhz。還具備編碼效益、片上糾錯能力，并與mc68hc11和mc68hc12結(jié)構(gòu)編碼向上兼容。mc9s12dg128單片機(jī)具有112個引腳，其中與cpu相關(guān)的引腳都是兼容的。

s12開發(fā)板上有構(gòu)成最小系統(tǒng)的復(fù)位電路、晶體振蕩器及時鐘電路，串行接口的rs-232驅(qū)動電路，+5v電源插座。單片機(jī)中已經(jīng)寫入了開發(fā)的監(jiān)控程序。8個小燈用于調(diào)試應(yīng)用系統(tǒng)。單片機(jī)的所有i/o端口都通過兩個64芯的歐式插頭引出。

硬件調(diào)試時，分別對各模塊功能進(jìn)行測試，重點調(diào)節(jié)光電傳感器，它感知黑白線時輸出信號應(yīng)不同，感知白線時經(jīng)過比較器輸出為低電平，感知黑線時輸出為高電平。軟件調(diào)試時，可利用bdm開發(fā)工具，顯示單片機(jī)運行時其內(nèi)部存儲器中的數(shù)據(jù)。

通過硬件軟件的聯(lián)合調(diào)試和實驗，出現(xiàn)了一些問題，但通過對程序的完善和車模的重新裝配后效果大大改善。最終車?？稍谂艿郎涎€運行，但仍存在功耗較大，轉(zhuǎn)向延時等問題。

結(jié)語

本文基于自動控制原理，利用探路模塊的道路偏差信號使智能車實現(xiàn)尋跡跟蹤，利用pwm技術(shù)控制電機(jī)的轉(zhuǎn)速和舵機(jī)的轉(zhuǎn)向。

本文重點介紹了光電傳感器的排布“w”形布局以及循線控制算法，它們是保證智能車循線運行的關(guān)鍵。“w”形布局使智能車具備了道路預(yù)測能力，而循線控制算法使得車體轉(zhuǎn)向快速正確。

通過對智能車仿真和實驗表明，整個系統(tǒng)的方案可行，系統(tǒng)的控制策略和軟硬件基本合理?？刂品矫?，雖然經(jīng)典的pid控制在電機(jī)調(diào)速方面有良好的控制效果，但由于車模的動力學(xué)模型因車況不同而變化等原因，使得pid控制效果受到影響，以后可考慮采用模糊控制，使算法更加智能化，系統(tǒng)的適應(yīng)性更強。