施衛(wèi)，夏濤

（江蘇理工學(xué)院 汽車與交通工程學(xué)院，江蘇 常州 213001）

前言

車輛換道在駕駛過程中是非常普遍的，數(shù)據(jù)表明交通事故中有一部分的原因就是車輛進(jìn)行車道更換引起的。因此，對于車輛進(jìn)行自主換道的研究就顯得十分重要了。換道軌跡的規(guī)劃是車輛能否自主換道的基礎(chǔ)和關(guān)鍵，精準(zhǔn)合理的換道軌跡有助于車輛安全平穩(wěn)地完成換道操作。目前國內(nèi)外學(xué)者對換道軌跡規(guī)劃進(jìn)行了許多研究，Margolis 等人[1]考慮直接施加轉(zhuǎn)彎和制動力的點(diǎn)質(zhì)量簡化模型，最優(yōu)控制用于求解換道平均曲率半徑最小化問題，從而規(guī)劃出一條避免碰撞的換道最佳路徑。張志超等人[2]通過將車速、換道的橫向距離和橫向最大加速度作為參數(shù)，創(chuàng)新地設(shè)計出X-Sin 函數(shù)換道軌跡曲線，將得出的軌跡與其他換道軌跡進(jìn)行比較，X-Sin 換道曲線擬合度更高。長安大學(xué)王暢等人[3]提出七次多項式模型來對車輛換道軌跡進(jìn)行規(guī)劃，結(jié)合換道時初始和結(jié)束邊界條件對初始表達(dá)式進(jìn)行運(yùn)算，得到換道軌跡的函數(shù)表達(dá)式。

本文在比較其他換道軌跡方法的基礎(chǔ)上，建立基于五次多項式的換道軌跡規(guī)劃模型，根據(jù)換道初始時刻和結(jié)束時刻車輛狀態(tài)量進(jìn)行軌跡求解運(yùn)算，得出一條光滑連續(xù)且符合實際的軌跡曲線。同時考慮到換道的舒適性和效率性，建立了軌跡優(yōu)化函數(shù)，通過引入k1 和k2 兩個權(quán)重系數(shù)進(jìn)行分析，得出了不同權(quán)重比下的換道最優(yōu)時間，使得車輛的換道軌跡更加優(yōu)化。在Carsim/Simulink 中對建立的換道軌跡模型進(jìn)行仿真驗證。

1 基于多項式的換道軌跡模型設(shè)計

1.1 換道場景假設(shè)

由于城市交通道路環(huán)境復(fù)雜多變，給研究帶來很大的困難，故本文對交通道路環(huán)境作出了簡化，只考慮交通流密度比較低的城市雙車道環(huán)境下的某些情況，不考慮行人、障礙物及紅綠燈對自主換道的影響，從而減小了研究難度。如圖1 就是簡化下的一個普遍的城市道路雙車道換道場景。

圖1 城市雙車道換道場景示意圖

如上圖所示，B 車為自主換道車輛，B1 和B4 分別為當(dāng)前行駛車道上前車和后車，B2 和B3 分別為目標(biāo)車道上的前車和后車。當(dāng)B 車滿足換道條件下，從當(dāng)前行駛車道左轉(zhuǎn)駛?cè)肽繕?biāo)車道，正好行駛到車B3 和車B2 之間，從換道開始到換道結(jié)束沒有與任一車輛發(fā)生碰撞，則換道完成。

1.2 換道軌跡數(shù)學(xué)模型建立與求解

如圖2 所示為換道車輛的換道初始時刻和結(jié)束時刻的狀態(tài)圖，車輛從圖示初始狀態(tài)位置換道到結(jié)束狀態(tài)位置，以初始位置車輛的質(zhì)心為坐標(biāo)原點(diǎn)，x 軸正方向為縱向行駛方向，y 軸正方向為橫向行駛方向，假定車輛在車道中行駛時都是沿著車道中心線，并且車輛在換道過程中橫向運(yùn)動和縱向運(yùn)動相對獨(dú)立，互不影響。

圖2 車輛換道場景狀態(tài)變化圖

