基于動(dòng)態(tài)預(yù)警的人車共駕智能汽車側(cè)向避障魯棒控制

聶枝根，王 超，王萬(wàn)瓊，沈 澳,韓四海

(1.昆明理工大學(xué) 交通工程學(xué)院，昆明 650500;2.法國(guó)信息與系統(tǒng)國(guó)家重點(diǎn)實(shí)驗(yàn)室，UMR CNRS 7020，法國(guó) 馬賽 13397;3.中國(guó)重汽集團(tuán)杭州發(fā)動(dòng)機(jī)有限公司， 杭州 311232)

智能駕駛汽車能夠提高汽車安全性，改善交通問(wèn)題，并提升汽車舒適性和經(jīng)濟(jì)性，成為目前交通和汽車領(lǐng)域的重要研究熱點(diǎn)[1-2]。但由于智能駕駛技術(shù)成熟性和智能駕駛背后法律問(wèn)題，造成智能駕駛汽車將在很長(zhǎng)時(shí)間內(nèi)處于人車共駕的狀態(tài)[3]?；诖?，為了提高汽車安全和駕駛員舒適性，先碰撞預(yù)警再根據(jù)駕駛員反應(yīng)進(jìn)行變道避障控制，為人車共駕智能汽車避障重要控制方式之一。

進(jìn)入21世紀(jì)，汽車碰撞預(yù)警系統(tǒng)得到廣泛關(guān)注，國(guó)內(nèi)外眾多企業(yè)和研究機(jī)構(gòu)對(duì)其進(jìn)行了大量的研究[4-5]。在美國(guó)AHS(automated highway system)項(xiàng)目的推動(dòng)下，開(kāi)始廣泛研究汽車避障預(yù)警和主動(dòng)控制系統(tǒng)。由于安全距離模型能夠直觀反映兩車之間的位置關(guān)系，具有廣泛的適用性[6]。因此，很多碰撞預(yù)警研究的重點(diǎn)多集中設(shè)計(jì)縱向安全距離模型[7]。文獻(xiàn)[8]通過(guò)獲取汽車狀態(tài)參數(shù)，提出了一種以所需安全距離為安全指標(biāo)的汽車追尾預(yù)警算法。文獻(xiàn)[9]通過(guò)對(duì)汽車超車時(shí)運(yùn)動(dòng)軌跡的分析，結(jié)合汽車的運(yùn)動(dòng)學(xué)模型，基于臨界縱向安全距離，構(gòu)建了超車汽車碰撞的預(yù)警模型。文獻(xiàn)[10]構(gòu)建了基于TTC(time to collision)碰撞時(shí)間理論的風(fēng)險(xiǎn)評(píng)估模型。但在真實(shí)行駛條件和環(huán)境下，路面狀態(tài)、駕駛狀態(tài)和駕駛干預(yù)將實(shí)時(shí)影響避障預(yù)警結(jié)果。并且，安全距離模型能實(shí)時(shí)計(jì)算兩車應(yīng)保持的期望安全車距，但無(wú)法反映出汽車當(dāng)前行車狀況的危險(xiǎn)程度。

文獻(xiàn)[11]利用3D虛擬危險(xiǎn)勢(shì)場(chǎng)規(guī)劃避障軌跡，并基于多約束模型預(yù)測(cè)方法，實(shí)現(xiàn)了避障參考軌跡跟蹤。文獻(xiàn)[12]基于模擬退火優(yōu)化算法，規(guī)劃了能夠繞過(guò)障礙物的避障軌跡，并基于主動(dòng)前輪轉(zhuǎn)向系統(tǒng)，設(shè)計(jì)了避障軌跡跟蹤控制器。文獻(xiàn)[13]采用人工勢(shì)場(chǎng)方法規(guī)劃了避障參考軌跡，并基于轉(zhuǎn)向系統(tǒng)跟蹤期望運(yùn)動(dòng)軌跡。但上述文獻(xiàn)未研究駕駛員是否介入以及駕駛員對(duì)側(cè)向避障起始時(shí)刻的影響，同時(shí)，控制策略也未考慮控制器參數(shù)攝動(dòng)。

