摘要:介紹了基于Freescale HCS12系列單片機的智能巡線小車多模式速度控制系統的設計方案。該速度控制系統主要由直流電機驅動電路、速度檢測模塊和無線通信模塊構成,包含四種速度模式。介紹了速度控制系統的總體結構,并分析了其主要模塊的工作原理。介紹了軟件思想和程序設計流程圖。實驗結果表明,該多模式速度控制系統保證了智能巡線小車具有較好的穩定性和快速跟隨性。
關鍵詞:單片機;多模式;制動;穩定性;快速跟隨性
引言
目前,設計出具有智能化的產品已經成為商家開發產品的目標之一,也是學生課外科技活動的熱點之一;其中,專門針對具有自主巡線功能的智能小車的設計更是數不勝數,但大多數智能巡線小車只是完成了“智能化”所要求的各部分的功能,在小車速度的穩定性和快速性上考慮的相對比較少。本文主要針對具有自主巡線功能的智能小車,設計出了一種多模式速度控制系統,可以使智能小車具有較好的穩定性和快速跟隨性。同時,該速度控制系統的多模式設計思想也可以用在以其它系列單片機為控制核心的智能模型車上。
1 控制系統原理
多模式速度控制系統的速度模式有4種:1、開環加速模式2、反接制動模式3、能耗制動模式4、速度閉環運行模式。系統模式通過速度測量值與給定值的偏差范圍進行選擇,速度給定值由前方傳感器檢測到的路徑形狀進行設定,而偏差范圍與模式選擇的關系根據電機自身的特性曲線和智能小車實際運行情況進行設定。
多模式速度控制系統由HCS12單片機、直流電機驅動電路、直流電機、速度檢測模塊和無線通信模塊組成。單片機產生的PWM波通過由H橋組成的驅動電路來控制直流電機的輸入電壓大小,速度檢測模塊通過旋轉編碼器把電機的轉速轉換為單位時間內的脈沖個數,無線通信模塊實現對速度控制系統相關參數的實時監測與調整,主要用于系統的調試和開發。整個速度控制系統的電源均由一節7.2V鎳鎘電池提供,控制系統原理圖如圖1所示。系統中使用低差壓穩壓器LM2940將7.2V電源變為5V穩壓電源輸出,可為單片機、速度檢測模塊和無線通信模塊等提供相應的電源,也可減少電池電壓不穩定給控制系統各個部分帶來的不良影響,保證了控制系統的穩定運行【1】。
圖1 控制系統原理圖
2 控制系統硬件設計
2.1 直流電機驅動電路
系統中采用的直流電機型號為RS—380H。直流電機驅動采用飛思卡爾公司的5A 集成H 橋芯片MC33886。MC33886芯片內置了控制邏輯、電荷泵、門驅動電路以及低導通電阻的MOSFET 輸出電路,適合用來控制感性直流負載,可以提供連續的5A 電流,并且集成了過流保護、過熱保護、欠壓保護。直流電機驅動電路如圖2所示。
圖2 直流電機驅動電路
通過控制MC33886 的四根輸入線可以方便地實現電機正轉、反轉、能耗制動及反接制動。圖3為經過簡化的H 橋電路,當S1、S4 導通且S2、S3 截止時,電流正向流過電機,電機正轉;S2、S3 導通S1、S4 截止時,電流反向流過電機,適當利用這個過程可以使電機處于反接制動狀態,迅速降低電機速度;當S3、S4導通且S1、S2 截止時,沒有電源加在電機上,可認為電機一端直接與另一端連接在一起,此時電機處于能耗制動狀態。
本設計中使用兩片MC33886 并聯,一方面進一步減小導通電阻對電機特性的影響,另一方面減小過流保護電路對電機啟動及制動時的影響【2】。
圖3 簡化的H橋電路
2.2 速度檢測模塊
通過在電機驅動軸的齒輪上加裝小型旋轉編碼器,使旋轉編碼器齒輪與電機驅動軸的齒輪進行嚙合。這樣,就可通過實驗測定每個脈沖對應的智能小車運行的距離;同時,可設定一個合適的定時中斷作為脈沖采樣周期,根據每個采樣周期內旋轉編碼器的輸出脈沖個數就可計算出智能小車的實際速度,這樣就使脈沖個數和智能小車實際速度具有了明確的對應關系,實際操作、測量非常方便。在本設計中,選用了OMRON E6A2-CS3E旋轉編碼器,該編碼器采用5v 供電,單相輸出,每圈輸出60個脈沖,用在本系統中比較合適【3】。在采樣周期的選取中,考慮到脈沖計數器所能允許的最大值及脈沖計數值要參與實際的運算,為了避免數據溢出,采樣周期不能選取過大。
2.3 無線通信模塊
本系統中的無線通信模塊是基于nRF403的無線數據傳輸模塊,并在此基礎上實現了MODBUS 通信協議。該模塊在智能小車參數測試及程序調試的過程中起到了很大的作用。在智能小車運行的過程中,可以通過下位機將與小車運行狀態有關的各項參數發送到上位機,并可通過簡單的VB程序在上位機上顯示出相應的狀態曲線,從而達到對智能小車的運行狀態進行實時監測的目的。在PID參數整定過程中,根據小車的實際運行狀態和P、I、D參數對控制系統的影響,可以通過上位機來改變下位機的P、I、D參數而不用重新燒寫程序,給系統的在線調試帶來了很大的方便。
3 控制系統軟件設計
HCS12單片機內置PWM模塊,在程序中只需調用相關函數設定PWM周期和寫入PWM占空比的值,就可以產生實際需要的PWM波【4】。考慮到有多模式調節,對閉環控制的響應速度要求不高,閉環控制采用了速度單閉環控制和位置式的PI控制算法,PI運算的結果作為PWM占空比的設定值。采用速度單閉環控制既達到了多模式調節中閉環運行模式的效果,同時也降低了系統設計的復雜性。在PI控制算法中,P、I參數整定的比較弱,這樣智能小車在過彎時的速度有一定的自然降落,可以防止智能小車脫離軌道。控制系統程序主要采用C語言編寫,PI控制算法程序流程圖如圖4【5】。本文設計的多模式速度控制系統,可以作為一個比較完整的模塊調用,這樣很容易與路徑檢測系統相結合,形成完整的具有自主巡線功能的智能小車。
圖4 PI控制算法程序流程圖
本控制系統選擇了一通過CMOS攝像頭進行道路識別的智能小車進行實驗,通過多次實驗及觀察得出:速度偏差在±5%以內智能小車運行在速度閉環模式,小于-5%切換到開環加速模式,大于5%且小于6%切換到能耗制動模式,大于6%切換到反接制動模式,這樣可以使智能小車在不脫離軌道的情況下達到較快的速度,具有較好的穩定性和快速跟隨性能。
4 總結
本文的創新點在于,設計的速度控制系統具有四種速度模式:1、開環加速模式2、反接制動模式3、能耗制動模式4、速度閉環運行模式。該多模式速度控制系統可以使智能小車在任何兩種速度模式之間進行快速的切換,同時保證智能小車仍能很穩定地運行。該多模式速度控制系統適用于多種類型的智能小車,可以使智能小車根據路面條件的變化,在速度調節上具有更好的靈活性。