宋曉琳+熊琦瑋+曹昊天

摘 要：針對(duì)已有的車輛碰撞預(yù)警系統(tǒng)中車輛軌跡預(yù)測(cè)的誤差較大問題，提出了一種基于DGPS和車載傳感器的車輛軌跡預(yù)測(cè)方法，并采用擴(kuò)展卡爾曼濾波，實(shí)現(xiàn)車輛位置的實(shí)時(shí)估計(jì)；提出了基于等加速度變化率、等橫擺角加速度模型的車輛位置預(yù)測(cè)改進(jìn)模型和基于V2X技術(shù)的協(xié)同碰撞預(yù)警系統(tǒng)（CCWS）；在此基礎(chǔ)上，采用模糊理論，實(shí)現(xiàn)縱向控制仿真試驗(yàn)，以驗(yàn)證預(yù)測(cè)模型的有效性.結(jié)果表明，基于等加速度變化率、等橫擺角加速度模型的車輛位置預(yù)測(cè)模型誤差更小，碰撞預(yù)警系統(tǒng)能更早的預(yù)警或主動(dòng)制動(dòng).

關(guān)鍵詞：縱向控制；軌跡預(yù)測(cè)；擴(kuò)展卡爾曼濾波；主動(dòng)安全；協(xié)同碰撞預(yù)警系統(tǒng)

中圖分類號(hào)：U461.91 文獻(xiàn)標(biāo)識(shí)碼：A

文章編號(hào)：1674-2974（2016）10-0001-07

Abstract：Aiming at the problem that the trajectory prediction error in existing vehicle collision warning system（CWS） is relatively large， a DGPS and other vehicle sensors based vehicle trajectory prediction was proposed. Real time vehicle position estimate was realized by using extended Kalman filter （EKF）. Then， constant rate of acceleration change， constant yaw rate acceleration model for vehicle position prediction and V2X technology based cooperative collision warning system（CCWS） were proposed. Based on this， the longitudinal control simulation was realized by using fuzzy theory to validate the method. The simulation results show that the vehicle position prediction model based on constant rate of acceleration change， constant yaw rate acceleration model has lower error， and zCWS can get warnings or brake earlier.

Key words：longitudinal control；trajectory prediction；extended Kalman filter（EKF）；active safety technology；cooperative collision warning system（CCWS）

隨著汽車交通運(yùn)輸?shù)难杆侔l(fā)展，車輛碰撞事故數(shù)量居高不下，僅2012年全國共發(fā)生汽車交通事故142 995起，造成44 679人死亡[1].為此國內(nèi)外許多專家學(xué)者開展了一系列研究，以減少事故的發(fā)生，車輛碰撞預(yù)警系統(tǒng)（CWS）便是有效方法之一.

CWS或車道偏離預(yù)警等主動(dòng)安全系統(tǒng)需要對(duì)車輛位置或軌跡進(jìn)行預(yù)測(cè)，吳沫等將車輛速度和航向角設(shè)為定值，進(jìn)行車輛跑偏檢測(cè)[2-3]；文獻(xiàn)[4]將車速設(shè)為定值，提出了車輛追尾報(bào)警算法.這些研究將車輛縱向速度和航向角或縱向加速度和橫擺角速度設(shè)為恒定值，仍存在一定誤差，導(dǎo)致預(yù)警信息不可靠，預(yù)測(cè)精度有待進(jìn)一步提高.隨著通信技術(shù)的發(fā)展，V2X技術(shù)開始受到關(guān)注，其感知范圍相對(duì)視覺傳感器、雷達(dá)等自主傳感器更廣[5-8]，可通過基站或其他車輛采用特定的通信方式得到環(huán)境信息，雖然車輛的快速移動(dòng)和網(wǎng)絡(luò)拓?fù)浣Y(jié)構(gòu)的快速變化給網(wǎng)絡(luò)體系結(jié)構(gòu)以及相關(guān)協(xié)議的設(shè)計(jì)帶來了嚴(yán)峻挑戰(zhàn)，但其仍廣泛應(yīng)用于車輛主動(dòng)安全系統(tǒng)中.謝伯元等基于DGPS和車路協(xié)同建立了二次卡爾曼濾波器，對(duì)車輛質(zhì)心側(cè)偏角進(jìn)行了估計(jì)[9].田晶晶等基于車路協(xié)同建立了動(dòng)態(tài)車輛安全狀態(tài)評(píng)價(jià)模型[10].文獻(xiàn)[11]基于多車協(xié)作進(jìn)行了車輛檢測(cè)和危險(xiǎn)預(yù)警.另外，隨著定位技術(shù)的不斷發(fā)展，差分全球定位系統(tǒng)（DGPS）已被廣泛地應(yīng)用于車輛定位，而差分技術(shù)中，載波相位差分技術(shù)（RTK，real time kinematic），可達(dá)到厘米級(jí)的高精度，在智能車輛領(lǐng)域得到了廣泛應(yīng)用[12-14].