針對(duì)上述研究不足，筆者根據(jù)前方汽車速度動(dòng)態(tài)變化，結(jié)合汽車的運(yùn)動(dòng)學(xué)模型，綜合考慮了路面、駕駛狀態(tài)和駕駛員干預(yù)，建立了縱向安全距離模型；并基于駕駛員反應(yīng)時(shí)間和制動(dòng)器反應(yīng)時(shí)間等，提出了基于臨界縱向安全距離和碰撞時(shí)間倒數(shù)(TTC1)融合互補(bǔ)的多級(jí)預(yù)警算法，有效處理多因素影響下的避障預(yù)警，并反映汽車當(dāng)前危險(xiǎn)程度和決定側(cè)向避障觸發(fā)時(shí)刻。同時(shí)，為了能夠精準(zhǔn)控制側(cè)向避障軌跡跟蹤，提出了考慮參數(shù)攝動(dòng)的魯棒控制策略。最終，通過(guò)預(yù)警和控制相結(jié)合，實(shí)現(xiàn)了根據(jù)駕駛員動(dòng)態(tài)干預(yù)，實(shí)時(shí)修正預(yù)警算法，并決定是否需要側(cè)向避障及側(cè)向避障觸發(fā)時(shí)刻，有效提高了人車共駕智能汽車安全性。

1 基于汽車制動(dòng)過(guò)程分析的安全距離模型

制動(dòng)過(guò)程經(jīng)歷如下過(guò)程：駕駛員反應(yīng)，駕駛員腳踩制動(dòng)踏板到制動(dòng)器開(kāi)始起作用，制動(dòng)器開(kāi)始增壓到最大壓力，汽車持續(xù)制動(dòng)到停車，汽車制動(dòng)器解除；其對(duì)應(yīng)時(shí)間分別為t1,t2,t3,t4,t5。從駕駛員反應(yīng)到制動(dòng)器開(kāi)始起作用，即t1+t2時(shí)間內(nèi)，汽車做勻速運(yùn)動(dòng)，制動(dòng)距離為S1；t3時(shí)間內(nèi)制動(dòng)距離為S2；t4時(shí)間內(nèi)制動(dòng)距離為S3。具體推導(dǎo)過(guò)程見(jiàn)參考文獻(xiàn)[14]。

總制動(dòng)距離為

Sbr=S1+S2+S3。

(1)

前車行駛的距離為SC，則安全預(yù)警距離表示為

Sw=Sbr-SC+d0，

(2)

式中d0為兩車最小保持車距。

安全距離預(yù)警模型的影響因素主要有自車初始車速、制動(dòng)過(guò)程各階段歷經(jīng)時(shí)間、最大制動(dòng)減速度和前車行駛距離。其中，制動(dòng)過(guò)程各階段時(shí)間除了與汽車制動(dòng)系統(tǒng)性能有關(guān)外，還與駕駛員的駕駛狀態(tài)密切相關(guān)。

最小保持車距為自車行駛或停車時(shí)與目標(biāo)車之間的臨界距離[15]。汽車避障過(guò)程中，將反映路面條件的附著系數(shù)和反映駕駛員特性的駕駛意圖參數(shù)引入到最小保持車距中[16]，以提高縱向主動(dòng)避障系統(tǒng)對(duì)不同路面和駕駛員的適應(yīng)能力，具體見(jiàn)公式(3)。

(3)

式中：k為駕駛意圖參數(shù)；φμ為附著系數(shù)；a，b為模型參數(shù)。

由公式(3)可知，當(dāng)駕駛員駕駛狀態(tài)相同且道路條件較好時(shí)，此時(shí)最小保持車距應(yīng)較小以提高道路交通的利用率；當(dāng)路面濕滑時(shí)，汽車易打滑，最小保持車距需較大以提升汽車行駛安全性。

