汪 ,嚴明月,張佳佳,吳樹凡,張鳳嬌,魏民祥
(1.南京航空航天大學, 南京 210016; 2.常州工學院, 江蘇 常州 213002)
自動駕駛汽車利用信息感知和控制技術來提高駕駛安全性和交通效率。近年來對自動駕駛汽車主動安全的研究越來越受到關注[1]。自動駕駛汽車研究在實際道路測試時須自動對緊急情況作出反應,主動介入接管車輛完成避撞操作[2]。因此,在不能及時操控汽車時,汽車能完全代替“人”的駕駛是降低車禍發(fā)生率、避免汽車與障礙物相撞的最好手段。但是,目前無人駕駛技術遠遠沒有成熟,汽車仍需要“人”來駕駛,因此現(xiàn)階段國內(nèi)外科研人員多致力于汽車部分智能化的開發(fā),尤其是汽車主動避撞系統(tǒng)成為研究熱點[3]。按照避撞的模式可進行如下分類:縱向制動避撞系統(tǒng)[4-5],主要是對車輛進行縱向制動控制以達到避免碰撞的目的;轉向換道避撞系統(tǒng)[6],能自動控制車輛轉向或避開障礙物和車輛,避免車輛發(fā)生側面碰撞;復合型智能避撞系統(tǒng)[7],是指先進行自動控制轉向試圖避開障礙物,如果車輛不滿足實施轉向的要求,系統(tǒng)再進行自動制動。針對主動避撞有基于智能輪胎的主動避撞策略[8]、基于附著系數(shù)和駕駛意圖的縱向避撞控制策略[9]。廉宇峰[10]針對四輪獨立驅動輪轂電機電動汽車,研究了車輛在制動與轉向兩種避撞方式下主動避撞系統(tǒng)的狀態(tài)估計與控制策略。李霖等[11]結合駕駛員避撞行為特征和車輛動力學特性的主動避撞,引入不同的TTC,提出了符合實際的換道預警避免碰撞等[12]一系列控制策略。但這些控制策略大多沒有考慮路面附著系數(shù)變化對避撞控制的影響,或即使考慮了路面附著系數(shù)對駕駛行為的影響,也沒有考慮路面發(fā)生突變情況下應如何控制避撞。
針對現(xiàn)有主動避撞控制系統(tǒng)的缺陷,本文設計了一種基于路面實時識別的自適應主動避撞系統(tǒng)。首先基于RLS對路面進行在線識別,根據(jù)路面信息實時更新安全距離模型,依據(jù)GPS、雷達等傳感器的輸入信息設計自適應避撞控制策略,保證車輛在傳統(tǒng)避撞控制策略失效的情況下依然能安全穩(wěn)定地避開障礙物,從而提高車輛的安全性能。
本文根據(jù)魔術輪胎[13]模型,依據(jù)輪胎的縱向力與滑移率的關系,利用遞推最小二乘法對路面附著系數(shù)進行實時估計。
當車輛直線行駛時,對車輛有影響的縱向力包括輪胎縱向力、重力和空氣阻力,忽略空氣阻力,規(guī)定車輛只做縱向上的運動,沒有轉向行為,根據(jù)魔術輪胎模型和沿車輛行駛方向的縱向力平衡方程做出輪胎縱向力與滑移率曲線,如圖1所示。
圖1 輪胎工作區(qū)域
在線性區(qū)域內(nèi),輪胎縱向力與滑移率成正比,且比例系數(shù)與路面附著系數(shù)有關[14]。在飽和區(qū)域,輪胎縱向力基本不隨滑移率的變化而變化,而是與路面附著系數(shù)和法向載荷有關。在暫態(tài)區(qū)域,輪胎縱向力曲線不僅受路面附著系數(shù)的影響,而且受車輛狀態(tài)和路面材料的影響。在實際行車過程中,線性區(qū)域和非線性工況居多,故本文主要進行線性區(qū)域和飽和區(qū)域內(nèi)的路面附著系數(shù)估計。當車輛處于暫態(tài)過程時,估計算法不更新,保存上一時刻的路面附著系數(shù)的值。
1.2.1 線性區(qū)域內(nèi)路面附著系數(shù)估計過程
由于本文方法估計需要滑移率的存在,因此在車輛未發(fā)生危險工況前的正常駕駛過程中必然涉及加減速操縱,所以本文只在制動過程中進行路面附著系數(shù)的估計。僅考慮車輛的縱向運動,忽略輪胎側向力,則
(1)
μ=Ck(μ)+D
(2)
經(jīng)過大量仿真驗證可得:C=0.03,D=0.07。
1.2.2 線性區(qū)域路面附著系數(shù)估計仿真分析
在路面附著系數(shù)突變的路況下,施加較小制動壓力控制車輛減速,驗證線性區(qū)域內(nèi)路面附著系數(shù)估計方法的性能??v向速度曲線如圖2所示。車速的初始值為120 km/h,取初值θ(0)=22,協(xié)方差矩陣P(0)=1及遺忘因子ζ=0.99。
在圖3的輪胎滑移率曲線中可以明顯看到:滑移率曲線從高附著系數(shù)到低附著系數(shù)路面曲線出現(xiàn)明顯下降,從低附著系數(shù)路面到高附著系數(shù)路面滑移率明顯上升。在進行算法更新時取前5個時間間隔內(nèi)的平均值作為輸入進行均值濾波以避免估計算法失效。
圖2 縱向速度曲線
圖3 輪胎滑移率曲線
路面附著系數(shù)估計曲線的仿真結果如圖4所示,可見在整個過程中滑移率一直小于2%,一直處于線性范圍內(nèi)。由于采用線性函數(shù)映射,可以看到路面附著系數(shù)的估計曲線與滑移率曲線變化保持高度一致。估計曲線能及時跟蹤路面的變化,實時性良好。在估計開始階段,滑移率有一個下降趨勢但能很快跟蹤到真實值,算法的魯棒性較好。
圖4 路面附著系數(shù)估計曲線
1.3.1 飽和區(qū)域內(nèi)路面附著系數(shù)估計過程
在飽和區(qū)域內(nèi)即滑移率大于30%時,線性區(qū)域內(nèi)的估計算法將不再適用,車輪出現(xiàn)滑轉或抱死狀態(tài),此時縱向力達到飽和??v向力僅與路面附著系數(shù)和法向載荷有關,如圖1所示。當車輪滑移率大于30%時,輪胎縱向力出現(xiàn)飽和現(xiàn)象,由遞推最小二乘法標準形式可得:y(t)=Fx是系統(tǒng)的輸出;θ(t)=μ是系統(tǒng)的未知參數(shù);φ(t)=Fz是系統(tǒng)的輸入。
1.3.2 飽和區(qū)域路面附著系數(shù)估計仿真分析
在路面附著系數(shù)突變的路況下,施加較大制動壓力控制車輛減速,驗證線性區(qū)域內(nèi)路面附著系數(shù)估計方法的性能??v向速度曲線如圖5所示。車速的初始值為120 km/h,取初值θ(0)=0.8,協(xié)方差矩陣P(0)=1,遺忘因子ζ=0.98。
圖5 縱向速度曲線
在圖6的輪胎滑移率曲線中可以明顯看到:滑移率曲線從高附著系數(shù)到低附著系數(shù)路面,曲線出現(xiàn)明顯下降;從低附著系數(shù)路面到高附著系數(shù)路面,滑移率明顯上升。在剛開始階段雖然有較大制動力,但是由于地面附著系數(shù)高,能提供較大驅動力,滑移率處于較小值。在2~7 s內(nèi)由于路面附著系數(shù)突然減小,路面所能提供的最大驅動力大大減小,此時制動力遠遠大于驅動力,滑移率急劇增加到接近1,輪胎近乎處于抱死狀態(tài)。在7 s以后輪胎的滑移率又快速恢復到較小值。在進行算法更新時,取前5個時間間隔內(nèi)的平均值作為輸入進行均值濾波以避免估計算法失效。
由于此部分包含線性和非線性的特性,采用單一飽和區(qū)域的動力學公式進行估計存在較大誤差[15],故結合線性部分估計算法,將線性區(qū)域內(nèi)路面附著系數(shù)估計方法和飽和區(qū)域內(nèi)路面附著系數(shù)估計方法結合使用。當滑移率小于2%時采用前一種估計方法,當滑移率大于30%時采用后一種估計方法。路面附著系數(shù)估計的仿真結果如圖7所示。由圖7可見:在7 s前,估計算法能較好地跟蹤實際值變化;在7 s后,估計算法相對真實值跟蹤有一定的滯后,滯后時間為0.15 s左右。由于此時車輛速度不高,故存在的一定滯后對后續(xù)控制器實時控制影響很小。
圖6 滑移率曲線
圖7 路面附著系數(shù)估計曲線
由于處于高速緊急工況,駕駛員來不及控制車輛躲避撞礙物,而是直接由控制器控制避撞,故忽略駕駛員反應時間。由文獻[16]可知,縱向制動安全距離為
(3)
其中:t1為抵消制動盤和制動鉗間隙所用時間;t2為制動力增加至路面附著力所用時間;μ為路面附著系數(shù);g為重力加速度;vc為初始車速。
對式(3)分析可知:安全距離模型的影響因素有t1、t2、vc、μ。由于t1和t2時間較短,故影響安全距離模型的主要因素是vc和μ。根據(jù)式(3)做出初始車速、制動距離與路面附著系數(shù)關系的三維曲面,如圖8所示。由圖8可知:隨著初始車速vc的增加,路面附著系數(shù)對制動距離的影響急劇增大。因此,針對車輛行駛在高速公路上的緊急避撞問題,路面附著系數(shù)的估計顯得尤為重要。
圖8 初始車速、制動距離與路面附著系數(shù)關系
簡化的換道距離模型[17]如圖9所示,其中:ye為車輛換道完成后的側向位移,采用高速公路標準車道寬,為3.75 m;tc為預碰撞時刻;te為換道完成時間;xe(t)為車道換道的縱向位移;θ為車輛航向角。根據(jù)一元高次多項式[18]描述換道路徑。
(0≤t≤te)
(4)
te取值大小會直接影響車輛在換道時的最大側向加速度,直接關系到車輛的穩(wěn)定性。仿真試驗顯示本文換道時間為1.5 s。
圖9 汽車換道位置示意圖
本文提出的自適應避撞控制策略能根據(jù)車輛行駛過程中實際路面變化進行適應不同車速、不同路面情況下的主動避撞操作,提高了避撞的適應性。車輛行駛時通過激光雷達傳感器采集自車與前車的距離信息S,控制系統(tǒng)采用RLS算法估計所得的路面附著系數(shù)μ,根據(jù)安全距離模型得到基于當前路面條件的縱向安全距離SW。
若S=SW,自車與前車實際距離等于避撞安全距離,車輛通過制動操作進行主動避撞。避撞過程中車輛實時監(jiān)測車距和路面條件,通過估計算法估計當前路面附著系數(shù)與前一時刻路面附著系數(shù)之差Δμ??紤]到同種路面估計值波動,為避免避撞方式頻繁切換,取Δμ的絕對值大于0.3時為路面突變。
1) 若Δμ≥0.3,車輛避撞時路面附著條件變好,避撞距離增大,控制系統(tǒng)能實時判斷車輛避撞方式,監(jiān)測車輛安全狀態(tài)。
2) 若Δμ<-0.3,車輛避撞時路面附著條件變差,此時通過制動操作難以避免與前車發(fā)生碰撞,因此系統(tǒng)通過轉向進行主動避撞。
3) 若-0.3<Δμ<0.3,車輛路面波動不大,繼續(xù)采用制動避撞操作。
若S>SW,自車與前車實際距離大于避撞安全距離,自車正常行駛,并通過雷達傳感器實時檢測車距和估計實際路面變化。
4) 若Δμ≤-0.3,S 5) 若Δμ≤-0.3,S=Sw,道路附著條件變差,兩車實際距離等于制動安全距離,車輛采用制動避撞方式。 6) 若Δμ≤-0.3,S>Sw,道路附著條件變差,但實際車距仍然大于制動安全距離,車輛處于安全狀態(tài),車輛正常行駛,并實時監(jiān)測車輛安全狀態(tài)。 7) 若Δμ>-0.3,路面附著條件未變差,車輛處于安全狀態(tài),車輛正常行駛,通過雷達傳感器實時監(jiān)測車輛安全狀態(tài)。 若S 8) 若Δμ≥0.3,S>Sw,路面附著條件變好,兩車實際車距大于基于當前突變路面的制動安全距離,車輛處于安全狀態(tài),車輛正常行駛,并實時監(jiān)測車輛安全狀態(tài)。 9) 若Δμ≥0.3,S=Sw,路面附著條件變好,兩車實際車距等于基于當前突變路面的制動安全距離,車輛采用制動避撞方式。 10) 若Δμ≥0.3,S 11) 若Δμ<0.3,路面附著條件未變好,車輛采用轉向避撞方式。 車輛整體控制策略邏輯框圖如圖10所示。 圖10 控制策略邏輯框圖 轉向下層控制器是根據(jù)轉向逆動力學模型[19]求出期望的方向盤轉角為理想值,方向盤轉角傳感器測出實際轉角值,輸入給控制器,在控制器內(nèi)部與理想值進行比較,判斷偏差的正負值,決定執(zhí)行電機旋轉方向。控制器輸出信號控制執(zhí)行機構動作,持續(xù)調節(jié)以達到理想的跟蹤效果。 制動下層控制器是根據(jù)制動逆動力學模型[17]求出期望的制動壓力為理想值,制動壓力傳感器測出實際制動主缸壓力輸入給PID控制器,控制器控制制動電機方向和速度使得實際壓力跟蹤期望壓力值。轉向/制動下層控制器如圖11所示。 圖11 轉向/制動下層控制器 仿真工況設置為2類:① 安全距離以內(nèi)路面附著系數(shù)突變;② 自車進入安全距離前路面發(fā)生突變,安全距離以內(nèi)路面未突變。由于路面發(fā)生變化,安全距離也發(fā)生變化,此處的安全距離是基于當前未突變路面進行安全距離計算所得值,具體如圖12所示。 圖12 路面突變工況 在圖12中深色代表低附著系數(shù)路面,淺色代表高附著系數(shù)路面。圖12中的(a)和(b)表示安全距離以內(nèi)路面突變,(c)和(d)表示安全距離以內(nèi)路面沒有發(fā)生突變,路面突變發(fā)生在進入安全距離以前的路段。三維場景模型如圖13所示。 設置自車初始車速為100 km/h,障礙車初始車速為80 km/h,在仿真開始時,障礙車以最大制動減速度緊急制動。對于圖12(a)的工況1,在安全距離以內(nèi)路面附著系數(shù)變大,道路附著條件變好,系統(tǒng)實時判斷兩車實際車距等于制動安全距離,系統(tǒng)施加適應該路面的制動壓力進行主動避撞,仿真結果如圖14所示。傳統(tǒng)單一制動由于不能檢測路面變化,制動壓力不變。自適應控制檢測到路面附著系數(shù)變大有更大的地面制動力,故其停下制動距離比傳統(tǒng)單一制動距離小,這樣安全性能更高。 圖13 三維場景模型 圖14 工況1縱向位移時間曲線 對于圖12(b)的工況2,在安全距離以內(nèi)路面附著系數(shù)變小,通過制動不能有效避撞,當檢測路面附著系數(shù)變小時由原制動避撞方式切換為轉向避撞方式。仿真結果如圖15、16所示。 圖15、16中,曲線為汽車質心運動軌跡,曲線的起點代表該車的初始位置。黑色實線代表自適應控制的自車,灰色實線代表單一制動控制的自車,黑色虛線代表障礙車。初始時刻自車和障礙車相距29 m,單一制動控制的自車沒有路面識別能力,在整個避撞過程中無轉向操作。在圖15中,時間為6 s時單一控制自車與障礙車縱向距離曲線相交且在一條直線上,兩車發(fā)生相撞,單一制動避撞失效。自適應控制自車縱向距離曲線雖然也與障礙車相交,但由圖16可知:此時自車已換道,自車與障礙車不在同一車道,實現(xiàn)了有效避撞。 圖15 工況2縱向位移時間曲線 圖16 工況2 縱橫向位移曲線 對于圖12(c)的工況3,在安全距離內(nèi)路段的路面附著系數(shù)由低變高,道路附著條件變好,系統(tǒng)實時判斷兩車實際車距大于制動安全距離,車輛正常行駛,雷達系統(tǒng)實時監(jiān)測車輛安全狀態(tài)。當實際車距等于制動安全距離時,系統(tǒng)施加適應該路面的制動壓力進行主動避撞,結果如圖17所示。傳統(tǒng)單一制動由于不能檢測路面變化保持制動力不變,自適應控制檢測到路面附著系數(shù)變大,有更大的地面制動力,故其制動距離比傳統(tǒng)單一制動小,安全性能更高。 對于圖12(d)的工況4,在安全距離外路段路面附著系數(shù)由高變低,路面附著條件變差,系統(tǒng)實時判斷兩車實際車距小于制動安全距離,通過制動不能有效避撞,控制系統(tǒng)控制車輛由制動避撞方式切換為轉向避撞方式,結果如圖18、19所示。 圖17 工況3縱向位移時間曲線 圖18 工況4縱向位移時間曲線 圖19 工況4縱橫向位移曲線 初始時刻自車和障礙車相距124 m,傳統(tǒng)單一制動控制自車沒有路面識別能力,避撞過程保持制動力不變。在圖18中,時間為9.9 s時單一控制自車與障礙車縱向距離曲線相交且在一條直線上,表明兩車發(fā)生碰撞,傳統(tǒng)單一制動避撞失效。自適應控制時自車縱向距離曲線雖然也與障礙車相交,但由圖19可知此時自車已經(jīng)換道,自車與障礙車不在同一車道,實現(xiàn)了有效避撞。 將RLS路面估計算法與縱向安全距離結合,設計了一種適用于變附著系數(shù)路面的自適應緊急避撞控制策略。路面附著系數(shù)估計算法能實時進行路面辨識,建立適應實際路面的安全距離模型,避撞上層控制器根據(jù)實時路面附著條件變化自動決策適應不同工況的避撞方式。設計了基于PID的下層控制器,保證執(zhí)行機構能實時跟隨上層控制器的輸出以實現(xiàn)有效避撞。 虛擬實驗結果表明:該變附著系數(shù)路面的自適應緊急避撞控制策略可以很好地完成路面突變條件下傳統(tǒng)單一制動控制失效情況下的緊急避撞,控制策略具有較好的自適應性。 [1] GUO J,PING H,WANG R.Nonlinear Coordinated Stee-ring and Braking Control of Vision-Based Autonomous Vehicles in Emergency Obstacle Avoidance[J].IEEE Transactions on Intelligent Transportation Systems,2016,17(11):3230-3240. [2] FUNKE J,BROWN M,ERLIEN S M,et al.Collision Avoidance and Stabilization for Autonomous Vehicles in Emergency Scenarios[J].IEEE Transactions on Control Systems Technology,2016 (99):1-13. [3] 燕來榮.避撞技術為汽車保駕護航一路暢通[J].交通與運輸,2014(2):51-52. [4] 羅莉華.車輛自適應巡航系統(tǒng)的控制策略研究[M].上海:上海交通大學出版社,2013. [5] 侯德藻.汽車縱向主動避撞系統(tǒng)的研究[D].北京:清華大學,2004. [6] EIDEHALL A,POHL J,GUSTAFSSON F,et al.Toward Autonomous Collision Avoidance by Steering[J].IEEE Transactions on Intelligent Transportation Systems,2007,1(8):84-94. [7] BRANNSTROM M,COELINGH E,SJOBERG J.Threat Assessment for Avoiding Collisions with Turning Vehicles[C]//2009 IEEE Intelligent Vehicles Symposium.USA:IEEE,2009:663-668. [8] SINGH K,ARAT M,TAHERI S.Enhancement of Collision Mitigation Braking System Performance Through Real-Time Estimation of Tire-road Friction Coefficient by Means of Smart Tires[J].SAE Int.J.Passeng Cars-Electr-on Electr Syst,2012,5(2):607-624. [9] 李素華.采用dSPACE的電動汽車縱向主動避撞系統(tǒng)研究[J].機械設計與制造,2017(7):111-114. [10] 廉宇峰.電動汽車主動避撞系統(tǒng)狀態(tài)估計與控制策略研究[D].長春:吉林大學,2015. [11] 李霖,朱西產(chǎn),陳海林.駕駛員制動和轉向避撞極限[J].同濟大學學報(自然科學版),2016,44(11):1743-1748. [12] 葛如海,儲亞婷,謝永東,等.基于Prescan的換道預警規(guī)則研究[J].重慶交通大學學報(自然科學版),2016,35(1):172-176. [13] PACEJKA H B.Tyre and vehicle dynamics[M].4th ed.Beijing:Tsinghua University Press,2009. [14] 李宇.基于路面辨識的行車安全距離控制研究[D].西安:長安大學,2006. [15] Gridsada P.State,Parameter,and Unknown Input Estimation Problems in Active Automotive Safety Applications[D].Minnesota:The faculty of the graduate school of the university of Minnesota,2011. [16] 余志生.汽車理論[M].北京:機械工業(yè)出版社,2014. [17] 黃麗瓊.基于制動/轉向的汽車主動避撞控制系統(tǒng)研究[D].南京:南京航空航天大學,2016. [18] WINSTON N.Continuous-curvature paths for autonomous vehicles[C]//Proc.IEEE Int.Conf.Robot.Autom.USA:IEEE,1989:1260-1264. [19] PACEJKA H B.Tyre and Vehicle Dynamics[M].2nd ed.New York:Elsevier,2006:101-117.3.2 下層控制器設計
4 基于虛擬實驗的算法驗證
5 結束語