• <tr id="yyy80"></tr>
  • <sup id="yyy80"></sup>
  • <tfoot id="yyy80"><noscript id="yyy80"></noscript></tfoot>
  • 99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看 ?

    基于彈性繩理論的自主車輛防碰撞的路徑規(guī)劃*

    2014-02-27 06:45:44曹昊天宋曉琳
    汽車工程 2014年10期
    關(guān)鍵詞:主車勢(shì)場(chǎng)中心線

    曹昊天,宋曉琳,黃 江

    (湖南大學(xué),汽車車身先進(jìn)設(shè)計(jì)與制造國(guó)家重點(diǎn)實(shí)驗(yàn)室,長(zhǎng)沙 410082)

    前言

    目前研發(fā)的車輛主動(dòng)避障系統(tǒng)有碰撞預(yù)警系統(tǒng)(collision warning system, CWS)、自適應(yīng)巡航控制系統(tǒng)(adaptive cruise control system, ACC)和車輛停走系統(tǒng)(stop & go)[1]等。歐洲EuroFOT提供的研究數(shù)據(jù)顯示,裝有ACC系統(tǒng)和前碰撞預(yù)警系統(tǒng)(FCW)等先進(jìn)駕駛員輔助系統(tǒng)(ADAS)的車輛,能減少交通事故的發(fā)生概率達(dá)5.7%[2]。根據(jù)2012年中國(guó)統(tǒng)計(jì)年鑒交通事故的數(shù)據(jù),我國(guó)2011年由于交通事故而死亡的人數(shù)達(dá)到六萬余人[3],盡管與前幾年比較死亡人數(shù)呈下降趨勢(shì),但總體而言,這個(gè)傷亡數(shù)目仍然巨大。而車輛主動(dòng)避障系統(tǒng)可以輔助駕駛員對(duì)潛有危險(xiǎn)的交通場(chǎng)景規(guī)劃出安全的避障路徑,從而可減少甚至避免交通事故的發(fā)生,因此車輛主動(dòng)避障系統(tǒng)的研究具有理論意義和實(shí)用價(jià)值。

    文獻(xiàn)[4]中提出的人工勢(shì)場(chǎng)理論和彈性繩理論最早運(yùn)用于機(jī)器人領(lǐng)域,文獻(xiàn)[5]和文獻(xiàn)[6]中加以改進(jìn)運(yùn)用到自主車輛路徑規(guī)劃領(lǐng)域,并成功實(shí)現(xiàn)了在低風(fēng)險(xiǎn)路況下動(dòng)態(tài)車輛的避障路徑規(guī)劃算法。為擴(kuò)大障礙車勢(shì)場(chǎng)的作用范圍,作者曾對(duì)影響避障路徑生成的幾個(gè)因素,即障礙車引導(dǎo)勢(shì)場(chǎng)的形狀、引導(dǎo)勢(shì)場(chǎng)因子、彈性繩剛度和主車速度進(jìn)行了探討,結(jié)果表明彈性繩剛度和主車車速的影響最大,然后是引導(dǎo)勢(shì)場(chǎng)因子,而引導(dǎo)勢(shì)場(chǎng)形狀的影響最小[7]。本文中在先前研究和文獻(xiàn)[6]算法的基礎(chǔ)上,分別在障礙車的前后增加一個(gè)引導(dǎo)勢(shì)場(chǎng),研究引入引導(dǎo)勢(shì)場(chǎng)后對(duì)主車避障路徑生成的改善情況。通過在直道和彎道兩種不同道路環(huán)境下,結(jié)合Carsim車輛動(dòng)力學(xué)模型進(jìn)行仿真分析。結(jié)果表明,添加引導(dǎo)勢(shì)場(chǎng)后,對(duì)于直線道路上行駛的車輛作用最為明顯,車輛能夠提前避障,從而給駕駛員更為寬裕的操作時(shí)間,并且避障過程中在縱向上與障礙車輛保持充分的安全距離,從而使避障過程更安全。

    1 道路模型

    道路環(huán)境的信息由車載雷達(dá)、GPS和車載攝像頭獲得。在路徑?jīng)Q策的初始階段,位于道路上的慣性坐標(biāo)系的原點(diǎn)選取在道路中心線上與車輛質(zhì)心縱向?qū)?yīng)的位置,如圖1所示。道路中心線由一回旋線構(gòu)造,其曲率變化率為一常數(shù),即其曲率與弧長(zhǎng)成正比。假定一條總弧長(zhǎng)為lD的回旋線線段,其起始曲率為c0,則自起點(diǎn)計(jì)弧長(zhǎng)為l處一點(diǎn)的曲率為c(l)=c0+c1l。由于回旋線的精確表達(dá)須計(jì)算Fresnel積分,因此更常用的方法是采用多項(xiàng)式逼近來表達(dá),即道路中心線的橫向位移可表示為

    (1)

    式中:x為道路坐標(biāo)系下的縱向位移;y0為道路中心線初始的橫向偏移;τ0為初始方向角;c1為曲率變化率或曲率常數(shù),c1=(cf-c0)/lD,cf為終點(diǎn)曲率。

    道路中心線上的點(diǎn)在道路坐標(biāo)系中可表示為

    Rc=xex+ycey

    (2)

    式中:ex、ey為道路坐標(biāo)系的縱向和橫向單位向量。

    根據(jù)圖1,結(jié)合邊界條件yc(0)=0和yc′(0)=0可將y0和τ0消掉。為計(jì)算簡(jiǎn)便,引入建立在道路中心線上的自然坐標(biāo)系,其切向和法向單位向量為

    (3)

    因此對(duì)于雙車道,道路邊界上的點(diǎn)可表示為

    (4)

    式中:B為道路總寬度;下標(biāo)q∈[l,r],表示左右邊界。

    此外考慮到構(gòu)成道路中心線的回旋線方向角較小,基于小曲率的假設(shè)下,整個(gè)道路上任意點(diǎn)的位置R近似表示為

    R=Rc+(y-yc)en

    (5)

    2 彈性繩模型

    根據(jù)文獻(xiàn)[5]中提出的彈性繩模型,假定車輛的緊急避障路徑是由一根虛擬的彈性繩模擬,它由N個(gè)節(jié)點(diǎn)的線性彈簧串聯(lián)在一起,如圖2所示。節(jié)點(diǎn)的位置向量在道路坐標(biāo)系中可表示為

    ri=xiex+yiey

    (6)

    路徑規(guī)劃開始時(shí),確定好起始點(diǎn)和目標(biāo)點(diǎn),這樣彈性繩的首尾處的節(jié)點(diǎn)坐標(biāo)是已知的。假設(shè)彈簧的拉伸滿足胡克定律,那么彈性繩節(jié)點(diǎn)處的彈性勢(shì)能可由與相鄰兩個(gè)節(jié)點(diǎn)之間的拉伸長(zhǎng)度給出,即

    (7)

    式中:i=1,2,3,…,N-1,N為節(jié)點(diǎn)個(gè)數(shù);ki為第i段彈簧的剛度;li為第i段彈簧的自然長(zhǎng)度。li定義為歐式距離,即

    3 勢(shì)場(chǎng)模型

    3.1 道路邊界勢(shì)場(chǎng)

    道路邊界勢(shì)場(chǎng)的建立是為確保車輛在道路上正常行駛而不至于出界,因此勢(shì)場(chǎng)模型的選擇是關(guān)鍵之一。根據(jù)人工勢(shì)場(chǎng)模型在機(jī)器人領(lǐng)域運(yùn)用的經(jīng)驗(yàn),選取如式(8)所示的勢(shì)場(chǎng),很顯然,當(dāng)車輛接近于道路邊界,它的勢(shì)能值趨向于無窮大,以達(dá)到限制車輛運(yùn)動(dòng)的目的。

    (8)

    式中ηq為道路邊界剛度值。

    3.2 障礙車勢(shì)場(chǎng)

    本文中采用的人工勢(shì)場(chǎng)法考慮的是車輛在R2空間中的路徑規(guī)劃,且障礙車采用凸多邊形表示,具體而言,采用矩形來描述障礙車的幾何結(jié)構(gòu)。構(gòu)建障礙車勢(shì)場(chǎng)的目的是防止它與其他車輛發(fā)生碰撞,并保持一定的安全距離。因此在設(shè)計(jì)障礙車勢(shì)場(chǎng)函數(shù)時(shí),應(yīng)使主車越接近該障礙車時(shí),障礙車的勢(shì)能值越大,即

    (9)

    式中:kobst為障礙車勢(shì)場(chǎng)的剛度值;r0(m)為第m個(gè)障礙車輛的質(zhì)心坐標(biāo);d為安全圓直徑。所謂安全圓就是以障礙車輛的質(zhì)心為圓心包含整輛車在內(nèi)的一個(gè)圓,以保證主車不會(huì)與障礙車發(fā)生接觸,見圖3。

    3.3 引導(dǎo)勢(shì)場(chǎng)

    為使主車能夠在運(yùn)動(dòng)中盡力避免與障礙車接近,考慮在障礙車前后加入引導(dǎo)勢(shì)場(chǎng),并且將勢(shì)場(chǎng)的影響范圍“放大”,從而使主車能夠提前做出避障措施。如圖3所示,在障礙車前后加入半圓形的引導(dǎo)勢(shì)場(chǎng),對(duì)于后引導(dǎo)勢(shì)場(chǎng),選取其勢(shì)場(chǎng)表達(dá)式為

    (10)

    式中:kgr為車輛勢(shì)場(chǎng)剛度值;τ為引導(dǎo)勢(shì)場(chǎng)半徑;xr為障礙車后方邊界的中心位置的橫坐標(biāo)。引導(dǎo)勢(shì)場(chǎng)的形式與障礙車勢(shì)場(chǎng)的表達(dá)式相近,但是R′中多出了一個(gè)放大因子ξ,通過在以障礙車后方邊界中點(diǎn)為原點(diǎn)的坐標(biāo)系中進(jìn)行縮放,擴(kuò)大引導(dǎo)勢(shì)場(chǎng)在道路縱向上的影響范圍(側(cè)向上保持不變)。經(jīng)“放大”后的縱向坐標(biāo)值在道路坐標(biāo)系中用x*′表示,在相應(yīng)的道路坐標(biāo)系中表示成x′。此外以左邊界中點(diǎn)為原點(diǎn)的坐標(biāo)系中的X方向的數(shù)值表示成x*,該坐標(biāo)系的單位向量與道路坐標(biāo)系中單位向量的轉(zhuǎn)換關(guān)系為

    (11)

    (12)

    式中:ψ0為障礙車的方向角,如圖3所示。后方放大因子ξr與主車和障礙車的速度差v-vm有直接關(guān)系,將βr稱作后方引導(dǎo)勢(shì)場(chǎng)因子。當(dāng)障礙車在直線道上行駛,ψ0=π。式(11)和式(12)可簡(jiǎn)化為

    (13)

    同樣,對(duì)于前方引導(dǎo)勢(shì)場(chǎng)也有類似的設(shè)定,ξf稱作前方放大因子,βf稱作前方引導(dǎo)勢(shì)場(chǎng)因子??偠灾ㄟ^引導(dǎo)勢(shì)場(chǎng)的“放大”作用使原障礙車勢(shì)場(chǎng)的影響范圍更大,原本離障礙車較遠(yuǎn)的點(diǎn),經(jīng)過坐標(biāo)變化后離障礙車更近了,從而促使車輛在離障礙車更遠(yuǎn)的地方就開始采取避障措施。β的取值決定了引導(dǎo)勢(shì)場(chǎng)的影響程度,β越大,所能影響的距離也就越遠(yuǎn)。

    3.4 道路風(fēng)險(xiǎn)圖

    對(duì)于M個(gè)障礙車,將所有的障礙車勢(shì)場(chǎng)和前后引導(dǎo)勢(shì)場(chǎng)疊加起來得到最終的障礙車勢(shì)場(chǎng),如式(14)所示。外界勢(shì)場(chǎng)為道路邊界勢(shì)場(chǎng)和障礙車勢(shì)場(chǎng)之和,如式(15)所示。

    (14)

    Uext=Uborder+Uobst

    (15)

    Uext的大小體現(xiàn)了道路風(fēng)險(xiǎn)的情況。由于障礙車的位置和狀態(tài)隨時(shí)間而變化,所以Uext大小也隨著時(shí)間而變化。圖4為初始時(shí)刻在引入引導(dǎo)勢(shì)場(chǎng)前后外界勢(shì)場(chǎng)圖的對(duì)比。

    4 平衡方程的建立和求解

    4.1 平衡方程的建立

    由向量微積分的相關(guān)知識(shí)可知,勢(shì)場(chǎng)作用于每一個(gè)節(jié)點(diǎn)產(chǎn)生的虛擬力可由對(duì)勢(shì)場(chǎng)進(jìn)行梯度運(yùn)算得到,即

    (16)

    Fobj,i= -iUobst,i=

    (17)

    (18)

    根據(jù)彈性繩理論的假設(shè),作用于每一個(gè)節(jié)點(diǎn)的合力應(yīng)處于平衡狀態(tài),由此可得到方程式為

    (19)

    對(duì)于N個(gè)彈性繩節(jié)點(diǎn),由于首尾節(jié)點(diǎn)均已固定,坐標(biāo)已知,將式(19)分解到橫向和縱向兩個(gè)方向,從而產(chǎn)生2(N-2)個(gè)方程組成的聯(lián)立方程組,因此節(jié)點(diǎn)位置的求解需解此非線性方程組。為使計(jì)算更加簡(jiǎn)便,將節(jié)點(diǎn)的x方向位移進(jìn)行約束,因?yàn)樵谲囕v進(jìn)行車道保持、換道或緊急避障時(shí),節(jié)點(diǎn)的縱向位移并非必要,因此可以將其進(jìn)行約束[6],即

    ri·ex=xi=i·Δx,i=1,2,…,N

    式中:Δx為節(jié)點(diǎn)之間在縱向上的間隔。這樣,式(19)可以簡(jiǎn)化為

    (20)

    4.2 方程組的數(shù)值解法

    本文中采用基本Newton-Raphson算法,它是多維求根方法中最為簡(jiǎn)單的一種,編程簡(jiǎn)易,但該算法對(duì)方程表達(dá)式的要求較高,求解的表達(dá)式必須連續(xù)可微,并且其1階導(dǎo)數(shù)是連續(xù)的。該方法雖然不具有全局收斂性質(zhì),但是對(duì)于足夠好的初始值仍然有著明顯的收斂效果。

    Newton-Raphson法是一種通過表達(dá)式的泰勒級(jí)數(shù)的1階近似,在方程根可能存在的區(qū)間上進(jìn)行迭代尋根的方法。一般而言方程可以用下式來描述:

    F(z)=0,dimz=N

    Fitotal=Fiext+Fiinc

    選取一組初始值為

    F(z)≈F(z(k))+J(z(k))(z-z(k))

    (21)

    式中:J為F的雅克比矩陣;k為迭代序號(hào)。將式(21)中F(z)=0的解記為z(k+1),因此有

    z(k+1)=z(k)-J-1(z(k))F(z(k))

    (22)

    直到所得到的搜索步長(zhǎng)Δz(k)=z(k+1)-z(k)在預(yù)期的誤差范圍ε內(nèi)停止迭代。此外,由于道路的危險(xiǎn)勢(shì)場(chǎng)隨著時(shí)間的變化而變化,因此路徑規(guī)劃須以一定的時(shí)間間隔進(jìn)行更新。這樣上一次規(guī)劃的路徑可作為下一次路徑規(guī)劃的初始值,通過Newton-Raphson算法來進(jìn)一步修正得到某規(guī)劃時(shí)刻規(guī)劃的路徑值。表1給出Newton-Raphson算法的偽代碼。

    表1 Newton-Raphson迭代法偽代碼

    4.3 初始解的產(chǎn)生

    用Newton-Raphson算法解方程組時(shí)須獲得一組初始解,即須得到一組初始路徑。為此本文中采取一種簡(jiǎn)單的幾何方法來獲得。如圖5所示,獲取探測(cè)到障礙車邊界與離它較遠(yuǎn)的車道邊界的中點(diǎn),然后將起始點(diǎn)P0和這些中點(diǎn)與目標(biāo)點(diǎn)PN進(jìn)行線性插值得到對(duì)應(yīng)的插值函數(shù),然后彈性繩各節(jié)點(diǎn)的取值便依照該插值函數(shù)來取點(diǎn)。這樣就得到一組可用來迭代求解的初始值。

    5 仿真

    本文中模擬的障礙車設(shè)定為一長(zhǎng)為4m,寬為2m的矩形,此外主車通過車載激光雷達(dá)來獲得與前方障礙車的間隔距離。其最大探測(cè)距離可達(dá)150m,取決于激光功率和人眼安全規(guī)定;最小0.5m,取決于脈沖長(zhǎng)度。在防碰撞預(yù)警系統(tǒng)中,考慮到自車和前車的絕對(duì)速度和相對(duì)速度、路況、兩車完全停止時(shí)的實(shí)際車間距離等因素,一般要求傳感器的探測(cè)距離不小于130m,分辨率為1m,激光雷達(dá)滿足該要求[8]。但在智能車的行車環(huán)境中,雷達(dá)的測(cè)量值可能來源于目標(biāo)車輛,也可能來源于其他干擾物;此外由于雷達(dá)自身工作的不穩(wěn)定和目標(biāo)回波能量的分布不均,還可能出現(xiàn)虛假目標(biāo),同時(shí)隨著車輛行駛中的隨機(jī)顛簸和擺動(dòng),雷達(dá)測(cè)量信號(hào)可能出現(xiàn)短暫丟失,從而導(dǎo)致目標(biāo)物信息的較大波動(dòng)[9]。因此,須對(duì)雷達(dá)測(cè)量信號(hào)進(jìn)行處理,以準(zhǔn)確選取有效目標(biāo)。為了簡(jiǎn)便,假定主車可準(zhǔn)確地捕捉到前方運(yùn)動(dòng)障礙車,且在仿真場(chǎng)景的設(shè)定中主車與障礙車有足夠的安全距離,方便主車進(jìn)行避障操作。為驗(yàn)證改進(jìn)算法的有效性,分別就以下兩種情形進(jìn)行仿真分析。

    5.1 直線道路

    在單向雙車道的直線高速公路上,車道寬度為3.5m,主車的初始位置為右車道中心線上,障礙車起始位置同樣在右車道中心線離主車前方60m處。主車速度為25m/s,障礙車速度為15m/s,均勻速行駛,如圖6所示。主車探測(cè)到前方出現(xiàn)的障礙車開始采取避障措施,繞過障礙后繼續(xù)前進(jìn)。利用Mathematica軟件編寫算法程序得到避障路徑,然后結(jié)合Carsim動(dòng)力學(xué)軟件將路徑導(dǎo)入進(jìn)行仿真,如圖7所示,觀察車輛在避障過程中的穩(wěn)定性。仿真參數(shù)設(shè)置如表2所示。

    參數(shù)數(shù)值描述ηl,ηr/(N/m)30道路左右邊界勢(shì)場(chǎng)剛度b/m35單車道寬度βf,βr020前后引導(dǎo)勢(shì)場(chǎng)影響因子N166彈性繩節(jié)點(diǎn)數(shù)l/m250路徑規(guī)劃長(zhǎng)度l0/m12彈性繩自然長(zhǎng)度k/(N/m)350000彈性繩剛度kobst/(N/m)1000障礙車勢(shì)場(chǎng)剛度kr,kf/(N/m)1000前后引導(dǎo)勢(shì)場(chǎng)剛度ε/m0001Newton?Raphson法求解精度W/m2障礙車橫向?qū)挾萀/m4障礙車縱向長(zhǎng)度

    避障路徑生成的動(dòng)態(tài)過程如圖8所示。仿真結(jié)果表明,在引入前后引導(dǎo)勢(shì)場(chǎng)后,規(guī)劃出的路徑改善明顯,具體表現(xiàn)在:障礙車勢(shì)場(chǎng)對(duì)主車的影響范圍變大,因此主車在避障開始駛?cè)肓硪卉嚨佬旭?,且避障時(shí)側(cè)向與障礙車保持著更為安全的距離。沒有加引導(dǎo)勢(shì)場(chǎng)的模型雖然也能“成功”避障,但是近乎與障礙車“擦身而過”,因而實(shí)際駕駛中非常容易導(dǎo)致與障礙車的碰撞,如圖7(b)所示。所以引導(dǎo)勢(shì)場(chǎng)的引入很好地避免了這類情況的發(fā)生,從而使主車在避障過程中更為安全。

    圖9(a)給出了加入和不加入引導(dǎo)勢(shì)場(chǎng)這兩種情況下生成的避障路徑在橫向上距離之差的絕對(duì)值??梢钥闯觯诩尤胍龑?dǎo)勢(shì)場(chǎng)后,主車與障礙車的橫向距離比未加入引導(dǎo)勢(shì)場(chǎng)時(shí)更遠(yuǎn),其最大差值達(dá)到約1.4m,可見效果明顯。

    此外,由圖9(b)給出的車輛在路徑跟隨過程中主車橫擺角速度隨時(shí)間變化的關(guān)系可知,主車在加入和未加入引導(dǎo)勢(shì)場(chǎng)在避障過程中都能夠保持車輛的穩(wěn)定前行,但加入引導(dǎo)勢(shì)場(chǎng)后,由于避障初始轉(zhuǎn)向角的增大,橫擺角速度也會(huì)增大,但是整個(gè)過程中相差并不太多,且沒有出現(xiàn)失穩(wěn)的情況。因此該方法的可行性和有效性得到驗(yàn)證。

    5.2 彎道情形

    彎道場(chǎng)景如圖10(a)所示,道路參數(shù)設(shè)置如表3所示。規(guī)劃初始時(shí)刻主車在右車道距離車道中心線2.5m處,以25m/s的速度勻速行駛。障礙車的初始位置為水平距離50m,與車道中心線相距2m的地方,并且以15m/s的速度勻速行駛。

    從圖10(b)的仿真結(jié)果來看,兩種情形下都能夠安全成功避障,雖然加入引導(dǎo)勢(shì)場(chǎng)的效果與不加入引導(dǎo)勢(shì)場(chǎng)沒有直線車道情形下差別明顯,但在加入引導(dǎo)勢(shì)場(chǎng)后,主車的避障路徑在橫向上距離最大差值約為0.4m,見圖10(c)。

    參數(shù)數(shù)值描述b/m35單車道寬度l/m200路徑規(guī)劃長(zhǎng)度x0/m-10彎道開始處曲率xf/m-1000125彎道末尾處曲率

    在彎道情形中,由于彈性繩起始位置的差異,在沒有加入引導(dǎo)勢(shì)場(chǎng)下主車也能夠較早駛?cè)肓硪卉嚨溃遗c障礙車在縱向上保持足夠的安全距離,是否加入引導(dǎo)勢(shì)場(chǎng)的區(qū)別不大。在直線車道情形中,由于引導(dǎo)勢(shì)場(chǎng)的加入也是為使主車在縱向上與障礙車保持更為安全的距離,所以位置會(huì)離障礙車更遠(yuǎn)。由此可見引導(dǎo)勢(shì)場(chǎng)的加入對(duì)直線道路上的避障作用更為明顯。此外從圖10(d)中也可以觀察到在避障過程中主車橫擺角速度大小,可知主車在整個(gè)過程中狀態(tài)穩(wěn)定。

    6 結(jié)論

    在人工勢(shì)場(chǎng)和彈性繩模型的基礎(chǔ)上,分別在障礙車前后添加引導(dǎo)勢(shì)場(chǎng)模型,實(shí)現(xiàn)了在低風(fēng)險(xiǎn)交通場(chǎng)景的緊急避障路徑規(guī)劃。仿真實(shí)驗(yàn)表明,改進(jìn)后的模型與改進(jìn)前相比,特別在直線道路情形下,會(huì)有更加安全的避障路徑。通過Carsim仿真模擬可知,主車在避障過程中可保持車輛的動(dòng)力學(xué)穩(wěn)定性。

    [1] 宋曉琳,馮廣剛,楊濟(jì)匡.汽車主動(dòng)避撞系統(tǒng)的發(fā)展現(xiàn)狀及趨勢(shì)[J].汽車工程,2008,30(4):285-290.

    [2] 中華人民共和國(guó)統(tǒng)計(jì)局.中國(guó)統(tǒng)計(jì)年鑒(2012年):交通事故統(tǒng)計(jì)情況(2011年)[DB/OL].http://www.stats.gov.cn/tjsj/ndsj/2012/indexch.htm,2012-09-19.

    [3] SAE International. Driver Assistance Technology: What Really Matters[EB/OL].www.sae.org/mags/sve/11152/,2012-06-02.

    [4] Quinlan S. Real-time Modification of Collision-free Path[D]. Stanford University, USA,1995.

    [5] Hilgert J, Hirsch K, Bertram T, et al. Emergency Path Planning for Autonomous Vehicles Using Elastic Band Theory[C]. IEEE/ASME International Conference on Advanced Intelligent Mechatronics AIM 2003, Kobe, Japan,20 -24 July 2003.

    [6] Sattel T Brandt. From Robotics to Automotive: Lane-keeping and Collision Avoidance Based on Elastic Bands[J]. Vehicle System Dynamics,2008,46(7):597-619.

    [7] Song Xiaolin, Cao Haotian, Huang Jiang. Influencing Factors Research on Vehicle Path Planning Based on Elastic Bands for Collision Avoidance[J]. SAE International Journal of Passenger Cars- Electronic and Electrical Systems,2012,5(2):625-637.

    [8] 李曉霞,江宗法,李百川,等.車載距離探測(cè)技術(shù)比較[J].長(zhǎng)安大學(xué)學(xué)報(bào)(自然科學(xué)版),2002,22(2):73-76.

    [9] 劉志峰,王建強(qiáng),李克強(qiáng).具有魯棒特性的車載雷達(dá)有效目標(biāo)確定方法[J].清華大學(xué)學(xué)報(bào)(自然科學(xué)版),2008,48(5):875-878.

    猜你喜歡
    主車勢(shì)場(chǎng)中心線
    基于Frenet和改進(jìn)人工勢(shì)場(chǎng)的在軌規(guī)避路徑自主規(guī)劃
    基于改進(jìn)人工勢(shì)場(chǎng)方法的多無人機(jī)編隊(duì)避障算法
    歐曼牽引車制動(dòng)系統(tǒng)異常的故障處理
    主車與掛車分別設(shè)立第三者責(zé)任保險(xiǎn)的賠償額如何確定
    山東青年(2017年7期)2018-01-11 16:09:15
    庫車坳陷南斜坡古流體勢(shì)場(chǎng)對(duì)陸相油氣運(yùn)聚的控制
    基于偶極勢(shì)場(chǎng)的自主水下航行器回塢導(dǎo)引算法
    第十講 幾何公差代號(hào)標(biāo)注示例10
    ——目鏡套筒
    X線攝影中中心線對(duì)DR攝影質(zhì)量的重要性
    基于Meanshift和Hough變換的秧苗行中心線提取
    基于曲率計(jì)算血管中心線特征點(diǎn)的提取方法
    河南科技(2014年8期)2014-02-27 14:08:08
    黄片大片在线免费观看| 淫妇啪啪啪对白视频| 国产成人一区二区三区免费视频网站| 国产成人欧美| 午夜精品国产一区二区电影| 国产精品国产av在线观看| 日本a在线网址| 99香蕉大伊视频| 男女高潮啪啪啪动态图| 又黄又爽又免费观看的视频| 午夜福利欧美成人| 久久久久久久精品吃奶| 色综合欧美亚洲国产小说| 美女福利国产在线| 老司机靠b影院| 亚洲精品一二三| 母亲3免费完整高清在线观看| 久久久久视频综合| 91在线观看av| 国产成人系列免费观看| 丝袜美腿诱惑在线| 首页视频小说图片口味搜索| 少妇猛男粗大的猛烈进出视频| 久久久久久免费高清国产稀缺| 两个人免费观看高清视频| 最近最新中文字幕大全免费视频| 亚洲精品国产一区二区精华液| 老司机深夜福利视频在线观看| av中文乱码字幕在线| 亚洲熟妇中文字幕五十中出 | 中文字幕色久视频| 色婷婷久久久亚洲欧美| 久久狼人影院| 亚洲五月天丁香| 一级片'在线观看视频| 亚洲欧美一区二区三区久久| 国产亚洲精品久久久久久毛片 | 操美女的视频在线观看| 搡老乐熟女国产| 欧美乱码精品一区二区三区| 搡老岳熟女国产| 丝袜美腿诱惑在线| 国产亚洲欧美精品永久| 国产精品99久久99久久久不卡| 精品国产一区二区三区四区第35| 欧美日韩乱码在线| 国产亚洲欧美精品永久| 又紧又爽又黄一区二区| 欧美黑人欧美精品刺激| av福利片在线| 99国产精品99久久久久| 女人高潮潮喷娇喘18禁视频| 男女之事视频高清在线观看| 精品欧美一区二区三区在线| 97人妻天天添夜夜摸| 日韩 欧美 亚洲 中文字幕| 亚洲九九香蕉| 狂野欧美激情性xxxx| 搡老熟女国产l中国老女人| 国产深夜福利视频在线观看| 国产精品自产拍在线观看55亚洲 | avwww免费| 久久精品国产亚洲av高清一级| 成人国语在线视频| 精品福利观看| 亚洲第一青青草原| 欧美日韩一级在线毛片| 亚洲午夜理论影院| 巨乳人妻的诱惑在线观看| 精品免费久久久久久久清纯 | 午夜福利,免费看| 亚洲五月婷婷丁香| av国产精品久久久久影院| 久久婷婷成人综合色麻豆| 亚洲成av片中文字幕在线观看| 亚洲五月婷婷丁香| 中文字幕高清在线视频| 在线视频色国产色| av超薄肉色丝袜交足视频| 国产精品免费大片| 在线观看www视频免费| 1024香蕉在线观看| 国产成人一区二区三区免费视频网站| 国产精品久久久久成人av| 波多野结衣av一区二区av| 丝袜美腿诱惑在线| 国产高清videossex| 亚洲欧美日韩另类电影网站| 91麻豆精品激情在线观看国产 | 精品午夜福利视频在线观看一区| 亚洲自偷自拍图片 自拍| 国产男靠女视频免费网站| 露出奶头的视频| 国产精品秋霞免费鲁丝片| 成人精品一区二区免费| 婷婷精品国产亚洲av在线 | 成年版毛片免费区| 亚洲,欧美精品.| 91国产中文字幕| 亚洲情色 制服丝袜| 国产无遮挡羞羞视频在线观看| 日韩三级视频一区二区三区| 69精品国产乱码久久久| 久久草成人影院| 国产一区在线观看成人免费| 国产精品影院久久| 飞空精品影院首页| 99热网站在线观看| 久久性视频一级片| 久久久久精品国产欧美久久久| 人人妻人人添人人爽欧美一区卜| 91精品国产国语对白视频| 久久国产精品人妻蜜桃| 亚洲av成人一区二区三| 久久精品亚洲精品国产色婷小说| 在线观看www视频免费| 午夜福利乱码中文字幕| 99精国产麻豆久久婷婷| 90打野战视频偷拍视频| 99re6热这里在线精品视频| 一区二区三区激情视频| 天天躁日日躁夜夜躁夜夜| 欧美成人午夜精品| 欧美国产精品va在线观看不卡| 久久精品国产亚洲av香蕉五月 | 欧美激情高清一区二区三区| 18禁美女被吸乳视频| 成人av一区二区三区在线看| 精品国产超薄肉色丝袜足j| 波多野结衣av一区二区av| 成人免费观看视频高清| 久久九九热精品免费| 国产片内射在线| 久久青草综合色| 久久热在线av| 美女福利国产在线| 女人爽到高潮嗷嗷叫在线视频| 久久人妻福利社区极品人妻图片| 午夜亚洲福利在线播放| 18禁黄网站禁片午夜丰满| 高清av免费在线| 久久久久精品国产欧美久久久| 色播在线永久视频| 窝窝影院91人妻| 国产精品国产高清国产av | 欧美性长视频在线观看| 色播在线永久视频| 国产高清国产精品国产三级| 啪啪无遮挡十八禁网站| 亚洲色图 男人天堂 中文字幕| 亚洲国产欧美一区二区综合| 亚洲人成伊人成综合网2020| xxx96com| 亚洲情色 制服丝袜| 9色porny在线观看| 亚洲va日本ⅴa欧美va伊人久久| 精品国产超薄肉色丝袜足j| 亚洲国产毛片av蜜桃av| 91精品三级在线观看| 久久中文看片网| 一进一出抽搐gif免费好疼 | 精品欧美一区二区三区在线| 人人澡人人妻人| netflix在线观看网站| 高潮久久久久久久久久久不卡| 最新美女视频免费是黄的| 国产精品永久免费网站| 中文字幕最新亚洲高清| 国产精品久久电影中文字幕 | 黄色丝袜av网址大全| av片东京热男人的天堂| 国产99久久九九免费精品| 丰满饥渴人妻一区二区三| 国产精品久久久人人做人人爽| 久久精品亚洲av国产电影网| 黑人欧美特级aaaaaa片| 丰满饥渴人妻一区二区三| 热99久久久久精品小说推荐| 久久天躁狠狠躁夜夜2o2o| xxx96com| 精品国产亚洲在线| 人妻 亚洲 视频| 91成年电影在线观看| 亚洲熟女精品中文字幕| 国产片内射在线| 免费观看精品视频网站| 午夜日韩欧美国产| 女同久久另类99精品国产91| 伊人久久大香线蕉亚洲五| 少妇被粗大的猛进出69影院| 欧美激情极品国产一区二区三区| 日韩精品免费视频一区二区三区| 午夜福利在线免费观看网站| 亚洲九九香蕉| 最近最新免费中文字幕在线| 亚洲成a人片在线一区二区| 久久草成人影院| 精品欧美一区二区三区在线| 欧美人与性动交α欧美软件| 午夜日韩欧美国产| 国产亚洲精品一区二区www | 国产精品免费一区二区三区在线 | 女人被狂操c到高潮| 人人妻人人添人人爽欧美一区卜| 亚洲国产精品合色在线| 丝瓜视频免费看黄片| 久久久精品免费免费高清| 99国产精品一区二区蜜桃av | 建设人人有责人人尽责人人享有的| ponron亚洲| a级片在线免费高清观看视频| 美女高潮到喷水免费观看| 国内毛片毛片毛片毛片毛片| 免费看十八禁软件| 精品国产一区二区久久| 50天的宝宝边吃奶边哭怎么回事| 日韩中文字幕欧美一区二区| 亚洲,欧美精品.| 波多野结衣一区麻豆| 成熟少妇高潮喷水视频| 午夜91福利影院| 99国产极品粉嫩在线观看| 视频区欧美日本亚洲| 国产精品久久视频播放| 在线观看午夜福利视频| 精品国产亚洲在线| 999久久久精品免费观看国产| 午夜影院日韩av| 久久99一区二区三区| 18禁裸乳无遮挡动漫免费视频| 岛国在线观看网站| 国产淫语在线视频| 国产成人啪精品午夜网站| 日本一区二区免费在线视频| 亚洲精品av麻豆狂野| 亚洲av成人不卡在线观看播放网| 国产精品.久久久| 久久精品成人免费网站| 国产精品免费大片| 国产真人三级小视频在线观看| 欧美黑人精品巨大| 亚洲七黄色美女视频| 超碰97精品在线观看| 色综合欧美亚洲国产小说| 中文亚洲av片在线观看爽 | 一边摸一边抽搐一进一小说 | 超碰97精品在线观看| tube8黄色片| 91成年电影在线观看| 亚洲中文av在线| 欧美人与性动交α欧美精品济南到| 亚洲情色 制服丝袜| 亚洲全国av大片| 老汉色av国产亚洲站长工具| 国产精品偷伦视频观看了| 国产99久久九九免费精品| 亚洲av成人不卡在线观看播放网| 啪啪无遮挡十八禁网站| 黄色a级毛片大全视频| 欧美 日韩 精品 国产| 男女床上黄色一级片免费看| videosex国产| 成人手机av| 夜夜躁狠狠躁天天躁| 国产日韩一区二区三区精品不卡| 一区福利在线观看| av有码第一页| 女人精品久久久久毛片| 久久国产精品影院| 天堂√8在线中文| 久久这里只有精品19| 亚洲专区国产一区二区| 999精品在线视频| 69精品国产乱码久久久| 在线天堂中文资源库| 后天国语完整版免费观看| 亚洲在线自拍视频| 亚洲欧美激情在线| 91成人精品电影| 视频在线观看一区二区三区| 多毛熟女@视频| 婷婷成人精品国产| 国内毛片毛片毛片毛片毛片| 国内久久婷婷六月综合欲色啪| 亚洲午夜精品一区,二区,三区| 国产不卡一卡二| 亚洲人成电影观看| 99久久人妻综合| 亚洲专区中文字幕在线| a级毛片在线看网站| 国产在视频线精品| 国产精品一区二区在线不卡| 老司机深夜福利视频在线观看| 欧美在线黄色| 大型av网站在线播放| 老司机午夜福利在线观看视频| 中文字幕av电影在线播放| 一边摸一边做爽爽视频免费| 日本五十路高清| 日韩大码丰满熟妇| 成人三级做爰电影| 中文亚洲av片在线观看爽 | 欧美人与性动交α欧美软件| 女人被狂操c到高潮| 国产精品1区2区在线观看. | 午夜免费观看网址| 日韩大码丰满熟妇| 国产成+人综合+亚洲专区| 欧美av亚洲av综合av国产av| 欧美成狂野欧美在线观看| 一区二区三区国产精品乱码| 免费看a级黄色片| av网站免费在线观看视频| 国产精品一区二区免费欧美| 精品人妻1区二区| 亚洲精品中文字幕一二三四区| 高潮久久久久久久久久久不卡| 精品亚洲成a人片在线观看| 大香蕉久久成人网| 99国产精品99久久久久| 国产一卡二卡三卡精品| 中文字幕人妻熟女乱码| 天天躁日日躁夜夜躁夜夜| 日韩精品免费视频一区二区三区| 成年人黄色毛片网站| 国产激情欧美一区二区| av天堂久久9| 日韩有码中文字幕| 女人爽到高潮嗷嗷叫在线视频| 午夜福利欧美成人| 又大又爽又粗| 成在线人永久免费视频| 久久这里只有精品19| 久久久久国产精品人妻aⅴ院 | 久久天躁狠狠躁夜夜2o2o| xxxhd国产人妻xxx| 精品一区二区三区视频在线观看免费 | 午夜福利乱码中文字幕| 在线观看免费午夜福利视频| 色婷婷久久久亚洲欧美| 亚洲精品美女久久久久99蜜臀| 日本vs欧美在线观看视频| 成人永久免费在线观看视频| 久久狼人影院| 中国美女看黄片| 一本综合久久免费| 久久精品aⅴ一区二区三区四区| 亚洲人成电影免费在线| 9热在线视频观看99| 黄片小视频在线播放| 国产精品亚洲av一区麻豆| 久久久久久免费高清国产稀缺| 啦啦啦 在线观看视频| 国产97色在线日韩免费| 成人特级黄色片久久久久久久| 男人舔女人的私密视频| 国产片内射在线| av国产精品久久久久影院| 亚洲专区中文字幕在线| 久久精品国产a三级三级三级| 亚洲人成77777在线视频| 中文字幕色久视频| 麻豆乱淫一区二区| 久久精品人人爽人人爽视色| 久久久久国产一级毛片高清牌| 精品少妇一区二区三区视频日本电影| 亚洲人成77777在线视频| 成人18禁高潮啪啪吃奶动态图| ponron亚洲| 夜夜爽天天搞| 午夜91福利影院| 一本一本久久a久久精品综合妖精| av网站在线播放免费| 一进一出抽搐gif免费好疼 | 亚洲国产精品合色在线| 人人妻人人添人人爽欧美一区卜| 国产成人欧美| 免费女性裸体啪啪无遮挡网站| 女人精品久久久久毛片| 建设人人有责人人尽责人人享有的| 欧美日韩中文字幕国产精品一区二区三区 | 啪啪无遮挡十八禁网站| 国内久久婷婷六月综合欲色啪| 精品一区二区三区视频在线观看免费 | 9色porny在线观看| 一边摸一边做爽爽视频免费| 老司机影院毛片| 人妻久久中文字幕网| 老司机靠b影院| 18禁裸乳无遮挡免费网站照片 | 精品第一国产精品| 飞空精品影院首页| 五月开心婷婷网| 69av精品久久久久久| 老鸭窝网址在线观看| 看免费av毛片| 久久精品国产清高在天天线| 在线观看免费日韩欧美大片| 精品高清国产在线一区| 99国产精品免费福利视频| 精品午夜福利视频在线观看一区| 丝袜在线中文字幕| 国产精品久久视频播放| 色老头精品视频在线观看| 99国产综合亚洲精品| 午夜日韩欧美国产| 亚洲精品粉嫩美女一区| 精品国产乱子伦一区二区三区| 波多野结衣av一区二区av| 99久久国产精品久久久| 美女视频免费永久观看网站| a在线观看视频网站| 国产99久久九九免费精品| 美女高潮喷水抽搐中文字幕| 男女高潮啪啪啪动态图| 黑人巨大精品欧美一区二区mp4| 国产精品免费一区二区三区在线 | 日韩一卡2卡3卡4卡2021年| 岛国在线观看网站| 国产精品一区二区在线观看99| 成人18禁高潮啪啪吃奶动态图| 女人高潮潮喷娇喘18禁视频| 精品免费久久久久久久清纯 | 90打野战视频偷拍视频| 91老司机精品| 久久精品国产清高在天天线| 校园春色视频在线观看| 97人妻天天添夜夜摸| 狠狠狠狠99中文字幕| 色播在线永久视频| 久久中文看片网| 女人精品久久久久毛片| 中文亚洲av片在线观看爽 | 久久青草综合色| 一级a爱片免费观看的视频| 国产成人av教育| 天堂俺去俺来也www色官网| 91成年电影在线观看| 久久久久国产一级毛片高清牌| cao死你这个sao货| 午夜免费鲁丝| 午夜福利乱码中文字幕| 十分钟在线观看高清视频www| 日韩免费av在线播放| 18在线观看网站| 高清欧美精品videossex| 亚洲精品自拍成人| 51午夜福利影视在线观看| 最近最新中文字幕大全电影3 | 99国产极品粉嫩在线观看| 满18在线观看网站| 国产激情欧美一区二区| av欧美777| 国产欧美日韩综合在线一区二区| 又紧又爽又黄一区二区| 天堂中文最新版在线下载| 在线观看免费高清a一片| 国产91精品成人一区二区三区| 午夜成年电影在线免费观看| 亚洲第一av免费看| 18禁裸乳无遮挡动漫免费视频| 韩国精品一区二区三区| 青草久久国产| 中文字幕精品免费在线观看视频| 在线免费观看的www视频| 精品一区二区三区四区五区乱码| www.精华液| 精品一区二区三区四区五区乱码| 女性被躁到高潮视频| 国产xxxxx性猛交| av福利片在线| 中文亚洲av片在线观看爽 | 国产精品欧美亚洲77777| 国产高清视频在线播放一区| 免费看十八禁软件| 女人被狂操c到高潮| 色婷婷av一区二区三区视频| 欧美日韩黄片免| 国产成人影院久久av| 高清欧美精品videossex| 欧美激情极品国产一区二区三区| 久久久久久久久免费视频了| 亚洲国产看品久久| 精品久久久久久电影网| 激情视频va一区二区三区| 一区二区三区精品91| 成人永久免费在线观看视频| 视频区欧美日本亚洲| 黄色毛片三级朝国网站| 80岁老熟妇乱子伦牲交| 中文字幕色久视频| 欧美人与性动交α欧美软件| 又黄又爽又免费观看的视频| 亚洲精品粉嫩美女一区| 黄色怎么调成土黄色| 人妻一区二区av| svipshipincom国产片| 国产淫语在线视频| 欧美日韩亚洲国产一区二区在线观看 | 精品少妇久久久久久888优播| 亚洲国产毛片av蜜桃av| x7x7x7水蜜桃| 亚洲熟女毛片儿| 这个男人来自地球电影免费观看| 亚洲欧美日韩另类电影网站| 亚洲av日韩在线播放| 久久精品亚洲熟妇少妇任你| 亚洲av电影在线进入| 欧美精品av麻豆av| 国产精品香港三级国产av潘金莲| 国产男女内射视频| 国产又色又爽无遮挡免费看| 欧美丝袜亚洲另类 | 国产高清国产精品国产三级| 国产一区二区三区视频了| 午夜福利免费观看在线| 精品少妇久久久久久888优播| 人妻一区二区av| 最新美女视频免费是黄的| 久久狼人影院| 校园春色视频在线观看| av视频免费观看在线观看| av天堂久久9| a级片在线免费高清观看视频| xxx96com| 精品人妻熟女毛片av久久网站| 欧美成人免费av一区二区三区 | 久久精品亚洲熟妇少妇任你| 丁香欧美五月| 久久亚洲真实| 手机成人av网站| 国产伦人伦偷精品视频| 一区二区三区国产精品乱码| 90打野战视频偷拍视频| 人人澡人人妻人| 99re6热这里在线精品视频| 国产成人啪精品午夜网站| 久久精品aⅴ一区二区三区四区| 亚洲国产中文字幕在线视频| 国产精品国产av在线观看| 欧美国产精品一级二级三级| avwww免费| 国产片内射在线| 日韩三级视频一区二区三区| 男男h啪啪无遮挡| 成人亚洲精品一区在线观看| 咕卡用的链子| 少妇裸体淫交视频免费看高清 | 久久国产精品大桥未久av| 国产精品久久久久成人av| 1024视频免费在线观看| 午夜激情av网站| 久久天躁狠狠躁夜夜2o2o| 精品一区二区三区视频在线观看免费 | 国产真人三级小视频在线观看| www.精华液| 亚洲av美国av| 久久久久精品国产欧美久久久| 黄片小视频在线播放| 国精品久久久久久国模美| 99热只有精品国产| 国产黄色免费在线视频| 久久久精品国产亚洲av高清涩受| 黑人巨大精品欧美一区二区蜜桃| 性少妇av在线| videos熟女内射| 大码成人一级视频| 国产又爽黄色视频| 午夜成年电影在线免费观看| 午夜福利一区二区在线看| 黄色丝袜av网址大全| 亚洲成av片中文字幕在线观看| 精品一区二区三区av网在线观看| 宅男免费午夜| 人人澡人人妻人| 天堂√8在线中文| 色综合婷婷激情| 国产一区二区三区在线臀色熟女 | 免费av中文字幕在线| 精品国产美女av久久久久小说| 黑人欧美特级aaaaaa片| 女性生殖器流出的白浆| 在线十欧美十亚洲十日本专区| 又大又爽又粗| 成人av一区二区三区在线看| 国产极品粉嫩免费观看在线| 在线视频色国产色| 可以免费在线观看a视频的电影网站| 日本欧美视频一区| 法律面前人人平等表现在哪些方面| ponron亚洲| 精品无人区乱码1区二区| 欧美日韩亚洲高清精品| 久99久视频精品免费| 亚洲成人免费av在线播放| 日韩欧美在线二视频 | 亚洲av欧美aⅴ国产| 热99re8久久精品国产| 每晚都被弄得嗷嗷叫到高潮| 久久久精品国产亚洲av高清涩受| 欧美精品高潮呻吟av久久| 欧美成人免费av一区二区三区 | av天堂在线播放| 久久这里只有精品19| 丁香欧美五月| 国产精品一区二区在线不卡| 天堂动漫精品| 天天躁日日躁夜夜躁夜夜| av网站免费在线观看视频| 久久久精品区二区三区| 一进一出抽搐动态| 国产在线一区二区三区精| 精品午夜福利视频在线观看一区| 1024香蕉在线观看| 国产激情欧美一区二区|