實(shí)時(shí)計(jì)算智能汽車與前車的縱向距離，為實(shí)時(shí)避障預(yù)警提供了基礎(chǔ)，詳見(jiàn)圖1。圖中：t0為初始時(shí)刻，t為任意時(shí)刻，SC0為初始距離，LS為自車車長(zhǎng)，LC為前車車長(zhǎng)，SNx為自車縱向距離。

圖1 汽車縱向距離示意圖Fig. 1 Schematic diagram of vehicle longitudinal distance

假設(shè)前車(C車)沿當(dāng)前車道直線行駛，C車和S車(自車)的縱向行駛位移如下。

(4)

(5)

S車與C車在任意t時(shí)刻之間的實(shí)時(shí)間距

(6)

式中：aC為前車加速度；aNx為自車加速度；vC為前車的實(shí)時(shí)車速；vNx為自車的實(shí)時(shí)車速；vC0為前車初始車速；vNx0為自車初始車速。

要使S車與C車在任意時(shí)刻都能安全避障，避障過(guò)程應(yīng)實(shí)時(shí)滿足式(7)。

SNC>d0,t∈(0,t)。

(7)

2 動(dòng)態(tài)預(yù)警算法

2.1 汽車側(cè)向避障軌跡模型

為了使變道完成時(shí)，車輛側(cè)向加速度為零，采用正弦函數(shù)作為車道軌跡模型[17]。如圖2所示，圖中P點(diǎn)為智能汽車變道過(guò)程中最易與前方汽車碰撞點(diǎn)。

圖2 智能汽車避障側(cè)向變道軌跡俯視圖Fig. 2 Vertical view for lateral lane change of collision avoidance

汽車側(cè)向運(yùn)動(dòng)模型為

(8)

式中H為車道寬度。

為了使汽車側(cè)向安全距離模型能夠適應(yīng)于不同路面條件和駕駛員的駕駛狀態(tài)，將縱向安全距離模型中的最小保持距離代入式(8)，可得S車側(cè)向行駛軌跡為

(9)

期望橫擺角速度為

(10)

2.2 汽車側(cè)向避障預(yù)警算法

當(dāng)汽車行駛到無(wú)法通過(guò)縱向制動(dòng)避障時(shí)，此刻主動(dòng)換道避障危險(xiǎn)報(bào)警距離為

Sa=S2+S3-SC+d0。

(11)

為確保預(yù)警系統(tǒng)不影響駕駛員駕駛狀態(tài)，預(yù)警系統(tǒng)不能夠設(shè)置過(guò)多預(yù)警狀態(tài)。當(dāng)SNC>SW時(shí)，此時(shí)處于安全行駛狀態(tài)，預(yù)警設(shè)備不報(bào)警；當(dāng)SNC≤SW時(shí)，進(jìn)行持續(xù)不間斷黃燈預(yù)警，提醒駕駛員控制汽車進(jìn)行制動(dòng)或轉(zhuǎn)向操作，此時(shí)系統(tǒng)實(shí)際上未進(jìn)行主動(dòng)控制；當(dāng)SNC≤Sa時(shí)，持續(xù)不間斷紅燈預(yù)警，此時(shí)無(wú)法通過(guò)制動(dòng)安全避障，必須轉(zhuǎn)向避障控制。

為實(shí)現(xiàn)轉(zhuǎn)向避障控制，根據(jù)前后汽車實(shí)時(shí)車速，參考側(cè)向行駛軌跡，建立了臨界側(cè)向避障安全距離模型，具體如下所示。

(12)

SNy=W，

(13)

式中：T為自車側(cè)向位移等于前車寬度所用的時(shí)間；W為前車最大寬度。

汽車臨界側(cè)向避障極限的縱向安全距離為

Ss=vNxT+d0-vCT。

(14)

