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

    線(xiàn)控四輪轉(zhuǎn)向汽車(chē)平行泊車(chē)路徑規(guī)劃與跟蹤控制

    2021-09-26 01:27:30張家旭卜純研王晨趙健
    關(guān)鍵詞:車(chē)輛工程路徑規(guī)劃控制工程

    張家旭 卜純研 王晨 趙健

    摘 ? 要:針對(duì)線(xiàn)控四輪轉(zhuǎn)向汽車(chē)平行泊車(chē)路徑規(guī)劃與跟蹤控制問(wèn)題,提出一種基于改進(jìn)粒子群優(yōu)化算法的平行泊車(chē)路徑規(guī)劃方法和一種基于前饋控制和反饋控制的平行泊車(chē)路徑跟蹤控制策略. 首先,綜合考慮線(xiàn)控四輪轉(zhuǎn)向汽車(chē)運(yùn)動(dòng)學(xué)非完整約束、動(dòng)力和轉(zhuǎn)向子系統(tǒng)的過(guò)程約束和邊界約束、避障約束、泊車(chē)初始位姿和目標(biāo)位姿約束,建立以最小化泊車(chē)過(guò)程總時(shí)長(zhǎng)為目標(biāo)的平行泊車(chē)路徑規(guī)劃約束最優(yōu)化問(wèn)題,并采用可以處理等式約束和不等式約束的粒子群優(yōu)化算法對(duì)其進(jìn)行求解,得到最優(yōu)平行泊車(chē)路徑. 隨后,利用平行泊車(chē)路徑規(guī)劃過(guò)程得到的車(chē)輪轉(zhuǎn)向角作為前饋控制量,并利用汽車(chē)實(shí)際位姿與期望位姿的偏差構(gòu)建PI反饋控制量,實(shí)現(xiàn)對(duì)規(guī)劃的平行泊車(chē)路徑快速、精確和穩(wěn)定的跟蹤控制. 最后,利用車(chē)輛動(dòng)力學(xué)仿真軟件構(gòu)建模型在環(huán)仿真系統(tǒng),驗(yàn)證所提出方法的可行性和有效性. 結(jié)果表明:所提出的方法可以快速、精確和穩(wěn)定地引導(dǎo)線(xiàn)控四輪轉(zhuǎn)向汽車(chē)自動(dòng)完成平行泊車(chē)任務(wù).

    關(guān)鍵詞:車(chē)輛工程;控制工程;線(xiàn)控四輪轉(zhuǎn)向汽車(chē);平行泊車(chē);路徑規(guī)劃;路徑跟蹤控制;改進(jìn)粒子群優(yōu)化算法

    中圖分類(lèi)號(hào):U461.1 ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ?文獻(xiàn)標(biāo)志碼:A

    Parallel Parking Path Planning and Tracking

    Control for Wire-four-wheel Steering Vehicle

    ZHANG Jiaxu1,2,BU Chunyan1,WANG Chen1,ZHAO Jian1

    (1. State Key Laboratory of Automotive Simulation and Control,Jilin University,Changchun 130022,China;

    2. Intelligent Network R&D Institute,China FAW Group Co Ltd,Changchun 130011,China)

    Abstract:Aiming at the parallel parking path planning and tracking control problem for the wire-four-wheel steering vehicle,a novel parallel parking path planning method is proposed based on the improved particle swarm optimization algorithm,and a novel parallel parking path tracking control strategy is proposed based on feedforward and feedback control architecture. Firstly,considering the kinematic non-holonomic constraint of the wire-four-wheel steering vehicle,the process and boundary constraints of the power and steering sub-systems,the obstacle avoidance constraint,the initial parking pose constraint and the target pose constraint,a parallel parking path planning constraint optimization problem with minimizing the parking time is established,and the particle swarm optimization,which can deal with the equality and inequality constraints,is adopted to solve the constraint optimization problem. In order to execute the planned parking path,the desired wheel steering angle is used as the feedforward control quantity,and the PI feedback control quantity is constructed based on the deviation between the actual pose and the expected pose of the vehicle. Finally,the model-in-the-loop simulation system is built based on vehicle dynamics simulation software to verify the feasibility and effectiveness of the proposed method,and the simulation results show that the proposed method can guide the wire-four-wheel steering vehicle to complete the parallel parking task quickly,accurately and stably.

    Key words:vehicle engineering;control engineering;wire-four-wheel steering vehicle; parallel parking; path planning; path tracking control; improved particle swarm optimization algorithm

    汽車(chē)運(yùn)動(dòng)學(xué)非完整約束使得經(jīng)驗(yàn)不足的駕駛員在狹窄環(huán)境內(nèi)難以完成泊車(chē)任務(wù),而自動(dòng)泊車(chē)系統(tǒng)是解決此問(wèn)題的有效手段之一. 在精確感知外界環(huán)境的前提下,泊車(chē)路徑規(guī)劃與跟蹤控制方法是決定自動(dòng)泊車(chē)系統(tǒng)性能的核心要素[1-2]. 因此,深入研究泊車(chē)路徑規(guī)劃與跟蹤控制方法對(duì)于解決汽車(chē)運(yùn)動(dòng)學(xué)非完整約束導(dǎo)致的泊車(chē)難問(wèn)題具有重要的意義.

    泊車(chē)路徑規(guī)劃方法主要有幾何規(guī)劃方法[3-5]、智能規(guī)劃方法[6-7]和優(yōu)化規(guī)劃方法[8-9]. 文獻(xiàn)[3]通過(guò)圓弧、直線(xiàn)和回旋曲線(xiàn)的平移與旋轉(zhuǎn)變換規(guī)劃出曲率連續(xù)的泊車(chē)路徑. 文獻(xiàn)[4]通過(guò)參數(shù)化Gompertz曲線(xiàn)獲得可執(zhí)行的泊車(chē)路徑. 文獻(xiàn)[5]采用圓弧-直線(xiàn)-β樣條曲線(xiàn)組合的方式規(guī)劃出曲率連續(xù)的泊車(chē)路徑. 采用幾何規(guī)劃方法得到的泊車(chē)路徑適用場(chǎng)景受限于初始泊車(chē)位姿、泊車(chē)位和不規(guī)則障礙物信息等,可行的泊車(chē)起始區(qū)域較小. 文獻(xiàn)[6]利用熟練駕駛員的泊車(chē)數(shù)據(jù)訓(xùn)練神經(jīng)網(wǎng)絡(luò),使其可以模擬熟練駕駛員完成泊車(chē)任務(wù). 文獻(xiàn)[7]利用自適應(yīng)神經(jīng)模糊推理系統(tǒng)學(xué)習(xí)熟練駕駛員的泊車(chē)操作,進(jìn)而自動(dòng)完成泊車(chē)任務(wù). 采用智能規(guī)劃方法得到的泊車(chē)路徑適用場(chǎng)景受限于訓(xùn)練樣本的規(guī)模和多樣性,泛化能力較弱. 文獻(xiàn)[8]將泊車(chē)路徑規(guī)劃問(wèn)題轉(zhuǎn)化為約束最優(yōu)化問(wèn)題,并利用高斯偽譜法求解得到最優(yōu)泊車(chē)路徑. 為了兼顧計(jì)算效率和求解精度,文獻(xiàn)[9]采用自適應(yīng)偽譜法求解泊車(chē)路徑規(guī)劃問(wèn)題來(lái)獲得最優(yōu)泊車(chē)路徑. 采用優(yōu)化規(guī)劃方法得到的泊車(chē)路徑適用場(chǎng)景最廣,但優(yōu)化求解方法的較大計(jì)算量限制了其工程應(yīng)用.

    泊車(chē)路徑跟蹤控制方法主要有模型預(yù)測(cè)跟蹤控制方法[10]、非線(xiàn)性魯棒跟蹤控制方法[11]和滑模跟蹤控制方法[5,12-13]. 文獻(xiàn)[10]將受控自回歸積分滑動(dòng)平均模型作為預(yù)測(cè)模型,采用模型預(yù)測(cè)控制方法設(shè)計(jì)泊車(chē)路徑跟蹤控制策略. 為了抑制外界干擾和名義模型不確定性對(duì)泊車(chē)路徑跟蹤精度的影響,文獻(xiàn)[11]采用非線(xiàn)性魯棒控制方法設(shè)計(jì)泊車(chē)路徑跟蹤控制策略. 文獻(xiàn)[5]建立包含外界干擾的汽車(chē)運(yùn)動(dòng)學(xué)名義模型,并采用滑模自抗擾控制方法設(shè)計(jì)泊車(chē)路徑跟蹤控制策略. 文獻(xiàn)[12]建立非時(shí)間參考泊車(chē)路徑跟蹤控制模型,并基于此設(shè)計(jì)了泊車(chē)路徑滑模跟蹤控制策略. 文獻(xiàn)[13]采用反正切函數(shù)代替泊車(chē)路徑滑模跟蹤控制策略中符號(hào)函數(shù)來(lái)抑制傳統(tǒng)滑模固有的抖振問(wèn)題. 上述泊車(chē)路徑跟蹤控制方法的被控對(duì)象均是前輪轉(zhuǎn)向汽車(chē),無(wú)法直接應(yīng)用于線(xiàn)控四輪轉(zhuǎn)向汽車(chē).

    線(xiàn)控四輪轉(zhuǎn)向汽車(chē)具有更好的機(jī)動(dòng)靈活性,在狹窄環(huán)境內(nèi)更容易實(shí)現(xiàn)泊車(chē)操作[14]. 本文針對(duì)線(xiàn)控四輪轉(zhuǎn)向汽車(chē)平行泊車(chē)場(chǎng)景的路徑規(guī)劃與跟蹤控制問(wèn)題,提出一種基于改進(jìn)的粒子群優(yōu)化算法的平行泊車(chē)路徑規(guī)劃方法,以及一種基于前饋控制和反饋控制的平行泊車(chē)路徑跟蹤控制策略. 首先,綜合考慮線(xiàn)控四輪轉(zhuǎn)向汽車(chē)運(yùn)動(dòng)學(xué)非完整約束、動(dòng)力總成子系統(tǒng)和轉(zhuǎn)向子系統(tǒng)的過(guò)程約束和邊界約束、直線(xiàn)交點(diǎn)法描述的避障約束、泊車(chē)的初始位姿和目標(biāo)位姿約束,建立以最小化平行泊車(chē)過(guò)程總時(shí)長(zhǎng)為目標(biāo)的平行泊車(chē)路徑規(guī)劃約束最優(yōu)化問(wèn)題,并采用可以有效處理等式約束和不等式約束的粒子群優(yōu)化算法對(duì)其進(jìn)行求解,進(jìn)而得到最優(yōu)平行泊車(chē)路徑. 隨后,利用平行泊車(chē)路徑規(guī)劃過(guò)程得到的前輪轉(zhuǎn)向角和后輪轉(zhuǎn)向角作為前饋控制量,并利用汽車(chē)實(shí)際位姿與期望位姿的偏差構(gòu)建PI反饋控制量,實(shí)現(xiàn)對(duì)規(guī)劃的平行泊車(chē)路徑快速、精確和穩(wěn)定的跟蹤控制. 最后,利用車(chē)輛動(dòng)力學(xué)仿真軟件構(gòu)建模型在環(huán)仿真系統(tǒng),驗(yàn)證所提出的線(xiàn)控四輪轉(zhuǎn)向汽車(chē)平行泊車(chē)路徑規(guī)劃方法和路徑跟蹤控制策略的可行性和有效性.

    1 ? 平行泊車(chē)路徑規(guī)劃

    1.1 ? 平行泊車(chē)路徑規(guī)劃問(wèn)題描述

    線(xiàn)控四輪轉(zhuǎn)向汽車(chē)平行泊車(chē)過(guò)程中處于低速大轉(zhuǎn)角行駛狀態(tài),可認(rèn)為四個(gè)車(chē)輪無(wú)側(cè)偏的繞同一瞬時(shí)圓心做圓周運(yùn)動(dòng). 如圖1所示,將線(xiàn)控四輪轉(zhuǎn)向汽車(chē)后軸中點(diǎn)作為參考點(diǎn),建立其平行泊車(chē)過(guò)程中的運(yùn)動(dòng)學(xué)方程為:

    式中:xr、yr、vr和ar分別為線(xiàn)控四輪轉(zhuǎn)向汽車(chē)后軸中點(diǎn)橫坐標(biāo)、縱坐標(biāo)、速度和加速度;δf和δr分別為線(xiàn)控四輪轉(zhuǎn)向汽車(chē)前輪和后輪轉(zhuǎn)向角;ωf和ωr分別為線(xiàn)控四輪轉(zhuǎn)向汽車(chē)前輪和后輪轉(zhuǎn)向角速度;φ和L分別為線(xiàn)控四輪轉(zhuǎn)向汽車(chē)方位角和軸距.

    式中:vrmax和armax分別為線(xiàn)控四輪轉(zhuǎn)向汽車(chē)后軸中點(diǎn)速度和加速度最大值;δfmax和δrmax分別為線(xiàn)控四輪轉(zhuǎn)向汽車(chē)前輪和后輪轉(zhuǎn)向角最大值;ωfmax和ωrmax分別為線(xiàn)控四輪轉(zhuǎn)向汽車(chē)前輪和后輪轉(zhuǎn)向角速度最大值.

    基于汽車(chē)后軸中點(diǎn)坐標(biāo)和方位角可得如圖1所示的汽車(chē)輪廓四個(gè)頂點(diǎn)A、B、C和D的坐標(biāo)為:

    xA(k),yA(k)=xr(k)+(L+Lf)cosφ(k)-Wsinφ(k)/2,yr(k)+(L+Lf)sinφ(k)+Wcosφ(k)/2xB(k),yB(k)=xr(k)+(L+Lf)cosφ(k)+Wsinφ(k)/2,yr(k)+(L+Lf)sinφ(k)-Wcosφ(k)/2xC(k),yC(k)=xr(k)-Lr cosφ(k)+Wsinφ(k)/2,yr(k)-Lr sinφ(k)-Wcosφ(k)/2xD(k),yD(k)=xr(k)-Lr cosφ(k)-Wsinφ(k)/2,yr(k)-Lr sinφ(k)+Wcosφ(k)/21≤k≤N

    (9)

    式中:Lf、Lr和W分別為汽車(chē)前懸、后懸和寬度.

    汽車(chē)平行泊車(chē)過(guò)程中其輪廓邊緣AB與如圖2所示的泊車(chē)位前方障礙物無(wú)碰撞的約束條件可表示為:

    汽車(chē)平行泊車(chē)過(guò)程中其輪廓邊緣BC與如圖2所示的泊車(chē)位前方障礙物無(wú)碰撞的約束條件可表示為:

    汽車(chē)平行泊車(chē)過(guò)程中其輪廓邊緣BC與如圖2所示的泊車(chē)位側(cè)方路基無(wú)碰撞的約束條件可表示為:

    yB(k) + Wp ≥ 0yC(k) + Wp ≥ 01 ≤ k ≤ N ? ? ? ? ? ? (12)

    式中:Wp為平行泊車(chē)位寬度.

    汽車(chē)平行泊車(chē)過(guò)程中其輪廓邊緣CD與如圖2所示的泊車(chē)位后方障礙物無(wú)碰撞的約束條件可表示為:

    式中:Lp為平行泊車(chē)位長(zhǎng)度.

    已知平行泊車(chē)的初始位姿和目標(biāo)位姿分別為(x0,y0,φ0)和(xf,yf,φf(shuō)),則有

    xr(0) = x0,yr(0) = y0,φ(0) = φ0xr(N) = xf,yr(N) = yf,φ(N) = φf(shuō) ? (14)

    將式(5) 、式(8)和式(14)描述的等式約束條件記為c(x,u) = 0,將式(7)、式(10)~式(13)描述的不等式約束條件記為g(x,u) ≤ 0,則平行泊車(chē)路徑規(guī)劃問(wèn)題轉(zhuǎn)化為以平行泊車(chē)過(guò)程總時(shí)長(zhǎng)為目標(biāo)的約束最優(yōu)化問(wèn)題,使線(xiàn)控四輪轉(zhuǎn)向汽車(chē)在最短時(shí)間內(nèi)完成平行泊車(chē)任務(wù).

    (15)g(x,u) ≤ 0

    由式(6)和式(15)可知,給定離散點(diǎn)數(shù)量N,最小化平行泊車(chē)過(guò)程總時(shí)長(zhǎng)tf約束最優(yōu)化問(wèn)題可等價(jià)為最小化計(jì)算步長(zhǎng)h約束最優(yōu)化問(wèn)題.

    1.2 ? 平行泊車(chē)路徑規(guī)劃問(wèn)題求解

    粒子群優(yōu)化算法是一種基于啟發(fā)式信息的隨機(jī)搜索算法,具有收斂速度快和設(shè)置參數(shù)少等優(yōu)點(diǎn),特別適用于無(wú)約束最優(yōu)化問(wèn)題求解[16]. 本節(jié)利用最優(yōu)化問(wèn)題的約束條件改進(jìn)粒子群優(yōu)化算法的適應(yīng)度函數(shù),使改進(jìn)的粒子群優(yōu)化算法可以求解式(15)描述的平行泊車(chē)路徑規(guī)劃約束最優(yōu)化問(wèn)題. 已知系統(tǒng)控制向量u(k),1≤k≤N包含三個(gè)分量,則表征系統(tǒng)控制向量的粒子位置向量和速度向量包含3N個(gè)分量. 若按照第一個(gè)系統(tǒng)控制向量三個(gè)分量至最后一個(gè)系統(tǒng)控制向量三個(gè)分量先后方式排序,則第i個(gè)粒子的位置向量和速度向量可分別表示為:

    pi(s) = [ p1i ?p2i ?… ?p3Ni]T ? ? ?(16)

    vi(s) = [ v1i ?v2i ?… ?v3Ni]T ? ? ?(17)

    式中:s為粒子群優(yōu)化算法的當(dāng)前迭代次數(shù).

    利用第i個(gè)粒子的歷史最優(yōu)解pbesti ? ?(s)和群體的歷史最優(yōu)解pbest ? ?(s)更新第i個(gè)粒子的速度為:

    vi(s+1) = q(s)vi(s)+d1r1(pbesti ? ?(s)-pi(s))+

    d2 r2(pbest ? ?(s)-pi(s)) ? ? ? (18)

    式中:r1,r2∈[0,1]為均勻分布的隨機(jī)數(shù);d1和d2分別為粒子速度自身部分和社會(huì)部分權(quán)重系數(shù),二者的有機(jī)組合可以使粒子群優(yōu)化算法保持收斂速度和搜索效果的均衡;q(s)為控制粒子歷史速度對(duì)當(dāng)前速度影響的慣性部分權(quán)重系數(shù),可表示為:

    式中:qmax和qmin分別為慣性部分權(quán)重的最大值和最小值;smax為總迭代次數(shù). 通過(guò)自適應(yīng)調(diào)整慣性部分權(quán)重系數(shù),使粒子群優(yōu)化算法在前期有較高的全局搜索能力,在后期有較高的局部搜索能力.

    利用第i個(gè)粒子在迭代計(jì)算次數(shù)s+1的速度更新其位置為:

    pi(s+1) = pi(s) + vi(s) ? ? (20)

    利用最優(yōu)化問(wèn)題的約束條件計(jì)算第i個(gè)粒子的適應(yīng)度函數(shù)為:

    Fi(s)=Ji(s) ? ? ? ? ? ? ? ? ? ? ? if Vi(s)=0J *(s)+J *(s)Vi(s) ? if Vi(s)>0 ? ? (21)

    式中:Ji(s)為第i個(gè)粒子在迭代計(jì)算次數(shù)s的優(yōu)化目標(biāo)值;J *(s)為第i個(gè)粒子的歷史最差優(yōu)化目標(biāo)值;Vi(s)表示為

    式中:Nc和Ng分別為最優(yōu)化問(wèn)題等式約束條件數(shù)量和不等式約束條件數(shù)量;μij(s)和ηij(s)表示為

    μij(s)=0, ? ? ? ? ? ? ? ?cj(x,u)=0|cj(x,u)|/εj,|cj(x,u)|≤εj, j = 1,2,…Nc1, ? ? ? ? ? ? ? ?|cj(x,u)|>εj

    (23)

    ηij(s)=0, ? ? ? ? ? ? ? ?gj(x,u)≤0|gj(x,u)|/ξj,0ξj

    (24)

    式中:εj和ξj分別為最優(yōu)化問(wèn)題等式約束條件允許的容差和不等式約束條件允許的容差.

    綜上所述,可得如圖3所示的基于改進(jìn)的粒子群優(yōu)化算法求解平行泊車(chē)路徑規(guī)劃約束最優(yōu)化問(wèn)題的具體流程.

    2 ? 平行泊車(chē)路徑跟蹤控制

    本節(jié)基于前饋控制和反饋控制相結(jié)合的方式設(shè)計(jì)平行泊車(chē)路徑跟蹤控制策略. 其中,前饋控制環(huán)節(jié)用于提高平行泊車(chē)路徑跟蹤控制策略的響應(yīng)速度和精度,而反饋控制用于抑制外界擾動(dòng)對(duì)平行泊車(chē)路徑跟蹤控制性能的影響.

    如圖4所示,首先利用汽車(chē)實(shí)際位置與期望位置的偏差eD(k)、汽車(chē)實(shí)際方位角與期望方位角的偏差eφ(k)計(jì)算前輪轉(zhuǎn)向角反饋控制量為:

    Δδf(k+1)=Δδf(k)+

    K PD(eD(k+1)-eD(k))+K IDeD(k+1)+

    K Pφ(eφ(k+1)-eφ(k))+K Iφeφ(k+1) ? ? ?(25)

    式中:K PD和K ID分別為汽車(chē)實(shí)際位置與期望位置偏差的比例系數(shù)和積分系數(shù);K Pφ和K Iφ分別為汽車(chē)實(shí)際方位角與期望方位角偏差的比例系數(shù)和積分系數(shù);eD(k)和eφ(k)可表示為:

    式中:(xr(k),yr(k),φ(k))和(xrd(k),yrd(k),φd(k))分別為汽車(chē)實(shí)際位姿和期望位姿.

    若平行泊車(chē)路徑規(guī)劃過(guò)程得到的汽車(chē)前輪轉(zhuǎn)向角前饋控制量為δfd(k + 1),則汽車(chē)前輪轉(zhuǎn)向角控制量可表示為:

    δf(k + 1) = δfd(k + 1) + Δδf(k + 1) ? ?(28)

    由汽車(chē)前輪轉(zhuǎn)向角最大值與后輪轉(zhuǎn)向角最大值的比例關(guān)系,可得汽車(chē)后輪轉(zhuǎn)向角控制量為:

    δr(k + 1) = δrd(k + 1) + Ks Δδf(k + 1) ? ?(29)

    式中:δrd(k + 1)為汽車(chē)后輪轉(zhuǎn)向角前饋控制量;Ks = δrmax /δfmax為比例系數(shù).

    3 ? 仿真分析

    本節(jié)利用車(chē)輛動(dòng)力學(xué)仿真軟件建立線(xiàn)控四輪轉(zhuǎn)向汽車(chē)平行泊車(chē)路徑規(guī)劃與跟蹤控制方法的模型在環(huán)仿真系統(tǒng),對(duì)其可行性和有效性進(jìn)行驗(yàn)證. 以天津一汽夏利N5整車(chē)參數(shù)為基礎(chǔ)設(shè)計(jì)線(xiàn)控四輪轉(zhuǎn)向汽車(chē)的仿真參數(shù)為L(zhǎng) = 4.155 m,W = 1.645 m,Lf=0.8 m,Lr = 0.95 m,vrmax = 1 m·s-1,armax = 2 m·s-2,δfmax = 0.524 rad,δrmax = 0.087 3 rad,ωfmax = ωrmax = 0.524 rad·s-1;依據(jù)工程經(jīng)驗(yàn),仿真驗(yàn)證過(guò)程中粒子群優(yōu)化算法的基礎(chǔ)參數(shù)分別設(shè)置為d1 = 1.2,d2 = 1.5,qmin = 0.3,qmax = 1.5,smax = 1 000和εj = ξj = 10-3,種群規(guī)模設(shè)置為30、粒子速度向量邊界區(qū)域設(shè)置為[-1,1]、粒子位置向量中表征汽車(chē)后軸中點(diǎn)加速度信息的分量的邊界區(qū)域設(shè)置為[-armax,armax],粒子位置向量中表征汽車(chē)前輪轉(zhuǎn)向角速度信息的分量的邊界區(qū)域設(shè)置為 [-ωfmax,ωfmax],粒子位置向量中表征汽車(chē)后輪轉(zhuǎn)向角速度信息的分量的邊界區(qū)域設(shè)置為[-ωrmax,ωrmax],算法迭代收斂判斷容差設(shè)置為10-4;仿真結(jié)果如圖5所示.

    如圖5(a) (b)所示,采用基于改進(jìn)粒子群優(yōu)化算法的平行泊車(chē)路徑規(guī)劃方法得到的平行泊車(chē)路徑可以安全、舒適地引導(dǎo)線(xiàn)控四輪轉(zhuǎn)向汽車(chē)進(jìn)入平行泊車(chē)位,并且目標(biāo)平行泊車(chē)路徑曲率的連續(xù)性有效避免了線(xiàn)控四輪轉(zhuǎn)向汽車(chē)原地轉(zhuǎn)向現(xiàn)象.

    如圖5(c)~(f)所示,采用基于前饋控制和反饋控制相結(jié)合方式設(shè)計(jì)的平行泊車(chē)路徑跟蹤控制策略可以使線(xiàn)控四輪轉(zhuǎn)向汽車(chē)快速、精確和穩(wěn)定地跟蹤目標(biāo)泊車(chē)路徑,進(jìn)而安全無(wú)碰撞地完成平行泊車(chē)任務(wù).

    4 ? 結(jié) ? 論

    本文提出了一種線(xiàn)控四輪轉(zhuǎn)向汽車(chē)平行泊車(chē)路徑規(guī)劃與跟蹤控制方法. 綜合考慮了線(xiàn)控四輪轉(zhuǎn)向汽車(chē)運(yùn)動(dòng)學(xué)非完整約束、動(dòng)力和轉(zhuǎn)向子系統(tǒng)約束、避障約束和泊車(chē)位姿約束,建立了平行泊車(chē)路徑規(guī)劃約束最優(yōu)化問(wèn)題,并采用可以改進(jìn)的粒子群優(yōu)化算法對(duì)其進(jìn)行求解來(lái)獲得最優(yōu)平行泊車(chē)路徑. 采用前饋控制和PI反饋控制相結(jié)合的方式設(shè)計(jì)了平行泊車(chē)路徑跟蹤控制策略,實(shí)現(xiàn)對(duì)規(guī)劃的平行泊車(chē)路徑快速、精確及穩(wěn)定的跟蹤控制. 利用車(chē)輛動(dòng)力學(xué)仿真軟件構(gòu)建模型在環(huán)系統(tǒng),驗(yàn)證所提出的線(xiàn)控四輪轉(zhuǎn)向汽車(chē)平行泊車(chē)路徑規(guī)劃與跟蹤控制方法的可行性和有效性,結(jié)果表明:所提出的方法可以快速、精確、穩(wěn)定地引導(dǎo)線(xiàn)控四輪轉(zhuǎn)向汽車(chē)自動(dòng)完成平行泊車(chē)任務(wù).

    參考文獻(xiàn)

    [1] ? ?JANG C,KIM C,LEE S,et al. Re-plannable automated parking system with a standalone around view monitor for narrow parking lots[J]. IEEE Transactions on Intelligent Transportation Systems,2020,21(2):777—790.

    [2] ? ?CHAI R Q,TSOURDOS A,SAVVARIS A,et al. Two-stage trajectory optimization for autonomous ground vehicles parking maneuver[J]. IEEE Transactions on Industrial Informatics,2019,15(7):3899—3909.

    [3] ? ?張家旭,趙健,施正堂,等. 基于回旋曲線(xiàn)的平行泊車(chē)路徑規(guī)劃和跟蹤控制[J]. 吉林大學(xué)學(xué)報(bào)(工學(xué)版),2020,50(6):2247—2257.

    ZHANG J X,ZHAO J,SHI Z T,et al. Path planning and tracking control for parallel parking based on clothoid curve[J]. Journal of Jilin University (Engineering and Technology Edition),2020,50(6):2247—2257. (In Chinese)

    [4] ? ?CHAND A,KAWANISHI M,NARIKIYO T. Application of sigmoidal gompertz curves in reverse parallel parking for autonomous vehicles[J]. International Journal of Advanced Robotic Systems,2015,12(9):127.

    [5] ? ?王健. 汽車(chē)在兩種轉(zhuǎn)向工況下的路徑規(guī)劃與路徑跟蹤研究[D]. 南京: 南京航空航天大學(xué),2015:32—35.

    WANG J. Research on path planning and path tracking for automobile in two steering conditions[D]. Nanjing:Nanjing University of Aeronautics and Astronautics,2015:32—35. (In Chinese)

    [6] ? ?LIU W,LI Z H,LI L,et al. Parking like a human:a direct trajectory planning solution[J]. IEEE Transactions on Intelligent Transportation Systems,2017,18(12):3388—3397.

    [7] ? ?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.

    [8] ? ?LI B,WANG K X,SHAO Z J. Time-optimal maneuver planning in automatic parallel parking using a simultaneous dynamic optimization approach[J]. IEEE Transactions on Intelligent Transportation Systems,2016,17(11):3263—3274.

    [9] ? ?張家旭,趙健,施正堂,等. 采用hp自適應(yīng)偽譜法的全自動(dòng)泊車(chē)系統(tǒng)軌跡規(guī)劃與跟蹤控制[J]. 西安交通大學(xué)學(xué)報(bào),2020,54(6): 176—184.

    ZHANG J X,ZHAO J,SHI Z T,et al. A trajectory planning and tracking control method for fully-automatic parking system using hp-adaptive pseudo spectral method[J]. Journal of Xian Jiaotong University,2020,54(6):176—184. (In Chinese)

    [10] ?趙海蘭. 全自動(dòng)平行泊車(chē)路徑規(guī)劃及路徑跟蹤研究[D]. 淄博: 山東理工大學(xué),2017:25—26.

    ZHAO H L. Study on path planning and path tracking method for fully-automatic parallel parking[D]. Zibo:Shangdong University of Technology,2017:25—26. (In Chinese)

    [11] ?張家旭,趙健,施正堂,等. 基于回旋曲線(xiàn)的垂直泊車(chē)軌跡規(guī)劃與跟蹤控制[J]. 東南大學(xué)學(xué)報(bào)(自然科學(xué)版),2020,50(1):182—191.

    ZHANG J X,ZHAO J,SHI Z T,et al. Trajectory planning and tracking control for perpendicular parking based on clothoid curve[J]. Journal of Southeast University (Natural Science Edition),2020,50(1):182—191. ?(In Chinese)

    [12] ?ZHANG J X,SHI Z T,YANG X,et al. Trajectory planning and tracking control for autonomous parallel parking of a non-holonomic vehicle[J]. Measurement and Control,2020,53(9/10):1800—1816.

    [13] ?DU X X,TAN K K. Autonomous reverse parking system based on robust path generation and improved sliding mode control[J]. IEEE Transactions on Intelligent Transportation Systems,2015,16(3):1225—1237.

    [14] ?ZHAO W Z,QIN X X,WANG C Y. Yaw and lateral stability control for four-wheel steer-by-wire system[J]. IEEE/ASME Transactions on Mechatronics,2018,23(6):2628—2637.

    [15] ?HAGER W W. Runge-Kutta methods in optimal control and the transformed adjoint system[J]. Numerische Mathematik,2000,87(2):247—282.

    [16] ?SUN J,WU X J,PALADE V,et al. Random drift particle swarm optimization algorithm:convergence analysis and parameter selection[J]. Machine Learning,2015,101(1/2/3):345—376.

    收稿日期:2020-07-10

    基金項(xiàng)目:國(guó)家自然科學(xué)基金資助項(xiàng)目(51775235),National Natural Science Foundation of China(51775235)

    作者簡(jiǎn)介:張家旭(1985—),男,黑龍江雙城人,吉林大學(xué)高級(jí)工程師,博士后

    通信聯(lián)系人,E-mail:zhaojian@jlu.edu.cn

    猜你喜歡
    車(chē)輛工程路徑規(guī)劃控制工程
    中材(天津)控制工程有限公司
    中材(天津)控制工程有限公司
    控制工程在機(jī)械電子工程中的應(yīng)用
    車(chē)輛工程專(zhuān)業(yè)工程人才培養(yǎng)模式改革之實(shí)驗(yàn)室開(kāi)放探討
    清掃機(jī)器人的新型田埂式路徑規(guī)劃方法
    自適應(yīng)的智能搬運(yùn)路徑規(guī)劃算法
    科技視界(2016年26期)2016-12-17 15:53:57
    基于B樣條曲線(xiàn)的無(wú)人車(chē)路徑規(guī)劃算法
    基于卓越工程師培養(yǎng)的車(chē)輛工程專(zhuān)業(yè)企業(yè)培養(yǎng)方案研究
    本科生導(dǎo)師制在應(yīng)用型高校車(chē)輛工程專(zhuān)業(yè)初探
    考試周刊(2016年76期)2016-10-09 10:00:15
    基于改進(jìn)的Dijkstra算法AGV路徑規(guī)劃研究
    科技視界(2016年20期)2016-09-29 12:00:43
    国产野战对白在线观看| 日韩欧美国产在线观看| 黄色丝袜av网址大全| 麻豆久久精品国产亚洲av| 国产精品电影一区二区三区| 男人操女人黄网站| 中文字幕人妻丝袜一区二区| 国产精品98久久久久久宅男小说| 欧美丝袜亚洲另类 | 亚洲三区欧美一区| 别揉我奶头~嗯~啊~动态视频| 亚洲国产看品久久| 国产99久久九九免费精品| 亚洲aⅴ乱码一区二区在线播放 | 中文在线观看免费www的网站 | 亚洲国产高清在线一区二区三 | 国产国语露脸激情在线看| 嫩草影视91久久| 淫妇啪啪啪对白视频| 一区二区三区精品91| 男女做爰动态图高潮gif福利片| 美女扒开内裤让男人捅视频| 国内毛片毛片毛片毛片毛片| 嫩草影视91久久| 国产成+人综合+亚洲专区| 少妇的丰满在线观看| 亚洲久久久国产精品| 久久婷婷成人综合色麻豆| 精品久久久久久久久久免费视频| 俺也久久电影网| 精品国产一区二区三区四区第35| 激情在线观看视频在线高清| 国产亚洲欧美精品永久| 少妇裸体淫交视频免费看高清 | 99精品久久久久人妻精品| 国产精品香港三级国产av潘金莲| 久久久久国产精品人妻aⅴ院| 午夜精品在线福利| 欧美黑人欧美精品刺激| 亚洲国产欧美日韩在线播放| 成人三级做爰电影| 制服丝袜大香蕉在线| 久久狼人影院| 亚洲国产欧洲综合997久久, | 一区二区三区高清视频在线| 国内精品久久久久久久电影| 最近最新中文字幕大全免费视频| 午夜福利一区二区在线看| 又黄又爽又免费观看的视频| 久久热在线av| 午夜老司机福利片| 精品免费久久久久久久清纯| 亚洲久久久国产精品| 国产亚洲精品第一综合不卡| 免费无遮挡裸体视频| 日本三级黄在线观看| 十八禁人妻一区二区| 久久香蕉国产精品| 无遮挡黄片免费观看| 老司机深夜福利视频在线观看| 欧美色视频一区免费| 女生性感内裤真人,穿戴方法视频| 国产亚洲精品第一综合不卡| 亚洲一区中文字幕在线| 91大片在线观看| 中文字幕精品亚洲无线码一区 | 琪琪午夜伦伦电影理论片6080| 无遮挡黄片免费观看| 日本免费一区二区三区高清不卡| 久久久久免费精品人妻一区二区 | www.精华液| 大香蕉久久成人网| 国产午夜精品久久久久久| 亚洲精品一区av在线观看| 欧美性长视频在线观看| 夜夜躁狠狠躁天天躁| 可以在线观看的亚洲视频| 日韩欧美免费精品| 欧美在线黄色| 午夜福利高清视频| 国产成+人综合+亚洲专区| 亚洲一区高清亚洲精品| 国产精品久久视频播放| 久久久久久久午夜电影| 国产真人三级小视频在线观看| 亚洲电影在线观看av| 日日摸夜夜添夜夜添小说| 校园春色视频在线观看| 亚洲人成电影免费在线| 国产精品精品国产色婷婷| 国产男靠女视频免费网站| 在线国产一区二区在线| 日本撒尿小便嘘嘘汇集6| 免费看美女性在线毛片视频| 亚洲 国产 在线| 人人妻人人看人人澡| x7x7x7水蜜桃| 亚洲aⅴ乱码一区二区在线播放 | 91老司机精品| 女警被强在线播放| 国产成年人精品一区二区| 伊人久久大香线蕉亚洲五| 欧美绝顶高潮抽搐喷水| 一本精品99久久精品77| АⅤ资源中文在线天堂| 精品电影一区二区在线| 国产熟女xx| 亚洲欧洲精品一区二区精品久久久| 国产极品粉嫩免费观看在线| 日本a在线网址| 久久精品国产清高在天天线| 国产午夜福利久久久久久| 国产亚洲精品综合一区在线观看 | а√天堂www在线а√下载| 亚洲熟妇中文字幕五十中出| 国产av在哪里看| 变态另类成人亚洲欧美熟女| 国产激情欧美一区二区| 色综合欧美亚洲国产小说| 久久精品成人免费网站| 黄片小视频在线播放| 亚洲美女黄片视频| 91在线观看av| 成年女人毛片免费观看观看9| 真人一进一出gif抽搐免费| 母亲3免费完整高清在线观看| 男女床上黄色一级片免费看| 亚洲成人精品中文字幕电影| 午夜两性在线视频| 成人永久免费在线观看视频| 国产精品永久免费网站| 欧美色欧美亚洲另类二区| 久久久久国内视频| 极品教师在线免费播放| 国产蜜桃级精品一区二区三区| 久久婷婷成人综合色麻豆| 国产视频一区二区在线看| 好看av亚洲va欧美ⅴa在| 国产高清videossex| 久久草成人影院| 国产成人一区二区三区免费视频网站| 亚洲aⅴ乱码一区二区在线播放 | 大型黄色视频在线免费观看| 少妇 在线观看| 亚洲午夜理论影院| 日本一本二区三区精品| 国产v大片淫在线免费观看| 可以在线观看的亚洲视频| 久久九九热精品免费| 这个男人来自地球电影免费观看| 黑丝袜美女国产一区| 国产精品爽爽va在线观看网站 | 丰满的人妻完整版| 熟女电影av网| 欧美不卡视频在线免费观看 | 欧美日韩亚洲国产一区二区在线观看| 日本撒尿小便嘘嘘汇集6| 精品欧美国产一区二区三| 亚洲aⅴ乱码一区二区在线播放 | 好男人电影高清在线观看| 黄色成人免费大全| 啦啦啦观看免费观看视频高清| 99热这里只有精品一区 | 少妇的丰满在线观看| 日本一区二区免费在线视频| 男女视频在线观看网站免费 | 97人妻精品一区二区三区麻豆 | 18禁观看日本| 亚洲国产高清在线一区二区三 | 亚洲中文字幕一区二区三区有码在线看 | 亚洲自拍偷在线| 97人妻精品一区二区三区麻豆 | 少妇裸体淫交视频免费看高清 | 欧美+亚洲+日韩+国产| 女人高潮潮喷娇喘18禁视频| 国产精品久久久久久亚洲av鲁大| 少妇粗大呻吟视频| 日本黄色视频三级网站网址| 国产精品1区2区在线观看.| 欧美激情久久久久久爽电影| 中文亚洲av片在线观看爽| 久久精品91蜜桃| 免费在线观看影片大全网站| 亚洲电影在线观看av| 妹子高潮喷水视频| 夜夜看夜夜爽夜夜摸| 亚洲精品一卡2卡三卡4卡5卡| 免费无遮挡裸体视频| 岛国在线观看网站| 欧美 亚洲 国产 日韩一| 欧美乱码精品一区二区三区| 亚洲 欧美一区二区三区| 久久青草综合色| 日日爽夜夜爽网站| 亚洲在线自拍视频| 淫妇啪啪啪对白视频| 黄片播放在线免费| 丰满人妻熟妇乱又伦精品不卡| 亚洲精品国产一区二区精华液| www国产在线视频色| 国产成人欧美在线观看| 日韩一卡2卡3卡4卡2021年| 亚洲美女黄片视频| 天天躁狠狠躁夜夜躁狠狠躁| 一二三四社区在线视频社区8| 国产欧美日韩精品亚洲av| 成人免费观看视频高清| 成人午夜高清在线视频 | 又黄又粗又硬又大视频| 中文亚洲av片在线观看爽| 12—13女人毛片做爰片一| 午夜福利欧美成人| 一二三四社区在线视频社区8| 51午夜福利影视在线观看| a级毛片在线看网站| 在线观看免费午夜福利视频| 少妇的丰满在线观看| 国产成人av激情在线播放| 麻豆成人av在线观看| 亚洲精品一区av在线观看| 免费在线观看完整版高清| 最近最新中文字幕大全免费视频| 大香蕉久久成人网| 热99re8久久精品国产| 亚洲精品国产一区二区精华液| 怎么达到女性高潮| 婷婷精品国产亚洲av| 999久久久国产精品视频| 国内揄拍国产精品人妻在线 | 性色av乱码一区二区三区2| tocl精华| 老司机福利观看| 成人18禁高潮啪啪吃奶动态图| 成人永久免费在线观看视频| 亚洲国产欧美日韩在线播放| 天天躁狠狠躁夜夜躁狠狠躁| 国产黄a三级三级三级人| 亚洲狠狠婷婷综合久久图片| 亚洲一卡2卡3卡4卡5卡精品中文| 成熟少妇高潮喷水视频| 国产精品电影一区二区三区| 国产黄片美女视频| 波多野结衣高清无吗| 亚洲男人天堂网一区| 99国产精品一区二区蜜桃av| 美女 人体艺术 gogo| 国产高清videossex| 国产熟女xx| 成人av一区二区三区在线看| 国产精品免费一区二区三区在线| 欧美日韩乱码在线| 99精品久久久久人妻精品| 成年女人毛片免费观看观看9| 日日爽夜夜爽网站| 好看av亚洲va欧美ⅴa在| 91字幕亚洲| 在线天堂中文资源库| 麻豆av在线久日| 桃色一区二区三区在线观看| 亚洲人成网站高清观看| 欧美国产精品va在线观看不卡| 国产亚洲精品第一综合不卡| 欧美性猛交╳xxx乱大交人| 禁无遮挡网站| 99精品在免费线老司机午夜| 亚洲一区中文字幕在线| 久久人人精品亚洲av| 国内毛片毛片毛片毛片毛片| 女警被强在线播放| 国产在线精品亚洲第一网站| 变态另类成人亚洲欧美熟女| 亚洲国产精品sss在线观看| 午夜亚洲福利在线播放| 日本撒尿小便嘘嘘汇集6| 精品国产国语对白av| 91字幕亚洲| 久久久久久久午夜电影| 一本一本综合久久| www.精华液| 亚洲三区欧美一区| 丰满的人妻完整版| 欧美zozozo另类| 欧美人与性动交α欧美精品济南到| 亚洲男人的天堂狠狠| 国产成+人综合+亚洲专区| 一进一出抽搐gif免费好疼| 美女高潮喷水抽搐中文字幕| 久久久久久国产a免费观看| 一本久久中文字幕| 美女扒开内裤让男人捅视频| 一级毛片女人18水好多| 久久精品亚洲精品国产色婷小说| 好看av亚洲va欧美ⅴa在| 麻豆久久精品国产亚洲av| 91大片在线观看| 亚洲av成人一区二区三| 国产黄片美女视频| 成人国产一区最新在线观看| 在线永久观看黄色视频| 成在线人永久免费视频| 久久久久九九精品影院| 桃色一区二区三区在线观看| 日本一本二区三区精品| 少妇 在线观看| 亚洲国产看品久久| 色综合站精品国产| 青草久久国产| 成熟少妇高潮喷水视频| 黄色毛片三级朝国网站| 一二三四在线观看免费中文在| 97碰自拍视频| 日韩欧美三级三区| 国产亚洲精品久久久久5区| 午夜精品久久久久久毛片777| 亚洲精品国产一区二区精华液| 中文字幕高清在线视频| 亚洲三区欧美一区| 又黄又粗又硬又大视频| 亚洲中文字幕一区二区三区有码在线看 | 国产精品电影一区二区三区| 日本熟妇午夜| 伊人久久大香线蕉亚洲五| 久久精品国产清高在天天线| 中文字幕另类日韩欧美亚洲嫩草| 国产成人影院久久av| 国产单亲对白刺激| 婷婷亚洲欧美| 欧美日本亚洲视频在线播放| 亚洲熟妇中文字幕五十中出| 嫁个100分男人电影在线观看| 黄色丝袜av网址大全| 老司机在亚洲福利影院| 亚洲精品久久成人aⅴ小说| 日本免费a在线| 很黄的视频免费| 日日爽夜夜爽网站| 久久久久久人人人人人| 国产一区二区在线av高清观看| 一本一本综合久久| 国产精品一区二区免费欧美| 午夜激情av网站| 18禁黄网站禁片免费观看直播| 亚洲熟妇熟女久久| 香蕉国产在线看| 久久午夜综合久久蜜桃| 又黄又爽又免费观看的视频| 中文字幕人成人乱码亚洲影| 露出奶头的视频| 麻豆成人午夜福利视频| xxx96com| 精品少妇一区二区三区视频日本电影| 一区二区日韩欧美中文字幕| 日本免费a在线| 久久久久国产一级毛片高清牌| 国内精品久久久久精免费| 一边摸一边做爽爽视频免费| 亚洲国产精品999在线| videosex国产| 人人妻人人澡人人看| 国内精品久久久久精免费| 中文亚洲av片在线观看爽| 在线观看一区二区三区| 久久中文字幕人妻熟女| 欧美人与性动交α欧美精品济南到| 欧美色欧美亚洲另类二区| 国产激情欧美一区二区| 亚洲专区中文字幕在线| 亚洲精品美女久久久久99蜜臀| 18美女黄网站色大片免费观看| 特大巨黑吊av在线直播 | 欧美日本亚洲视频在线播放| 国产精品九九99| 禁无遮挡网站| 国产精品永久免费网站| 老熟妇乱子伦视频在线观看| 国产亚洲精品第一综合不卡| 亚洲中文av在线| 青草久久国产| 高清在线国产一区| 色婷婷久久久亚洲欧美| 国产高清视频在线播放一区| 亚洲av美国av| 麻豆av在线久日| 亚洲男人的天堂狠狠| 韩国av一区二区三区四区| 韩国精品一区二区三区| 国产午夜精品久久久久久| 麻豆成人午夜福利视频| 久久午夜综合久久蜜桃| 成人国产综合亚洲| 国产真人三级小视频在线观看| 天堂√8在线中文| 91国产中文字幕| 国产激情久久老熟女| 少妇熟女aⅴ在线视频| 嫩草影视91久久| 琪琪午夜伦伦电影理论片6080| 香蕉国产在线看| 精品国产乱子伦一区二区三区| 国产精品亚洲一级av第二区| 亚洲精品久久成人aⅴ小说| 久久精品国产亚洲av高清一级| 成年免费大片在线观看| 9191精品国产免费久久| 自线自在国产av| 久久久国产精品麻豆| 99久久国产精品久久久| 看片在线看免费视频| 一区二区三区高清视频在线| 亚洲国产欧洲综合997久久, | 日韩欧美在线二视频| www日本在线高清视频| 午夜影院日韩av| 亚洲九九香蕉| 桃色一区二区三区在线观看| 人人妻人人看人人澡| 亚洲av成人不卡在线观看播放网| 露出奶头的视频| 亚洲人成伊人成综合网2020| 成人欧美大片| 亚洲 国产 在线| 淫秽高清视频在线观看| 无人区码免费观看不卡| 亚洲国产欧美网| 男女午夜视频在线观看| 国产精品av久久久久免费| 在线观看66精品国产| 久久久国产成人免费| 中文字幕久久专区| 国产爱豆传媒在线观看 | 人人妻,人人澡人人爽秒播| 琪琪午夜伦伦电影理论片6080| 国产国语露脸激情在线看| 国产亚洲精品综合一区在线观看 | 欧美绝顶高潮抽搐喷水| 亚洲精品一区av在线观看| 国产精品自产拍在线观看55亚洲| 热99re8久久精品国产| 搡老熟女国产l中国老女人| 国产又爽黄色视频| 母亲3免费完整高清在线观看| 久久久久精品国产欧美久久久| 黄网站色视频无遮挡免费观看| 美女高潮喷水抽搐中文字幕| 亚洲色图 男人天堂 中文字幕| 中文字幕高清在线视频| 国产男靠女视频免费网站| 人成视频在线观看免费观看| 久久久久久久久免费视频了| 精品一区二区三区视频在线观看免费| 国产精品二区激情视频| 后天国语完整版免费观看| 国产成人精品久久二区二区免费| 日本免费一区二区三区高清不卡| 中文字幕另类日韩欧美亚洲嫩草| 中文在线观看免费www的网站 | 精品久久蜜臀av无| 亚洲色图av天堂| 亚洲成av片中文字幕在线观看| 国产麻豆成人av免费视频| 中文字幕精品免费在线观看视频| 一区福利在线观看| 日本 欧美在线| 午夜免费鲁丝| 伊人久久大香线蕉亚洲五| av视频在线观看入口| 日韩欧美国产在线观看| 国产一区二区三区视频了| 亚洲av日韩精品久久久久久密| 性欧美人与动物交配| 午夜激情av网站| 深夜精品福利| aaaaa片日本免费| 日韩精品中文字幕看吧| 日本精品一区二区三区蜜桃| 亚洲成a人片在线一区二区| 午夜激情av网站| 亚洲精品粉嫩美女一区| 国产日本99.免费观看| 在线十欧美十亚洲十日本专区| 国产精品久久久久久精品电影 | 国产精品电影一区二区三区| 男女午夜视频在线观看| 免费女性裸体啪啪无遮挡网站| 日韩欧美在线二视频| 成人特级黄色片久久久久久久| 成人亚洲精品一区在线观看| 久久久久久亚洲精品国产蜜桃av| 日韩精品中文字幕看吧| 天堂动漫精品| 亚洲成a人片在线一区二区| 国产乱人伦免费视频| 免费高清视频大片| 美女 人体艺术 gogo| 精品福利观看| 美女高潮喷水抽搐中文字幕| 99久久国产精品久久久| 美女国产高潮福利片在线看| 亚洲av美国av| 久久草成人影院| 12—13女人毛片做爰片一| 国产伦人伦偷精品视频| 久久人妻av系列| 国产男靠女视频免费网站| 两个人视频免费观看高清| 国产又黄又爽又无遮挡在线| 999久久久国产精品视频| 国产黄色小视频在线观看| 黄色丝袜av网址大全| 好男人电影高清在线观看| 18美女黄网站色大片免费观看| 热re99久久国产66热| 久久精品国产亚洲av香蕉五月| 午夜免费激情av| 欧美日本视频| 丰满的人妻完整版| 一进一出抽搐动态| 少妇熟女aⅴ在线视频| 免费av毛片视频| 桃色一区二区三区在线观看| 亚洲熟女毛片儿| 天堂√8在线中文| 精品午夜福利视频在线观看一区| 欧美亚洲日本最大视频资源| 精品免费久久久久久久清纯| 制服人妻中文乱码| 国内少妇人妻偷人精品xxx网站 | 亚洲一区高清亚洲精品| 欧美日韩精品网址| 天堂动漫精品| 国产v大片淫在线免费观看| 少妇粗大呻吟视频| 午夜亚洲福利在线播放| 九色国产91popny在线| 亚洲全国av大片| 久久精品成人免费网站| 久久伊人香网站| 韩国精品一区二区三区| 丝袜人妻中文字幕| 香蕉久久夜色| 99在线人妻在线中文字幕| 高清在线国产一区| av中文乱码字幕在线| 成年人黄色毛片网站| 两性午夜刺激爽爽歪歪视频在线观看 | www国产在线视频色| 一进一出抽搐gif免费好疼| 亚洲国产欧美一区二区综合| 99国产精品99久久久久| 香蕉av资源在线| 老司机福利观看| 天天躁夜夜躁狠狠躁躁| 亚洲 欧美 日韩 在线 免费| 精品国内亚洲2022精品成人| 亚洲最大成人中文| www.999成人在线观看| 成年人黄色毛片网站| 色婷婷久久久亚洲欧美| 国产一区二区三区在线臀色熟女| 九色国产91popny在线| 一区二区日韩欧美中文字幕| 十分钟在线观看高清视频www| 国内少妇人妻偷人精品xxx网站 | 日本 av在线| 国产成人影院久久av| 欧美 亚洲 国产 日韩一| 一区福利在线观看| 亚洲成av人片免费观看| 白带黄色成豆腐渣| 国产一区二区三区在线臀色熟女| 50天的宝宝边吃奶边哭怎么回事| 精品国产美女av久久久久小说| 熟女少妇亚洲综合色aaa.| 91成人精品电影| 国产麻豆成人av免费视频| 久久婷婷成人综合色麻豆| 丝袜人妻中文字幕| 777久久人妻少妇嫩草av网站| 日韩欧美免费精品| 黄色毛片三级朝国网站| 黄片小视频在线播放| 校园春色视频在线观看| 天天躁狠狠躁夜夜躁狠狠躁| 久久这里只有精品19| 亚洲成人久久性| a在线观看视频网站| 成人国产综合亚洲| 制服丝袜大香蕉在线| netflix在线观看网站| 国产精品日韩av在线免费观看| 亚洲人成网站高清观看| 国产精品久久久人人做人人爽| 91麻豆av在线| 国产精品综合久久久久久久免费| www.www免费av| 黄色成人免费大全| 母亲3免费完整高清在线观看| 亚洲自偷自拍图片 自拍| 露出奶头的视频| 久久国产亚洲av麻豆专区| 老汉色av国产亚洲站长工具| 男女那种视频在线观看| 亚洲,欧美精品.| 久久国产精品人妻蜜桃| 欧美午夜高清在线| 国内久久婷婷六月综合欲色啪| 日韩 欧美 亚洲 中文字幕| 国产区一区二久久| 此物有八面人人有两片| 精品无人区乱码1区二区| 精品电影一区二区在线| 日日干狠狠操夜夜爽| 欧美乱色亚洲激情| 黑丝袜美女国产一区| 久久 成人 亚洲|