欧美成人午夜精品久久久,国产?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
返回資訊列表
欧美三级视频下载| 成人网站免费在线播放| 91.com男女操| 五月天五月色| 无码se| 国产片XXXXA片国语对白| 色五月婷婷丁香婷婷| 天天综合久久| 精品国产乱码久久久久夜深人妻| 日韩 中文 欧美| 色五月五月丁香| 9婷婷内射| 久久久久久综合88| 丁香午夜天| 丁香婷婷六月激情文学| 操久久精| 天堂在线观看视频| 五月综合色| 日日日日操| 狠狠舔| 婷婷五月激情综合网| 9|无码久久久久久| 日本色五月婷婷| wwwss在线观看| 日本视频不卡123区| 丁香五月综合激情性爱| 天天插综合| 五月天丁香六月综合| 岛囯综合激情网| 六月丁香激情网| 人人人操97| 97人人看| 97精品综合久久| 丁香五月婷婷香| 婷婷五月天影院| 99热资源在线| 婷婷九月在线| 日韩操逼大片| 99激情在线| 开心激情网五月| XXXX岛国| 久久这有这里精品| 99热在这里只有免费精品| 成人在线综合| 亚洲成人av在线| 第1影院之五月婷婷| 欧美色男人网站| 色色国产| 国产成人精品亚洲线观看| www.99热在线观看| 91ncom.色| 九九99九九99九九99视频网| 五月丁香久久综合| 99成人在线观看| 久久久精品人妻录| 99精品亚洲| 337p午夜影院| 99热99热99热99热| 婷婷五月天在线观看免费| 色欲五月天| 日韩砖区| 亚洲久久婷婷丁香五月天| 成人片在线播放| 六月婷婷久久| 天天操夜夜啊| 天天夜天天色天天| 天天日日人| 亭亭色色五月天| 人妻久热| 五月丁香婷婷激情在线| 99操逼| 五月天激情婷婷丁香| 99热在线里有精品| 日韩欧美一级大黄网站| 粉嫩av蜜桃av蜜臀av| 991精品在线视频| 五月天婷婷AV| 夜夜穞天天穞狠狠穞AV美女按摩| 亚洲传媒在线观看| 99热日| 久久婷婷丁香| 丁香五月天精品| 亚洲五月情| 狠狠色噜噜| 五月激情婷婷开心| av中文在线| 深爱五月婷婷| 五月丁香啪。| 欧韩性爱| 国产精品久久久99视频| 开心五激情网| 超碰人人艹| 99久久99九九99九九九| 婷婷丁香黄色| 俺也去婷婷五月天第五色| 五月婷婷综合色啪| 久久狠狠干| 色色色色色色色色网站| 五六月婷婷久久| 亚洲无AV在线中文字幕| 天天操B| 色五月之第四色| caopeng97日韩| 色婷婷综合视频| 婷色五月天| 天天操夜夜操| 26.uuu丁香五月婷婷| 九九热这里有精品视频| 婷婷成人五月天成人文学| 五月丁香六月激情综合| 日韩精品呦呦va| 婷婷五月天中文字幕| 啪啪色激情五月天| 夜夜爱伊人| 天堂成人A片永久免费网站| 开心色色五月天综合| 欧美日本高清视频99| 狠狠第四色| 人人亚洲| 亚洲网视屏| 91久久婷婷| Av中文在线| 久久婷婷热| 日日日影院| 日本久久性| 婷婷香草网| 99色视频在线观看最新| 五月天另类小说| 99这里只有精品|v| 国产精品操| 深爱五月天天| 亚洲成av人影院| 超碰高清在线| 亚洲综合五月| 人人草碰| 这里只有精品无码| 久久五月婷婷视频| 丁香五月综合AV在线| 色综合五月天| A一级操| 激情五月婷婷| 99色五月| 日韩爱操视频| 182.t午在线观看| 五月丁香久久| 99精品综合视频| 欧美操我| 色五月婷婷五月天| a九九热www| 天天日,天天干,天天操| 婷婷九月在线| 超碰97干| 日韩久久日| 激情五月天开心网丁香无码| 一本大道熟女人妻中文字幕在线 | 99热99热在线观看| 99久久九九视频| 天天日天天插天天操| 丁香九九九九| 欧美群妇大交乱婬网| www.色五月.com| AV中文在线| 久久五月婷婷丁香| 久久久久久久97| 欧洲精品爱爱| 色九九综合| www.99热视频| 另类少妇人与禽zOZZ0性伦| 永久的网站AAAA| 日本久久天堂| 五月天播播综合| 亚洲亚洲人成综合网络| 五月丁香婷婷开心| 2022人人操人人看| 99在线精品观看99| 美女婷婷六月色| 狠狠干,狠狠操| 99re这里只有精品免费| 五月激情小说| 玖玖精品视频| 中文字幕不卡+婷婷五月| 五月天天天天天天天天天天天天天天天婷婷婷| 国产色网站| 婷婷丁香花五月天| 婷婷舔| 欧美大片免费观看| 天天做夜夜爽| 轮奸综合网| 99久热| 精品一区二区三区四区五区六区介绍| 中文字幕人妻一区二区| 亲子乱AV一区二区三区下载| 色五月激情五月丁香五月婷婷啪啪综合| 婷婷五月天av| 天天插天天干| 激情五月婷婷综合网| 五月婷婷影视| 99re久久| 囯产精品一品二区三区| 综合网狠狠| 六月婷婷综合激情| 色婷婷丁香特级性爱视频| 丁香五月婷婷激情蜜桃| 婷婷四色五月| 99热成人在线| 在线视频另类| 亚洲传媒在线观看| 直接看的AV| 热久久66| 亚洲av无码精品色午夜| 少妇AB又爽又紧无码网站| 99综合色| 97丁香五月天| 丁香五月婷婷影院| 亚洲精品一区中文字幕乱码| 99资源在线视频| 亚洲操逼片| 欧美激情性做爰免费视频| 狠狠色综合网站久久久久| 99热碰碰热| 日产精品一线二线三线芒果| 五月婷婷香| 99热综合网| 婷婷五月天色综合翘| 99热播放| 99九九精品| 免费黄色AV| 日本欧美成人片AAAA| 日本五月婷婷| 婷婷久久五月天亚洲欧美国产日韩在线观看| 国产精品久久久久久久久久久久| 色婷婷综合影院| 沈娜娜av| 久久XX| 狠狠狠狠狠狠狠狠狠狠狠色宗合图片 | 欧洲激情五月天婷婷| 奇米色大香蕉| 女人高潮内射99精品| 韩国天天婷婷| 亚洲AV无码久久精品色欲| 五月丁香激情综合欧美| 天天综合 99久久婷婷| 91九色国产熟女| 五月丁香天堂网婷婷| 99自拍视频网站| 秋霞AV吧| 黄桃AV无码免费一区二区三区| 69色色视频| 婷婷丁香五月天哟啪| 97日日碰碰| 国产成人+综合亚洲+天堂| 青青久在线视频免费观看| 国产婷婷综合在线免费视频| WWW.开心五月天.COM| 国产激情AV| 久久精99| 极品少妇XXXX精品少妇偷拍| 欧美日韩精品人妻狠狠躁免费视频| 青草青青草| 极品人妻videosss人妻| 五月丁香好婷婷姑娘综合网| 日韩欧美一区二区三区四区| 久久草人妻| 成人一级片| 六月婷婷激情| 日本黄色三级片内射| 狠狠色婷婷六月激情网| 亚洲激情网站| 亚洲另类婷婷五月综合| 亚洲人人操BD| 五月天另类小说| 欧美视频在线观看噜噜| 亚洲丁香五月| 99久久这里只有精品| 狠狠干综合网| 丁香婷婷色色| 草草操操| 四色五月婷婷| 色色婷婷五月| 91九色网| 99综合| 六月激情婷婷| 老师的粉嫩小又紧水又多A片视频| 色综合色| 成人中文网| 青青久在线视频免费观看| 婷婷五月花| 天天干,天天日| 婷婷五月丁香性爱| 日韩日比视频在线| 99视频日韩| 久久精品99| 亚洲色色色| 亚洲人人操| 国产无套精品一区二区| 久久蜜臀婷婷| 黄网免费观看| 2020久久婷婷五月| 26uuu精品国产| 色综合伊人网| av国产精品| 五月天丁香色色| 久久色亭亭五月天| av九九| 日本eVa一区=区视频| 9色在线视频精品观看| 婷婷五月天大香蕉在线视频观看| 99视频自拍| 蜜臀丁香黄色婷婷五月天| 4399在线观看免费高清电视剧| 婷婷综合久久| 美英法精品无码免费视频| 亚洲五月花| 六月激情婷婷| 丁香五月激情五月色综合| 午夜婷婷久久 | 另类天堂| 久热这里| 色婷婷综合亚洲| 五月情四婷婷| 伊人五月综合网| AA丁香综合激情| 亚洲午夜精品久久久久久人妖| 五月天色婷婷图片| 天天舔天天摸| 成人综合视频网址| 精品九九在线观看视频| 激情五月婷婷五月| 国产99久久久国产精品免费看| 亚洲丁香花五月丁香花| 婷婷欧美综合| 婷婷五月天欧美| www久久久| 国产做爰视频免费播放| av在线激情| 丁香五月网络网络| 久久久激情视频| 婷婷五月久久| 五月网激情| 激情婷婷狠狠干| 五月婷婷色丁香| 99激情视频| 五月停性愛| 毛片新网地| 69er小视频| 激情久久肏屄视频| 日韩色色一区| 青青草原福利在线| 大地9中文在线观看免费高清| 91人人操人人看| 激情四射网| 婷婷五月天第四色| 亚洲精品久久久久久久久久吃药| 九九無碼| 九九sese| 亚洲国产精品SUV| 婷婷五月天AV在线| 老司机伊人| 久9无码视频| 亚洲正能量欧美| 色婷视频| 色色色色综合| 51成人| 思思热久热| 国产精品涩涩涩视频网站| 五月婷婷与六月丁香图片激情| 婷婷狠狠五月综合| 99久久精品免费精品国产_国产精品久久久久久_国产在线|日韩_久久国产精品电影 | 人人操人人爽成人AV| 天天日天天舔天天摸| 99这里只有精品视频| 亚洲精品国产A久久久久久| 天天色天天射天天日| 婷婷另类小说| 久久精品国产AV一区二区三区 | 中文av网站| 色五月婷婷AV| 另类激情综合| 99啪啪网| 午夜成人天堂久久无码日韩久久| 99久久五月天| 国产精品爽爽久久久久久| 射满了还射免费在线观看 -午夜版全集-新视觉影院 | 91久操| 亚洲婷婷91丁香| 婷婷刺激综合| 五月天婷婷青青草| 五月天播播中文字幕| 9l久久久视频| 99精彩视频| 无码动漫AV| 538在线精品| 九九人人看| 91日日日| 五月婷婷六月丁香免费| 久久六月天| 在线播放中文字幕| 亚洲色色色| 爱草视频在线观看| 91美女啪啪| 亚洲天堂aaaa| 五月天婷婷色| 色婷婷99| 99精品7| 97超美国视频在线观看| 日本WWW九九九| 欧美色必爱| 99视频精品全部观看10| 大香蕉伊在| 91精品婷婷国产综合久久| 久草婷婷| 国产FREESEXVIDEOS性中国| 亚洲婷婷丁香五月亚洲| 国产九月婷婷| 久久99视频| 曰韩五月丁香色婷婷无码| 九九精品在线网| 五月婷婷片| 色综合五月婷婷狠狠干| 久久Xx| 亚洲色在线观看| 99热乎| 久久无码成人| 久草性爱| 亚洲综合色五月| 激情亭亭五月| 婷婷五月综合啪| 九一九九黄色| 婷婷综合激情| 天天爽免费视频| 国产精品成人AV在线| 亚洲综合激情五月久久| 成人五月天视频播放| www久久艹| 亚洲色网址| 99热这里只是精品| 亚洲激情亚洲激情 | 密臀久久| 五月香蕉婷婷| 久久五月婷天天干| 色色色热| 欧美日韩成人在线观看| 森林影视大全,最好看的2019年视频 | 亚欧州精品视频| www.9操| 综合激情五月婷婷| 亚洲色情网站| 丁香五月综合久久八| 色99免费视频中文| 日日鲁鲁鲁夜夜爽爽狠狠视频97| 色情五月综合婷婷| 开心五月深爱五月丁香五月激情五月| 丁香六月婷婷开心| 激情久久久久久久久久久| 人妻丰满精品一区二区A片| 五月丁香五月婷婷在线观看| 99热久久这里只有精品| 亚洲视频1区| 丁香五月成人| 欧美色色色色色| 五月天狠狠草| 亚洲精品五月| 在线综合婷婷| VA日本视频| 碰碰人人漕| 香蕉AV777XXX色综合一区| 五月色网| 婷婷在线综合| 亚洲婷婷欧美婷婷| 色五月女| 99视频在线观看视频| 激情五月深爱五月观看| 九色视频91| 99免费偷拍视频| 激情色五月天| 丁香五月人妻| 台湾无码A片一区二区| 五月丁香色狠狠干大屄| 五月天综合区| 婷婷涩涩网| 婷婷欧美色| 综合色久| 亚洲色涩视频| 国产亚洲精品人人| 精品国产va久久久久| 五月激情综合网| 国产黄色大片| 午夜精品久久久久久久爽| 播播网色播播| 激情婷婷五月天| aaa久久| www.婷婷,com| 99在线精品视频| www.色综合.com| 日本色久| 久色资源| 99久视频| 色婷婷成人影片| 婷婷丁香五月天影院 | 激情五月小说婷婷| 99热这里全都是精品| 99热视| 婷婷五月天国产手机在线视频观看| 丁香五月网络网络| 婷婷五月天激情四射五月天激情| 日韩婷婷五月| 777久久综合视频| 99爱免费在线观看| 日本AAAAAAAAAAAAAA片| 久久婷婷激情视频| 玖玖婷婷五月天| 色播五月天激情| 精品免费99| 九九婷婷网五月天| 久热伊人| 影音先锋男人站,影音先锋男人色资源网,影音先锋AV最新资源站,影音先锋AV资源 | 一起操最新网址| 久操香蕉| 91五月天| 六月婷婷香蕉| 都市激情久久| 99热精品一| 欧洲亚洲免费视频9| 亚洲激情 久久| 伊人婷婷激情| 久久婷婷五月综合色丁香| 99热国产免费| 狠狠色噜噜狠狠狠888| 五月丁香激情综合六月涩涩爱| 五月婷婷av| 大香蕉520| 婷婷五月天第四色| 五月丁香婷婷六月| 拍真实国产伦偷精品| 操逼五月天| 99精品在线播放| 婷婷五月天激情综合| ss视频xx91| 久久久大香蕉| 日操熟女| 99色视| 欧美群妇大交乱婬网| 思思热久久婷婷五月天| 操碰99| 逼特逼在线免费播放| 成 人片 黄 色 大 片| 97男人天堂| 亚洲激情综合| 亚洲欧美另类在线23p| 五月丁香在线婷婷美女| 夜夜操狠狠操| 九九热视频在线观看| 91操人视频| 五月婷婷草| 欧美三级巜人妻互换| 99日视频在线| 久热大香蕉| 五月WWW| 99ri在线| 色婷婷色九月| 色五月之第四色| 亚洲激情高潮| 色五月大香蕉| 婷婷丁香五月91| 六月婷婷国产| 日日夜夜天天| 九九热a| 五月天丁香婷婷社区| 日夜操B| 国产成人+综合亚洲+天堂| 五月婷久久综合| 性婷婷| 久久香蕉网| Aα在线免费观看| 色婷婷色丁香色欲av| 激情五月天之六月婷婷| 五月开心激情| 思思99热这里只有精品| 久久3p| 97操碰日本女人| 九九99视频精品| 操操天堂| 99黄色在线视频精品熟女| 九九热精品6| 午夜不卡久久精品无码免费 | 色吧五月婷婷| 婷婷五月在线免费| 丁香色六月婷婷| 91久久五月天| 青青草原亚洲天堂| 九九色色网| www.婷婷.com| 干一干xxxx| 国产成人VA| 婷婷亚洲天堂| 丁香色五月婷婷17C| 婷婷色情网| 色五月激情综合| 色色色综合网| 狠狠五月激情在线| 丁香五月色| 99久久99热| 无码激情AAAAA片-区区| 九玖欧洲亚洲| AV在线大香蕉| 久久免费精品小视频| 天天日天天摸| 色小说婷婷五月天天天| av在线超清中文| 婷婷爱综合| 51XX午夜影福利| 夜精品无码A片一区二区蜜桃| 丁香六月激情综合网| 青草青草久9视频在线视频| 天天操天天插| 久久黄色免费视频| 激情骚五月| 91人操| 2017狠狠干| 久久综合性| 天天综合色丁香| 婷婷性爱网| 五月天开心激情网色欲无码| Blackedraw视频一区二区| 日日夜夜小色哥| 综合亚洲AV| 成人av在线网址| 欧美黑人大吊| 九月激情婷婷丁香| 日日夜夜狠狠操| AV成人在线播放| www.henhenl| 天天综合网91| 97精品人人A片免费看| 丁香五月综合在线视频| 97啪在线观看视频| 日韩欧美成人片| 超碰在线观看成人视| 97在线视频观看| 婷婷五月天xxx| 欧美婷婷九月| 丁香六月久久| 婷婷五月天亚洲综合| 婷婷色操| 少妇性按摩无码中文A片| 自拍盗摄 另类| 九九香蕉网| 俺去也五月| 婷婷五月免费视频| 天堂五月婷婷| 99这里有精品视频| 91综合在线| 婷婷九月激情| 亚洲国产色婷婷| 免费视频无码| 丝袜大香蕉| 久久人妻视步| 婷婷五月天成人动漫| 九九人人看| 99国产精品久久久久久久久久久 | 五月婷婷综合色啪首页| 日本久久视频| 久超超碰| 99热在线成人网站| 五月丁香激情综合啪| www.久9| 97人人射| 五月丁香婷婷色| 99精品在线下载| 国产成人综合网| 亚洲成人综合网在线免费观看| 五月天婷综合| 婷婷五月开心中文字幕色| 97婷婷在线| 99riav 亚洲| 思思热精品在线| 久久精品人妻| 26uuu| 亚洲综合色色| 色五月av| 天天综合五月天| 亚洲va国产va天堂va综合va| 欧美激情综合五月色丁香| 色色色色色色色色网站| 成人五月天视频播放| 婷婷五月天在婷| 国精产品一区一区三区免费视频| 天天日天天色| 日本熟妇乱妇熟色A片蜜桃| 激情综合网五月| 婷婷久久色| 高清无码入口| h在线看免费版在线看| 精品国产AV色一区二区深夜久久 | 九月丁香婷婷综合激情| 天天拍夜夜撸| 开心亚洲久久开心| 婷婷五月天影视| 色婷婷六月精品| 99视频热| 激情五月综合婷婷| 激情色色色| 99综合网| 任你搞免费视频观看| 六月婷婷天堂| 国产亚洲色婷婷久久99精品9j| 五月天婷婷色色网| 激情综合啪啪| 天天草狠狠擦| 夜夜撸天天操| 色播五月网| 国产美女无遮挡裸体毛片A片| 一二线视频 另类| 97自拍视频网| 日本九九网| 九月丁香婷婷综合激情| 精品成人无码A片观看香草视频| 婷婷视频在线| 婷婷五月丁香六月| 久草婷婷在线| 久久永久视频| AV 3P| 婷婷爱五月天| 成人做爰A片免费看视频| 偷拍99在线视频观看| 综合激情五月婷婷| 五月天开心色情网| 精品人妻伦一二三区久久| 超碰在线成人| 91久久精品视频| 国产精品大香蕉| 热久久精品视频网站| 97人人操| 狠狠干五月| 99狠狠色| 很很干五月天| 欧美丁香五月| 五月综合激情久久| 另类图片天天影视在线观看| 天天精品视频在线观看视频| 国产在线中文字幕| Av在线资源| 丁香五月综合久久八| 天天激情| 极品人妻VIDEOSSS人妻| 色婷婷视频| 五月婷婷在线播放| 99在线精品观看99| 深爱婷婷色| 中文字幕丰满人妻无码专区| 丁香六月在线综合| 99er日韩| 久久婷婷丁香| 夜夜爱爱亚洲| 五月丁香六月合| 91丨九色丨东北熟女| 欧美六月婷婷| 天天综合.com| 99在线精品观看99| 欧美va视频| 五月天色丁香| 日本片日本片祼观看网站在线看中文版网页在线看 | 综合色影| 另类图片五月天| 日操熟女| 很操日本7| 99热国产这里只有精品| 日韩一级一片内射视频4K| 九九热青青草| 狠狠色综合网站| 色色婷婷丁香| 天天骑日日爽| 色婷婷久久综合中文久久一本| 成人国产欧美大片一区| 最新热中文字幕| 日韩aaa| 久色激情| 亚洲人人操| 久久精彩视频99| 五月天婷婷黄色| 国色天香成人网| 五月丁香色婷婷婷基地| 五月婷婷激情综合| 丁香大香蕉| 91久久久久久久久18| 97婷婷在线| 色五月亚洲| 色婷婷激情五月天丁香| www色五月天| 99精品久久久久久| 99热在线观看这里只有精品| 天堂成人A片永久免费网站| 888精品福利地址| 99在线精品视频| 99re熱| 丁香五月影院| 思思热热久久| 婷婷五月天综合久久日美女| 99亚洲色色| 99久热在线精品99re6热| 人人干人人操人人摸| 五月婷婷精品视频| 丁香婷婷激情五月天无毒不卡蜜桃| 三十熟女| 99热a片免| 色婷小说| 狠狠穞A片一區二區三區| 色五月婷婷成人| 91精品久久久久久综合五月天| 日本nghangse中文字幕| 综合婷婷五月天| 91激情五月开心| 亚洲区视频| 六月婷婷天天操夜夜爽视频| 亚洲亚洲人成综合网络| 99爱免费在线视频| 五月丁香婷婷色播无码| 免费啪啪亚州视频| 亚洲日韩人妻操逼| 人操91在线| 婷婷五月色色| 超碰色色综合| 日日做A爰片久久毛片A片英语| 亚州日本欧州韩美高青高潮一| AV色色天堂中文| 开心激情播播五月天| 玖玖色综合网| 国产又爽又猛又粗的视频A片| 在热视频精品| 五月丁香激情啪啪网| 夜夜 操无码| 欧美色色色色色色色色色色影视| 亚洲午夜成人av电影网| 99热新网址| 天天免费成年人视频| 91久久久久| 玖玖色综合网| 五月丁香花激情综合网| 成人婷婷| 五月婷婷视频| 99热在线观看精品| 另类小说婷婷色| 激情丁香五月| 激情五月天婷婷| 久久婷婷视频| 开心婷婷五月激情网小说| 亚洲综合色成丁香五月色| 丁香五月在线观看| 秋霞午夜理论| 久久综合播放| 免费观看全黄做爰的视频| 婷婷五月天久久| 五月丁香va| 九九性爱网| 无码激情AAAAA片-区区| 精品皮股午夜AV| 亚洲成人一区| 99操网站| 禁欲电影完整版在线播放| 91黄操| 成人一级片| 丁香五月婷婷激情视频播放| 久99久在线| 色婷婷性爱| 国产乱人偷精品人妻A片| 综合啪啪| 五月色情网| 超碰人人在线| 超碰猛烈的性猛交| 综合在线观看99| 少妇人妻偷人精品无码视频新浪 | 九九综合88| 内射爽无广熟女亚洲| 97久久超碰| 婷婷五月情| 激情五月亚洲| 亚洲婷婷激情888精品久| 五月六月播婷婷| 五月天天综合| 人人97操| 毛片九九九九九九| 国产黄色在线观看| 五月色综合| 激情综合五月婷婷| 人人妻人人澡| 能看的av| 狠狠操.COM| 久久精品永久免费| 婷婷六月综合在线| 99re99热| 婷婷激情五月视频| 成片免费观看大全| 五月停视频天堂| 五月婷婷六月天| AV电影在线播放| 思思re99视频在线观看| 97碰碰在线看视频免费| 五月婷婷丁香婷婷| 五月婷婷中文字幕| 99re热视频这里只精品5| 久久视频婷婷视频| 婷婷成人综合免费视频| 五月天伊人av| 日韩狠狠色婷婷| 影音先锋xfplay资源男人网| 婷婷六月色丁香视频在线观看| 激情婷婷五月亚洲| 天天天操天天天爰| 欧美日韩国产一区| 五月婷婷婷综合网| 夜夜爱伊人| 97干网站| 婷婷丁香色五月天久久88| 免费国产VA国产免费| 天天舔天天插天天爱| 99热欧| 五月丁香在线国产 | 色偷偷综合| 五月天综合激情网| 天天肏夜夜肏| 亚洲中文字幕av| 久久婷婷综合五月| Caoub青青超碰| 日本少妇AA一级特黄大片| 综合精品99| 久久婷网| 午夜丁香丁香婷婷| ,99视频久久| 六月婷婷狠狠做| 丁香五月婷婷俺也要去| 色五月丁香婷婷综合| 天天综合久久| www.婷婷,com| 亚洲色99| www色色com| 欧美激情综合色综合啪啪五月| 91肏肏肏| 五月婷婷中文字幕| 五月丁香婷婷福利| 思思热在线视频99| 婷婷激情九月| AV九九| 四色女婷婷| 欧美成人性爱网| 天天日日夜夜| 激情小说婷婷| 色综啪啪网| 五月婷婷亚洲色图| 99久re热视频精品98| 五月丁香六月日逼| 婷婷五月天基地| 天天色粽合合合合合合合| 六月成人网| 久久久久久久久久婷婷| 久久香蕉网| 五月婷婷九月婷婷九月婷婷| 九月色婷婷综合| 99视频内射三四| 天天综合色99| 六月婷婷狠狠| 色情五月综合婷婷| 婷婷色综合| 日本WWW九九九| 亚洲 激情 中文| 天天日夜夜曹| 99精品偷自拍| 婷婷色啪| 亚洲色vA| 深爱五月婷婷| 久久九九亚洲| 五月开心六月婷婷在线播放网站| 五月激情六月综合| 成人av免费观看| 色色影院黄大片| wwwxxx五月婷婷小说| 五月婷婷色影院| 色情网综合| 激情五月综合免费| 国产激情av| 中文字幕丰满乱孑伦无码专区 | 少妇AB又爽又紧无码网站| 91婷婷五月丁香碰| 亚洲尤物在线| 天天操加勒比| 97操碰免费视频| 久久九九免费大视频| 色色色色色网| 五月天色小说| 五月天激情综合在线| 天天干天天爽天天操| 国产精品久久久久久久久久免费| 日韩成人无码人妻| 久久亚洲婷婷| 亚洲日韩操B| 9.1综合网| 99热久草| 教师性爱毛片| 日本天天综合| 久久精彩视频| 99九精品| 停停五月丁香| 一区无码| 婷婷色Av| 色伦专区97中文字幕| 婷婷五月天777| 亚州色色色| 综激情网| 婷婷综合成人| www.久久色.com| 能直接看的AV网站| 中文字幕丰满孑伦无码专区| 亚洲思思热久| 亚洲激情五月天| 亚洲精品网址| 五月叮香啪| 伊人大综合| 日日夜夜小色哥| av免费在线看不卡无毒| 人人操Av| h在线看免费版在线看| 婷婷激情伍月网| 桃色五月天| 五月丁香啪啪啪| 色5月婷婷| 五月激情婷婷在线| 丁香激情综合| 日韩综合大黄| 久久久日韩特色特黄AAAA| www,五月天激情| 日韩99无码| 天天插天天操| 97ai婷婷| 欧美久久网| 天堂中文国产| 五月婷色色| 综合综合色色| 国产69久久久欧美黑人A片| 伊人成人宗合网| AV片在线观看| 日日天天干| 九九九九中文字幕| 色五月婷婷操逼| 日韩欧美颜射| 国产乱子轮XXX农村| 精品怡红九九九| 五月丁香天堂| 大香蕉啪啪| 97色色-99久久| 少妇高潮A片无套内谢麻豆传| 亚洲狠狠婷婷综合久久久| www,奇米影视| 色婷婷亚洲六月婷婷中文字幕| 美欧成人视频| 97人人超| 激情婷婷亚洲五月| 丁香婷婷五月综合欧美另类| 亚洲五月情| 欧美在线看| 亚洲无码色| 9这里只有精品| 丁香视频| 99热免费观看| 另类小说五月天综合网| 婷婷五月丁香综合桃花色网| 激情无码网| 欧美日韩成人| www.91av.com| 婷婷色Av| 超碰色色综合| 99re在线播放| 久久九九热视频| 九九五月天| 99国产精品久久久久久久久久久 | 色五月激情视频在线综合| 乱精品一区字幕二区| 国产精品色婷婷AV综合色色| 婷婷综合欧美| 国模狼狼| 日韩999| 逼里香不卡| 婷婷五月天成人在线视频| 欧美午夜乱妇午夜福利| 五月婷婷影| 五月婷婷激情综合在线| 最新AV在线观看| 婷婷中文字幕| 丁香五月播播| 丁香五月天婷婷久久| 伊人玖玖网| 天天日色情| 激情五月综合网| 久久狠狠欧美| 中文av在线观看| 99国产精品白浆在线观看免费| 思思热久热| 色播五月婷婷综合| 97久久超视频| 北京熟妇搡BBBB搡BBBB| 久久金品黃色| 99在线视频精品| -91九色大屁股| 久久精品99国产精品日本| 欧美 日韩 成人 在线| 五月天激情无码高清| 激情综合网络插| 91婷婷色| 日日操夜夜操中国无码| 深爱激情小说五月婷婷| 九九综合网色全集| 熟女色色一区二区| 天天爽天天日| 激情六月色| 综合五月天婷婷色| 欧洲婷婷五月天| 玖玖婷婷五月天| a在线免费v| 五月丁香偷拍| 久热在线中文字幕色999舞 | 99热6这里只有精品6| 欧美在线视频9| 青青草青青草五月天| 丁香五月天堂| 自拍偷窥99热| 天天草天天爽| 激情丁香五月天图片| 天天拍夜夜爽日日| 激情五月婷婷免费视频| 偷偷狠狠久久婷婷五月天| 久99久热| 五月婷婷97| 97操资源婷婷| 婷婷五月天福利| 激情五月婷婷五月| 九九九九综合| 婷综合| 五月天丁香成人| 色久丁香五| 激情综合网五月天| 天天色天天爱天天爽| 丁香色播五月天| 激情五月天综合图片小说网站| 婷婷五月天.com| 91精品久久久久久综合五月天| 超碰av在线| 久热99| 开心深爱五月天| 婷婷色五月综合丁香| 91超碰人人操| 婷婷六月激情小说网| 色一情一乱一乱一区91Av| 亚洲小视频免费播放| 色色色婷婷五月天| 亚洲综合1024| 丁香五月开心亚洲| 另类伊人婷婷| 欧美激情伊人| 人人综合久| 激情99热| www99热| 色五月婷婷久久爱| 丁香六月 人妻| www色中色综合| 天天综合色综合| 热久久视频99| 日日夜夜天天爽| 99精品在线下载| 丁香五月婷婷手机| 五月婷婷色五月| 天天天天天日| 91啪啪| 日本nghangse中文字幕| 久热re在线视频| A在线观看| 国产AV熟妇人震精品一品二区 | 久久成人性爱| 激情综合激情五月| 久久激情五月网| 五月丁香激| 79精品视频在线观看,| 思思9久久| 人妻中文av| 丁香五月综合高清在线| 国产六月婷婷| 久久人妻伦理| 啊v视频在线观看| 99视频这里有精品| 亚洲免费成人电影AV| 铁牛TV人妻| 久久国产性爱A V| 激情综合五月色丁香婷婷| 人妻少妇色综合| 激情图片五月天| 色五月激情综合网站| 日本久久超碰| 国产99精品免费视频| 五月婷婷说| 这里只有精品久久| 日碰日| 国产韩日亚洲美州欧亚综合在线| 九九免费在线视频| 91九色国产| 丁香五月开心七月| 中文字幕成人影视| 热的国产,热的综合,热的有码| 成人精品在线观看| 激情性五月天免费小说视频| 九九色欲网| 亚洲成AV人片在线观看| 伊人超碰| 狠狠色综合五月| 亚洲激情AV| 六月丁香天堂| 精品九九在线观看| 五月天久久综合| 色五月婷婷777| 丁香婷婷人妻| 丁香婷五月| 五月天色区| 天天色凹凸| 婷婷天堂综合| 五月夜丁香| 欧美槡BBBB槡BBB少妇| 五月婷婷综合天天操| 午夜丁香婷婷| 亚洲情欲| 国产毛片操B| 精品99这里有| 99热免费在线| 亚洲妇女熟BBW| 色播丁香| 99热在线成人网站| 婷婷丁香五月综合| 另类国产区| 色婷婷色五月天| 五月丁香啪啪网| 五月天婷婷AV| 欧美xx激情视频在线观看| 99视频| 99精品视频在线观看免费| www.99热这里精品| 久久久久视剧HD| 先锋男人99资源| 激情六月婷婷| 久久人人九| 婷婷五月天情色| 中文字幕操比影片| 久久精品在线| 婷婷五月色播放| 久操人妻| 91大神操美女| 99丁香五月婷婷在线| A网在线欧洲| 色99久草在线| www.五月婷婷久久.com| 激情色色| 91 原创 在线 九色| 丁香五月六月综合欧美| 久久九九激情五月天 | 久99久精品| 色色a| 99九九视频| 五月丁香六月婷婷姐| 亚洲成人网站在线| 丁香五月天堂网| 碰碰女| 女人被男人吃奶到高潮|