換道初始時刻的車輛狀態(tài)的各個參數(shù)可以由車載傳感器獲取，其參數(shù)為：初始縱向位置x（t0），初始橫向位置y（t0），初始縱向速度，初始橫向速度，初始縱向加速度初始橫向加速度初始狀態(tài)的各個參數(shù)值為：

換道結(jié)束時刻的車輛狀態(tài)的各個參數(shù)是由車輛自身屬性、道路條件和目標(biāo)期望共同決定的，其參數(shù)為：結(jié)束時縱向位置x（te），結(jié)束時橫向位置y（te），結(jié)束時縱向速度結(jié)束時橫向速度，結(jié)束時縱向加速度，結(jié)束時橫向加速度。

結(jié)束狀態(tài)的各個參數(shù)值為：

式中：te為換道結(jié)束所用時間，Xe為車輛換道結(jié)束時縱向總位移，vxe為換道結(jié)束時的縱向速度，h為換道橫向總位移。

本文選取五次多項式函數(shù)來描述車輛換道的橫縱向運(yùn)動，其函數(shù)為：

式中：x（t）、y（t）分別為在t 時刻車輛的縱向行駛距離和橫向行駛距離，ai、bi（i=0，1，2，3，4，5）為多項式系數(shù)。

將式（1）和式（2）得到的12 個已知條件代入到式（3）中可得：

為了求解式（3）和（4）的軌跡函數(shù)，用矩陣來進(jìn)行計算，可以簡化運(yùn)算過程。令a=[a5a4a3a2a1a0]T，b=[b5b4b3b2b1b0]T，X=[0vx00Xevxe0]T，Y=[0 0 0h0 0]T。

由a=M-1X，b=N-1Yb，可求解到換道軌跡函數(shù)：

由換道軌跡（5）可以發(fā)現(xiàn)，整個換道過程換道軌跡與換道總時間te、換道橫向總位移h、初始縱向速度vx0和結(jié)束時的車輛縱向速度vxe有關(guān)。由于車輛橫向換道總位移即車道寬度h取得是定值3.75m，并且因為換道過程換道時間較短，這里為了簡化分析，假定換道過程中車輛的縱向速度不發(fā)生改變，即vx0=vxe，所以現(xiàn)在只有換道總時間和車輛的縱向速度影響著換道軌跡形狀。

1.3 模型仿真分析

運(yùn)用Matlab 對兩種情形的換道軌跡進(jìn)行研究：換道時間一定，不同的車輛縱向速度對軌跡的影響；車輛縱向速度一定，不同的換道時間對軌跡的影響。

（1）換道時間一定，這里取te=4s，縱向車速分別取15m/s，20m/s 和25m/s 三種情況。

（2）當(dāng)縱向速度一定，這里取vx=20m/s，換道時間te分別取4s，5s 和6s。

由圖3 可以看出，當(dāng)換道時間一定時，車輛以不同的縱向速度換道時，其軌跡也是有差別的，速度越大它的整體軌跡曲率就越小，反之越大，換道曲率過大會導(dǎo)致車輛發(fā)生側(cè)滑等問題，從而影響換道的橫向穩(wěn)定性。從圖4 和5 可以看出，在縱向速度一定的情形下，不同的換道時間對換道軌跡和車輛橫向加速度影響較為明顯。換道時間越短，車輛的橫向加速度變化就越大，換道軌跡的曲率也就越大，所以選取合適的換道時間不僅對換道軌跡有一定的影響，也對車輛橫向加速度產(chǎn)生比較大的影響，并且會影響換道的穩(wěn)定性與舒適性。

圖3 換道時間一定，不同縱向車速的換道軌跡圖

圖4 縱向速度一定，不同換道時間的換道軌跡圖

2 軌跡優(yōu)化控制器設(shè)計

通過建立五次多項式車輛的換道軌跡，從而得出了不同的換道時間對車輛的橫向加速度[4]有比較大的影響，而換道車輛的橫向加速度對換道的舒適性有很大的關(guān)系，換道時間的長短同時也影響著換道的效率。由圖5 可知，換道時間越短，雖然換道的效率提高了，但橫向加速度的變化越陡，舒適性就會降低；相反換道時間越長，換道效率會降低，但橫向加速度變化就越平緩，舒適性就會增加。因此考慮換道舒適性與效率性[5]，建立換道軌跡評價函數(shù)，對換道時間和橫向加速度進(jìn)行權(quán)衡，從而選取合適的換道時間。建立換道時間和橫向加速度的評價函數(shù)為：

