基于Carsim的駕駛仿真系統(tǒng)開發(fā)

吉 豪，李曙光，楊亞茹，王 穎

(1.四川大學(xué)機(jī)械工程學(xué)院，四川 成都 610065；2.電子科技大學(xué)自動化工程學(xué)院，四川 成都 611731)

1 引言

駕駛仿真系統(tǒng)是計算機(jī)仿真技術(shù)應(yīng)用在汽車領(lǐng)域的一個典型案例，主要由操縱平臺、車輛動力學(xué)模型和運(yùn)動模擬平臺組成[1-2]?？捎糜隈{駛技能培訓(xùn)、駕駛員行為特性研究、車輛在極限工況下的性能測試、硬件在環(huán)仿真測試、車身結(jié)構(gòu)參數(shù)優(yōu)化等[3-4]。而車輛動力學(xué)建模是開發(fā)駕駛仿真系統(tǒng)的核心和關(guān)鍵技術(shù)，也是其開發(fā)過程中的難點所在。

王偉等人通過車輛運(yùn)動時的受力分析為駕駛模擬系統(tǒng)搭建了動力學(xué)仿真模型，提高了仿真模型的準(zhǔn)確性[5]。詹軍等人開發(fā)了車輛動力學(xué)系統(tǒng)的轉(zhuǎn)向模型、制動系統(tǒng)模型，提高了ADSL駕駛模擬器的逼真度[6]。蘇光磊在Simulink中創(chuàng)建了車輛動力學(xué)模型，加快了駕駛模擬器仿真模型的搭建工作[7]?？梢园l(fā)現(xiàn)，建立更加準(zhǔn)確的車輛動力學(xué)模型可以提高駕駛仿真系統(tǒng)的精度和有效性，但是通過分析和數(shù)學(xué)建模的方法來搭建駕駛仿真系統(tǒng)的車輛動力學(xué)模型較為困難和復(fù)雜。

Carsim車輛動力學(xué)軟件可通過配置參數(shù)的方式快速地搭建出仿真汽車的車輛動力學(xué)模型和行駛場景，還可以進(jìn)行實時仿真。許吉禪等人利用Carsim快速的搭建出了車輛半主動懸架的仿真模型，通過仿真測試改善了車輛懸架的性能[8]。張玉潔設(shè)計了基于Carsim的電動助力轉(zhuǎn)向系統(tǒng)，通過Carim的實時仿真模式的數(shù)據(jù)輸入輸出接口對其進(jìn)行了硬件在環(huán)仿真測試[9]。魯玉萍等人利用Carsim和Simulink搭建了車輛動力學(xué)模型，通過實驗對比仿真模型和樣車測試數(shù)據(jù)，結(jié)果表明Carsim仿真模型具有較高的準(zhǔn)確度[10]。利用Carsim軟件可快速地搭建出較為準(zhǔn)確的駕駛模擬系統(tǒng)的車輛動力學(xué)仿真模型，還可以通過其數(shù)據(jù)接口對其搭建的仿真車輛進(jìn)行實時控制以及處理其動力學(xué)模型輸出的車輛行駛數(shù)據(jù)。

本文利用不同于數(shù)學(xué)建模的方法，通過配置參數(shù)在Carsim中快速搭建了駕駛仿真系統(tǒng)的車輛動力學(xué)模型，并利用其數(shù)據(jù)接口開發(fā)了操縱平臺和運(yùn)動模擬平臺，改善在開發(fā)駕駛仿真系統(tǒng)的過程中車輛動力學(xué)建模復(fù)雜的問題，降低駕駛模擬系統(tǒng)車輛動力學(xué)建模的難度，簡化了開發(fā)過程。

2 操縱平臺

駕駛仿真系統(tǒng)的操縱平臺用于采集操縱人員的控制指令。其主要由傳感器和DSP開發(fā)板組成，如圖1所示。為了滿足該系統(tǒng)對于處理速度、計算精度等方面的要求，采用型號為TMS320F28335的DSP處理器。該芯片主頻高達(dá)150MHz，能夠進(jìn)行32位浮點運(yùn)算，并且具有豐富的外設(shè)接口與通信模塊。

圖1 操縱平臺硬件

信號采集框架如圖2所示。傳感器主要包括油門踏板傳感器、剎車踏板傳感器、方向盤轉(zhuǎn)角傳感器、檔位位置傳感器。油門和剎車踏板傳感器將踏板的位移轉(zhuǎn)換成相應(yīng)的電壓信號輸出，利用DSP的ADC模塊采集該電壓信號；利用其CAN總線通訊接口讀取方向盤轉(zhuǎn)角傳感器輸出的轉(zhuǎn)角數(shù)值信號；利用外部中斷模塊檢測檔位位置傳感器輸出的電平信號，從而讀取狀態(tài)信息。

圖2 信號采集框架

通過配置采樣量化寄存器可以有效地去除毛刺信號的干擾。使用DMA模塊直接訪問ADC采樣結(jié)果寄存器并發(fā)送給SCI模塊的數(shù)據(jù)寄存器，可將采樣采集到的數(shù)據(jù)通過RS232串口通訊模塊直接發(fā)送給上位機(jī)程序，無需經(jīng)過CPU處理，有效地降低了DSP處理器的負(fù)擔(dān)。

3 動力學(xué)聯(lián)合仿真環(huán)境

Carsim汽車仿真軟件的LabVIEW_RT模式可實現(xiàn)與LabVIEW軟件的共同運(yùn)行，快速地搭建出動力學(xué)聯(lián)合仿真環(huán)境，如圖3所示。

圖3 動力學(xué)聯(lián)合仿真環(huán)境

3.1 Carsim仿真環(huán)境

Carsim軟件的Road頁面中提供了車輛行駛的三維場景，并且可以設(shè)置路面附著系數(shù)等參數(shù)；在Vehicle Configuration中設(shè)置車輛的車身結(jié)構(gòu)、風(fēng)阻系數(shù)、輪胎模型、懸架模型等參數(shù)，搭建車輛仿真模型；在Run Control中設(shè)置主機(jī)和目標(biāo)機(jī)IP、仿真步長、仿真輸入輸出參數(shù)，實現(xiàn)與LabVIEW軟件的數(shù)據(jù)交互。

3.2 LabVIEW上位機(jī)程序

利用LabVIEW軟件的圖形化編程語言可快速地開發(fā)上位機(jī)程序，與Carsim軟件聯(lián)合仿真，該程序具有以下功能模塊：

1)串口數(shù)據(jù)讀取。利用VISA串口配置、串口接收、串口關(guān)閉等模塊讀取串口通訊數(shù)據(jù)；通過RS232轉(zhuǎn)USB芯片，接收DSP采集并發(fā)送過來的傳感器信號數(shù)據(jù)。

