劉濱濱 皇甫亦盈 于佳尼
摘要
為了實現(xiàn)對大型玩具車體底盤電機(jī)控制,設(shè)計了基于STM32和上位機(jī)相結(jié)合的控制驅(qū)動系統(tǒng)。系統(tǒng)采用CAN2.0B標(biāo)準(zhǔn)幀控制協(xié)議,通過工PAD發(fā)送串口命令由Wi-Fi到STM32后,STM32將相應(yīng)的命令根據(jù)協(xié)議編寫成相應(yīng)的CAN指令集經(jīng)由CAN總線發(fā)送給驅(qū)動板,驅(qū)動板解析指令完成電機(jī)驅(qū)動;同時驅(qū)動板中加入電流實時采集和保護(hù)電路,提高驅(qū)動系統(tǒng)的安全性和穩(wěn)定性;Wi-Fi模塊上的攝像頭采集到的圖像回傳到IPAD端,作為系統(tǒng)是否正常工作的反饋。
【關(guān)鍵詞】電流實時采集 圖像回傳 CAN2.0BWi-Fi
上位機(jī)經(jīng)Wi-Fi和STM32進(jìn)行通信,對底盤電機(jī)進(jìn)行驅(qū)動。STM32對接收到的指令解析,通過CAN總線和驅(qū)動板通信,完成電機(jī)動作的相應(yīng)控制。視頻模塊的視頻回傳和電流實時采集保護(hù)電路以及CAN總線協(xié)議自帶的錯誤探測和管理能力使得系統(tǒng)更加安全可靠。
1 驅(qū)動系統(tǒng)原理
1.1 驅(qū)動電路原理
在可逆變速控制驅(qū)動電路中,H橋驅(qū)動電路使用最廣泛。如圖1,當(dāng)開關(guān)管Q1,Q4都導(dǎo)通而Q2,Q3都截止時,電流從電機(jī)左端流向右端,電機(jī)沿著一個方向旋轉(zhuǎn),當(dāng)開關(guān)管Q2和Q3導(dǎo)通而Q1,Q4都截止時,電機(jī)反向旋轉(zhuǎn)。完成電機(jī)的驅(qū)動。
1.2 CAN控制器收發(fā)器工作原理
系統(tǒng)用TJA1050和STM32自帶的CAN控制器連接。TJA1050符合ISO11898標(biāo)準(zhǔn),不上電時呈現(xiàn)無源特性,發(fā)送數(shù)據(jù)時數(shù)據(jù)由主控制器經(jīng)接口管理邏輯到發(fā)送緩存器后傳輸?shù)紺AN核心模塊,模塊根據(jù)CAN規(guī)范將并行位流轉(zhuǎn)換成串行位流,位流經(jīng)過串口傳輸?shù)绞瞻l(fā)器進(jìn)行報文的發(fā)送;接收數(shù)據(jù)時CAN模塊將接收到的串行位流變成并行數(shù)據(jù)后經(jīng)過驗收濾波器和接收FIFO完成報文的過濾和存儲。
1.3 電流實時監(jiān)測原理
本文用的LF-205-S可以測量的電流范圍是±200A。對電機(jī)的A相C相電流檢測,將大電流信號變成小電壓信號。無刷直流電機(jī)中IA+IB+IC-0,通過對A,C求和后反相可以得到B相電流。將電流經(jīng)由高精度半波整流模塊整流成電壓信號求和反相,即可得到此時進(jìn)入功率管的瞬時值所對應(yīng)的電壓值。完成電流的實時采集。
1.4 保護(hù)電路原理
在電流實時采集時發(fā)出2路信號,一路輸入采樣模塊,另一路輸入比較器。設(shè)計了2種保護(hù)方式,一種是限流保護(hù),當(dāng)電流超過設(shè)定的過載電流值時,保護(hù)電路使STM32啟動相應(yīng)的程序停車5秒鐘后恢復(fù)正常工作;另一種是超載保護(hù),當(dāng)電流超過設(shè)置的超載電流值時,STM32會啟動相應(yīng)的停機(jī)程序,防止電路損壞。如圖2。
1.5 CAN應(yīng)用層協(xié)議的制定原理
驅(qū)動器的CAN通訊協(xié)議采用一主多從的方式。采用CAN2.0B標(biāo)準(zhǔn)通信協(xié)議,指令碼為[長度LEN]+[ID]+[FUNC]+[DATA]。
硬件設(shè)計:
硬件由STM32,驅(qū)動板,TJA1050CAN和Wi-Fi視頻模塊。收發(fā)器和stm32由串口連接,和驅(qū)動板由雙絞線連接,如圖3。
3 軟件的設(shè)計
IPAD端軟件采用Socket編程實現(xiàn)命令發(fā)送,采用蘋果公司推出的標(biāo)準(zhǔn)布局設(shè)計UI,同時加入視頻解析的功能,實現(xiàn)實時回傳。核心板程序設(shè)計包含2方面內(nèi)容,一是系統(tǒng)安全的設(shè)計一引入定時器計數(shù),設(shè)定3秒內(nèi)如果沒有接到IPAD端的命令,則系統(tǒng)進(jìn)入待機(jī)狀態(tài)。二是底盤電機(jī)控制,這部分則是改變左右電機(jī)的速度和電機(jī)的轉(zhuǎn)向,發(fā)送CAN指令至驅(qū)動板完成電機(jī)的控制。
4 結(jié)語
系統(tǒng)采用上位機(jī)和STM32相結(jié)合的控制方式,使用CAN總線和驅(qū)動板進(jìn)行通信,視頻反饋功能不僅可以對底盤周圍環(huán)境實時觀察,而且可以對系統(tǒng)工作狀況進(jìn)行監(jiān)測。經(jīng)測試,該Wi-Fi模塊的有效傳輸距離達(dá)到100m,視頻延時小于1S。同時驅(qū)動板的電流實時采集和電路保護(hù)功能提高系統(tǒng)安全性和穩(wěn)定性。
參考文獻(xiàn)
[1]滕守明,魯奕,李響.基于STM32芯片及CAN總線在汽車上的應(yīng)用[J].無線互聯(lián)科技,2013(03):224-224.
[2]胡發(fā)煥,楊杰,邱小童.大功率直流驅(qū)動電機(jī)的設(shè)計[J].機(jī)械與電子,2009(10).
[3]馬喜春,張曾科.基于Socket進(jìn)行通用的網(wǎng)絡(luò)通信程序設(shè)計[J].實驗技術(shù)與管理,2005,22(03):58-61.