• <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亚洲精品天堂| 国产99白浆流出| 在线观看免费高清a一片| 欧美日韩亚洲国产一区二区在线观看| 欧美中文综合在线视频| 国产成人av教育| 超色免费av| 欧美色视频一区免费| 18禁黄网站禁片午夜丰满| 99在线视频只有这里精品首页| bbb黄色大片| 日本wwww免费看| 成熟少妇高潮喷水视频| 黑人欧美特级aaaaaa片| 色播在线永久视频| 丝袜在线中文字幕| 国产亚洲欧美在线一区二区| 操出白浆在线播放| 一级毛片精品| 国产精品影院久久| 久久人妻熟女aⅴ| 夜夜夜夜夜久久久久| 麻豆一二三区av精品| 身体一侧抽搐| 欧美日本中文国产一区发布| 午夜老司机福利片| 精品卡一卡二卡四卡免费| 每晚都被弄得嗷嗷叫到高潮| 在线天堂中文资源库| 十八禁人妻一区二区| 熟女少妇亚洲综合色aaa.| 在线观看舔阴道视频| 999久久久国产精品视频| 99精品欧美一区二区三区四区| 久久精品成人免费网站| 久久国产亚洲av麻豆专区| 亚洲精品成人av观看孕妇| 国产高清激情床上av| 男女下面插进去视频免费观看| 两人在一起打扑克的视频| 亚洲欧美日韩高清在线视频| 日韩精品青青久久久久久| 五月开心婷婷网| 国产精品美女特级片免费视频播放器 | 久久性视频一级片| 搡老乐熟女国产| 九色亚洲精品在线播放| 亚洲av美国av| 麻豆国产av国片精品| 搡老乐熟女国产| 亚洲三区欧美一区| 美女高潮喷水抽搐中文字幕| 99热国产这里只有精品6| 国产aⅴ精品一区二区三区波| 无人区码免费观看不卡| 亚洲成人免费av在线播放| 变态另类成人亚洲欧美熟女 | 国产亚洲欧美98| 久久精品国产99精品国产亚洲性色 | 岛国在线观看网站| 欧美乱色亚洲激情| 黑人操中国人逼视频| 国产成人av激情在线播放| av片东京热男人的天堂| 午夜老司机福利片| 欧洲精品卡2卡3卡4卡5卡区| 午夜两性在线视频| 国产精品一区二区三区四区久久 | 亚洲,欧美精品.| 老鸭窝网址在线观看| 精品日产1卡2卡| 在线十欧美十亚洲十日本专区| 亚洲第一av免费看| 久久久久国内视频| 亚洲色图综合在线观看| 亚洲成人免费av在线播放| 99精国产麻豆久久婷婷| 亚洲精品国产一区二区精华液| 色婷婷久久久亚洲欧美| 久久中文看片网| 大香蕉久久成人网| 免费观看精品视频网站| 午夜影院日韩av| 男女之事视频高清在线观看| 国产片内射在线| 亚洲专区国产一区二区| 国产精品二区激情视频| 操出白浆在线播放| 国产成+人综合+亚洲专区| 亚洲国产精品999在线| 亚洲精品中文字幕一二三四区| 大码成人一级视频| 国产精品99久久99久久久不卡| 久久亚洲精品不卡| 欧美乱妇无乱码| 首页视频小说图片口味搜索| 亚洲国产精品一区二区三区在线| 在线视频色国产色| 丰满的人妻完整版| 黄色视频,在线免费观看| а√天堂www在线а√下载| 欧美色视频一区免费| 一级片'在线观看视频| 亚洲精品国产色婷婷电影| 麻豆一二三区av精品| 亚洲情色 制服丝袜| 成人精品一区二区免费| 久久人妻av系列| 欧美乱色亚洲激情| 日韩精品青青久久久久久| 88av欧美| 亚洲五月天丁香| 99久久精品国产亚洲精品| 国产无遮挡羞羞视频在线观看| 国产精品免费视频内射| 亚洲五月色婷婷综合| 少妇粗大呻吟视频| 久热这里只有精品99| 午夜福利一区二区在线看| 欧美老熟妇乱子伦牲交| 日本黄色日本黄色录像| 久久精品91无色码中文字幕| 美女 人体艺术 gogo| www.熟女人妻精品国产| 国产99久久九九免费精品| 成人永久免费在线观看视频| 欧美日韩黄片免| 国产野战对白在线观看| 精品人妻在线不人妻| 少妇裸体淫交视频免费看高清 | 久久亚洲真实| 最新在线观看一区二区三区| 夜夜躁狠狠躁天天躁| 国产视频一区二区在线看| 日韩欧美一区二区三区在线观看| 99久久国产精品久久久| 欧美精品亚洲一区二区| 啦啦啦 在线观看视频| 人人妻人人澡人人看| 亚洲一区二区三区不卡视频| 日韩欧美三级三区| 大码成人一级视频| 欧美日韩亚洲高清精品| 一个人免费在线观看的高清视频| www.熟女人妻精品国产| 国产深夜福利视频在线观看| 国产精品自产拍在线观看55亚洲| 精品第一国产精品| 日本免费一区二区三区高清不卡 | 欧美丝袜亚洲另类 | 日韩 欧美 亚洲 中文字幕| 亚洲国产欧美一区二区综合| 久久人妻av系列| 嫩草影视91久久| 国产黄a三级三级三级人| 99久久国产精品久久久| 又紧又爽又黄一区二区| 成人免费观看视频高清| 日本三级黄在线观看| 亚洲国产欧美日韩在线播放| 精品福利永久在线观看| 精品国产乱子伦一区二区三区| 人人妻,人人澡人人爽秒播| 日韩av在线大香蕉| 精品高清国产在线一区| 欧美在线黄色| 国产熟女午夜一区二区三区| 国产精品乱码一区二三区的特点 | 丝袜人妻中文字幕| 精品高清国产在线一区| 男女做爰动态图高潮gif福利片 | 人妻久久中文字幕网| 久久香蕉精品热| 久久久国产精品麻豆| 熟女少妇亚洲综合色aaa.| 国产亚洲精品久久久久久毛片| 精品国产一区二区三区四区第35| 侵犯人妻中文字幕一二三四区| √禁漫天堂资源中文www| 久久久久久久久中文| 一级黄色大片毛片| 国产99白浆流出| 两个人免费观看高清视频| 男女下面插进去视频免费观看| 黄频高清免费视频| 国产精品 国内视频| 校园春色视频在线观看| 免费一级毛片在线播放高清视频 | 亚洲三区欧美一区| 黄片小视频在线播放| 一区二区三区精品91| 精品国产乱子伦一区二区三区| 午夜免费成人在线视频| 国产精品日韩av在线免费观看 | 精品国内亚洲2022精品成人| 亚洲 国产 在线| 大陆偷拍与自拍| 99久久综合精品五月天人人| 9热在线视频观看99| 一区二区三区激情视频| 岛国视频午夜一区免费看| 久久精品91无色码中文字幕| 国产高清videossex| 欧美 亚洲 国产 日韩一| 国产精品国产高清国产av| 国产在线观看jvid| 午夜福利在线免费观看网站| 制服诱惑二区| 午夜成年电影在线免费观看| 成人精品一区二区免费| 女同久久另类99精品国产91| 国产又爽黄色视频| 成人免费观看视频高清| 又大又爽又粗| 成人黄色视频免费在线看| √禁漫天堂资源中文www| 9热在线视频观看99| 91字幕亚洲| 国产三级黄色录像| 首页视频小说图片口味搜索| 精品福利观看| 精品乱码久久久久久99久播| 免费在线观看黄色视频的| 91在线观看av| 99国产极品粉嫩在线观看| 色综合站精品国产| 国产亚洲欧美精品永久| 国产精品一区二区精品视频观看| 在线视频色国产色| 久久精品成人免费网站| 精品欧美一区二区三区在线| 欧美精品啪啪一区二区三区| 午夜免费观看网址| 十八禁人妻一区二区| 国产高清videossex| 国产一区二区三区视频了| 国产免费现黄频在线看| 欧美一级毛片孕妇| 变态另类成人亚洲欧美熟女 | 男人舔女人下体高潮全视频| 国产精品成人在线| 啦啦啦在线免费观看视频4| 999精品在线视频| 色综合站精品国产| 国产成人欧美在线观看| 777久久人妻少妇嫩草av网站| 久热这里只有精品99| 欧美精品一区二区免费开放| 国产精品野战在线观看 | 久久久久久亚洲精品国产蜜桃av| 欧美性长视频在线观看| 美女午夜性视频免费| 五月开心婷婷网| 制服诱惑二区| 午夜成年电影在线免费观看| 久久香蕉精品热| 长腿黑丝高跟| 男人操女人黄网站| 欧美久久黑人一区二区| 757午夜福利合集在线观看| 一进一出抽搐gif免费好疼 | 狂野欧美激情性xxxx| 国产片内射在线| 女性被躁到高潮视频| 久久亚洲精品不卡| 1024视频免费在线观看| 精品欧美一区二区三区在线| 精品欧美一区二区三区在线| 亚洲欧洲精品一区二区精品久久久| 美女国产高潮福利片在线看| 波多野结衣av一区二区av| 亚洲一码二码三码区别大吗| 美女扒开内裤让男人捅视频| 在线观看免费视频日本深夜| 国产又爽黄色视频| 99国产综合亚洲精品| 精品久久蜜臀av无| 久久久久久免费高清国产稀缺| 欧美日本中文国产一区发布| 女警被强在线播放| 精品高清国产在线一区| 久久国产精品男人的天堂亚洲| 亚洲五月天丁香| 国产精品亚洲av一区麻豆| 窝窝影院91人妻| 99国产极品粉嫩在线观看| 女生性感内裤真人,穿戴方法视频| 一区在线观看完整版| www.精华液| 亚洲av五月六月丁香网| 一进一出好大好爽视频| 久久天躁狠狠躁夜夜2o2o| 最新美女视频免费是黄的| 亚洲自偷自拍图片 自拍| 亚洲美女黄片视频| 国产亚洲精品久久久久5区| 国产成人欧美在线观看| 国产精品亚洲一级av第二区| 欧美日韩中文字幕国产精品一区二区三区 | 中文亚洲av片在线观看爽| 宅男免费午夜| 亚洲九九香蕉| 女警被强在线播放| 日日夜夜操网爽| 777久久人妻少妇嫩草av网站| www.999成人在线观看| 免费不卡黄色视频| 国产精品国产高清国产av| 午夜免费观看网址| 欧美色视频一区免费| 国产伦一二天堂av在线观看| 在线观看免费视频网站a站| 免费搜索国产男女视频| 午夜免费鲁丝| 国产高清视频在线播放一区| 他把我摸到了高潮在线观看| 久久性视频一级片| 久久伊人香网站| 一级黄色大片毛片| 亚洲成人精品中文字幕电影 | 嫁个100分男人电影在线观看| 最新美女视频免费是黄的| 自线自在国产av| 日日干狠狠操夜夜爽| 国产精品一区二区在线不卡| 91字幕亚洲| 久久人妻福利社区极品人妻图片| www.精华液| 欧美成人午夜精品| 老汉色av国产亚洲站长工具| 国产欧美日韩综合在线一区二区| 欧美精品啪啪一区二区三区| 欧美黑人欧美精品刺激| bbb黄色大片| 超碰成人久久| 亚洲激情在线av| 久久久久久亚洲精品国产蜜桃av| 午夜激情av网站| 国产欧美日韩精品亚洲av| 性少妇av在线| 国产成+人综合+亚洲专区| 在线永久观看黄色视频| 操出白浆在线播放| 在线国产一区二区在线| 少妇被粗大的猛进出69影院| 成年人黄色毛片网站| 高潮久久久久久久久久久不卡| 女人被躁到高潮嗷嗷叫费观| 色综合站精品国产| √禁漫天堂资源中文www| 丝袜在线中文字幕| 51午夜福利影视在线观看| 欧美成人免费av一区二区三区| www日本在线高清视频| 亚洲精品一二三| 久久这里只有精品19| 亚洲色图av天堂| 91成年电影在线观看| 女人被狂操c到高潮| 少妇 在线观看| 欧美老熟妇乱子伦牲交| 久久香蕉激情| 又黄又粗又硬又大视频| 久久国产乱子伦精品免费另类| 在线看a的网站| 中文字幕最新亚洲高清| 18禁观看日本| 一级,二级,三级黄色视频| 精品国产国语对白av| 岛国视频午夜一区免费看| 老司机午夜十八禁免费视频| 搡老熟女国产l中国老女人| 午夜福利,免费看| 少妇的丰满在线观看| 一级黄色大片毛片| 人人妻人人爽人人添夜夜欢视频| 国产成人欧美在线观看| 成年版毛片免费区| 亚洲成av片中文字幕在线观看| 精品一区二区三区四区五区乱码| 两性午夜刺激爽爽歪歪视频在线观看 | 超碰97精品在线观看| 国产精品av久久久久免费| 国产亚洲欧美精品永久| 少妇粗大呻吟视频| 国产伦人伦偷精品视频| 欧美久久黑人一区二区| 嫩草影视91久久| 性色av乱码一区二区三区2| www.精华液| 国产乱人伦免费视频| 午夜福利,免费看| 欧美成人免费av一区二区三区| 91字幕亚洲| 国产精品自产拍在线观看55亚洲| 久久久国产一区二区| 黄色成人免费大全| 啦啦啦 在线观看视频| 女人被狂操c到高潮| 精品电影一区二区在线| aaaaa片日本免费| 午夜影院日韩av| 老司机午夜福利在线观看视频| 午夜福利欧美成人| 天堂影院成人在线观看| 中文字幕人妻丝袜一区二区| 黄色怎么调成土黄色| 亚洲一区高清亚洲精品| 精品一品国产午夜福利视频| 国产高清videossex| 精品一区二区三卡| www.熟女人妻精品国产| 欧美激情 高清一区二区三区| 50天的宝宝边吃奶边哭怎么回事| 国产黄a三级三级三级人| 亚洲中文日韩欧美视频| 俄罗斯特黄特色一大片| 手机成人av网站| 免费人成视频x8x8入口观看| 色婷婷久久久亚洲欧美| 一边摸一边抽搐一进一小说| 超碰97精品在线观看| 日韩有码中文字幕| 天天躁狠狠躁夜夜躁狠狠躁| 一级片'在线观看视频| 在线观看免费视频网站a站| 国产激情久久老熟女| 97碰自拍视频| 制服诱惑二区| 777久久人妻少妇嫩草av网站| 丝袜美腿诱惑在线| 亚洲精品国产色婷婷电影| 婷婷精品国产亚洲av在线| 亚洲精华国产精华精| 黑人操中国人逼视频| 亚洲熟妇熟女久久| xxx96com| 丰满的人妻完整版| av片东京热男人的天堂| 老熟妇乱子伦视频在线观看| 欧美激情极品国产一区二区三区| 亚洲男人的天堂狠狠| 亚洲激情在线av| 国产精品电影一区二区三区| 久久久久久大精品| 一边摸一边抽搐一进一出视频| 一级片免费观看大全| 女同久久另类99精品国产91| 国产极品粉嫩免费观看在线| 91成人精品电影| 午夜久久久在线观看| 午夜福利,免费看| xxxhd国产人妻xxx| 久久人妻福利社区极品人妻图片| av免费在线观看网站| tocl精华| 村上凉子中文字幕在线| 黑人猛操日本美女一级片| 国产精品一区二区三区四区久久 | 日韩有码中文字幕| 亚洲第一av免费看| 欧美久久黑人一区二区| 国产一区二区激情短视频| 又黄又粗又硬又大视频| av超薄肉色丝袜交足视频| 不卡一级毛片| 首页视频小说图片口味搜索| 午夜免费观看网址| 热re99久久国产66热| 狠狠狠狠99中文字幕| 亚洲欧美激情在线| av福利片在线| 欧美在线黄色| 国产aⅴ精品一区二区三区波| 国产一区二区在线av高清观看| 又黄又粗又硬又大视频| 亚洲五月天丁香| 免费在线观看影片大全网站| 国产亚洲欧美98| 少妇被粗大的猛进出69影院| 亚洲精品久久午夜乱码| 国产伦人伦偷精品视频| 亚洲欧美精品综合一区二区三区| 大香蕉久久成人网| 最好的美女福利视频网| 黑人猛操日本美女一级片| 久久久水蜜桃国产精品网| 一本大道久久a久久精品| 免费看十八禁软件| 午夜视频精品福利| 性欧美人与动物交配| 午夜免费观看网址| 9191精品国产免费久久| 亚洲欧美一区二区三区黑人| 亚洲五月色婷婷综合| bbb黄色大片| 国产成人系列免费观看| 国产人伦9x9x在线观看| 欧美日本中文国产一区发布| 老司机亚洲免费影院| 在线观看午夜福利视频| 亚洲av成人不卡在线观看播放网| 夫妻午夜视频| 亚洲av日韩精品久久久久久密| 老司机亚洲免费影院| 欧美乱妇无乱码| 色在线成人网| 黑人欧美特级aaaaaa片| 少妇裸体淫交视频免费看高清 | 一个人观看的视频www高清免费观看 | 手机成人av网站| 男人的好看免费观看在线视频 | 成年女人毛片免费观看观看9| 国产精品免费一区二区三区在线| 亚洲欧美一区二区三区久久| 国产精品 国内视频| 妹子高潮喷水视频| www国产在线视频色| 日韩欧美三级三区| 亚洲专区字幕在线| 一区二区三区精品91| 欧美日本亚洲视频在线播放| 欧美大码av| 久久久国产精品麻豆| 777久久人妻少妇嫩草av网站| 亚洲色图 男人天堂 中文字幕| 精品人妻1区二区| 法律面前人人平等表现在哪些方面| 十八禁网站免费在线| 免费日韩欧美在线观看| 99精品久久久久人妻精品| 天天躁狠狠躁夜夜躁狠狠躁| 久久影院123| 国产av精品麻豆| 日韩中文字幕欧美一区二区| 一进一出抽搐动态| 国产蜜桃级精品一区二区三区| 免费一级毛片在线播放高清视频 | 高清在线国产一区| 免费高清在线观看日韩| 亚洲欧美激情在线| aaaaa片日本免费| 国产一卡二卡三卡精品| 美女福利国产在线| 久久久久国内视频| 国产野战对白在线观看| 国产精品一区二区在线不卡| 日韩欧美免费精品| 老汉色∧v一级毛片| 欧美丝袜亚洲另类 | 久久性视频一级片| 国产男靠女视频免费网站| 久久国产精品人妻蜜桃| 俄罗斯特黄特色一大片| 不卡一级毛片| 亚洲avbb在线观看| 午夜福利免费观看在线| 九色亚洲精品在线播放| 日本撒尿小便嘘嘘汇集6| 在线免费观看的www视频| 亚洲自偷自拍图片 自拍| 亚洲五月婷婷丁香| 亚洲成人免费av在线播放| 国产日韩一区二区三区精品不卡| 99精国产麻豆久久婷婷| 超碰97精品在线观看| 自拍欧美九色日韩亚洲蝌蚪91| 国产一区二区激情短视频| 久热爱精品视频在线9| 美女 人体艺术 gogo| 亚洲精品一二三| 国产精品久久久久成人av| 久久香蕉激情| 国产免费av片在线观看野外av| 搡老熟女国产l中国老女人| 香蕉国产在线看| 村上凉子中文字幕在线| 脱女人内裤的视频| 69av精品久久久久久| 波多野结衣高清无吗| 中文字幕最新亚洲高清| 男女之事视频高清在线观看| 日韩免费av在线播放| 国产高清videossex| 精品久久久久久久毛片微露脸| 国产亚洲av高清不卡| e午夜精品久久久久久久| 精品乱码久久久久久99久播| 国产精品乱码一区二三区的特点 | 99久久99久久久精品蜜桃| 免费看十八禁软件| 亚洲精品一区av在线观看| 国产精品一区二区免费欧美| 满18在线观看网站| 国产精品影院久久| 亚洲欧美日韩高清在线视频| 母亲3免费完整高清在线观看| 嫩草影视91久久| 国产人伦9x9x在线观看| 亚洲九九香蕉| 999久久久精品免费观看国产| 色综合欧美亚洲国产小说| 19禁男女啪啪无遮挡网站| 777久久人妻少妇嫩草av网站| 日本wwww免费看| 国产精品二区激情视频| 欧美激情久久久久久爽电影 | 日韩免费高清中文字幕av| 成人黄色视频免费在线看| 国产av一区二区精品久久| 又黄又粗又硬又大视频| 国产熟女午夜一区二区三区| 久久久久亚洲av毛片大全| 亚洲在线自拍视频|