但已有的許多研究中[2-4]，忽略了車速的變化和車輛的橫向運(yùn)動(dòng)，車輛模型簡化為等加速度等橫擺角速度模型，這與實(shí)際不符.為此，本文改進(jìn)車輛軌跡預(yù)測(cè)方法：該方法采用擴(kuò)展卡爾曼濾波進(jìn)行車輛狀態(tài)估計(jì)，基于改進(jìn)的等加速度變化率和等橫擺角加速度模型，進(jìn)行車輛位置預(yù)測(cè).同時(shí)，為了驗(yàn)證預(yù)測(cè)模型，設(shè)計(jì)協(xié)同碰撞預(yù)警機(jī)制和縱向模糊控制器，并采用直線減速和彎道兩種行駛工況仿真試驗(yàn)進(jìn)行驗(yàn)證.

1 傳感器數(shù)據(jù)的獲取

為了描述車輛的運(yùn)動(dòng)，需要獲取相應(yīng)的傳感器數(shù)據(jù)，包括描述車輛縱向和橫向運(yùn)動(dòng)的傳感器數(shù)據(jù)和車輛坐標(biāo)、航向角.

縱向運(yùn)動(dòng)：

對(duì)于縱向運(yùn)動(dòng)，傳感器數(shù)據(jù)包括節(jié)氣門開度、制動(dòng)壓力、車速和縱向加速度.若使用節(jié)氣門開度和制動(dòng)壓力，則需要車輛制動(dòng)系統(tǒng)、發(fā)動(dòng)機(jī)和車輛的縱向動(dòng)力學(xué)模型，這將極大地增加系統(tǒng)的復(fù)雜度，且難以保證預(yù)測(cè)的高精度.而縱向速度和縱向加速度能直接反映車輛的縱向運(yùn)動(dòng)，且較易于獲得，因此選擇速度和加速度來描述車輛的縱向運(yùn)動(dòng).

橫向運(yùn)動(dòng)：

方向盤轉(zhuǎn)角和橫擺角速度可描述車輛的橫向運(yùn)動(dòng).但使用方向盤轉(zhuǎn)角則需要特定的車輛橫向動(dòng)力學(xué)模型，而橫擺角速度可用低成本MEMS模塊測(cè)得，且精度較高，故選擇橫擺角速度描述車輛橫向運(yùn)動(dòng).

另外，車輛位置預(yù)測(cè)時(shí)還需要車輛在大地坐標(biāo)中的絕對(duì)信息，本文研究車輛通過DGPS獲得車輛坐標(biāo)和航向角.

仿真時(shí)，對(duì)真實(shí)值加入均值為0的白噪聲，加入噪聲，綜合考慮系統(tǒng)成本和精度要求，DGPS定位誤差標(biāo)準(zhǔn)差設(shè)為0.6 m，車速誤差標(biāo)準(zhǔn)差0.5 m/s，航向角誤差標(biāo)準(zhǔn)差1°，加速度誤差標(biāo)準(zhǔn)差0.5%，橫擺角速度誤差標(biāo)準(zhǔn)差0.1°/s.

2 車輛狀態(tài)的估計(jì)

為了獲得更加準(zhǔn)確可信的車輛狀態(tài)信息，需要對(duì)傳感器數(shù)據(jù)進(jìn)行濾波估計(jì)，本文采用擴(kuò)展卡爾曼濾波（EKF）進(jìn)行車輛狀態(tài)估計(jì).該方法分兩步：1）時(shí)間更新.使用上一時(shí)刻狀態(tài)的估計(jì)值進(jìn)行當(dāng)前時(shí)刻狀態(tài)的預(yù)測(cè)；2）觀測(cè)更新.在得到當(dāng)前狀態(tài)的測(cè)量值后可對(duì)步驟1）中得到的預(yù)測(cè)值進(jìn)行修正得到當(dāng)前時(shí)刻更加精確的估計(jì)值.與經(jīng)典卡爾曼濾波相比，它能將非線性函數(shù)進(jìn)行Taylor展開并忽略二階及以上高階項(xiàng)，將模型線性化從而應(yīng)用于非線性模型[15-16].

