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

    平行泊車路徑規(guī)劃與跟蹤控制仿真分析

    2022-07-08 10:05:22覃立仁張成濤楊航趙浙棟譚澤旦
    廣西科技大學(xué)學(xué)報 2022年3期
    關(guān)鍵詞:模型預(yù)測控制路徑規(guī)劃

    覃立仁 張成濤 楊航 趙浙棟 譚澤旦

    摘? 要:隨著汽車保有量的增多,泊車環(huán)境變得復(fù)雜,駕駛經(jīng)驗不足的駕駛員難以安全地完成平行泊車操作,泊車安全性問題成為研究熱點。結(jié)合某款車型參數(shù),針對平行泊車的路徑規(guī)劃和路徑跟蹤問題進(jìn)行研究和分析。根據(jù)三階貝塞爾曲線的性質(zhì),基于車輛運(yùn)動學(xué)采用兩段三階貝塞爾曲線和倒推法規(guī)劃出一條無碰撞的參考路徑,利用模型預(yù)測控制進(jìn)行路徑跟蹤,最后通過Simulink與Carsim進(jìn)行聯(lián)合仿真,得到的軌跡曲率連續(xù)且安全無碰撞,軌跡跟蹤結(jié)果與參考軌跡基本吻合,驗證了利用該方法進(jìn)行平行泊車的路徑規(guī)劃與跟蹤控制的可行性。

    關(guān)鍵詞:平行泊車;路徑規(guī)劃;路徑跟蹤;貝塞爾曲線;模型預(yù)測控制

    中圖分類號:U491.7? ? ? ? ? ?DOI:10.16375/j.cnki.cn45-1395/t.2022.03.003

    0? ? 引言

    隨著科學(xué)技術(shù)的發(fā)展和經(jīng)濟(jì)的增長,汽車逐漸成為重要的交通工具,給人們的出行帶來了便利,但也造成了許多交通事故,其中由泊車引起的交通事故約占1/5。面對復(fù)雜的泊車環(huán)境,即使經(jīng)驗豐富的駕駛員也需要小心翼翼地反復(fù)調(diào)整才能將車輛安全地駛?cè)胲囄弧km然現(xiàn)在很多汽車都安裝倒車?yán)走_(dá)、倒車影像等輔助泊車裝置,但駕駛員的視野仍會受到一定的限制,對車輛周圍的環(huán)境觀察不到位,導(dǎo)致泊車過程中與其他車輛、行人等發(fā)生碰撞,造成經(jīng)濟(jì)損失或危及人們的生命安全。因此,研究者們對自動泊車系統(tǒng)開展研究,以期能有效解決泊車問題。

    對于路徑規(guī)劃與跟蹤問題,Kim等[1]采用兩段圓弧添加一段直線的方式來規(guī)劃泊車路徑,這種方式雖然簡單,但是得到的路徑曲率不連續(xù),增加了路徑跟蹤難度。Gómez-Bravo等[2]采用兩段相切的圓弧的方式來規(guī)劃泊車路徑,基于模糊控制理論設(shè)計控制規(guī)則,但控制精度不高。Demirli等[3]采用多項式曲線和模糊控制網(wǎng)絡(luò)來規(guī)劃泊車路徑,但該方法計算量較大。吳中偉等[4-6]采用B樣條曲線進(jìn)行路徑規(guī)劃設(shè)計,得到了曲率連續(xù)路徑,但是參數(shù)較多,求解過程較為復(fù)雜。Moon等[7]運(yùn)用逆向泊車的方式,用貝塞爾曲線和圓弧的方式得到了一條曲率連續(xù)的泊車路徑,但利用兩種線形規(guī)劃來計算控制點的方式比較復(fù)雜。

    本文基于貝塞爾曲線的性質(zhì)采用倒推法進(jìn)行軌跡規(guī)劃,利用兩段三階貝塞爾曲線進(jìn)行平行泊車參考軌跡規(guī)劃,結(jié)合車輛和泊車位的約束條件,計算貝塞爾曲線各個控制點的坐標(biāo),規(guī)劃出一條無碰撞的參考軌跡;結(jié)合車輛運(yùn)動學(xué)模型,利用模型預(yù)測控制來實現(xiàn)軌跡跟蹤。

    1? ? 車輛運(yùn)動學(xué)建模

    在泊車過程中,車輛速度一般不會大于10 km/h。假設(shè)車輛在行使過程中車輪不會發(fā)生側(cè)向滑動,沒有產(chǎn)生側(cè)向力,車輛的側(cè)向速度為0,車輪的側(cè)偏角為0°[8]。因此,基于阿克曼轉(zhuǎn)向原理對汽車運(yùn)動模型進(jìn)行簡化,建立車輛運(yùn)動學(xué)模型[9-12]。本文針對低速的泊車場合,基于阿克曼轉(zhuǎn)向原理建立的車輛運(yùn)動學(xué)模型如圖1所示。

    設(shè)[xf, yf]為車輛前軸中點坐標(biāo),[xr, yr]為后軸中點坐標(biāo),[φ]為車身橫擺角,[φ]為橫擺角速度,[χ]和[y]為慣性坐標(biāo)系下車輛在x軸和y軸的速度,[l]為車輛的軸距,取后軸中心點速度[νr]為整車速度[ν],[δ]為車輛的前輪轉(zhuǎn)角。車輛的運(yùn)動學(xué)方程可表示為:

    [χ=νcosφ? ?y=νsinφ? ? φ=νtan(δ/l)?χyφ=νcosφνsinφνtan(δ/l)=f1f2f3] .? ? (1)

    2? ? 平行泊車參考路徑

    2.1? ?參考路徑設(shè)計

    依據(jù)現(xiàn)實生活中的平行泊車情況,初步規(guī)劃出平行泊車的參考路徑示意圖如圖2所示。

    通過圖2可以看出,平行泊車軌跡中間的曲率變化率較大,而利用兩段三階貝塞爾曲線可以擬合曲率變化較大的曲線,因此,本文采用兩段三階貝塞爾曲線來規(guī)劃出平行泊車的參考軌跡。

    假設(shè)[A]、[B]、[C]和[D]是曲線[AD]的貝塞爾曲線控制點,那么以[u]為參數(shù)變量的三階貝塞爾曲線方程可以表達(dá)如下:

    [Q(u)=A(1-u)3+3B(1-u)2u+]

    [3C(1-u)u2+Du3] .? ? ? ? ? ? ? ? ? ? (2)

    貝塞爾曲線[13]具有以下特性:

    1)在貝塞爾曲線中,只有起點和終點在曲線上,其他點均為調(diào)整曲線形狀和結(jié)束的控制點;

    2)貝塞爾曲線通過起始點和終止點,并與起始點和終止點的折線相切,在對泊車路徑進(jìn)行規(guī)劃時,可根據(jù)曲線的起始點和終止點的切線方向確定泊車起始點姿態(tài)和目標(biāo)點姿態(tài);

    3)至少需要三階貝塞爾曲線才能生成曲率連續(xù)的路徑,三階貝塞爾曲線均由2個端點和2個柄點共4個控制點進(jìn)行控制,其中每個控制點的改變,均會影響這段曲線的所有部分[14]。

    2.2? ?控制點的選擇

    根據(jù)貝塞爾曲線的特性并聯(lián)系實際平行泊車情況,利用倒推法(安全停放在車位里的車輛駛離車位進(jìn)入道路)確定平行泊車參考軌跡貝塞爾曲線的控制點坐標(biāo)。忽略后視鏡的影響把車輛看作一個長方形,首先尋找第一段貝塞爾曲線軌跡的控制點,如圖3所示。車輛在停車位時,車尾與泊車位的后邊線存在一段安全距離,記為[S1],與旁邊邊界存在一段安全距離,記為[d]。根據(jù)車輛結(jié)構(gòu)和環(huán)境條件的約束,車輛駛離停車位時車頭右前端要與泊車位前角保持一段安全距離,記為[S2],這樣才能保證車輛的泊車安全。

    假設(shè)車輛后懸的長度為[Lf] ,車身寬度為[W],則第一段貝塞爾曲線軌跡的第一個控制點[A]的坐 標(biāo)為:

    [A(x, y)={S1+Lf,-W2-d}] .? ? ? ? ?(3)

    根據(jù)阿克曼轉(zhuǎn)向原理可知,車輛的轉(zhuǎn)向中心點位于車輛后軸的延長線上,泊車過程中車輛處于位置[P]的后軸延長線與車輛處于位置[P1]的后軸延長線相交于一點[Z],即Z點為車輛的轉(zhuǎn)向瞬心。車輛從位置[P]行駛至位置[P1]時,轉(zhuǎn)過的角度為[θ],如圖3所示。設(shè)車輛在此參考位置的轉(zhuǎn)向半徑為[R1],根據(jù)幾何關(guān)系算出[θ]的值和第三個控制點[C]的坐標(biāo)。

    設(shè)停車位長度為[Lp],車輛軸距為l,前懸長度為[Lb],則[θ]的值為:

    [θ=arctanLp-S1-S2-LfR1-0.5W-d-]

    [arctanl+LbR1+0.5W] .? ? ? ? ? ? ? ? ? ? ? ?(4)

    控制點[C]的坐標(biāo)為:

    [Cx, y={S1+Lf+R1 sinθ,R11-cosθ -0.5W-d}] .? (5)

    由于泊車結(jié)束時要保證車輛平行于泊車位,則第一個控制點[A]處的斜率應(yīng)該為0。根據(jù)三階貝塞爾曲線的性質(zhì)(三階貝塞爾曲線起點處的斜率由前2個控制點決定,終點處的斜率由后2個控制點決定),第二個控制點[B]應(yīng)該和第一個控制點[A]處于同一水平線上,如圖3所示。根據(jù)幾何關(guān)系可以算出第二個控制點[B]的坐標(biāo)為:

    [Bx, y=Cx-Cy-Aytanθ,Ay].? ? (6)

    第一段貝塞爾曲線軌跡的第四個控制點如圖4所示。為了保證車輛駛離泊車位進(jìn)入道路時車尾不與泊車位前角發(fā)生碰撞,所以車輛繼續(xù)向前行駛,直到車輛的后軸延長線與車身相交的點和泊車位的前角存在一段安全距離后,才能保證泊車的安全性,所以第四個控制點為車輛在此參考位置的后軸中心點[D]。

    根據(jù)幾何關(guān)系可計算出第四個控制點[D]的坐標(biāo)為:

    [Dx, y={C(x)+(l+Lb)cosθ,C(y)+(l+Lb)sinθ}].? ?(7)

    至此,第一段貝塞爾曲線的4個點已經(jīng)全部求出,需要調(diào)整方向駛?cè)氲缆贰8鶕?jù)貝塞爾曲線的性質(zhì)(貝塞爾曲線通過起始點和終止點,并與起始點和終止點的折線相切),第二段貝塞爾曲線軌跡的起點[A1]必然經(jīng)過第一段貝塞爾曲線的第四個點[D],所以第二段貝塞爾曲線軌跡的起點[A1]為:

    [A1x, y=Dx, y] .? ? ? ? ? ? ? ? ? ?(8)

    為了保證泊車軌跡的平順,兩段貝塞爾曲線的相交處斜率相同,所以第二段貝塞爾曲線軌跡的第二個控制點[B1]應(yīng)在第一段貝塞爾曲線的控制點[BC]的延長線上。由于泊車的初始點車身擺正與車位平行,所以車輛要轉(zhuǎn)過[θ]角度才能保證車身擺正,因此,車輛轉(zhuǎn)過[θ]角度后的后軸中心為第二段貝塞爾曲線軌跡的第三個控制點[C1]。為了避免泊車起始就原地轉(zhuǎn)向,在[C1]點前1 m處設(shè)置一個新的起點[D1]給車輛一個緩沖,則[D1]為第二段貝塞爾曲線軌跡的最后一個控制點。[C1D1]的延長線與[BC]的延長線交于一點,這個點為第二段貝塞爾曲線軌跡的第二個控制點[B1]。第二段貝塞爾曲線軌跡的控制點如圖5所示。

    [Z1]點為車輛的轉(zhuǎn)向瞬心,[R2]為轉(zhuǎn)向半徑。根據(jù)幾何關(guān)系可以求出第二段貝塞爾曲線軌跡的所有控制點的坐標(biāo)。

    [C1]的坐標(biāo)為:

    [C1x, y={A1(x)+R2 sinθ,A1(y)+R2(1-cosθ)}] ,? ? (9)

    [D1]的坐標(biāo)為:

    [D1x, y={C1x+1,C1 y}] ,? ? ? (10)

    [B1]的坐標(biāo)為:

    [B1x, y=A1x+C1y-A1ytanθ,D1y]. (11)

    綜上,兩段三階貝塞爾曲線規(guī)劃出來的平行泊車參考軌跡的所有控制點的坐標(biāo)表達(dá)式已經(jīng)全部 求出。

    2.3? ?生成參考軌跡

    參考軌跡與車輛參數(shù)和泊車位參數(shù)有關(guān)?,F(xiàn)選用某車型作為研究車輛,其參數(shù)如表1所示。

    小型平行泊車位的標(biāo)準(zhǔn)尺寸為長6 m,寬2.5 m[15]。把目標(biāo)車輛參數(shù)和泊車位參數(shù)代入平行泊車參考軌跡控制點的坐標(biāo)表達(dá)式,求出所有控制點的坐標(biāo)。各控制點的坐標(biāo)如表2所示。

    將表2中各控制點的坐標(biāo)代入MATLAB的貝塞爾曲線程序,生成兩段三階貝塞爾曲線,即為平行泊車參考軌跡,如圖6所示。

    3? ? 車輛泊車路徑跟蹤控制

    運(yùn)動控制作為平行泊車的重要組成部分,只有規(guī)劃合適的泊車路徑和合理的軌跡跟蹤才能保證泊車成功。

    模型預(yù)測控制是一種特殊的控制方法,是一種多變量控制策略,是通過描述系統(tǒng)動力學(xué)的系統(tǒng)模型來預(yù)測未來的狀態(tài)和輸出,然后根據(jù)目標(biāo)函數(shù)計算系統(tǒng)的最優(yōu)控制輸入[16-18]。

    3.1? ?模型

    車輛運(yùn)動學(xué)模型的運(yùn)動方程為式(1)。

    設(shè)選取的狀態(tài)量為[χ=[x, y, φ]T],選取的控制量為[u=[ν, δ]T],對于參考軌跡的任意一個參考點用[r]表示,將式(1)改寫成:

    [χ=fχ, u?χr=f(χr, ur)] .? ? ? ? ?(12)

    該車輛運(yùn)動學(xué)模型非線性,需要將其線性化?;谶\(yùn)動高等數(shù)學(xué)中泰勒級數(shù)展開的思想將其線性化:

    [χ=f(χr, ur)+?f(χ, u)?χ(χ-χr)+?f(χ, u)?uu-ur] . (13)

    進(jìn)行前向歐拉離散化得到:

    [χ=χ-χry-yrφ-φr?χ=Mχ+Nu] ,? ? ? ? ?(14)

    [M=?f?χ=00-νrsinφr00νrcosφr000],? ? ? ? ? ? (15)

    [N=?f?u=cosφrsinφrtanφr/l00νr/lcos2δr] .? ? ? ? ?(16)

    此時獲得了非線性運(yùn)動模型。但基于MPC的原理,需要利用運(yùn)動學(xué)模型進(jìn)行遞歸運(yùn)算,將連續(xù)的運(yùn)動學(xué)模型轉(zhuǎn)換成離散的運(yùn)動學(xué)模型,利用數(shù)值分析中的前向歐拉離散化,得到:

    [χk+1=TM+Eχk+TNuk=Mχk+Nuk].(17)

    其中:[T]為采樣時間,[E]為單位向量。

    基于MPC控制理論,控制量需要用控制量差值來表示,因此,需進(jìn)一步改進(jìn)該模型,構(gòu)建新的狀態(tài)向量:

    [ξk=χkuk-1] ,? ? ? ? ? ? ? ?(18)

    [ξk+1=χk+1uk=Mξk+NΔuk] .? (19)

    得到新的狀態(tài)空間表達(dá)式,可以對該表達(dá)式進(jìn)行改進(jìn),得到輸出方程:

    [ηk=ENx0χkuk-1=Gξk] .? ? (20)

    3.2? ?預(yù)測

    利用線性誤差模型構(gòu)建預(yù)測時域內(nèi)的狀態(tài)量誤差輸出量。

    構(gòu)建好線性誤差模型后,利用該模型進(jìn)行狀態(tài)量誤差預(yù)測。本文已經(jīng)由[ξ(k)]預(yù)測出了[ξ(k+1)],需預(yù)測未來[Np]個時刻的[ξ],推導(dǎo)流程如下:

    [ξ(k+1)=Mξ(k)+NΔuk,ξ(k+2)=M2ξ(k)+MNΔuk+NΔu(k+1),ξ(k+3)=M3ξ(k)+M2NΔu(k)+? ? ? ? ? ? ? ? ? ? MNΔu(k+1)NΔu(k+2),? ? ? ? ? ? ? (21)? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ?ξ(k+Np)=MNpξ(k)+MNp-1NΔu(k)+? ? ? ? ? ? ? ? MNp-2NΔu(k+1)+M0NΔu(k+Np-1).]

    [ηk+1=GMξk+GNuk,η(k+2)=GM2ξ(k)+GMNΔu(k)+? ? ? ? ? ? ? ? ? ? ? ?GNΔu(k+1),η(k+3)=GM3ξ(k)+GM2NΔu(k)+? ? ? ? ? ? ? ? ? ? ? GMNΔu(k+1)+GNΔu(k+2), (22)? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ?η(k+Np)=GMNpξ(k)+GMNp-1NΔu(k)+? ? ? ? ? ? ? ? ? ? ? ? ?GMNp-2NΔu(k+1)+…+? ? ? ? ? ? ? ? ? ? ? ? ?GM0NΔu(k+Np-1).? ? ? ? ? ? ? ? ? ]

    [Np]為模型預(yù)測算法中的預(yù)測時域。綜合上述推導(dǎo),可以得到輸出方程:

    [Y=Ψξk+ΘΔU] .? ? ? ? ? ? ? (23)

    其中:

    [Y=ηk+1ηk+2?ηk+Np,Ψ=GMGM2?GMNp, ΔU=Δu(k)Δu(k+1)?Δu(k+Np-1),]

    [Θ=GN0…0GMNGN…0???GMNp-1NGMNp-2N…GM0N] .

    3.3? ?控制

    構(gòu)建目標(biāo)函數(shù)和約束方程。

    將目標(biāo)表達(dá)式用二次型表示,得到目標(biāo)函數(shù):

    [J=YTQQY+ΔUTRRΔU] .? ? ? ? ? (24)

    其中:[Q]為輸出權(quán)重矩陣,[R]為控制增量權(quán)重矩陣。在控制過程中希望只有控制量增量這一個自變量,因此,對表達(dá)式進(jìn)行變換:

    [I=Ψξk ,QQ=ENp?Q ,RR=ENp .]? ? ? ? ? ? ? ? ? ? ? ? (25)

    式中:[?]為克羅內(nèi)克積。

    得到目標(biāo)函數(shù):

    [J=ΔUT(ΘTQQΘ+RR)ΔU+2ITQQΘΔU-]

    [YrQQΘΔU+ITQQI+YrTQQY-2YrTQQI] .? (26)

    MPC約束函數(shù)主要是針對控制量的增量以及控制量,由于本文控制的輸入是控制量的增量,因此定義:

    [ΔUmin≤ΔU≤ΔUmax] .? ? ? ? ? ? ?(27)

    [Umin]和[Umax]分別為控制時域內(nèi)控制量的最小值、最大值集合。

    對于控制量的約束,需要進(jìn)行公式遞推,進(jìn)而利用控制量增量來表達(dá)。已知某一時刻的控制量可以由上一時刻的控制量和這一時刻的控制量增量組成,即:

    [uk=uk-1+Δuk+1,uk+1=uk-1+Δuk+Δuk+1,? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ?? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? (28)uk+Nc-1=uk-1+Δuk+? ? ? Δuk+1+…+Δuk+Nc-1.]

    式中:[Nc]為控制時域。

    將式(28)改寫成:

    [U=uk-1uk-1?uk-1+E000EE00????EEEEΔukΔuk+1?Δuk+Nc-1] .? (29)

    式(29)可簡化為:

    [U=Ut+M1ΔU] .? ? ? ? ? ? ? ?(30)

    利用控制量的約束,將約束函數(shù)改寫成控制量增量的形式:

    [uminumin?umin≤ukuk+1?uk+Nc-1≤umaxumax?umax] .&nbsp; ? ? ? ?(31)

    式(31)可簡化為:

    [M1ΔU≤Umax-U ,-M1ΔU≤Umin-Ut .]? ? ? ? ? ? ? ?(32)

    4? ? 基于Carsim與Simulink的聯(lián)合仿真試驗

    4.1? ? 基于Carsim的仿真模型設(shè)置

    試驗車輛參數(shù)設(shè)置如圖7所示。以Carsim數(shù)據(jù)庫中的E-Class、 Sedan車作為原型進(jìn)行建模,根據(jù)試驗車的參數(shù),在軟件中設(shè)定好仿真車輛的整車質(zhì)量、尺寸、軸距、轉(zhuǎn)動慣量等主要參數(shù),其他參數(shù)默認(rèn)為數(shù)據(jù)庫原型車的本來參數(shù)。

    試驗泊車位場景如圖8所示。根據(jù)小型平行泊車位的標(biāo)準(zhǔn)尺寸(長6 m,寬2.5 m),搭建了3個平行泊車位。選擇直線道路,路面摩擦系數(shù)為0.85。

    4.2? ?聯(lián)合仿真模型搭建

    聯(lián)合仿真模型如圖9所示,主要由Carsim車輛模型、MPC追蹤算法模型、停車制動模型、車輛前輪轉(zhuǎn)角轉(zhuǎn)換模型和車輛橫、縱坐標(biāo)轉(zhuǎn)換模型? ? ?組成。

    Carsim車輛模型:輸入左、右前輪轉(zhuǎn)角和制動主缸壓力,輸出車輛當(dāng)前行駛狀態(tài)的橫、縱坐標(biāo)和車輛橫擺角。

    MPC追蹤算法模型:輸入車輛當(dāng)前行駛狀態(tài)的橫、縱坐標(biāo)和車輛橫擺角,輸出前輪轉(zhuǎn)角。

    停車制動模型:當(dāng)檢測到車輛實際行駛狀態(tài)的橫坐標(biāo)到達(dá)終止值時,給車輛發(fā)送制動信號使其 停車。

    車輛前輪轉(zhuǎn)角轉(zhuǎn)換模型:由于Carsim模型使用角度制,而Simulink使用弧度制,需要進(jìn)行數(shù)學(xué)轉(zhuǎn)換。Simulink中MPC追蹤模型輸出的前輪轉(zhuǎn)角是車輛模型的前輪轉(zhuǎn)角,需要轉(zhuǎn)換成Carsim模型中的前輪左、右轉(zhuǎn)角。

    車輛橫縱坐標(biāo)轉(zhuǎn)換模型:由于Carsim模型的橫、縱坐標(biāo)是基于質(zhì)心點,而Simulink中MPC追蹤模型所使用的車輛橫、縱坐標(biāo)是基于后軸中心,因此,Carsim模型中輸出車輛的橫軸坐標(biāo)和車輛橫擺角時需要進(jìn)行數(shù)學(xué)轉(zhuǎn)換。

    5? ? 聯(lián)合仿真試驗結(jié)果分析

    通過Simulink將聯(lián)合仿真模型進(jìn)行仿真,將得到的聯(lián)合仿真泊車軌跡與參考軌跡進(jìn)行對比分析,泊車軌跡與參考軌跡如圖10所示,其中小圖為軌跡的局部放大圖。由圖可以看出,泊車軌跡與參考軌跡基本吻合,說明設(shè)計的MPC模型的跟蹤效果較為良好。

    通過Simulink運(yùn)行聯(lián)合仿真模型,得到泊車過程中前輪轉(zhuǎn)角的變化如圖11所示??梢钥闯觯囕v的車輪轉(zhuǎn)角最大值約為29°,小于允許的最大值30°;泊車過程中前輪轉(zhuǎn)角的變化是連續(xù)的,而且比較平緩。

    通過Carsim軟件運(yùn)行聯(lián)合仿真模型后,在Carsim中搭建的試驗車泊車位場景中觀察車輛的運(yùn)行狀態(tài),車輛泊車軌跡跟蹤如圖12所示。圖12(a)為車輛在泊車起始位置的狀態(tài),此時車輛與車位平行且與車位保持一定的安全距離;圖12(b)為車輛泊車過程中車輛后輪即將進(jìn)入泊車位的狀態(tài),此時車輛后輪與車位的右前角保持一定的安全距離,沒有造成壓角;圖12(c)為車輛泊車過程中車輛前輪即將進(jìn)入泊車位的狀態(tài),此時車輛前輪與車位的右前角保持一定的安全距離,沒有造成壓角;圖12(d)與圖12(e)為車輛泊車結(jié)束的狀態(tài),可以看出車輛與泊車位四周的畫線都保持一定的安全距離;圖12(f)為平行泊車全過程的狀態(tài),可以看出車輛安全進(jìn)入了泊車位,成功地進(jìn)行了泊車操作。

    由此可知,本試驗所規(guī)劃的泊車參考軌跡能滿足該試驗車的安全泊車要求,所設(shè)計的軌跡跟蹤方法能使該試驗車具有良好的跟蹤軌跡,在此條件下,該試驗車能安全地完成泊車操作。

    6? ? 結(jié)論

    利用兩段三階貝塞爾曲線規(guī)劃泊車參考軌跡可解決軌跡曲率不連續(xù)的問題,可以得到比較平滑的泊車軌跡。根據(jù)車輛參數(shù)與車位參數(shù)計算出控制點,生成合適該參數(shù)的泊車軌跡,通過仿真驗證了該軌跡規(guī)劃方式在平行泊車中的可行性。針對軌跡跟蹤的復(fù)雜性,選用模型預(yù)測控制跟蹤算法,將運(yùn)動學(xué)模型線性化、離散化,構(gòu)建新狀態(tài)向量,得到線性誤差模型;利用線性誤差模型構(gòu)建預(yù)測時域內(nèi)的狀態(tài)量誤差輸出量,構(gòu)建目標(biāo)函數(shù)和約束方程;最后通過仿真驗證了該算法在平行泊車軌跡跟蹤方面的可行性。

    參考文獻(xiàn)

    [1]? ? ?KIM D,CHUNG W,PARK S.Practical motion planning for car-parking control in narrow environment[J].IET Control Theory and Applications,2010,4(1):129-139.

    [2]? ? ?GóMEZ-BRAVO F,CUESTA F,OLLERO A. Parallel and diagonal parking in nonholonomic autonomous vehicles[J].Engineering Applications of Artificial Intelligence,2001,14(4):419-434.

    [3]? ? ?DEMIRLI K,KHOSHNEJAD M.Autonomous parallel parking of a car-like mobile robot by a neuro-fuzzy sensor-based controller[J].Fuzzy Sets and Systems,2009,160(19):2876-2891.

    [4]? ? ?吳中偉.乘用車自動泊車系統(tǒng)路徑規(guī)劃與仿真分析[D].廣州:華南理工大學(xué),2018.

    [5]? ? ?葉茂.基于B樣條的多段式平行泊車軌跡規(guī)劃研究[D].西安:長安大學(xué),2020.

    [6]? ? ?李紅,王文軍,李克強(qiáng).基于B樣條理論的平行泊車路徑規(guī)劃[J].中國公路學(xué)報,2016,29(9):143-151.

    [7]? ? ?MOON J,BAE I,CHA J G,et al. A trajectory planning method based on forward path generation and backward tracking algorithm for automatic parking systems[C]//17th IEEE International Conference on Intelligent Transportation Systems. IEEE,2014:719-724.

    [8]? ? ?李臣旭,馬世典,江紹康,等.基于CarSim與Matlab的泊車路徑跟蹤控制模型設(shè)計[J].汽車實用技術(shù),2019(14):47-49.

    [9]? ? ?張馳.基于連續(xù)曲率的平行泊車路徑規(guī)劃研究[D].合肥:合肥工業(yè)大學(xué),2015.

    [10]? ?王國棟,張華強(qiáng),蘇慶華.基于運(yùn)動學(xué)模型的軌跡跟蹤方法研究[J].科技創(chuàng)新與應(yīng)用,2021,11(25):109-110,113.

    [11]? ?譚光興,符丹丹,丁穎,等.基于擴(kuò)展卡爾曼濾波的汽車行駛狀態(tài)估計[J].廣西科技大學(xué)學(xué)報,2020,31(1):18-24,44.

    [12]? ?王鵬,陶小松,陳樂,等.低速四輪轂電動汽車電子差速控制仿真[J].廣西科技大學(xué)學(xué)報,2019,30(2):46-52,78.

    [13]? ?ARASTEH S T,KALISZ A.Conversion between cubic bezier curves and catmull-rom splines[J].SN Computer Science,2021,2(5):398.

    [14]? ?劉學(xué)問,陶鈞,徐海巍.基于三階貝塞爾曲線的AGV軌跡規(guī)劃研究[J].工業(yè)控制計算機(jī),2018,31(1):113-114.

    [15]? ?李婭,祖永昶,司宇琪,等. 公安行業(yè)標(biāo)準(zhǔn)《城市道路路內(nèi)停車位設(shè)置規(guī)范》(GA/T 850—2021)解析[J]. 中國標(biāo)準(zhǔn)化,2021(19):186-191.

    [16]? ?劉楠.基于MPC的無人駕駛車輛軌跡跟蹤控制研究[D].西安:西安理工大學(xué),2021.

    [17]? ?辛鵬.自動駕駛車輛的路徑跟蹤模型預(yù)測控制方法研究[D].蘭州:蘭州理工大學(xué),2021.

    [18]? ?李威.模型預(yù)測控制在軌跡規(guī)劃和車輛控制中的應(yīng)用研究[D].杭州:浙江大學(xué),2021.

    Parallel parking path planning and tracking control

    simulation analysis

    QIN Liren, ZHANG Chengtao*, YANG Hang, ZHAO Zhedong, TAN Zedan

    (School of Mechanical and Automotive Engineering, Guangxi University of Science and Technology,

    Liuzhou 545616, China)

    Abstract: Parking safety has become a hot topic of current research as the inexperienced drivers cannot complete parallel parking operation in complicated parking environment with the increase of the number of cars. This paper studies and analyzes the path planning and path tracking of parallel parking based on the parameters of a certain vehicle model. Firstly, a collision-free reference path is drawn based on vehicle kinematics with two third-order Bezier curves and backward inference method. Then the path tracking is carried out by using model predictive control. Finally, Simulink and Carsim? ? ? ? ? co-simulation are conducted. The results show the obtained trajectory curvature is continuous and safe without collision. The trajectory tracking result is consistent with the reference trajectory, which verifies the feasibility of the proposed method for parallel parking path planning and tracking control.

    Key words: parallel parking; path planning; path tracking; Bezier curve; model prediction control

    (責(zé)任編輯:黎? 婭)

    猜你喜歡
    模型預(yù)測控制路徑規(guī)劃
    三相電壓型PWM整流器直接功率控制策略研究
    三相電壓型PWM整流器直接功率控制策略研究
    公鐵聯(lián)程運(yùn)輸和售票模式的研究和應(yīng)用
    基于數(shù)學(xué)運(yùn)算的機(jī)器魚比賽進(jìn)攻策略
    清掃機(jī)器人的新型田埂式路徑規(guī)劃方法
    自適應(yīng)的智能搬運(yùn)路徑規(guī)劃算法
    科技視界(2016年26期)2016-12-17 15:53:57
    AECS—2000在機(jī)組AGC控制中的應(yīng)用
    基于B樣條曲線的無人車路徑規(guī)劃算法
    基于改進(jìn)的Dijkstra算法AGV路徑規(guī)劃研究
    科技視界(2016年20期)2016-09-29 12:00:43
    非完整移動機(jī)器人的模型預(yù)測控制技術(shù)的研究
    科技資訊(2015年4期)2015-07-02 17:55:56
    久久精品国产亚洲av涩爱 | 亚洲av二区三区四区| 国产一区二区三区视频了| 少妇丰满av| 偷拍熟女少妇极品色| 黄片大片在线免费观看| 特大巨黑吊av在线直播| 国产精品99久久久久久久久| 男女午夜视频在线观看| 99国产综合亚洲精品| 国产淫片久久久久久久久 | 亚洲av成人精品一区久久| 国产伦一二天堂av在线观看| 97人妻精品一区二区三区麻豆| 九九热线精品视视频播放| 男人的好看免费观看在线视频| 日本撒尿小便嘘嘘汇集6| 制服丝袜大香蕉在线| 小蜜桃在线观看免费完整版高清| av片东京热男人的天堂| 51国产日韩欧美| 嫁个100分男人电影在线观看| 国产精品美女特级片免费视频播放器| 狠狠狠狠99中文字幕| 麻豆国产97在线/欧美| 精品人妻1区二区| 日韩国内少妇激情av| 欧美成人免费av一区二区三区| 欧美成狂野欧美在线观看| 我要搜黄色片| 午夜福利在线观看吧| 精品熟女少妇八av免费久了| 亚洲人成电影免费在线| 少妇的丰满在线观看| 日韩欧美国产在线观看| 日日夜夜操网爽| 搡老熟女国产l中国老女人| 亚洲午夜理论影院| 国产三级中文精品| 久久久久久大精品| bbb黄色大片| 99精品在免费线老司机午夜| 婷婷精品国产亚洲av在线| 亚洲精品粉嫩美女一区| 日本撒尿小便嘘嘘汇集6| 9191精品国产免费久久| 97人妻精品一区二区三区麻豆| 偷拍熟女少妇极品色| 成年免费大片在线观看| 又黄又爽又免费观看的视频| 中文字幕人成人乱码亚洲影| 国模一区二区三区四区视频| 亚洲在线观看片| 亚洲国产高清在线一区二区三| 久久中文看片网| 欧美成人一区二区免费高清观看| 天堂网av新在线| 精品国产超薄肉色丝袜足j| 亚洲,欧美精品.| 亚洲五月婷婷丁香| 国产高清三级在线| 悠悠久久av| 老汉色av国产亚洲站长工具| 国产中年淑女户外野战色| 国产伦精品一区二区三区四那| 12—13女人毛片做爰片一| 免费高清视频大片| 老司机午夜十八禁免费视频| 欧美乱码精品一区二区三区| 一a级毛片在线观看| 久久6这里有精品| 精品午夜福利视频在线观看一区| 三级男女做爰猛烈吃奶摸视频| 亚洲美女视频黄频| 欧美成狂野欧美在线观看| 中文字幕久久专区| 又粗又爽又猛毛片免费看| 色综合站精品国产| 中出人妻视频一区二区| 日本成人三级电影网站| 床上黄色一级片| 国产成人aa在线观看| 日韩欧美在线乱码| 国产不卡一卡二| 亚洲国产精品成人综合色| 蜜桃久久精品国产亚洲av| 三级男女做爰猛烈吃奶摸视频| 高清日韩中文字幕在线| 亚洲欧美日韩高清专用| 国产亚洲精品一区二区www| 日韩成人在线观看一区二区三区| 国产精品久久久久久人妻精品电影| 熟女少妇亚洲综合色aaa.| 网址你懂的国产日韩在线| 搡女人真爽免费视频火全软件 | 国产 一区 欧美 日韩| 日韩中文字幕欧美一区二区| 国产一区二区三区在线臀色熟女| 老司机福利观看| 欧美日韩精品网址| 国产精品,欧美在线| 一本一本综合久久| 亚洲国产日韩欧美精品在线观看 | www.熟女人妻精品国产| 99久久久亚洲精品蜜臀av| 国产三级黄色录像| 99久久综合精品五月天人人| 亚洲精品影视一区二区三区av| 国产精品亚洲av一区麻豆| 国产探花极品一区二区| 国产私拍福利视频在线观看| 最近在线观看免费完整版| 小蜜桃在线观看免费完整版高清| 精华霜和精华液先用哪个| 亚洲五月天丁香| 国产又黄又爽又无遮挡在线| 欧美+亚洲+日韩+国产| 免费大片18禁| 制服人妻中文乱码| 日韩欧美国产一区二区入口| 亚洲精品影视一区二区三区av| 亚洲人成网站高清观看| 日韩欧美 国产精品| 亚洲熟妇熟女久久| 亚洲成a人片在线一区二区| 一级毛片高清免费大全| 欧美在线黄色| 黄片大片在线免费观看| 一本综合久久免费| 亚洲,欧美精品.| 熟女人妻精品中文字幕| 国产熟女xx| 中文字幕人成人乱码亚洲影| 1024手机看黄色片| 91九色精品人成在线观看| 91av网一区二区| 色精品久久人妻99蜜桃| 日日摸夜夜添夜夜添小说| 亚洲精品一区av在线观看| 国产高清有码在线观看视频| 啦啦啦观看免费观看视频高清| 欧美+亚洲+日韩+国产| 男女之事视频高清在线观看| 亚洲人成网站高清观看| 在线视频色国产色| 毛片女人毛片| 又黄又粗又硬又大视频| 欧美黄色片欧美黄色片| 国产69精品久久久久777片| 激情在线观看视频在线高清| 欧美黑人欧美精品刺激| 久久久国产成人精品二区| 免费无遮挡裸体视频| 丰满人妻一区二区三区视频av | 变态另类成人亚洲欧美熟女| 久久久国产精品麻豆| 婷婷丁香在线五月| 亚洲成人久久性| 一个人免费在线观看的高清视频| 国产久久久一区二区三区| 欧美日韩黄片免| 欧美性猛交黑人性爽| 狂野欧美激情性xxxx| 在线观看66精品国产| 国产国拍精品亚洲av在线观看 | 一区二区三区高清视频在线| 母亲3免费完整高清在线观看| 国产色婷婷99| 国产不卡一卡二| 毛片女人毛片| 日韩精品中文字幕看吧| 五月玫瑰六月丁香| 老司机福利观看| 国产一区二区三区视频了| 国产精品精品国产色婷婷| 又爽又黄无遮挡网站| 一级黄色大片毛片| 久久久精品欧美日韩精品| 精品久久久久久成人av| 精品人妻1区二区| 天天躁日日操中文字幕| 免费av观看视频| 男女下面进入的视频免费午夜| 1024手机看黄色片| 少妇高潮的动态图| 国产一区二区三区在线臀色熟女| 99热这里只有是精品50| 最好的美女福利视频网| 欧美色视频一区免费| 欧美乱色亚洲激情| 天堂√8在线中文| 最新在线观看一区二区三区| 国产免费一级a男人的天堂| 99国产综合亚洲精品| 老师上课跳d突然被开到最大视频 久久午夜综合久久蜜桃 | 国产午夜精品久久久久久一区二区三区 | 国内毛片毛片毛片毛片毛片| av黄色大香蕉| 午夜福利高清视频| 国产成人影院久久av| 亚洲午夜理论影院| 久久精品影院6| 又爽又黄无遮挡网站| 亚洲电影在线观看av| 国产精品女同一区二区软件 | 99久久综合精品五月天人人| 亚洲精品亚洲一区二区| 午夜福利视频1000在线观看| 特级一级黄色大片| 国产精品三级大全| 国产精品永久免费网站| 日韩人妻高清精品专区| 最近最新免费中文字幕在线| 国产精品99久久久久久久久| 色综合站精品国产| 精品一区二区三区av网在线观看| 久久婷婷人人爽人人干人人爱| 亚洲成人久久爱视频| 老司机在亚洲福利影院| 国产伦人伦偷精品视频| 天堂av国产一区二区熟女人妻| 国产不卡一卡二| 久99久视频精品免费| 日韩精品中文字幕看吧| 深爱激情五月婷婷| 日日夜夜操网爽| 午夜a级毛片| 51国产日韩欧美| 小说图片视频综合网站| 99国产精品一区二区蜜桃av| 少妇的逼水好多| 亚洲激情在线av| 熟女人妻精品中文字幕| 国产99白浆流出| 国产伦人伦偷精品视频| 国产亚洲精品综合一区在线观看| 九色成人免费人妻av| 亚洲avbb在线观看| 国产野战对白在线观看| 欧美日韩福利视频一区二区| 99视频精品全部免费 在线| 欧美性感艳星| 国产伦精品一区二区三区四那| 黄色女人牲交| 国产精品久久久久久久久免 | 亚洲自拍偷在线| 成年人黄色毛片网站| 亚洲最大成人中文| 国产黄a三级三级三级人| 亚洲人成网站在线播| 国产三级中文精品| 99精品久久久久人妻精品| 亚洲av五月六月丁香网| 免费大片18禁| 久久精品国产综合久久久| 99热只有精品国产| 90打野战视频偷拍视频| 脱女人内裤的视频| 黄片小视频在线播放| 欧美成人免费av一区二区三区| 国产乱人视频| 一级作爱视频免费观看| 国产一级毛片七仙女欲春2| а√天堂www在线а√下载| 可以在线观看毛片的网站| 亚洲美女视频黄频| 欧美日韩亚洲国产一区二区在线观看| 两个人的视频大全免费| 午夜免费激情av| 国产探花极品一区二区| 免费大片18禁| 亚洲国产日韩欧美精品在线观看 | 免费一级毛片在线播放高清视频| 美女高潮喷水抽搐中文字幕| 午夜久久久久精精品| www日本黄色视频网| 狂野欧美白嫩少妇大欣赏| 精品不卡国产一区二区三区| 岛国在线免费视频观看| 久久精品国产亚洲av涩爱 | 很黄的视频免费| 夜夜看夜夜爽夜夜摸| 搡老妇女老女人老熟妇| 国产熟女xx| 麻豆国产97在线/欧美| 久久久久精品国产欧美久久久| 美女免费视频网站| 亚洲成a人片在线一区二区| 国产探花极品一区二区| 国产爱豆传媒在线观看| 91九色精品人成在线观看| 亚洲人成伊人成综合网2020| 欧美日韩综合久久久久久 | 成人欧美大片| 国产精品久久久久久亚洲av鲁大| 日本 欧美在线| 脱女人内裤的视频| 欧美乱色亚洲激情| 亚洲成人中文字幕在线播放| 欧美黑人巨大hd| 99热这里只有是精品50| 免费在线观看影片大全网站| 国产精品自产拍在线观看55亚洲| 熟女少妇亚洲综合色aaa.| 欧美日韩黄片免| 亚洲国产欧洲综合997久久,| 亚洲第一欧美日韩一区二区三区| 999久久久精品免费观看国产| 中文字幕熟女人妻在线| 精品久久久久久成人av| 在线观看av片永久免费下载| 18禁在线播放成人免费| 亚洲精品456在线播放app | 亚洲黑人精品在线| 色综合欧美亚洲国产小说| 手机成人av网站| 国产精品一区二区三区四区久久| 久99久视频精品免费| 看黄色毛片网站| 国产一区在线观看成人免费| 日韩欧美精品免费久久 | 特级一级黄色大片| 他把我摸到了高潮在线观看| 一进一出抽搐动态| 亚洲av五月六月丁香网| 99在线人妻在线中文字幕| 亚洲欧美精品综合久久99| 免费在线观看影片大全网站| 亚洲av日韩精品久久久久久密| 国产色婷婷99| 五月玫瑰六月丁香| 日韩大尺度精品在线看网址| 国产欧美日韩一区二区三| 亚洲人成网站在线播| 亚洲国产精品sss在线观看| 很黄的视频免费| 伊人久久大香线蕉亚洲五| 欧美色视频一区免费| 欧美三级亚洲精品| 一本一本综合久久| 91久久精品电影网| 欧美日韩一级在线毛片| 成人国产一区最新在线观看| 51国产日韩欧美| 老熟妇仑乱视频hdxx| 欧美成狂野欧美在线观看| 一区二区三区激情视频| 国产亚洲精品久久久com| 小说图片视频综合网站| 美女cb高潮喷水在线观看| 欧美区成人在线视频| 久久精品91无色码中文字幕| 一级黄色大片毛片| 国产精华一区二区三区| 久久精品91蜜桃| a在线观看视频网站| 久久国产精品影院| a在线观看视频网站| 欧美日韩综合久久久久久 | 亚洲av中文字字幕乱码综合| 99久久成人亚洲精品观看| 九九在线视频观看精品| 国产成人福利小说| 国产69精品久久久久777片| 国内精品美女久久久久久| 观看美女的网站| 亚洲第一电影网av| 999久久久精品免费观看国产| 免费高清视频大片| 午夜福利成人在线免费观看| 全区人妻精品视频| 我要搜黄色片| 日日夜夜操网爽| 国产精品香港三级国产av潘金莲| 少妇人妻精品综合一区二区 | 精品国产亚洲在线| 床上黄色一级片| 91麻豆av在线| 欧美最新免费一区二区三区 | 丁香欧美五月| 国产精品久久久人人做人人爽| 日韩欧美国产一区二区入口| 国产欧美日韩精品亚洲av| 亚洲av免费高清在线观看| 午夜免费男女啪啪视频观看 | 久久中文看片网| 亚洲精品456在线播放app | 少妇的丰满在线观看| 亚洲一区二区三区色噜噜| 亚洲七黄色美女视频| 久久人妻av系列| 无遮挡黄片免费观看| 嫁个100分男人电影在线观看| 国产精品亚洲美女久久久| 亚洲熟妇中文字幕五十中出| 亚洲不卡免费看| 97碰自拍视频| 一区二区三区免费毛片| 亚洲无线观看免费| 免费高清视频大片| 国产欧美日韩精品一区二区| 午夜福利免费观看在线| 老司机深夜福利视频在线观看| 狠狠狠狠99中文字幕| 又黄又爽又免费观看的视频| 免费看十八禁软件| 我的老师免费观看完整版| 久99久视频精品免费| 日韩欧美国产一区二区入口| 国产欧美日韩一区二区精品| 一级黄色大片毛片| 12—13女人毛片做爰片一| av天堂在线播放| 欧美zozozo另类| 一区二区三区国产精品乱码| 国产蜜桃级精品一区二区三区| 欧美日韩福利视频一区二区| 国产免费一级a男人的天堂| 操出白浆在线播放| 午夜福利在线在线| 老司机福利观看| 久久精品国产亚洲av香蕉五月| 老师上课跳d突然被开到最大视频 久久午夜综合久久蜜桃 | 精品人妻1区二区| 美女高潮的动态| 啦啦啦免费观看视频1| 中出人妻视频一区二区| www.色视频.com| 九色国产91popny在线| 国产高清视频在线观看网站| 在线播放无遮挡| 男女之事视频高清在线观看| 欧美日韩综合久久久久久 | 亚洲内射少妇av| 一区二区三区国产精品乱码| а√天堂www在线а√下载| av福利片在线观看| 午夜精品久久久久久毛片777| 久久欧美精品欧美久久欧美| 蜜桃亚洲精品一区二区三区| 九九久久精品国产亚洲av麻豆| 制服人妻中文乱码| 国产精品日韩av在线免费观看| 亚洲无线观看免费| 最近最新免费中文字幕在线| 12—13女人毛片做爰片一| aaaaa片日本免费| 国产真实伦视频高清在线观看 | 国产精品美女特级片免费视频播放器| 亚洲自拍偷在线| 亚洲国产精品久久男人天堂| 波多野结衣高清作品| 色综合婷婷激情| а√天堂www在线а√下载| 露出奶头的视频| 在线国产一区二区在线| 狠狠狠狠99中文字幕| 在线a可以看的网站| 毛片女人毛片| 久久久久亚洲av毛片大全| 少妇的丰满在线观看| 99久久精品热视频| 成人一区二区视频在线观看| 欧美一区二区亚洲| 一个人看的www免费观看视频| 欧美成狂野欧美在线观看| 日韩欧美国产一区二区入口| 欧美日韩亚洲国产一区二区在线观看| 亚洲,欧美精品.| 波多野结衣巨乳人妻| 一夜夜www| 亚洲专区国产一区二区| 精品熟女少妇八av免费久了| 美女大奶头视频| 精品人妻一区二区三区麻豆 | 国产伦一二天堂av在线观看| 欧美成人a在线观看| 不卡一级毛片| 成年免费大片在线观看| 久久精品国产亚洲av香蕉五月| 国产精品一区二区免费欧美| 九色成人免费人妻av| 成人欧美大片| 国产欧美日韩精品亚洲av| 国产在视频线在精品| 一区福利在线观看| 亚洲国产中文字幕在线视频| 少妇丰满av| 国产精品久久电影中文字幕| 欧美黑人欧美精品刺激| 在线观看舔阴道视频| 偷拍熟女少妇极品色| 免费av不卡在线播放| 欧美日韩一级在线毛片| 五月伊人婷婷丁香| 夜夜躁狠狠躁天天躁| 极品教师在线免费播放| 欧美日韩综合久久久久久 | 国产成人福利小说| 两性午夜刺激爽爽歪歪视频在线观看| 最后的刺客免费高清国语| 伊人久久大香线蕉亚洲五| 校园春色视频在线观看| 波多野结衣高清作品| 亚洲一区二区三区不卡视频| 亚洲精品久久国产高清桃花| 久久久久久人人人人人| 精品日产1卡2卡| 国产高清视频在线观看网站| 久久精品国产亚洲av涩爱 | 国产色婷婷99| 一夜夜www| 国产午夜福利久久久久久| 桃色一区二区三区在线观看| 宅男免费午夜| 韩国av一区二区三区四区| 夜夜爽天天搞| 亚洲 国产 在线| 欧洲精品卡2卡3卡4卡5卡区| 国产黄a三级三级三级人| 亚洲最大成人中文| 亚洲欧美日韩高清专用| 亚洲精品日韩av片在线观看 | 黄色女人牲交| 人人妻人人看人人澡| 99久久无色码亚洲精品果冻| 一区二区三区高清视频在线| 欧美极品一区二区三区四区| 88av欧美| 搞女人的毛片| 日韩亚洲欧美综合| 亚洲精品日韩av片在线观看 | 最新中文字幕久久久久| 可以在线观看毛片的网站| 亚洲aⅴ乱码一区二区在线播放| 99久久久亚洲精品蜜臀av| 亚洲人成伊人成综合网2020| 午夜影院日韩av| 亚洲精华国产精华精| 久久伊人香网站| 国产精品香港三级国产av潘金莲| 亚洲久久久久久中文字幕| 亚洲精品成人久久久久久| 熟女少妇亚洲综合色aaa.| 色综合亚洲欧美另类图片| 亚洲欧美日韩高清在线视频| 精品久久久久久久毛片微露脸| 又黄又粗又硬又大视频| 久久亚洲真实| 亚洲中文字幕一区二区三区有码在线看| 禁无遮挡网站| 大型黄色视频在线免费观看| 很黄的视频免费| 91字幕亚洲| 18+在线观看网站| 欧美性猛交╳xxx乱大交人| 日韩国内少妇激情av| 日日干狠狠操夜夜爽| 亚洲av五月六月丁香网| 久久亚洲真实| 欧美日韩综合久久久久久 | 亚洲久久久久久中文字幕| 草草在线视频免费看| 亚洲精品乱码久久久v下载方式 | 国产高清videossex| 久久精品国产亚洲av香蕉五月| 熟女少妇亚洲综合色aaa.| www日本黄色视频网| 中出人妻视频一区二区| 亚洲片人在线观看| 亚洲国产精品久久男人天堂| 91麻豆精品激情在线观看国产| 最近最新中文字幕大全电影3| 一二三四社区在线视频社区8| 99热精品在线国产| 露出奶头的视频| 熟妇人妻久久中文字幕3abv| 亚洲av第一区精品v没综合| 搞女人的毛片| 免费看十八禁软件| 色哟哟哟哟哟哟| 热99re8久久精品国产| av国产免费在线观看| 一卡2卡三卡四卡精品乱码亚洲| 97超视频在线观看视频| www日本在线高清视频| 亚洲人与动物交配视频| 色吧在线观看| 久久久久国产精品人妻aⅴ院| 狂野欧美白嫩少妇大欣赏| 宅男免费午夜| www日本在线高清视频| 51国产日韩欧美| 精品乱码久久久久久99久播| 亚洲国产精品合色在线| 99热6这里只有精品| 男女床上黄色一级片免费看| 免费无遮挡裸体视频| 99久久精品国产亚洲精品| 亚洲av成人av| av福利片在线观看| 欧美中文日本在线观看视频| 亚洲国产欧美人成| 全区人妻精品视频| 欧美日韩亚洲国产一区二区在线观看| or卡值多少钱| av在线蜜桃| 国内久久婷婷六月综合欲色啪| 香蕉丝袜av| 老熟妇仑乱视频hdxx| 国产综合懂色| 香蕉丝袜av| 在线观看av片永久免费下载| 国产色爽女视频免费观看| 日韩av在线大香蕉|