在此縱向安全距離之前，駕駛員可以自主控制汽車進(jìn)行側(cè)向避障；當(dāng)SNC≤Ss時(shí)，駕駛員依然未干預(yù)，主動(dòng)避障系統(tǒng)將自動(dòng)接管汽車進(jìn)行側(cè)向變道避障控制。

汽車主動(dòng)避障控制系統(tǒng)應(yīng)能夠根據(jù)當(dāng)前汽車運(yùn)動(dòng)狀態(tài)，判斷安全狀況并及時(shí)預(yù)警提醒駕駛員控制汽車。但安全距離模型只能夠?qū)崟r(shí)計(jì)算兩車應(yīng)保持的期望安全距離，無(wú)法反映出汽車當(dāng)前危險(xiǎn)程度[18]?；谏鲜鲈?，引入汽車碰撞時(shí)距TTC的倒數(shù)設(shè)計(jì)融合互補(bǔ)的多層預(yù)警算法。

汽車碰撞時(shí)距定義[19]為

(15)

式(15)也可表示為

(16)

由TTC1的定義可知，當(dāng)TTC1>0時(shí)，自車大于目標(biāo)車速，即自車正在接近目標(biāo)車；當(dāng)TTC1<0時(shí)，自車小于目標(biāo)車速，說(shuō)明自車正在遠(yuǎn)離目標(biāo)車，此時(shí)為安全狀態(tài)；當(dāng)TTC1=0時(shí)，自車等于目標(biāo)車速，說(shuō)明兩車處于相對(duì)靜止?fàn)顟B(tài)，故為安全狀態(tài)。

考慮到評(píng)價(jià)系統(tǒng)的實(shí)用性和通用性，融合互補(bǔ)的多級(jí)預(yù)警算法分為4個(gè)等級(jí)：安全、警告、危險(xiǎn)及臨界狀態(tài)。并且，為了保證汽車實(shí)時(shí)安全，所提預(yù)警算法的預(yù)警等級(jí)由安全距離和碰撞時(shí)距早觸發(fā)者決定。具體預(yù)警分級(jí)如表1所示。

表1 融合互補(bǔ)的多級(jí)預(yù)警算法

根據(jù)預(yù)警各級(jí)定義，設(shè)計(jì)了避障預(yù)警及避障方式切換流程圖，見(jiàn)圖3。在動(dòng)態(tài)環(huán)境不同前車和智能汽車狀態(tài)下，兩種方式預(yù)警時(shí)間節(jié)點(diǎn)不同，實(shí)際預(yù)警狀態(tài)由兩個(gè)預(yù)警方式中早觸發(fā)的方式?jīng)Q定，形成了兩種預(yù)警方式融合互補(bǔ)的多層預(yù)警算法，以確保駕駛員和控制器更多處理時(shí)間，進(jìn)而保證汽車避障安全性。此多層預(yù)警算法既能夠判斷當(dāng)前行駛與前車應(yīng)保持的距離，也能夠反映任一時(shí)刻的危險(xiǎn)情況。

圖3 避障預(yù)警及避障方式切換流程圖Fig. 3 Flow chart of collision avoidance warning and mode switching strategy

由圖3可知，當(dāng)預(yù)警等級(jí)為2級(jí)時(shí)，發(fā)出黃燈警告，提醒駕駛員及時(shí)進(jìn)行轉(zhuǎn)向或制動(dòng)干預(yù)；若駕駛員沒(méi)有反應(yīng)，到達(dá)3級(jí)危險(xiǎn)狀態(tài)時(shí)，發(fā)出持續(xù)不間斷紅燈警告，并只能通過(guò)轉(zhuǎn)向避障；如果駕駛員未干預(yù)，到達(dá)4級(jí)臨界狀態(tài)時(shí)，避障系統(tǒng)將主動(dòng)接管汽車進(jìn)行主動(dòng)換道，保證汽車避障安全。

3 汽車側(cè)向避障控制

