基于LabVIEW的倒車自動剎車系統(tǒng)開發(fā)
3.3.3 速度控制器設(shè)計
本文引用地址:http://m.butianyuan.cn/article/147867.htm速度控制器采用離散型的增量PI算法。經(jīng)整理后如(3)式所示。
式中KP=K*T/Ti,KI=K,K為增益系數(shù),Ti為積分時間,T為足夠小的常量本系統(tǒng)選取系統(tǒng)程序運(yùn)行周期時間即50ms。
由于車輛影響系統(tǒng)動能因素較多,故在增量式PI算法的基礎(chǔ)上結(jié)合Fuzzy算法。(3)式經(jīng)Z變換整理后如(4)式所示:
根據(jù)(4)式構(gòu)建的Fuzzy—PI控制器如圖8所示:
在Fuzzy算法中,本系統(tǒng)利用實時車速與預(yù)定車速軌跡的誤差量定義相關(guān)特征變量的歸屬函數(shù),即實時速度歸屬函數(shù)(圖9)、速度誤差量歸屬函數(shù)(圖10)及速度積分誤差量歸屬函數(shù)(圖11)。上述三個歸屬函數(shù)均采用三角形分布的歸屬函數(shù),由于試驗車是自動檔車型,怠速下的速度最大值在5Km/h左右,而本系統(tǒng)是將車速控制在3Km/h以下,故速度歸屬函數(shù)介于0-3Km/h。一般而言,考慮微控制器的運(yùn)算速度情況下,所設(shè)計的語意法則不超過9個,結(jié)合本系統(tǒng)輪速傳感器的有效精度是0.01Km/h,故在上述三個歸屬函數(shù)均采用了5個模糊語言變量?! ?/p>
相關(guān)歸屬函數(shù)的定義原則是當(dāng)速度誤差較大時調(diào)整為較大參數(shù),使得速度可以快速的收斂到預(yù)定軌跡,反之若誤差量較小時調(diào)整為較小參數(shù),使得速度可以穩(wěn)定在預(yù)定軌跡附近。速度積分誤差量的歸屬函數(shù)定義則是為了解決系統(tǒng)的穩(wěn)態(tài)誤差,即減小實時車速與預(yù)定軌跡車速間的誤差。KP及KI的模糊控制表如表2、3所示。
經(jīng)多次測試后得到的特征變量參數(shù)如(5)及(6)式所示。最后在解模糊化時,本系統(tǒng)采用最大隸屬度去最大值法。
KP={18/NB,10/NS,5/ZR,10/PS,20/PB} (5)
KI={20/NB,10/NS,8/ZR,10/PS,15/PB} (6)
四. 軟件實現(xiàn)與現(xiàn)場結(jié)果
4.1 系統(tǒng)結(jié)構(gòu)
基于LabVIEW的倒車自動剎車系統(tǒng)主要分為兩個部分:
4.1.1 數(shù)據(jù)采集(下位機(jī)部分)
依據(jù)前文所述的系統(tǒng)模塊可將數(shù)據(jù)采集分為兩個部分。在測距模塊中,驅(qū)動NI 9264模擬輸出產(chǎn)生周期為30ms的40kHz超聲波激勵信號,通過NI9205接收反射波信號,并利用Labview的脈沖探測函數(shù)計算超聲波的傳播時間,從而計算出車—障礙物的實時距離。在剎車控制模塊中,利用NI 8473與車載CAN網(wǎng)絡(luò)無縫連接,實現(xiàn)DPC與車載設(shè)備的數(shù)據(jù)交互。
加速度計相關(guān)文章:加速度計原理
評論