2)信號處理。使用中值濾波算法模塊對信號進(jìn)行濾波處理：設(shè)定采樣窗個數(shù)，按照數(shù)值大小排序，去掉最大值和最小值后，取剩余數(shù)據(jù)的平均值輸出；在零點位置加入死區(qū)環(huán)節(jié)，進(jìn)一步降低干擾造成的數(shù)據(jù)波動。

3)數(shù)據(jù)交互。通過不斷循環(huán)調(diào)用與Carsim連接的初始化(Init.vi)、單步(Step.vi)和停止(Terminate.vi)子VI程序?qū)崿F(xiàn)數(shù)據(jù)交互，把控制信號發(fā)送給Carsim，同時接收其返回的車輛行駛數(shù)據(jù)。

4)數(shù)據(jù)顯示。利用數(shù)值顯示控件顯示控制信號以及車輛實時數(shù)據(jù)信息。

4 運(yùn)動仿真平臺

利用Washout算法和六自由度平臺開發(fā)駕駛仿真系統(tǒng)的運(yùn)動仿真平臺，該平臺用于模擬Carsim中的仿真車輛在行駛過程中的加速度和車身姿態(tài)，為駕駛?cè)藛T提供更加逼真的駕駛感受。

4.1 系統(tǒng)組成

Carsim可實時計算出車輛加速度和角速度，并發(fā)送給LabVIEW進(jìn)行處理。由于六自由度平臺的運(yùn)動范圍有限，不能完全復(fù)現(xiàn)出車輛行駛過程的車身姿態(tài)，所以利用LabVIEW控制設(shè)計工具包編寫Washout算法程序?qū)arsim輸出的直線加速度α和旋轉(zhuǎn)角速度ω進(jìn)行處理，將其轉(zhuǎn)換成六自由度平臺的位移距離S和旋轉(zhuǎn)角度θ，并通過TCP/IP模塊發(fā)送給六自由度平臺控制器，實現(xiàn)實時的運(yùn)動模擬。