由此可對(duì)系統(tǒng)的6個(gè)狀態(tài)變量進(jìn)行估計(jì)，減小噪聲的影響，保證后續(xù)車輛位置預(yù)測(cè)的高精度.經(jīng)過濾波后的車輛定位和車速誤差如圖1，圖2所示，傳感器測(cè)量誤差與估計(jì)誤差比較如表1所示，從圖和表可知，經(jīng)擴(kuò)展卡爾曼濾波估計(jì)后，誤差大大降低.

3 車輛位置的預(yù)測(cè)

在已有的許多研究中，車輛模型簡化為等加速度等橫擺角速度模型，如式（2）所示，也有采用更簡單的等速等航向角模型，如式（9）所示：

為了更加準(zhǔn)確地描述駕駛員的駕駛行為，提高預(yù)測(cè)精度，本文提出了車輛位置預(yù)測(cè)模型，該模型在式（2）的基礎(chǔ)上，引入縱向加速度變化率和橫擺角加速度，兩者通過測(cè)量的縱向加速度和橫擺角速度計(jì)算得出.故車輛位置預(yù)測(cè)模型為等加速度變化率和等橫擺角加速度模型，預(yù)測(cè)方程為：

預(yù)測(cè)時(shí)，每經(jīng)過ΔT，車輛對(duì)自身進(jìn)行狀態(tài)估計(jì)，得到估計(jì)的位置和傳感器數(shù)據(jù)后，將式（9）重復(fù)計(jì)算N次，即可得到NΔT后的車輛位置.本文N取50，即得到2.5 s后的車輛位置.

本文基于PRESCAN軟件環(huán)境，完成了直線加速和彎道兩種場(chǎng)景的仿真試驗(yàn).數(shù)據(jù)由PRESCAN軟件的虛擬傳感器得到，加入噪聲后進(jìn)行狀態(tài)估計(jì)和位置預(yù)測(cè).

1）直線場(chǎng)景.車輛起步經(jīng)兩次加速至15 m/s.

由圖3可知，等速模型由于忽略了車速的變化，在車輛進(jìn)行加速時(shí)產(chǎn)生了較大的預(yù)測(cè)誤差，而等加速度模型的誤差則相對(duì)較小，但在車輛開始加速和結(jié)束加速時(shí)均產(chǎn)生了一個(gè)滯后的誤差，這是由于車輛開始加速時(shí)加速度逐漸增大，結(jié)束加速時(shí)加速度逐漸減小所致，但等加速度變化率模型則克服了這一不足，整體誤差均較小.

2）彎道場(chǎng)景.車輛勻速入彎及出彎，車速為10 m/s，彎道半徑40 m，車輛路徑如圖4所示.

由圖5可知，車輛約于15 s時(shí)進(jìn)入彎道，約30 s時(shí)離開彎道，由于忽略了車輛的橫向運(yùn)動(dòng)，等航向角模型在車輛處于整個(gè)彎道時(shí)產(chǎn)生了較大的預(yù)測(cè)誤差，而等橫擺角速度模型和本文的等橫擺角加速度模型只在車輛入彎和出彎時(shí)產(chǎn)生了誤差，且等橫擺角加速度模型的誤差更小.

4 協(xié)同碰撞預(yù)警

本車通過V2X接收到其他車輛的狀態(tài)估計(jì)后，通過預(yù)警算法計(jì)算是否有碰撞的危險(xiǎn).協(xié)同碰撞預(yù)警系統(tǒng)框架如圖6所示.本研究危險(xiǎn)指標(biāo)選用碰撞時(shí)間TTC（time to collision）.一般情況下，駕駛員正常跟車、開始制動(dòng)和最危險(xiǎn)時(shí)的TTC值分別為2.9 s，2.0 s和1.0 s[17].由于駕駛員得到預(yù)警信息后存在反應(yīng)時(shí)間，故TTC預(yù)警閾值需大于2.0 s.為了分析預(yù)測(cè)時(shí)間對(duì)預(yù)測(cè)效果的影響，分別選取預(yù)測(cè)時(shí)間2.1 s，2.5 s和2.9 s，采用等加速度變化率模型對(duì)直線加速場(chǎng)景進(jìn)行仿真研究.預(yù)測(cè)誤差隨預(yù)測(cè)時(shí)間的變化如圖7所示，預(yù)測(cè)時(shí)間為2.9 s時(shí)誤差較大，其最大值約為7.9m，故不可取；預(yù)測(cè)時(shí)間為2.1 s和2.5 s的誤差均較小，由于駕駛員反應(yīng)時(shí)間和制動(dòng)系統(tǒng)反應(yīng)時(shí)間的存在，本研究選擇TTC預(yù)警閾值為2.5 s.兩車碰撞定義為兩車相對(duì)距離小于2.5 m，故2.5 s后兩車相對(duì)距離小于2.5 m時(shí)即觸發(fā)預(yù)警.

