欧美成人午夜精品久久久,国产?V天堂一区二区三区,欧美精品va在线观看,亚洲一区二区三区免费在线观看,av无码精品一区二区久久,欧美性爱视频不卡一区三区,欧美乱人伦视频在线观看,国产一级牲交高潮

ARTICLE DETAIL

資訊詳情

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

Apollo 9.0分段Jerk速度非線性優(yōu)化器:建模、求解與調(diào)參實(shí)戰(zhàn)

Apollo 9.0分段Jerk速度非線性優(yōu)化器:建模、求解與調(diào)參實(shí)戰(zhàn) 做自動(dòng)駕駛規(guī)劃這兩年多我一直有個(gè)判斷路徑規(guī)劃的問題大多“想得明白但寫起來煩”速度規(guī)劃則恰恰相反——“看起來簡(jiǎn)單跑起來全是坑”。尤其在 Apollo 9.0 平臺(tái)里planning 模塊中最容易被低估、也最經(jīng)得起折騰的就是那個(gè)負(fù)責(zé)把一條已定路徑變成可執(zhí)行速度曲線的 piecewise jerk speed nonlinear optimizer分段 jerk 速度非線性優(yōu)化器。我為什么單獨(dú)把它拎出來寫因?yàn)樽罱@段時(shí)間我在做 speed planning 的工程落地碰到的幾個(gè)最詭異的線上問題最后全都定位到這個(gè)優(yōu)化器身上一是障礙物 ST 約束被硬生生卡死導(dǎo)致頻繁無意義減速二是目標(biāo)函數(shù)權(quán)重失衡加減速來回震蕩乘客體感非常差三是某些 cut-in 場(chǎng)景下舊版 QP 求解器直接報(bào)無解。Apollo 9.0 里帶“非線性”三個(gè)字的這個(gè)版本就是沖著這些問題來的。這篇文章會(huì)把它的建模原理、求解鏈路、調(diào)參手段、以及那些不寫在文檔里的坑一次性講透適合正在讀 Apollo planning 源碼、或者有意自己搭速度規(guī)劃模塊的工程師參考。1. 速度規(guī)劃為什么繞不開“非線性”先看上一代 QP 版本卡在哪1.1 速度規(guī)劃在這條鏈路里的角色先對(duì)齊一下基本流程。任何一個(gè)規(guī)劃模塊通常都是先解決“往哪走”再解決“怎么走”上游路徑優(yōu)化器給出一條平滑的幾何曲線只包含位置信息速度規(guī)劃的任務(wù)就是在這條曲線上找到一段隨時(shí)間變化的關(guān)系即 s(t)、v(t)、a(t)最后拼成帶時(shí)間戳的軌跡交給控制模塊。整個(gè)過程里ST 圖是核心中間產(chǎn)物——把障礙物投影到以時(shí)間為橫軸、縱向距離為縱軸的圖里速度規(guī)劃本質(zhì)上是在這張圖上找一條合理的 s(t) 曲線。這一步的產(chǎn)出對(duì)整車體驗(yàn)的影響往往比路徑規(guī)劃更大。橫向路徑不平滑乘客頂多覺得“有點(diǎn)晃”但縱向速度曲線只要有一點(diǎn)抖動(dòng)人體對(duì)縱向加速度的感知會(huì)立刻被放大——前仰后合、推背頓挫全是這里來的。所以速度規(guī)劃一直是規(guī)劃模塊里對(duì)數(shù)值精度和實(shí)時(shí)性要求最苛刻的部分。1.2 上一代 QP 版本三個(gè)讓人頭疼的毛病Apollo 在非線性版本之前默認(rèn)的 speed optimizer 走的是二次規(guī)劃路線時(shí)間軸離散成若干段狀態(tài)量是距離、速度、加速度jerk 作為控制量障礙物在 ST 圖上用上下邊界框出來寫成 s_min(t) ≤ s(t) ≤ s_max(t) 的線性約束再配 slack 變量防止硬性無解。這套框架在教科書上無懈可擊但工程上跑起來我總結(jié)出了三個(gè)典型問題。第一盒子約束天生保守。ST 圖里的障礙物往往不是一個(gè)干凈矩形而是帶軌跡預(yù)測(cè)不確定度的區(qū)域。QP 版本為了安全通常取完整包絡(luò)于是“前方一輛車在變道但實(shí)際離我挺遠(yuǎn)”也會(huì)被壓成一個(gè)很緊的可行走廊。表現(xiàn)出來就是車提前一兩百米開始減速后車瘋狂按喇叭乘客也不知道你在躲什么。第二slack 和速度跟蹤項(xiàng)打架。為了避免無解每個(gè)障礙物約束都配了 slack權(quán)重卻不能設(shè)太大否則約束形同虛設(shè)設(shè)小了一旦約束被頂?shù)竭吔鐑?yōu)化器寧可產(chǎn)生巨大減速度也不愿破約束。我見過速度曲線在一個(gè)周期內(nèi)從 72 掉到 35 km/h 再拉回 70 的情況就是 slack 權(quán)重與 v_ref 跟蹤權(quán)重互相拉扯的結(jié)果。第三無解場(chǎng)景處理太粗糙。旁車不打燈直接切到車道這類場(chǎng)景ST 圖上兩個(gè)障礙物的可行區(qū)間在時(shí)間軸上互相擠壓QP 的可行域直接為空。代碼只能返回失敗整個(gè)規(guī)劃幀拿不到新曲線只能沿用上一幀甚至觸發(fā)保守剎停。這在高速場(chǎng)景尤其危險(xiǎn)因?yàn)榘踩艚o你的反應(yīng)時(shí)間本來就不多。1.3 非線性版本到底改變了什么以及“Ⅱ”迭代了什么非線性版本的思路換了個(gè)角度把“必須落在障礙物邊界一側(cè)”的硬邏輯變成“離障礙物邊界越近代價(jià)越高”的軟懲罰。優(yōu)化器自己權(quán)衡“貼邊加速通過”和“減速讓行”哪個(gè)綜合代價(jià)更低而不是被布爾條件一票否決。這帶來兩個(gè)直接好處可行域幾乎不會(huì)為空因?yàn)槿魏螘r(shí)刻都能通過增大懲罰代價(jià)找到一條偏保守但存在的解速度曲線也不會(huì)因?yàn)閱蝹€(gè) ST 盒子的抖動(dòng)而劇烈變化因?yàn)閼土P函數(shù)是光滑的。另外非線性問題天然能表達(dá)更多耦合關(guān)系——彎道里限速和橫向加速度的乘積關(guān)系、坡道上重力分量對(duì)加速度的抵消這些東西寫進(jìn) QP 里要么線性化失真要么根本寫不進(jìn)去。至于標(biāo)題里的“Ⅱ”以我對(duì) Apollo 9.0 規(guī)劃的跟蹤理解這標(biāo)記了該優(yōu)化器的第二代實(shí)現(xiàn)。第一代更像是把原本的 QP 框架硬塞給 NLP 求解器的過渡品固定時(shí)間網(wǎng)格、障礙物懲罰簡(jiǎn)單粗暴第二代則真正按 NLP 思路重新設(shè)計(jì)了代價(jià)與約束結(jié)構(gòu)引入非均勻時(shí)間離散、更精細(xì)的懲罰函數(shù)和更穩(wěn)健的初始化策略。后面章節(jié)我會(huì)把這些差異具體展開。2. piecewise jerk 建模全解從分段常 jerk 假設(shè)到代價(jià)函數(shù)推導(dǎo)2.1 為什么是“分段常 jerk”先說一個(gè)反直覺的點(diǎn)速度規(guī)劃里真正被優(yōu)化的對(duì)象其實(shí)不是速度而是 jerk——加速度的變化率。乘客暈不暈車主要看 jerk 是否一直在大幅跳變。工程里常用的舒適性指標(biāo)是縱向 jerk 不超過 2~4 m/s3超過這個(gè)范圍人體很快會(huì)產(chǎn)生不適感?!胺侄纬?jerk”就是把控制量簡(jiǎn)化成把時(shí)間軸切成 N 段每一段內(nèi) jerk 保持恒定。這樣做最大的好處是第 i 段到第 i1 段的狀態(tài)轉(zhuǎn)移可以用閉式公式直接寫出來優(yōu)化變量只有每段的起始狀態(tài)和該段的 jerk 值問題規(guī)模可控。標(biāo)準(zhǔn)遞推式是s_{i1} s_i v_i·Δt ?·a_i·Δt2 (1/6)·j_i·Δt3v_{i1} v_i a_i·Δt ?·j_i·Δt2a_{i1} a_i j_i·Δt其中 s 是縱向距離v 是速度a 是加速度j 是 jerkΔt 是這一段的時(shí)長(zhǎng)。N 個(gè)時(shí)間段狀態(tài)變量約 3N 個(gè)再加 N 個(gè) jerk 控制量整體是 4N 量級(jí)的小規(guī)模問題對(duì)現(xiàn)代求解器來說負(fù)擔(dān)并不大。2.2 代價(jià)函數(shù)每一項(xiàng)都在表述一種“駕駛性格”優(yōu)化器的性格完全由代價(jià)函數(shù)決定。我把它的核心拆成四部分。第一部分是參考速度跟蹤項(xiàng)w_v·Σ(v_i ? v_ref,i)2。v_ref 來自限速、交通流速度、決策模塊給的目標(biāo)速度。這一項(xiàng)權(quán)重越大車越“急著”貼限速走權(quán)重越小車越“肉”會(huì)優(yōu)先照顧其他目標(biāo)。高速巡航和城市低速跟車場(chǎng)景對(duì)這項(xiàng)權(quán)重的需求完全不同。第二部分是加速度懲罰w_a·Σa_i2。它抑制大起大落讓車盡量保持勻速或平緩加減速。注意這里懲罰的是加速度本身所以長(zhǎng)時(shí)間緩加速和短時(shí)間急加速之間優(yōu)化器會(huì)傾向于前者。第三部分是 jerk 懲罰w_j·Σj_i2。這是舒適性的直接體現(xiàn)。jerk 權(quán)重高時(shí)優(yōu)化器寧可早一點(diǎn)開始減速也不愿意在最后關(guān)頭猛踩一腳。實(shí)話說這一項(xiàng)才是速度曲線“柔軟度”的真正來源。第四部分是障礙物軟懲罰也是非線性版本的精髓。對(duì)每個(gè)時(shí)間點(diǎn) iST 圖給出安全區(qū)間 [s_low,i, s_high,i]然后定義一個(gè)門檻懲罰函數(shù)落在安全區(qū)間內(nèi)時(shí)懲罰近乎為零一旦逼近甚至越過邊界懲罰迅速上升。一種常見寫法是單側(cè)二次懲罰加緩沖區(qū) Δp(s_i) ?·w_obs·max(0, s_low,i Δ ? s_i)2 ?·w_obs·max(0, s_i ? (s_high,i ? Δ))2這里有個(gè)工程細(xì)節(jié)必須注意max(0, ·) 會(huì)在觸發(fā)點(diǎn)造成一階不光滑梯度在那里跳變求解器容易在邊界附近來回振蕩。穩(wěn)妥做法是把轉(zhuǎn)折處做一個(gè)微小圓弧或線性過渡保證函數(shù)一階光滑甚至二階光滑。這一點(diǎn)后面調(diào)參部分還會(huì)再提。最后還有一類末端代價(jià)比如紅燈場(chǎng)景要求某個(gè)時(shí)間點(diǎn)后速度歸零或者要求在規(guī)劃末段達(dá)到目標(biāo)速度。我建議能寫成軟約束就寫在代價(jià)里比寫死約束更穩(wěn)。硬約束在求解器數(shù)值誤差下容易出現(xiàn)“差一點(diǎn)點(diǎn)不滿足”然后整解被判失敗的情況。2.3 約束體系哪些必須硬哪些可以軟我的原則很簡(jiǎn)單物理極限必須硬安全與舒適可以軟。硬約束包括狀態(tài)轉(zhuǎn)移方程本身、速度上下限、加速度上下限由輪胎附著和縱向控制能力決定、jerk 上下限、初始狀態(tài)等式約束——當(dāng)前位置、速度、加速度必須等于車輛實(shí)際值。末端如果明確要求停車比如紅燈或前方靜止障礙物終點(diǎn)速度等于零也要寫成強(qiáng)約束或用足夠大的末端權(quán)重逼近。軟的方面則有兩類。一類是障礙物邊界用軟懲罰代替硬約束前面已反復(fù)說明。第二類是舒適性邊界比如“正常行駛加速度不超過 2 m/s2”。我會(huì)把它做成懲罰而非硬約束因?yàn)榫o急避險(xiǎn)時(shí)突破它是合理的硬約束會(huì)直接導(dǎo)致無解。還有一個(gè)經(jīng)常被忽略的非線性約束彎道限速的耦合關(guān)系。彎道上速度必須滿足 v_i2 ≤ a_lat_max / κ(s_i)其中 κ 是路徑在 s_i 處的曲率。κ 是 s 的函數(shù)而 s_i 本身是決策變量所以這個(gè)約束本質(zhì)上是非線性的。QP 版本只能預(yù)先按路徑位置算好一張限速表當(dāng)常量用轉(zhuǎn)彎前把速度壓得很死NLP 版本可以在迭代過程中根據(jù)當(dāng)前 s_i 修正曲率取值限速曲線與真實(shí)位置嚴(yán)格對(duì)應(yīng)。這也是非線性版本在彎道場(chǎng)景體驗(yàn)更好的原因之一。3. 非線性問題怎么解Apollo 9.0 求解鏈路與工程細(xì)節(jié)3.1 求解器選型內(nèi)點(diǎn)法還是序列二次規(guī)劃NLP 問題規(guī)模雖小但選錯(cuò)求解器照樣會(huì)跑不完一個(gè)規(guī)劃周期。工程實(shí)現(xiàn)里主流是兩條路一條用 IPOPT 這類內(nèi)點(diǎn)法通用求解器一條是自研序列二次規(guī)劃SQP。Apollo 9.0 的規(guī)劃模塊具備多種求解器調(diào)度能力工程上通常以外接 IPOPT 或等價(jià)實(shí)現(xiàn)為主。內(nèi)點(diǎn)法對(duì)“變量少、約束結(jié)構(gòu)稀疏且固定”的問題非常友好每次迭代只需要解析目標(biāo)函數(shù)值、梯度以及約束雅可比矩陣。但內(nèi)點(diǎn)法有一個(gè)大坑對(duì)數(shù)值尺度極其敏感。s 是幾十米量級(jí)v 是十幾 m/sa 是幾個(gè) m/s2jerk 則可能小到 0.01 量級(jí)。如果不做變量縮放Hessian 條件數(shù)會(huì)非常難看輕則收斂慢重則根本不收斂。我建議在做這類優(yōu)化器時(shí)先把變量歸一化或者在調(diào)用求解器時(shí)顯式設(shè)置變量 scale。很多規(guī)劃代碼里 solver 配置那欄有一堆 tolerance 參數(shù)調(diào)來調(diào)去根因往往就是尺度沒處理干凈。梯度也要盡量給解析式。分段常 jerk 的狀態(tài)轉(zhuǎn)移是多項(xiàng)式求導(dǎo)是簡(jiǎn)單到不能再簡(jiǎn)單的事手寫 Jacobian 完全可行。數(shù)值微分雖然在開發(fā)期省事但在線運(yùn)行時(shí)每次多算幾十次函數(shù)求值耗時(shí)會(huì)明顯增加而且精度誤差會(huì)在 KKT 判定時(shí)反咬你一口。3.2 warm start能不能收斂一半看初始猜測(cè)NLP 求解的是局部最優(yōu)初始點(diǎn)往哪給結(jié)果就落在哪片山谷里。速度規(guī)劃常見的三種初始化方式一是直接用上一幀的解平移二是先用動(dòng)態(tài)規(guī)劃DP在 ST 圖上跑一個(gè)粗糙解插值到 NLP 的網(wǎng)格上三是用勻速外推。我強(qiáng)烈推薦做 DP warm start。原因很簡(jiǎn)單DP 雖粗糙但天然“可行”——它避開了障礙物、滿足基本限速。把這些信息喂給 NLP 后求解器基本只需在可行點(diǎn)附近做打磨把加速度和 jerk 修平滑。直接拿上一幀解做 warm start低速場(chǎng)景還好一旦上一幀是緊急剎車狀態(tài)平移過來的初值會(huì)讓本幀解偏向剎車產(chǎn)生“剎一下、停一下、再剎一下”的怪曲線。勻速外推更糟糕障礙物前的初始點(diǎn)完全不滿足約束求解器光是把點(diǎn)拉回可行域就要耗掉大半迭代預(yù)算。這里要特別說一句第二代實(shí)現(xiàn)里 warm start 的改進(jìn)是肉眼可見的它把 DP 結(jié)果按非均勻網(wǎng)格重新采樣近端插值更密遠(yuǎn)端稀疏讓求解器在關(guān)鍵決策區(qū)域更快起步。這一點(diǎn)在實(shí)際測(cè)試中顯著降低了迭代次數(shù)。3.3 收斂判據(jù)與失敗回退一個(gè)規(guī)劃幀只有 100 毫秒實(shí)時(shí)規(guī)劃對(duì)耗時(shí)零容忍一個(gè) planning cycle 通常只有 100 毫秒級(jí)別速度優(yōu)化器必須在這個(gè)時(shí)間內(nèi)交卷。工程上要設(shè)幾道保險(xiǎn)最大迭代次數(shù)要卡死比如 100~200 次超時(shí)就停求解器狀態(tài)碼要單獨(dú)判斷不是 SUCCESS 一律視為失敗失敗后不能把速度曲線直接丟掉否則控制端瞬間失去目標(biāo)。我的回退鏈分三級(jí)先嘗試沿用當(dāng)前迭代點(diǎn)因?yàn)榈胶笃诘狞c(diǎn)哪怕沒收斂往往也八九不離十不行就回退到上一周期成功的速度曲線再不行才用保守的緊急剎停 profile但這是最低優(yōu)先級(jí)選項(xiàng)。實(shí)測(cè)中真正走到第三步的場(chǎng)景極少大部分失敗在第一步就被接住了。還有一個(gè)隱蔽的坑判斷“成功”要看 KKT 條件殘差是否真正滿足而不是只看求解器返回值。我踩過一次求解器每次返回“最優(yōu)”但速度曲線末端每隔幾個(gè)周期就抖一下。排查很久才發(fā)現(xiàn)是約束 Jacobian 里某個(gè)動(dòng)態(tài)約束對(duì) s 的偏導(dǎo)寫錯(cuò)了導(dǎo)致拉格朗日乘子假收斂。這類問題在仿真里基本看不出來實(shí)車只要跑到那個(gè)速度區(qū)間就會(huì)周期性頓挫。強(qiáng)烈建議把 KKT 殘差、約束違例量這些診斷信息全部落盤做長(zhǎng)里程數(shù)據(jù)回放后再上線。4. 調(diào)參與排障讓非線性優(yōu)化器在真實(shí)道路上跑穩(wěn)4.1 權(quán)重標(biāo)定從默認(rèn)值出發(fā)的三步法調(diào)權(quán)重沒有銀彈但我有一套固定的起步流程保證不會(huì)從零開始亂試。第一步先固定加速度和 jerk 的相對(duì)關(guān)系。讓 w_a 約等于 w_j 的 0.1 到 0.2 倍也就是允許適度加速度但強(qiáng)烈抑制 jerk 突變。這個(gè)比例決定了“平順優(yōu)先”的底色。第二步只調(diào)參考速度權(quán)重 w_v觀察高速巡航和跟車距離是否滿足要求。w_v 太小車跟在慢車后面懶得超w_v 太大遇障剎車過晚乘客被嚇到。第三步再調(diào)障礙物軟懲罰的形狀參數(shù)比如懲罰函數(shù)上升的陡峭程度以及從多近開始起作用。我常用的量級(jí)參考如下但注意不同實(shí)現(xiàn)里 s/v/a 的量綱處理不一樣直接抄數(shù)字沒意義關(guān)鍵看相對(duì)比例參數(shù)量級(jí)參考影響方向w_v1 ~ 10速度跟蹤緊迫感、跟車距離w_a100 ~ 1000加減速激進(jìn)程度w_j1000 ~ 10000速度曲線平滑度、舒適性障礙物懲罰斜率視函數(shù)形式貼邊通過 vs 保守避讓舉一個(gè)實(shí)際例子低速跟車場(chǎng)景我把 w_v 從 5 降到 2同時(shí)把障礙物懲罰的起始距離從 1.5 米擴(kuò)到 3 米車輛在擁堵路段的“點(diǎn)頭”頻率立刻下降。代價(jià)是跟車距離稍微拉大容易被加塞但乘客舒適度明顯提升。4.2 時(shí)間分辨率dt 的選擇與分段設(shè)計(jì)速度規(guī)劃的預(yù)測(cè)時(shí)域通常取 8~10 秒但到底切多少段、每段多長(zhǎng)直接關(guān)系響應(yīng)速度。dt 太大優(yōu)化器對(duì) cut-in 這類突發(fā)障礙反應(yīng)遲鈍因?yàn)榈谝粋€(gè)決策點(diǎn)離當(dāng)前太遠(yuǎn)dt 太小變量個(gè)數(shù)膨脹求解時(shí)間不可控。工程上我推薦基礎(chǔ)網(wǎng)格用 0.5~1 秒近端前 1~2 秒加密到 0.2~0.4 秒。別小看這一段加密它決定了緊急制動(dòng)能不能在第一個(gè)周期內(nèi)把減速度拉起來。舉個(gè)例子8 秒時(shí)域全用 0.5 秒網(wǎng)格是 17 段改成近端 0.2 秒 × 1 秒、中段 0.5 秒 × 3 秒、遠(yuǎn)端 1.0 秒 × 4 秒總段數(shù) 13 段左右變量反而少了關(guān)鍵區(qū)域的決策精度卻高了。NLP 版本比 QP 版本更愿意接受非均勻網(wǎng)格這個(gè)紅利值得吃滿。4.3 真實(shí)道路上的四個(gè)邊界 case 與排查套路分享四個(gè)我在測(cè)試中真實(shí)撞過的場(chǎng)景每一個(gè)都值得記進(jìn)自己的排查手冊(cè)。第一個(gè)是綠燈倒計(jì)時(shí)。這個(gè)場(chǎng)景的坑在于決策模塊給了“可通行”語義但 ST 圖里又有匯聚的車流邊界兩次規(guī)劃之間語義切換速度曲線會(huì)瞬間從“保持 50”變成“急?!薄E挪闀r(shí)要先看決策層語義是否滯后半拍再看終點(diǎn)速度約束是不是從“自由”突然變成 0。我的處理是給倒計(jì)時(shí)場(chǎng)景單獨(dú)設(shè)置末端速度軟約束用權(quán)重過渡代替硬切換。第二個(gè)是旁車 cut-in。非線性軟懲罰大多時(shí)候表現(xiàn)驚艷但如果懲罰函數(shù)設(shè)計(jì)得太陡旁車一進(jìn)來代價(jià)在邊界附近出現(xiàn)陡峭梯度優(yōu)化器給出的速度剖面會(huì)有明顯的“下探”再“回拉”體感就是一腳急剎然后松開。解決思路是限制懲罰函數(shù)的最大斜率這等價(jià)于給避讓行為設(shè)置縱向減速度上限。第三個(gè)是限速突變比如隧道入口從 80 限到 60。v_ref 如果直接給跳變優(yōu)化器為了滿足速度跟蹤項(xiàng)可能在一個(gè) segment 內(nèi)強(qiáng)行產(chǎn)生巨大負(fù) jerk。根子在上游但優(yōu)化器這邊可以兜底給 v_ref 序列做滑動(dòng)平均同時(shí)把 jerk 硬上限設(shè)到舒適值以下讓它無論如何都突破不了物理極限。第四個(gè)是高架上坡。加速度上限必須考慮重力沿坡道的分量平地上能剎住的減速度在坡上要額外抵消一個(gè) g·sinθ。如果不把這項(xiàng)寫進(jìn)約束優(yōu)化器算出的速度剖面在坡道會(huì)“超能力”實(shí)車表現(xiàn)為速度比規(guī)劃值越掉越多控制端反復(fù)補(bǔ)油門出現(xiàn)追趕振蕩。這個(gè)約束是典型的非線性紅利QP 版本很難優(yōu)雅處理。每個(gè) case 的排查我都有固定動(dòng)作先把 s/v/a/jerk 四個(gè) profile 導(dǎo)出 CSV畫出來看曲線形態(tài)再查約束違例量看哪些約束在圖上最緊的位置被激活最后核對(duì)求解器狀態(tài)和迭代軌跡。這套動(dòng)作走下來80% 的速度異常能在十分鐘內(nèi)定位到是上游還是優(yōu)化器本身的問題。5. 與上下游模塊的配合一次完整的速度規(guī)劃實(shí)戰(zhàn)復(fù)盤5.1 上游輸入的質(zhì)量決定優(yōu)化器一半的命運(yùn)很多人遇到 NLP 優(yōu)化結(jié)果抽風(fēng)時(shí)第一反應(yīng)是調(diào)參但我發(fā)現(xiàn)相當(dāng)比例的“優(yōu)化器抽風(fēng)”根源在上游。路徑曲率連續(xù)性是最典型的例子如果路徑優(yōu)化器輸出一條 κ 不連續(xù)的曲線那么 v2 ≤ a_lat/κ 這個(gè)曲率限速會(huì)在拐點(diǎn)處突變速度優(yōu)化器被迫在極短時(shí)間內(nèi)從 70 剎到 40這本身就是一個(gè)大 jerk。所以排查速度問題時(shí)先檢查路徑曲率曲線的連續(xù)性再談其他。參考速度也一樣。決策模塊給的目標(biāo)速度如果是步進(jìn)式的比如前方路段限速從 80 在某處突變?yōu)?60喂給優(yōu)化器的 v_ref 就是一個(gè)階躍信號(hào)。我的習(xí)慣是在優(yōu)化器前面加一個(gè)速度參考平滑層用一階慣性或滑動(dòng)窗口把跳變抹平。這比在代價(jià)函數(shù)里硬調(diào)權(quán)重省事得多而且對(duì)下游控制更友好。5.2 輸出對(duì)接控制端的三個(gè)細(xì)節(jié)速度優(yōu)化器交出的是一組時(shí)間軸上的 s/v/a 序列但控制模塊真正需要的是更高采樣率、且三階可導(dǎo)的速度曲線。實(shí)際工程要做三件事一是把離散序列插值成高分辨率 profile。這一點(diǎn)在分段常 jerk 假設(shè)下非常省事任意時(shí)刻 τ 在第 i 段內(nèi)的位置可以直接用閉式公式算s(τ) s_i v_i·τ ?·a_i·τ2 (1/6)·j_i·τ3不需要重新擬合也不會(huì)引入插值誤差。二是裁剪時(shí)域到真實(shí)可執(zhí)行范圍保證末端速度不為負(fù)、且對(duì)靜止目標(biāo)準(zhǔn)確歸零。三是和控制周期對(duì)齊避免多項(xiàng)式插值在控制 tick 之間引入相位差。我踩過一個(gè)很典型的坑只把 s 和 v 發(fā)給控制a 由控制端自己差分來算結(jié)果高頻噪聲被放大車?yán)锫牭匠掷m(xù)的細(xì)碎頓挫。后來把優(yōu)化器里的 a 和 jerk 一并下發(fā)控制端直接用于前饋問題立刻消失。輸出接口別省a 和 jerk 的精度對(duì)下游控制不是錦上添花是剛需。5.3 復(fù)盤一次高架匯入場(chǎng)景的對(duì)比最后講一次讓我印象深刻的實(shí)測(cè)對(duì)比。某條高架匯入口主路車流密集我們?cè)谕欢螠y(cè)試道路上分別跑了 QP 舊版和 nonlinear 新版。場(chǎng)景是左前方一輛慢車壓著車道右側(cè)匯入車流緩緩并入視線里幾百米外路牌寫著匝道結(jié)束。舊版 QP 給出的速度曲線在進(jìn)入?yún)R入段時(shí)先降一截等匯入車流離開可行域后猛加速再因?yàn)閹装倜缀蟮南匏儆纸怠巍捌脚_(tái)—急剎—急加速”的階梯體感很差。非線性版本則不同它把“貼邊跟住慢車”和“為匯入車讓點(diǎn)空間”放進(jìn)同一個(gè)代價(jià)函數(shù)權(quán)衡輸出曲線先建立在一個(gè)溫和減速度上貼著可行域邊緣穩(wěn)定通過隨后緩慢回到目標(biāo)速度。兩臺(tái)車跑下來乘客對(duì)橫向表現(xiàn)評(píng)價(jià)沒差別縱向評(píng)價(jià)差距巨大。那次之后我把一條經(jīng)驗(yàn)定成了團(tuán)隊(duì)內(nèi)部原則速度優(yōu)化器里的安全邊界能軟則軟盡量不要用硬約束去做避讓決策硬約束留給物理極限就夠了。這條原則聽起來簡(jiǎn)單真正實(shí)踐起來需要針對(duì)每個(gè)約束做反復(fù)的仿真與實(shí)車 A-B 測(cè)試。我的個(gè)人體會(huì)是這個(gè)優(yōu)化器真正值錢的地方不在“非線性”這個(gè)標(biāo)簽本身而在于它給了規(guī)劃工程師一個(gè)連續(xù)調(diào)優(yōu)的旋鈕把很多從前只能靠規(guī)則硬編碼的駕駛行為變成了目標(biāo)函數(shù)里幾個(gè)有物理意義的權(quán)重系數(shù)。想用好它先忘掉默認(rèn)參數(shù)表回到“駕駛性格”四個(gè)字上想清楚每一項(xiàng)代價(jià)在表達(dá)什么然后一條路一條路地跑數(shù)據(jù)、回放、微調(diào)。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
欧洲激情网站| 99这里只有精品视频| 一月婷婷色色| 91丨人妻丨国产丨丝袜| 色综合日日| 天天日天天舔| 久久五月网| 激情欧美五月丁香| 国产亚洲精品AAAAAAA片| 亚洲激情| 丁香五月在线观看完整版| 欧美精品999| 婷婷五月天黄色| 五月天综合在线观看| 日本天天操| 91婷婷搞| 久操操| 综合99在线| 色亚洲色宗合| 欧州婷婷五月天综合| 色色色在线免费视频| 我爱大香蕉| 久久精品99久久久久久久久| 26uuu欧美| 久久精品五月| 六月婷婷久久| 啪啪黄页网| 亚洲综合另类| WWW色色色COM| 狠狠操狠狠操AV| 91精品丝袜久久久久久久久粉嫩| 国产精品色色| 婷婷久久性爱| 99久久婷婷五月天| 丁香婷婷综合影院| 99精品免费| 丁香五婷婷| 精品久久99码| 日批在线看| AA片在线观看视频在线播放| 五月丁香激情深爱婷婷| 久久婷婷五月综合色和| 五月丁香影院| 丁香六月婷婷激情综合| 日本一道久久| 97精品综合| 狠狠 久久| 色色色com| 丁香婷婷超碰| 99ri在线观看视频| 成人视频九九| 这里只有精品久久| 丁香色综合| 五月丁香婷婷婷激情爱爱| 超碰在线观看9| 人人色人人摸人人看| 亚洲综合新99视频| 国产伊人大香蕉| 99精品国产乱码久久久人妻| 日本一级一片免费视频 | 九九这里只有精品| 婷婷深爱五月天| 日本一级一级一级一级| 久久探花91swag| 久久色天堂| 婷婷狠狠久久| 久久性视频| 九月激情婷婷丁香| 亚洲婷婷欧美婷婷| 小视频aaa久久久| 久久婷婷六月| 六月丁香婷婷色综合| 丁香六月婷婷综情欧美| 五月色婷婷夜色| 超碰在线网站9| 麻豆WWWCOM内射软件| 亚洲激情五月天| 九九爱激情| 丁香五月婷婷在线视频| 久久九九蜜| 99色在线观看视频| 日本色婷婷| 色级婷婷| 五月婷视频| 久久久8| 2025年最新亚洲在线欧美| 精品牛仔裤超碰| 成人片黄网站色大片免费毛片| 99r这里| 久久性爱视频| 丁香五月综合| 亚洲无线视频| 日韩伊人大香蕉| 激情98色婷婷五| 丁香六月婷婷综合| 黄色一级影片| 婷婷五月天最新综合你懂的| 欧美成人猛片AAAAAAA| 色和综合网| 五月丁香毛片| 婷婷丁香色情| 激情五月开心五月在线视频| 久久久人妻门| 97婷婷丁香五月天激情图片| 这里只有国产精品在线| 草逼大片| 日本色爽| 人妻av在线| 五月天成人免费视频| 人妻视频在线| 亚洲亚洲人成综合网络| 啪啪六月婷婷| 人人干Av| 亚洲中文乱字字幕在线永久| 国产三级在线播放| 九九热视频免费观看| 婷婷亚洲欧美丁香五月| 99热这里精品| www.综合久久.com| 激情五月五月五月婷婷| www.99热这里只有精品| 亚洲成片在线观看| 无码网| 五月婷婷激情四月| 丁香五月婷久久| www.97视频| 站长推荐无码播放| 五月丁香激情综合欧美| 99热精品中文字幕| 一级七香蕉| 这里只有免费的精品| 超碰99热| 国产va在线视频| 夜夜谢天天干| 欧美亚洲999| 99日韩| 五月婷婷综合热| 99热这里有精品| 婷婷大香蕉| 婷婷久久综合| 这里只有精品视频视频在线观看| 色婷婷激情| WWW色色色COM| 伊人色欲五月天| 香蕉综合网| 99久久婷婷| 丁香五月自拍| 国产日日夜夜操| 99热在线观看| www色中色综合| 五月九九综合| 2025天天日爽| 色五月婷色彩免播放器| 成人精品视频99在线观看免费| 五月丁香婷婷激情在线视频| 日韩二区搞逼插逼毛片| 五月色综合网| 99久久99九九99九九九| 色五月综合| 婷婷丁香97| 婷婷激情九月| 丁香花五月天| 色播五月天婷婷老师| 老师把我爽高潮了免费A片| 99色色网| 日韩AC在线免费观看| 99re在线免费视频| 欧美色色色色色色色| 99热色无码| 在线播放成人网站| 人人澡天天色天天做| 99 频99热国里只有精品| 日本黄色精品| 久久婷婷五月综合激情国产| 人人干人人看| 99国产精品白浆在线观看免费| 少妇综合网| 色欧美一级| 日韩av在线免费观看| 99热偷拍| 性综合网| 欧美电影在线观看| 996热| 狠狠色丁香婷婷基地| 九九九九国产| 激情五月综合网最新| 开心五月综合激情网| 婷婷丁香黄色| 天天日夜夜草进麻麻的子宫| 国产婷婷色综合AV蜜臀AV| 99热在线看片| 婷婷伊人网| 伊人五月天97| 婷婷婷五月天最新综合你懂的| 狠狠色无码| 五月综合视频| 久色网| 婷婷王月天影院| 天天操夜夜操| 激情伊人网| 99在线播放视频| 午夜九九电影| 欧美三级巜人妻互换| 欧美影院婷婷| 亚洲视频二区| 五月丁香| 五月激情小说| oumeisesewang| 五月婷婷深深爱| 欧美S码亚洲码精品M码| 超碰在线91| 91九色精品| 婷婷六月香| 狠狠艹狠狠艹| 色色热| 日日天天操| 天天干天天干天天| 久操干| 色婷婷激情五月天在线观看| 色综合色五月| 欧美韩国日本| 五月丁香999| 亚洲色久| 九九大香视频| 婷婷五月欧美AA片免费| 九九aV| 丁香丁香激情网| 涩婷婷五月天在线精品视频| 久久久婷丁香五月| 婷婷五月激情视频网| 另类综合婷婷五月天欧美视频| 日本久热| 涩涩婷婷五月| 天天色亚洲| 婷婷热婷婷色| 丁香五月婷婷亚洲激情四射| 五月天婷婷人妻| 日本色99网站| 开心五月深爱五月| www狠狠| 婷婷六月亚洲综合| 婷婷丁香五月激情综合站_久久五月丁香激情综合_开心五月综合激情综合五月_婷 | 久久ww| 久久女伦| 天天干狠狠操| 五月激情在线| 日本色噜| 9月色婷婷| 亚洲无码AV片| 久久久精品人妻录| 国产婷伊人| 狠狠香蕉| 人妻AV在线观看| 久久蜜臀婷婷| 亚洲九九99精品视频在线播放| www.五月丁香| 色婷婷成人| 五月婷婷偷拍| 精品久热| 黄色片精品| 色婷婷五月综合| 日本性视频| 无码激情精品色婷婷久久久久| 开心丁五月| 91亚洲免费片| 久久伊人婷| 亚洲精品久久久无码| WWW,婷婷,COM| 日本精品。999| 热99在线精品| 九七色色六月丁香| 五月天啪啪| 激情五月天小说网| 婷婷五月丁香久久| 色婷婷五月天亚洲| 五月激情婷婷国产精品久久久久久| 欧美天天干五月丁香| 国产在线网址1| 五月天婷婷在线AN| 色婷婷9| 国色天香伊人狠狠色| 久久您您综合网| 亚洲欧洲另类| 中文字幕按摩做爰| 日韩AAAAA| 操九色| 五月婷婷激情四月| 久色中文| 丁香婷婷五月天色播| 婷婷五月天激情电影| 影音先锋91资源站| 国产日韩欧美| 丁香五月激情综合在线观看| 亚洲AV日韩无码| 婷婷五月天大香蕉在线视频观看| 婷婷另类小说| 亚洲精品视频在线| 99只有精品| 五月天啪啪| 色噜噜狠狠色综合网| 色婷婷久综合久久一本国产AV| 天插天啪天啪天啪| 激情图片亚洲| 99热e| 91 久热| 国产人妻777人伦精品HD| 日日夜夜天天| 性做久久久久久久免费看| 精品人妻伦一二三区久| 五月天社区| 丰满老熟妇BBBBB搡BBB| 五月婷婷六月激情| 99色色网| 国产精品久久久久9999小说| 婷婷九九色| 婷婷九月丁香天堂丁香天堂| 超碰妻人人| 国产黄大片在线观看画质优化 | 婷婷五月丁香六月| 婷婷中文字幕| 五婷婷综合网| 超碰伊人碰婷婷五月| 天堂久久大香蕉| 草久私拍| 狠狠搞五月天| 99这里只有精品|v| 五夜婷婷| 99国产精品久久久久久久久久久| 天天综合网站| 99热精品在线在线| 91狼友视频在线观看| 蜜臀久久99精品久久久久久酒店| 丁香社92视频| 99色色热热| 色六月天| 亚洲啪啪视频| 丁香婷婷久久| 五月天久久激情| 猫咪伊人久久| 婷婷五月天影视| 亚韩在线视频| 成人综合网站| 超碰AV成人| 成人午夜视频精品一区| 六月丁香成人| 26uuu.| 99re这里只有精品国产99| 999影院成人在线影院| 婷婷丁香五月综合| 丁香五月-激情综合| 影视av久久久噜噜噜噜噜三级| 伊人久久婷| 亚洲精品乱码久久久久99| 91精品久久久久久久久久久久| 婷婷丁香六月天| 色婷婷电影网| 五月婷婷无码| 国产欧美日韩综合精品一区二区| 欧美日韩中文国产一区发布| 色婷婷视频| 四色五月婷婷| 99热手机在线精品| 五月性色| 大香蕉精品视频| 91岛国片| av操一操| 亚洲视频在线网站| 日本三级日本黄色| 色婷婷丁香六月| 激情五月综合网| 91国产精品视频播放| 丁香五月激情天AV无码| 天天摸天天透天天舔| 欧美激情-区二区三区| 五月婷婷婷| 五月丁香色婷| 国产成人综合亚洲| 丁香五月婷婷成人色区| 99啪啪网| 丁香五月婷婷欧美成人色图| 九九视频热| www.婷婷.com| 婷色成人| 免费在线观看av网站| 精品婷婷| 婷婷射综合| 丁香婷婷老司机久操| 久久中文人妻系列| 久久九九综合| 97色色色视屏| 91夫妻网站九色| 五月丁香六月欧美综合| 狠狠插狠狠| 国产九月婷婷| 天天日天天做天天操| 91妻人人爽人人看片| 日韩一区二区在线播放| 日韩性爱AV| www.思思99热| 久久久久9久无码视频| 婷婷在线观看五月天在线视频| 操久久网| Www.婷婷五月| 超碰在线网站| 激情婷婷色色| 色六月丁香婷婷啪啪啪| 婷婷五月花| 成人婷婷五月天| 综合五月天| 精品一区二区三区木瓜| 69热91天堂| 五月天丁香啪啪综合| 激情五月五月婷婷| 天天干天天操天天上| 久久44| 日本在线视频www色| 激情的五月婷婷蜜桃| 激情综合网婷婷五夜| 这里只有精品99www| 色情五月婷婷| 九月婷婷| 五月婷婷黄网站大全| 五月叮香啪| 啊v视频在线观看| 婷婷综合中文字幕| 天天日天天干天天操| 五月丁香六月婷婷亚洲天堂网站| 国产成人网址| 五月花在线观看视频| 超碰AV成人| 国产精品天天狠天天看| 超碰国产在线观看| 影音先锋女人av鲁色资源网小说免费| 乱精品一区字幕二区| 婷婷网五月天| 日日天天操| 婷婷激情性爱| ady狠狠入| 思思热在线观看| 丁香激情五月| 人人天堂操| 色综合久久综合中文综合网| 日本久碰| 99色网站| 五月开心深爱激情网| 99色色爰| 五月亭亭欧美女人| co超碰在线观看| 91九色国产| 色J香五月天| 99碰在线视频| 开心激情站| 五月婷丁香| 五月婷婷开心激情六月蜜桃| 九九热99熟女| 激情四射五月天| 无码人妻一区| 成人网在线视频| 狠狠香蕉| 亚州操操| 婷婷五月综合久久中文字幕| 激情五月,婷婷五月,丁香五月| 成人五月天在线观看| 综合激情专区| 日韩免费99| AA片在线观看视频在线播放| 少妇人妻丰满做爰XXX| 婷婷激情五月天在线| 日日噜噜夜夜狠狠久久丁香六月| 色五月天丁香婷婷色| 天天日中文| 人人操97| 久久久五月五丁香| XXXX岛国| 日操五月婷| 永久的网站AAAA| 99在线观看精品| 热久久91| 久久综合性| 久久久18| 这里只有精品日韩精品| 色偷偷色婷婷| 亚洲XX网| 黄色AV日韩| 婷婷她六月天| 免費亭亭成人| 狠狠久久婷五月| 久久狠婷婷| 欧美日韩国产日本精品四虎网网站物 | 五月天色播网| 2025天天爽天天摸| 五月丁香色婷婷综合| www.五月激情红色| 99热这里只有精品无码| www.99情趣网| 五月婷婷综合激情网| 99久久9| 26uuu亚洲| www五月| 久久久亚洲精品一区二区三区浴池 | 偷拍九九五月丁香婷婷| 91久草五月天婷婷| 亚洲激情免费视频观看| 狠狠色狠狠操| 丁香婷婷狠狠97| 丁香五夜激情四射夜夜夜| 超碰人人在线观看| 亚洲AV网站| 精品99久久久久成人网站免费| 综合99久久| 婷婷五月激情基地| 激情五月婷婷五月| 亚洲九九视频| 婷婷丁香五月基地| 99操九九网| 九九99热久久精品66中文字幕| 如何安全看伊人婷婷| 岛国AV网站| 无码人妻一区| 狠狠综合网| 色五月首页| 精品一二三区久久AAA片| 五月婷婷 自拍| 国产片天天爽夜夜爽| 六月丁香婷婷网| 六月五月婷婷| 日日夜夜狠狠| 67194成I人在线观看线路1| 亚洲色爽| 日韩色色视频| 婷婷天堂视频| 丁香五月综合在线| 五月天婷婷久久视频| 8050一级网| 欧美欧盟性爱网| 五月天激情四射网站| 9久热精品在线视频| 99热最新| 五月丁香啪啪网| 久久只有18视频| 五月开心啪啪| 婷婷五月婷| 亚洲精品国产熟女久久久| 日本97在线视频| 丁香六月激情综合啪啪| 韩日另类| 亚洲婷婷月丁香五月| 色无码| 91大神操美女| 五月婷婷,六月丁香| 九九伊人网| 久久久久久激情| 五月天天视频| 色五月中文字幕| 韩国情人在线电视剧免费观看高清版全集 | 久久综合综合久久| 婷婷五月综合社区| 婷婷综合亚洲| 99在线精品视频| 日韩黄色网络| 99热思思| 激情久久网 | 婷婷开心深爱五月天| 新激情五月天天在线网| 97人碰人操| 美国色五月天婷婷资源站| 五月丁香久久激情综合| 亚洲激情五月天| 亚洲免费在线观看岛国| 思思精品视频| 激情久久久久久久久久久| 色综合色| AV成人在线播放| a网站免费观看| 色五月婷婷影院| 色婷婷AⅤ| 成人在线精品| 天天爽爽日日做做| 天天操天天曰| 欧美va视频不用播放器的va视频网| 五月色网| 婷婷五月丁香影院| 情欲禁地| 伊人久久五月天综合| 婷婷久久五月天中文字幕在线观看| 久久99久久99精品免观看粉嫩| 丁香五月婷婷综合激情啪啪啪啪啪啪啪 | 能直接看的AV网站| 黑人无码一区| 色婷婷丁香五月| 日撸夜撸日操| 亚洲成人免费在线| 极品人妻VIDEOSSS人妻 | 9|人妻人人操| 亚洲婷婷丁香五月视频| 1级欧美日韩| 天天爱天天秀天天做| 狠色综合网| 大香蕉在线99热| 91九色精品女同系列| 欧美天天干五月丁香| 成人在线视频网| 夜夜综合色| 久热只有这里有精品| 禁片二区| 97碰碰碰免费公开在线视频| 十月丁香九月婷婷综合| 婷婷五月色情天| 丁香五月综合| 天天综合天综合| 欧美三日本三级少妇三99| 五月丁香色综合| 人草人人| 无码一区二区三区四区五区| 丁香五月伊人| 五月天婷婷成人网| 激情婷婷六月天| 99视频地址| 综合AV在线| 色婷婷伊人激情在线观看| 天天舔天天操| 亚洲国产精品五月天| 九色成人AV在线| 六月丁香网| 综合网视频| WWW色五月天| www.91av.com| 婷婷色中文字幕| 开心激情综合| 99热这里只有精品最新地址获取| 激情五月天婷婷直播| 综合网网欲色| 免费色婷婷| 操人无码| 久久婷婷影院| 久久婷婷五月综合啪| 深爱五月天天| 超碰在线视屏| 丁香六月激情四射| 国产精品岛国片在线观看免费| 99热官网精品在线| 人人干AV| 激情五月视频| 天堂草在线观| 色色网站免费观看| 这里只有精品视频视频在线观看| 五月婷婷丁香大香蕉| 五月天色小说| 久草丁香婷婷1024| 九九九九操逼| www天堂99| 婷婷五月天丁香综合网| 丁香五月www| 日B日潘金莲BB| 色婷婷色综合久久精品V| 婷婷丁香六月| 色色色com| 国产99久| 99在线视频观看| 1024AV视频| 激情五月天色色| 亚洲综合在线视频| 婷婷色五月综合| 亚洲在线综合| 亚洲avjiujiur91| 五月婷婷高清| 99热在线观看免费中文| 97色97干| 五月婷综合激情| 久久婷婷六月| 五月婷婷亚洲色视频| A久久| 亚洲AV无码成人精品区电影网| 久re热视频| 激情五月丁香色婷婷| 综合五月丁香六月婷婷| 91中文狠狠综合| 婷婷五月丁香久久| 亚洲VA在线| 99色网站| 欲求不满的人妻| 草操AV在线| 五月狠狠| 欧美黄色一级| 天天日,天天射,天天插| 大香蕉欧美在线| 99久久99综合| 色婷婷影院| 亚洲色情在线| 亚洲精品V天堂中文字幕| 26UUU欧美激情一区二区| 人妻久久久久久久久妻久久久久| 国产成人AV在线| Caoub青青超碰 | 日本一级| 狠狠草综合网| 狠狠干综合| 自拍偷窥99热| 九九热最新| 丁香五月婷婷国产av| 婷婷在线观看五月天在线视频| 99∨VTV| 亚洲av另类在线观看| 人人干天天舔| 婷婷激情综合网| 婷婷五月中文字幕| 79色色色色| 免费无码毛片一区二区A片| 色婷婷丁香五月| 天天干天天爽| 丁香五月 性爱| 第六色在线| 五月激情影院| 五月天啪啪| 另类视在线| 综久久久| 色婷婷激情五月天| 五月天丁香婷婷久久九| 激情五月天之五月婷婷| 日本天天色| 97中文在线| 97干视频在线| 91嫩草久久| 亚洲情欲| 五月天另类小说久久小说网| 99视频精品8 | 日日干天天爽| 日本色色视频| 六月丁香五月亭亭| 亚洲成av人影院| 久久亚洲婷婷综合色五月| 这里只有精品视频| 婷婷五月天综合久久| 色五月五月婷婷| 五月丁香婷婷99| 九九热经典视频在线观看| av中文字幕免费观看| 五月丁香六月婷婷不卡免费无码| 婷婷五月花| 思思热思在线精品视频| 午夜丁香婷婷| 天天日,天天射,天天插| 日韩成人精品中文字幕| 大香蕉九九| 9+1视频网址| 色婷婷影视| 26uuu精品一区二区| 色就是色婷婷五月亚洲激情| 99色视频| 激情99。| 精品少妇人妻AV无码专区偷人| 久久婷婷五月综合激情国产| 中文字幕乱码亚洲精品一区| 小视频一区 | 色情五月天首页| 欧美性生交XXXXX无码小说| 亚州视频九九99| 久久婷婷五月天丁香| 久久婷婷色五月| 热久91| 性生活久久朋友人妻| 久久日本wwww色| 婷婷无码五月天| 99久re热| 成人在线二区| 思思热思在线精品视频| 91丁香色| 色婷婷亚洲六月婷婷中文字幕| 日韩精品无码AV| 日本一级一片免费视频| 天天肏视频| 五月丁香六月婷婷网| 五月丁香色婷婷伊人| 丁香婷婷五月色成人网站| 日韩成人网址| 婷婷五月花| 色五月综合网| 欧美啪啪网| 亚洲av网站| 99 频99热国里只有精品| 国产精产国品一二三在观看| www.成人婷婷综合| 激情综合色图| 成人在线日韩| 婷婷开心综合人妻小说网址| 久热天堂| 婷婷五月,偷窥偷拍网| 99激情网| 精品一二三区久久AAA片| 337午夜福利| 玖玖精品婷婷| 丁香婷婷五月| www,婷婷五月天,com| 五月天婷婷激情网| 开心激情网五月天| 久久成人性爱| 激情综合另类| 337p大胆噜噜噜噜噜91Av| 九九热10| 影音先锋男人站,影音先锋男人色资源网,影音先锋AV最新资源站,影音先锋AV资源 | 91色综合网站在线| 婷婷六月五月| 亚洲欧美婷婷五月色综合| 天天干天天做| 五月丁香六月情| 激情AV| 一起草AV入口| 日韩在线观看亚洲| 六月丁香激情综合网| 久久一级AV| 五月婷婷丁香六月| 色综合色五月| 国产精品美女久久久久AV超清| 久久丁香五月| 黄网免费看| 大地9中文在线观看免费高清| 激情五月天在线观看色婷婷| 久久99免费视频网站| 99婷婷国产最新视频| 成人欧美一区二区三区在线观看| 一区无码| 丁香五月影院| 久99久热只有精品国产99| 91免费看片| 国产五月视频| 99ri国产| 99热这里只有免费| 九九热99视频在线| 91色性感五月婷婷丁香| AV中文在线| 夜夜爽天操| 五月丁香六月婷婷精品| 97sese婷婷| 亚洲综合在线视频| 99这里热| 日本a片网址| 五月天丁香综合在线| 99久久国产宗和精品1上映| 久久综合婷婷五月| 色婷婷五月天不卡| 人妻性爱av网站| 成人网页在线观看| 亚洲V国产V欧美V久久久久久| 操逼巨乳91| 亚洲行行色色| 婷婷偷拍网| 丁香五月天天| 色婷婷在线电影| 热99这就是精品视频| 色色色色网站| 久久99热 这里有精品| 亚洲精品国产setv| 婷婷五月天丁香久久| 青草视频在线观看视频| 久久五月婷婷丁香| 色综合色色色色色| 99热国品免费| 91干在线| 国产做A爰片毛片A片美国| 久久久无码精品成人A片小说| 五月丁香六月婷婷手机无线| www久久99com| 日韩性爱无码| 五月天久久婷| 天天插天天插| 东京热伊人| 亚洲狠狠狠| 99热这里只有精品亚洲| 久久九九爽| 婷婷五月天丁香激情| 就爱日五月天| 欧洲MV日韩MV国产| 婷婷色综合| 依人大香蕉| 色深爱五月| WWW.桔色成人.COM| AV伊人青草丁香六月| 久久久久网站| 欧美婷婷九月| 婷婷黄色网| 激情操逼婷婷| 粉嫩AV久久一区二区三区| 婷婷激情综合| www.久久爱| 久久9视频欧美| 日日夜夜久| 欧洲免费视频色| 天天综合亚洲综合网天天αⅴ| 玖玖爱伊人| 九九99热| 好色婷婷| 天天综合色99| 亚州第一黄网| http:色情日本com| 2018国产大陆天天弄| 丁香五月天激情| 色五月天堂| 色在线99| 婷婷激情人妻| 超碰在线免费9| 黄色一级影片| 五月婷婷丁香啪啪| 中文字幕激情综合| 人。妻久久| 六月色播| 久久只有18视频| 综合五月丁香六月婷婷| 俺去也在线官网| 婷婷五月丁香五月天| 天天色,天天操,天天射| 亚洲婷婷丁香五月视频| 超碰在线成人| 青青.com| 天天日,天天射,天天插| 老司机午夜福利视频金瓶梅| 操99| 欧亚色色| 欧美va亚洲va在线播放| 欧美成人AAA片一区国产精品| 欧美综合婷婷网| 天天爽天天弄| 五月婷婷这里都是精品| 色婷婷五月天小说网| 久婷婷久草| 国产精品久久久久久久久久| 天天操天天操天天操天天操天天操| 色婷婷网| 激情五月婷婷| 99热这里只有精品22| 在线中文字幕视频| 996er热| 国产亚洲精品AAAAAAA片| 欧美叉叉叉BBB网站| 少妇人妻偷人精品无码视频新浪| 亚洲V国产V欧美V久久久久久| 婷婷欠久少妇| 亚洲狠9| 69色婷婷| 大香蕉婷婷丁香天堂AV| 天天日日夜夜爽| 天天拍夜夜撸| 夜夜爽天天日| 51国精产品自偷自偷综合| 一级精品999WWW| 久9精品视频| www.minyis.com【JT】实力收量可预付QQ2101460746 | 国产av天堂| 婷婷五月天天| 中文字幕不卡视频| 久久久ww| 人人人人人人人人人草| 99re这里只有精品在线观看| 日韩视频99| 欧美激情综合色综合啪啪五月| 五月天婷婷小说| 亚洲成人影视在线| 天堂网色婷婷| 天天综合91入口| 91色久| 婷婷五月天天| 五月色婷婷综合| 色五月色五天免费视频| 二色av| 中文字幕丰满孑伦无码专区| 超碰自拍天堂| 色情丁香五月婷婷精品| eeuus五月婷| 人人操人人爱丁香五月| 日本色综合| 久久九区| 色狠狠色噜噜AV天堂五区| Y11111111111少妇电影院| 超碰免费大香蕉| 日日色五月天| 深爱综合网| 日本久久高清| 中文字幕丰满孑伦无码专区 | 99久久婷婷国产综合| 亚洲精品V天堂中文字幕| 丁香五月玖玖| 五月天啪啪视频| 清色五月天| 久久这里只精品| 色九九综合| 九色亚洲| 久热九九| 天天狠狠色综合| 丁香桃色网| 思思热这里只有精品| 人人操人人妻| 99熟女| 五月婷在线播放| 五月大香蕉| 区欧美日韩成人| 亚洲色五月婷婷| 天堂婷婷五月在线| 99精品色| 第九色区av天堂| 五月婷婷导航| 亚洲激情电影五月天色婷婷丁香一起草 | 久久影视婷婷五月| 99久久久国产大片区| 五月丁查人人| 色婷婷久久| 久久五月天丁香花| 欧美激情 日韩无码 婷婷 五月天 久久婷婷丁香五月一二三 | 久久久人人人妻丝丝丝| 性爱网五月天| 久久九九Com| 在线色色| 久久五月天激情| 色情综合网| 99久久.www| 久热中文字幕在线线观看| 91大神操美女| 色婷婷激情Av久久久| 久久停停超碰| 丁香五月综合AV在线| 欧美电影在线观看| www.91.com黄| 五月天久久网站| 激情五月婷婷| 99久在线精品| 丁香五月电影| 五月婷婷六月激情| 99热99ai| 婷婷月综合| 婷婷综合在线网| 久1色色| 激情久久久久久久久| 丁香深五月婷婷| 狠狠色狠狠| 五月丁香性| 久久五月婷天天干| 婷婷五月天天天日日夜夜| 男人的天堂五月丁香| 天天干天天日蜜臀av| 丁香丁香激情网| 国産精品| 久人操| 色婷婷综合网站| 97精品人人A片免费看| 九九九色综合| 五月色丁香| 人妻激情久久| 色婷婷在线视频久| 五月丁香在线| 97超碰色| 婷婷丁香五月天欧美| 99久热| 五月天丁香久久| 快色t v在线入口| 天堂成人A片永久免费网站 | 成人电影在线免费试看| 婷婷久久色| 九九99久久| 日本色久| 欧美中文五月天| 综合另类激情| 婷婷综合在线观看视频| 无码AV免费精品一区二区三区| 亚洲激情四射| 另类精品视频在线观看| 99热人人操人人操| m色激情网| 亚洲国产无线乱码在线观看| 2015好吊操| 精品激情| 丁香五月久久社区| av在线色五月丁香婷区久| 中文字幕丰满孑伦无码专区| 九九热在线亚洲免费视频| 丁香六月激情四射| 婷婷丁香社区| 狠狠狠色激情综合适合| 9久热在线精品| 五月丁香六月婷婷亚洲综合| 亚洲精品又粗又大又爽A片| 日日天天天| 另类小说五月天| 五月天色导航婷婷资源婷婷| 婷婷五月天成人网| 热久久91| 久久99精品视频| 中文字幕永久免费| www99在线观看视频| 五月天狠狠色| 99九九视频| 久久色午夜在线导航| 亚洲欧美一区二区三区爱爱动图 | 婷婷大香焦| 婷婷丁香五月欧美人| 亚洲av另类在线观看| 99热这里只有在线| 97色碰碰公开视频| 九九视频这里是精品五月| 午夜婷婷| 欧美婷婷五月无砖| 大陆极品少妇内射AAAAAA| 激情综合五月激情17| 婷婷婷婷婷婷婷五月丁香| 色色色综合网| 97在线视频观看| 色婷丁香| 久久99热这里只有精品| site:901-07.com| 九九热在线观看视频| 五月天色播网| 白人荫道BBWBBB大荫道| 五月婷婷综合色啪首页| 成人做爰高潮A片免费视频 | 国产五月视频| 天天做 天天爱| 亚洲久艹| 美女天天爽| 91婷婷色 | www.久久99精品| 九九色热| 欧美久久婷婷| 久久久激情| 免费试看小视频 99| 丁香婷婷老熟女综合网| 婷婷五月情天| av激情在线| 玖玖在线视频| aaa丁香五月天| 99操碰| 夜夜夜叫天天天做| www.久操| 一区二区免费看| 91操网| 天天爽夜夜操| 思思色综合网站| 97sese婷婷| 久久久99视频| 开心婷婷五月激情网小说| 亚洲亚洲人成综合网络| 日本狠狠爽| 色婷婷久久9.com| 99啪99| 色就是色婷婷五月亚洲激情| 无码激情AAAAA片-区区| 亚洲综合激情五月| 婷婷色九月| 欧美成人精品三区综合A片| 性生活久久朋友人妻| 亚洲天99| 成人做爰高潮A片免费视频| 色五月婷婷内射| 五月天婷婷激情在线色图| 人妻AV在线观看| 综合网色| 99久久99九九99九九九| 99激情视频| 婷婷色Av| 久久伊人9| 大地9中文在线观看免费高清| 欧美草久久五月天91| 国产激情av| 国产67194| 婷婷综合爱| 丁香婷婷五月激情| 中文字幕日产A片在线看| 五月天激情电影| 啪啪黄页网| 久久丁香| 丁香六月婷婷综合缴| 97色色色色| 亚州男人天堂婷婷五月| 操逼三区| 日日干夜夜撸夜夜骑| 日本乱论99| 狠狠干综合| 精品久久穴| 天天综合网亚洲综合网| 97久久综合网| 在线视频另类| 五月婷婷精品视频| 色天使色婷婷| 成人在线99| 亚洲综合热| 亭亭丁香久久五月| 丁香五月 激情文学| 天天做天天爱天天高潮| 人人摸人人干人人做| 99在线69| 婷婷酒色网| 99免费热视频在线| 色色色色色网站| 日本妈妈乱| www.97干视频| 亚洲国产精品VA在线看黑人| 狠狠五月天| 第六色在线| 激情文学第四色婷婷丁香五月| 成人综合网站| 黄色成人网站在线播放| 99久久99热这里只有精品| 色综合久久天天综合网| 依人大香蕉在钱1| 婷婷六月色| 思思热在线| 五月丁香婷中文| 色五月激情网| 久综合4| 内射综合网| 五月婷婷无码| 九九视频精品这里只有| 九九干视频| 果冻传媒A片一二三区| 夜夜操夜夜操| 在线只有精品| 丁香五月激情鲁| 亚洲激情淫网| 黄色AV日韩| 国产44页| 97五月婷| 黑人糟蹋人妻HD中文字幕| 九九亚洲综合| 六月婷婷在线视频| 国产丁香五月天婷婷| 92久操视频| 国精产品一区一区三区免费视频 | 骚货艹网站视频| 婷婷激情五月天天天开心| 超碰二区| 丁香九月综合在线| 日韩熟女啪啪视频| 国产精品美女久久久久AV超清| 五月丁香自拍| 久久少妇视频| 五月婷婷免费视频| VA国产在线综合网站| 操逼视频一区| 去色色五月天| 久久婷婷七月丁香| 丁香五月激情五月| www.99热在线观看| 成人丁香五月| 天天爽夜夜爽天天爽夜夜爽| 日本狠狠爽| 免费AV黄在线播放| 亚洲色啪| 日韩在线9| 亚洲国产另类av| 色色综合网www| 日韩中文字幕| 97人妻碰碰中文无码久热丝袜| 大香蕉婷婷丁香天堂AV| 久久 婷婷 五月天| 色综合激情| www激情五月天| 五月婷婷六月奇米网丁香| 99re思思精品视频在线观看| 五月婷婷色色色| 大香蕉伊在| 99九九免费精品| 五月丁香婷婷五月色| 婷婷五月成人| 丁香婷婷色五月| 婷婷五月花| 99精品久久久| 色啪影院| 开心五月综合激情网| 成人网站免费在线播放| 人人播|