4.2 Washout算法設(shè)計

Washout算法結(jié)構(gòu)如圖4所示。主要由高通直線加速度通道、低通直線加速度通道和高通角速度通道組成。

圖4 Washout算法框圖

4.2.1 高通直線加速度通道

利用高通濾波器過濾出Carsim動力學(xué)模型輸出的車輛運(yùn)動過程中的高頻直線加速度，再通過二次積分轉(zhuǎn)換成平臺的位移S。

比例變換：由于六自由度平臺的運(yùn)動范圍有限，需要利用比例環(huán)節(jié)對輸入的加速度幅值進(jìn)行限制，避免其超過最大幅度。采用三階多項式設(shè)計該環(huán)節(jié)

(1)

y=a0+a1x1+a2x2+a3x3

(2)

式中，ax、ay、az分別為X、Y、Z三軸方向的直線加速度。

由于人體感知加速度的耳石器官是通過比力來感受運(yùn)動加速度，因此需要對加速度進(jìn)行比力變換

fg=a-g

(3)

式中，fg為比力；g為重力加速度。

加速度變換：利用變換矩陣L將車輛的直線加速度從體坐標(biāo)系變換到慣性坐標(biāo)系

f1=Lfg

(4)

L=LxLyLz

(5)

(6)

(7)

(8)

式中，σ、?、λ分別為繞X、Y、Z軸的旋轉(zhuǎn)角度；Lx、Ly、Lz為分別為對應(yīng)的旋轉(zhuǎn)系數(shù)矩陣。

二階和三階高通濾波器傳遞函數(shù)一般形式為

(9)

(10)

式中，H(s)、G(s)分別為二階、三階高通濾濾波器對應(yīng)的傳遞函數(shù)；k為放大系數(shù)；ωn為自然響應(yīng)頻率；ωb為一階環(huán)節(jié)轉(zhuǎn)角頻率；ξ為阻尼比。

當(dāng)輸入幅值為1的階躍信號時，利用終值定理

(11)

(12)

通過上式可以發(fā)現(xiàn)：使用二階高通濾波器后經(jīng)過二次積分得到的位移值非零，平臺會停在某個位置；而使用三階高通濾波器得到的輸出值會逐漸變?yōu)?，平臺會回逐步到初始位置，可以為下一次運(yùn)動提供更大的運(yùn)動范圍，輸出結(jié)果對比如圖5所示。

圖5 濾波器性能對比

4.2.2 直線加速度通道

利用低通濾波器過濾Carsim輸出的低頻直線加速度信號，再通過計算轉(zhuǎn)換成角度。使平臺傾斜一定角度，利用重力加速的分量模擬低頻和持續(xù)性的加速度運(yùn)動。

低通濾波器的傳遞函數(shù)一般形式

(13)

平臺傾斜角度α計算

(14)

4.2.3 高通角速度通道

利用高通加速度通道過濾出Carsim輸出的高頻直線加速度，通過一次積分轉(zhuǎn)換成平臺的旋轉(zhuǎn)角度β。

通過角速度變換矩陣T將角速度轉(zhuǎn)變成慣性坐標(biāo)系下的歐拉角變換率

ω1=Tω

(15)

(16)

式中，ω為歐拉角變換率。