為了模擬城市道路工況，研究設(shè)置了直線前后碰撞場(chǎng)景和交叉路口碰撞兩種場(chǎng)景.本文比較各方法觸發(fā)預(yù)警的時(shí)間，即預(yù)測(cè)到兩車2.5 s后相對(duì)距離小于2.5 m的時(shí)間.預(yù)測(cè)2.5 s后兩車相對(duì)距離曲線下降到2.5 m時(shí)即為觸發(fā)預(yù)警時(shí)間，理想觸發(fā)預(yù)警時(shí)間為實(shí)際發(fā)生碰撞前2.5 s.

1）直線碰撞場(chǎng)景.假設(shè)前后兩輛車距離20 m直線行駛，車速為20 m/s，前車突然發(fā)生故障并開始減速，后車進(jìn)行碰撞預(yù)警，如圖8所示.

由圖9可知，在直線碰撞場(chǎng)景中，理想的觸發(fā)預(yù)警時(shí)間為第3.5 s，等加速度變化率模型、等加速度模型和等速模型的觸發(fā)預(yù)警時(shí)間分別為第3.6 s，第4.0 s和第4.5 s.

2）交叉路口碰撞場(chǎng)景.假設(shè)主車直線行駛穿過交叉口，另有一輛車從交叉口右側(cè)進(jìn)入交叉口并左轉(zhuǎn)，假設(shè)兩車在交叉口發(fā)生碰撞，主車速度9 m/s，障礙車速度10 m/s，如圖10所示.

由圖11可知，在交叉口碰撞場(chǎng)景中，理想的觸發(fā)預(yù)警時(shí)間為第4.62 s，等橫擺角加速度模型、等橫擺角速度模型和等航向角模型的觸發(fā)預(yù)警時(shí)間分別為第4.72 s，第4.80 s和第4.88 s.

圖9和圖11的仿真結(jié)果顯示：等加速度變化率模型與等橫擺角加速度模型均比其他模型提前預(yù)警，更加接近理想預(yù)警的時(shí)間，可留給駕駛員或主動(dòng)制動(dòng)系統(tǒng)更多的時(shí)間來采取機(jī)動(dòng)措施，從而更有效地降低碰撞風(fēng)險(xiǎn).

為了進(jìn)一步對(duì)預(yù)警模型進(jìn)行驗(yàn)證，本文設(shè)計(jì)了模糊控制器，對(duì)車輛進(jìn)行縱向控制，在觸發(fā)預(yù)警即TTC值低于2.5 s時(shí)進(jìn)行制動(dòng)控制.模糊控制器的輸入為TTC和兩車速度差Δv，輸出為節(jié)氣門開度和制動(dòng)主缸壓強(qiáng).由于兩車的航向角可能不同，Δv由式（11）計(jì)算：

同樣選用直線前后碰撞場(chǎng)景和交叉路口碰撞兩種場(chǎng)景進(jìn)行了縱向控制仿真，仿真采用不同的預(yù)測(cè)模型和相同的控制策略.

1）直線碰撞場(chǎng)景.仿真結(jié)果如圖12，圖13所示，采用等速模型的車輛不能及時(shí)進(jìn)行制動(dòng)，導(dǎo)致兩車發(fā)生碰撞；采用等加速度模型和等加速度變化率模型的車輛均能使車輛安全停車，但后者能更早地進(jìn)行制動(dòng)，兩車最終距離相對(duì)前者更加安全.

2）交叉路口碰撞場(chǎng)景.仿真結(jié)果如圖14，圖15所示，采用等橫擺角加速度模型的車輛相對(duì)于采用等航向角和等橫擺角速度模型的車輛更早地進(jìn)行制動(dòng)，兩車的最近距離也最大，發(fā)生碰撞的可能性更小.