如果從普通預(yù)警至4級(jí)(臨界狀態(tài))預(yù)警，駕駛員一直未進(jìn)行干預(yù)，此時(shí)控制系統(tǒng)將主動(dòng)接管人車共駕智能汽車進(jìn)行側(cè)向避障。人車共駕智能汽車在側(cè)向避障過(guò)程中，汽車狀態(tài)變化將引起汽車垂直載荷動(dòng)態(tài)變化，進(jìn)而引起汽車前后側(cè)偏剛度動(dòng)態(tài)變化，影響控制策略精準(zhǔn)控制。同時(shí)，人車共駕智能汽車在避障過(guò)程中可能存在外部干擾。因此，為了實(shí)現(xiàn)避障軌跡精準(zhǔn)跟蹤，設(shè)計(jì)了考慮參數(shù)動(dòng)態(tài)攝動(dòng)的側(cè)向避障魯棒控制策略。

3.1 汽車側(cè)向動(dòng)力學(xué)模型

為實(shí)現(xiàn)側(cè)向避障軌跡跟蹤，建立二自由度簡(jiǎn)化模型[20-21]，如圖4所示。其二自由度分別為側(cè)向運(yùn)動(dòng)和橫擺運(yùn)動(dòng)。側(cè)向運(yùn)動(dòng)由質(zhì)心側(cè)偏角表征，橫擺運(yùn)動(dòng)由橫擺角速度表征。

圖4 簡(jiǎn)化模型Fig. 4 Simple model

(17)

(18)

為了設(shè)計(jì)簡(jiǎn)化，設(shè)定前后輪輪距相等，假設(shè)前后輪的行駛條件相同，且左右輪的行駛條件也相同，則四輪汽車模型可化簡(jiǎn)為兩輪簡(jiǎn)化汽車模型，對(duì)應(yīng)的兩輪汽車的側(cè)向動(dòng)力學(xué)方程為

(19)

(20)

當(dāng)輪胎側(cè)偏角較小時(shí)，側(cè)向輪胎力可以線性近似地表示為

(21)

(22)

式中:Cf為前軸側(cè)偏剛度；Cr為后軸側(cè)偏剛度。

設(shè)車身側(cè)偏角和橫擺角速率為汽車模型的狀態(tài)變量，并假設(shè)對(duì)于前輪轉(zhuǎn)向角在汽車高速行駛時(shí)相對(duì)較小，結(jié)合小角近似，將式(21)(22)代入(19)(20)中，得到線性二自由度汽車模型，即

(23)

(24)

狀態(tài)空間表達(dá)式為

(25)

3.2 不確定性簡(jiǎn)化模型

為確保汽車側(cè)向避障精準(zhǔn)控制，設(shè)計(jì)了考慮參數(shù)動(dòng)態(tài)攝動(dòng)的H∞魯棒控制策略[20]。側(cè)向避障過(guò)程中，汽車前輪側(cè)偏剛度Cf和后輪側(cè)偏剛度Cr動(dòng)態(tài)變化，將影響路徑跟隨精準(zhǔn)控制。但其取值區(qū)間已知，動(dòng)態(tài)變化如式(26)。

(26)

將式(26)進(jìn)行上線性分式變換，可得到式(27)。

(27)

式中Mf，Mr為上線性分式變換的系數(shù)矩陣。

結(jié)合汽車二自由度狀態(tài)空間和汽車系統(tǒng)模型中攝動(dòng)參數(shù)對(duì)應(yīng)的上線性分時(shí)變換，可得到含有參數(shù)攝動(dòng)的汽車系統(tǒng)模型結(jié)構(gòu)，具體參考文獻(xiàn)[20]。Gmds表示動(dòng)力學(xué)標(biāo)稱模型，其輸入為[uf1,uf2,ur1,ur1,u1,u2]，輸出為[yf1,yf2,yr1,yr1,y1,y2]，狀態(tài)變量為[β,γ]，其狀態(tài)空間表達(dá)式為

