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

ARTICLE DETAIL

資訊詳情

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

移動(dòng)機(jī)器人路徑規(guī)劃:A*、RRT與DWA算法原理及融合實(shí)戰(zhàn)

移動(dòng)機(jī)器人路徑規(guī)劃:A*、RRT與DWA算法原理及融合實(shí)戰(zhàn) 一個(gè)移動(dòng)機(jī)器人要從A點(diǎn)走到B點(diǎn)中途有人走過來地面上多了臨時(shí)堆放的紙箱你要是沒給機(jī)器人配好路徑規(guī)劃它就只能面臨兩個(gè)結(jié)局要么直愣愣撞上去要么停在原地死等直到障礙自己消失。路徑規(guī)劃算法要解決的就是這個(gè)繞不開的問題而在這個(gè)領(lǐng)域里A*、RRT、DWA 是三個(gè)繞不開的名字A* 負(fù)責(zé)在地圖上找出一條不撞墻的宏觀路線RRT 負(fù)責(zé)在沒有完整地圖時(shí)也能探出一條可達(dá)的路DWA 負(fù)責(zé)盯著眼前這一兩秒讓底盤既避障、又走得不毛躁。我是做移動(dòng)機(jī)器人導(dǎo)航的這幾年和這三個(gè)算法打了太多交道踩過的坑能裝滿一抽屜。這篇文章想做的只有一件事把它們的原理拆碎講透各自擅長什么、死穴在哪再把“A* 全局規(guī)劃 DWA 局部避障”這個(gè)最常見的融合方案怎么落地、怎么調(diào)參、怎么排故從頭到尾給你捋一遍。剛接觸自主導(dǎo)航的人可以把它當(dāng)成一張入門地圖已經(jīng)在調(diào)導(dǎo)航參數(shù)的人可以直接跳到后面的速查表和排故清單。1. 三個(gè)算法先站穩(wěn)全局、采樣、局部各管哪一段1.1 A* 是地圖上的“路線規(guī)劃師”A* 不是某個(gè)機(jī)器人專用的算法它是圖搜索家族的明星也是我做全局規(guī)劃時(shí)最先上手的方案。你手里有一張柵格地圖每個(gè)格子要么可走、要么有障礙機(jī)器人要從起點(diǎn)格挪到終點(diǎn)格A* 做的就是告訴你沿哪一串格子走代價(jià)最小。它的思路樸素但好用維護(hù)兩個(gè)集合open list 和 close list。每輪從 open list 里挑一個(gè) f 值最小的格子擴(kuò)展f g h。g 是從起點(diǎn)走到當(dāng)前格已經(jīng)花掉的真實(shí)代價(jià)h 是從當(dāng)前格到終點(diǎn)的一個(gè)樂觀估計(jì)代價(jià)常用歐幾里得距離。每擴(kuò)展一個(gè)格子就把它的鄰居丟進(jìn) open list同時(shí)把父節(jié)點(diǎn)指向當(dāng)前格子循環(huán)直到終點(diǎn)被擴(kuò)展。一句話總結(jié)它是從所有候選路徑里優(yōu)先探索“看起來最有希望”的那幾條。類比一下。你在陌生城市趕去一家飯店手里有地圖。你不會(huì)把所有路口都走一遍而是先估算哪些路口方向離飯店最近優(yōu)先走過去。A* 的 h 就是這個(gè)估算它能把搜索方向強(qiáng)烈地拽向終點(diǎn)所以比 Dijkstra 那種無差別掃描通常要快一個(gè)量級。補(bǔ)充一些實(shí)用考慮。網(wǎng)格鄰居用四鄰居還是八鄰居直接決定路徑是只能橫豎走還是可以斜穿。用八鄰居時(shí)斜向移動(dòng)的代價(jià)要按 sqrt(2) 倍計(jì)算否則地圖上會(huì)出現(xiàn)“斜著走和橫著走一樣快”的錯(cuò)覺路徑會(huì)失真。另一個(gè)常被忽略的點(diǎn)是啟發(fā)式函數(shù)的權(quán)重如果地圖很大可以給 h 乘一個(gè)大于 1 的權(quán)重來提速這叫加權(quán) A*。我試過把權(quán)重從 1.0 拉到 1.5 左右在大地圖上規(guī)劃耗時(shí)能明顯下降路徑長度只多出百分之幾。但權(quán)重太大就會(huì)犧牲最優(yōu)性甚至看起來像“貪心”所以別一味求快。1.2 RRT 是“摸著石頭過河”的探險(xiǎn)家RRT 和 A* 長相完全不同它不依賴柵格也不需要先建一張完整的環(huán)境圖。它的工作方式是從起點(diǎn)長一棵隨機(jī)樹隨機(jī)撒一個(gè)點(diǎn)在樹上找離它最近的節(jié)點(diǎn)沿這個(gè)方向按固定步長生長出一個(gè)新節(jié)點(diǎn)如果新節(jié)點(diǎn)和父節(jié)點(diǎn)之間的線段沒有碰到障礙就把它掛上樹。這個(gè)循環(huán)重復(fù)幾百上千次樹會(huì)慢慢長滿整個(gè)搜索空間等某個(gè)新節(jié)點(diǎn)距離終點(diǎn)足夠近就順著父節(jié)點(diǎn)回溯出一條完整路徑。這個(gè)機(jī)制讓它天然適合 A* 難以建模的問題。比如機(jī)械臂在關(guān)節(jié)空間里找運(yùn)動(dòng)軌跡每個(gè)關(guān)節(jié)角度都是維度柵格化代價(jià)極高再比如地圖外沿有大量未知區(qū)域建圖本身就很勉強(qiáng)。這類問題里RRT 只需要判斷“兩點(diǎn)之間能不能走”不要求全局地圖完整往往是更現(xiàn)實(shí)的選擇。但隨機(jī)性是把雙刃劍。同一張地圖跑十次RRT 給出的路徑每次都完全不一樣而且很容易帶一堆無用拐角路徑長度也可能明顯差于最優(yōu)解。工程上很少直接用裸 RRT一般會(huì)用它的兩個(gè)改進(jìn)版本。RRT* 在每次插入新節(jié)點(diǎn)后會(huì)把附近節(jié)點(diǎn)的父指針重新優(yōu)化讓解漸近收斂到最優(yōu)雙向 RRT 則從起點(diǎn)和終點(diǎn)同時(shí)向中間長樹遇到狹窄通道時(shí)成功率提升明顯。從我實(shí)際調(diào)試的經(jīng)驗(yàn)看如果你急著讓一個(gè)粗糙但能用的導(dǎo)航系統(tǒng)跑起來雙向 RRT 加簡單路徑裁剪性價(jià)比其實(shí)很高。1.3 DWA 盯著“下一秒怎么走”DWA 的視角和上面兩個(gè)完全不同。A* 和 RRT 都在回答“從全局看走哪條路”DWA 則在回答“下一個(gè)控制周期底盤該給多大線速度和角速度”。它不評估遠(yuǎn)方只看眼前一小段。算法流程是這樣的根據(jù)當(dāng)前速度、底盤最大加速度、控制周期算出一個(gè)下一周期可行的速度組合窗口對窗口里的每一組速度按恒定速度向前模擬一小段軌跡然后給每條軌跡打分主要看它會(huì)不會(huì)撞障礙、末端朝向是不是趨近目標(biāo)、速度夠不夠快最后選得分最高的速度組合發(fā)給電機(jī)。每個(gè)控制周期都重新算一遍因此對動(dòng)態(tài)障礙物的反應(yīng)很快這也是它成為局部規(guī)劃主力的原因。DWA 的“動(dòng)態(tài)窗口”這四個(gè)字指的就是每步約束出來的可行速度集合。這個(gè)集合不是憑空來的而是由當(dāng)前運(yùn)動(dòng)狀態(tài)和機(jī)器人物理極限共同決定的。明白了這一點(diǎn)就明白 DWA 為什么會(huì)出那些經(jīng)典毛病只看腳下路徑會(huì)陷入局部最優(yōu)目標(biāo)太遠(yuǎn)時(shí)容易對著墻反復(fù)試探。這也是為什么生產(chǎn)級方案幾乎不會(huì)單獨(dú)用 DWA而是把它掛在全局路徑后面。1.4 選型參考什么場景用誰直接把三種算法放進(jìn)應(yīng)用場景里對比場景特征推薦組合原因地圖完整、環(huán)境基本靜止A* DWAA* 能給出最短且穩(wěn)定的全局路線DWA 負(fù)責(zé)沿途避障地圖未知或頻繁變化雙向 RRT DWA不依賴全局精確柵格能快速摸出可達(dá)路徑人流多、動(dòng)態(tài)障礙密集A* 強(qiáng)化局部規(guī)劃全局路線讓機(jī)器人不繞遠(yuǎn)局部層要留足反應(yīng)空間機(jī)械臂等關(guān)節(jié)空間規(guī)劃RRT/RRT*高維空間難以柵格化采樣法幾乎是唯一實(shí)用選項(xiàng)選型不是比誰更高級而是看環(huán)境缺什么信息、底盤缺什么約束。對絕大多數(shù)輪式移動(dòng)機(jī)器人來說第一行“A* DWA”就是最穩(wěn)的起點(diǎn)。先把它跑通再談別的這套組合也是后面要展開的融合主線。2. A* 和 RRT 的全局規(guī)劃實(shí)戰(zhàn)原理與摳參數(shù)2.1 A* 的代價(jià)函數(shù)怎么寫最穩(wěn)直接給你一段可以反復(fù)用的偽代碼骨架# A* 主循環(huán)偽代碼 open_list [start] closed_list [] while open_list: current open_min_f(open_list) # 每次取 f 最小的節(jié)點(diǎn) if current goal: return reconstruct_path(current) open_list.remove(current) closed_list.append(current) for neighbor in get_neighbors(current): if neighbor in closed_list: continue tentative_g current.g distance(current, neighbor) if tentative_g neighbor.g or neighbor not in open_list: neighbor.g tentative_g neighbor.h heuristic(neighbor, goal) neighbor.parent current open_list.add(neighbor)對有經(jīng)驗(yàn)的讀者來說這段代碼太“標(biāo)準(zhǔn)”了但標(biāo)準(zhǔn)正好說明核心邏輯簡單。真正影響效果的是后面三件容易被忽略的事。啟發(fā)式函數(shù)選型八鄰居網(wǎng)格里用歐幾里得距離是自然選擇曼哈頓距離只能用在四鄰居場景否則會(huì)嚴(yán)重高估移動(dòng)代價(jià)。h 權(quán)重大于 1 時(shí)規(guī)劃更快但結(jié)果次優(yōu)我一般在大地圖上把權(quán)重壓在 1.2~1.5 之間。open list 的實(shí)現(xiàn)方式節(jié)點(diǎn)很多時(shí)線性掃描取最小值會(huì)明顯變慢。工程上建議用二叉堆數(shù)據(jù)量大再考慮更復(fù)雜的數(shù)據(jù)結(jié)構(gòu)。我見過有人拿著基礎(chǔ)實(shí)現(xiàn)處理 500×500 的地圖一幀規(guī)劃卡了 300 多毫秒換成堆之后降到十幾毫秒這是純數(shù)據(jù)結(jié)構(gòu)的收益不是算法本身變高級了。閉合檢查也要留意neighbor 同時(shí)由多條路徑到達(dá)時(shí)要正確比較并更新 g否則路徑可能在角落反復(fù)橫跳。細(xì)節(jié)雖小但出問題時(shí)會(huì)表現(xiàn)為地圖上出現(xiàn)“同一點(diǎn)被反復(fù)選中”的卡頓排查起來容易懷疑人生。2.2 柵格分辨率、膨脹半徑和路徑毛刺實(shí)際導(dǎo)航中A* 的問題通常不在搜索算法本身而在“地圖喂得對不對”。一個(gè)常見組合是地圖分辨率 0.05 米機(jī)器人半徑 0.3 米膨脹半徑設(shè) 0.35 米。這個(gè)配置下A* 找出來的路徑一般會(huì)離障礙物半米左右局部規(guī)劃器跟起來很舒服。分辨率如果改到 0.2 米效果就開始變質(zhì)。窄通道在地圖上可能只剩一個(gè)格子機(jī)器人物理尺寸根本過不去但 A* 不知道路徑照樣從那里穿過去。所以地圖分辨率要和機(jī)器人尺寸掛鉤經(jīng)驗(yàn)上單個(gè)柵格邊長別超過機(jī)器人外接圓半徑的一半。地圖精度也不是越高越好0.02 米和 0.05 米在大多數(shù)室內(nèi)場景根本沒區(qū)別但計(jì)算量會(huì)暴漲。膨脹本身也會(huì)帶來問題。膨脹半徑設(shè)得太大A* 會(huì)認(rèn)為所有路都被堵死在地圖上找不到解設(shè)得太小路徑貼著墻走給局部規(guī)劃器留的調(diào)整空間不足。比較穩(wěn)的做法是膨脹半徑 機(jī)器人外接圓半徑 安全余量 定位誤差。安全余量通常給 5~10 厘米定位誤差按實(shí)際傳感器水平估。然后是路徑毛刺。A* 在柵格上搜出來的路徑由一串相鄰格子組成折角多斜線少。直接拿給 DWA 跟輪子會(huì)頻繁修正方向。后期可以做一個(gè)剪枝從起點(diǎn)開始往前找能無碰撞直連的最遠(yuǎn)點(diǎn)刪掉中間點(diǎn)再對剩下的點(diǎn)做輕量平滑。這個(gè)步驟不用引入復(fù)雜的曲線優(yōu)化就能把路徑長度和角度跳變降下來一大截。2.3 RRT 的關(guān)鍵參數(shù)步長、碰撞檢測與迭代次數(shù)RRT 的參數(shù)比 A* 少很多但并不代表好調(diào)。步長是最關(guān)鍵的一個(gè)太大新節(jié)點(diǎn)可能一步跨過窄縫漏掉可行路徑太小樹長得慢到達(dá)終點(diǎn)要更多迭代規(guī)劃耗時(shí)增加。按地圖尺度來定比如地面機(jī)器人場景步長取 0.5 米左右是一個(gè)常用起點(diǎn)再按地圖障礙密度微調(diào)。碰撞檢測也要注意。判斷“節(jié)點(diǎn)之間能否直連”時(shí)不能只檢查兩個(gè)端點(diǎn)要在線段上均勻采樣逐點(diǎn)看是不是處于障礙或膨脹區(qū)域。采樣太粗會(huì)漏檢路徑看著能通過實(shí)際會(huì)撞。我習(xí)慣把采樣間隔設(shè)成地圖柵格分辨率的二分之一以下。迭代次數(shù)決定成功率。迭代太少樹還沒有覆蓋到終點(diǎn)方向容易超時(shí)失敗迭代太多耗時(shí)白白浪費(fèi)。工程上可以先跑一次看第多少次迭代找到解然后把這個(gè)數(shù)字乘 1.5 作為上限。如果你用的是 RRT*還要額外關(guān)心重連半徑和優(yōu)化迭代次數(shù)。重連半徑太小節(jié)點(diǎn)優(yōu)化效果基本為零太大每次插入節(jié)點(diǎn)都掃描一堆鄰居耗時(shí)上升。我在二維平面上常用“步長的 2~3 倍”作為起始值再根據(jù)實(shí)測調(diào)整。2.4 全局規(guī)劃怎么打分規(guī)劃結(jié)果好不好不能靠感覺。我自己評估全局規(guī)劃主要看四個(gè)指標(biāo)規(guī)劃耗時(shí)、路徑長度、平滑性累計(jì)轉(zhuǎn)角、成功率。算法耗時(shí)路徑長度平滑性適用場景基礎(chǔ) A*中短一般柵格完整、可重復(fù)規(guī)劃加權(quán) A*短略長一般大圖、實(shí)時(shí)要求高RRT*中較長差高維空間、連續(xù)空間雙向 RRT中較長差狹窄通道、地圖不完整路徑長度和平滑性往往是一對矛盾。過分追求最短路徑必然貼障礙、折角多追求平滑路徑會(huì)變長。全局規(guī)劃層只需要求“大致合理”把大量平滑工作交給局部規(guī)劃層去處理這是分層架構(gòu)的核心思想也是后面融合方案的出發(fā)點(diǎn)。3. DWA 局部規(guī)劃器拆解速度窗口、軌跡模擬與評分3.1 速度窗口怎么算DWA 的第一步是確定“動(dòng)態(tài)窗口”。假設(shè)機(jī)器人當(dāng)前線速度是 0.2 米/秒最大線加速度是 0.5 米/秒2控制周期是 0.1 秒那么下一周期能達(dá)到的線速度范圍就是 0.15~0.25 米/秒。角速度也一樣由當(dāng)前角速度和最大角加速度約束。這個(gè)范圍還要和機(jī)器人允許的絕對速度上限取交集比如底盤最高線速度 0.8 米/秒你就不能算出一個(gè) 0.9 的采樣點(diǎn)。如果問題只有加減速約束DWA 還算簡單。真正復(fù)雜的是剎車約束就算某個(gè)速度組合在加減速范圍內(nèi)如果機(jī)器人以上這個(gè)速度沖出去在可預(yù)測的距離內(nèi)剎不住、會(huì)撞上障礙那它也是不可行的。所以窗口最終是“加速度窗口 ∩ 速度極限 ∩ 剎車安全區(qū)”。這個(gè)邏輯就是 DWA 被稱為“動(dòng)態(tài)”的根源窗口不是固定值而是隨當(dāng)前狀態(tài)不斷變化。給個(gè)直觀例子。機(jī)器人正以 0.5 米/秒沖向一個(gè) 0.4 米外的箱子最大減速度 0.8 米/秒2那它至少需要 0.156 米的剎車距離按勻減速公式 v2/(2a) 算勉強(qiáng)來得及但任何加速選項(xiàng)都會(huì)被剔除。如果箱子在 0.2 米外能用的速度選項(xiàng)基本就只剩下“原地制動(dòng)”了。3.2 軌跡模擬與預(yù)測時(shí)間確定速度窗口后DWA 會(huì)對每個(gè)可行速度組合做一次短時(shí)模擬假設(shè)在接下來的一小段時(shí)間里機(jī)器人保持這個(gè)速度不變沿著一條圓弧或直線前進(jìn)生成一條模擬軌跡。模擬的預(yù)測時(shí)間一般取 0.5~1.5 秒這是個(gè)很講究的參數(shù)。預(yù)測時(shí)間太短機(jī)器人只看得見眼前一小段障礙稍微遠(yuǎn)一點(diǎn)就“看不見”會(huì)顯得反應(yīng)過激頻繁急停預(yù)測時(shí)間太長它又會(huì)過度考慮遠(yuǎn)期軌跡是否撞墻在通道里容易猶豫不決明明貼著墻就可以過它卻覺得前面會(huì)撞。我用來回測試的起點(diǎn)通常是 1.0 秒障礙密集時(shí)縮短到 0.6 秒開闊環(huán)境拉到 1.2 秒。另一個(gè)容易被忽略的點(diǎn)是采樣分辨率。線速度采樣 5 檔、角速度采樣 10 檔就有 50 條模擬軌跡每個(gè)控制周期都要重新算一遍計(jì)算量完全可接受。但采樣太粗時(shí)速度選擇不連續(xù)相鄰周期可能從“猛轉(zhuǎn)”跳到“直行”機(jī)器人就會(huì)抖。采樣太細(xì)則差異太小容易在幾個(gè)相似選項(xiàng)中反復(fù)橫跳。實(shí)際操作中觀察模擬軌跡的疏密再對比機(jī)器人實(shí)際路徑的平穩(wěn)度就能大致判斷該往哪邊調(diào)。3.3 評價(jià)函數(shù)的三項(xiàng)方向、距離、速度每條模擬軌跡的得分由三個(gè)量決定score α × 方向偏差 β × 障礙距離 γ × 速度方向偏差衡量軌跡末端朝向和目標(biāo)的夾角障礙距離衡量軌跡與最近障礙的間距速度項(xiàng)則獎(jiǎng)勵(lì)走得快。如果一個(gè)軌跡會(huì)撞上障礙分?jǐn)?shù)直接記負(fù)無窮或直接淘汰。權(quán)重配平是 DWA 調(diào)試的核心。α 過大機(jī)器人會(huì)特別“犟”非要正對目標(biāo)不可結(jié)果貼著障礙邊緣硬擠β 過大機(jī)器人安全第一繞遠(yuǎn)路也不在乎在窄通道里會(huì)墨跡γ 過大機(jī)器人貪快動(dòng)態(tài)障礙高發(fā)區(qū)容易剎不住。我建議的初始配平順序是先把 β 固定在一個(gè)中間值比如 0.8再調(diào) α 和 γ 的比值。一組能跑通大多數(shù)室內(nèi)場景的起始權(quán)重是 α0.5、β0.8、γ0.3但這不是萬能值。有一個(gè)關(guān)鍵改動(dòng)要從融合的角度理解在純 DWA 里“目標(biāo)方向”直接指向終點(diǎn)一旦把它掛在全局路徑后面“目標(biāo)”應(yīng)該改為局部前瞻點(diǎn)方向而不是遠(yuǎn)方的最終終點(diǎn)。否則機(jī)器人會(huì)在接近終點(diǎn)前就開始猶豫或者在岔路口做出不合理的轉(zhuǎn)向。這個(gè)改動(dòng)一句話就能說完但很多人融合失敗就是栽在這。3.4 DWA 三個(gè)經(jīng)典故障和處理方向原地旋轉(zhuǎn)不停常見原因是目標(biāo)方向項(xiàng)權(quán)重 α 太大機(jī)器人還沒往前挪就急著轉(zhuǎn)向或者局部目標(biāo)點(diǎn)離機(jī)器人太近速度小、轉(zhuǎn)向要求又高。先試著降低 α或把速度項(xiàng)權(quán)重提上去也要看是不是局部目標(biāo)一直貼在機(jī)器人正前方很近處。左右抖動(dòng)相鄰控制周期選出的速度組合頻繁跳變。處理辦法通常是把預(yù)測時(shí)間拉長一點(diǎn)或者把采樣分辨率調(diào)粗也可以給速度輸出加限制讓每個(gè)周期的變化量不能超過某個(gè)比例。速度全部被拒絕日志里找不到可發(fā)送的可行速度機(jī)器人直接死鎖。優(yōu)先檢查目標(biāo)點(diǎn)是不是被代價(jià)地圖膨脹成了障礙其次看當(dāng)前速度窗口是不是太小最后看剎車距離計(jì)算有沒有因?yàn)闇p速度設(shè)置太小而把所有選項(xiàng)都掐死。4. A* DWA 融合落地路徑跟隨、前瞻目標(biāo)與參數(shù)聯(lián)動(dòng)4.1 為什么不直接讓 DWA 追終點(diǎn)把終點(diǎn)直接丟給 DWA理論上也能走但實(shí)際表現(xiàn)很糟距離遠(yuǎn)時(shí)終點(diǎn)方向在機(jī)器人坐標(biāo)系里的變化很慢DWA 缺少“遠(yuǎn)方該繞哪兒”的指引遇到第一個(gè)障礙就可能被帶偏。局部規(guī)劃的每一步都只保證“這一秒最優(yōu)”多個(gè)“這一秒最優(yōu)”拼起來整體路線往往不是最短甚至?xí)谡系K前磨蹭。融合的基本結(jié)構(gòu)可以理解成一個(gè)“宏觀意志下放”的過程A* 在地圖上算出一條全局路徑這條路徑被切分成一串離散點(diǎn)機(jī)器人實(shí)時(shí)找回離自己最近的點(diǎn)把前方一段距離外的那個(gè)點(diǎn)當(dāng)作臨時(shí)目標(biāo)DWA 只需要負(fù)責(zé)把這個(gè)臨時(shí)目標(biāo)吃進(jìn)評價(jià)函數(shù)輸出速度。這樣全局的繞行決策和局部的避障動(dòng)作就自然分開了。這樣的分層架構(gòu)還有個(gè)額外好處地圖更新時(shí)不需要讓局部規(guī)劃器重新思考全局。全局規(guī)劃以較低頻率重算局部規(guī)劃器每個(gè)控制周期都允許動(dòng)態(tài)障礙改變它的決策兩者節(jié)奏不一各司其職。4.2 實(shí)現(xiàn)流程路徑重采樣、目標(biāo)切換與坐標(biāo)對齊把前面說的結(jié)構(gòu)落到代碼上可以拆成四個(gè)步驟全局路徑重采樣把 A* 產(chǎn)出的一串稠密格點(diǎn)按固定間距比如 0.2 米轉(zhuǎn)成離散點(diǎn)序列。計(jì)算機(jī)器人當(dāng)前位置到每個(gè)路徑點(diǎn)的距離找到最近點(diǎn)。從最近點(diǎn)向前取一段距離這個(gè)位置作為局部目標(biāo)。前瞻距離通常取 1~2 個(gè)車身長度或者按“當(dāng)前線速度 × 1.5~2 秒”估算。把局部目標(biāo)點(diǎn)從全局坐標(biāo)轉(zhuǎn)換到機(jī)器人坐標(biāo)系再交給 DWA 的評價(jià)函數(shù)使用。這里最關(guān)鍵的是前瞻距離的選擇。前瞻太短機(jī)器人對全局路徑的跟隨太“粘”路徑稍微有波動(dòng)就跟著急剎走過直角彎時(shí)會(huì)一頓一頓前瞻太長則過彎時(shí)機(jī)器人會(huì)切內(nèi)線離障礙物很近甚至把全局路徑的彎道“拉直”了。我調(diào)試時(shí)有個(gè)快速經(jīng)驗(yàn)如果機(jī)器人過彎順暢但路徑貼邊就把前瞻距離拉大一點(diǎn)如果機(jī)器人頻繁停車、轉(zhuǎn)彎遲鈍就把前瞻距離縮近一點(diǎn)。這個(gè)參數(shù)通常不需要精確公式而是根據(jù)實(shí)測路徑形態(tài)反推。4.3 更高級的融合低分辨率 A* RRT* 局部規(guī)劃A* DWA 是“柵格世界的標(biāo)準(zhǔn)答案”但當(dāng)環(huán)境里局部障礙非常復(fù)雜、柵格圖又不可靠時(shí)可以再加一層 RRT*。一種可行的混合策略是全局層用低分辨率 A*以很低的頻率更新給出一個(gè)大致方向上的粗路徑當(dāng)機(jī)器人進(jìn)入障礙密集區(qū)域時(shí)局部層用 RRT* 在這個(gè)區(qū)域快速重規(guī)劃出一條無碰撞的短線段替代原來那一段的全局路徑DWA 繼續(xù)負(fù)責(zé)把這條短線段平滑地執(zhí)行出來。背后的思路是分層降低不確定性A* 提供方向穩(wěn)定性RRT* 提供對復(fù)雜局部的“可繞過”判斷DWA 提供底盤物理約束下的平滑執(zhí)行。這種三明治結(jié)構(gòu)比兩層結(jié)構(gòu)復(fù)雜得多代價(jià)地圖也要分多層維護(hù)但它確實(shí)能處理很多“A* 認(rèn)為走得通、實(shí)際現(xiàn)場卻亂成一團(tuán)”的場景。如果你剛開始做融合我不建議一上來就搞三層先把 A* DWA 調(diào)順再考慮往里塞 RRT*否則出問題都不知道去哪一層找。4.4 參數(shù)聯(lián)動(dòng)控制周期、最大速度、前瞻距離怎么一起調(diào)融合系統(tǒng)的參數(shù)不是獨(dú)立存在的必須聯(lián)動(dòng)調(diào)整。我習(xí)慣按照下面順序取數(shù)控制周期由底盤接口決定通常是 0.05~0.1 秒。最大線速度由現(xiàn)場安全要求決定取值時(shí)得保證緊急剎停距離遠(yuǎn)小于傳感器可視范圍。前瞻距離按“最大線速度 × 1.5~2 秒”估算。比如最大線速度 0.5 米/秒前瞻距離約 0.8~1.0 米。最大加速度取一個(gè)讓單周期速度增量不超過最大線速度 10%~15% 的值這樣底盤起步、剎車都相對平穩(wěn)。舉個(gè)例子。我在一個(gè)模擬巡檢項(xiàng)目里用過這組配置控制周期 0.1 秒最大線速度 0.5 米/秒最大角速度 1.0 弧度/秒最大線加速度 0.4 米/秒2最大角加速度 2.0 弧度/秒2前瞻距離 0.9 米預(yù)測時(shí)間 1.0 秒。這個(gè)組合跑起來整體平順動(dòng)態(tài)障礙從側(cè)面插進(jìn)來時(shí)DWA 也能在 1 米左右的距離做出明顯的減速避讓。注意這只是起點(diǎn)不同底盤和傳感器下差異很大一定要按自己的機(jī)器人實(shí)測。5. 避坑經(jīng)驗(yàn)、排故速查與調(diào)試心得5.1 地圖分辨率與機(jī)器人尺寸不匹配很多人第一次翻車都翻在這地圖用 0.2 米分辨率機(jī)器人外接圓半徑卻接近 0.35 米。A* 規(guī)劃出來的路徑在地圖上看著穿過了某個(gè)窄口實(shí)際上機(jī)器人物理上根本擠不進(jìn)去由于膨脹半徑當(dāng)時(shí)沒包含機(jī)器人尺寸路徑也會(huì)貼著墻角走導(dǎo)致局部規(guī)劃器一路瘋狂修正。對策分兩層地圖分辨率盡量滿足單格邊長小于機(jī)器人半徑的一半這是硬指標(biāo)膨脹半徑一定要含上機(jī)器人外接圓半徑、安全余量和定位誤差。否則你調(diào)再多的 DWA 權(quán)重也救不回來因?yàn)閱栴}的根源在“地圖對機(jī)器人來說壓根不可通行”。5.2 DWA 死鎖所有采樣軌跡都被判失敗現(xiàn)象比較典型機(jī)器人停在原地速度始終為零日志刷滿了“找不到可行軌跡”。我排查這個(gè)問題時(shí)一般按順序做三件事。第一看局部目標(biāo)點(diǎn)。代價(jià)地圖的膨脹層可能把目標(biāo)點(diǎn)附近的區(qū)域全標(biāo)成了障礙目標(biāo)點(diǎn)本身不可達(dá)這時(shí)機(jī)器人不管怎么采樣都“撞墻”。處理辦法是讓全局規(guī)劃把終點(diǎn)或局部目標(biāo)改成最近的自由格點(diǎn)。第二看膨脹半徑是不是過大。機(jī)器人明明離障礙還有 30 厘米但代價(jià)地圖認(rèn)為已經(jīng)是禁區(qū)也會(huì)把可行速度全掐斷。第三看剎車約束計(jì)算。最大減速度設(shè)得太小會(huì)讓剎車距離變大動(dòng)態(tài)窗口被進(jìn)一步壓縮速度選項(xiàng)就少了。把減速度調(diào)大一點(diǎn)再給原地轉(zhuǎn)向留一條可選速度死鎖往往會(huì)解除。5.3 全局路徑貼墻局部規(guī)劃蛇形走位這種現(xiàn)象表現(xiàn)為機(jī)器人路線總體正確但輪子一直在左右修方向走起來像蛇。先別急著怪 DWA多半是全局路徑本身離障礙太近。A* 的代價(jià)函數(shù)只優(yōu)化距離不優(yōu)化“安全間距”所以如果膨脹半徑?jīng)]設(shè)置好或者加權(quán) A* 權(quán)重太大導(dǎo)致路徑靠墻抄近路就必然出現(xiàn)這種結(jié)果。處理辦法是給全局層的障礙距離加權(quán)或者干脆把膨脹半徑再加大一圈讓 A* 主動(dòng)繞開“剛剛好能過”的區(qū)域。我還會(huì)在后處理階段對路徑做一次“向外推”的輕量操作把每個(gè)路徑點(diǎn)往遠(yuǎn)離最近障礙物的方向挪一小段距離再重新檢測碰撞。這個(gè)操作在走廊環(huán)境里尤其有用。5.4 重規(guī)劃震蕩機(jī)器人左右擺頭融合系統(tǒng)跑起來后最常見的動(dòng)態(tài)問題不是撞而是“左右擺”。A* 全局路徑不變但每個(gè)控制周期算出來的局部目標(biāo)點(diǎn)都在細(xì)微變化DWA 的評分對目標(biāo)方向非常敏感于是速度指令來回跳底盤表現(xiàn)為左右擺頭。給目標(biāo)切換加一個(gè)滯回區(qū)問題能消掉大半。具體做法是當(dāng)前局部目標(biāo)點(diǎn)與上一個(gè)目標(biāo)點(diǎn)的距離小于某個(gè)閾值比如 0.1 米時(shí)繼續(xù)沿用舊目標(biāo)不切新的。這本質(zhì)上是給離散控制加了一點(diǎn)“慣性”讓決策不要因?yàn)槲⑿_動(dòng)而來回翻轉(zhuǎn)。另一個(gè)輔助手段是略微降低角速度采樣分辨率減少相鄰周期速度指令的跳變幅度。5.5 排故速查表現(xiàn)象可能原因檢查點(diǎn)處理方向機(jī)器人懟墻地圖分辨率過低路徑穿過不可行窄縫柵格邊與機(jī)器人半徑比提高地圖精度加大膨脹原地死鎖DWA 評分全失敗目標(biāo)點(diǎn)是否被膨脹減速度設(shè)置修正目標(biāo)點(diǎn)調(diào)大減速度蛇形走位全局路徑貼障礙、折角多膨脹半徑、路徑采樣點(diǎn)加大膨脹路徑平滑左右擺頭局部目標(biāo)頻繁切換前瞻距離、目標(biāo)切換邏輯加滯回區(qū)降低采樣分辨率規(guī)劃超時(shí)卡頓A* 在大地圖上搜索過慢open list 數(shù)據(jù)結(jié)構(gòu)、h 權(quán)重?fù)Q二叉堆、用加權(quán) A*排故的核心思路是分層定位先分清是全局路徑的問題還是局部執(zhí)行的問題再動(dòng)參數(shù)。不要一上來就調(diào) DWA 的權(quán)重很多時(shí)候根子在前面那層。5.6 調(diào)試心得把內(nèi)部狀態(tài)畫出來比盲調(diào)參數(shù)快十倍這是我最想強(qiáng)調(diào)的一點(diǎn)。調(diào)導(dǎo)航參數(shù)時(shí)不要只看機(jī)器人最終跑得好不好要把中間狀態(tài)全部可視化全局路徑點(diǎn)、當(dāng)前局部目標(biāo)、DWA 模擬出來的幾十條軌跡、代價(jià)地圖、還有每條軌跡的評分全都畫在同一張圖上。一旦機(jī)器人出現(xiàn)怪動(dòng)作先通過畫面定位是哪一層的問題。全局路徑在障礙物里穿說明 A* 這層錯(cuò)了全局路線上局部目標(biāo)亂跳說明前瞻邏輯有問題全局路徑?jīng)]問題但模擬軌跡全貼著障礙那就去調(diào) DWA 的評價(jià)函數(shù)。我見過很多開發(fā)者憑感覺在參數(shù)文件里來回改改半天也不知道是哪一層導(dǎo)致就是因?yàn)闆]看到中間狀態(tài)。另外一個(gè)容易出效果的小操作是把 DWA 的預(yù)測時(shí)間臨時(shí)調(diào)大比如從 1.0 秒調(diào)到 2.0 秒你就能在可視化面板里看到機(jī)器人“預(yù)判”的軌跡到底傾向哪邊這時(shí)候評分的傾向性一目了然??赐暝僬{(diào)回實(shí)際值調(diào)參效率會(huì)高很多。我個(gè)人這幾年做下來最大的體會(huì)是路徑規(guī)劃這個(gè)領(lǐng)域真正難的從來不是某個(gè)算法本身的公式而是怎么讓不同工作節(jié)奏的算法在一臺機(jī)器人身上協(xié)同工作。A* 想的是全局要不要繞路RRT 想的是到底有沒有一條路DWA 想的是這一秒怎么走穩(wěn)。把這三層接好之后機(jī)器人才會(huì)像一個(gè)有判斷力的司機(jī)而不只是條件反射的避障器。最后再分享一個(gè)很小的習(xí)慣每次只改一個(gè)參數(shù)改完把評分日志打出來對比數(shù)據(jù)別一次動(dòng)三四個(gè)參數(shù)。路徑規(guī)劃這種系統(tǒng)牽一發(fā)動(dòng)全身盲改參數(shù)翻車之后你連復(fù)現(xiàn)問題都困難。數(shù)據(jù)說話比手感可靠得多。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
狠狠操狠狠操AV| 99网| 五月在线婷色| bukadeavzaixian| 亚洲激情婷婷| 可以免费看AV网站| 6月丁香婷婷| 99热在线观看| 色五月色五天色情网| 五月婷婷天天色| 伊人大香久久| 亚洲无AV在线中文字幕| 久久视频婷婷视频| 99国产精品久久久久久久久久久| 深爱开心五月天| 开心久久网婷婷| 色情五月天丁香社区| 狠狠色狠狠干| 啊V视频在线观看| 日韩无码专区| 97操操| 亚洲色色香蕉| 爱草视频在线观看| 九月色婷婷| 91麻豆国产三级精品福利在线观看| 色五月五月天色婷婷色五月| 九九机热| 婷婷五月天亚洲精品| 97色97干| 百度4399有码精品V在线观看 | www.婷婷,com| 欧美日韩中国| 一区二区无码视频| 九七色色六月丁香| 无码日本精品XXXXXXXXX | 26uuu成人网| 五月婷婷和六月| 亚洲色婷婷五月天| 九九综合九| 97碰超级人人看| 色五月天视频| 九九爱看亚洲| 丁香婷婷免费| 丁香五月1页| 亚洲成人无码免费| 婷婷五月综合色小姐小说| 97碰在线视频| 丁香婷婷色五月激情综合| 午夜成人综合| 97色天堂| 91色噜噜狠狠狠狠色综合| 五月丁香婷庭在线| 五月天色婷婷成人| 五月天六月婷婷电影| 在线区区区| 婷婷六月天天| 99亚洲天堂| 六月婷婷最新网址| 99九九视频精彩在线| 色婷婷综合久久| 丁香花五月天激情| 五月婷网| 在线不卡视频| 色色色综合色| 99综合网| 五月天久久色| 五月丁香综合精品欧美| 丁香五月天亚洲综合| 国产露脸150部国语对白| 天天日日夜夜| 久久久GOGO无码啪啪艺术 | 五月天色婷婷综合| 国产这里只有精品| 五月天丁香网站| 丁香五月婷婷av| 丁香五月电影| 激情中文在线| 99超级碰免费视频| AA丁香综合激情| 99操碰| 久久婷婷色| 九九热在线观看视频| 99精品在线播放| 婷婷99狠狠躁天天| 无码少妇高潮喷水A片免费| 99自拍视频在线观看| 色综合伊人网| 久久大国产香蕉| 婷婷五月性感| 久久新| 色婷久| 五月丁香六月激情综合| 久久久宗合| 91婷婷色| 这里只有精品视频国产| 婷婷 激情 五月| 在线色五月婷婷| 日日夜夜噜噜爽爽| 99热网址| 亚洲精品久久久久AV无码| 色婷婷丁香A片区毛片区女人区| 国产精产国品一二三在观看| WWW、日本色丁香、co m| 九一牛视频探花| 成人视频免费观看高清完整版在线观看| 91女人18毛片水多国产| 婷婷色丁香五月| 五月在线婷色| 天天狠狠六月婷丁香影院| 26UUU精品一区二区| 九九久久五月天| 亚洲综合在线视频| 97成人在线视频| www色婷婷com| 最新激情五月天| 久久机热思思热| 五月天,激情四射,婷婷频道| 免费黄色片子| 精品久久婷婷| www.sezonghe| 久久98| 国产亚洲精品久久久久苍井松| 九九99精品免费播放| 热婷婷在线视频| 日本久久综合| 五月亚洲| 精国产品一区二区三区A片 | XX色综合| 日韩久综合| 亚州精品色情无码A片| 综合深爱五月| 婷婷在线视频| 久久精品99久久久久久久久| 婷婷色天香| 久久五月天婷婷| 狠狠干天天日| 亚洲婷婷丁香| 国色天香伊人狠狠色| 色99色| 97久久超碰| 色婷婷精| 激情婷婷人妻| 婷婷六月色开| 久久天堂加勒比| 三级黄网站| av性爱网站| 久久婷婷综合五月天| 久久五月天精品视频| 成人视频一区| 久久婷婷六月综合综合| 色爱爱综合网| 狠狠操天天日| 色综合色综合网| 五月丁了香蕉综合| 婷婷五月天啪啪| 99亚洲视频| WWW.HENHENL.| 六月婷婷激情小说网| av九九| 9久热在线精品| 99亚洲大片精品永久在线观看| 丁香五月电影| WWW.99热| 久久久8| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 99精色| 精品一二三区久久AAA片| 婷婷综合色网| 色偷偷综合| 婷婷久综合| 五月丁香六月久久| 天天天天天天操| 五月丁香视频色色| 丁香六月欧美| 婷婷黄色五月| 日韩精品一品二区三区的使用体验| 最近中文字幕2019视频1| 五月天色色激情综合| 美国色五月天婷婷资源站| 精品亚洲国产成AV人片传媒| 五月婷婷激情综合视频| 97香蕉人人在线观看| 人人视频色| 久久九网| 五月天激情网站| 婷婷丁香先锋资源网站| 久久久久网站| 国产亚洲色婷婷久久99精品91| 五月丁香啪啪啪啪| 婷婷五月综合婷婷| 欧美大片免费播放器| 久1色色| 少妇高潮呻吟A片免费看软件| 人人色性网| 婷婷97狠狠成人网站| A√天堂网在线| 99热国产这里只有精品| 米奇激情婷婷| 大香人妻| 伊人久久艹| 婷婷爱在线观看| 五月花婷婷| 另类图片五月天婷婷| 超碰免费人| 亚洲bt丁香五月天婷婷激情小说| 国产一区18| www超碰| 欧美日韩大黄| 亚洲有码在线视频| 日日杆天天| 色婷婷五月基地在线| Aaa久久| 亚洲操B| 97久久久久| 青草五月天| 五月色欧洲| 亚洲尤物在线| 久久xx| 久久婷婷五月综合色播| 九九视频在线观看| 日韩精品二三区| 91超碰九色| 久久精品性爱| 久久看婷婷| 九九色热| 色婷婷六月性| 91九色成人原创视频| 综合网啪| 996热re视频精品视频这里| 亚洲精品网址| 大香蕉220| 婷婷久久综合| 久热这里只有精品3| 99色婷婷视频| 婷婷六月视频| 人人爱干人人爱草| 五月婷婷人人人操| 婷五月天在线草| 99在线视频免费| 99热热热天天人人人超超碰| 人人人va亚洲视频在线| 五月丁香| 婷婷五月色图| 视频一区二区在线| 色噜噜综合网| 香蕉婷婷色五月| 激情五月天在线| 激情五月婷婷啪啪| 五月桃花网综合| 99啪| 五月婷婷激情久久| 天天肏天天插| 亚洲超碰在线| 九九99在线视频| 强壮公让我夜夜高潮A片视频| 9九色首页| 婷婷综合成人五月天| 中文字幕av在线播放| 精品欧美性爱超级爽| 天堂中文国产| 婷婷激情图片| 久久久精品色色色| 五月综亚洲| 亚洲激情综| 久久婷婷青青| 国产精品色情AAAAA片软件| 台湾无码A片一区二区| 亚洲丁香网| 五月六月婷婷激情网| 欧美三级级99久久| 碰碰碰97免费精彩视频| 奇米色大香蕉| 久久日婷婷| 五月天婷婷小说| 五月丁香婷婷基地| 超碰九九热| 亚洲综合五月天婷婷| 久久有码| 欧美激情五月| 战争与艾拉电影免费观看| 色狠狠激情五月| 五月丁香婷婷综合久久| 色婷婷六月天| 五月婷婷99热| VA色婷婷| 综合亚洲六月婷婷在线| 色五月婷婷婷婷婷婷婷婷婷婷| 婷婷激情在线| 五月婷婷色色色| 婷婷大乡焦噜噜| 亚洲AV电影av| 亚州综合色| 丁香五月婷婷影院| 久久综合网桃花| 热久91| 五月丁香婷婷激情爱爱| 午夜福利8055| 亚洲综合在线播放| 97人人超| 九月婷婷综合八月丁香在线观看| 开心日韩丁香婷婷五月| 华人在线免费| 色婷婷电影网| 成人视频在线免费播放| 丁香六月在线| 五月天激情小说| 色狠狠色| 《亚洲操B久久免费在线观看,亚洲操B久久在线播放》在线播放 - 高清资源 - 97 | 99久久精彩视频。| 五月天婷婷自拍图片在线观看| www.激情五月天。com| 超碰av在线| 婷婷香香五月| 天堂婷婷丁香六月网| 综合深爱五月| 影音先锋偷偷色男人站| 五月婷婷丁香| 99网| 丁香五夜激情四射夜夜夜| 婷婷婷五月香蕉| 婷婷综合av| 日韩视频女神99| 五月天婷婷色色网| 激情五月天在线观看色婷婷| 婷婷六月天精品| 五月婷婷狠狠干| 美女妹子后射视频网站在线观看| 在线网黄| 中文字幕精品无码一区二区| 久久久噜噜噜操操操| 亚洲 欧洲 国产 伦综合| 五月婷婷日本| 视频综合网| 亚洲五月天天| 天天做天天爱天天爽综合网| 91操碰| 狠狠干,狠狠操| 激情九月婷婷九月| 婷婷丁香社区| 五月天色播网| 色欲午夜无码久久久久久张津瑜 | 真实的国产乱XXXX在线91| 影音先锋91视频| 久久久久久久久久久97| 26uuu色噜噜精品一区| 这里只有精品69| 狠狠色五月天| 五月综合激情婷婷六月色窝| 最新AV在线观看| 九九国产视频| 99热这里只有精品3| 久久色天堂| 国产亚洲精品久久久久久郑州| 婷婷9月天| 嫩草视频观看| 五月久久亚洲| 婷婷丁香色五月| 天天干人人奸97| 国产无人区大片| 婷婷六月色丁香视频在线观看| 怡红院一二三| 日本欧美成人片AAAA| 日韩AV中文字幕在线| 久久视屏这里只有久久| 五月丁香激情综合网| 97综合在线| 日本人妻久久| 五月丁香色狠狠干大屄| 99自拍视频| 色情成人五月天| 性五月激情| 五月婷婷六月丁香在线视频| 色五月激情五月| 五月天婷婷綜合院| 天天操天天操天天操天天操天天操天天操| 色婷婷六月| 91AV视频| Caoub青青超碰 | 丁香五月天电影| 丁香激情五月天| 97碰免费精采视频| 久久这里都是精品| 色图亚洲91| 亭亭丁香aV| 色色色综合| 婷婷五月,综合伊人| 婷婷五月综激情| 亚洲AV色婷婷人禽五月天| 欧美日韩91| 色v综合网| 婷婷色正月| 99热这里有精品| 色~性~乱~伦~噜| 五月丁香六月婷婷综合| 99久久婷婷国产综合精品电影| 欧美天天爽| 日韩久久色| 激情国产综合| 久久五月天网| 黑人熟妇一区二区三区| www.五月丁香| 伊人婷婷五月天av| 婷婷五月天激情网| 99re热在线观看| 天天爽,夜夜爽| 色综合77777| 色五月五月天| 综合色在线| 五月丁香婷婷激情久久| BBWCUCKOLD精品熟妇| 另类色网| 韩国真做片在线观看| 五月婷婷色| 婷婷五月av| 7777激情基地| 天干夜夜操| 99re66热这里只有精品| 色婷婷亚洲婷婷| 五月婷婷色播视频| 六月婷婷综合| 婷婷开心综合人妻小说网址| 大香蕉久久青青| 综合热无码| 婷婷色色综合| 久久久精品色| 14色综合婷婷| 色播五月| 丁香五月婷婷丫| 中文字幕丰满孑伦无码专区| 久久这里99| 久久5 9视频免费观看| 欧美va欧美va差| 精品五月花| 婷婷开心激情| 丁香综合网| 狠狠综合| 国产精品在线视频| 婷婷五月天VI| 五月婷在线播放| 色综合色婷色基地| 91偷拍视频| 欧美日本黄色| 九九色色| 伊人色欲五月天| 九九精品免费视频99| 婷婷五月天精品| 欧美色色色色色色色色| 成人丁香色| 日韩啪啪网| www.99热| 日韩AV色色色| 久久精品夜色噜噜亚洲a∨| 99九无网码| 色五月丁香五月激情五月激情| 搡BBBB搡BBB搡18| 亚洲色综久久五月| 亚洲成人在线观看网址| 超碰在线人妻| sewuyuejiqingwang| 五月婷免费视频| 大香蕉婷婷丁香视频在线| www婷婷| 黄色五月婷婷| 精品皮股午夜AV| 九97免费视频| www.天天干| 亚洲啪视频| 五月婷婷激情综合| 色99在线视频| 五月天无码视屏播放| 五月天丁香婷婷久久九| 五月丁香六月婷婷久久肏| 五月婷婷综合热| 欧美特大片黄| 成人av在线网址| 五月丁香WWW| WWW色色色COM| 亚洲激情网| 久久婷婷丁香六月天| 伊人碰碰婷婷| 日本熟妇乱妇熟色A片蜜桃| 五月婷婷综合视频| 97激情五月天| www.99热精品| 成人在线日韩| 色五月婷婷五月天| 97激情五月天| 九九热九九| 五月天久久色| 色婷婷色99国产综合精品| 五月天五月天成人网亭亭成人色网站| 日本三级黄色大片| 色约约视频一区二区三区四区五区| 久久久噜噜噜久久人妻| 五月丁香六月激情综合啪啪| 五月婷婷丁香大陆免费| 九九精品re免费视频| 99久久极情精品一区| 成人精品亚洲性爱| 密乳视频| 亚洲激情亚洲激情| 超碰人人干| 五月丁香WWW| 超碰国产av| 久久九九99视频| www.五月丁香| www.99日本| 日本操逼九九九九58日本操逼| 91丨九色丨43老版熟女| 大鸡巴伊人网| 五月丁久久| 香蕉综合在线| 伊人婷婷大香蕉| 久色国产| 天天操夜夜夜拍拍拍| 九九国产视频| 五月久久网| 超碰国产在线播放| 99精品在线观看| 国产97色在线 | 日韩| 九九热在线观看视频网站| 九九精品视频免费在线| 色婷婷先锋| 男女av免费看| 色综啪啪| 67久久| 91久久婷婷| 第四色五月天| 日韩啪啪视频| 色五月天丁香婷婷| 亚洲美女高潮久久久久久69| 开心五月深爱五月| 99精品视频网站| 激情网五月婷婷| 激情开心五月婷婷| 久久这里面只有精品视频| 青青草原中文字幕| 91碰碰| 97极品在线| www.色婷婷.com| 97人人操人| 久久91久久精品久久| 五月Huangsewang| www激情| 综合色色色| 久久婷婷成人综合色怡春院| 丁香婷婷久久 | 亚洲V国产V欧美V久久久久久| 自拍偷窥99热| 99热综合| 北京熟妇搡BBBB搡BBBB| 天天射影院| 国产全是老熟女太爽了| 国产XXXX搡XXXXX搡麻豆| 色情综合| 激情小说色五月| 国产精品第一国产精品| 色综合99无码 | 九九这里只有精品在线视频| 亚洲激情高潮| 色婷婷丁香五月天激情综合网| 五月婷无码| 密桃激情五月天综合网| 99亚洲日韩| 亚洲五月色| 欧美成人日韩| 99久久极情精品一区| 深爱激情综合网| 亚洲无AV在线中文字幕| 日本韩国视频在线观看社区免费的9| 日本V在线观看不卡视频网站| 色婷婷久久7777| www.com.色色| 激情综合网络插| 天天综合干| 五月开心婷婷| 久久思思热| 五月天久久婷婷| 丁香五月五月婷婷| 超碰免费观看| 六月丁香婷婷综合狠狠爱夜夜爱| 超碰免费成人| 五月成人网天天| 五月丁香婷婷爱| 日韩久久视频| 日韩黄色影院| 99久久www| 欧美久草在线日本一级特黄大片做受9在线观看韩国电影《两个女人》未删减-毛片 | 激情桃色网| 性生活久久人妻| 99久久五月婷婷| 人妻内射视频| 在线视频九色97| 五月丁香婷婷综合久久| 天天日人人| 丁香婷婷视频一区二区| 97热视频| 欧美成人在线观看| 日本一毛片| 五月色婷婷综合丁香精品无遮挡| 色五月婷婷久久| 91久久| 五月丁香本色在线观看| 插逼综合网| AⅤ色区| 婷婷六月亚洲综合| 丁香六月婷| www.久久久久久久久久久| 天天爽夜夜爽夜夜爽精品| 操操操操操电影网| 日日色综合| 无码字幕中文| 五月天无码| 熟女激情五月天| 网站免费一站二站| 五月婷婷婷综合网| 这里只有国产精品在线| 日日噜噜夜夜狠狠久久丁香六月| 婷婷在线日韩综合| 全亚洲最大的婷婷五月天网站COM| 色99综合视频| JAPANRCEP老熟妇乱子伦视频 | 99re思思热久久| 丁香六月情| 色色网91| 色五月丁香婷婷综合| 26UUU欧美激情一区二区| 熟女少妇内射日韩亚洲| 一本综合丁香日日狠狠色| 综合五月婷婷| 九九九九九九九九九九九九九国产精品| 亚洲久热| 99热这里都是精品| 色色丁香色五月| 少妇日麻屄| 变态另类9| 97人人操人人拍| 色国产五月| 五月婷婷三级| HD久久精品视频| 亚洲色vA| 丰满老熟妇BBBBB搡BBB| 精品久热| 久久久18| 91狠狠色色丁香婷婷综合久久| 五月天激情网开心网| 无码AV免费精品一区二区三区| 99在线视频资源| 26UUU精品一区二区| 女人被躁到高潮嗷嗷叫小| 99黄色性生活| 超碰99在线| 久操干| 丁香五月婷婷基地| 国产超碰av| 翔田千里无码| 久草丁香婷婷1024| 婷婷激情六月中文| 亚洲操操| 丁香亭亭久久| 99久久久久| 日韩另类| 五月天激情四射| 人妻AV在线| 丁香六月婷婷开心| 婷婷午夜激情| 亚洲综合激情五月久久| 综合久久婷婷| 日韩婷婷| .操區COm| 97干在线| 天天艹天天色| 五月丁香久久综合91| 天天干夜夜b| 九月婷婷在线视频| 影音先锋男人站,影音先锋男人色资源网,影音先锋AV最新资源站,影音先锋AV资源 | 视色网在线播放| 激情婷婷丁香| 97在线视频观看| 五月婷视频| 日日噜狠狠色综| 婷婷99狠狠| 五月六月丁香婷婷在线观看| 五月婷色| 天天爽综合| 香港九九六区八区99| 久久偷拍综合五月天| 综合久久综合五月天婷婷| 五月婷婷色吧!| 五月色婷婷夜色| 日本欧美成人片AAAA| 亚洲精品国产setv| 五月婷在线| 激情婷婷丁香色五月综合| www.丁香黄色五月天人与| 久久婷婷色五月| 色伊人91在线视频| 思思热视频在线观看| 五月婷婷七月丁香| 五月丁香成人网| 五月天六月天| 九九无毛| 成人 在线 日韩| 久久99热这里只有精品首| 久久婷婷五月综合啪| 另类激情五月| 99免费超碰在线| 欧美色爱五月天| 91黄址| 丁香五月天堂网| 亚洲五月天伊人| 婷婷激情四射五月天| 超碰二区| 亚洲看av的网站| 9 大屁股在线视频精品| 一区视频网站| 五月婷婷五月天激情视频| 国产精品久久..4399| JAPANRCEP老熟妇乱子伦视频| 狠狠狠狠狠草| 99人妻碰碰碰久久久久禁片| 精品人妻午夜一区二区三区四区| 色导航色婷婷五月天在线观看| 国产成人av在线| 国产肥白大熟妇BBBB视频 | 色9色| 99干免费视频| 九九精品热| 五月天婷婷乱| 99热在线观看| 青青操日本摸摸看看| 婷婷九月色| 99r这里| 97精品综合久久| 99视频啪啪| 久久久精品人妻| 玖玖资源站蜜臀| 99热 这里只有精品 国产 日韩| 欧美熟女视频 色婷婷| 色九月| 国产精品香蕉| 天天摸天天舔天天爽| 一起肏在线视频| 国产亚洲精品久久久久久郑州 | 五月丁香综合网| 五月综合777| 色婷视频| 久热久操久热久草国产91| 国产SUV精品一区二区6| 色色五月婷婷久久| 久久久久久综合五月婷婷| 色欲人妻综合aaaaaaaa网| 色99超碰| 伊人九九68| 俺去也婷婷| 另类A片| 玖玖资源站中文| 激情com| 99ri在线观看视频| 婷婷自拍| 色婷婷影视99| 人妻体体内射精一区二区| 色色色色色色色色网站| 女人天堂AV| 开心五月色婷婷综合开心网| 97色色色色色色色色色色色色色| 91九色在线| 狼人婷婷综合| 色五月婷婷很很操| 婷婷五月色丁香在线看| 色七色九九| 99手机在线精品视频| 97ai婷婷| 九九九九九九热| 91精品国产综合久久久不卡电影| 永久精品| 天天天天操| 午夜一区| 色婷婷狠狠爱| 91玖玖| 激情欧美五月丁香| 99爱在线精品视频免费观看| 99.色| 热99这里只有精品视频| 五月天小说激情| 丁香婷婷免费| 亚洲成人色五月婷婷综合| 婷婷激情五月综合| 日本69日人视频| 五月天色色婷婷| 久久98热re| 色综合香蕉| 九9九9无码| 9热在线视频精品| 亭亭五月基地在线| 久操福利| 国产操碰| 久热久色| 激情综合自拍五月婷婷色五月| 成人在线不卡| 国产免费AV在线| 在线观看的av| 开心婷婷五月激情网小说| 丁香五月婷婷激情小说| 五月婷婷伦理| 五月丁香六月婷婷综合网| www,婷婷五月天777me,com| 日日射天天射| 亚州精品久久久久AV无码| 丁香婷婷久久综合在线| 久久机热这里只有 | 五月花成人网| 六月色色婷婷| 色色性爱视频| 五月婷婷色播| 99性爱视频| 中文字幕欧美日韩VA免费视频| 色5月婷婷| 五月天丁香啪啪网| 亚洲欧美国产A片免费观看| 白天AV月月| 亚洲成人乱码av网站| www.minyis.com【JT】实力收量可预付QQ2101460746 | www.色色com| 九月影院義母在线播放| 全亚洲最大的婷婷五月天网站COM| 九九视频这里是精品五月| 五月综合激情图片| 噜噜色噜噜网| 五月婷中文字幕| 丁香久久| 丁香五月婷婷五月基地| 91色噜噜狠狠狠狠色综合| 99日本精品视频热| 五月婷婷免费在线观看| 超碰熟女拍拍| 色婷婷五月天成人网| 99精品综合视频| 极品人妻VIDEOSSS人妻| 在线看黄色| 99热伊人| 五月丁香六月婷婷综合网缴情| 婷婷六月丁香五月| 五月丁香六月| 97日本在线播放| 九九精品自拍| 综合色天天| 可以免费观看的av| 激情五月天视频| 夜色爱爱亚洲| 丁香婷婷啪啪| 开心五月深爱婷婷| 九九色逼| 日本精品人妻无码77777| 一婬一伦一区二区三区| 成人五月天综合网| 欧美黄色AA片哗啦啦啦| 亚洲色视频| 日韩AV在线电影| 另类小说五月天| 婷婷丁香五月高清| 丁香五月天婷婷激情| 久久精品五月| 丁香婷婷五月天色综合| 色五月丁香婷婷| 伊人综合网站| 五月天婷婷色情| 五六月丁香激情视频| 狼友超碰| 少妇被下春药玩弄A片| 99在线视频播放| 狠狠干狠狠干狠狠干狠狠干| 91seav| 大香蕉 婷婷| 欧韩性爱| 五月天激情综合| 九色在线五月婷婷网址| 色五月六月| 丁香久久九九99| 五月色 亚洲| 亚洲成人在线播放| 亚洲欧洲小视频9| 激情纯色婷婷五月天在线不卡视频| 夜色综合网| 午夜]香婷婷深深爱| 婷婷五月成人色综合| 五月天婷婷爱| 亚洲AV无码电影| 开心五激情网| 日本99视频| 五月婷婷影| 日操夜撸| 色五月婷婷在线观看第一页舔| 五月天社区| 97干婷婷| 99久久偷拍视频| 五月丁花色综合网| 99色在线视频| 久操热| 九九热最新| 午夜福利成人AV91| 99视频在线观看视频| 色婷婷丁香五月| 国产精品社区| 91九色丨国产丨爆乳| 天色色综合网| 九九久热| 成人丁香婷婷| 五月丁香色婷婷熟女| 天天综合精品| 婷婷色天香| 婷婷五月丁香五月| 激情综合播播| 婷婷综合网| 亚洲欧美综合7777色婷婷| 激情五月丁香婷婷| 色色色色色五月| 丁香六月亭亭久久综合| 99热在线播放精品| 开心五月深爱五月婷| 国产又爽又猛又粗的视频A片 | 啪啪啪大香蕉| 久久伊人婷婷| 亚洲第一成人无码A片| 九九热精品99| 色v综合网| 色婷婷五月综合在线| 激情综合在线观看| 久久视频婷婷| 色婷婷婷婷| 中文字幕视频在线播放| 五月丁香综合啪啪| 97啪啪| 九九热视频精品2| 超碰在线免费9| 99热日韩| 99精品视频网| 五月丁香激情综合啪| 激情五月婷婷| 五月激情综合五月| 伊人热在线大香蕉| www.26uuu.com亚洲电影| 操碰99在线视频观看| 欧美黄色AA片哗啦啦啦| 色天堂97| 熟女激情网| 激情五月深爱五月| 美女婷婷激情亚洲| 六月婷婷中文字幕| 激情都市五月天| 67194线路二在线观看| AV操操操| 色色五月丁香婷婷| 五月丁香婷婷综合网| 亚洲婷婷婷| 国产色香蕉精品五夜婷| 婷婷五月精品中文字幕| www.狠狠| 影音先锋女人AA鲁色资源| 狠狠五月激情婷婷直播片| 色综久久久| 九九这里是免费的视频5| 五月天色综合| 色色五月婷| 综合九九| 久久伦乱| 国产精产国品一二三在观看 | 色婷婷啪啪啪啪啪啪| 丁香六月婷婷综合| 天天撸夜夜爽| 人人操人人添人人摸97| 99精在线| 五月丁香六月合| 97色图片中文字幕视频在线观看 | 色欧美影院| 欧美色婷婷| 狠狠操狠狠做| 色色色色综合网| 97精品人人A片免费看| 婷婷淫淫狠狠六月| 色婷婷基地| 色九四色| 99自拍视频| 色婷五月天网站| 九九综合色综合| 26uuu国产| 丁香五月欧美午夜视频| 狠狠香婷婷五月| 日韩无码性爱| 久久xxxx| 五月天综合| 成人精品一区二区三区四区五区 | 色五月综合| 婷婷五月丁香99| 中文字幕AV在线| 久99久热只有精品国产99| 丁香五月天狠狠操| 天天揷综合网| 操逼六区| 国产一二三四五六七八视频| 婷婷月综合| 91a片爽| 天天爽天天| 色五月婷婷在线观看| 五月天婷婷午夜丁香| 韩日AV片| 嫩草AV久久伊人妇女超级A| 欧美丁香五月夫妻天| 五月婷婷色男女| 91丨九色丨熟女|老版| 精品少妇人妻AV无码专区偷人| 久9久9久9久9久9久9| 欧美色色色| 六月婷婷深深爱| 久青草大香蕉| 激情性爱五月天网页| 大香蕉久艹| 天天搞天天爽| 九九机热| 六月五月丁香五月欧美| 国产综合视频婷婷| 国内精品免费一区二区2009| 国产这里只有精品| 色噜噜狠狠色综合网| 激情综合色播| 激情伍月 欧美| 97人妻碰碰中文无码久热丝袜| 黄色五月婷| 九八Av| 99在线精品观看99| 99热e| 九九婷婷网五月天| 能看的av片| 99久久a线观| 人妻综合网| 婷婷五月在线| 操逼视频网址| 少妇性按摩无码中文A片| 五月丁香激情综合网| 久久女人天堂| 激情综合网激情五月天| 天天橾夜夜爽| 成人网站免费sxj| 狠狠五月丁香色婷| 丁香五月1页| 啪啪啪大香蕉| 超碰人人91| 久久久婷婷五月亚洲97号色| 五月丁香婷婷啪啪网| 色五月综合网站| 免费碰碰视频久| 午夜成人片400| 天堂无码人妻精品AV一区| 亚洲激情久久| 天天综合网在线| 久综合网| 五月丁香六月综合激情| 婷婷五月天开心网| 激情综合婷婷| 色九九综合| 五月婷婷激情五月| 婷婷色婷婷| 精品乱码久久久久| 五月天婷婷无码| 伊人啪啪网| 99久久网站| 五月色亚洲| 丁香五月天激情综合| 丁香五月中文字幕| 99热这| 久久婷婷影院| 婷婷五月天激情网| 午夜69成人做爰视频| 色久综合| 日本操B视频| 亚洲图色五月天| 久久婷婷大香蕉| 欧美伊人9| 强伦轩人妻一区二区电影| 亚洲五月激情| 任你艹| 色婷婷XXXXX| 天天爱天天做综合| 精品皮股午夜AV| 牛牛碰免费| 天天天天操| 狠狠穞A片一區二區三區| 思思99久久| 五月天激情图片| 婷婷色色网| 男人的天堂婷婷色五月| 天天射天天操天天干| 超碰在线网站| 久久婷婷五月天懂色| 久久久精品99亚洲综合| 噜噜噜噜在线| 996日日爱| 激情综合网五月丁香| 1024人妻| 一区二区成人电影免费播放| 四川操逼站| 99操无码视频观看| 狠狠夜夜五月丁香| av中文网站| 色色99| 五月丁香六月色| 丁香婷婷五月香蕉91| 影院久久久| 99re在线观看| 丁香五月天人体| 五月天色丁香| 五月丁香啪啪网| 亚洲视频在线观看| 男人的天堂97| 97综合色片| 亚洲视频在线观看99| 99爱无码| 国产婷婷五月天| 国产小精品| 狠狠干综合网| 99热 在线观看| 日日操夜夜骑| 中文字幕在线观看视频www| 97碰碰碰免费公开在线视频| 九九超碰人人| 久久五月丁香婷婷| 99无吗| 激情五月天色播| 97操碰98| 久久中文人妻系列| 欧美天天性| 婷婷激情丁香五月婷婷激情丁香五月婷婷 | 色综合99无码 | 9热在线观看| 天天操九九插| 粉嫩av懂色av蜜臀av熟妇| 国产毛多水多女人A片| 大香蕉人在线65| 日日噜狠狠色综合久久| 中文在线成人| 热91久| www.99在线| 国产精品久久久久久五月天加勒比 | 夜夜操,天天撸| 国产精品人人做人人爽人人添| 欧美操综合| Va另类视频| 亚洲免费婷婷| 激情久久网 | 五月婷婷,六月婷婷| 一本久久亚洲五月婷婷| 99久在线观看| 久久婷婷一级片| 99er免费在线观看| 亚洲激情视频在线观看| 久久精彩视频99| 久久五月丁香综合17C| 日韩99视频| 色九九九综合| 婷婷亚洲丁香五月| 99re这里只有| 色婷婷丁香综合中文字幕| www,五月丁,com| 六月激情网| AA久久| 深爱激情网五月天| 中文字幕日本最新乱码视频| 国产99热| 久久激情网| 香港九九六区八区99| 五月丁香六月欧美综合| 夜夜资源站| 啪精品| 亚洲精品激情| 激情婷婷五月天| 婷婷五月激情四月综合 | 五月花综合网| 久久五月激情综合| 国产综合81p| 丁香五月天堂| 北条麻妃九九九国产精品视频| 激情99热| 97碰在线视频| 亚洲AV综合在线观看| 色老久久| 欧美三级级99久久| 中文国产五月天| 婷婷五月激情基地| 五月色丁香婷婷中文字幕| 天天色视频| 色色色综合网| 97 A I色色| 久久婷丁香五月| WWW.99视频| 91日日日| 岛国AV网| 丁香五月婷综合| 99热这里全是精品| 美女婷婷激情亚洲| 九九热这里只有精品9| 九九色网专区| er99免费视频在线| 99免费超碰在线| www激情网| 狠狠精品干练久久久无码中文字幕| 五月激情开心婷婷| 日本欧美成人片AAAA| 综合99在线| 中文字幕乱码亚洲精品一区| 天天做天天要天天爽| 激情五月婷婷| 玖操97| 大香蕉视频99| 亚洲小说欧美激情| 五月婷婷 激情按摩| 色色免费网战视频| 99热一本久道| 丁香五月色| 久久久久久99精品无码| 丁香综合网| 日本色婷婷| 91丨九色丨大屁股| 五月花婷婷最新| 五月天福利影院导航| 五月激情婷婷开心| 成人资源在线| 蜜臀av粉嫩av懂色av| 五月丁香婷婷综合| 激情婷婷五月天| 麻豆123区| 日操熟女| 激情六月婷婷| 国产亚洲99久久精品| 激情五月综合| A色色| 亚洲激情五月| 一区二区免费看| 激情网五夜婷婷| 五月丁香六月激情| 婷婷四色五月| 丁香香蕉婷婷| 成人AV在线电影| 天天天天天操| 五月天婷婷青青草| 99热免费| 天天爽天天爽天天爽天天爽天天爽天天爽天天| 人人操av| 激情九九这里只有精品| www91在线| 香蕉久久国产AV一区二区| 欧美日韓成人亚洲精品另类| 日本在线观看aaa 99| 五月丁香成人| 色五月婷婷狠狠撸| 狠狠色中色| a在线观看| 99精品色色| 亚洲欧洲一二| www.激情五月| 天天射色五月天| 大香蕉中文| 色欲一区二区三区精品A片| 可以直接看的av| 五月丁香狠狠爱| 日本高清不卡免费一区二区三区| 超碰激情网|