基于MSP430 單片機(jī)的智能小車尋跡模塊設(shè)計(jì)方案
0 引言
智能小車又稱輪式移動機(jī)器人,能夠按預(yù)設(shè)模式在特定環(huán)境中自動移動,無需人工干預(yù),可用于科學(xué)勘測、現(xiàn)代物流等方面。針對路面采用黑色標(biāo)記線條作為路徑引導(dǎo)線的應(yīng)用場合,反射式光電傳感器是常用的路徑識別傳感器。反射式光電傳感器因信號處理方式和物理結(jié)構(gòu)簡單的特點(diǎn)而被廣泛應(yīng)用于結(jié)構(gòu)化環(huán)境和低成本產(chǎn)品中,雖然存在檢測距離近、預(yù)測性差的弱點(diǎn),但通過合理設(shè)計(jì)和選擇反射式光電傳感器并結(jié)合合適的信息處理軟件能夠滿足上述簡單環(huán)境場合應(yīng)用。隨著汽車ECU 電子控制的發(fā)展,在汽車上配備遠(yuǎn)程信息處理器,傳感器和接收器,通過這些器件的協(xié)調(diào)控制可以實(shí)現(xiàn)汽車的無人駕駛。本文提出基于MSP430單片機(jī)的控制裝置,通過反射式光電傳感器尋跡,MSP430單片機(jī)處理反射式光電傳感器檢測到的信號,從而控制智能車的轉(zhuǎn)向,實(shí)現(xiàn)智能小車的自動尋跡。
1 系統(tǒng)總體設(shè)計(jì)方案
在小車車體的前端貼近地面的地方安裝有4 組尋跡模塊,如圖1所示,單片機(jī)通過判斷4個(gè)尋跡模塊發(fā)送來的信號進(jìn)行自動循跡。尋跡模塊在遇到黑線時(shí)發(fā)送低電平信號,遇到空白的地方發(fā)送高電平信號,單片機(jī)通過判斷高低電平即可作出相應(yīng)的操作。通過4組尋跡模塊發(fā)送的信號組合,可將小車行駛狀態(tài)分成如表1所示7種狀態(tài)。
單片機(jī)通過判斷當(dāng)前的運(yùn)行狀態(tài),然后對L298 驅(qū)動模塊進(jìn)行相應(yīng)的操作。當(dāng)正常時(shí),不進(jìn)行調(diào)整;當(dāng)左偏時(shí),通過對L298 驅(qū)動模塊進(jìn)行調(diào)整,使小車的左輪速度大于右輪速度,即可實(shí)現(xiàn)小車向右調(diào)整。由于左偏有三種情形,但每種情形只是使能端的PWM 參數(shù)不同。當(dāng)右偏時(shí),處理流程與左偏類似。
2 尋跡模塊的硬件設(shè)計(jì)
繪制完成的反射式光電傳感器電路圖如圖2 所示。該電路的工作原理為:當(dāng)光耦TCRT5000 有光線反射回來,即遇到白色等反光能力強(qiáng)的跑道,放大器LM324AD 的輸出端輸出為高電平,反之,輸出為低電平。單片機(jī)通過控制LM324AD 的輸出端電壓即可做出相應(yīng)的控制操作。四個(gè)相同的此模塊分別與單片機(jī)的P41,P42,P43,P44引腳相連。單片機(jī)模塊如圖3所示。
3 循跡模塊的軟件設(shè)計(jì)
在小車的自動控制模式下,單片機(jī)通過判斷4個(gè)尋跡模塊發(fā)送回來的不同信號進(jìn)行相應(yīng)的操作。整體的思路為:小車左偏則左輪的速度要大于右輪的速度小車才能恢復(fù)正常,小車右偏則右輪的速度要大于左輪的速度小車才能恢復(fù)正常,當(dāng)小車正常時(shí)兩側(cè)輪子的速度相同[6].由上面的分析可知速度的快慢可通過對L298使能端PWM值的控制進(jìn)行調(diào)節(jié)。通過多次調(diào)試可得出如表2所示的PWM數(shù)值。
電機(jī)保護(hù)器相關(guān)文章:電機(jī)保護(hù)器原理
評論