(28)

汽車系統(tǒng)模型攝動(dòng)參數(shù)部分可由一個(gè)結(jié)構(gòu)固定參數(shù)未知的不確定對(duì)角矩陣[22]表示：

(29)

3.3 魯棒控制器設(shè)計(jì)

鑒于魯棒穩(wěn)定性，閉環(huán)系統(tǒng)對(duì)于所有的G=Fu(G0,Δ)都必須滿足性能準(zhǔn)則，即為S/KS混合靈敏度問(wèn)題[20,22]。

(30)

式中：G=Fu(G0,Δ)為汽車系統(tǒng)模型，其包含標(biāo)稱模型和攝動(dòng)參數(shù)的不確定性；靈敏度權(quán)值函數(shù)Wp代表了干擾的頻率特性，反映了對(duì)系統(tǒng)靈敏度函數(shù)的形狀要求，使其具有低頻高增益特性；控制權(quán)值函數(shù)Wu可以限制控制量；S被定義為靈敏度函數(shù)。閉環(huán)系統(tǒng)結(jié)構(gòu)如圖5所示。

圖5 閉環(huán)系統(tǒng)關(guān)聯(lián)結(jié)構(gòu)圖Fig. 5 Association structure of the closed loop system

(31)

(32)

從d到e=[epeu]T的閉環(huán)傳遞函數(shù)：

(33)

因此，式(33)混合靈敏度問(wèn)題即可轉(zhuǎn)化為H∞標(biāo)準(zhǔn)控制問(wèn)題，即：

‖F(xiàn)l(P,K)‖∞<1。

(34)

4 仿真分析

為驗(yàn)證基于碰撞預(yù)警的智能汽車側(cè)向避障控制策略，搭建Carsim與Simulink聯(lián)合仿真平臺(tái)。根據(jù)駕駛員預(yù)警后的反應(yīng)，設(shè)計(jì)了2個(gè)測(cè)試工況。工況1，預(yù)警后，駕駛員及時(shí)干預(yù)；工況2，預(yù)警后，駕駛員未干預(yù)，控制策略主動(dòng)側(cè)向避障控制。通過(guò)此2個(gè)工況，能夠測(cè)試人車共駕狀態(tài)下，預(yù)警算法預(yù)警效果；以及預(yù)警達(dá)到4級(jí)(臨界狀態(tài))預(yù)警狀態(tài)而駕駛員未干預(yù)時(shí)，驗(yàn)證控制策略自行側(cè)向避障控制效果。人車共駕智能汽車基本參數(shù)如表2所示。

表2 汽車模型參數(shù)

4.1 駕駛員干預(yù)

工況設(shè)置：前車以vC0=65 km/h的初速度行駛，自車初始車速vNx0=80 km/h，兩車初始間距SC0=120 m，兩車道間距H=3.5 m，駕駛員反應(yīng)時(shí)間一般在0.4～1.0 s之間，考慮到不同駕駛員駕駛狀態(tài)存在差異，取1.0 s；克服踏板自由行程、制動(dòng)期間隙時(shí)間為0.2 s；轎車制動(dòng)系統(tǒng)一般都為液壓制動(dòng)系統(tǒng)，則液壓系統(tǒng)起作用時(shí)間為0.3 s，路面附著系數(shù)最大值為0.7。為了驗(yàn)證動(dòng)態(tài)條件下有無(wú)駕駛員干預(yù)的預(yù)警效果，進(jìn)行了無(wú)駕駛員和有駕駛員干預(yù)的兩種模式仿真實(shí)驗(yàn)，驗(yàn)證結(jié)果如圖6所示。

圖6 駕駛員干預(yù)的自車預(yù)警響應(yīng)圖Fig. 6 Warning response with driver intervention