其它各個環(huán)節(jié)與高通直線加速度通道類似，不再敘述。

5 實驗

為了驗證所設(shè)計的駕駛仿真系統(tǒng)的有效性，設(shè)計了駕駛仿真和運(yùn)動仿真。駕駛仿真通過對比駕駛輸入控制量和駕駛仿真系統(tǒng)輸出參數(shù)來驗證該仿真系統(tǒng)的跟隨性。通過運(yùn)動仿真驗證六自由度運(yùn)動平臺模擬車輛運(yùn)動的性能，以及Washout算法在該仿真系統(tǒng)的有效性。駕駛模擬器仿真系統(tǒng)如圖6所示。

圖6 駕駛仿真系統(tǒng)

5.1 駕駛仿真

記錄采集到的方向盤、油門、檔位、剎車傳感器信號并將其轉(zhuǎn)換成方向盤轉(zhuǎn)角、發(fā)動機(jī)節(jié)氣門開度(百分比)、檔位、制動壓力，發(fā)送給Carsim進(jìn)行實時駕駛仿真，然后將與Carsim輸出的數(shù)據(jù)對比，實驗結(jié)果如圖7、8、9、10所示。

圖7 轉(zhuǎn)向?qū)嶒?/p>

圖8 加速實驗

圖9 換擋實驗

圖10 ABS制動實驗

駕駛仿真包括轉(zhuǎn)向仿真、加速仿真、換擋仿真和制動仿真。由圖7、8、9、10可知：Carsim輸出的前輪轉(zhuǎn)角和車輛側(cè)向加速度響應(yīng)能夠很好地跟隨采集到的方向盤傳感器角度信號；鎖定變速箱檔位，輸入給定的油門信號，輸出的車輛速度會逐漸達(dá)到峰值，加速度會逐漸變?yōu)?；當(dāng)變換檔位時，離合器的閉合狀態(tài)以及車輛在X方向的加速度會發(fā)生相應(yīng)的變化；將采集到的剎車踏板傳感器信號轉(zhuǎn)換成制動壓力輸入Carsim，處于ABS模式的制動系統(tǒng)會使剎車踏板的位移出現(xiàn)抖動，最后達(dá)到穩(wěn)定。通過測試，發(fā)現(xiàn)輸出相應(yīng)的延遲低于10ms，能夠滿足實時性的要求。

5.2 運(yùn)動仿真

利用給定測試信號作為輸入，測試運(yùn)動仿真系統(tǒng)中設(shè)計的Washout算法，輸出結(jié)果如圖11所示。

圖11 算法仿真

由圖11可知：高通直線加速度通道可過濾出車輛行駛過程中的高頻直線加速度并將其轉(zhuǎn)換成位移，使平臺運(yùn)動相應(yīng)的距離，當(dāng)加速度穩(wěn)定后，輸出的位移變?yōu)?，平臺逐漸返回原點；低通加速度通道過可過濾出低頻直線加速度，并轉(zhuǎn)換成一定的傾斜角度，用于模擬低頻和持續(xù)性的加速度；高通角速度通道可過濾出高頻角速度，將其轉(zhuǎn)換成對應(yīng)角度，使平臺傾斜，模擬車身姿態(tài)。

6 結(jié)論

本文提出基于Carsim的駕駛仿真系統(tǒng)開發(fā)方案，通過配置參數(shù)在Carsim中快速搭建了車輛動力學(xué)模型，將操縱平臺采集到的駕駛員控制指令接入到Carsim的數(shù)據(jù)輸入接口，利用Washout算法處理Carsim動力學(xué)仿真模型輸出的車輛加速度、角速度。通過實驗發(fā)現(xiàn)在Carsim中搭建的車輛動力學(xué)模型的輸出響應(yīng)對控制信號的跟隨性較好，根據(jù)其輸出的車輛行駛參數(shù)搭建的Washout算法有效地模擬了車輛運(yùn)動，該方案降低駕駛仿真系統(tǒng)開發(fā)過程中動力學(xué)建模的難度，加快了開發(fā)過程，具有可行性和有效性。