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

ARTICLE DETAIL

資訊詳情

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

Apollo 9.0速度規(guī)劃核心:Piecewise Jerk非線性優(yōu)化器Ⅱ解析

Apollo 9.0速度規(guī)劃核心:Piecewise Jerk非線性優(yōu)化器Ⅱ解析 做自動(dòng)駕駛規(guī)劃模塊的人對(duì)“速度規(guī)劃”這四個(gè)字的感情一定很復(fù)雜。路徑規(guī)劃給你一條曲線但車速怎么沿著這條曲線走才是決定乘坐體驗(yàn)和安全的下半場(chǎng)。Apollo 9.0 里的這套 piecewise jerk speed nonlinear optimizer Ⅱ就是速度規(guī)劃環(huán)節(jié)里最硬核的一塊它把速度曲線求解建模成一個(gè)分段加加速度piecewise jerk約束下的非線性規(guī)劃問(wèn)題。這篇文章不打算從頭講概念直接聊大家最關(guān)心的幾件事——代價(jià)函數(shù)怎么設(shè)計(jì)、約束系統(tǒng)怎么搭、為什么必須用非線性求解器、以及代碼跑起來(lái)之后參數(shù)該怎么調(diào)、不收斂時(shí)怎么排查。內(nèi)容適合正在看 Apollo 規(guī)劃源碼的人、想在自己的無(wú)人車框架里實(shí)現(xiàn)類似速度規(guī)劃器的工程師以及被“NLP 求解慢/發(fā)散/結(jié)果抖”折磨過(guò)的同學(xué)。我會(huì)按我自己優(yōu)化這類問(wèn)題的思路展開(kāi)不堆公式標(biāo)題把拆過(guò)的模型和踩過(guò)的坑盡量說(shuō)透。1. 速度規(guī)劃到底解決什么問(wèn)題從 ST 圖到 piecewise jerk 模型1.1 路徑定下來(lái)之后速度為什么還要單獨(dú)做規(guī)劃在 Apollo 的規(guī)劃棧里規(guī)劃模塊大致按“感知 → 預(yù)測(cè) → 路由 → 決策 → 規(guī)劃 → 控制”的鏈路工作。規(guī)劃這一步通常又分成兩層先解路徑Path再解速度Speed。路徑?jīng)Q定車往哪條線走速度決定車上每個(gè)時(shí)刻以多快沿著這條線走。兩者不能完全解耦因?yàn)閺澋郎系淖罡哕囁倥c曲率有關(guān)動(dòng)態(tài)障礙物又跟時(shí)間有關(guān)所以速度規(guī)劃一直是單獨(dú)拿出來(lái)重點(diǎn)處理的部分。速度規(guī)劃的輸出本質(zhì)上是一條 s-t 曲線s 表示車輛沿參考線走過(guò)的縱向弧長(zhǎng)t 表示時(shí)間。有了 s(t)就可以求導(dǎo)得到速度 v(t)、加速度 a(t) 和加加速度 j(t)。所有跟“舒適性”“安全性”有關(guān)的約束最后都會(huì)落實(shí)到這條曲線上。1.2 ST 圖把動(dòng)態(tài)問(wèn)題變成二維幾何問(wèn)題處理動(dòng)態(tài)障礙物最經(jīng)典的手段就是 ST 圖。橫軸是時(shí)間縱軸是縱向位移。靜態(tài)障礙物在 ST 圖上表現(xiàn)為一段沿 s 方向的平行區(qū)域動(dòng)態(tài)障礙物則表現(xiàn)為一塊斜著的多邊形區(qū)域——前車減速時(shí)它的末端在 ST 圖上會(huì)向上彎對(duì)向車道來(lái)車看起來(lái)更陡。規(guī)劃任務(wù)就是在 ST 圖里找一條從當(dāng)前狀態(tài)出發(fā)、繞過(guò)所有障礙物區(qū)域、滿足速度和加速度上下界的三次平滑曲線。Apollo 里早期的 DP 速度規(guī)劃就是先在離散網(wǎng)格上粗搜一條可行走廊再用 QP 平滑。但粗搜和二次規(guī)劃在處理連續(xù)的非線性約束曲率限速、障礙物距離度、舒適度指標(biāo)時(shí)都需要做分段線性近似精度和光滑性都不夠理想。于是后續(xù)迭代里引入了基于 piecewise jerk 的非線性優(yōu)化器把整個(gè)問(wèn)題直接建成 NLP 來(lái)做。1.3 為什么叫“piecewise jerk”簡(jiǎn)單說(shuō)piecewise jerk 模型把速度規(guī)劃的時(shí)間域離散成 N 個(gè)等長(zhǎng)小段每一小段上的加加速度jerk被假設(shè)為常數(shù)。這樣一來(lái)加速度在每一段內(nèi)是線性變化的速度在每一段內(nèi)是二次變化的位移在每一段內(nèi)是三次變化的。所以每個(gè)小段 s(t) 都是一個(gè)三次多項(xiàng)式。如果你把相鄰若干段連起來(lái)看位移不僅能保證連續(xù)還能保證速度、加速度連續(xù)這正是乘員能明顯感知到的舒適性邊界。選擇 jerk 作為控制量而不是加速度是有講究的。如果只對(duì)加速度做約束規(guī)劃出來(lái)的速度曲線可以保證加減速過(guò)程是“平滑”的但加速度突變?nèi)匀粫?huì)讓人感到?jīng)_擊。加上 jerk 約束后加加速度被限制在一個(gè)小范圍內(nèi)車輛起步、剎停的過(guò)程才真正柔和下來(lái)。這也是 piecewise jerk 類方法在工業(yè)界被廣泛應(yīng)用的原因。1.4 先回顧一下第一版非線性優(yōu)化器做了什么既然是“Ⅱ”前面必然有一篇講基礎(chǔ)模型的。第一部分的重點(diǎn)一般是定義決策變量、寫出運(yùn)動(dòng)學(xué)遞推關(guān)系、搭出優(yōu)化問(wèn)題的整體骨架。決策變量通常包含每段的位移 s_i、速度 v_i、加速度 a_i以及作為控制輸入的 jerk j_i。相鄰變量之間滿足s_{i1} s_i v_i * Δt 0.5 * a_i * Δt^2 (1/6) * j_i * Δt^3v_{i1} v_i a_i * Δt 0.5 * j_i * Δt^2a_{i1} a_i j_i * Δt這三個(gè)式子就是整個(gè)優(yōu)化問(wèn)題的核心等式約束后面所有推導(dǎo)都是圍繞它展開(kāi)。第二部要討論的就是在這個(gè)模型之上如何把現(xiàn)實(shí)場(chǎng)景里的各種目標(biāo)、約束、數(shù)值問(wèn)題都塞進(jìn)一個(gè)可求解的 NLP 框架里。2. 非線性優(yōu)化器Ⅱ的核心代價(jià)函數(shù)與約束系統(tǒng)的設(shè)計(jì)2.1 代價(jià)函數(shù)不是拍腦袋定的每一項(xiàng)都對(duì)應(yīng)一種“不滿”速度規(guī)劃的本質(zhì)是在多個(gè)互相矛盾的目標(biāo)里找平衡既想跑得快又怕剎不住既要貼線又擔(dān)心太顛既想跟前車保持距離又不希望車速忽快忽慢。這些矛盾全部體現(xiàn)在代價(jià)函數(shù)里。一個(gè)典型的 piecewise jerk speed 代價(jià)函數(shù)會(huì)包含以下幾類項(xiàng)對(duì)加速度 a^2 的懲罰限制大油門、急剎車懲罰大加速度。對(duì)加加速度 j^2 的懲罰限制加速度的突變提升平順性。對(duì)參考速度偏差 (v - v_ref)^2 的懲罰讓速度盡可能貼近期望巡航速度或限速避免司機(jī)覺(jué)得“這車怎么慢吞吞的”。對(duì)橫向加速度的懲罰彎道處要考慮側(cè)向力而橫向加速度約等于 v^2 乘以曲率 κ(s)所以這項(xiàng)本質(zhì)上是把路徑曲率信息耦合進(jìn)了速度規(guī)劃。對(duì)障礙物距離的懲罰不能讓車貼著障礙物邊界走懲罰項(xiàng)給安全余量留出空間。末端代價(jià)針對(duì)停車場(chǎng)景期望最后一段速度接近 0、加速度接近 0讓車輛能“穩(wěn)穩(wěn)停住”。把這么多項(xiàng)寫進(jìn)目標(biāo)函數(shù)時(shí)每一項(xiàng)前面的權(quán)重系數(shù)決定了它的“話語(yǔ)權(quán)”。權(quán)重差一個(gè)數(shù)量級(jí)規(guī)劃出來(lái)的速度曲線風(fēng)格就完全不一樣。這就是為什么很多團(tuán)隊(duì)對(duì)同一套源碼調(diào)了幾個(gè)月參數(shù)配出來(lái)的車感千差萬(wàn)別。2.2 為什么這個(gè)優(yōu)化問(wèn)題必須是“非線性”的很多初學(xué)者會(huì)問(wèn)這些目標(biāo)看起來(lái)有平方項(xiàng)約束看起來(lái)也不少用二次規(guī)劃QP不是更快更成熟嗎確實(shí)Apollo 早年版本里就有一個(gè) QP-based 的 piecewise jerk speed optimizer。但 QP 只能處理線性約束和二次目標(biāo)在速度規(guī)劃這個(gè)場(chǎng)景里有幾個(gè)東西是天然非線性的曲率限速約束。彎道允許的最大車速與曲率相關(guān)通常寫成 v ≤ sqrt(a_lat_max / |κ(s)|)。這個(gè)約束包含開(kāi)方不是線性約束。橫向加速度目標(biāo)項(xiàng)。橫向加速度本身是 v^2 與 κ 的乘積是二次非線性的。障礙物距離懲罰。如果直接用分段線性約束來(lái)表示 ST 圖中的障礙物上邊界會(huì)讓可行域出現(xiàn)大量折角求解出來(lái)的速度曲線也容易出現(xiàn)轉(zhuǎn)折點(diǎn)。更好的做法是用平滑函數(shù)比如指數(shù)、對(duì)數(shù)障礙函數(shù)表達(dá)“離障礙物越遠(yuǎn)越安全”這幾乎注定是非線性問(wèn)題。所以非線性優(yōu)化器Ⅱ的定位就是把這些真實(shí)約束直接用原始公式塞進(jìn)優(yōu)化模型靠 NLP 求解器去找一個(gè)滿足全部條件的局部最優(yōu)解。2.3 約束系統(tǒng)分層等式約束、變量邊界、障礙物約束實(shí)際搭約束的時(shí)候我習(xí)慣把它們分成三層來(lái)梳理。第一層是等式約束。運(yùn)動(dòng)學(xué)遞推三式必須嚴(yán)格滿足它們?cè)?NLP 里以殘差形式出現(xiàn)比如把等式改寫成 g_i(x) 0 后交給求解器。第二層是變量邊界。位移 s 有上下界——下界來(lái)自不可倒退和動(dòng)態(tài)障礙物下邊界上界來(lái)自停車線、靜態(tài)障礙物和跟隨目標(biāo)速度 v 有上下界——下界一般是 0上界來(lái)自道路限速與曲率限速的較小者加速度和加加速度的上下界通常由車輛性能和舒適性標(biāo)定決定。第三層是障礙物相關(guān)的約束。對(duì)于每個(gè)動(dòng)態(tài)障礙物需要把它的 ST 投影變成隨時(shí)間變化的上邊界和距離邊界。最直接的做法是構(gòu)造一組分段線性邊界約束非線性優(yōu)化器里更傾向用平滑函數(shù)去逼近障礙物的“可通行區(qū)域邊界”然后把這個(gè)平滑函數(shù)引入到目標(biāo)函數(shù)或不等約束中。2.4 末端狀態(tài)約束的細(xì)節(jié)很容易被忽略很多團(tuán)隊(duì)第一次做速度規(guī)劃時(shí)重點(diǎn)都放在中間過(guò)程平滑卻忽略了終點(diǎn)狀態(tài)。結(jié)果就是車在接近終點(diǎn)或者停車線時(shí)速度曲線不收斂最后幾米突然沖一下或者剎不住。原因很簡(jiǎn)單如果優(yōu)化目標(biāo)里沒(méi)有端點(diǎn)的速度和加速度約束那么 N 段軌跡的最后一小段狀態(tài)只是自由變量它可以被目標(biāo)函數(shù)里的其他項(xiàng)“欺負(fù)”得很狼狽。Apollo 這類規(guī)劃器在處理停車場(chǎng)景時(shí)通常會(huì)對(duì)末端 s、v、a 設(shè)置硬約束或者很強(qiáng)的末端代價(jià)讓末點(diǎn)速度 v_N 接近 0、加速度 a_N 接近 0。正常巡航場(chǎng)景則會(huì)對(duì)末端速度設(shè)置期望值保證與下一幀規(guī)劃結(jié)果銜接連續(xù)。這個(gè)細(xì)節(jié)在復(fù)現(xiàn)算法時(shí)一定要加上否則離線仿真看著沒(méi)事一上實(shí)車就是各種“點(diǎn)頭”。3. 求解器選型與數(shù)值實(shí)現(xiàn)從理論到代碼的最后一公里3.1 決策變量與問(wèn)題規(guī)模小身材里的稀疏性接進(jìn)來(lái)一個(gè)實(shí)際的點(diǎn)。假設(shè)時(shí)間窗口 T 取 8 秒離散步長(zhǎng) Δt 取 0.1 秒那么 N 80。每一段有 s_i、v_i、a_i 三個(gè)狀態(tài)變量再加上每一段的控制變量 j_i總共大約有 4 個(gè)變量乘以 80 段也就是 320 個(gè)決策變量。再加上 240 個(gè)左右運(yùn)動(dòng)學(xué)等式約束以及各種上下界約束。這個(gè)規(guī)模在現(xiàn)代 NLP 求解器面前不算大但如果把雅可比矩陣當(dāng)成稠密矩陣來(lái)寫計(jì)算量和內(nèi)存消耗都會(huì)成倍上漲。正確的做法是利用稀疏結(jié)構(gòu)大多數(shù)約束只涉及相鄰兩三個(gè)時(shí)間節(jié)點(diǎn)雅可比矩陣呈帶狀分布。用稀疏矩陣接口來(lái)裝配 Jacobian 和 Hessian求解效率會(huì)快一個(gè)量級(jí)以上。3.2 解析雅可比永遠(yuǎn)是首選能不用差分就不用差分我在實(shí)際調(diào)試中遇到過(guò)幾次“解決問(wèn)題的時(shí)候發(fā)現(xiàn)求解器很慢”排查到最后發(fā)現(xiàn)是代碼里用了有限差分去估算導(dǎo)數(shù)。有限差分在變量規(guī)模小的時(shí)候看不出問(wèn)題但到了 300 多個(gè)變量時(shí)每次迭代都要多次擾動(dòng)求解浪費(fèi)時(shí)間而且差分步長(zhǎng)選不好會(huì)引入數(shù)值噪聲導(dǎo)致優(yōu)化結(jié)果抖來(lái)抖去。對(duì)這個(gè)模型解析導(dǎo)數(shù)并不難寫。狀態(tài)遞推式對(duì) s_i、v_i、a_i、j_i 的導(dǎo)數(shù)就那么幾個(gè)常數(shù)項(xiàng)代價(jià)函數(shù)對(duì) a 和 j 的求導(dǎo)也很直接唯一麻煩的是橫向加速度項(xiàng)它會(huì)同時(shí)依賴 v_i 和 κ_i寫鏈?zhǔn)椒▌t時(shí)容易漏項(xiàng)。我建議每寫完一個(gè)導(dǎo)數(shù)函數(shù)先做一次數(shù)值差分對(duì)拍確認(rèn)誤差在 1e-6 量級(jí)再往下走。提示別小看這一步。數(shù)值對(duì)照是檢驗(yàn)解析雅可比最快的辦法很多“輕量級(jí) bug”比如下標(biāo)差一、漏乘 Δt幾乎都是靠對(duì)拍抓出來(lái)的。3.3 熱啟動(dòng)解決非凸問(wèn)題局部最優(yōu)的關(guān)鍵一招NLP 本質(zhì)上是個(gè)非凸優(yōu)化找到全局最優(yōu)是非常困難的。速度規(guī)劃這類問(wèn)題更實(shí)際的目標(biāo)是“求一個(gè)可行且足夠好的局部最優(yōu)解”。要讓求解器穩(wěn)定找到這樣一個(gè)解初值非常重要。Apollo 的實(shí)現(xiàn)里通常會(huì)用上一步的規(guī)劃結(jié)果或者一個(gè)粗糙的 DP / QP 解來(lái)作為熱啟動(dòng)。熱啟動(dòng)的好處有兩層一是大幅減少迭代次數(shù)讓求解能在 50 毫秒量級(jí)內(nèi)完成二是讓優(yōu)化落在上一拍解的附近避免兩幀之間速度曲線發(fā)生跳變。我自己踩過(guò)的坑是某些場(chǎng)景下熱啟動(dòng)解已經(jīng)接近約束邊界比如貼著障礙物邊界NLP 從這種初始點(diǎn)出發(fā)很容易被障礙物懲罰項(xiàng)推到另一個(gè)分歧解里。這時(shí)候可以先把障礙物距離懲罰做大一點(diǎn)讓初值“遠(yuǎn)離”約束邊界再逐步恢復(fù)原權(quán)重。3.4 數(shù)值規(guī)范化讓量綱不同的問(wèn)題不再病態(tài)速度規(guī)劃里同時(shí)存在 s、v、a、j。數(shù)值上 s 動(dòng)輒幾十上百v 十幾二十a(chǎn) 只有幾j 是零點(diǎn)幾到幾。如果直接把這些變量丟給求解器矩陣條件數(shù)很容易變差導(dǎo)致收斂緩慢或者壓根不收斂。我的做法是在進(jìn)入求解器前把每個(gè)變量除以一個(gè)特征尺度比如 s 除以 100v 除以 20a 除以 5j 除以 3。代價(jià)函數(shù)的權(quán)重也跟著重新標(biāo)定。解完之后再乘回尺度系數(shù)。這套歸一化處理整體代碼量很小收益卻非常明顯尤其是轉(zhuǎn)彎場(chǎng)景下橫向加速度和縱向加速度同時(shí)起作用時(shí)。4. 實(shí)操過(guò)程從配置到代碼骨架如何快速把優(yōu)化器跑起來(lái)4.1 關(guān)鍵參數(shù)與調(diào)參方向速查如果你用的是 Apollo 現(xiàn)成框架通常不希望你直接改二進(jìn)制的權(quán)重值而是通過(guò) planning 配置里的參數(shù)去調(diào)。這里整理一個(gè)我自己常用的參數(shù)調(diào)優(yōu)速查表基本覆蓋了最容易影響速度規(guī)劃效果的幾個(gè)旋鈕參數(shù)方向?qū)?yīng)目標(biāo)項(xiàng)手感表現(xiàn)調(diào)參數(shù)值的影響jerk 權(quán)重調(diào)大加加速度懲罰速度曲線更柔起步/剎停更線性曲線變鈍但可能過(guò)分保守加速度權(quán)重調(diào)大加速度懲罰大油門/急剎減少跟車靈敏度下降參考速度權(quán)重調(diào)大貼近限速車速更接近期望速度容易忽略舒適性橫向加速度權(quán)重調(diào)大彎道車速入彎速度更早降下來(lái)出彎提速變慢障礙物距離權(quán)重調(diào)大安全距離跟車距離變大通過(guò)性變差可行域更大平滑約束靈活度提升更容易出現(xiàn)局部振蕩調(diào)參有一個(gè)順序建議先調(diào)好舒適性相關(guān)權(quán)重jerk、加速度再調(diào)限速相關(guān)權(quán)重參考速度最后調(diào)安全相關(guān)權(quán)重。原因是從目標(biāo)函數(shù)的耦合度來(lái)看安全權(quán)重加得太早容易把其他項(xiàng)的問(wèn)題掩蓋住后面想排查舒適性問(wèn)題就很麻煩。4.2 一個(gè)最簡(jiǎn) C 偽代碼骨架展示問(wèn)題裝配過(guò)程接觸過(guò) Apollo 這類 C 代碼庫(kù)的人看到大段的 Problem 對(duì)象、變量數(shù)組和約束矩陣時(shí)容易一頭霧水。其實(shí)把 NLP 的裝配過(guò)程抽象出來(lái)骨架并不復(fù)雜// 偽代碼示意構(gòu)建 piecewise jerk speed NLP const double dt 0.1; // 離散步長(zhǎng) const int N 80; // 離散段數(shù) // 1. 初始化決策變量 std::vectordouble s(N 1), v(N 1), a(N 1), j(N); // 2. 設(shè)定狀態(tài)初值熱啟動(dòng) s[0] current_s; v[0] current_v; a[0] current_a; // 3. 構(gòu)建代價(jià)函數(shù)項(xiàng) for (int i 0; i N; i) { cost w_ref * (v[i] - v_ref[i]) * (v[i] - v_ref[i]); cost w_acc * a[i] * a[i]; cost w_lat * kappa[i] * v[i] * v[i] * v[i] * v[i]; } for (int i 0; i N; i) { cost w_jerk * j[i] * j[i]; } // 4. 添加運(yùn)動(dòng)學(xué)等式約束寫成殘差形式 for (int i 0; i N; i) { addResidual(s[i1] - (s[i] v[i]*dt 0.5*a[i]*dt*dt j[i]*dt*dt*dt/6.0)); addResidual(v[i1] - (v[i] a[i]*dt 0.5*j[i]*dt*dt)); addResidual(a[i1] - (a[i] j[i]*dt)); } // 5. 添加變量邊界 for (int i 0; i N; i) { addLowerBound(s[i], st_s_min[i]); addUpperBound(s[i], st_s_max[i]); addLowerBound(v[i], 0.0); addUpperBound(v[i], std::min(limit_speed[i], curvature_limit_speed[i])); addLowerBound(a[i], a_min); addUpperBound(a[i], a_max); } // 6. 設(shè)置末端約束 addLowerBound(v[N], 0.0); addUpperBound(v[N], 0.0); // 停車場(chǎng)景示例 // 7. 交給 NLP 求解器求解 solver.solve(cost, constraints);這段代碼雖然只是骨架但已經(jīng)包含了求解一個(gè)速度曲線所需的最小要素。很多團(tuán)隊(duì)在工程落地時(shí)會(huì)再加一層對(duì)每個(gè)時(shí)間點(diǎn)把外部傳入的障礙物 ST 約束轉(zhuǎn)換成一個(gè)分段線性函數(shù)存到數(shù)組 st_s_max 里。這一步做實(shí)了整個(gè)問(wèn)題才真正“接”上了感知和預(yù)測(cè)。4.3 一個(gè)典型的場(chǎng)景實(shí)測(cè)彎道遇靜止障礙物跑通代碼后我建議用一個(gè)簡(jiǎn)單場(chǎng)景來(lái)驗(yàn)證整體效果車輛沿彎道行駛前方同一車道內(nèi)有一個(gè)靜止障礙物比如一臺(tái)拋錨的貨車。這個(gè)場(chǎng)景能同時(shí)暴露曲率限速、障礙物避讓、末端停車三個(gè)方面的耦合問(wèn)題。從結(jié)果上你一般會(huì)看到離障礙物還有一段距離時(shí)速度先開(kāi)始緩慢下降而不是到跟前才急剎。這是加加速度約束在起作用。進(jìn)入彎道之前速度會(huì)比直道限速更低因?yàn)闄M向加速度項(xiàng)的懲罰開(kāi)始?jí)哼^(guò)目標(biāo)速度項(xiàng)。在障礙物位置附近s-t 曲線會(huì)留出明顯的安全余量不會(huì)貼著障礙物邊界走。接近停車目標(biāo)點(diǎn)時(shí)末段速度和加速度同時(shí)收斂到 0整條曲線看起來(lái)像“自然滑停”。如果實(shí)測(cè)中看到速度曲線在彎道段出現(xiàn)抖動(dòng)多半是橫向加速度權(quán)重和曲率圖分辨率不匹配或者離散步長(zhǎng)太大把曲率變化劇烈的地方采樣漏了。可以試試把 Δt 從 0.1 縮到 0.05代價(jià)是段數(shù)翻倍求解時(shí)間會(huì)上升但曲線的順滑度通常能明顯變好。5. 常見(jiàn)問(wèn)題與排查技巧實(shí)錄5.1 問(wèn)題一NLP 求解器一直報(bào)不收斂時(shí)間窗口被耗盡這是最常遇到的情況。排查思路按優(yōu)先級(jí)排序先看初值是否合理。如果熱啟動(dòng)解本身就在障礙物里面或者速度初值超過(guò)限速很多那求解器大概率會(huì)為了找可行解反復(fù)摸索。再看約束是否過(guò)緊。把障礙物距離約束松開(kāi)一點(diǎn)點(diǎn)或者把末端速度約束從硬約束改成大權(quán)重代價(jià)看看求解時(shí)間是否急劇下降。最后檢查導(dǎo)數(shù)是否正確。在模型代碼里寫一個(gè)差分對(duì)照的開(kāi)關(guān)跑一輪小規(guī)模問(wèn)題如果解析雅可比與差分結(jié)果差異很大基本可以鎖定 bug 在導(dǎo)數(shù)。注意非線性優(yōu)化不收斂時(shí)不要上來(lái)就調(diào)求解器參數(shù)。先降問(wèn)題難度再逐步加約束逐個(gè)排查效率高得多。這個(gè)順序我用了很多次屢試不爽。5.2 問(wèn)題二速度曲線出現(xiàn)明顯的高頻振蕩這種現(xiàn)象的典型特征是 v-t 圖上有肉眼可見(jiàn)的紋波尤其是起步、停車和通過(guò)曲率突變點(diǎn)時(shí)。原因主要有三個(gè)jerk 權(quán)重太小對(duì)加加速度的懲罰力度不夠讓速度曲線可以肆意地在相鄰時(shí)間點(diǎn)來(lái)回彈跳。解決辦法是調(diào)大 jerk 權(quán)重。約束不光滑障礙物邊界是分段線性表達(dá)時(shí)折角會(huì)引入不光滑導(dǎo)致目標(biāo)函數(shù)的梯度在交界面附近劇烈變化。解決辦法是用平滑函數(shù)近似邊界。初值本身帶振蕩上一步 DP 解太粗直接拿它熱啟動(dòng)NLP 需要大量迭代去“磨平”初值。解決辦法是對(duì)初值先做一次輕量級(jí)平滑或者增加迭代上限。我給一個(gè)經(jīng)驗(yàn)值方向jerk 權(quán)重的量級(jí)通常要比加速度權(quán)重大 2 到 5 倍才能壓得住振蕩趨勢(shì)。具體數(shù)值受不同車型、不同整車質(zhì)量影響還是需要結(jié)合實(shí)車/仿真標(biāo)定。5.3 問(wèn)題三實(shí)時(shí)性不達(dá)標(biāo)求解耗時(shí)超過(guò) 100 毫秒Apollo 這類系統(tǒng)里規(guī)劃周期一般只有 100ms 甚至更短留給 NLP 的時(shí)間最多 50 到 60ms。如果超時(shí)常見(jiàn)處理路徑是縮小優(yōu)化時(shí)域。把 8 秒窗口砍到 6 秒或者把 Δt 從 0.05 放大到 0.1段數(shù) N 減半。熱啟動(dòng)做扎實(shí)。同一場(chǎng)景連續(xù)多幀規(guī)劃解之間的差異很小熱啟動(dòng)可以把迭代次數(shù)壓到個(gè)位數(shù)。對(duì)難解場(chǎng)景做“多級(jí)降級(jí)”。先讓快速求解器跑一個(gè)完整解如果時(shí)間預(yù)算不夠就用上一次規(guī)劃結(jié)果結(jié)合局部修正而不是繼續(xù)死磕 NLP。預(yù)處理曲率表、限速表。在進(jìn)入優(yōu)化器之前把 s 相關(guān)的靜態(tài)信息算好避免在目標(biāo)函數(shù)里頻繁查表。實(shí)時(shí)性問(wèn)題的根源通常在“建模太重”而不是求解器太慢。把不必要的大 N 和過(guò)緊的約束放掉往往比升級(jí)硬件更直接。5.4 問(wèn)題四規(guī)劃結(jié)果與控制模塊對(duì)不上車實(shí)際表現(xiàn)比曲線“愣”規(guī)劃輸出的是未來(lái)若干秒的速度曲線控制模塊去跟蹤時(shí)會(huì)有滯后尤其在急轉(zhuǎn)彎或者強(qiáng)制動(dòng)場(chǎng)景。這時(shí)我看到很多團(tuán)隊(duì)第一反應(yīng)是去調(diào) PID但真正的問(wèn)題可能出在規(guī)劃末端狀態(tài)不連續(xù)。每一幀規(guī)劃開(kāi)始時(shí)初始狀態(tài)必須是上一幀規(guī)劃在“當(dāng)前時(shí)刻”的狀態(tài)值而不是直接用定位反饋的即時(shí)值。如果這兩者差得多相當(dāng)于讓優(yōu)化器從全新起點(diǎn)重新規(guī)劃每一幀都會(huì)推出一段不同形狀的曲線控制自然追不上。Apollo 這類系統(tǒng)非常強(qiáng)調(diào)上一個(gè)周期的輸出與下個(gè)周期的輸入對(duì)齊查這個(gè)問(wèn)題時(shí)先看變量銜接處是否有跳變往往能找到真兇。6. 后續(xù)擴(kuò)展與一點(diǎn)個(gè)人體會(huì)非線性速度優(yōu)化器的能力邊界不止于當(dāng)前這套配置。如果你繼續(xù)往深了做會(huì)發(fā)現(xiàn)它和路徑規(guī)劃是強(qiáng)耦合的當(dāng)前方法是把路徑當(dāng)作已知輸入所以橫向加速度項(xiàng)只是“引用”曲率而不是去決策路徑形狀。更進(jìn)一步的方案會(huì)把路徑采樣和速度優(yōu)化放在同一層迭代求解但工程復(fù)雜度會(huì)成倍上漲。我個(gè)人的體會(huì)是piecewise jerk speed nonlinear optimizer 這類算法真正難的不是把數(shù)學(xué)公式寫成代碼而是在真實(shí)感知噪聲、控制偏差、限速變化頻繁切換的場(chǎng)景里保持解的穩(wěn)定性和連續(xù)性。針對(duì)這一點(diǎn)持續(xù)維護(hù)一個(gè)場(chǎng)景回歸集特別重要——把單車道跟車、多車博弈、彎道靜止障礙物、連續(xù)紅綠燈等場(chǎng)景錄制成離線測(cè)試包每改一次權(quán)重或者約束邏輯就全量回放一遍。這套流程跑順之后你再回去看源代碼里那些權(quán)重參數(shù)就能真正理解每一處數(shù)值背后的行車性格。最后分享一個(gè)小技巧調(diào)試時(shí)優(yōu)先看加加速度曲線而不是速度曲線。加速度和加加速度是對(duì)舒適性最敏感的指標(biāo)兩幀之間速度曲線看著差不多但加加速度曲線可能已經(jīng)出現(xiàn)了肉眼可見(jiàn)的毛刺。養(yǎng)成“最終判讀看 a-t 和 j-t 圖”的習(xí)慣能幫你省下大量肉眼比對(duì)速度圖的時(shí)間。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
婷婷七月丁香色色| 老司机视频lsj爱就色| 成人午夜天| 欧美精产国品一二三区| 色婷婷丁香AV综合| 91狠狠综合久久久久久| 天天狠狠婷婷在线| 五月WWW| 九九热99热| 久久综合综合综合| 另类激情码| 五月激情精品视频| 天天做天天爽| 国产熟女大叫受不了| Av性爱网| 久久婷婷五月综合| 91日本在线观看| 婷婷五月伦理网站| 色情五月天导航| 婷婷深爱网| 91精品久久久久| 超碰在线免费观看3 9| www色婷婷com| 亚洲视频伍月婷婷| 中文字幕在线日亚州9| 99综合网| 26uuu丁香婷婷五月| 79色色色色| 五月天婷婷激情六月久久| 日本丁香五月婷婷| 九九色婷婷| 日韩综合久| 爱婷婷都市激情| 国产女18毛片多18精品| 天天做 天天爱| 热日韩欧美| 五月丁香婷婷俺| 97干在线免费| 激情五月,婷婷五月,丁香五月| 九九热九九| 51XX午夜影福利| 五月婷婷啪啪| 婷婷色无码| 天天插操| 国产毛片精品一区二区色欲黄A片| 91人久| 五月婷在线视频免费看| 97超碰人人操| 色婷婷亚洲婷婷| 日本九九网| 五月激情婷婷女| 日逼影音先锋男人资源站| 婷婷丁香18| jiujiujiuwuyuetian| 婷婷五月激情小说| 狠狠夜夜五月丁香| 热热99爱爱| 97香蕉碰碰人妻国产欧美| 久久66er久久| 国内自拍97在线| 99re视频精品| 婷婷色爱| 综合网啪| 国产韩日亚洲美州欧亚综合在线| 五月天激情综合10p| 欧美大香蕉视频| 色屌丝中文字幕| 玖玖九九99| 欧美VA视频| 婷婷六月啪啪| 婷婷五月综合体验看| 色色网站免费在线视频| 伊人超碰在线| 婷婷色婷婷| 色狠狠婷婷| 可以直接看的av网站| 亚洲无码影音| 超碰99在线| 天天爽天天日| 天天碰天天插天天操| 人人97碰| 五月天婷婷伊人| 草草夜夜操| 久久婷婷五月综合| 91九色精品| 久热这里只有精品66| 五月丁香福利| 996热re视频精品视频| 狠狠色综合五月人人| 图片区 小说区 区 亚洲五月 | 日本色99| 四月婷婷五月丁香| 久久天天| 激情五月天综合| 乱女乱妇熟女熟妇综合网站| 天天日日夜夜爽| 婷婷六月综合| 综合视频久久| 99久.| 嫩模aV在线| 91碰碰碰久久久久| 国产97在线日韩亚洲女人被黑人巨大| 2018国产大陆天天弄| 国产精产国品一二三在观看 | 成人AV综合在线| 99少妇精品| 五月天婷综合| 色婷婷综合久久久久| 啪精品| 97性视频| 成年人丁香五月| 九九久久99| 久久久久9| 亚洲五月婷| 中文字幕免费高清电视剧| 26uuu欧美| 伊人激情| 99色人| 性爱五月婷| 色综合视频在线| 久久全色| 色婷婷久久综合| 夜夜人妻五月天| 色天堂A| 婷婷欧美色| 光棍影院日韩精品| 欧洲激情网站| 五月色婷婷综合色| 日本丁香五月| 久久婷婷亚洲| 《丁香激情综合久久伊人久久》影视在线观看 -高清预告手机免费播放 -三妹影院 | 一级黄色尤物综合视频手机在线观看| 4438激情网| 婷婷大乡焦噜噜| 久久久久亚洲AV成人无码电影| 伊人激情影院| 伊人综合网站| 色色综合网。| 久久精品五月天| 五月丁香啪啪啪综合网| AV大香蕉| 婷婷丁香无码专区| 亚洲综合一区二区| 丁香婷婷精品视频| 婷婷五月六月丁香综合| 人人草人人爱| 少妇人妻人伦A片| 99热99| 丁香五月天激情网址| 丁香激激情网| 99色热| 久9精品| 99er这里只有精品视频| 色五月激情五月天| 少妇人妻偷人精品无码视频新浪| 丁香婷婷综合激情五月色,开心五月丁香花综合网,激情综合五月亚洲婷婷,五月天 | 91久久综合亚洲噜噜成人在线| 六月激情婷婷| 9月色婷婷| 欧美大片| 激情婷婷色小说| 天天 青草 丝袜制服 在线| 99精品亚洲| 99热国产| 无码地址| 五月婷婷无码| 亚洲天堂无码| 丁香婷婷六月在线资源观看| 任你躁XXXXX麻豆精品| 97人人超| 五月天天综合| 色婷婷国产精品综合在线观看| 五月丁香日本在线视频观看| 狠狠色噜噜狠狠狠888| 一本色道久久88综合日韩精品| 亚洲五月婷| 成人va视频| 岛国午夜视频| 激情五月天综合| 五月丁香婷婷五月色| 丁香五月婷婷色情综合| 色综合色五月| 9热在线视频精品| 色五月亚洲开心网| 九九九九九九热| 亚洲99在线| 国产真人做爰视频免费| 丁香五月激情视频在线| 亚洲欧洲另类图片| 婷婷精品性性性性性性性| 69精品人人人人| 激情com| 九九99精品视频在线观看| 99热这里都是精品| 色99色| 九九综合色| 九九色综合网| 国产亚洲色婷婷99精品| 欧美日韩成卜| 婷婷综合在线| 超碰色综合| 99久久99九九99九九九| 蜜乳国产网站| av在线不卡播放| 色五婷婷开心缴| 97色永久免费视频| 欧亚色色| 婷婷9月天| 99re这里| 大香蕉久久久久| 777色色色| 伊人狠狠狠综合| 九月丁香欧美综合| 色综合色色| 五月六月激情| 丁香六月色婷婷| 99色爱| 91日日日| 婷婷四色五月| 99九九玖玖| 免费无码毛片一区二区A片| www.婷婷.com| 思思国产99| www91在线| 国产AV一区二区三区日韩| 午夜无码精品色综合久久| 欧美图片丁香五月天| 在线理论片| 国产精品日日躁夜夜躁| www.粉嫩av.com| 日韩AV在线免费| 婷婷九月色| 久热播这里只有精品| 色蜜婷婷| 中文字幕人妻一区二区| av大片在线| 亚洲视频五区| 色色亚洲五月天| 天色综合网站| 激情五月天丁香| 人妻在线观看视频| 五月丁久久| 这里只有精品视频在线| 久久久久亚洲AV成人无码电影| 伊人久久五月天| 日韩成人AV在线| 亚洲无码影音| 天天碰夜夜操| 97在线精品| 久久综合伊人77777蜜臀| 久久草婷婷丁香网站| 五月丁香婷婷99| 色婷婷小说| 五月天色丁香| 99A片| 国产成人va在线| 激情综合网亚洲色图| 色婷婷基地| 国产av影片| 91干在线| 97资源碰碰在线| 九九综合图片网| 久草热久草在线视频| 五月婷婷激情网| 九九热精品在线| 丁香五月伊人| 久久网日本| 99久久激情视频| 综合激情五月丁香| 免费观看的av| 人人肏逼视频在线一区二区| 亚洲AV无码成人电影| 婷婷网五月天| 婷婷色五月91啪啪| 激情视频综合| www.99在线| 五月天婷婷操逼视频| 影音先锋 一区| 五月天婷婷基地| 欧美久久婷婷| 熟女激情网| 色小说婷婷五月天天天| 99愛国产| 亚洲99综合| 9久久精品| 五月花婷婷| 日本V在线观看不卡视频网站| 超碰婷婷五月| 色色五月婷婷久久| 日日夜夜噜噜爽爽| 日本激情91| 丁香六月啪| 91碰九色| 深爱五月婷婷开心中文字幕| 欧美激情-区二区三区| 中文AV网站| 五月婷婷啪啪| 天天操天天插天天射| 人妻九九九九| 久久人妻视步| 99性视频| av第一二区| 狠狠艹狠狠艹| 五月天婷婷色综合| 久婷自拍视频| 伦99热| 久久综合首页| 91男人资源站| 狠狠干总合| 久久狼人天堂| 91jiuseshunv| 婷婷五月天免费| 欧日韩成人| 2050人人操免费工开爱 | 俺去也综合| 欧美婷婷九月| 五月天婷婷爱| 五月久久丁香| 日日肏天天操| AV在线不卡播放| 伊人久久大香蕉网| 狠狠色噜噜狠狠狠777奇米| 五月丁香婷中文| 婷婷99丁香| 婷婷五月天激情偷拍| 五月天天爽| 日韩啪啪网| 爱操天堂| 婷婷激情五月天激情在线| 五月丁六月香| 无人区码一码二码三码医生系列| 综合色网站| 色五月视频无码播放| 丁香五月天婷婷中文字幕| 婷婷色在线| 婷婷激情四射五月天| av婷婷丁香 六月| 精品99在线| 99ri网站在线观看| 91久久婷婷| 五月天婷婷在线观看| 开心五月婷婷| 丁香婷婷黄网站| 亚洲天堂aaa| 熟妇内谢69XXXXXA片| 五月婷婷天堂| 天天久| 久99久视频精品| 玖玖综合色| 五月丁香六月在线| 久久亭亭电影| 思思久久99热只有频精品66| 欧美丰满熟妇BBB久久久| 婷婷伊人| 五月丁香婷婷啪啪| 久久jiuwww| 亚洲五月天婷婷在线| 激情五月天久久| 狠狠夜夜五月丁香| 一起草Av| 丁香五月天婷婷91| 这里只有久久精99| 欧美婷婷综合| 婷婷激情丁五月| 少妇高潮呻吟A片免费看软件| 久久最新色色色| 五月婷婷丁香综合| 五月激情视频| 天天激情站| 97精品欧美91久久久久久久| 噜噜操操| 丁香五月色| 狠狠综合久久| 丁香五月六月久久综合 | 五月丁香在线| 99九九视屏| 亚洲熟妇AV乱码在线观看| 亚洲综合色丁香五月天| 亚洲日比视频| 9久热这里只有精品| 五月天久久小说| 99热这里只有精品16| 婷婷婷久久| 亚洲色五月天| 在线,国产,色,热视频| 五月婷婷久久综合| 这里只有精品视频一区| 丁香五月www| 99热精品观看| www久久99com| 色婷婷呢狠禁久禁| 久热这里只有精品66| 草了bav视频在线观看| 99综合五月免费视频色婷婷| 色欲色香综合网| 超级黄色片| www.minyis.com【JT】实力收量可预付QQ2101460746 | 色www99| 天天爽天天干| 人人干人人干骚美女| 99热久草| 婷婷五月丁香久久| 国产成人一区二区三区在线观看| 亚洲色激情| 97人人干| 狠狠色婷婷丁香五月| 婷婷五月天综合久久| www.99热| 97操在线| 狠狠操狠狠爱| 夜夜做天天爽| 久久五月天视频| 少妇高潮呻吟A片免费看软件| 婷婷瑟瑟五月天| 超碰亚洲天堂| 五月天天综合网色婷婷| 婷婷综合网| 久色国产| 婷婷激情五月天综合| 操97在线观看| 五月综合无码| 丁香五月天综合| www.99热视频在线观看| 九九热在线99| 97自拍视频网| 九月激情婷婷丁香| 婷婷五月天激情四射| 久热播这里只有精品| 久热综合| 色婷婷91| 婷婷六月丁香五月图区| 天天日夜夜拍| 9精品在线| 欧美色色色色色色| 开心激情播播五月天| 色噜噜狠狠色综合无码久久欧美| 九热...av| 色婷婷四虎| 丰满少妇乱A片无码| 久久超级碰碰| 五月婷婷免费看| 丁香成人综合| 欧美97色| 丁香五月激情综合婷综| 国产一级黄色影片,| www.夜夜| 欧美槡BBBB槡BBB少妇| 婷婷综合色| 综合网亚洲| 白天AV月月| 丁香色六月婷婷| 人人色人人摸人人看| 99在线资源| 一级黄色操B| 国产人人操| 色综合激情图区| 超碰日韩成人| 精品九九九久| 婷婷日韩| 青草青草视频2免费观看| 337p大胆噜噜噜噜噜91Av| 色天堂A| 国精产品一区一区三区有限公司杨 | 五月综合激情啪啪啪啪啪| 色噜噜狠狠色综无码久久合欧美| 777影视理论片大全在线观看| 久热久| 疯狂做受XXXX高潮A片动画| 色婷五月天| 一级片操逼视频| 小香蕉av| 亚洲图色五月天| 99视频在线观看视频| 99久高清视频| 成人婷婷| 九九视频免费| 色婷婷丁香中文在线播放| 凹凸操Av| 色99视频| 久机视频这只有精品| 丁香五月偷拍| 婷婷五月丁香青青草在线| 婷婷综合伊人| 色婷婷a| 色色精品色| 五月丁香婷婷激情久久| 色五月丁香五月| 婷婷九月综合| 欧美成人精品A片免费一区99| 九九热9| 九九色区| 岛国资源网| 天天精品视频免费观看| 婷婷色网站| 专区无日本视频高清8| 在线一起草av| 97碰在线视频| 五月丁香六月婷婷婷婷| 色狠狠婷婷| 热久精品| 丁香五月天激情四射网络不好| 色婷婷狠狠久久YY| 亚洲激情色色| 九九自拍网| 久久久久亚洲AV综合| 一月婷婷色色| 国产精品色一哟哟| 伊人网碰碰| 高清资源站日A美A欧亚…| 无码99| 九月av在线| 丁香五月日啪| 久久综合中文| 国产中文字幕在线视频免费观看| 婷婷色在线观看| 天天舔日日肏夜夜爽| 九九99久久| 色色色综合| 九月色婷婷| 大香蕉av在线| 91综合在线观看| 五月情综合| 五月婷婷深深爱| 青草青草久9视频在线视频| 精品久色| 26uuu欧美| 婷婷五月天成人视频| 久久 中文 日本| www。狠狠干。com| 婷婷激情人妻| 韩国不卡AC视频| 日本婷婷网| 色久综合| 亚洲成人网站在线| 激情五月丁香综合网站| 精品久久久中文字幕大豆网推荐理由| 狠狠香婷婷五月| 亚洲av网站在线观看| 99视频在线观看视频| 5月婷婷激情网| 日本性视频| 色色色在线免费视频| 欧美婷婷综合| 激情五月天久久丁香| 六月丁香啪啪啪| 97人妻碰碰碰久久| 大香蕉欧美在线| 丁香五月婷婷大香蕉| 日韩操| 亚洲无码 图片区| 99热最新精品| 青青青在线视频国产| 婷婷伊人激情婷婷| 国产69久久久欧美黑人A片| 欧美色骚婷婷五月天| A片女女女女女女BBBB| 色情五月丁香婷婷网| 色五月首页| 日本精品。999| www.色五月| 99福利视频| 北条麻妃伊人 | www.色婷婷。com| www.丁香六月婷婷久久天堂影院.con| 激情深爱五月| 永久免费一区二区三区| 91超级碰碰| 色亚洲色宗合| 日本97在线看片| 色婷婷久综合久久一本国产AV| 激情婷婷22月间| 久久婷婷丁香| 99在线观看精彩视频| 狠狠爱深色婷婷综合| 综合九九| 色婷婷免费观看| 婷婷综合五月| 亚洲性爱区无码区| 免费观看日韩成人av| 婷婷五月综合亚洲| 中文字幕在线免费| 日本一級黃色一級片| 操一操插一插| 日韩狠狠色| 国产做爰视频免费播放| 久久色五月天综合网| 日韩高清成人| 桃色成人网| 九九激情| 天天干天天日日| 五月叮香啪| 免费观看的av| 婷婷激情图片| 婷婷五月天最新综合你懂的 | 99熟女视频| 青青草深爱激情网| 成人网站免费在线播放| 99re热视频这里只精品| 五月激情婷婷国产精品久久久久久| 婷婷色吧| 少妇性按摩无码中文A片 | 99re在线观看| 91jiuseshunv| 狠狠操狠狠| 九九re精品视频在线观看 | 99碰视频| 男女啪啪做爰高潮无遮挡| 播播网色播播| 翔田千里aV中文字幕| 碰碰女| 2005天天干天天1| 国产精品日本一区二区在线播放| 中文字幕不卡+婷婷五月| 天天肏天天爽夜夜爽| VA日本视频| 台湾无码A片一区二区| 丁香五月激情啪啪啪| 国产肥白大熟妇BBBB视频| 久热69| 天天综合网网欲色| 五月天无码视屏播放| 91碰九色| www.99操| 激情五月丁香五月综合| 99久在线| 婷婷五月天情色| 天天激情| 五月天综合图片| 色婷婷五月天综合网| 色9色| 激情小说五月丁香在线视频观看视频| 97精品综合| 超碰99在线观看| 国产.亚洲.欧洲视频在线| 4438成人电影| 色婷婷五月天成人网| ady狠狠入| 精品操逼一区二区| 丁香五月激情五月| 婷婷.com| WWW.五月com| 丁香网五月天| 免费91久久精品| www.wuyuetian啪啪| 双性美人被调教到喷水A片| 精品夜夜澡人妻无码AV| 亚洲成人影视在线| ZpRSw| 丁香五夜激情四射夜夜夜| 超碰熟女农村在线69| 中文字幕乱码亚洲精品一区| 六月婷婷毛片| 伊人狼人干| 大香蕉人人人| 99er这里只有精品| 久久人妻在线| 色欲五月天| 婷婷五月免费在线| 婷婷六月天亚州| 亚洲综合婷婷五月天| 日日夜夜爽| 五月天激情视频| 婷婷综合网站| 午夜成人片400| 97婷婷五月丁香| 五月丁香啪综合| 性爱动图国产麻豆一区二区三区| 深爱五月亚洲| www,com,五月色色| 成人αV视频免费观看| 爱射综合| 99热热热99精品丁香| 日本操碰碰| 丁香五月伊人| 天天插综合| 人人舔天天| 亚州操操| 日本婷婷在线| 色激情五月| 丁香婷婷五月人体| 九九激情视频| 色99视| 久久久婷婷五月天| 三十熟女| 无遮羞AV| 无遮挡国产高潮视频免费观看| 97人人干人人操| 丁香婷婷五月| 天天插天天射| 操碰97| 丁香九月婷婷| 国产精品人成A片一区二区| 极品人妻VIDEOSSS人妻| 狠狠穞A片一區二區三區| 日韩人妻AV在线| 91色综合网| 激情开心五月亚洲| 99国产精品白浆在线观看免费| 狼人婷婷久久| 五月天婷婷激情综合| 国产精品天天狠天天看| 久久女婷| 任你日视频| 亚洲超碰中文字幕| 伊人六月无码视频| 五月婷婷六月色| 成人短视频免费观看| 婷婷久久免费看| 五月婷婷六月情| 国产成人精品一区二区三区视频| 热的国产99热| 超碰超碰在线| 一区二区三区XXXXXX| 五月丁香六月婷综合成人综合| 婷婷色综合| 色婷操逼| 九九色综合网| 91精品又长又大又粗又爽又猛| 可以免费看AV网站| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 碰碰操91| 久久精品女人天堂AAA| 偷偷操99| 丁香五月天天哦| pacopacomama 070722_670 素人奥様初撮りドキュメント 103 大久保純子 | A色色| 色情五月天A片| 久久九九蜜| 五月天综合色| 婷婷五月天精品| 激情五月婷婷五月| 做爰丰满少妇1313| 丁香五月婷婷综合激情啪啪啪啪啪啪啪| 懂色av蜜臀av粉嫩av永陈冠希| 久久婷婷五月综合| 欧美性生交xXxX久久久| www.99热这里精品| 思恩热国产视频右线观看| 性色播| 热99精品视频| 黄色三级日本| 国产精品久久久久久久久久| 亚洲久久天堂| 五月婷啪| 久久五月天精品视频| 久色国产| 色五月大香蕉| 超碰免费成人网站| 精品99在线看| tingting五月天亚洲| 五月天婷婷日日爱| 婷婷五月色情天| 五月天色丁香| 丁香五月性| 久热婷婷在线视频| 操人妻90p| 久久人妻久久| 91中文在线| 亚洲国产网址| 人人爽在线视频综合网| 日韩三级高清无码| 最近韩国日本免费高清观看| 丁香久月| 天天拍久久| 久久婷婷网| 9热超碰| 激情五月天色色| 色婷婷丁香五月综合| 五月婷婷影| 五月美女婷婷风骚| 99成人网一区| 天天干电影| 国产肥白大熟妇BBBB视频| 啪啪 综合网| 婷婷五月天伊人网在线观看视频| 激情婷婷久久| 丁香99| 香蕉婷婷| 综合图片色色| 猫咪伊人AV| 欧美天天爽| 婷婷五月丁香综合激情| 99热人人艹| 国产在线中文字幕| 高清无码视频网址| 玖玖婷婷色欲| 天天爽成人综合网站| 少妇搡BBBB搡BBB搡毛茸茸 | 激情综合色五月丁香| 99综合网| 超碰男人色| 玖玖综合色区在线观看| 婷婷成人综合免费视频| 99久在线观看| 丁香五月天激情四射网| 久香草视频在线观看| 一起草Av| 久久综合色情网站| 五月丁香六月色| 人人看人人摸人人| AA片在线观看视频在线播放| 五月天色播网| www.色婷婷| 婷婷婷久久久| 婷婷五月天综合在线| 色婷婷中文| 激情婷婷丁香色五月综合| 超碰久热| 无码人妻激情| 免费国产视频| 激情综合色婷婷啪啪六月天| 婷婷五月色情天| 9热超碰| 婷婷五月天人妻| 日本欧美成人片AAAA| 九九热99免费视频| 五月婷婷啪啪综合网| 特黄三级又爽又粗又大| 区区欧美你爱| 中文字幕婷婷9月天| 多精窝99在线视频| 婷婷久久五月| 丁香婷婷综合激情五月色,开心五月丁香花综合网,激情综合五月亚洲婷婷,五月天 | 丁香婷婷激情五月色| 婷婷狠狠操| 可以免费观看的av网址| 五月天.com| 五月天婷婷色| 九月婷婷久久| 久久一热免费视频| 五月丁香六月| 热热久久精品视频| 国产成人片| 激情婷婷综合| 精品久久99| 67194中文字幕| 99热这里只有精品13| 婷婷免费无马| 丁香影院五月综合| 99热免| 强伦轩人妻一区二区电影| 丁香五月六月久久综合| aaa9区免费在线观看| 久久久国产精品黄毛片| 色色激情网| 日日操天天| WWW丁香五月| 97久人人| 91干99| 麻豆AV一区二区三区| 超碰男人色| 欧美色五月天| 欧洲亚洲免费视频区| 另类激情五| 狠狠色噜噜狠狠亚洲A∨| 性爱久久| 任你草| 月婷婷婷婷五月| 狠狠五月天婷婷| 九九99九九99偷拍视频免费看| 色五月天婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷 | 久久婷婷五月综合色欧美| 天天日天天干天天插天天射| 99久久高清视频| 亚洲男女激情| 激情婷婷五六月天| 午夜天堂啪啪| 色色九九五月天| 操碰99在线视频观看| 五月婷婷五月| 激情综合五月天| 夜夜操激情| 色视五月天婷婷| 大香蕉啪啪啪| 色99热| 五月婷婷色| 亚洲性爱干干| 色亭亭丁香五月天| 婷婷五月天Av| 婷婷久久午夜网| 91人妻人人操| 能直接看的av网站| 婷婷五月丁香综合| 日日操日日撸| 久色中文| 五月丁香最新| 丁香五月综合网亚洲综合欧美狠狠| 婷色五月| 婷综合| 五月天丁香成人| 影音先锋91资源站| 丁香五月天大香蕉啪啪| 99热99艹在线观看| 91丨九色丨熟女高潮| 婷婷射综合| 色婷五月| 欧美婷婷五月天综合| 天天天天天操| 丁香五月激情综合在线观看| 中文字幕av在线| 亚洲六月色婷婷| 日韩在线一级| 五月婷婷激情日本| 99热在线中出| 波多婷婷久久| yw国产AV| 国精产品一区一区三区免费视频| 婷婷五月丁香五月| 激情五月天婷婷| 色婷婷成人做爰A片免费看网站| 99热国内精品| 综合AV在线| 99热主页日本| 激情婷婷色色| 婷婷亚洲影院| 九九视频在线观看| 97香蕉碰碰人妻国产欧美| 亚洲热视频| 夜夜撸日日操| 99久久网站| 色婷婷小说| 99精品在线播放| 日本欧美成人片AAAA| 婷婷亚洲综合| 噼里啪啦完整版中文在线观看| 五月丁香激情综合| 亚洲视频在线观看| 久久婷婷六月综合国际| 日韩人人操| 人人看人人97| 婷婷激情视频| 99热最新| 五月激情丁香六月狠狠干| 99热这是里只有精品| 色色色色色色97| WWW.桔色成人.COM| 99热99热不卡| 国产美女视频久| 在线视频你懂得| 色色射| 另类激情综合| 97亚洲视频在线| 五月婷婷色欲| 狠狠爱深色婷婷综合| 国产av第一专区| 碰人人97| 啪啪 综合网| 九九精品在线视频观看| 这里只有精品热| 五月天成人在线播放丁香| 激情五月天婷婷丁香| 五月婷婷99热| 久久婷婷久久| 久久久免费精彩视频| 这里只有精品在线视频精品| 内射人妻视频国内| 亚洲AV无码电影| www.久久久久久| 综合色播| 婷婷六月插屄激情| 人人操人av| 殴美综合激情五月天免费视频| 亚洲色五月天| 丁香五月天堂婷婷| 九九热婷婷| 综合天天综合| 天天成人综合视频| 六月激情久久| 99re热视频这里只精品| 免费无码毛片一区二区A片| 一片AV片免费播放| 91avse| 人人舔人人色人人高潮| 深爱激情五月婷婷| site:pnnrt.com| 狠狠操狠狠操| 国产av一区二区三区| 光棍影院日韩精品| 亚洲av综合网| 色婷激情网| www.日本91| 五月天婷婷激情| 97操女视频| 激情宗合 激情宗合| 免费国产VA国产免费| www.五月天社区| 五月天大香蕉| 婷婷五月激情在线| 九九综合久久| 国产日批视频| 最新va在线播放| 九月丁香| 人人操91色| 欧美群妇大交乱婬网| 2025年最新亚洲在线欧美| www.91色| ztEJj| 天天久久狠狠色综合| 精品九九视频| 五月天天久久香| 婷婷五月影院| WWW免费视频碰碰碰碰| 26uuu国产精品| 五月激情综合网| 久热99视频在线观看| 欧洲毛片基地c区| 99思思热只有在这里看| 色中色综合| 六月丁香开心婷婷欧美| 在线资源av-超碰中文在线-成人AV| 六月色婷婷欧美| 九九性爱网| 内射在线CHINESE| 亚洲色婷婷五月天| 高清无码一区二区三区四区| 色久九| 99久久婷婷国产综合精品电影| 欧美内射AA| 亚洲成人在线五月天| 99综合视频一体| 久久超视频| 青青五月天婷婷| 五月丁香精品| 中文字幕不卡视频| 天天草天天爱| 丁香六月久久| 色婷婷久久7777| 五月婷婷综合网在线播放| 香蕉狠狠爱视频| 日本久久激情| 狠狠做六月爱婷婷综合aⅴ| 久久精彩免费视频| 五月天啪啪网| 丁香五月天激情婷婷丁香六月 | 91色欲综合| 亚洲色婷婷99一9|| 久久9精品| 黄色中文字目| 免费国产VA国产免费| 丁香婷婷六月天| 日本A片一区| 婷婷性爱无码视频| 丁香五月婷婷在线| 人人干人人操外国| 日逼免费视频| 六月天婷婷| 亚洲中文字幕AV| 色五月综合资源推荐| 99热午夜精品| 美女要搞搞天天搞搞搞网站| 91蜜桃婷婷狠狠久久综合9色| 99日本视频| 26uuu另类亚洲欧美日本一| 国产AV一区二区三区最新精品| 精品久久99码| 五月婷激情影院| 丁香五月www| 亚洲九九99精品视频在线播放| 九月丁香| 99热18| www.maotanji.com| 五月丁香视频色色| 毛片色五月| 久久久久9久无码视频| 婷婷五月激情片| av大香蕉| 最新热中文字幕| 国产无套精品一区二区| 中文精品在| 五月天激情四射网站| 色婷婷很很十八禁| 色高清无码视频| 日韩少妇内射免费播放| 婷婷五月天黄色| 综合视频久久| 婷婷狠狠97| 日本五月天激情| 色综合久久8| 久久精品亚洲一级牲爱综合| 无码免费人妻A片AAA毛片西瓜| 久久杏爱视频| 狠狠干综合网| 丁香视频| 99热免费| 五月婷婷综合社区| 五月天婷婷操逼视频| 在线日韩av| 99热这里精品| 亚洲AV永久无码影院黑人| 婷婷五月丁香基地| 人操人| 能直接看的av网站| 碰碰碰97免费精彩视频| 99精品视频免费| 色九九丁香九月色九九色| 色五月中文网| 97极品在线| 婷婷五月天免费视频| 免费超碰在线| 日日噜噜夜夜狠狠久久丁香五月| 丁香五月天婷婷91| 琪琪色五月天| 国产67194| 九热视频| 色五月婷婷狠狠撸| 图片区 小说区 区 亚洲五月 | 婷婷丁香五月色| 五月天久久小说| 女高怪谈在线观看| 开心婷婷五月综合| 日本颜色视频人人爱| av无码电影| 性高潮久久久久久-九九九九九九九九九九热-成人AV | 婷婷久久五月| 国产精品久久久久久妇女6080| er99免费视频在线| 91久久国产自产拍夜夜91久久精品文字>91麻豆精品国产 | 九月色婷婷综合| 五月丁香综合中文| 五月天激情国产综合婷婷婷| 成人网站免费在线播放| 五月婷婷六月丁香| 思思热久在线观看视频| 中文字幕无码人妻少妇免费视频| 亚洲AV无码久久精品色欲| www.99精品日操伊人乱碰在线| 九九综合久久| 99久久亚洲国产| 丁香婷婷久久 | 538在线精品| 五月婷婷人妻| 黑人无码一区| 26uuu欧美| 激情综合网亚洲色图| 狠狠色狠狠色综合日日91| 亚韩在线视频| 五月天婷五月天综合网小说首页-五月天激激婷婷大综合,婷婷亚洲综合五月天小说 | 狠狠干伊人| 图片区 小说区 区 亚洲五月| 丁香五月狠狠综合欧美| 一本色道久久88加勒比| www.俺去也com| 99re热视频这里只精品| 精品无码99| 99综合入口| 激情五月天啪啪| 秋霞学生妹一二级| 日韩精品一区二区三区,四区,五区视频 | 欧美婷| 成人免费视频一区| 婷婷五月综合在线| 国产婷婷五月中文字幕高清| 亚洲成人电影在线免费观看| 日韩欧美成人片| 丁香五月在线视频| 大香蕉网 久久| aa久久| 无码中文一区二区三区| 丁香婷婷老司机久操| 91久久久久久久久久久| 手机激情网| 亚洲秘 无码一区二区三区妃光/1| 五月开心激情| 丁香六月亚洲综合| 97人人搞| 亚洲婷婷五月天| 五月婷婷色播视频| 亚洲成人网址在线观看| 久久五月激情| 亚洲第精品| 欧洲一区二区| 超碰日韩成人| 日本久久婷| 五月婷婷丁香色吧网| 日本在线视频看se99| 综合网色| 天天操综合网站| 五月丁婷香| www.刺激色网站www.| 爱射综合| 婷婷金品综合视频| 五月天婷婷六月激情网| 去色色五月天| 亚洲中文字幕在线观看| 丁香激情网| 成年人丁香五月| 激情五月天在线免费美女视频| 婷婷激情社区| 青青草日本亚洲| 开心五月深爱五月婷| 婷婷丁香成人网址| 五月精品免费XXX| 五月激激激情综合网| 婷婷开心激情五月激情网| 人妻操在线看| 婷婷五月天激情小说网站| 天天干天天干天天干天天干天天| 婷婷五月天人妻| 丁香五月天啪啪激情综和网| 日韩av干| 婷婷五月天伊人在线| 亚洲VA欧美VA| 亚洲精品视频在线播放| 99 福利 导航| 九九视频在线观看视频6| 99∨VTV| 性爱综合网| 久久人人九九| 日本色视| 97碰在线视频| 蜜桃五月天| 强伦轩人妻一区二区电影| 色色a| 婷婷亚洲五月| 五月中旬婷婷丁香六| 99五月丁香丁| 欧美精产国品一二三区| 99视频在线看| 国产69精品久久久久999小说| 久久九九爽| 国语精品探花| 99热99思午夜精品| 爽tv | 日韩精品无码一区二区| 九九黄色网| 8090在线影视少妇| 嫩草AV久久伊人妇女超级A | 五月天激情小说婷婷| 六月激情丁香一道本7777| 成人网丁香五月| 五月婷婷丁香五月| 婷婷黄色网| 伊人9在线| 69婷婷丁香午夜| 丁香六月色婷婷| 五月婷婷六月综合| 天天色天天爱天天爽| 九九这里只这里只有精品| 久草天堂| 日本美女上人| 五月丁香久久色| 另类丁香五月天区图| 婷婷综合视频| 亚洲综合激情五月久久| 丁香五月色欲| 五月天婷婷色播在线网| 五月丁香色婷婷婷基地| www。五月天激情| 超碰中文字幕在线| 亚洲天堂制| 被男人添B超爽视频| 久久婷婷五月丁香网| 五月色丁香| 五月天婷婷乱论小说| 激情五月天色婷婷| 五月天婷婷导航| 国产一级婬片毛片| 五月天亚洲最大成人| 色色亚洲无码| 色婷婷电影| 五月婷在线观看| 久热爱大香蕉在线蜜臀悦色 | 99re8热精品免费视频| 丁香五月婷婷天激情| 日本一級黃色一級片| 5月丁香综合图区|