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

ARTICLE DETAIL

資訊詳情

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

RRT路徑規(guī)劃實(shí)戰(zhàn):3自由度機(jī)械臂無碰撞軌跡的MATLAB實(shí)現(xiàn)

RRT路徑規(guī)劃實(shí)戰(zhàn):3自由度機(jī)械臂無碰撞軌跡的MATLAB實(shí)現(xiàn) 這陣子剛好在做機(jī)械臂相關(guān)的項(xiàng)目把基于RRT算法的3自由度機(jī)械臂路徑規(guī)劃器整理了出來。這個(gè)項(xiàng)目的目標(biāo)很明確在存在圓形障礙物的二維平面中給定機(jī)械臂的初始關(guān)節(jié)角度和目標(biāo)關(guān)節(jié)角度自動(dòng)規(guī)劃出一條無碰撞路徑全程用MATLAB實(shí)現(xiàn)。RRT算法在這個(gè)場景里發(fā)揮得很穩(wěn)定3自由度機(jī)械臂的關(guān)節(jié)空間采樣、碰撞檢測、路徑平滑這些環(huán)節(jié)我都踩過不少坑這篇就把完整的思路、代碼和調(diào)試經(jīng)驗(yàn)一起寫出來。適用人群正在學(xué)機(jī)器人運(yùn)動(dòng)規(guī)劃的學(xué)生、要做課程設(shè)計(jì)的同學(xué)、剛接觸機(jī)械臂仿真的工程師。整個(gè)過程不依賴額外工具箱代碼邏輯拆開講清楚拿過去修改參數(shù)就能跑。下面直接進(jìn)入正題。1. 項(xiàng)目思路與方案選型1.1 為什么選RRT先看路徑規(guī)劃問題本身機(jī)械臂路徑規(guī)劃的本質(zhì)是在機(jī)械臂的構(gòu)型空間里找一條從起點(diǎn)到終點(diǎn)的連續(xù)曲線曲線上每個(gè)點(diǎn)對(duì)應(yīng)的機(jī)械臂姿態(tài)都不能碰到障礙物。這里有個(gè)關(guān)鍵概念叫構(gòu)型空間C-space3自由度機(jī)械臂的構(gòu)型空間就是一個(gè)三維空間每個(gè)維度對(duì)應(yīng)一個(gè)關(guān)節(jié)角度空間中任意一個(gè)點(diǎn)就代表一組關(guān)節(jié)角度組合。在C空間里做規(guī)劃最大的麻煩是障礙物形狀會(huì)變得非常復(fù)雜。工作空間里的一個(gè)圓形障礙物映射到C空間里往往是一團(tuán)扭曲的不規(guī)則形狀而且隨著自由度增加這個(gè)形狀會(huì)越來越難顯式表達(dá)。這直接導(dǎo)致了柵格法、A*這類需要預(yù)先離散化空間的方法在高維下不太可行——三維還好四維、五維的柵格數(shù)量指數(shù)增長內(nèi)存和計(jì)算都扛不住。RRTRapidly-exploring Random Tree快速擴(kuò)展隨機(jī)樹恰恰繞開了這個(gè)難題。它不做空間離散化而是靠隨機(jī)采樣不斷向外擴(kuò)展樹結(jié)構(gòu)讓樹逐步覆蓋C空間的可通行區(qū)域。對(duì)障礙物的處理方式只有一個(gè)布爾判斷當(dāng)前擴(kuò)展出來的新節(jié)點(diǎn)會(huì)不會(huì)碰撞。這就不需要把障礙物邊界解析出來只需要一個(gè)可以隨時(shí)調(diào)用的碰撞檢測函數(shù)就行。這也是RRT在高維規(guī)劃里能成為主流方案的根本原因。RRT還有一個(gè)重要性質(zhì)是概率完備當(dāng)采樣次數(shù)足夠多時(shí)如果路徑存在找到它的概率趨向于1。雖然它不像A*那樣保證最優(yōu)但對(duì)機(jī)械臂規(guī)劃場景來說能快速找到一條無碰撞路徑才是第一優(yōu)先級(jí)最優(yōu)性可以靠后處理來優(yōu)化。1.2 在關(guān)節(jié)空間規(guī)劃還是在直角空間規(guī)劃機(jī)械臂路徑規(guī)劃有兩種常見思路一種直接在工作空間直角坐標(biāo)空間規(guī)劃末端軌跡再通過逆運(yùn)動(dòng)學(xué)轉(zhuǎn)成關(guān)節(jié)角另一種就是在關(guān)節(jié)空間里直接規(guī)劃。這個(gè)項(xiàng)目我選擇的是后者原因有兩個(gè)。第一關(guān)節(jié)空間規(guī)劃天然規(guī)避了逆運(yùn)動(dòng)學(xué)的多解和奇異問題。3自由度機(jī)械臂在平面上操作時(shí)末端位置加上姿態(tài)約束逆解數(shù)量不止一個(gè)規(guī)劃時(shí)還需要處理解的連續(xù)性。而在關(guān)節(jié)空間里每個(gè)節(jié)點(diǎn)就是一組關(guān)節(jié)角度拿到的路徑直接就是控制指令不存在歧義。第二關(guān)節(jié)空間規(guī)劃能充分利用機(jī)械臂的冗余靈活性。末端在直角空間看似需要繞過某個(gè)點(diǎn)但機(jī)械臂可能有多種彎曲方式來達(dá)到同樣效果。如果只盯著末端位置規(guī)劃很容易丟掉那些末端不動(dòng)但關(guān)節(jié)在大范圍運(yùn)動(dòng)的可行解。RRT在關(guān)節(jié)空間采樣時(shí)天然就把這些可能性都搜索進(jìn)去了。當(dāng)然關(guān)節(jié)空間規(guī)劃也有它的麻煩工作空間里的圓形障礙物在C空間里是歪歪扭扭的調(diào)試時(shí)直觀性差一些。所以我的代碼里特意加了可視化函數(shù)把機(jī)械臂當(dāng)前姿態(tài)和工作空間障礙物同時(shí)畫出來這樣雖然規(guī)劃在C空間做但每擴(kuò)展一個(gè)節(jié)點(diǎn)都能直觀看到機(jī)械臂的實(shí)際位形。1.3 圓形障礙物怎么建模才高效這個(gè)項(xiàng)目用圓形障礙物是因?yàn)樵诠ぷ髦羞@類模型很常見——比如機(jī)械臂周圍的圓形立柱、圓柱形安全緩沖區(qū)域都可以簡化成圓來處理。更重要的是圓的幾何性質(zhì)讓碰撞檢測變得特別簡潔只需計(jì)算線段到圓心的最短距離和半徑比一下就能得出結(jié)果。機(jī)械臂的每根連桿可以抽象成一條線段第i段連桿就是從關(guān)節(jié)i-1到關(guān)節(jié)i的連線。碰撞檢測就轉(zhuǎn)化為對(duì)機(jī)械臂的每一段連桿計(jì)算它到每個(gè)障礙物圓心的最短距離如果這個(gè)距離小于障礙物半徑就說明發(fā)生了碰撞。這樣的建模方式還有一層好處是便于擴(kuò)展。如果不想讓機(jī)械臂貼著障礙物走可以對(duì)半徑加一個(gè)安全余量相當(dāng)于把障礙物膨脹一圈。這個(gè)膨脹值可以來自機(jī)械臂連桿的實(shí)際半徑也可以來自工程上對(duì)安全距離的要求。改動(dòng)只涉及一個(gè)常量非常方便。2. 核心算法與關(guān)鍵實(shí)現(xiàn)細(xì)節(jié)2.1 RRT主循環(huán)采樣、最近鄰、擴(kuò)展RRT算法的思路用一句話總結(jié)就是從起點(diǎn)開始不斷隨機(jī)采樣C空間中的點(diǎn)然后讓樹朝著采樣點(diǎn)生長直到樹覆蓋到目標(biāo)點(diǎn)附近。拆開來看主循環(huán)里每輪循環(huán)只干四件事。一是采樣。每次迭代以一定概率在C空間范圍內(nèi)均勻隨機(jī)采樣一個(gè)點(diǎn)以另一個(gè)概率直接取目標(biāo)點(diǎn)作為采樣點(diǎn)。直接取目標(biāo)點(diǎn)的這個(gè)概率叫目標(biāo)偏置goal bias作用是把樹往目標(biāo)方向拽加快收斂。我做實(shí)驗(yàn)時(shí)發(fā)現(xiàn)偏置設(shè)在0.05到0.15之間效果比較好太高會(huì)讓樹過早陷入局部區(qū)域太低則收斂太慢。二是找最近鄰節(jié)點(diǎn)。在當(dāng)前已經(jīng)生成的樹里找到距離采樣點(diǎn)最近的那個(gè)節(jié)點(diǎn)。距離度量直接用關(guān)節(jié)空間里的歐氏距離。這里有個(gè)小細(xì)節(jié)如果某個(gè)關(guān)節(jié)的角度范圍是-pi到pi那1.9π和-1.9π在數(shù)值上相距很遠(yuǎn)但實(shí)際只在0.2π會(huì)出問題。處理辦法是控制角度范圍或者使用角度差的最小環(huán)繞距離我在代碼里直接給每個(gè)關(guān)節(jié)都加了邊界約束所以沒遇到這個(gè)坑。三是擴(kuò)展。從最近鄰節(jié)點(diǎn)出發(fā)沿著指向采樣點(diǎn)的方向走一個(gè)固定步長得到一個(gè)新節(jié)點(diǎn)。步長的選擇直接影響規(guī)劃質(zhì)量步長太大生成的路徑粗糙而且容易跨過狹窄通道甚至穿過障礙物步長太小樹擴(kuò)展太慢迭代次數(shù)需求大幅增加。對(duì)3自由度機(jī)械臂來說我常用的步長是0.1到0.2弧度具體影響后面實(shí)驗(yàn)部分會(huì)有對(duì)比。四是碰撞檢測。新節(jié)點(diǎn)生成后要檢查從最近鄰節(jié)點(diǎn)到新節(jié)點(diǎn)之間這段路徑是否與障礙物碰撞。注意不能只檢查新節(jié)點(diǎn)一個(gè)點(diǎn)因?yàn)槁窂蕉慰赡艽Χ^。正確做法是把這段路徑插值成多個(gè)中間點(diǎn)逐一檢測。我在check_collision_motion函數(shù)里默認(rèn)插值10個(gè)點(diǎn)效果足夠穩(wěn)定。整個(gè)循環(huán)一直執(zhí)行到新節(jié)點(diǎn)距離目標(biāo)點(diǎn)小于閾值且新節(jié)點(diǎn)到目標(biāo)點(diǎn)之間無碰撞為止或者達(dá)到最大迭代次數(shù)放棄。目標(biāo)容差我通常設(shè)0.05到0.1弧度太嚴(yán)苛?xí)屗惴ê茈y收斂太寬松則終點(diǎn)的精度不行。2.2 正運(yùn)動(dòng)學(xué)與碰撞檢測的配合碰撞檢測需要知道機(jī)械臂在給定關(guān)節(jié)角下的實(shí)際位形這就用到正運(yùn)動(dòng)學(xué)。平面3R機(jī)械臂的正運(yùn)動(dòng)學(xué)不需要復(fù)雜的DH參數(shù)表直接用幾何累加法就行。從基座開始初始姿態(tài)角設(shè)為0然后依次疊加每個(gè)關(guān)節(jié)角每段連桿的終點(diǎn)坐標(biāo)就是上一段終點(diǎn)加上當(dāng)前段長度乘以旋轉(zhuǎn)后的單位方向向量。這樣一來給定一組(theta1, theta2, theta3)我就能算出三個(gè)關(guān)節(jié)點(diǎn)和末端點(diǎn)的坐標(biāo)。機(jī)械臂的三段連桿分別是基座到關(guān)節(jié)1、關(guān)節(jié)1到關(guān)節(jié)2、關(guān)節(jié)2到末端。碰撞檢測時(shí)只要對(duì)這三條線段分別進(jìn)行線段-圓距離計(jì)算即可。線段到圓心的最短距離計(jì)算標(biāo)準(zhǔn)做法是用向量投影。把圓心向線段所在直線投影如果投影點(diǎn)落在線段內(nèi)部最短距離就是投影點(diǎn)到圓心的距離如果投影點(diǎn)落在延長線上最短距離就是圓心到較近端點(diǎn)的距離。用MATLAB實(shí)現(xiàn)時(shí)用clamp函數(shù)把投影參數(shù)限制在0到1之間就行代碼很短。碰撞檢測里還有一個(gè)工程判斷機(jī)械臂的基座和關(guān)節(jié)本身也有體積。項(xiàng)目里為簡化處理把整個(gè)機(jī)械臂視作三根無半徑的線段用膨脹障礙物半徑的方式來補(bǔ)償連桿的實(shí)際粗細(xì)。這樣既保持了計(jì)算簡單又不至于讓規(guī)劃出來的路徑在實(shí)際執(zhí)行時(shí)真的撞上。2.3 路徑平滑與剪枝RRT直接生成的路徑有個(gè)通病大量冗余的折線拐彎因?yàn)槊總€(gè)節(jié)點(diǎn)都是隨機(jī)采樣擴(kuò)展出來的樹生長時(shí)根本不會(huì)考慮走直線。直接拿這條路徑去控制機(jī)械臂運(yùn)動(dòng)過程會(huì)非常別扭關(guān)節(jié)角速度也會(huì)頻繁突變。所以規(guī)劃出的路徑必須做后處理。我用的后處理方法是貪心剪枝。思路很直觀從路徑的起點(diǎn)開始依次嘗試跳過中間節(jié)點(diǎn)直接連接到盡量遠(yuǎn)的節(jié)點(diǎn)只要這一段路徑無碰撞就直接跳過中間那些節(jié)點(diǎn)。重復(fù)這個(gè)過程直到到達(dá)終點(diǎn)。這個(gè)方法雖然原理簡單但效果立竿見影路徑點(diǎn)數(shù)通常能減少60%以上路徑長度也能縮短不少。貪心剪枝有個(gè)細(xì)節(jié)跳過的距離越遠(yuǎn)越好所以內(nèi)層循環(huán)要從路徑末端往起點(diǎn)方向倒著找。找到第一個(gè)無碰撞的遠(yuǎn)端節(jié)點(diǎn)后就跳轉(zhuǎn)過去不用再找更近的。這個(gè)策略能保證每次跳躍都是當(dāng)前可達(dá)的最遠(yuǎn)距離路徑最緊湊。如果還需要進(jìn)一步平滑可以在剪枝后的路徑上用B樣條或貝塞爾曲線做插值但要注意插值后的路徑可能會(huì)偏離原路徑必須重新做碰撞檢測。項(xiàng)目當(dāng)前的版本只保留了貪心剪枝對(duì)3自由度機(jī)械臂來說剪枝后的路徑已經(jīng)足夠平滑再上曲線插值性價(jià)比不高。3. MATLAB完整實(shí)現(xiàn)與代碼解讀3.1 整體代碼結(jié)構(gòu)與數(shù)據(jù)組織工程文件我按功能拆成了7個(gè)文件職責(zé)清晰方便復(fù)用main.m % 主腳本場景設(shè)置、調(diào)用規(guī)劃器、可視化 plan_rrt_3dof.m % RRT規(guī)劃主函數(shù) forward_kinematics.m % 正運(yùn)動(dòng)學(xué)關(guān)節(jié)角 - 關(guān)節(jié)位置 check_collision.m % 碰撞檢測判斷單點(diǎn)位形是否碰撞 check_collision_motion.m % 運(yùn)動(dòng)段碰撞檢測判斷路徑段是否碰撞 nearest_neighbor.m % 最近鄰搜索 smooth_path.m % 貪心路徑剪枝 draw_robot.m % 繪制機(jī)械臂當(dāng)前姿態(tài)和障礙物數(shù)據(jù)結(jié)構(gòu)方面障礙物用一個(gè)結(jié)構(gòu)體數(shù)組保存每個(gè)元素含cx、cy、r三個(gè)字段分別代表圓心x坐標(biāo)、圓心y坐標(biāo)和半徑。規(guī)劃樹用兩個(gè)變量維護(hù)nodes是一個(gè)N行3列的矩陣每行存一組關(guān)節(jié)角parent是一個(gè)N維向量存每個(gè)節(jié)點(diǎn)在nodes里的父節(jié)點(diǎn)索引。正運(yùn)動(dòng)學(xué)函數(shù)返回的是一個(gè)2行4列的矩陣四列分別是基座、關(guān)節(jié)1、關(guān)節(jié)2、末端的位置坐標(biāo)。這個(gè)數(shù)據(jù)結(jié)構(gòu)在碰撞檢測和可視化里都能直接復(fù)用省去重復(fù)計(jì)算的麻煩。3.2 關(guān)鍵函數(shù)實(shí)現(xiàn)解析先看正運(yùn)動(dòng)學(xué)函數(shù)代碼很簡潔function pts forward_kinematics(theta, L) % 輸入theta [theta1, theta2, theta3]L [L1, L2, L3] % 輸出pts 為 2x4 矩陣每列為基座/關(guān)節(jié)1/關(guān)節(jié)2/末端坐標(biāo) pts zeros(2, 4); phi 0; for i 1:3 phi phi theta(i); pts(:, i1) pts(:, i) L(i) * [cos(phi); sin(phi)]; end end這里phi是累積角度也就是第i段連桿在世界坐標(biāo)系里的實(shí)際朝向。為什么是累加而不是直接用theta(i)因?yàn)槠矫鏅C(jī)械臂的連桿方向是前面所有關(guān)節(jié)角度的總和這個(gè)細(xì)節(jié)新手最容易出錯(cuò)。碰撞檢測函數(shù)function hit check_collision(theta, obstacles, L) pts forward_kinematics(theta, L); hit false; for i 1:3 if isempty(obstacles) continue; end p1 pts(:, i); p2 pts(:, i1); for k 1:length(obstacles) dist point_segment_distance(obstacles(k).cx, obstacles(k).cy, p1, p2); if dist obstacles(k).r hit true; return; end end end endpoint_segment_distance是計(jì)算點(diǎn)到線段最短距離的子函數(shù)邏輯就是前面說的向量投影加clamp這里不展開寫。注意我加了障礙物為空的判斷這樣即使場景里不放障礙物也能正常跑。運(yùn)動(dòng)段碰撞檢測函數(shù)用來檢查路徑段是否穿障礙function hit check_collision_motion(theta_start, theta_end, obstacles, L, num_samples) if nargin 5 num_samples 10; end for i 0:num_samples ratio i / num_samples; theta theta_start * (1 - ratio) theta_end * ratio; if check_collision(theta, obstacles, L) hit true; return; end end hit false; end這里用線性插值把路徑段切成11個(gè)中間點(diǎn)來檢測。步長如果在0.1左右相鄰兩個(gè)點(diǎn)之間角度差很小10個(gè)中間點(diǎn)足夠覆蓋不會(huì)出現(xiàn)漏檢。RRT主函數(shù)的核心循環(huán)代碼如下function [path, tree_nodes, tree_parent] plan_rrt_3dof(start, goal, obstacles, L, bounds, params) tree_nodes start(:); tree_parent 0; max_iter params.max_iter; step_size params.step_size; goal_bias params.goal_bias; goal_tol params.goal_tol; for iter 1:max_iter % 采樣 if rand goal_bias sample goal; else sample bounds(:, 1) rand(1, 3) .* (bounds(:, 2) - bounds(:, 1)); end % 最近鄰 idx nearest_neighbor(tree_nodes, sample); % 擴(kuò)展 delta sample - tree_nodes(idx, :); dist norm(delta); if dist 1e-8 continue; end new_node tree_nodes(idx, :) step_size * delta / dist; new_node max(min(new_node, bounds(:, 2)), bounds(:, 1)); % 碰撞檢測 if check_collision(new_node, obstacles, L) continue; end if check_collision_motion(tree_nodes(idx, :), new_node, obstacles, L) continue; end % 加入樹 tree_nodes(end1, :) new_node; tree_parent(end1) idx; % 檢查是否到達(dá)目標(biāo)附近 if norm(new_node - goal) goal_tol if ~check_collision_motion(new_node, goal, obstacles, L) tree_nodes(end1, :) goal; tree_parent(end) length(tree_nodes) - 1; % 修正goal掛在new_node下 path trace_path(tree_nodes, tree_parent); return; end end end path []; end這段代碼里有兩個(gè)細(xì)節(jié)值得說明。一是擴(kuò)展完后的邊界裁剪把new_node限制在關(guān)節(jié)角度范圍內(nèi)防止采樣越界二是到達(dá)目標(biāo)時(shí)的處理要把目標(biāo)點(diǎn)也加進(jìn)樹里然后通過回溯parent鏈提取路徑。回溯時(shí)從最后一個(gè)節(jié)點(diǎn)往前找父節(jié)點(diǎn)一直到根節(jié)點(diǎn)然后把節(jié)點(diǎn)順序倒過來就是正向路徑。貪心剪枝函數(shù)function smoothed smooth_path(path, obstacles, L) smoothed path(1, :); i 1; while i size(path, 1) for j size(path, 1):-1:(i1) if ~check_collision_motion(path(i, :), path(j, :), obstacles, L) smoothed(end1, :) path(j, :); i j; break; end end end end外層循環(huán)每跳到一個(gè)新節(jié)點(diǎn)就繼續(xù)向后找更遠(yuǎn)的可達(dá)節(jié)點(diǎn)直到終點(diǎn)。注意內(nèi)層循環(huán)倒序查找保證每次跳轉(zhuǎn)都是最遠(yuǎn)可達(dá)。3.3 參數(shù)設(shè)置與調(diào)試經(jīng)驗(yàn)main.m里的參數(shù)初始化是我反復(fù)調(diào)出來的經(jīng)驗(yàn)值L [1.0, 0.8, 0.6]; % 三節(jié)連桿長度 bounds [-pi, pi; -pi, pi; -pi, pi]; % 關(guān)節(jié)角度范圍 start [-1.2, 0.5, 0.3]; % 初始關(guān)節(jié)角 goal [1.5, -0.8, 0.6]; % 目標(biāo)關(guān)節(jié)角 params.max_iter 3000; params.step_size 0.15; params.goal_bias 0.1; params.goal_tol 0.08;調(diào)試時(shí)我建議先開一個(gè)RNG種子rng(42)這樣每次跑出來的結(jié)果可以復(fù)現(xiàn)定位問題會(huì)容易很多。如果某次規(guī)劃失敗先看是樹沒擴(kuò)展起來還是擴(kuò)展到了目標(biāo)區(qū)域但卡在最后一步。前者通常是step_size太大或者max_iter太小后者通常是goal_tol太嚴(yán)或者目標(biāo)點(diǎn)本身在障礙物內(nèi)部。4. 實(shí)驗(yàn)結(jié)果與參數(shù)影響分析4.1 典型場景測試我搭了三個(gè)典型測試場景。場景A是單個(gè)圓形障礙物擋在機(jī)械臂伸展路徑中間場景B是兩個(gè)障礙物形成走廊場景C是三個(gè)障礙物在狹窄空間里形成遮擋。三個(gè)場景下RRT都能穩(wěn)定找到路徑區(qū)別在于收斂速度和路徑質(zhì)量。以場景A為例起始關(guān)節(jié)角(-1.2, 0.5, 0.3)目標(biāo)關(guān)節(jié)角(1.5, -0.8, 0.6)在默認(rèn)參數(shù)下大約迭代400到600次就能找到路徑生成的路徑點(diǎn)數(shù)量在30個(gè)左右剪枝后只剩5到7個(gè)點(diǎn)。整條路徑的關(guān)節(jié)角度變化均勻沒有突變。記錄一組典型結(jié)果如下場景障礙物數(shù)迭代次數(shù)剪枝前路徑點(diǎn)數(shù)剪枝后路徑點(diǎn)數(shù)規(guī)劃耗時(shí)(ms)A1486336380B2730479560C312405812890耗時(shí)的數(shù)據(jù)在普通PC上跑出來大概就是這個(gè)量級(jí)MATLAB本身就是解釋執(zhí)行性能可以接受。場景C迭代次數(shù)明顯更高是因?yàn)檎系K物多導(dǎo)致采樣點(diǎn)落在碰撞區(qū)域的概率大樹的生長效率下降。4.2 步長與目標(biāo)偏置對(duì)性能的影響我把step_size從0.05到0.3逐個(gè)跑了一遍每組跑50次統(tǒng)計(jì)成功率。結(jié)果如下步長(rad)成功率平均迭代次數(shù)平均路徑長度(rad)路徑點(diǎn)數(shù)(剪枝后)0.0592%11206.8100.196%6205.980.1594%5105.470.282%3805.260.361%2904.95可以明顯看到步長太大時(shí)成功率急劇下降。原因是步長超過狹窄通道的寬度后路徑段兩頭無碰撞但中間可能穿墻即使插值檢測也無法把每一個(gè)中間點(diǎn)都卡住。步長太小時(shí)成功率略降且迭代次數(shù)暴增主要因?yàn)闃湓谡系K物邊緣大量采樣卻無法通過。goal_bias的影響也做了測試0.05時(shí)收斂偏慢但探索隨機(jī)性高適合復(fù)雜障礙環(huán)境0.1到0.15是性能均衡區(qū)間0.2以上容易在快速逼近目標(biāo)的過程中被障礙物擋住最終在局部死循環(huán)成功率不升反降。實(shí)際使用中建議在0.08到0.12之間取值。4.3 算法局限與改進(jìn)方向RRT最大的短板是路徑質(zhì)量非最優(yōu)。它的路徑長度通常比實(shí)際最優(yōu)長10%到30%而且隨機(jī)性強(qiáng)每次規(guī)劃結(jié)果都不一樣。如果項(xiàng)目對(duì)路徑長度和關(guān)節(jié)平穩(wěn)性有硬性要求可以考慮兩個(gè)改進(jìn)方向。一是RRT算法。RRT在RRT的基礎(chǔ)上增加了重選父節(jié)點(diǎn)和重布線的機(jī)制每一步擴(kuò)展完都會(huì)檢查是否能通過新節(jié)點(diǎn)重新連接鄰近節(jié)點(diǎn)來改善代價(jià)。代價(jià)函數(shù)可以用路徑長度RRT*能收斂到漸近最優(yōu)。代價(jià)是計(jì)算量翻倍每個(gè)新節(jié)點(diǎn)都要搜索鄰近區(qū)域并運(yùn)行多次碰撞檢測。二是混合策略先用RRT快速找到一條可行路徑再用A*在路徑周圍的局部區(qū)域搜索更優(yōu)解或直接對(duì)RRT路徑做多次貪心剪枝加隨機(jī)擾動(dòng)來優(yōu)化。這種混合方法在工程里很實(shí)用算是對(duì)時(shí)間和質(zhì)量的折中。5. 常見問題與踩坑記錄5.1 高頻問題速查表測試過程中我把遇到的高頻問題整理成了下面的速查表問題現(xiàn)象可能原因解決方法樹一直長但找不到路徑目標(biāo)點(diǎn)本身在障礙物內(nèi)或goal_tol設(shè)置過小檢查目標(biāo)點(diǎn)是否無碰撞放寬goal_tol到0.1以上路徑明顯穿過障礙物運(yùn)動(dòng)段插值點(diǎn)數(shù)太少把check_collision_motion的num_samples提高到20規(guī)劃結(jié)果每次都不一樣RRT是隨機(jī)算法需要復(fù)現(xiàn)時(shí)用rng(seed)固定隨機(jī)種子某些關(guān)節(jié)角度超出限制擴(kuò)展時(shí)沒有做邊界約束添加邊界clamp同時(shí)檢查bounds設(shè)置在狹窄通道中成功率低步長太大樹穿不過縫隙縮小step_size到0.08以下增大max_iter生成的路徑抖動(dòng)嚴(yán)重RRT路徑冗余折點(diǎn)多使用貪心剪枝必要時(shí)加B樣條平滑起始點(diǎn)或目標(biāo)點(diǎn)碰撞檢測報(bào)true坐標(biāo)系不一致或障礙物初始化錯(cuò)位先畫機(jī)械臂位形和障礙物確認(rèn)布局正確這里特別說下目標(biāo)是碰撞的情況。我調(diào)試時(shí)經(jīng)常忘記檢查目標(biāo)點(diǎn)本身是否在障礙物內(nèi)部結(jié)果樹都長到目標(biāo)旁邊了卻因?yàn)槟繕?biāo)點(diǎn)碰撞而無法結(jié)束循環(huán)。建議在main.m里加一個(gè)預(yù)檢查規(guī)劃前先對(duì)start和goal各跑一次check_collision如果碰撞就直接報(bào)錯(cuò)退出省得浪費(fèi)迭代次數(shù)。5.2 實(shí)戰(zhàn)心得提高規(guī)劃成功率的小技巧第一個(gè)技巧是給障礙物加膨脹半徑。規(guī)劃時(shí)用的障礙物半徑略大于實(shí)際物理半徑比如物理半徑0.2規(guī)劃時(shí)用0.25。這樣算出來的路徑天然離障礙物有一定安全距離后面就算控制有誤差也不會(huì)真的碰上。我通常在main.m里定義四個(gè)量物理半徑、規(guī)劃半徑、膨脹增量、連桿半徑膨脹增量取連桿半徑加一點(diǎn)安全余量。第二個(gè)技巧是C空間的采樣范圍不要用滿-pi到pi而是根據(jù)機(jī)械臂實(shí)際關(guān)節(jié)限位來設(shè)。有些關(guān)節(jié)轉(zhuǎn)動(dòng)范圍只有-pi/2到pi/2采樣范圍設(shè)大了會(huì)增加大量無效采樣。這個(gè)對(duì)規(guī)劃效率的影響比我預(yù)期的大得多實(shí)測能帶來30%左右的迭代次數(shù)節(jié)省。第三個(gè)技巧是可視化調(diào)試。我寫代碼時(shí)習(xí)慣每擴(kuò)展幾十個(gè)節(jié)點(diǎn)就刷新一次圖形把樹節(jié)點(diǎn)、機(jī)械臂位形和障礙物一起畫出來。這樣一旦出問題能直觀看到樹是被哪塊障礙物擋住還是采樣有問題比盯著數(shù)值猜原因效率高很多。調(diào)試完成后再把刷新關(guān)掉跑正式實(shí)驗(yàn)就快了。還有一個(gè)容易被忽視的點(diǎn)MATLAB的向量化和循環(huán)寫法對(duì)規(guī)劃性能影響巨大。RRT主循環(huán)本身是個(gè)串行循環(huán)很難向量化但碰撞檢測里如果障礙物數(shù)量不多可以把所有障礙物一次性向量化計(jì)算距離替代用for循環(huán)遍歷障礙物。障礙物數(shù)量到10個(gè)以上時(shí)這能省下不少時(shí)間。最后提一下路徑平滑的度。貪心剪枝雖然能大幅減少路徑點(diǎn)但我在實(shí)測中發(fā)現(xiàn)剪枝后的路徑可能會(huì)離障礙物比較近因?yàn)槠交^程是盡量拉直拉直后的路徑段可能擦著障礙物邊緣過去。所以我在smooth_path的所有跳躍檢查里用的也是膨脹后的障礙物半徑保證平滑后依然有安全裕度。這個(gè)細(xì)節(jié)有幾次差點(diǎn)漏掉確實(shí)值得專門寫出來。這個(gè)項(xiàng)目做到后面我發(fā)現(xiàn)RRT最迷人的地方在于它把復(fù)雜的高維規(guī)劃問題簡化成了采樣碰撞檢測兩個(gè)基本操作。只要這兩個(gè)點(diǎn)做扎實(shí)再復(fù)雜的環(huán)境也能跑起來。代碼里還有很多可以繼續(xù)打磨的地方比如改成RRT*、加入軌跡時(shí)間參數(shù)化、或者換到三維空間去規(guī)劃這些都是自然延伸的方向。目前在3自由度平面機(jī)械臂上這套方案已經(jīng)足夠可靠跑仿真和課程設(shè)計(jì)完全夠用。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
激情六月天| 亚洲日韩一页精品发布| 888久久久| 婷婷五月婷婷五月天| 婷婷六月天| 一本色道久久综合狠狠躁小说| 亚洲精品无码一区二区| 久久99精品久久久久久三级| 天天狠狠六月婷丁香影院| 丁香六月五月天| 91视频久久久| 99色这里| 五月天激情四射网站| 五月丁香啪啪| 成人美女网| 九月色婷婷综合| 二色av| 亚洲狠狠狠| 超碰在线成人| 五月婷婷成人| 97碰免费视频在线| 色五月综合网| 国产乱妇无乱码大黄AA片| www.91操| 久久久婷丁香五月| 激情五月天综合网| 99精品久久| 日本啪啪天堂| 婷婷丁香六月五月天| WWW.99热| 99惹精品视频| 人人爱干人人爱草| 9999热免费视频视频| 天天操天天爱天天玩| 日本123区日韩欧美不卡在线看| 五月六月婷婷| 日 日干 日日做| 拍色综合| 久久9视频| 99思思热只有在这里看| 久久国产高清| 丁香九月激情| 大香蕉520| 五月婷婷色综图片| AV伊人青草丁香六月| 天天做天天爽| 色婷婷9| 人人草人| 色五月天成人在线| 最新av在线观看| 丁香网站| 中文字幕网伦射乱中文| 丁香五月影视| 色婷婷成人在线| 成人精品视频99在线观看免费| 亚洲精品无码99热| 五月丁香婷婷基地| 99热这里都是精品| 狠狠干思思热| 五月色婷婷中文字幕| 婷婷五月丁香激情色情| 九九激情视频| 操操碰| 五月丁香| 五月天婷婷无码| 色婷婷久久综| 任你躁XXXXX麻豆精品| 五月丁香六月综合激情无码软件亮点| 色欲色天天香综合| 五月丁香影院| 天天噪夜夜爽| 激情婷婷丁香五月| 99操久久| 久久婷婷丁香六月天| AV免费在线网站| 伊人啪啪网| 99啪在线| 丁香婷婷五月香蕉91| 五月丁香成人网| 欧美高潮9| 夜夜撸日日操| 天天干天天爽天天操| 亚洲成人av在线| 91丨九色丨熟女高潮| 九九99视频精品| 五月天另类图片区99| 精品无码久久久久久久久| 99热九九热| 久婷婷五月激情| 日韩三十六页| 亚韩在线视频| 艾小青av| 99 热| 亚洲第一成人无码A片| 91啪级电影| www.久久久久久久| 婷婷综合国产| 操大屄五月天视频| 日本视频不卡123区| 第五色色色婷婷| 丁香五月亭亭六月综合激情网| 97久久超碰| 丁香六月婷婷色XXXX| 狠狠色狠狠干| 国产婷婷久久| 国产午夜精品一区二区三区嫩草| 久久久五月天| 九月丁香五月婷婷| 亚洲精品国产精品乱码视99| 99热| 情欲禁地| 色婷婷色综合久久精品V| 婷婷六月激情| 色婷婷在线视频| 丁香六月婷婷久久综合| 九九在线这里只有精品视频| 性生活久久朋友人妻| 丁香五月六月久久综合| 2015WWW永久免费观看播放| 操人视频91| 人妻操日日| 亚洲av成人一区二区电影在线| 操人妻AV| 538任你爽视频不一样的| 色色色色色色色色色色色色色五月天| 六月婷久久| 亚洲一级AV在线免费播放| 久久999久久999久久999久久| 色噜噜狠狠色综合网| 中文字幕,综合,91| 在线,国产,色,热视频| 99热大全在线观看| 色婷婷九月| 婷婷五月色综合| 综合色播| 91日韩在线| 亚洲黄网在线| 99热大香蕉| 五月香蕉综合| 色欲天天综合| 五月好婷婷| 久久综合激情| 天色色综合网| 久久久999精品| 激情深爱综合| 久久人妻视频| 一级片操逼视频| 色综合色婷色基地| 深爱五月激情网| 婷婷五月天com| 国产精品成人AV在线| 五月色综合| 99久久精品国产色欲| 婷婷五月天色丁香| 99男人的天堂| 欧美色色日韩| 开心六月丁香五月婷婷| 开心激情站| 六月天婷婷| 影音先锋综合网| 他改变了拜占庭| Jh7Uf088VHafNm| 99ree6| 激情 五月 婷婷 丁香| 色综合天天综合成人网| 综合网精品99| 高清无码中文字幕aVDV| 婷婷精品| 天天玩夜夜操天天爽| 丁香婷婷社区| 啪色综合| 99热这里只有精品3| 玖玖午夜视频| 五月婷婷片| 毛片九九九九九九| 中文字幕欧美久久| 天天干天天做| 亚洲无码另类| 91人妻PORNY九色大屁股| 亚洲av网站在线观看| 婷婷婷婷色| 99热在线资源| 少妇AB又爽又紧无码网站| 五夜婷婷| 久热伊人| 天天操天天草天天草天天| 亚洲区1| 婷婷六月丁香欧美视频在线| 色综合久久中文| 九九碰九九爱97超| 婷婷综合精品视频97| 97涩婷婷婷婷基地| 五月丁香好婷婷A片网| 99视频色在线观看| 五月婷婷视频| 丁香五月首页| 六月婷婷开心| 九热在线这里有精品6| 国产永久一黄| 九九九九九九九九九九九九九九九九九九九在线视频 | www.久久9| 久久婷婷内射| 久久婷婷五月天激情唯美| 北京熟妇搡BBBB搡BBBB| 熟女色专区| 97综合视频在线| 操久久网| 五月天开心婷婷激情网站| 久久思思热视频| 深爱激情六月天| 日本激情综合| 亚洲人妻一区二区| 婷婷五六日| 成片免费播放| 99啪啪网| 色婷婷六月| 丁香五月Av| 久8色色| 天天肏天天插| 九九 激情 网| A片试看120分钟做受视频红杏 | 色婷久久| 五月花免费视频| 五月草影视| 六月丁香色色色| 99亚洲精美视频在线观看| 婷婷五月另类网站| 五月天婷婷色播综合在线| 五夜丁香| 国产超碰在线| 另类激情首页| 思思久久思思| 婷婷久热| 五月天婷婷基地丁香| 丁香六月欧美| 99久.| 97热久久| 五月婷免费视频| 日本3级片一区2区| 五月婷婷与六月丁香图片激情| 丁香色婷婷色手机免费在线| 九月丁香婷婷综合| 天天舔天天插天天爱| 婷婷色一二三区波多野结衣| www,com,五月色色| 欧美成人精品三区综合A片| 国产激情AV| 久久五月丁香| 99热免费18| 五月丁香六月片| 99在线免费视| 人人干人人操外国| 他改变了拜占庭| 热久久66| 91九色丨国产丨爆乳| 天天干天天插| 欧美色一级色| 99噜噜噜在线播放| 久热在线中文字幕色999舞| 久久久久久久人妻| 久久九九精彩| 日韩小视频在线99| 99热在这里只有免费精品| 色播五月综合网| 在线观看996精品| 国产无人区大片| 天天做天天爱天天摸| 婷婷月五天在线在线看| 五月总合激情网| 五月丁香综合伦理片| www.日本91| 99热这里只有精品8| 婷婷欧美| 97干欧美| 色婷婷五月天久久| 日本44久久在线| 超爽内射| 色婷婷综合网站| 九九色热| 九月色婷婷综合亚洲| 色情五月天导航| 婷婷丁香人妻| 九九热在线视频| 久久作爱| 婷婷四色成人综合色视| 亚洲第一成人无码A片| 激情综合五月婷婷| 九月婷婷激情| 亚洲激情五月| 久久免片| 亚洲妇女熟BBW| 五月婷婷二月丁香| 99在线精品视频| 伊人大香蕉爱聚| 五月婷婷co.m| 欧美精品XXXXBBBB| 久久精品性爱视频,| 91avse| 丁香五月婷综合| 亚洲精品一二三| 五月丁香久久综合色| 墨西哥毛片内射精| 久99精品视频| 五月天在线视频尤物视频在线看| AV性爱在线| 国产肥白大熟妇BBBB视频| 中文成人在线| 欧美大片免费播放器| 久久五月网| 九九热这里只有精品一| 五月丁小婷婷激情四射| 婷婷五月天开心激情网| 日韩av免费版| 久久婷婷综合色丁香| 六月丁香婷婷尤物| 五月婷狠狠| 国产日日夜夜操| 成人.在线日韩| 激情六月丁香| 99视频在线观看地址| 色综合综合色| AV在线中文| 中文字幕不卡+婷婷五月| 婷婷五月天Av| 久久9热好| 五月天成人网在线观看| BlACKEDRAW视频一区二区| 成人精品亚洲性爱| 婷婷丁香五另类网站| 国色天香成人网| 欧美精品999| 五月婷婷av在线| 99久久a线观| 丁香六月婷婷久久综合| 五月综合色| 日韩AV在线免费| 婷婷五月另类网站| 婷综合六月| 五月天婷亚洲综合在线嫩草网| 狠狠爱婷婷五月天| 久久久久久久久久久jjjj| 大香网伊人久久综合| 婷婷色在线观看| 大香蕉AV在线| 91久久综合亚洲噜噜成人在线 | 久久婷婷热| 婷婷丁香五月激情图片| 丁香婷婷五月| www.天天色综合| 亚洲黄色操逼| 精品国产AV色一区二区深夜久久| 丁香丁香激情网| 日本99婷婷| 99免费在线视频| 深爱激情AV| 精品爱欲五| 亚洲mm色| 《》【无码】想被搞到爽AV应募而来的超M素人 西纯子 10musume-011723-01 | 91人在线观看| 26uuu亚洲| 色就是色婷婷五月亚洲激情| 日本99婷婷| 草草夜夜操| 天天五月天综合网址| 丁香六月啪| 新激情综合| 久久精品99久久久久久| 97人人操人人爽| 亚洲VA口| 五月天婷婷綜合院| 国产精品噜噜在线视频| 变态另类9| 九9九9无码| 国产av第一专区| 大地9中文在线观看免费高清 | 五月天婷婷色| 色婷婷小说网| 天天插天天插天天插天天插| 日日夜夜狠狠干| 狠狠色婷婷六月激情网| 噜噜狠狠色综合久| 成人免费在线电影| 久久电影4399| 思思热这里只有精品视频666| 亚洲五月激情| 无码色色色色色| 一区二区成人电影| 99色6爱9热| 欧美日韩999| 色私五月婷婷| 九九热九九| 五月天婷婷一起草| 极品人妻videosss人妻| 丁香五月婷婷激情123| 狠狠狠夜夜夜| 一区二区乱码视频| 婷婷丁香五月网| 五月丁香婷婷深深爱| 99综合视频| 婷婷久久网| 天堂亚洲 在线| 免费看成人747474九号视频在线观看| 婷婷五月天丁香社区| 如何安全看伊人婷婷| 丁香伊人网| 久久丁香婷婷五月天| 色婷婷五月开心六月综合| 丁香五月婷婷六月婷| 五月花激情网| 激情综合女人网五月播播| 偷拍视频五月天| 五月婷婷影| 色狠狠综合入口| 少妇激情五月天| 香蕉久久国产AV一区二区| 国产99久| 91九色国产| 五月天激情小说婷婷基地| 99re这里只有精品在线观看| 国产成人综合网| 色综合久久久久| 午夜少妇在线观看视频| 操比激情五月| 色色综合日韩| 天天干电影| 91无码一区人妻A片蜜| 久久婷婷一级片| 久99视频在线观看| 婷婷色五月开心五月| 五月天六月丁香| 99色1| 婷激情五月| 狼人婷婷综合| 中文字幕成人网站| 色欲色天天香综合| 色播五月丁香| 婷婷久久网| 99超碰欧美| 亚洲色综合| 久久性爱网| 91vip在线观看| 婷婷六月天精品| 99热精品免费| 激情人妻蜜夜系列区| 五月丁香综合成人社区| 五月天.com| 婷婷五月成人| 丁香五月天天久久综合小说| 色婷婷偷拍| 婷婷91视频| 综合逼五月激情婷婷| 欧美激情综合| 久久久人妻久久久| 日本九九网| 欧美成人日韩| 操操自拍| 99久久久久久www| 欧美黄色韩日网| www.久操| 超碰在线观看9| 婷婷成人小说综合| 色播五月天婷婷老师| 天天干天天操天天爽| 婷婷九月激情网| 丁香婷婷五月综合影院| 色五月婷婷天堂| 久久99热这里只频精品6学生| 操91| 久婷婷五月激情| 免费在线观看av网站| 日日天天天| 激情五月丁香色婷婷| 人与禽A片啪啪| 久青操| 色色色色热| 一起草AV| 丁香丝袜五月| 七七九色| 欧美日韩成人综合9| 色XX综合网| 五月天色在线| 婷婷色婷婷亚洲成人| 熟女重口味αV| 综合深爱五月| 色婷婷性爱| 婷婷狠狠干| www.亚洲激情| 色娸娸综合网| 精品欧美一区二区三区久久久| 五月婷婷,六月丁香| 亚洲成人网站在线| 婷婷五月欧美综合| 91性高潮久久久久久久久| www激情| 成人免费120分钟啪啪| 超碰久热| 国産精品| 夜夜撸夜夜骑| 色五月婷婷中文字幕| 五月天婷婷7米| 六月丁香久久| yiqicaoav| 丁香五月手机在线| 欧洲精品爱爱| 婷婷丁香五月天色区| 激情www| 日本va视频| 狠狠狠狠操| 丁香五月亚洲| 激情五月丁香五月| 亚洲成人在线播放| 五月丁香六月激情综合| 天天激情视频| 99在线观看精品| 国产精品久久久久久久久久| 国产亚洲99| 五月丁香综合啪啪啪啪啪| 婷婷九月丁香中文| 五月婷婷丁香六月| 可以免费看的av网站| 五月香婷婷| 日日爽日日爽| www.minyis.com【JT】币址百万U预算可预付QQ2101460746 | 中文资源在线a| 色综合天天综合成人网| 久操激情| 五月天六月婷婷电影| 超碰97免费在线| 99热亚州综合| 人碰人人人玩91| 婷婷成人视频| 综合久久99| 精a品a| 噜噜噜噜婷婷五月天| 色丁香五月婷婷在线| 日日干夜夜干| 激情综合网激情五月天| 成人在线99| 色哟哟www| 亚洲视频码| 超碰99热精品在线| 五月天婷婷黄色视频| 午夜五月天| 屁股翘好撅高迎合跪趴| 操操操www.com| 婷婷五月天综合久久| 成人精品免费在线观看| 丁香五月激情宗合网| 被强行糟蹋的女人A片| 婷婷丁香激情五月天色色| 欧美性爱5月天天天看| 亚洲成人va| 99视频在线观看网址| 98永久精品| 色综合天天综合成人网| 婷婷成人五月天| www.五月婷婷| 蜜乳国产网站| 中文av网| 亚洲国产99| 五月天丁香成人社| 五月综合亚洲婷婷| 在线1青婷| 成人一级片| 中文毛片无遮挡高潮免费| 色婷丨日丨天丨综合久久| 五月天激日本色情在线| 人妻性爱av网站| 婷婷五月欧美| 日本三久久| 丁香色五月 97干| 色婷婷狠| 激情五月婷婷伊人| 婷婷色色网站| 婷婷五月视频| 狠狠九九婷婷韩| 亚洲天堂色色| 在线中文av| 国产成人亚洲综合A∨婷婷| 99热这里只有精品1025| 99热这里只有精品23| 97久久久| 亚洲乱码w在线观看| 色色免费网战视频| 五月天成人手机在线视频| 天天日天天爽夜夜爽| 性爱视频久久| 夜夜爱影院| 五月婷婷黄色毛片| 五月天综合区| 婷婷色婷婷| 五月成人丁香av91| 五月婷婷免费看| 97人人干| 99久久超级| 色天堂在线| 天天上天天爽| 五月天婷婷色色| 色综久久久| 日韩狠狠色| 亚洲丁香五月深爱五月| 类似婷婷激情综合网站| 丁香花五月天激情| 九九99精品视频在线观看| 再綫Av免费視品| 色婷婷电影网| 九九热这里只有精品9| 丁香五月天堂| 另类视屏| 综合色图婷婷| 91精品无码久久久久久五月天| 噜噜噜噜噜久| 激情五月综合网最新| 2017狠狠干| 影音先锋美国A| 97人人看一| 亚洲无AV在线中文字幕| 天堂在线9| 夜夜骑日日夜夜| 97影院一级片| 久久综合五月天激情小说网站 | 五月婷婷亚洲| 婷婷五月天亚洲激情戏精品| 色五月成人| 婷婷五月丁香五月| www.91.com黄| 亚洲色情网站| 国产真人做爰视频免费| aa久久| 深爱五月激情网| 播五月丁香三月婷婷| 国外亚洲成AV人片在线观看| 婷婷深爱五月| 久久98热re| 日本欧美国产| 少妇大叫太大太粗太爽了A片| 91成人看片| 色五月大| 六月婷婷在线视频| 成人精品视频99在线观看免费| 丁香婷婷五月六月久久| 亚洲中文乱字字幕在线永久| 大香蕉色婷婷伊人在线| 狠狠做婷婷| 99热精品在线在线| 亚洲色激婷| 99热e| 丁香婷婷九月在线| 99热免费精品热久久66| 色综合久久88色综合天天看| 狠狠色狠狠色综合日日91| 五月天天天操天天爽夜夜操| 色婷婷超碰| 久热久re| 婷婷五月天中文字幕| 日韩成人无码| 综合激情网五月激情| 五月天成人综合| 大香蕉手机视频| www久久艹| 天天影院色| 97久久超视频| 色色色色色综合| 色约约视频一区二区三区四区五区 | 五月婷婷啪啪| av九九| 91操熟女| 天天干天天干天天操| 色情综合| 思思热在线视频精品| 五月丁香综合啪啪| 婷婷开心激情| 影视av久久久噜噜噜噜噜三级| 五月婷婷五月天| 午夜免费试看| 久久精品婷婷| 色五月婷婷五月天| 天天干,天天舔| 成人视频在线免费播放| 五月婷啪啪| 欧美色99| 激情宗合哪里能看| 国产成人精品123区免费视频| 婷婷五月天无码视频| 一本色道久久88综合日韩精品| 激情综合激情五月| 夜精品无码A片一区二区蜜桃 | 五月天激情影院| 青青草免费公开视频| 玖玖婷婷色五月| 丁香五月婷婷成人色区| 任我肏| 99热在线观看精品| 日本在线噜噜| 六月激情网| 天天干天天爽天天操| 国产午夜精品一区二区三区四区 | 亚洲看av的网站| 91操黄| 婷婷五月天综合久久| 99日本精品视频热| 激情婷婷五月天| 九九婷婷五月天影视| 婷婷五月综合中文字幕| 国产美女视频久| 人妻人人操| 久久亚洲网| 五月天开心网| 婷婷五月天成人网站| 五月丁香婷婷婷激情爱爱| 综合五月婷婷| 呦呦v线| JAPANRCEP老熟妇乱子伦视频| 欧美综合五月丁香六月婷| 丁香五月婷综合| 99re热视频这里只精品5| 99久扒热| 成人精品视频99在线观看免费| 色狠狠色综合| 亚洲精品亚洲人成人网| 免费三级黄色| 丁香五月婷婷激情尤物| 婷婷丁香高潮了| 另类国产欧美视频| 激情六月婷婷| 人人草人| 欧美婷婷六月丁香综合色连续高潮抽搐| 99精品成人无码A片观看金桔 | 青青日韩| 国产色色色色| 大香蕉啪啪网| 婷婷免费视频| 五月丁香激情综合网| 99久久成人| 婷婷五月丁香综合激情| 九月丁香| 综合狠狠五月婷婷| 伊人激情啪啪| 国产精品电影| 中字幕视频在线永久在线观看免费| 99这里精品| 玖玖九九9999在线观看视频精品| 综合xx网| 五月天婷婷情色| 欧类av怡春院| 色吧综合网| 欧美丁香五月天| 91狠狠综合久久久| 1024在线视频| 国产精品国产成人国产三级| 99热新网址| 色综合综合网| 丁香五月综合无码趴趴| 成人做爰A片免费看视频| 99re在线精品视频| 激情深爱五月| 亚洲五月天色| 1024在线视频| 99成人在线观看| 激情婷婷丁香色情五月天| 欧美综合丁香网| 婷婷综合网| 色婷婷亚洲六月婷婷中文字幕| 亚州精品色情在线观看| 99热新网址| 9久热视频| 91无码色色| 五月丁香婷婷色| 激情五月丁香婷婷| 九九视频网| 人妻激情综合| 久热丁香| 九九色婷婷五月天| 啪啪啪大香蕉| 天堂久久婷婷| 天天干天天干天天干天天干天天干| 99热精这里只有精品| 欧美久草在线日本一级特黄大片做受9在线观看韩国电影《两个女人》未删减-毛片 | 99'无码| 丁香婷婷综合喷| 在线理论片| 日本色道视频网站| 任你日视频| 一月婷婷色色| www.久久爱.com| 天天插天天| 久久草婷婷丁香网站| 好看的国产精品| 五月天婷婷久草丁香| 狠狠爱深色婷婷综合| 免费看欧美成人A片无码| 激情影院丁香五月| 天天色亚洲| 九九色色| 51国精产品自偷自偷综合| 欧美va在线观看| 99热国产免费| 91精品久久久久、久五月天| 人妻久久久久久久 | 免费亚洲婷婷中文字幕| 337p午夜影院| 五月丁香六月欧美| 婷婷五月激情丁香激情| A色色| 日本色婷婷综合| 99精品久久| 九九热av| 97色色色色色色色| 99色啊| 婷婷久久五月| 六月丁香婷婷综合在线| 久99视频在线观看| 亚州激情在线视频| 五月丁香婷婷综合久久| 九九AV在线| 五月丁香亚洲校园欧美| 婷婷综合97| 麻豆精品| 婷婷99狠狠躁天天| 6月丁香婷婷| av婷婷丁香 六月| 免费AV黄在线播放| 日本激情五月| 狠狠操狠狠插| 色情久久久| 婷婷五月无码| 激情五月丁香五月| 亚洲国产精品VA在线看黑人| www超碰com| 人妻五月天激情开心网| 天天久综合网永久入口17v| 97人人操| 级情九色| 五月丁香花伦理电影| 五月天婷婷人妻| 丁香五月天在线视频| 亚洲六月婷| 综合网亚洲| 色五月天婷婷| 色综合婷婷99| 欧洲不卡视频| WWW久久久| 婷婷五月色| 婷婷五月丁香99| 久久久久9999| 天天干天天射综合网| 色人妻五月| 夜夜夜夜夜操| 狠狠色综合五月人人| 99热这里只有精品66| 亚洲亚洲人成综合网络| 婷婷丁香综合色AV| 六月婷婷五月丁香| 激情四射婷婷| 国产婷婷色五月| 五月婷婷色丁香| 五月婷婷官网色| 五月婷婷六月丁香综合在线| 拍真实国产伦偷精品| 日韩不卡123| 天天综合网91| www色五月天| 丁香五月综合| 五月天婷婷社区久久综合| 精品婷婷丁香五| 色五月婷婷91| 任你日视频| 激情婷婷内射| 99九九在线视频| 中文字幕丰满孑伦无码专区| site:feetmall.com| 人妻啪啪啪| 激情综合色| 99视频在线观看网址| 色播五月天天| 成人在线不卡| 9精品国产在热久久| 婷婷偷拍网| www,99热在线观看| 六月欧美综合色情| 五月激情六月综合| 九九热中文| 九九热精品| 色婷婷中文| 人人妻人人澡人人爽| 在线不卡AC| 99色6爱9热| 另类图片色五月| 影音先锋偷偷色男人站| 亚洲欧州色情在线观看| 99色热| 激情婷婷五月天网址| 国外亚洲成AV人片在线观看| 哇嘎成人久久| 久久精彩免费视频| 激情欧美婷五月| 色综合爽| 狠狠干激情五月| 五月丁六月香| 久久99久久99精品,久国产,久久精品免费,99久在线,久久久久国产精品免费网站,9 | 18av天堂| 99热在线观看| 丁香五月冃欧美| 五月丁香亚州综合网| 丁香色啪综合| 欧美久久婷婷| 日操夜撸| 欧美亚洲色色色色| 啪啪色激情五月天| 99ri在线观看视频| av在线免费网站| 天天综合五月天| 天天xxxxxx天天日| 91丨九色丨东北熟女| 天堂网亚洲色图| 精品少妇蜜臀91| 欧洲色区| 玖玖99福利| 亚州色色色| 在线视频你懂得| 激情五月开心五月丁香五月| 久久精品99国产精品日本| 狠狠五月激情在线| 五月天国产| 如何安全看伊人婷婷| 99啪| 性爱网五月天| 91视频精品99| 97干在线看| 天天综合精品| 91人人操| 色色色婷| 91精品婷婷国产综合久久| 超碰91人人操| 久久99婷婷| 天天干天天干天天干天天干天| 久久久99久久| 成人狠狠成人狠狠成人狠狠成人狠狠| 九月丁香亭亭| 国产精品久久久久久久久久 | 国产成人精品一区二三区熟女在线| 色永久| 婷婷丁香91| 国产亚洲精品久久久久久郑州| 99热| 色99在线视频| 五月天 另类图片| 婷婷伊人綜合中文| 天天五月天综合网址| 婷婷五月激情视频网| 亚洲天堂碰碰婷婷| 久99久精品| 日日做夜夜爱| 人妻性爱av网站| 香蕉网久久| 免费V片在线| 婷婷导航| 人人色人人弄人人操| 99九无网码| 久久这里只有精品22| 九九99在线免费在线观看视频| 99久视频| 夜夜谢天天干| 欧洲亚洲免费视频区| 中文字幕av网站| 草草操操| 停停五月天激情网| 久草 天堂| 婷婷激情五月呦呦| 国产成人精品一区二三区熟女在线 | 久久五月情| 久久九九@| 丁香六月婷婷综合色| 色135综合网| 激情五月天影院| 91成人电影| 欧美99| 亚洲久久婷婷丁香五月天| 色区久久| 久久久久久久97| 综合另类视频| 97久久久久| 夜夜 操无码| 9色免费网| 激情五月天的婷婷| 日本色久| 99热人人| 99久99热| 婷婷激情五月天亚洲综合| 天天摸天天舔天天爽| 成人婷婷五月天| 久久ww| 人人干人人干骚美女| 久久色五月天| 婷婷六月综合在线| 天天爽天天爽视频| 超碰97干| 亚洲亚洲永久无码777777| 五月婷婷丁香伦理网| 视频一二区| 亚洲啪啪自拍| 99久久色| 五月丁小婷婷激情四射| 淫视馆aV二区一区| 欧美在线视频99| 亚洲春色奇米影视| 超碰在线免费观看日韩| 99热日本精品| 四虎成人精品永久免费AV九九| 成人在线日韩欧美| 美女五月天| 五月丁香六月成人| 综合网色| 青青久久大香蕉| 青草性爱视频| 激情综合色播| 操操国产| 九九九九精品精| 超碰1999| 色婷操逼| 亚洲欧洲美女在线观| 曰本aaaaaa丈片| 超碰在线观看9| 国产亚洲色婷婷久久99精品91| www,五月天激情| 九月婷婷激情| 北京熟妇搡BBBB搡BBBB| Caoub青青超碰| 色啪影院| 第四色婷婷丁香五月| 五月丁香婷婷免费视频| 99热这里只有精品9| 国产熟女一区二区三区五月婷| 激情五月综合网| 天天日天天爽| 热九九精品| 色色色色色网| 俺来也狠狠| 色婷婷天堂| 亚洲激情网| 任你艹| 国产精品日日躁夜夜躁| 这里只有精品在线视频在线观看| 五月天婷婷丁香导航| 色之综合网| 欧美人人草草| 国产综合视频婷婷| 激情五月婷婷欧美极品| 亚洲区在线| 五月丁香啪啪伦理电影| 丁香六月激情毛片| 午夜丁香| 综合狠狠伊人| 丁香五月激情婷婷| 九色啦蜜臀| 91色婷婷综合久久中文字幕二区| 无码少妇高潮喷水A片免费| 午夜性爱影视一区77| 亚洲色啪| 婷久久| 五月婷婷亚洲| 青青草婷婷五月天| 婷婷色正月| 操碰99在线视频观看| 国产三级秋霞| 久碰综合| 俺去也婷婷| 人妻VideOssS人妻高清| 无码字幕中文| 久久精品爱爱| 99爱爱| 色婷婷五月影视| 大香蕉av在线| 九九美女视频| 成人狠狠成人狠狠成人狠狠成人狠狠 | 91婷婷色五月| 色婷成人狠干| 日日夜夜天天| 久久这里只有精品07 | 91精品又长又大又粗又爽又猛| 婷五月丁香俺| 国产免费一区二区三州老师F1……| 婷婷久久欧美| 欧美肉大捧一进一出免费视频| 婷婷激情五月天色| 色狠狠综合| 天天天摸夜夜夜玩| 操操日韩| www.婷婷| 国产99精品免费视频| 超碰在线成人| 伊人五月久久| 丁香五月色情av| 99日在线视频| 99精品女人天堂| 99人妻碰碰碰久久久久禁片| 久色网| 毛片毛片毛片毛片| 天天射美女| 99热老网站| 五月开心网| 久鲁鲁色网 | 99无码黄色视频| 丁香五月婷婷老师网站| 亚洲色五月婷婷| 97人人操人人| 五月激情天| 婷婷激情丁五月| ...婷婷五月综合不卡,国产在线手机| 丁香久久久| 色综合中文综合网| 色五月综合激情| 香蕉操亚洲| 婷婷亚洲在线| 思思热在线视频精品| 日韩精品AV一区二区三区| 思思热99热| 欧美成人精品A片免费一区99| 韩国中文字幕91| 欧美日本不卡黄色片| 影音先锋91在线资源站| 中文成人在线| 中文无码婷婷| 天天插天天草人人玩| 开心五月丁香综合久久| 97日本在线播放| 97色在线视频| 欧美性丁香色色五月天干干| 再次出发二| 综合激情在线观看| 91丁香综合| 99ER热精品视频| 久久 婷婷 五月天| 五月天亚洲综合网| 在线可以看的av网址| 丁香五月天无码AV| 97久久草草超级碰碰碰| 中文成人在线| 91超碰人人操| 欧美成人精品A片免费一区99| 熟女婷婷网站一婷婷五月一丁香婷婷一婷婷激情网 | 色噜噜狠狠狠狠色综合久欧美| 天天日夜夜操五月| 五月天伊人久久| 超碰97在线观看免费| 99热精品在线| 色婷婷综合在线| 六月丁香五月激情网| 丰满少妇猛烈A片免费看观看| 丁香五月婷婷免费视频| 国产毛片精品一区二区色欲黄A片| 欧美性丁香色色五月天| 亚洲国产精品VA在线看黑人| 99色亚洲| 婷婷五月天激情在线观看| 91热在线观看视频| 99色婷婷视频| 人人干99| 国产激情婷婷| 看国产探花操逼三级片| 激情纯色婷婷五月天在线不卡视频| 天天射影| 五月天国产成人| site:xmssd.com| 激情综合区| 91视频五月丁香| 波多野结衣不卡AV| 婷婷五月天综合亚洲| 99@久久@99精品视频| 婷婷自拍| 91日韩美女被插视频| 婷婷伊人五月丁香天堂网| 激情五月黄色| 9色婷婷| 丁香久久| 大香蕉婷婷| 99re这里只有| 婷婷午夜精品久久久| 丁香5月啪啪| 五月婷婷六月丁香在线| 春色激情| 成人 在线观看国产| 一本色道久久综合狠狠躁小说| 人人澡天天色天天做| 婷婷五月天视| 色五月天中文字幕| 99热这里只有精品4| 狠狠爱激情网| 粉嫩AV久久一区二区三区| 91无码色色| xx久久| 婷婷丁香人妻天天| a性生活久久无| 91九色熟女| 色丁香五月| 生活片五区| 9一精品视频观看| 9久热这里只有精品视频| 激情五月婷婷综合色播小说| 五月婷视频| 色色色综合色| 日本天堂免费99| 激情五月丁香五月| 丁香天堂夜| 九九视频精品在线免费| 香蕉综合网| 人人干99| 91九色中文字幕女在线观看| 99爱在线精品视频免费观看| 久久六月天| 免费播放片大片| 色五月第四色| 五月色亭丁香| 欧美色播综合在线观看| 丁香色婷婷| 9 99免费视频| www99在线观看视频| 色开心五月婷婷丁香HD| 激情婷婷五月天在线观看| 五月婷婷六月丁香| 97碰在线| 亚洲天堂aaa| 免费无码毛片一区二区A片| 婷婷婷色五月| 玖玖99免费视频| 91九色国产在线| 色五月综合婷婷| 亲子乱AV-区二区三区| 五月伊人视频在线看| 天天爽天天| 色色无码日韩| 99只有精品| 丁香五月成人论坛| 五月天大香蕉av| 欧美97p| www.色婷婷.com| 五月婷婷与六月丁香图片激情| 开心激情婷婷| 天天 青草 丝袜制服 在线| 99热大香蕉| 五月婷色色| 久久综合婷婷| 欧美激情xxxXX| 九九伊人网| 五月婷婷co.m| 久狠狠狠| 掩去也综合五月视频| 五月日韩中文字幕| 青青草轻轻操| 天天综合网在线| 色99免费视频中文| 99热8| 色婷婷五月天中文字幕| 五月天开心网| 激情婷婷网| 婷婷五月综合中文字幕| sewuyuejiqingwang| 99热思思| 五月天堂色| 26uuu视频欧美| 成人亚洲精品久久久久| 天天干天天色天天干| 网站免费一站二站| 大香人妻| 婷婷五月六月丁香| 色婷婷五月天|