綜上所述，在同樣的控制策略下，采用等加速度變化率模型和等橫擺角加速度模型的車輛比采用其他模型的車輛能夠更早地進(jìn)行制動(dòng)，兩車的最近距離最大，也即碰撞可能性更小.

5 結(jié) 論

利用擴(kuò)展卡爾曼濾波對(duì)車輛狀態(tài)進(jìn)行了濾波估計(jì)，提出了等加速度變化率和等橫擺角加速度的車輛位置預(yù)測(cè)模型，并基于該預(yù)測(cè)模型提出了車輛協(xié)同碰撞預(yù)警機(jī)制.仿真結(jié)果表明：該預(yù)測(cè)模型誤差較小，應(yīng)用該預(yù)測(cè)模型方法可更早地進(jìn)行碰撞預(yù)警及主動(dòng)制動(dòng).

參考文獻(xiàn)

[1] 中華人民共和國國家統(tǒng)計(jì)局. 中國統(tǒng)計(jì)年鑒（2013年）. 交通事故統(tǒng)計(jì)情況（2012年）[DB/OL].[2013-09-22]. http：//www.stats.gov.cn/tjsj/ndsj/2013/indexch.htm.

National Bureau of Statistics of the People's Republic of China. China Statistical Yearbook（2013）. Traffic accidents statistics（2012）[DB/OL].[2013-09-22].http：//www.stats.gov.cn/tjsj/ndsj/2013/indexch.htm. （In Chinese）

[2] 吳沫， 安向京， 賀漢根. 基于視覺的車道跑偏檢測(cè)方法研究及仿真[J]. 中國圖像圖形學(xué)報(bào)， 2007， 12（1）： 110-115.

WU Mo， AN Xiang-jing， HE Han-gen. On vision-based lane departure detection approach[J]. Journal of Image and Graphics， 2007， 12（1）： 110-115.（In Chinese）

[3] 肖獻(xiàn)強(qiáng)， 王其東， 潘盛輝. 基于視覺及 TLC 概念的車輛跑偏檢測(cè)方法研究[J]. 汽車工程， 2010， 32（1）： 77-80.

XIAO Xian-qiang， WANG Qi-dong， PAN Sheng-hui. A study on lane departure detection method based on vision and TLC concept[J]. Automotive Engineering， 2010， 32（1）： 77-80. （In Chinese）

[4] 王建強(qiáng)， 遲瑞娟， 張磊， 等. 適應(yīng)駕駛員特性的汽車追尾報(bào)警-避撞算法研究[J]. 公路交通科技， 2009， 26（S1）： 7-12.

WANG Jian-qiang， CHI Rui-juan， ZHANG Lei， et al. Study on forward collision warning-avoidance algorithm based on driver characteristics adaptation[J]. Journal of Highway and Transportation Research and Development， 2009， 26（S1）： 7-12. （In Chinese）

[5] ARINO M. ITS policy in Japan and smartway[R].Tokyo：ITS Policy and Program Office， 2007： 1-14.

[6] 王龐偉， 余貴珍， 王云鵬， 等. 基于滑模控制的車車協(xié)同主動(dòng)避撞算法[J]. 北京航空航天大學(xué)學(xué)報(bào)， 2014， 40（2）： 268-273.

WANG Pang-wei， YU Gui-zhen， WANG Yun-peng， et al. Cooperative active collision avoidance algorithm based onsliding mode control[J]. Journal of Beijing University of Aeronautics and Astronautics， 2014， 40（2）： 268-273. （In Chinese）

[7] 常促宇， 向勇， 史美林. 車載自組網(wǎng)的現(xiàn)狀與發(fā)展[J]. 通信學(xué)報(bào)， 2008， 28（11）： 116-126.

CHANG Cu-yu， XIANG Yong， SHI Mei-lin. Development and status of vehicular ad hoc networks[J]. Journal on Communications， 2008， 28（11）： 116-126. （In Chinese）

[8] CAVENEY D. Cooperative vehicular safety applications[J]. Control Systems， IEEE， 2010， 30（4）： 38-53.

[9] 謝伯元， 王建強(qiáng)， 秦曉輝， 等. 基于車路協(xié)同的車輛狀態(tài)估計(jì)方法[J]. 汽車工程， 2014， 36（8）： 968-973.