智能巡線(xiàn)小車(chē)的多模式速度控制系統
摘要:介紹了基于Freescale HCS12系列單片機的智能巡線(xiàn)小車(chē)多模式速度控制系統的設計方案。該速度控制系統主要由直流電機驅動(dòng)電路、速度檢測模塊和無(wú)線(xiàn)通信模塊構成,包含四種速度模式。介紹了速度控制系統的總體結構,并分析了其主要模塊的工作原理。介紹了軟件思想和程序設計流程圖。實(shí)驗結果表明,該多模式速度控制系統保證了智能巡線(xiàn)小車(chē)具有較好的穩定性和快速跟隨性。
關(guān)鍵詞:?jiǎn)纹瑱C;多模式;制動(dòng);穩定性;快速跟隨性
引言
目前,設計出具有智能化的產(chǎn)品已經(jīng)成為商家開(kāi)發(fā)產(chǎn)品的目標之一,也是學(xué)生課外科技活動(dòng)的熱點(diǎn)之一;其中,專(zhuān)門(mén)針對具有自主巡線(xiàn)功能的智能小車(chē)的設計更是數不勝數,但大多數智能巡線(xiàn)小車(chē)只是完成了“智能化”所要求的各部分的功能,在小車(chē)速度的穩定性和快速性上考慮的相對比較少。本文主要針對具有自主巡線(xiàn)功能的智能小車(chē),設計出了一種多模式速度控制系統,可以使智能小車(chē)具有較好的穩定性和快速跟隨性。同時(shí),該速度控制系統的多模式設計思想也可以用在以其它系列單片機為控制核心的智能模型車(chē)上。
1 控制系統原理
多模式速度控制系統的速度模式有4種:1、開(kāi)環(huán)加速模式2、反接制動(dòng)模式3、能耗制動(dòng)模式4、速度閉環(huán)運行模式。系統模式通過(guò)速度測量值與給定值的偏差范圍進(jìn)行選擇,速度給定值由前方傳感器檢測到的路徑形狀進(jìn)行設定,而偏差范圍與模式選擇的關(guān)系根據電機自身的特性曲線(xiàn)和智能小車(chē)實(shí)際運行情況進(jìn)行設定。
多模式速度控制系統由HCS12單片機、直流電機驅動(dòng)電路、直流電機、速度檢測模塊和無(wú)線(xiàn)通信模塊組成。單片機產(chǎn)生的PWM波通過(guò)由H橋組成的驅動(dòng)電路來(lái)控制直流電機的輸入電壓大小,速度檢測模塊通過(guò)旋轉編碼器把電機的轉速轉換為單位時(shí)間內的脈沖個(gè)數,無(wú)線(xiàn)通信模塊實(shí)現對速度控制系統相關(guān)參數的實(shí)時(shí)監測與調整,主要用于系統的調試和開(kāi)發(fā)。整個(gè)速度控制系統的電源均由一節7.2V鎳鎘電池提供,控制系統原理圖如圖1所示。系統中使用低差壓穩壓器LM2940將7.2V電源變?yōu)?V穩壓電源輸出,可為單片機、速度檢測模塊和無(wú)線(xiàn)通信模塊等提供相應的電源,也可減少電池電壓不穩定給控制系統各個(gè)部分帶來(lái)的不良影響,保證了控制系統的穩定運行【1】。
圖1 控制系統原理圖
2 控制系統硬件設計
2.1 直流電機驅動(dòng)電路
系統中采用的直流電機型號為RS―380H。直流電機驅動(dòng)采用飛思卡爾公司的5A 集成H 橋芯片MC33886。MC33886芯片內置了控制邏輯、電荷泵、門(mén)驅動(dòng)電路以及低導通電阻的MOSFET 輸出電路,適合用來(lái)控制感性直流負載,可以提供連續的5A 電流,并且集成了過(guò)流保護、過(guò)熱保護、欠壓保護。直流電機驅動(dòng)電路如圖2所示。
圖2 直流電機驅動(dòng)電路
通過(guò)控制MC33886 的四根輸入線(xiàn)可以方便地實(shí)現電機正轉、反轉、能耗制動(dòng)及反接制動(dòng)。圖3為經(jīng)過(guò)簡(jiǎn)化的H 橋電路,當S1、S4 導通且S2、S3 截止時(shí),電流正向流過(guò)電機,電機正轉;S2、S3 導通S1、S4 截止時(shí),電流反向流過(guò)電機,適當利用這個(gè)過(guò)程可以使電機處于反接制動(dòng)狀態(tài),迅速降低電機速度;當S3、S4導通且S1、S2 截止時(shí),沒(méi)有電源加在電機上,可認為電機一端直接與另一端連接在一起,此時(shí)電機處于能耗制動(dòng)狀態(tài)。
評論