日韩精品一区二区三区在线视频放-无码中文字幕V?一区二区-成年片免费观看视频-国内少妇人妻丰满av-国产精品中文字幕免费观看-亚洲成人久久一区二区三区-国内少妇偷人精品视频无缓冲-一区二区国产精品日本一区二区三区在线网

ARTICLE DETAIL

資訊詳情

深耕商務(wù)建站與企業(yè)官網(wǎng)運(yùn)營(yíng)的一線(xiàn)實(shí)戰(zhàn)洞察。

Frenet坐標(biāo)系在無(wú)人車(chē)動(dòng)作規(guī)劃中的核心原理與工程實(shí)踐

Frenet坐標(biāo)系在無(wú)人車(chē)動(dòng)作規(guī)劃中的核心原理與工程實(shí)踐 簡(jiǎn)介面向自動(dòng)駕駛與輔助駕駛領(lǐng)域的算法學(xué)習(xí)者和開(kāi)發(fā)者這份Python項(xiàng)目演示了高速場(chǎng)景下基于Frenet優(yōu)化軌跡的無(wú)人車(chē)動(dòng)作規(guī)劃思路。通過(guò)完整可運(yùn)行的代碼讀者可以學(xué)習(xí)如何將道路坐標(biāo)轉(zhuǎn)換到Frenet系理解軌跡生成、平滑與可行性驗(yàn)證的整體流程適合具有一定Python基礎(chǔ)、希望深入局部路徑規(guī)劃的讀者。壓縮包共8個(gè)文件核心為2個(gè)py腳本——三次樣條插值工具與Frenet最優(yōu)軌跡生成主程序配套xml工程配置、iml模塊文件及pyc編譯緩存整體僅12KB輕量且易于直接運(yùn)行調(diào)試。目前已有5347人次學(xué)習(xí)瀏覽對(duì)正在學(xué)習(xí)路徑規(guī)劃、動(dòng)作規(guī)劃或準(zhǔn)備入門(mén)自動(dòng)駕駛項(xiàng)目的開(kāi)發(fā)者有一定參考價(jià)值。借助代碼讀者可直觀(guān)看到不同采樣參數(shù)對(duì)軌跡形態(tài)的影響并結(jié)合作者博客梳理代價(jià)函數(shù)設(shè)計(jì)、障礙物約束處理和橫向/縱向運(yùn)動(dòng)解耦等關(guān)鍵點(diǎn)修改車(chē)道間距、速度等參數(shù)后還能快速驗(yàn)證多種場(chǎng)景下的規(guī)劃效果是理解無(wú)人車(chē)動(dòng)作規(guī)劃從理論到實(shí)現(xiàn)的實(shí)用樣例。 作為一名在自動(dòng)駕駛行業(yè)摸爬滾打了多年的工程師我深知「Frenet」這三個(gè)字在無(wú)人車(chē)動(dòng)作規(guī)劃中的分量。我們常說(shuō)車(chē)要開(kāi)得「像老司機(jī)」本質(zhì)上就是要在任意彎曲的道路上既能把控好方向盤(pán)、保持車(chē)道又能安全平穩(wěn)地跟車(chē)、變道、避障。而這一切的起點(diǎn)就是坐標(biāo)系的選擇。坦白說(shuō)早期我用笛卡爾坐標(biāo)系做軌跡規(guī)劃時(shí)被彎道上的目標(biāo)點(diǎn)約束問(wèn)題折騰得夠嗆直到徹底吃透基于Frenet優(yōu)化軌跡的動(dòng)作規(guī)劃框架才真正體會(huì)到什么叫「豁然開(kāi)朗」。這篇文章我不打算聊教科書(shū)上那種枯燥的推導(dǎo)而是以我實(shí)際跑過(guò)的一個(gè)項(xiàng)目為例把「為什么用Frenet」「軌跡怎么生成」「代價(jià)函數(shù)怎么設(shè)計(jì)」以及「實(shí)車(chē)調(diào)試中的那些坑」拆開(kāi)講透。無(wú)論你是剛接觸動(dòng)作規(guī)劃的學(xué)生還是已經(jīng)在工程里被各種軌跡抖動(dòng)折磨的同行這篇都值得收藏慢慢看。1. 為什么無(wú)人車(chē)的動(dòng)作規(guī)劃繞不開(kāi)Frenet坐標(biāo)系1.1 笛卡爾坐標(biāo)系下的「約束困境」先從我踩過(guò)的一個(gè)坑說(shuō)起。項(xiàng)目初期我直接在全局坐標(biāo)系笛卡爾坐標(biāo)系下規(guī)劃軌跡車(chē)輛的位姿是 (x, y, yaw)規(guī)劃的每一步都要把車(chē)的位置、朝向、曲率放在統(tǒng)一的XY平面上計(jì)算。當(dāng)時(shí)遇到一個(gè)典型的場(chǎng)景車(chē)輛需要在一個(gè)曲率較大的彎道內(nèi)側(cè)變換車(chē)道目標(biāo)點(diǎn)不僅要滿(mǎn)足橫向位移還要時(shí)刻保持在道路邊界內(nèi)。麻煩就出在這里道路邊界在X-Y平面上是一個(gè)不規(guī)則的彎曲區(qū)域如果你想約束軌跡不壓線(xiàn)就得把道路邊界離散成幾百個(gè)點(diǎn)然后做大量點(diǎn)在多邊形內(nèi)部的判斷計(jì)算量陡增。更要命的是橫向偏移和縱向行駛距離在笛卡爾坐標(biāo)系下是高度耦合的。你想讓車(chē)在彎道里平緩地橫向偏移但同樣的橫向偏移量在彎道外側(cè)和內(nèi)側(cè)對(duì)應(yīng)的實(shí)際道路空間完全不同。我花了大量時(shí)間去調(diào)整約束條件結(jié)果軌跡仍然會(huì)出現(xiàn)局部抖動(dòng)就是因?yàn)樽鴺?biāo)系本身的耦合特性把問(wèn)題復(fù)雜化了。1.2 Frenet框架真正表達(dá)的是什么后來(lái)我切換到了Frenet坐標(biāo)系一句話(huà)概括它的核心思想以參考線(xiàn)通常是道路中心線(xiàn)或車(chē)道中心線(xiàn)為基準(zhǔn)把車(chē)輛的任意運(yùn)動(dòng)拆解成兩個(gè)獨(dú)立的分量——縱向位移 s沿著參考線(xiàn)走了多遠(yuǎn)和橫向偏移 d偏離參考線(xiàn)多少。這個(gè)拆解帶來(lái)的好處是革命性的。道路的彎曲形狀被「拉直」成了一個(gè)弧長(zhǎng)軸 s原本在笛卡爾坐標(biāo)系下的彎道約束變成了對(duì)橫向偏移 d 的簡(jiǎn)單區(qū)間約束。比如「車(chē)輛不能壓線(xiàn)」可以直接寫(xiě)成一個(gè)不等式d_min d d_max。而「車(chē)輛需要保持車(chē)道中心」則意味著目標(biāo)橫向偏移 d_target ≈ 0。這就很像我們平時(shí)開(kāi)車(chē)時(shí)腦子里的導(dǎo)航邏輯我不會(huì)去想「我現(xiàn)在在世界坐標(biāo)系里的絕對(duì)坐標(biāo)是多少」而是想「我離車(chē)道中心偏了多遠(yuǎn)」「前方彎道還有多少米」。Frenet坐標(biāo)系本質(zhì)上就是把這種人類(lèi)駕駛直覺(jué)數(shù)學(xué)化。所以做無(wú)人車(chē)動(dòng)作規(guī)劃時(shí)Frenet 幾乎是繞不開(kāi)的基礎(chǔ)設(shè)施。2. 從行車(chē)狀態(tài)到Frenet軌跡完整的數(shù)學(xué)建模與狀態(tài)轉(zhuǎn)換2.1 Frenet坐標(biāo)系下車(chē)輛狀態(tài)的六個(gè)關(guān)鍵量要在代碼里實(shí)現(xiàn)這個(gè)框架第一步是把車(chē)輛的實(shí)時(shí)狀態(tài)映射到Frenet坐標(biāo)系中。這里需要用到六個(gè)關(guān)鍵量它們共同描述了一輛車(chē)在當(dāng)前參考線(xiàn)上的運(yùn)動(dòng)狀態(tài)s縱向弧長(zhǎng)表示車(chē)輛在參考線(xiàn)上的投影位置。s_dot縱向速度即沿參考線(xiàn)方向的速度分量。s_ddot縱向加速度。d橫向偏移表示車(chē)輛相對(duì)參考線(xiàn)的側(cè)向距離左負(fù)右正符號(hào)約定因工程而異。d_dot橫向速度即橫向偏移的變化率。d_ddot橫向加速度。嚴(yán)格來(lái)說(shuō)完整的Frenet公式還會(huì)涉及 d 對(duì) s 的各階導(dǎo)數(shù)d、d、d用來(lái)關(guān)聯(lián)軌跡幾何與車(chē)輛運(yùn)動(dòng)學(xué)。但在實(shí)際的采樣規(guī)劃中我們通常會(huì)保留時(shí)間域上的導(dǎo)數(shù)因?yàn)楹罄m(xù)生成軌跡多項(xiàng)式時(shí)時(shí)間域積分更直觀(guān)。2.2 從笛卡爾坐標(biāo)到Frenet坐標(biāo)的轉(zhuǎn)換實(shí)踐工程上做坐標(biāo)轉(zhuǎn)換最核心的工作是找到車(chē)輛當(dāng)前位置在參考線(xiàn)上的最近投影點(diǎn)。這個(gè)點(diǎn)對(duì)應(yīng)的弧長(zhǎng)就是 s而從車(chē)輛位置到投影點(diǎn)的有向向量長(zhǎng)度就是 d。我們項(xiàng)目里的做法是把參考線(xiàn)預(yù)采樣成密集的點(diǎn)列每0.5米一個(gè)點(diǎn)然后用KD-Tree加速查找最近點(diǎn)。這里有一個(gè)容易被忽略的細(xì)節(jié)找到最近點(diǎn)之后還需要對(duì)s坐標(biāo)做線(xiàn)性插值修正。因?yàn)樽罱c(diǎn)所在的線(xiàn)段其方向可能和車(chē)輛前進(jìn)方向有夾角直接取離散點(diǎn)索引做s會(huì)導(dǎo)致縱向速度產(chǎn)生微小跳變。我試過(guò)忽略這個(gè)修正結(jié)果在彎道出口處軌跡曲率出現(xiàn)了周期性抖動(dòng)。坐標(biāo)轉(zhuǎn)換的偽代碼大致長(zhǎng)這樣def cartesian_to_frenet(x, y, ref_line): # 1. KD-Tree 查找最近點(diǎn)索引 nearest_idx kd_tree.query([x, y])[1] # 2. 在最近線(xiàn)段上做投影插值 segment_start ref_line[nearest_idx] segment_end ref_line[nearest_idx 1] dx segment_end.x - segment_start.x dy segment_end.y - segment_start.y seg_len sqrt(dx * dx dy * dy) # 3. 計(jì)算橫向偏移帶符號(hào) cross dx * (y - segment_start.y) - dy * (x - segment_start.x) d cross / seg_len # 4. 計(jì)算縱向弧長(zhǎng)考慮插值比例 proj_ratio ((x - segment_start.x) * dx (y - segment_start.y) * dy) / (seg_len * seg_len) s ref_line.cumulative_s[nearest_idx] proj_ratio * seg_len return s, d這一步如果做得扎實(shí)后面軌跡生成的所有輸入都是干凈、連續(xù)的能省下無(wú)數(shù)排查時(shí)間。3. 候選軌跡生成橫向與縱向解耦后的采樣與多項(xiàng)式擬合3.1 橫向軌跡五次多項(xiàng)式連接起終點(diǎn)狀態(tài)有了當(dāng)前狀態(tài)下一件大事就是「生成候選軌跡」。Frenet框架的核心魅力在于橫向運(yùn)動(dòng) d(t) 和縱向運(yùn)動(dòng) s(t) 可以被分別規(guī)劃然后在時(shí)間軸上重新組合。先看橫向。我在項(xiàng)目中生成橫向軌跡時(shí)使用的是五次多項(xiàng)式d(t) a0 a1·t a2·t2 a3·t3 a4·t? a5·t?為什么是五次而不是三次因?yàn)闄M向軌跡需要滿(mǎn)足的邊界條件有六個(gè)起點(diǎn)位置的橫向偏移、橫向速度、橫向加速度以及終點(diǎn)位置的橫向偏移、橫向速度、橫向加速度。六個(gè)未知數(shù)a0~a5六個(gè)方程恰好能解出唯一解。如果需要終點(diǎn)加速度可控三次多項(xiàng)式是無(wú)論如何也做不到的。實(shí)際操作中我會(huì)先把當(dāng)前車(chē)輛的 d、d_dot、d_ddot 讀出來(lái)作為起點(diǎn)狀態(tài)然后遍歷一系列目標(biāo)橫向偏移值 d_target。比如在標(biāo)準(zhǔn)雙車(chē)道場(chǎng)景下我會(huì)采樣 {-3.5, -3.0, -2.5, ..., 0, ..., 3.5} 米同時(shí)設(shè)定到達(dá)時(shí)間 T 的采樣集合常見(jiàn)的取值是 {1秒, 2秒, 3秒, 4秒, 5秒}。這樣橫向規(guī)劃就生成了一批「從當(dāng)前位置平滑挪到不同橫向位置」的軌跡簇。3.2 縱向軌跡四次多項(xiàng)式讓速度變化更平滑縱向軌跡 s(t) 采用了四次多項(xiàng)式s(t) b0 b1·t b2·t2 b3·t3 b4·t?這里只需要五個(gè)邊界條件因?yàn)榭v向規(guī)劃的終點(diǎn)通常不需要約束加速度只需要約束位置和速度即可。起點(diǎn)縱向位置 s、縱向速度 s_dot、縱向加速度 s_ddot終點(diǎn)縱向位置 s_target、終點(diǎn)縱向速度 s_dot_target。我特別強(qiáng)調(diào)一個(gè)技巧終點(diǎn)速度的選擇決定了車(chē)輛的駕駛風(fēng)格。如果你想讓車(chē)在跟車(chē)時(shí)保持舒適那么 s_dot_target 應(yīng)該朝向目標(biāo)車(chē)輛的當(dāng)前速度收斂。比如我在高速巡航場(chǎng)景下會(huì)設(shè)置一個(gè)「巡航速度」參數(shù)比如 25 m/s約90 km/h然后所有縱向采樣的終點(diǎn)速度都向這個(gè)值靠攏。而在路口或擁堵場(chǎng)景則會(huì)根據(jù)前車(chē)速度動(dòng)態(tài)調(diào)整??v向采樣的目標(biāo)位置 s_target 不是隨意定的它由想要到達(dá)的縱向距離范圍決定。比如前方10米、30米、60米處分別采樣一個(gè)目標(biāo)位置加上目標(biāo)速度就生成了一組全速域可選的縱向軌跡。3.3 采樣組合與軌跡合并成完整運(yùn)動(dòng)軌跡橫向軌跡和縱向軌跡生成好之后就要把它們「合體」。具體的做法是在每一個(gè)時(shí)間步 t 上把橫向多項(xiàng)式給出的 d(t) 和縱向多項(xiàng)式給出的 s(t) 合并成一個(gè)Frenet坐標(biāo)點(diǎn) (s(t), d(t))然后轉(zhuǎn)換回笛卡爾坐標(biāo)系。這個(gè)合體過(guò)程在代碼里特別容易出錯(cuò)因?yàn)樗髾M向和縱向的采樣時(shí)間集合必須完全對(duì)齊。我見(jiàn)過(guò)不少新手直接把兩個(gè)獨(dú)立時(shí)間軸的結(jié)果套在一起導(dǎo)致軌跡出現(xiàn)「時(shí)間扭曲」。穩(wěn)妥的做法是先定義一個(gè)統(tǒng)一的時(shí)間軸比如 t 0, 0.1, 0.2, ..., T_max再分別對(duì)橫向和縱向多項(xiàng)式做求值最后配對(duì)組合。組合之后的軌跡還要做一次幾何轉(zhuǎn)換??梢园褏⒖季€(xiàn)的每個(gè)點(diǎn)看成是一個(gè)局部坐標(biāo)系原點(diǎn)把 (s(t), d(t)) 映射到全局坐標(biāo)系。這個(gè)環(huán)節(jié)里s 方向決定參考線(xiàn)切向d 方向決定參考線(xiàn)法向轉(zhuǎn)換公式是def frenet_to_cartesian(s, d, ref_line): # 找到參考線(xiàn)上 s 對(duì)應(yīng)的區(qū)間插值得到位置和切線(xiàn)方向 x_ref, y_ref, yaw_ref interpolate_ref_line(ref_line, s) # 法向方向偏移 x x_ref - d * sin(yaw_ref) y y_ref d * cos(yaw_ref) return x, y到這里一條完整的候選軌跡就生成了。批量遍歷橫向目標(biāo)偏移和縱向目標(biāo)位置的笛卡爾積就能得到幾十上百條候選軌跡下一步就是從中選出最優(yōu)。4. 最優(yōu)軌跡篩選代價(jià)函數(shù)設(shè)計(jì)、碰撞檢測(cè)與權(quán)重調(diào)參4.1 代價(jià)函數(shù)的架構(gòu)與各項(xiàng)的物理意義候選軌跡生成后不能一股腦全交給控制模塊必須通過(guò)「淘汰評(píng)分」兩道關(guān)卡。淘汰靠碰撞檢測(cè)和物理約束檢查評(píng)分靠代價(jià)函數(shù)。我項(xiàng)目的代價(jià)函數(shù)長(zhǎng)這樣J_total w_safe · J_collision w_jerk · J_jerk w_lat · J_lateral_offset w_eff · J_efficiency w_consistency · J_consistency每一項(xiàng)的物理意義很直接J_collision安全代價(jià)軌跡與障礙物距離的懲罰項(xiàng)。如果距離小于安全閾值這一項(xiàng)直接給極大值距離越大懲罰越小。更精細(xì)的做法是引入「時(shí)間維度」的碰撞檢查即考慮障礙物未來(lái)一段時(shí)間的預(yù)測(cè)位置與軌跡在對(duì)應(yīng)時(shí)刻的位置比較。J_jerk舒適性代價(jià)評(píng)價(jià)軌跡的加加速度即橫向jerk和縱向jerk的加權(quán)和。這個(gè)值越低車(chē)輛加減速和方向盤(pán)動(dòng)作越柔和乘客感受越舒適。J_lateral_offset偏移代價(jià)評(píng)價(jià)軌跡與參考線(xiàn)的偏差程度。它反映了「保持車(chē)道中心」的傾向避免車(chē)輛在無(wú)必要的情況下頻繁變道或壓線(xiàn)。J_efficiency效率代價(jià)評(píng)價(jià)軌跡與期望車(chē)速的偏差。如果前方暢通效率代價(jià)會(huì)鼓勵(lì)車(chē)輛加速到巡航速度如果前方堵車(chē)效率代價(jià)會(huì)引導(dǎo)車(chē)輛跟隨前車(chē)速度。J_consistency一致性代價(jià)比較當(dāng)前候選軌跡與上一周期規(guī)劃結(jié)果的差異。這是我在實(shí)車(chē)調(diào)試后補(bǔ)充的非常重要。沒(méi)有這一項(xiàng)車(chē)輛在快速切換規(guī)劃周期時(shí)軌跡容易左右搖擺乘感極差。4.2 碰撞檢測(cè)與物理約束檢查的前置把關(guān)代價(jià)函數(shù)之前必須先做硬約束檢查。我把它分成三層靜態(tài)障礙物碰撞把柵格地圖上被占用的區(qū)域和軌跡點(diǎn)做距離檢查。這里我使用「圓-矩形」粗檢測(cè)速度快然后對(duì)候選軌跡上曲率較大的點(diǎn)做精確檢測(cè)避免軌跡弧線(xiàn)中部侵入障礙物。動(dòng)態(tài)障礙物碰撞一輛無(wú)人車(chē)不可能只面對(duì)靜止的錐桶。對(duì)于動(dòng)態(tài)車(chē)輛我會(huì)用簡(jiǎn)單的線(xiàn)性速度模型預(yù)測(cè)它未來(lái)3~5秒的包圍盒位置然后和軌跡逐時(shí)刻檢查。這里有個(gè)經(jīng)驗(yàn)預(yù)測(cè)時(shí)間窗不要設(shè)太長(zhǎng)超過(guò)5秒的預(yù)測(cè)模型誤差極大反而會(huì)誤殺很多本來(lái)安全的軌跡。車(chē)輛動(dòng)力學(xué)約束生成軌跡時(shí)可以天馬行空但最終能落地的軌跡必須滿(mǎn)足車(chē)輛本身的轉(zhuǎn)向和加速度極限。比如最大轉(zhuǎn)向角約束會(huì)轉(zhuǎn)化為軌跡最大曲率限制最大加速度/減速度約束會(huì)對(duì)應(yīng)縱向加速度限制。如果一個(gè)候選軌跡在以上任意一層被卡住就直接淘汰不再參與代價(jià)評(píng)分。這樣既保證了安全性又大幅減少了評(píng)分階段的計(jì)算量。4.3 權(quán)重調(diào)參的幾個(gè)實(shí)用方向代價(jià)函數(shù)寫(xiě)完之后真正的工程難點(diǎn)才出現(xiàn)權(quán)重怎么設(shè)。我常用的方法是「分層調(diào)參」第一層先固定安全相關(guān)權(quán)重把J_collision調(diào)成一個(gè)「一刀切」的硬門(mén)限不是靠權(quán)重壓而是靠淘汰機(jī)制兜底。第二層調(diào)舒適性和一致性。先設(shè)定一組默認(rèn)權(quán)重在仿真環(huán)境里跑標(biāo)準(zhǔn)彎道和變道場(chǎng)景觀(guān)察橫向加速度曲線(xiàn)。如果峰值加速度超過(guò)0.3g說(shuō)明J_jerk權(quán)重偏低或采樣時(shí)間窗太短我會(huì)把采樣時(shí)間窗拉長(zhǎng)1~2秒而不是一味加權(quán)重這樣更容易根治抖動(dòng)。第三層調(diào)效率和偏移。城市道路場(chǎng)景中效率和偏移經(jīng)常打架——想開(kāi)得快就難免偏離車(chē)道中心。我的建議是在限速較高的場(chǎng)景讓效率權(quán)重占優(yōu)在擁堵場(chǎng)景讓偏移和舒適權(quán)重占優(yōu)。一個(gè)我常用的初始權(quán)重方案相對(duì)值代價(jià)項(xiàng)權(quán)重比例說(shuō)明J_collision1000本質(zhì)替代淘汰碰到即死J_jerk10保證基本舒適度J_lateral_offset5趨向車(chē)道中心J_efficiency8追求合理速度J_consistency15抑制軌跡抖動(dòng)這套參數(shù)在我的項(xiàng)目里表現(xiàn)穩(wěn)定但具體數(shù)值必須在你的場(chǎng)景里重新標(biāo)定。不要迷信任何一套固定權(quán)重。5. 實(shí)車(chē)落地中被反復(fù)教育的幾個(gè)細(xì)節(jié)5.1 Frenet坐標(biāo)與笛卡爾坐標(biāo)轉(zhuǎn)換的精度陷阱仿真里跑得好好的軌跡一上實(shí)車(chē)就可能出現(xiàn)「車(chē)輛畫(huà)龍」。我排查了整整兩周最后定位到問(wèn)題根源參考線(xiàn)投影的精度不夠。當(dāng)車(chē)輛實(shí)際位置與參考線(xiàn)的最近點(diǎn)落在兩個(gè)預(yù)采樣點(diǎn)之間時(shí)線(xiàn)性插值會(huì)引入一個(gè)微小的切向誤差這個(gè)誤差在彎道曲率變化劇烈的地方會(huì)被放大導(dǎo)致轉(zhuǎn)換出的笛卡爾軌跡出現(xiàn)高頻抖動(dòng)。解決辦法是在投影點(diǎn)附近做一次局部二階插值或者把參考線(xiàn)采樣間隔從0.5米加密到0.2米。加密之后軌跡抖動(dòng)問(wèn)題基本消失。代價(jià)是內(nèi)存和查找時(shí)間略微增加但換來(lái)的是實(shí)車(chē)穩(wěn)定性這筆賬非常劃算。5.2 高速場(chǎng)景下橫向采樣的范圍收縮很多從仿真轉(zhuǎn)到實(shí)車(chē)的朋友會(huì)忽略一個(gè)問(wèn)題橫向采樣范圍應(yīng)該隨車(chē)速變化。在低速泊車(chē)場(chǎng)景橫向采樣范圍可以拉到 ±3.5 米甚至更大讓車(chē)有足夠的機(jī)動(dòng)空間。但在高速公路上車(chē)速到 80 km/h 以上時(shí)橫向采樣范圍如果還是 ±3.5 米生成的軌跡往往因?yàn)闄M向加速度過(guò)大而被動(dòng)力學(xué)約束淘汰有效軌跡稀疏甚至可能導(dǎo)致規(guī)劃無(wú)解。我實(shí)際的做法是做一個(gè)簡(jiǎn)單的線(xiàn)性收縮max_d clamp(0.5 0.04 * v, 1.0, 3.5)車(chē)速越高橫向可探索范圍越窄。這樣既能保證高速下軌跡都在車(chē)輛物理極限附近又能讓低速時(shí)的機(jī)動(dòng)靈活性不丟失。5.3 軌跡連續(xù)性防止上一幀到下一幀的跳變最后聊一個(gè)所有實(shí)車(chē)工程師都會(huì)遇到的痛點(diǎn)軌跡跳變。原因是每個(gè)規(guī)劃周期都是獨(dú)立采樣的上一幀選出的最優(yōu)軌跡是T1下一幀可能因?yàn)檎系K物位置輕微變化或權(quán)重微小波動(dòng)選出一條與前幀差異很大的軌跡T2。如果直接把T2交給控制模塊車(chē)輛會(huì)猛地打一把方向。解決這個(gè)問(wèn)題我在項(xiàng)目中引入了「上一周期的軌跡作為基準(zhǔn)」策略。具體來(lái)說(shuō)把上一幀的最優(yōu)軌跡作為一組固定的候選軌跡加入本次的候選集中。在代價(jià)函數(shù)里提高 J_consistency 的權(quán)重凡是與上幀軌跡偏離過(guò)大的候選直接扣分。這套策略實(shí)車(chē)效果非常顯著。我見(jiàn)過(guò)一個(gè)真實(shí)案例去掉軌跡連續(xù)性約束后車(chē)輛在自動(dòng)駕駛變道時(shí)平均每15秒出現(xiàn)一次明顯的橫向抖動(dòng)加上之后連續(xù)跑了30分鐘都沒(méi)有一次明顯跳變。另外還有一個(gè)細(xì)節(jié)在做軌跡平滑時(shí)我會(huì)對(duì)最終輸出的路徑點(diǎn)做一個(gè)輕量級(jí)的曲率平滑比如滑動(dòng)窗口平均或道格拉斯-普克抽稀后再插值。這個(gè)步驟不改變軌跡的整體形態(tài)但能顯著減少方向盤(pán)修正頻率對(duì)乘坐體驗(yàn)的改善非常直接。最后再分享一個(gè)我個(gè)人的調(diào)試心得每次改完代價(jià)函數(shù)或采樣參數(shù)不要只在單一場(chǎng)景下驗(yàn)證。我會(huì)把同一套參數(shù)丟到三組數(shù)據(jù)里——高速?gòu)澋?、城市擁堵、緊急避障——去跑回歸測(cè)試。只有三個(gè)場(chǎng)景都不出問(wèn)題才敢提交。因?yàn)镕renet框架的解耦特性雖然強(qiáng)大但橫縱向軌跡組合之后小概率會(huì)出現(xiàn)「橫向沒(méi)問(wèn)題、縱向也沒(méi)問(wèn)題、合在一起就是不舒服」的耦合效應(yīng)。這種時(shí)候檢查一下是不是采樣組合里漏掉了「動(dòng)態(tài)障礙物預(yù)測(cè)軌跡與候選軌跡重疊」的情況通常能找到答案。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
特级毛片特黄久久免费看 | 白丝AV网站| 日日干天天干夜夜爽| 国产精品2020| 国产精品99久久久www| 东京热天堂网| 日韩97视频| 五月天婷婷色| 97在线精品观看视频| 人妻人久久精品中文字幕| www.夜夜| 欧美成人性爱视频免费观看 | 中文人妻av高清一区| 欧美在线视频观看一二三四区高清| 国产精品久久久久久高清无码免费看| 亚洲成人在线乱码色午夜| 色婷婷久久| 香伊人在线| 97超碰国产亚洲精品| 亚欧美色图| 久久久久免费少妇| 偷窥自拍A片| 精品午夜福利| 97伊人| 插老姨肥穴| 欧洲无码一区二区| 久久久精品国产亚洲伊人| 8050无码八戒| 亚洲av综合伊人久久| 躁躁躁日日躁2020| 男人天堂毛片| 大茄子熟女AV导航| 91美女视频直播| 久草精品国产蜜臀 | 久操 高清| 91九色精品熟女内射| 久久毛卡| 中字幕人妻一区二区三区| 97在线观| 欧美91变态| 9精品久久久久| 欧洲亚洲人人爽爽视频| 综合欧美日韩在线| 国产一区二区三区,在线观看观看| 国产精品视频精品一二| 日韩欧美tv一区二区在线观看| 91色色网站| 亚洲精品97| 精品美女少妇一区二区| 久久一二三四五六七八九区| 天欧美在线| 情侣操 逼视频99| sss视频华人在线| 日韩99神马视频播放片在线播放| 青青操在线亚洲视频观看欧美在线| 久久久久国产亚洲一区欧美色图日韩| 毛片17S| 国产av热热色| 日韩特一级久久| 久久综合精品一区二区三区| 后入式在线免费观看60秒| 精品国产一区二区三区久久久蜜臀| 美女啊啊啊啊pc| 欧美 亚洲 大香| 97超碰免费人人性爱| 日韩熟女操逼| 日本免费专区| 婷婷激情四射| 97青娱乐超碰久久| 日韩一级二级三级免费看完整版国语版 | 亚洲色阁| 丰满人妻区一区二区三| 精品久久久av无码免费| 精品一区二区亚洲国产| 91啪啪视频| 天天日天天插| 日韩一级二级三级免费看完整版国语版| 91劲爆| 青草成人免费视频一COm| 亚洲成人贴图| 免费的黄片有限公司| 熟女色综合久久| 日韩精品一区二区三区色欲 | 欧美久久久| 色欲久久99精品久久| 欧美综合第一页| 一个色导综合| 国产91美女高潮| 日少妇亚洲版| 日韩91网| 国产欧美一级在线观看| 日本韩国一本产品小视频日本韩国一本产品久久久产品小视频日本韩国一本产品久 | 激情啪啪视频| 少妇久久久久久久久| 日本人妻伦在线中文字幕| 中文字幕一区二区韩| 超碰97起碰| 久草精品视频| 91人妻少妇| 97在线精品观看视频| 色情综合| 色www精品视频在线观看| 91热色| 91av一区二区在线观看| 天美传媒国产原创中文字幕亚洲欧美另类 | 凹凸 69堂 在线播放| 国模无码一区二区三区在线| 97视频在| 国产毛片毛片4p懂色| 性做久久久久久免费观看软件| 亚洲欧美日韩有码| 青青草女人天天干| 乱伦日本中文自拍| 99这里有精品| 熟女91网站| 色哟哟 日韩精品| 九九AV| 久久精品无码不卡| 国产区性爱在线视频秋霞豆| 91 国产丝袜在线播放-百度| 一级日本牲交大片好爽在线看| 欧美亚洲日韩人妻在线观看| 国产视频97| A级片日韩欧美国产欧美视频精选观看 | 探花激情视频| 暴力av在线| 欧美精品日韩久久久九| 嗯嗯啊啊的视频| 亚洲欧美色图片| 精品久久人妻成人网| 国产第11页| 欧美五十路熟| 啊啊啊97视频| 情趣丝袜无码操逼视频| 中文字幕伊人| 婷婷丁香五月激情啪啪| 欧美小说区视频区| 日韩欧美经典在线观看| 欧美日日人人天天| 东京热激情视频一二三区| 另类老少妇| 亚洲成人久久美女| 97超碰超| 久久国产精品一级二级三级| 精品欧美老熟女一二区| 欧美精品双插| 岛国大片国产| 久久久久久人| 96久久科窝| 久久无码精品| 成人日韩中文字幕| 亚洲国产午夜真人一级片中文字幕精品黄网站 | 欧美性生活综合| 国产三级中文字幕粉嫩| 国产狂喷潮在线精品| 91女在线观看| 亚洲一区二区三区不卡国产欧美| 丁香7月婷婷| 色婷亚洲五月在线观看| 欧美黑人极品高潮喷吹熟女黑人性暴力日韩在线欧美极品一区二区老师黑人潮喷一 | 色噜噜狠狠色综无码久久合欧美| 偷拍 精品另类 凸凹了四区| 欧美黑人168页欧美黑人167| 亚洲九九视频在线观看| 六月丁香久久| 久久亚洲天堂| 亚洲AV成人无码一区二区三区在线观看| 舔舔啊| 色综合天天| 色约约一区=区三区| 夜夜爽妓女| 日韩国产不卡在线视频| 97国产精品久久久久| 亚洲精品一区二区免费在线观看| 97爱爱爱| 蜜臀久久久国产| 操逼啊啊啊91| 97在线看| 岛国不卡超碰护士AV在线播放| 欧美黄色片AAAAA| 精品久9| 大香蕉综合久久| 人妻精品一区二区在线| 翔田千里AV无码秘 三区| 97视频网站在线观看| 亚州一区二区| 日韩特一级久久| 色呦呦、国产精品| 婷婷在线精品| 日本久久女同性恋视频| 舔人妻中文免费视频| 亚洲最大91网| 一类av片在线看| 丰满人妻一区二区三区免费| A男人的天堂| 国产一区二区在线电影| 国产v片在线免费观看| 日韩无码久久熟女一级片| 使劲用力艹少妇视频一区二区| av国产无码| 青青免费在线视频一区 | 91动漫操逼视频| 欧美日韩精品久久久久久久久东北老熟妇| 久久綜合很很很| 人人摸人人添人人操| 一区在线精品中文字幕| 欧美日韩国产色五月综合在线| 大香蕉色十月| 99精品网| 6080yy午夜理论三级一区二区三区无码 | 国产成人精品午夜福利| 欧洲无码一区二区| 亚洲天堂中文字幕无码男同| 日本综合色图| 1禁看欧美黄片免费看| 高清不卡视频| 久草综合京东| 久久精品视-一级做a爰片性色毛片16美国-中国女与老外在线精品 | 一区二区三区高清天码| 国产精品久久妻无码网站| 干B网| 最新av在线| 黑丝少妇在线观看| 先锋精品av色鲁| 97色在线| 超碰亚洲欧美日韩无| 久久99操天天日| 久久9亚洲| 热久久99999| 麻豆性爱视频在线播放| 欧美一区二区情色| 啊啊啊啊在线观看网址| 综合网97| 深喉吞精| 草草电影院| 日韩无限资源| 欧美十八禁视频| 天天懆天天日| 红杏大香蕉| av天堂手机版追回| 91亚洲黑人| 色一射色一射| 加勒比久久av| 日日操丁香五月天| 日产狠狠干| 东北老女人的激情视频| 91久久久久| 久久区| 免费一级黄色录像影片| 嗯阿好爽好紧| 日韩本不卡视频在线观看| 91处女在线观看| 午夜黄色免费在线观看| 7月婷婷综合| 国产精品久久久久999| 中文乱码字幕观看视频| 国产特级毛片AAAAAA高潮流水 | 乱欲视频| 亚洲砖码砖专无区2023| 亚洲不卡不卡中文字幕不卡| 男女香蕉一区二区| 操逼无码操逼| 无码99| 91青青在线视频| 亚洲伊人成综合成人网| 国产精品久久久久综合| 一牛一区二区三区久久| 97亚洲综合影院| 人人摸人人摸人人干| 中文字幕丝袜人妻| 国产老女人久久毛| av九九| 久久超碰av在线| 肉动漫无遮挡h在线观看| 国产激情av女片自拍| 狼人综合婷婷激情四射| 风间由美日韩欧美久久| 大香蕉免费乱伦视频| 蜜桃传媒一区二区亚洲| 欧美亚洲手机在线| 99色色网| 亚洲天天自拍| 久久东京国产精品视频| 伊人久久在线视频观看| 久久久久久大| 370p日韩欧美亚洲精品| 99精品热| 亚洲av国产av综合av卡| 久久精品老司| 久久性爱精品一区| 中美日韩毛片| 久久这里只精品免费福利| 欧美精品人妻视频| 亚洲欧美天堂| 亚洲激情色片 | 久久一二区四| 国产精品com| 黄页18禁| 免费A片三p视频| 国产精品久久久久绯色| 级做a爱无码性色永久免费| 欧美在线伊人色| 日本爽爽爽爽爽爽免费视频| 日本不卡码黄色| 家庭乱伦麻豆| 国产一区麻豆免费观看| 黄色AAAAA欧美| 精品一久久久| 欧美性爱www免费版| 狠狠躁天天躁日日躁| 操逼免费视频无码国产| 97久久国产亚洲精品超碰热| 免费啪啪啪网站18岁| 亚洲色天堂九9| 岛国精品视频在线观看| 天天爽天天操啊啊啊| 校园春色之综合网| 欧美gv在线观看| 久久久久久久9最新免费视频观看| 黄色AAAAA欧美| 青青草女人天天干| 欧美老熟另类| 日本高清有码网址视频| 精品国产av一区二区三区四区入口| 91丝袜在线观看视频在线观看| 狠狠色伊人亚洲综合网站色| 日韩欧美久久婷婷网站| 精品视频日日夜夜| 日逼国产| 你懂的在线观看区国产| 欧美手机在线综合| 婷婷色一区| 18禁在线视频| 青青草五月份天| 国产久久一区二区午夜| 色婷婷激一区二区三区| 色吧5亚洲| 自拍第一页| 欧美在线官网| 国产成人自拍视频在线| 懂色中文一区二区三区| 97色碰| 玖玖超碰熟| 亚洲色图20p| 六月激情婷婷| 女人高潮大叫一级毛片| 丰满人妻一区二区三区性色| 人妻精品一区二区三区| 夜夜免费视频| 东北女人的毛片| 丁香五月电影| 郑州宾馆老熟女露脸啪啪| 啪啪啪亚欧美视频| 青草伊人网| 91性生活久久久| 超碰调教97| 天堂8在线新版官网| 亚洲 中文字幕 精品| 中出91视频| 久久一二三四不卡| GVH-003 母子姦 青木玲-麻豆视频,麻豆视传媒短视频网站入口,麻豆视传媒官网直 | 91麻豆天美| 久久精品六区| 91欧美丝袜| 久久久久一本一区二区青青蜜月| 狠狠色婷婷7777久| 日韩精品一区的| 日韩激情小说一区二区| 国产东北女人在线视频| 日韩精品一区二区高清| 亚洲不卡三级手机播放| 亚洲丝袜综合| 免费国产视频| 亚洲日韩国产精品| 欧美黑人极品高潮喷吹熟女黑人性暴力日韩在线欧美极品一区二区 | 男人的天堂2018.| 人妻熟女字幕一区二区| 人人操AV| 中文字幕一区av| 久久人妻无码毛片A片麻豆| 69AV女优男人的天堂| 99热在线观看| 激情五月综合网| 九九色色| 久热色情精品| 国内精品久久国产,www香蕉久久五月丁香,亚洲欧美日韩精品永久在线,日本精品一 | 麻豆久久视频在线地址| 美国美女AV在线| 国产乱码久久| 亚洲大色堂| 久久久久ab| 日本男人插女人的逼黄色| 性性久久| av天堂加勒比| 亚洲色图综合| 影视综合无码少妇| 欧美成人一级免费电影| 国产伦精品一区二区三区在线观 | 免看60秒涩涩视频| 蜜臀久久99精品久久久久久成人小说| 激情在线青青操| 亚洲欧美另类小说| 国产亚洲日韩欧| 亚洲国产成人福利在线观看| 亚洲AV无码国产精品久久久久| 日本午夜精品理论片A级APP发布| rivers-china.com| 久久 精品| 岛国黄片网站| 国内自拍 日韩激情 99| 成人五月香网在线| 精品一区二区麻豆| 国产深喉| 亚洲麻豆av一区二区| 日本熟女不卡视频| 五月丁香激情综合| 99啪啪视频| 超碰无码五月97| 久久这里只有精品9| 无码操逼视频一下| 五月丁香啪啪网| 欧美精品丝袜久久久中文字幕| 亚洲综合夜色| 69XX一中文字幕人妻91| 久久久九九网站| 日本裸体久久色噜噜| 色偷偷男人的天堂麻豆| 啪啪视频免费在线观看| 中文字幕日本久久| 亚洲成人精品久久久| 欧美亚洲清纯| 婷婷av在线中文字幕| 国产福利精品最新在线| 玖玖爱综合| 欧美日韩妖精91com| 亚洲国产一级黄色视频| 五月丁香综合激情| 午夜精品人妻二区三区| 最新无码国产| 久久色激情一区二区三区| 天美传媒精品一区二区三区| 影音先锋新男人| 欧日韩不卡视.频| 91女优在线观看| 国产精品无码成人精品| 日韩久久三区| 欧美天天综合网版| 亚洲偷拍自拍在线视频| 精品人妻无码一区二区三区不卡-精品人妻无码一区二区...|精品少妇一区二区三 | 另类一区| 黄久在线| 综合久久久久久久综合网| 99久久久无码| 久久加勒比| 婷婷色色网| 91精品操美女| 国产女人91精品嗷嗷嗷嗷| 东北女人被操| 中字幕人妻一区二区三区| 亚洲欲色9532548967一区| 人妻熟女一区二区在线视频| 91黑人无码激情在线| 精品人妻一区春色| 黄色电影观看久久9| 自拍丝袜美腿人妻| 手机看片91人妻| 乱人伦 国语对白:视频直接看| 色97欧美| 免费看毛片操穴| 密臀视频三区免费网站| 懂色AV一区二区三区| 2017天天插| 丁香五月社区| 日韩日本欧美在线观看| 不卡人妻少妇精品毛片一区23区视频| 在线αⅴ| 色www精品视频在线观看| 精品无码久久久久久国产浪潮| 91天天综合网,天天综合网| 国内毛片欧美香蕉精品| 久久超碰大香蕉| 人人看欧美性爱| 曰本道人妻久久久在线不卡色视频| 久久三| 日日爽熟女| 91蜜桃婷婷狠狠久久综合9色| 久久久久久人体| 亚洲老熟妇xxx| 九九九热| 1024手机看片欧美日韩| 亚洲激情在线一区二区| 亚洲一区二区AV| 天天香香欲综合| 岛国毛片在线观看免费| 天天操天天干美女网址导航| 69精品少妇一区二区三区蜜桃| 国产无码精品无码| 岛国不卡超碰护士AV在线播放| A片三级无码| 一区二区影视| 国产美女精品| 五月丁香婷婷综合| 99re免费视频精品全部| 久久九九久精品国产尤物|国产精品爽黄69天堂A片潘金莲,国产亚洲精品第一综合 | 九色 人妻 大香蕉| av天堂精品久久| 午夜福利 成人 91| 欧美中文字幕一区 | 欧美高潮| av婷婷色网| 欧美日韩性爱无码| 中文字幕精品探花视频| 亚洲精品人伦一区二区| 九色 人妻 大香蕉| 人人做人人妻人人夜视频| 综合夜夜| 怡红院网站在线视频| 欧美日韩免费专区在线| 亚欧国产无码精品在线| 亚川综合视频| 大象AV在线| 伊人在线大香蕉视频久久| 国产视频一区二区在线| 日韩少妇一区二区三区| 欧美精品久久久久久久丰满| 96超碰网| 综合网亚洲1| 啊啊啊不要啊啊受不了了视频在线| 高清在线偷拍自拍视频| 91深夜夜| 亚洲日韩精品久久久久一区壹牛| 欧美黑人与女人91| 色眯眯av| 日本一天色道久久久精品视频| 婷婷五月天丁香| 亚洲二区精品在线观看 | 好吊爽好吊爽在线视频,中文字幕精品一区二区日本,国产良妇出轨视频在线观看, | 日本免费一级AAA大片器 | 日本一二区免费| 激情五月婷婷综合| av天堂5| 乱伦1色页| 明星性猛交ⅹxxx乱大交| 九九热精品视频六| 蜜桃AV天堂| 亚洲诱惑天堂| 99精品丰满人妻无码| 久久久久密臀一区二区| 97超碰天天| 日本精品88888888| 久久e6只有精品| 一区久久久二区| 久久香蕉国产传媒一区剧情天美| 99热在线播放| 女同在线视频一区| 欧美后进式| 九色97| 韩国一区二区精品亚洲| 精彩视频日韩| 91精品人妻一区二区-全集完整版免费正片国语-B02AV | 欧美亚州色的图| 999 久久久| 91五月天| 综合天天。| 亚洲好色人妻| 密臀在线视频| 九九热九九| 91丝袜在线观看| 97综合久久| 一级做a爰片性色毛片久久| 中文字幕黑人大片| 婷婷三区| 亚洲天天影视色综合| 91强在线播放| 一本一道久久综合久久| 强奸乱伦AV网站| 欧洲综合无码| 国产精品无码在线| 99人人干| 美日韩一卡二卡三卡免费人妻精品| 九九精品美女高溯喷水| 欧美日韩大陆黑人少妇99| 欧美青青草视频| 99少妇| 国产一国产一级毛片古装| 日本色色色网站免费看不卡| 亚洲一区二区久久久久| 熟女视频久久| 日本丝袜美腿人妻九九| 91欧美巨乳| 野狼福利社区| 淫荡少妇免费| 国产免费一区二区三区最新不卡| www老逼91| 99精品人人爽| 久久精品久| 国产51色综合久久免费| 激情开心五月天| m欧洲一级午老| 欧美亚洲天天| 在线无码视频| 日本超碰在线国产一区| 狠狠2050在线观看| 亚洲毛片基地专区| 婷婷影院入口| 国产夫妻一区二区| 日本布卡一区二三区| 八戒午夜福利理论片| 亚洲成人久久美女| 另类图片亚洲加勒比另类图片亚洲加勒比另类图片亚洲加勒比 | 久久妇| 五月开心网| 久偷拍欧美日韩三区| 色图综合| 国产成人精品亚洲日本| 韩国女主播青草在线| 精品天堂| 91色久| 中国熟女91| 人人操 欧美| julia高潮后不停追击中出| 色偷综合| 伊人精品久久网站| 色性荡荡荡荡视频| 亚洲人久久久久日| 激情综合婷婷| 亚洲欧洲激情| 丰满人妻无码一区二区三区| 和协无码影院| 欧美色女人| 色婷婷五月天| 96一区二区三区| 人人操,操人人| 欧洲精品人妻| 免费黄色片。| 日韩电影天堂视频二区三区| 亚洲欧洲自拍图片专区满春格 | 中文字幕黄片在线| 少妇诱惑视频| 天堂v无码免费视频| 精品国产综合久久福利,热99这里有精品综合久久,99热这里只有免费国产精品,精 | 熟女人妇一区二区三区| 蜜桃精品视频一区| 小视频国产| 97超级欧美| 黑人美精品 A片| 欧美亚洲se91| 2019天天干天天操| 欧美综合 站| 约操熟妇| 97国产精选| 超碰精品在线| 久草这里只有精品| 青青草中文-久久青草精品一区二区三 | 嗯嗯啊啊啊好爽| 色综合五月天| 白嫩少妇| 在线观看A啊啊啊| 国产综合在线视频网站| 中文字幕AV片| 五月丁香社区婷婷日韩欧美精品影院 | 欧美视频边做饭边橾| 色综合1991| 99精品热| 欧美精品成人一区二区在线观看| 国产午夜福利视频在线| 亚洲成aⅴ人片不卡无码| 色老牛| 婷婷丁香五月激情啪啪| 男女国产精品| 亚洲蜜臀懂色| 亚洲av淫乱| 三级色影综合网| 欧美性区| 亚洲女毛多水多21P| 欧美一区二区| 78久久久| 久久久国产三级黄色片| 91精品国产91久久青草 | 亚洲综合中文字幕有码 | 爆乳免费黄网站| 午夜福利激情在线视频| 久久九九久精品国产尤物|国产精品爽黄69天堂A片潘金莲,国产亚洲精品第一综合 | 91高潮| 日韩欧美被操黄免费观看| 日韩人成网站在线播放| 狠日欧美| 欧美黑人极品高潮喷吹熟女黑人性暴力日韩在线欧美极品一区二区老师 | 91亚洲青青草原精品1区| 国产极品精品美女视频| 精人妻一区二区三区| 天天综合网91入口| 国产1769在线| 日韩一级性爱无码| 国产91丝袜 在线播放| 色好看av| 免费视频无码| 人妻系列无码专区中文有码| 天天噜| 精品制服美女中文一区二区三区| 东京太热久久久| 国产精品久久久三级无码| 97久久久久久久精| www网站黄| se吧提供91精品国产91久久久久久| 五十路熟女,国产欧美精品区一区二区三区| 熟妇熟女亚洲天堂网| h无码动漫在线观看| 亚洲影院成人| 99re视频在线播放青草| 97超碰中文| 超碰97男人| 日本三级久| 亚洲综合九九| 久久久久久久国产a∨| 无码137片内射在线影院| 91热热色| 久久久久深夜无码| 欧美亚洲涩涩| 97精品第3页| 嗯阿好爽好紧| 偷拍欧美激情| 色婷婷综合久久久久中文国产精品一区中文字幕,国产福利电影一区二区三区 | 亚洲婷婷丁香在线| 免费在线视频97| 玖玖综合视频| 久草老司机| 午夜无码熟妇丰满人妻| 亚洲美女 晚间男人天堂 | 黄色区免费观看中文字幕| 9国产超碰| AAAA欧美日韩| 日韩一级欧美一级国产一级台湾| 久久久久久综合久久伊人蜜月| 人人澡人人澡人人| 亚洲图片欧美另类综合免费视频大大香| 久久日本熟女精品一区| 330Dv国产女人终合视频极品人与兽 | 欧日韩一二三f区| 亚洲欧美天| 啊啊啊 在线| 久热精品在线| 91久久婷婷| 久热最新在线杭州| 亚洲91色| 欧美成年人性爱视频免费观看| 色综合av综合久久| 亚洲婷婷综合网| 豆花视频操逼网址| 密乳无码| 美女被艹尤物视频| 在线日韩视频| 天美国产三级传媒| 无码78| 精品视频在线观看精品| 强奸乱伦 亚洲一区| 一本色道久久天天射天天干| 狠狠操夜夜| 男女真人网18| 午夜精品久久久久久久男人的天堂 | 91日韩在线| 蜜臀国产AV中文字幕| 国产精品女同| 伊人国产视频| 超碰 国产熟女精品一区| 在线视频资源| 日韩欧美大片免费高清啪啪| 欧美性爱日韩性爱| 激情综合久久| 欧美九九99久久精品| 999 久久久| 久久男人| 黄片qw| 日本在线视频导航| 黄色乱论网站| 精彩久久中文| 国产精品国产精品国产| 成人乱人伦一区二区| 手机在线看片免费人成视频| 夜夜爽33333| 亚洲永久永久永久永久一级一级一级精品 | 久久亚码| 久久国产乱子伦精品免费女,网站| 夜草网站| 性爱1区| 日日日啊啊啊| 成人日本片久久久蜜桃| 夜夜草我| av九九| 成人久久精品| 大香蕉中文在线| 伊人久久综合精品欧美| 乱精品一区字幕二区| 91美女看B| 午夜精品久久一区二区| wwwcaobibi| 久久精品72| 日本媚薬中文字幕在线| 亚洲成人性| 一区二区三区看视频| 国产最新小视频在线播放下载| 婷婷色综合| 好吊爽好吊爽在线视频,中文字幕精品一区二区日本,国产良妇出轨视频在线观看, | 密臀成人视频久久久| 欧美18 在线观看| 狠狠色色| 无码精品啪啪啪一区二区三区三州| 伊人天天久久动态图| 天天干人妇| 青青草色情网站视频| rion磁力链接| 婷婷色影院| 久久久精品中文字幕麻豆| 家庭乱伦麻豆| 欧美亚州手机在线| 3级毛片一二| 亚洲少妇综合在线播放| 夜夜久久| 欧美日韩国产成人高清| 日韩精品区二区三区不卡| 日韩成人人妻网站| 国产69精品久久久久99尤物| 日韩情色AV| 绯色一区二区三区不卡少妇| 色噜噜日韩精品| 加勒比久久综合网高清| 天天综合网入口~91| JIZZJIZZ亚洲女人被躁| 欧美综合站| 91精品91久久久中77777| 中文字幕在线高清男人的天堂| 精吧天堂| 欧美人人AAA| 国产精品大屁股999| 黄片免费久久久久久久| 亚洲黄色网址| 国产精品视频麻豆入口| 九九热这里只有在线精品视 伊人草 成人菠萝蜜视频在线观看 | 欧美性巨大╳╳╳╳╳高跟鞋| 九九九九日本| 久久久久免费看少妇A片特黄| 日夜久久久九九九久| 国产亚洲深夜激情| 91久久婷婷| 国产乱弄免费在线视频。| 中文字幕精品探花视频| 日韩中字av一区| 男女日B国产| 91成人国产综合久久精品蜜月| 蜜臀AV秘一区翔田千里| 久久久久网站-538在线视频-欧美永久乱码| 国产乱伦性爱区| 欧美综合 站| 韩日无码在线观看| 国内毛片四区| 青青草日本无码| 亚洲中字幕日本一区二区三区| 大香蕉综合| 欧美日日操| 久草老司机| 嗯嗯啊啊视频在线看| 亚洲成人激情小说视频| 精品美女少妇一区二区三区| AV免费在线播放一区| 亚洲资源吧| 精品无码久久久| 成人无码在线超碰网| 日日干夜夜欢| 淫妻综合网| 日韩激情毛片一级久久久| 天天天操天天天爱| 91欧美高清| 2017人人操,人人摸| 九九九九九九免费视频| av天堂影视中文在字幕在线中文 | 婷婷亚洲天堂| 天天射天天操天天干天天吃2018| 婷婷五月天无码 | 欧美乱妇狂野欧美在线视频| 亚洲高清在线| 亚洲国产成人精品久久久国产成人一区二区| 亚洲美女色图| 五月开心网| 亚洲第一免费视频| 欧美日韩亚洲天堂| 亚洲性猛交| 混色激情av| 国产家庭乱伦网址| 黑人娇小av在线播放| 精品欧美日韩在线观看| 精品人妻一区二区三区-国产| 国产 日韩 欧美 中文 另类,国产 欧美 另类 制服 变态,高清 日韩 欧美 中文,高 | 精品一久久久| 天天干美少妇一区| 国产精品999zyz| 免费操逼91| 久久久月天| 亚洲吊色| 综合久久99| 蜜臀aV午夜一区二区三区| 四虎 精品 WWW| 久久久九九网站| 久久精品国产99精品亚洲蜜...| 精品视频久久| 91激情国产| 青女在线| 人人摸人人干| 欧洲天天在线| 丁香五月综合| 岛国黄色大片网站| 亚洲精品乱码线路中文字幕 | 婷婷激情一区二区三区俺也去| 久操热线| 熟女六十路| 久久一区二区高清免费| 黄色成人网久久久久久| 日韩欧美加勒比| 春色91| 一二三四区电影| 亚洲色图综合网| 亚洲揄拍网| 美女淫穴| 综合亚洲情色| 口爆欧美91| 天天综合有色网| 好淫网一二三视区| 日本久操视频| 狂操嫩妻视频一区二区三区| 色五月首页| 久久综合激情| 九九香蕉网| 日本99久久| 九九热AV| av大香蕉| 婷婷久草一区二区三区| 丁香五月婷婷五月| 人妻激情偷乱视频一区二区三区 | 熟女少妇一区二区三区| 色与欲影视天天看综合网| 爱丝福利| 欧美日韩制服| 精品久久99| www久久久| 欧美亚洲综合色| 天美麻豆精品视频99| 超碰亚洲欧美日韩无| 亚洲春色激情小说| 99热免费| 久久久久久久久久久久黄色| 国产白丝在线| 亚洲自拍青操视频| 蜜桃臀av一区二区| 一区二区三区不卡视频| 欧美日本成人一区二区| 国产家庭乱伦表演| 久久黄色性爱视频| 婷婷五月天激情网| www.色婷婷.com| 嗯嗯嗯嗯啊啊啊好紧好大| 99re69综合| 欧洲精品区| 9精品久久久久| 欧美黄页| 国产欧美精选激情视频| 午夜欧美女人操逼| 九九色色| 91天堂视频| 久久r精品| 色悠久| 亚一综合久久久久久久久久| 国产亚洲精品自在线亚洲情侣| 啊啊啊啊一区| 久久99999| 天天色综合影视网| 免费a v| 激情综合网五月婷婷五月天| 99热思思| 伦理弟一页| 久操免费观看| 人妻啪| 九九碰九九爱97| 91视频成人福利网站在线一区| 亚洲怡春院| 一区在线精品中文字幕| 天操老女人| 欧美亚洲首页| 天天干天天燥| 99爱精品| 九九九九九九视频| 爱逼综合| 天天干天天狼在线视频| 欧美在线色图| 传媒在线观看一区二区三区| 日韩美女啪啪一区| 六九九九| 天天天堂影视日韩亚洲91| 天天躁日日躁狠狠躁| 女同性恋久久| 伊人国产视频| 中文字幕乱码在线| 精品毛片久久久精品毛片| 18精品一区| 国产精品伦理| 操逼片中文| 绑缚麻绳人妻寝取完整版| 999精品女人| 999国产精品999| 爱爱久久| 日韩免费三级黄片电影| 亚洲 日本 一 二 三| 亚洲 欧美 综合 91| 美女熟妇色| 艳美熟妇先锋一二三区| 久久婷婷一区| 秋霞免费AV| 91少妇香蕉久久精品| 国产女同在线观看视频| 日韩三级一区| 9精品久久久久| 久精品无码av一区二免费国产在线观看| 欧美精品91| 亚洲国产一级黄色视频| 天天流夜夜操| 亚洲黄色| 激情综合五| 欧美激情精品久久久久久| 一级久久久久久久久久久| 330dv亚洲成年视频网| 国产亚洲精品一区二区三区| 人人喜人人妻| 日本久久99| 97超级久久| 国产成人+综合亚洲+天堂| 天天综合网亚洲综合网| 日本一区二区不卡精品| 日本熟妇色熟妇在线视频播放| 中文字幕,人妻,日韩| 久久超碰免费的| 人人干人人操人人爱| 福利风月五月天影院| 中文字幕蜜乳av| 97亚洲国产影视| 欧美一区二区男人天堂| 老熟女91av| 成全动漫视频观看免费下载| 亚洲综合影视| 久久久亚洲Av| 日韩不卡一二三四| 性爱乱伦网址| 欧美色图校园春色| 色欧美天天| 天天草天天日| 97视频7| 在线综合色| 亚洲第二页| 一区二区三区精品黑丝白丝酒店对鸡| 天天拍夜夜| 日韩精品高清资源在线| 超碰色男人操熟女| 久久久久久久9最新免费视频观看| 久久精品亚洲成a人天堂| 成人性爱高清视频免费看| 精品妇操一区二区三区| 亚洲av淫乱| 黄色工厂这里只有精品| 久九九九九九九九热| 99热欧美| 天天激清| 欧美78| 国产版a级片直播在线| 久久东京热久久| 亚洲高清内射| 国语av最新自产拍在线观看| 欧美九九九九九| 久久只有精品一区二区三区| 天天搞在线综合网| 人妻第一页| 躁躁日曰躁2020| 精品一区二区成人动漫| 无码国产精品96久久久久孕妇| 亚洲视频,小说| 精品性爱无码在线播放| 无码精品久久久久久亚洲| 青木玲在线不卡| 长长久久免费视频| 国产精品亚洲无码| 男人的天堂99| 国产美女激情| 国产999精品久久久久久| 美女视频尤物网在线看| 久久婷婷成人综合色怡春院| 打av高清| 国产成人+综合亚洲+天堂| 日韩黄色片子| 中文字幕一区二区无码成人 | 天堂69亚洲精品中文字| 97超色| 校园春色欧美色图| 婷婷丁香久久| 91精品国产日韩欧美综合| 好吊色综合| 97亚洲国产| 神马午夜久久久| 九色97| 日本道久久综合色色| 成人av在线播放| 熟女人妻精品一区二区视频| 日韩中文字幕宗合在线| 欧美一级欧美三级在线观看| 激情专区综合| 免费精品中文字幕| 色哟哟 日韩精品| 水滴偷拍| 97久久精品不卡| 99热导航| 久草视频制服诱惑| 91蜜桃婷婷狠狠久久综合9色| 国产人妖视频一区在线观看| 日韩兔费看黄片| 不卡视频一区蜜桃视频 | 静品嫩模一区二区| 艹精品| 八戒午夜福利理论片| 国产h小视频在线观看免费| 97中文字幕一区| 欧美草草| 婷婷精品国产欧美精品亚洲人人爽| 九九热视频这里只有精品| 中文字幕91综合| 久久精精区一区二区一蜜桃一区二区| 国产一区二区三区精品观看啪| 免费精品中文字幕| 97综合日韩| 欧美久久草熟女| 天堂精品在线| 狠狠操夜夜操蜜桃视频三区| 日本免费亚洲欧美| 国产精品国产拍高清AV| 午夜精品探花| www.av在线观看| 国产精品99久久久www| 一级久久性爱视频| 在线人人人人人人精品超 | 加勒比少妇AV婷婷六月天超碰超碰| 久久一二三四不卡| 久久99999| 欧美熟女丝袜| 国产热av| 亚洲中文字幕久久无码精品| 欧美最婬乱婬爆婬牲视频| 色噜噜日韩精品| 久草免费在线视频| 999综合网| 天天视频黄| 影音先锋少妇| 日韩一性一交一A片俄罗斯| 国产91精品福利在线| 92午夜免费福利视频| 国产精品久久久三级无码| 91久热|