肖紅霞 周密
摘 要:采用模糊控制算法,以單片機MC9S12XS128為控制核心,結(jié)合CCD線性器件作為道路信息檢測設(shè)備設(shè)計了智能小車控制系統(tǒng)。道路尋優(yōu)模糊控制算法,可實現(xiàn)了對直道、蛇形彎道以及大半徑彎道三種典型道路的自動跟隨。
關(guān)鍵詞:模糊算法;智能小車;道路檢測
智能小車是具有自動導(dǎo)航功能的智能汽車的微縮模型。隨著智能化的發(fā)展,智能車技術(shù)也將逐步壯大,功能將更完善,將具有更為廣泛的應(yīng)用前景。該系統(tǒng)設(shè)計可分為硬件實現(xiàn)、算法應(yīng)用和軟件實現(xiàn)三部分。
1 硬件實現(xiàn)
1.1 整體模塊設(shè)計
該控制系統(tǒng)的結(jié)構(gòu)主要由飛思卡爾MC9S12XS128單片機、CCD路徑識別模塊、紅外線傳感器測速模塊、電源管理模塊、直流驅(qū)動電機模塊、舵機轉(zhuǎn)向模塊、液晶屏動態(tài)顯示模塊組成,如圖1所示。
1.2 局部模塊實現(xiàn)
⑴CCD路徑識別模塊設(shè)計。首先在行、場同步信號的時間基準(zhǔn)下,由MC9S12XS128的A/D口對CCD攝像頭掃描出的路徑視頻信號進行采集,并對此圖像路徑信息處理;然后選取途中合適的點算出小車與路徑的夾角與偏移距離;最后把已知數(shù)據(jù)傳給單片機,模糊算法控制舵機轉(zhuǎn)角,同時采用模糊控制與比例微分控制相結(jié)合的方法控制電機的速度,MC9S12XS128將舵機轉(zhuǎn)角信息準(zhǔn)確輸給舵機PWM信號,以及速度信息實時輸出驅(qū)動電機的PWM轉(zhuǎn)速控制信息,從而實現(xiàn)小車的智能路徑跟蹤。
⑵測速模塊設(shè)計。速度檢測電路主要是為電機控制提供準(zhǔn)確的速度反饋,讓小車能在不同的路況上行駛時準(zhǔn)確的設(shè)定不同的速度。系統(tǒng)采用紅外線傳感器的對射式傳感方式進行測速,檢測電路如圖3所示。
2 模糊算法應(yīng)用
2.1 模糊控制器設(shè)計
本系統(tǒng)通過上面?zhèn)鞲衅鞑杉降男畔?,可以設(shè)計一個雙輸入雙輸出的模糊控制器,輸入變量是由上面經(jīng)過處理的路徑識別模塊的數(shù)據(jù)和測速電路的數(shù)據(jù),輸出是轉(zhuǎn)角和速度的控制信號,從而實現(xiàn)舵機的轉(zhuǎn)向控制和電機的轉(zhuǎn)速控制。
2.2 模糊控制器應(yīng)用
⑴舵機控制策略。CCD傳感器反饋智能車偏移軌跡的偏移量可以通過測得的小車與路徑的偏移夾角和偏移距離計算得到,將這兩個量送入模糊控制器,求得到需要的輸出量。根據(jù)提供的數(shù)據(jù),對其進行模糊化,模糊推理,反模糊化等操作,最后將得到的數(shù)據(jù)處理成相應(yīng)轉(zhuǎn)角信號,然后送給舵機。
⑵速度控制策略。在模糊控制的基礎(chǔ)上,對小車測得的速度采用位置式閉環(huán)Pd控制進行調(diào)整,可以保證小車在各種負載和供電變化的情況下車速能穩(wěn)定、快速的達到預(yù)定速度。
3 軟件實現(xiàn)
CCD智能車系統(tǒng)的軟件開發(fā)設(shè)計是基于CodeWarrior CW12 V4.5編程環(huán)境,使用匯編與C語言相結(jié)合實現(xiàn)的。整體方案程序模塊設(shè)計如圖4所示。
4 小結(jié)
單片機MC9S12DG128B對采集到的視頻圖像數(shù)據(jù)進行預(yù)處理、提取賽道信息、進行路徑識別,然后運用模糊算法將轉(zhuǎn)角信息轉(zhuǎn)換成舵機PWM信號,同時對電機進行模糊PD控制,并將速度信息通過12864液晶屏動態(tài)顯示。模糊算法的高效性提高了小車的路徑跟蹤精度和運行速度。
[參考文獻]
[1]劉建剛,程磊,黃劍.基于CCD圖像識別的HCS12單片機智能車控制系統(tǒng)[J].光電技術(shù)應(yīng)用,2007,22(6).
[2]湯兵勇,路林吉,王文杰.模糊控制理論與應(yīng)用技術(shù)[M].清華大學(xué)出版社,2002.