由圖6(a)(b)可知,前車加速度和速度動(dòng)態(tài)變化，有利于驗(yàn)證預(yù)警算法的動(dòng)態(tài)預(yù)警能力。由6(c)(e)可知，每個(gè)預(yù)警級(jí)別參考值隨著前車和后車加速度和速度變化而變化，因此，預(yù)警算法能夠根據(jù)外界條件變化來(lái)實(shí)時(shí)決定不同預(yù)警層次的參考值，為人車共駕智能車精準(zhǔn)預(yù)警和安全提供必要基礎(chǔ)。由圖6(c)(d)可知，實(shí)時(shí)間距和碰撞時(shí)距隨著前車和自車狀態(tài)動(dòng)態(tài)變化而變化，且各自實(shí)時(shí)預(yù)警級(jí)別參考值形成交點(diǎn)，獲得了提醒報(bào)警點(diǎn)、危險(xiǎn)報(bào)警點(diǎn)和臨界點(diǎn)預(yù)警狀態(tài)。圖6(e)(f)為駕駛員根據(jù)報(bào)警主動(dòng)采取了干預(yù)，進(jìn)行了制動(dòng)操作后預(yù)警變化結(jié)果。由此兩圖可知，駕駛員采取行動(dòng)后，危險(xiǎn)報(bào)警點(diǎn)和臨界點(diǎn)時(shí)間都會(huì)延后；并且駕駛員持續(xù)制動(dòng)，汽車報(bào)警結(jié)果動(dòng)態(tài)變化甚至解除報(bào)警。因此，融合互補(bǔ)的多級(jí)預(yù)警算法能夠根據(jù)駕駛員動(dòng)態(tài)介入，動(dòng)態(tài)調(diào)整預(yù)警結(jié)果；并且，兩種預(yù)警方式不同安全級(jí)別的報(bào)警時(shí)間不同，預(yù)警結(jié)果以兩種預(yù)警方式早觸發(fā)的為預(yù)警依據(jù)，有利于提高預(yù)警提前性，為駕駛員干預(yù)或者控制器控制獲得更多控制時(shí)間。有無(wú)駕駛員干預(yù)的預(yù)警結(jié)果見(jiàn)圖6(g)(h)。

4.2 駕駛員未干預(yù)

在實(shí)際交通環(huán)境下，由于駕駛員疲勞或者工況危險(xiǎn)等原因，當(dāng)汽車進(jìn)入危險(xiǎn)工況，駕駛員未對(duì)汽車進(jìn)行干預(yù)，汽車將發(fā)生碰撞事故。針對(duì)此工況，所提控制策略在預(yù)警后，駕駛員未做出反應(yīng)到達(dá)4級(jí)(臨界狀態(tài))預(yù)警狀態(tài)，將主動(dòng)接管汽車進(jìn)行主動(dòng)側(cè)向避障控制，保證智能汽車安全。測(cè)試工況展現(xiàn)了從開(kāi)始檢測(cè)到前方存在危險(xiǎn)汽車，到最終實(shí)現(xiàn)智能汽車側(cè)向安全避障全過(guò)程，仿真結(jié)果如圖7。

圖7 側(cè)向避障控制仿真結(jié)果Fig. 7 Simulation results of lateral collision avoidance

由圖7(a)(b)可知，前車加速度和速度動(dòng)態(tài)變化，有利于驗(yàn)證動(dòng)態(tài)工況多級(jí)預(yù)警算法預(yù)警準(zhǔn)確性。由圖7(c)(d)可知，隨著前車速度急劇降低，多級(jí)預(yù)警算法先后實(shí)現(xiàn)了各種級(jí)別的預(yù)警。同時(shí)對(duì)比圖6(c)(d)和圖7(c)(d)上述兩工況的預(yù)警方式，安全距離和碰撞時(shí)間預(yù)警時(shí)間節(jié)點(diǎn)接近，但不同行駛狀態(tài)下，兩種預(yù)警方式在同安全等級(jí)下預(yù)警時(shí)間互有早晚。因此，通過(guò)采用時(shí)間早的節(jié)點(diǎn)能夠互補(bǔ)兩種預(yù)警算法，更好地確保在不同行駛狀態(tài)預(yù)警準(zhǔn)確性，有效提高了人車共駕智能汽車避障安全性。融合互補(bǔ)的多級(jí)預(yù)警算法的預(yù)警結(jié)果見(jiàn)圖7(k)。