圖5 換道橫向加速度隨時間變化圖

式中：te為換道完成時間，temax為換道完成的時間最大值，ay為車輛換道橫向加速度，aymax為車輛自身所能達(dá)到的最大橫向加速度。

同時考慮到舒適性和效率性，在式(6)中加入兩個權(quán)重系數(shù)k1和k2，且k1+k2=1，可以通過調(diào)整k1和k2之間的比值來權(quán)重?fù)Q道時的舒適性和效率性。

通過對軌跡評價函數(shù)（7）進(jìn)行最小值求解可以得到軌跡規(guī)劃優(yōu)化函數(shù)：

在換道時k1和k2的大小受到車輛之間的縱向安全距離的影響，當(dāng)換道車輛與附近車輛的距離較小時，則此時應(yīng)該著重考慮效率性，k2的比重就會大些；反之當(dāng)距離較大時，應(yīng)當(dāng)著重考慮舒適性，則k1的比重就會大些。k2的取值由換道車輛B 與周圍車輛間最小換道安全距離與初始縱向距離的比值來確定。

通過車輛自身的參數(shù)和道路條件，得到軌跡優(yōu)化函數(shù)的約束條件：vx＜vxmax，vy＜vymax，|ay|≤aymax，0＜te≤temax。

3 仿真實驗分析

3.1 仿真參數(shù)設(shè)置

3.1.1 車輛參數(shù)設(shè)置

主換道車輛B 的參數(shù)如表1 所示，初始車道前車B1 的速度為16m/s，位置在換道車輛前方30m；目標(biāo)車道前車B2的速度為22m/s，位置在換道車輛左前方35m；目標(biāo)車道后車B3 的速度為20m/s，位置在換道車輛左后方30m。

表1 車輛部分參數(shù)

3.1.2 軌跡規(guī)劃參數(shù)設(shè)置

橫向位移0≤y≤3.75m，橫向加速度0≤ay≤0.4g m/s2，換道時間0＜te≤6s。

3.2 仿真實驗與分析

設(shè)置換道車輛Toyota_Prius（B）縱向以20m/s 的速度進(jìn)行換道。

圖6 車輛換道過程仿真動畫

如圖7 所示為不同的權(quán)重系數(shù)k1和k2之比下的軌跡優(yōu)化函數(shù)J 隨時間的變化曲線，從圖中可以發(fā)現(xiàn)優(yōu)化函數(shù)J 曲線的最小值所對應(yīng)的時間為該權(quán)重比下的最優(yōu)換道時間。k1反映的是換道時的舒適性，而k2反映的是換道時的效率性，由圖所示，當(dāng)權(quán)重比k1/k2的值越來越大時，函數(shù)J 的最小值所對應(yīng)的最優(yōu)換道時間也在隨之增大，當(dāng)舒適性的比例在不斷增大時，效率性相應(yīng)地減少，換道時間也就更長，與實際情況相符。

圖7 不同權(quán)重比下優(yōu)化軌跡函數(shù)J 隨時間變化圖

圖8 為相同換道環(huán)境下，采用優(yōu)化模型后的換道軌跡與非優(yōu)化的換道軌跡對比圖。由圖可以發(fā)現(xiàn)，優(yōu)化后的換道軌跡在完成換道時的縱向距離縮短了，換道時間也相應(yīng)地減少了，表明了優(yōu)化后的換道模型在考慮舒適性和效率性的同時，對于道路上的突發(fā)情況，可以更快地作出反應(yīng)，從而進(jìn)一步保證了換道的安全性。

圖8 優(yōu)化軌跡與非優(yōu)化軌跡對比圖

4 結(jié)論

由上述仿真實驗中，可以發(fā)現(xiàn)本文提出的軌跡規(guī)劃方法可以較好地擬合車輛的換道軌跡，通過建立軌跡優(yōu)化函數(shù)使得換道更加舒適和安全，對之后的無人駕駛換道技術(shù)奠定基礎(chǔ)。