• <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
    两个人视频免费观看高清| 一级a爱片免费观看的视频| 欧美日韩黄片免| 亚洲专区国产一区二区| 在线观看66精品国产| 国产免费一级a男人的天堂| 欧美av亚洲av综合av国产av| 亚洲无线在线观看| 熟女人妻精品中文字幕| 成人一区二区视频在线观看| 悠悠久久av| 久久这里只有精品中国| a级毛片a级免费在线| 欧美乱妇无乱码| 欧美成人免费av一区二区三区| 亚洲av中文字字幕乱码综合| 久久久久久人人人人人| 国产黄a三级三级三级人| 一边摸一边抽搐一进一小说| 亚洲av电影不卡..在线观看| 亚洲国产精品合色在线| 3wmmmm亚洲av在线观看| 一夜夜www| 亚洲欧美日韩高清专用| 一边摸一边抽搐一进一小说| 国产亚洲精品久久久com| 欧美另类亚洲清纯唯美| 亚洲国产精品合色在线| 最新中文字幕久久久久| 18禁美女被吸乳视频| 黄色片一级片一级黄色片| 国产综合懂色| 欧美日韩综合久久久久久 | 国产激情欧美一区二区| 免费在线观看影片大全网站| 五月玫瑰六月丁香| 好男人在线观看高清免费视频| 国产高清videossex| 欧美日韩精品网址| 久久欧美精品欧美久久欧美| 欧美最新免费一区二区三区 | 亚洲人成网站在线播放欧美日韩| 亚洲一区二区三区不卡视频| 成年版毛片免费区| 欧美日韩黄片免| 人人妻人人澡欧美一区二区| 丁香欧美五月| 精品国产美女av久久久久小说| 欧美黑人欧美精品刺激| 国产三级黄色录像| 琪琪午夜伦伦电影理论片6080| 香蕉丝袜av| 性色avwww在线观看| 最近在线观看免费完整版| 中文字幕人妻熟人妻熟丝袜美 | 青草久久国产| 脱女人内裤的视频| 精品人妻偷拍中文字幕| 国产欧美日韩精品亚洲av| 免费观看的影片在线观看| 亚洲不卡免费看| 国内精品一区二区在线观看| 草草在线视频免费看| 日本a在线网址| 亚洲一区高清亚洲精品| 两个人看的免费小视频| 99精品在免费线老司机午夜| 婷婷亚洲欧美| 午夜a级毛片| 亚洲欧美日韩卡通动漫| 精品99又大又爽又粗少妇毛片 | 黑人欧美特级aaaaaa片| 免费在线观看影片大全网站| 舔av片在线| 一进一出抽搐动态| 中文资源天堂在线| 丁香欧美五月| 一边摸一边抽搐一进一小说| 高潮久久久久久久久久久不卡| 亚洲国产高清在线一区二区三| 国产蜜桃级精品一区二区三区| а√天堂www在线а√下载| 免费在线观看成人毛片| 久久久久免费精品人妻一区二区| 国产亚洲精品av在线| 亚洲专区中文字幕在线| 国产黄色小视频在线观看| 欧美中文日本在线观看视频| 高潮久久久久久久久久久不卡| 国产精品1区2区在线观看.| 午夜影院日韩av| 国产精品自产拍在线观看55亚洲| 国产精品亚洲av一区麻豆| 99久久精品一区二区三区| 亚洲成人久久性| АⅤ资源中文在线天堂| 国内精品久久久久久久电影| 波多野结衣巨乳人妻| 亚洲专区中文字幕在线| 日本免费a在线| 中国美女看黄片| 日本黄色片子视频| 成人永久免费在线观看视频| 色噜噜av男人的天堂激情| 免费搜索国产男女视频| 精品久久久久久久久久免费视频| 久久精品91蜜桃| 长腿黑丝高跟| 97超级碰碰碰精品色视频在线观看| 久久精品国产综合久久久| 神马国产精品三级电影在线观看| 搡老妇女老女人老熟妇| 精品久久久久久久久久久久久| 三级男女做爰猛烈吃奶摸视频| 他把我摸到了高潮在线观看| 1024手机看黄色片| 欧美日本视频| 国产一区在线观看成人免费| 欧美激情在线99| 性欧美人与动物交配| 国内精品久久久久精免费| 老熟妇乱子伦视频在线观看| 岛国视频午夜一区免费看| 久久久色成人| 一本综合久久免费| 国产免费av片在线观看野外av| 99riav亚洲国产免费| 国产色爽女视频免费观看| 亚洲精品在线美女| 丰满乱子伦码专区| 蜜桃久久精品国产亚洲av| 精品国内亚洲2022精品成人| 亚洲国产高清在线一区二区三| 五月玫瑰六月丁香| 午夜激情欧美在线| 成人国产综合亚洲| 一进一出好大好爽视频| 一本一本综合久久| 搡老熟女国产l中国老女人| 五月伊人婷婷丁香| 亚洲五月天丁香| 精品久久久久久久久久久久久| 日本黄色视频三级网站网址| 亚洲av日韩精品久久久久久密| aaaaa片日本免费| 内射极品少妇av片p| www日本黄色视频网| 最近最新中文字幕大全免费视频| 天堂网av新在线| 大型黄色视频在线免费观看| 99国产综合亚洲精品| 色av中文字幕| 午夜福利高清视频| 岛国在线免费视频观看| 国内精品久久久久精免费| 麻豆久久精品国产亚洲av| 国产亚洲欧美在线一区二区| 婷婷丁香在线五月| 三级国产精品欧美在线观看| 狠狠狠狠99中文字幕| 国产视频内射| 欧美激情久久久久久爽电影| 一二三四社区在线视频社区8| 三级毛片av免费| 欧美乱色亚洲激情| 亚洲片人在线观看| 欧美xxxx黑人xx丫x性爽| 国产单亲对白刺激| 欧美高清成人免费视频www| 国产乱人伦免费视频| 特级一级黄色大片| 香蕉久久夜色| 亚洲中文字幕一区二区三区有码在线看| 精品国产三级普通话版| 毛片女人毛片| 欧美+日韩+精品| 国产精品av视频在线免费观看| 男插女下体视频免费在线播放| 一级毛片高清免费大全| 久久久成人免费电影| 好男人在线观看高清免费视频| 中文资源天堂在线| 亚洲精品色激情综合| 精品无人区乱码1区二区| 两性午夜刺激爽爽歪歪视频在线观看| 五月玫瑰六月丁香| 久久久色成人| 婷婷丁香在线五月| 亚洲熟妇熟女久久| 黄色视频,在线免费观看| 十八禁人妻一区二区| 中出人妻视频一区二区| 国产久久久一区二区三区| a级一级毛片免费在线观看| 欧美区成人在线视频| 不卡一级毛片| 精品人妻偷拍中文字幕| 亚洲成人中文字幕在线播放| 深爱激情五月婷婷| 国产精品 欧美亚洲| 身体一侧抽搐| 免费搜索国产男女视频| 99久久精品一区二区三区| 成人三级黄色视频| 丝袜美腿在线中文| 国产真实乱freesex| 看黄色毛片网站| 国产爱豆传媒在线观看| 国产精品自产拍在线观看55亚洲| av片东京热男人的天堂| 黄色成人免费大全| 五月伊人婷婷丁香| 一边摸一边抽搐一进一小说| 日本熟妇午夜| 亚洲内射少妇av| 色综合欧美亚洲国产小说| 亚洲 欧美 日韩 在线 免费| 最近最新中文字幕大全免费视频| 看黄色毛片网站| 欧美三级亚洲精品| 免费观看人在逋| 老师上课跳d突然被开到最大视频 久久午夜综合久久蜜桃 | 欧美中文综合在线视频| 亚洲专区国产一区二区| 成人三级黄色视频| 男人和女人高潮做爰伦理| 特大巨黑吊av在线直播| 看片在线看免费视频| 91字幕亚洲| 丰满乱子伦码专区| 九色国产91popny在线| 亚洲真实伦在线观看| 中亚洲国语对白在线视频| 久久伊人香网站| 国语自产精品视频在线第100页| 91在线观看av| 亚洲成人免费电影在线观看| 一级a爱片免费观看的视频| 黄色视频,在线免费观看| 国产在视频线在精品| 亚洲成人免费电影在线观看| 18禁美女被吸乳视频| 日韩大尺度精品在线看网址| 在线视频色国产色| 久久精品91无色码中文字幕| 国产免费男女视频| 国产精品三级大全| 黄色片一级片一级黄色片| 人人妻人人看人人澡| 亚洲自拍偷在线| 香蕉丝袜av| 色尼玛亚洲综合影院| 我的老师免费观看完整版| 欧美一区二区国产精品久久精品| 男女那种视频在线观看| 国内揄拍国产精品人妻在线| 精品欧美国产一区二区三| 在线观看舔阴道视频| 久久精品国产亚洲av香蕉五月| 国产麻豆成人av免费视频| 黄色日韩在线| 精品免费久久久久久久清纯| 一区二区三区国产精品乱码| 99精品欧美一区二区三区四区| 首页视频小说图片口味搜索| 欧美日韩精品网址| 一a级毛片在线观看| 日韩欧美精品免费久久 | 亚洲 国产 在线| 亚洲精品久久国产高清桃花| 国产精品野战在线观看| 日本免费一区二区三区高清不卡| 18禁在线播放成人免费| 精品午夜福利视频在线观看一区| 在线观看av片永久免费下载| 禁无遮挡网站| 国产黄片美女视频| 51午夜福利影视在线观看| 人妻丰满熟妇av一区二区三区| 精华霜和精华液先用哪个| 亚洲av免费高清在线观看| 欧美日韩瑟瑟在线播放| 欧美日韩中文字幕国产精品一区二区三区| 亚洲欧美激情综合另类| 我的老师免费观看完整版| avwww免费| 久久天躁狠狠躁夜夜2o2o| 最近最新中文字幕大全电影3| ponron亚洲| 性色avwww在线观看| 又黄又爽又免费观看的视频| 99国产综合亚洲精品| 窝窝影院91人妻| 香蕉av资源在线| 老司机福利观看| 成人av一区二区三区在线看| 久久九九热精品免费| 中文字幕av在线有码专区| 村上凉子中文字幕在线| 在线观看午夜福利视频| 久久精品国产亚洲av涩爱 | 国产高清有码在线观看视频| 又黄又粗又硬又大视频| 在线免费观看的www视频| 三级毛片av免费| 日韩欧美精品免费久久 | www日本在线高清视频| 日韩人妻高清精品专区| 久久久久久大精品| 非洲黑人性xxxx精品又粗又长| 香蕉久久夜色| 男女下面进入的视频免费午夜| 亚洲aⅴ乱码一区二区在线播放| 高清在线国产一区| 国产伦在线观看视频一区| 一区福利在线观看| 偷拍熟女少妇极品色| 亚洲久久久久久中文字幕| 国产99白浆流出| 最近视频中文字幕2019在线8| 老司机福利观看| 国产一区二区三区视频了| 欧美性感艳星| 欧美另类亚洲清纯唯美| 亚洲成人免费电影在线观看| 国产精品日韩av在线免费观看| 在线观看免费午夜福利视频| 欧美不卡视频在线免费观看| 久久久久久国产a免费观看| 午夜福利成人在线免费观看| 亚洲国产精品sss在线观看| 午夜免费激情av| 日韩精品中文字幕看吧| 一个人免费在线观看电影| 中文字幕高清在线视频| 欧美一区二区国产精品久久精品| 少妇的逼水好多| 老汉色av国产亚洲站长工具| 夜夜躁狠狠躁天天躁| 国产精品,欧美在线| 色尼玛亚洲综合影院| 伊人久久大香线蕉亚洲五| 精品久久久久久久末码| 看免费av毛片| 欧美av亚洲av综合av国产av| 一区二区三区免费毛片| 99国产精品一区二区三区| 香蕉丝袜av| 怎么达到女性高潮| 国产三级黄色录像| 国产综合懂色| 色吧在线观看| 一卡2卡三卡四卡精品乱码亚洲| 午夜福利18| 欧美成狂野欧美在线观看| 国产在视频线在精品| 国产乱人伦免费视频| 欧美+亚洲+日韩+国产| 午夜免费成人在线视频| 69av精品久久久久久| 精品国内亚洲2022精品成人| 国产欧美日韩一区二区三| 精品99又大又爽又粗少妇毛片 | avwww免费| 给我免费播放毛片高清在线观看| 最新美女视频免费是黄的| 国产成人啪精品午夜网站| 老司机午夜十八禁免费视频| 精品午夜福利视频在线观看一区| 欧美激情久久久久久爽电影| 欧美午夜高清在线| 日韩欧美精品免费久久 | 在线观看午夜福利视频| 国产激情偷乱视频一区二区| 日本黄大片高清| 一个人免费在线观看的高清视频| 国内精品久久久久久久电影| 成人一区二区视频在线观看| 一区二区三区国产精品乱码| 成年女人看的毛片在线观看| 免费av毛片视频| 三级毛片av免费| 午夜福利在线观看免费完整高清在 | 国产视频一区二区在线看| 欧美日韩中文字幕国产精品一区二区三区| 在线播放国产精品三级| www日本黄色视频网| 亚洲欧美日韩卡通动漫| 高潮久久久久久久久久久不卡| 亚洲成人久久性| 色吧在线观看| 欧美一级a爱片免费观看看| 亚洲欧美日韩无卡精品| 欧美丝袜亚洲另类 | bbb黄色大片| 一区二区三区高清视频在线| 中国美女看黄片| 午夜两性在线视频| 男女之事视频高清在线观看| 亚洲天堂国产精品一区在线| 午夜免费成人在线视频| 久久性视频一级片| 小蜜桃在线观看免费完整版高清| 一个人免费在线观看的高清视频| 色尼玛亚洲综合影院| 男女做爰动态图高潮gif福利片| 特大巨黑吊av在线直播| 日本五十路高清| 高清毛片免费观看视频网站| 国产精品98久久久久久宅男小说| 高清毛片免费观看视频网站| 国产精品98久久久久久宅男小说| 青草久久国产| 伊人久久精品亚洲午夜| 久久久久久久精品吃奶| 看免费av毛片| 一个人免费在线观看的高清视频| 高清在线国产一区| 久久久久久九九精品二区国产| 免费大片18禁| 精品一区二区三区av网在线观看| 亚洲乱码一区二区免费版| 亚洲人成伊人成综合网2020| 国产精品99久久99久久久不卡| 国产精品 国内视频| 欧美+日韩+精品| 有码 亚洲区| 黄片大片在线免费观看| 亚洲人成网站高清观看| 亚洲片人在线观看| a在线观看视频网站| 99精品在免费线老司机午夜| 欧美bdsm另类| 中国美女看黄片| 国产伦精品一区二区三区四那| 久久人人精品亚洲av| 69av精品久久久久久| 亚洲久久久久久中文字幕| 99国产精品一区二区三区| 91字幕亚洲| 最后的刺客免费高清国语| 欧美大码av| 午夜福利高清视频| 18禁裸乳无遮挡免费网站照片| 丁香六月欧美| 日韩成人在线观看一区二区三区| 久久久国产成人免费| 熟妇人妻久久中文字幕3abv| 亚洲av成人av| 久久草成人影院| 男人舔奶头视频| 黄色视频,在线免费观看| 亚洲人成伊人成综合网2020| 韩国av一区二区三区四区| 高潮久久久久久久久久久不卡| 美女被艹到高潮喷水动态| 亚洲国产精品sss在线观看| 有码 亚洲区| 窝窝影院91人妻| 99热只有精品国产| 午夜福利18| 日日干狠狠操夜夜爽| 国产亚洲精品一区二区www| 香蕉av资源在线| 国内久久婷婷六月综合欲色啪| ponron亚洲| 亚洲精品国产精品久久久不卡| 成熟少妇高潮喷水视频| 一级毛片女人18水好多| 亚洲中文字幕一区二区三区有码在线看| 搡老妇女老女人老熟妇| 国产久久久一区二区三区| 国产一区二区三区视频了| 在线观看午夜福利视频| 小蜜桃在线观看免费完整版高清| 岛国视频午夜一区免费看| 欧美乱妇无乱码| 久久国产精品影院| 免费av毛片视频| av女优亚洲男人天堂| 免费av观看视频| 久久久久久九九精品二区国产| 深爱激情五月婷婷| 亚洲av中文字字幕乱码综合| 91麻豆精品激情在线观看国产| 亚洲av免费高清在线观看| www国产在线视频色| 精品欧美国产一区二区三| 亚洲av电影在线进入| 中文字幕人妻丝袜一区二区| 免费av毛片视频| 99riav亚洲国产免费| 成人亚洲精品av一区二区| 在线观看免费视频日本深夜| 亚洲片人在线观看| 我要搜黄色片| 午夜激情欧美在线| 久久久国产成人精品二区| 亚洲人成网站高清观看| 日韩精品中文字幕看吧| 免费电影在线观看免费观看| 桃红色精品国产亚洲av| 国产 一区 欧美 日韩| 一级黄色大片毛片| 黄色成人免费大全| 变态另类丝袜制服| 日韩有码中文字幕| 亚洲午夜理论影院| 小说图片视频综合网站| 动漫黄色视频在线观看| 男女午夜视频在线观看| 床上黄色一级片| 女人被狂操c到高潮| 免费一级毛片在线播放高清视频| 亚洲专区中文字幕在线| 国产精品精品国产色婷婷| 少妇人妻精品综合一区二区 | 两个人视频免费观看高清| 国产精品 欧美亚洲| 午夜福利在线观看免费完整高清在 | 99国产综合亚洲精品| 99久久无色码亚洲精品果冻| 精品日产1卡2卡| 欧美乱色亚洲激情| 久久亚洲精品不卡| 黄片大片在线免费观看| 亚洲国产欧美网| 久久久成人免费电影| 一边摸一边抽搐一进一小说| 欧美国产日韩亚洲一区| 女同久久另类99精品国产91| 国产高清激情床上av| 精品久久久久久久末码| 国产色婷婷99| 1000部很黄的大片| 久久久久久久精品吃奶| 日日夜夜操网爽| 美女免费视频网站| 免费观看的影片在线观看| 欧美成人免费av一区二区三区| 中文资源天堂在线| 草草在线视频免费看| 免费观看人在逋| 99精品久久久久人妻精品| 欧美日韩亚洲国产一区二区在线观看| 国产亚洲精品av在线| 亚洲av免费在线观看| 色视频www国产| 国产极品精品免费视频能看的| 99国产综合亚洲精品| 国产高清videossex| 99精品在免费线老司机午夜| 亚洲 国产 在线| 一个人免费在线观看的高清视频| 国产在视频线在精品| av天堂在线播放| 午夜福利在线观看吧| 久久精品国产综合久久久| 91av网一区二区| 老鸭窝网址在线观看| 免费看日本二区| 久久人妻av系列| 2021天堂中文幕一二区在线观| 免费搜索国产男女视频| 91九色精品人成在线观看| 九九热线精品视视频播放| 老司机福利观看| 国产一区二区三区视频了| 免费大片18禁| 99热这里只有是精品50| 亚洲精品在线观看二区| 99在线视频只有这里精品首页| 国产色爽女视频免费观看| 精品国产超薄肉色丝袜足j| 3wmmmm亚洲av在线观看| 极品教师在线免费播放| 午夜久久久久精精品| 日本免费一区二区三区高清不卡| 免费观看人在逋| 色综合婷婷激情| 国产主播在线观看一区二区| 成年人黄色毛片网站| 老司机在亚洲福利影院| 露出奶头的视频| 亚洲欧美日韩高清专用| 亚洲在线观看片| 又紧又爽又黄一区二区| 欧美性猛交黑人性爽| 欧美极品一区二区三区四区| 国产高清视频在线播放一区| 午夜精品在线福利| 国内精品一区二区在线观看| АⅤ资源中文在线天堂| 99久久成人亚洲精品观看| av天堂在线播放| 久久久色成人| 午夜日韩欧美国产| 国产成人91sexporn| 亚洲精品影视一区二区三区av| 精品一区二区三卡| 精品人妻偷拍中文字幕| 女人十人毛片免费观看3o分钟| 欧美高清成人免费视频www| 国产欧美另类精品又又久久亚洲欧美| 久久久久性生活片| 边亲边吃奶的免费视频| 舔av片在线| 免费看av在线观看网站| av在线蜜桃| 欧美zozozo另类| 亚洲国产成人一精品久久久| 国产伦理片在线播放av一区| 男的添女的下面高潮视频| 亚洲一级一片aⅴ在线观看| 在线观看免费高清a一片|