當(dāng)4級(jí)(臨界狀態(tài))觸發(fā)后，避障系統(tǒng)主動(dòng)接管了汽車，進(jìn)行規(guī)劃軌跡跟蹤控制，實(shí)現(xiàn)智能汽車側(cè)向避障控制。由圖7(e)(f)(g)(h)(i)可知，控制策略實(shí)現(xiàn)了位移、航向角和航向角速度良好跟蹤。經(jīng)過(guò)計(jì)算可知，側(cè)向位移最大偏差量為0.077 m，最大誤差率為2.2%；航向角峰值誤差為0.26°，峰值誤差率為7.5%；航向角速度峰值誤差為0.05°/s，峰值誤差率為2.2%。由圖7(j)可知，航向角速度變化平穩(wěn)，并且值在正負(fù)2.27°/s范圍內(nèi)。因此，魯棒控制策略能夠保證避障過(guò)程中人車共駕智能車橫擺穩(wěn)定性。

綜上所述，所提融合互補(bǔ)的多級(jí)預(yù)警算法能夠根據(jù)外界狀態(tài)的變化，實(shí)時(shí)調(diào)整各種級(jí)別的安全預(yù)警距離，為人車共駕智能車準(zhǔn)確預(yù)警提供基礎(chǔ)；同時(shí)，彌補(bǔ)了實(shí)時(shí)間距和碰撞時(shí)距兩種方式不足，既能夠體現(xiàn)距離變化又能夠表示危險(xiǎn)程度；并且能夠根據(jù)駕駛員干預(yù)程度，實(shí)時(shí)修正預(yù)警結(jié)果。人車共駕智能車預(yù)警到四級(jí)(臨界狀態(tài))且駕駛員未干預(yù)汽車，控制策略自動(dòng)接管了智能車，并克服了前后側(cè)偏剛度參數(shù)攝動(dòng)，實(shí)現(xiàn)了側(cè)向避障控制且確保了智能車橫擺穩(wěn)定性。

5 結(jié) 論

1)針對(duì)前車和人車共駕智能車速度和加速度動(dòng)態(tài)變化，考慮了駕駛員駕駛狀態(tài)等因素，提出了汽車縱向安全距離模型。

2)提出了基于縱向安全距離模型和避障時(shí)間融合互補(bǔ)的多級(jí)預(yù)警算法，實(shí)現(xiàn)了既保證汽車避障安全，又能夠體現(xiàn)智能汽車危險(xiǎn)狀態(tài)。此預(yù)警算法實(shí)現(xiàn)了動(dòng)態(tài)環(huán)境下各級(jí)預(yù)警，應(yīng)對(duì)了預(yù)警過(guò)程中駕駛員干預(yù)，獲得了多因素影響下實(shí)時(shí)準(zhǔn)確的預(yù)警，為人車共駕智能車安全控制奠定了基礎(chǔ)。人車共駕智能車到達(dá)4級(jí)(臨界狀態(tài))且駕駛員未干預(yù)汽車，所提控制策略主動(dòng)接管了汽車進(jìn)行側(cè)向避障，確保了汽車安全避障。

3)考慮了側(cè)向避障過(guò)程中參數(shù)動(dòng)態(tài)攝動(dòng)，設(shè)計(jì)側(cè)向避障魯棒控制器，實(shí)現(xiàn)了避障軌跡準(zhǔn)確跟蹤，從而實(shí)現(xiàn)了智能汽車側(cè)向避障，并保證了避障過(guò)程智能汽車安全性和穩(wěn)定性。