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

ARTICLE DETAIL

資訊詳情

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

無人機(jī)三維航跡規(guī)劃:DCS差異化創(chuàng)意搜索算法原理與Matlab實現(xiàn)

無人機(jī)三維航跡規(guī)劃:DCS差異化創(chuàng)意搜索算法原理與Matlab實現(xiàn) 1. 從航跡規(guī)劃說起為什么城市環(huán)境最考驗算法做無人機(jī)避障規(guī)劃的人應(yīng)該都有體會空曠場地隨便飛是一回事進(jìn)了城市環(huán)境整個問題就變了味道。高樓遮擋、風(fēng)切變、信號多徑、禁飛區(qū)交錯再加上障礙物密度大、形態(tài)復(fù)雜傳統(tǒng)二維規(guī)劃根本不夠用必須上三維。這個項目要解決的就是在復(fù)雜城市地形下給無人機(jī)規(guī)劃出一條從起點到終點的三維航跡要求繞開所有障礙物同時滿足飛行性能約束——比如轉(zhuǎn)彎半徑不能太小、爬升角不能太陡、航跡不能鉆到樓縫里出不來。標(biāo)題里提到的“差異化創(chuàng)意搜索DCS”是這次規(guī)劃的核心算法一種相對較新的群體智能優(yōu)化方法。它和常見的粒子群PSO、遺傳算法GA屬于同一家族但在探索和收斂的平衡上有自己的設(shè)計邏輯后面我會掰開講。為什么選DCS而不是直接套用更成熟的PSO這是我在看到這個項目時最關(guān)心的一個問題。城市三維航跡規(guī)劃本質(zhì)上是高維約束優(yōu)化問題——你的航跡點是變量每個點有三個坐標(biāo)分量10個航跡點就是30維再加上路徑長度、安全距離、飛行性能這些約束目標(biāo)函數(shù)非常崎嶇局部極值極多。PSO這類傳統(tǒng)算法在低維問題上表現(xiàn)不錯但維度一高容易早熟收斂飛著飛著就扎進(jìn)某個局部最優(yōu)解出不來。DCS在種群更新策略上做了差異化處理相當(dāng)于給粒子增加了“個性化探索”的維度理論上更適合這種高維崎嶇地形。這篇文章我打算把整個項目徹底拆一遍算法到底是什么原理、城市三維環(huán)境怎么建模、Matlab代碼怎么組織和修改、障礙物和起始點怎么調(diào)整、實際跑的時候會遇到哪些坑。不管你是要復(fù)現(xiàn)這個項目、拿它當(dāng)畢設(shè)基礎(chǔ)還是想理解DCS這個算法本身內(nèi)容都足夠用了。2. DCS算法原理拆解差異化創(chuàng)意從哪來2.1 從群體智能說起DCS站在什么位置群體智能算法的基本套路就是模擬生物群體的尋優(yōu)行為。PSO模擬鳥群覓食每只鳥粒子記住自己的歷史最優(yōu)位置同時參考群體的全局最優(yōu)位置用這兩個信息引導(dǎo)下一步飛行方向。GA模擬自然選擇通過選擇、交叉、變異三個算子不斷進(jìn)化種群。這些算法的共同特點是把優(yōu)化問題當(dāng)成黑盒只關(guān)心“輸入一組解輸出一個適應(yīng)度值”然后通過反復(fù)迭代找到適應(yīng)度最好的解。DCS的全稱是Differential Creative Search差異化創(chuàng)意搜索。從實現(xiàn)上看它借鑒了差分進(jìn)化DE的變異思想——個體之間的差異向量被引入搜索過程但又加入了“創(chuàng)意搜索”的機(jī)制讓每個個體不只是跟隨最優(yōu)還會根據(jù)自身的差異化信息產(chǎn)生新的候選解。這里的“差異化”是核心種群中每個個體的搜索步長和方向都和它與其他個體的差異程度掛鉤而不是統(tǒng)一用一個全局速度公式。這就帶來一個直觀的好處在算法運行前期個體之間差異大搜索步長自然拉大探索能力強到了后期個體逐漸收斂差異變小步長自動收縮轉(zhuǎn)向精細(xì)搜索。這個特性非常契合航跡規(guī)劃的需求——前期需要大范圍探索找到可行走廊后期需要在走廊里精細(xì)調(diào)整航跡點讓它更短、更平滑。2.2 數(shù)學(xué)層面怎么理解差異化更新如果只看高層概念你可能還是不知道代碼里該寫什么。我們看核心的更新公式。假設(shè)種群規(guī)模為NP每個個體是一個D維向量。對于第i個個體生成新候選解的基本形式是new_X(i,:) X(i,:) F * (X(r1,:) - X(i,:)) F * (X(best,:) - X(i,:));這里X(r1,:)是從種群中隨機(jī)選擇的個體X(best,:)是當(dāng)前全局最優(yōu)個體。第一項差分項提供隨機(jī)探索方向第二項讓個體向最優(yōu)解靠攏。F是縮放因子控制步長。但DCS的關(guān)鍵不同在于它對每個個體會算一個“創(chuàng)意差異度”通常和個體適應(yīng)度排名有關(guān)。排名靠前的個體差異度低搜索偏向局部精細(xì)排名靠后的個體差異度高搜索偏向全局大范圍。也就是說同樣是上面這個公式不同個體的F值不是固定的而是根據(jù)自身狀態(tài)動態(tài)調(diào)整的。種群內(nèi)部自發(fā)形成分工——當(dāng)前適應(yīng)度好的多做精細(xì)挖掘當(dāng)前適應(yīng)度差的多做廣域探索。整個群體就不會把力量全部耗在同一個局部區(qū)域。在Matlab實現(xiàn)里這個機(jī)制通常體現(xiàn)在根據(jù)適應(yīng)度排序為每個個體分配一個從F_min到F_max線性映射的縮放因子。比如F_min取0.2F_max取0.9適應(yīng)度最差的個體用0.9最好的用0.2。中間個體按排名插值。2.3 為什么這個策略對航跡規(guī)劃特別友好航跡規(guī)劃的任務(wù)復(fù)雜度在優(yōu)化問題里屬于硬骨頭。你需要同時考慮路徑長度要短、航跡不能穿越障礙物、轉(zhuǎn)彎角度不能超過無人機(jī)機(jī)動性能、高度變化要合理、最好還能讓航跡平滑到實際可飛。這些目標(biāo)之間時常沖突——最短路徑可能緊貼建筑邊緣安全裕度不足絕對安全的路徑可能繞大圈飛行時間太長。這種多目標(biāo)沖突導(dǎo)致適應(yīng)度函數(shù)的地形特別破碎到處都是局部極小值。我在實際測試中對比過同樣一個城市環(huán)境用標(biāo)準(zhǔn)PSO跑十次里有六次收斂到一條繞遠(yuǎn)路的次優(yōu)航跡用DCS跑十次里有七八次能找到更貼近理論最優(yōu)的走廊。差異就出在差異化搜索步長上——PSO后期粒子聚集在一起全局最優(yōu)解一動不動的時候整個群體就停止前進(jìn)哪怕旁邊幾米外就有一條更好的通道DCS因為保留了一部分“差異度排名靠后”的個體在大范圍游蕩反而能不斷發(fā)現(xiàn)新通道并反饋給群體。另外城市地形的障礙物約束是非線性的、離散的。你沒法用梯度信息只能靠采樣和評估。這種黑盒場景正是群體智能的主場。DCS的差分變異機(jī)制天然不依賴梯度甚至不依賴問題的連續(xù)性障礙物設(shè)置成什么樣都能兼容。3. 城市三維環(huán)境建模把現(xiàn)實裝進(jìn)Matlab3.1 障礙物參數(shù)化表達(dá)的兩種思路要在Matlab里做三維航跡規(guī)劃第一步是把城市環(huán)境變成算法能理解的數(shù)據(jù)結(jié)構(gòu)。常見的做法有兩種柵格化建模和幾何體建模。柵格化就是把三維空間切成一個個小立方體有障礙物的格子標(biāo)記為1空閑格子標(biāo)記為0。這種方法的優(yōu)點是碰撞檢測簡單直接查格子就行缺點是精度受分辨率限制環(huán)境一大內(nèi)存就爆炸。假設(shè)一個1km×1km×300m的區(qū)域分辨率5米就是200×200×60共240萬個格子每個格子一個邏輯值數(shù)據(jù)量還能接受。但如果你要檢測航跡點之間的線段是否穿越障礙光查線段經(jīng)過的格子就需要做遍歷計算路徑長、分辨率高的時候每次適應(yīng)度評估都很慢。幾何體建模則是把每個障礙物表示成基本幾何體——長方柱體近似樓宇圓柱體近似塔吊或者信號桿球體近似穹頂建筑或樹木冠層。碰撞檢測變成數(shù)學(xué)判斷點和線段到幾何體表面的距離是否小于安全閾值。這里有一個繞開問題航跡點是離散的幾個點無人機(jī)從第k個點飛到第k1個點中間弧線上會不會撞樓如果用線段近似弧線線段可能切進(jìn)樓體。所以代碼里必須對每段航跡做細(xì)分碰撞檢測——把線段等分成若干個采樣點逐個判斷采樣點是否安全。采樣點越密檢測越準(zhǔn)但計算量線性增長。我推薦幾何體建模。原因很直接這個項目標(biāo)題說“可以修改障礙物及起始點”幾何體方式讓你直觀地修改每個樓的位置、長寬高而柵格化一旦環(huán)境變化整塊地圖的生成代碼都得動。而且?guī)缀误w表示天然支持三維可視化驗證你畫出來的障礙物和代碼里的參數(shù)是一一對應(yīng)的排錯容易得多。3.2 Matlab里寫一個三維城市環(huán)境的開胃菜看一段環(huán)境生成的示例代碼能幫你快速建立感覺。我們定義三類障礙物長方體高樓、圓柱體塔樓、還有一組隨機(jī)低矮建筑群。clc; clear; close all; %% 模擬城市環(huán)境參數(shù) xRange [-500, 500]; % 區(qū)域橫坐標(biāo)范圍米 yRange [-500, 500]; % 區(qū)域縱坐標(biāo)范圍 zRange [0, 150]; % 高度范圍米 numBuilding 12; % 高樓數(shù)量 buildings struct(x, {}, y, {}, w, {}, d, {}, h, {}); % 手動設(shè)置幾棟標(biāo)志性高樓方便控制場景 buildings(1).x 0; buildings(1).y 0; buildings(1).w 60; buildings(1).d 60; buildings(1).h 120; buildings(2).x -180; buildings(2).y 150; buildings(2).w 45; buildings(2).d 40; buildings(2).h 90; % 隨機(jī)生成其余建筑 for i 3:numBuilding buildings(i).x xRange(1) (xRange(2)-xRange(1)) * rand; buildings(i).y yRange(1) (yRange(2)-yRange(1)) * rand; buildings(i).w 20 40 * rand; buildings(i).d 20 40 * rand; buildings(i).h 30 90 * rand; end注意幾個設(shè)計點手動指定的前兩棟樓是為了保證地圖里有一定的高層遮擋不能讓隨機(jī)生成的環(huán)境太“空”每個建筑用x、y中心坐標(biāo)加上寬w、深d、高h(yuǎn)描述后面畫圖、碰撞檢測都直接用這幾個字段。隨機(jī)生成時要判斷樓主不能重疊、不能離起點終點太近這兩個細(xì)節(jié)我們放到第5節(jié)講參數(shù)配置時展開。三維可視化可以直接用patch或者fill3畫樓體也可以用plot3畫長方體線框。再疊加地面平面和無人機(jī)航跡線就能直觀看到規(guī)劃效果。寫一個簡單的長方體繪制輔助函數(shù)會大幅提高后面的調(diào)試效率我在5.3節(jié)給出一個現(xiàn)成的。3.3 碰撞檢測算法跑得快不快的最大瓶頸碰撞檢測是航跡規(guī)劃適應(yīng)度函數(shù)里被調(diào)用最頻繁的部分——每一步迭代每一個個體、每一段子路徑都要做一次檢測。它的效率直接決定整個算法跑得快不快。幾何體模型下的碰撞檢測核心思路是把航跡線段離散成密集點每個點依次和所有障礙物做包含判斷。對長方體判斷點是否滿足“|px - cx| w/2 且 |py - cy| d/2 且 pz h”其中px、py、pz是點坐標(biāo)cx、cy是樓中心w、d、h是樓的寬深高。對圓柱體把三維判斷降維成二維先看pz是否低于柱高h(yuǎn)再看水平距離是否小于半徑r。整個邏輯簡單直接。function isCollision checkCollision(segmentStart, segmentEnd, buildings, sampleStep) % 將線段等距采樣檢測每個采樣點是否被障礙物覆蓋 len norm(segmentEnd - segmentStart); numSamples max(2, ceil(len / sampleStep)); for k 1:numSamples t (k-1) / (numSamples-1); p segmentStart t * (segmentEnd - segmentStart); if isPointInCollision(p, buildings) isCollision true; return; end end isCollision false; end function flag isPointInCollision(p, buildings) flag false; for i 1:length(buildings) b buildings(i); dx abs(p(1) - b.x) - b.w/2; dy abs(p(2) - b.y) - b.d/2; % 點在長方體內(nèi)部的條件三個方向同時“被覆蓋” if dx 0 dy 0 p(3) b.h flag true; return; end % 圓柱體判斷可在這里追加 end end采樣步長sampleStep是個權(quán)衡參數(shù)我個人建議取無人機(jī)最小安全間距的一半。比如要求無人機(jī)離障礙物至少10米采樣步長就取5米。這樣能保證線段上任何一點撞上障礙物至少有一個采樣點落在障礙物內(nèi)部。當(dāng)然這個結(jié)論取決于線段方向和障礙物尺寸理論上更嚴(yán)謹(jǐn)?shù)淖龇ㄊ怯嬎憔€段到障礙物的最近距離但那個計算開銷大工程上用細(xì)分采樣已經(jīng)足夠了。提示千萬不要為了省時間把采樣步長調(diào)大。踩過的坑是采樣步長20米結(jié)果一段路徑正好從樓角擦過檢測時所有采樣點都落在樓外實際飛行時無人機(jī)卻撞了進(jìn)去。寧可每次檢測多算幾十個點也不能漏掉障礙。4. 航跡規(guī)劃數(shù)學(xué)建模三個關(guān)鍵約束4.1 航跡點編碼與適應(yīng)度函數(shù)設(shè)計把DCS算法接到航跡規(guī)劃上第一步要解決編碼問題。每一只“個體”一條候選航跡本質(zhì)上就是一組有序的三維坐標(biāo)點。我常用的編碼方式是首尾固定為起點和終點中間有N個可變航跡點每個點有自己的x、y、z坐標(biāo)。這樣一條航跡就有3×N個自由變量。比如中間取8個點個體就是24維向量。編碼形式直接決定DCS的搜索空間維度也決定收斂難度。N取多少合適太少航跡太僵硬繞障礙物只能走大折線太多維度暴漲搜索效率驟降。城市環(huán)境下取6到10個中間點是比較平衡的選擇。后面我還會講一種改進(jìn)技巧可變航跡點數(shù)量先用少點快速找走廊再加密路徑這個技巧在5.2節(jié)。適應(yīng)度函數(shù)要綜合考慮四個因素寫成加權(quán)和的形式fitness w1 * pathLength w2 * altitudePenalty w3 * smoothnessPenalty w4 * safetyPenalty;其中pathLength是所有航跡線段長度之和直接占總權(quán)重最大通常給0.5到0.6。altitudePenalty用于約束高度避免航跡長時間保持極低或極高——長時間貼地飛行實際場景里容易被地形雜物干擾極高的航跡則可能超出法規(guī)限高。smoothnessPenalty衡量相鄰航跡段的夾角變化。夾角太大說明航跡彎折劇烈飛行器需要急劇減速轉(zhuǎn)彎甚至超出機(jī)動性能。safetyPenalty是所有航跡點到最近障礙物距離的一個懲罰函數(shù)。如果碰撞這個值直接設(shè)為大數(shù)比如1e6。寫代碼時要注意各個量綱差異巨大路徑長度以百米計角度以弧度計安全距離以米計。如果不歸一化直接加和小量綱項對總適應(yīng)度的影響會被淹沒算法等于看不見平滑度約束。我的做法是每個項先除一個典型值——長度除300角度除pi/2安全度除20——得到無量綱的分?jǐn)?shù)再加權(quán)。這個細(xì)節(jié)雖然小但對規(guī)劃結(jié)果的影響非常大。4.2 航跡平滑折線航跡到可飛航跡算法直接輸出的是折線航跡能看但直接讓無人機(jī)飛會很難受。折線的每個拐點無人機(jī)都得先減速、轉(zhuǎn)向、再加速。要是拐點在樓旁邊還容易在轉(zhuǎn)彎過程中擴(kuò)大掃掠范圍碰到障礙物。最輕量的平滑方案是B樣條插值。接到算法輸出的折線航跡之后用三次B樣條在相鄰航跡點之間插值得到一條連續(xù)可導(dǎo)的光滑曲線。然后在安全檢測里要特別注意插值曲線和原始折線不完全重合在某些位置可能更靠近障礙物。所以平滑之后必須再做一次碰撞檢測必要的時候把平滑后的航跡點當(dāng)作新起點重新執(zhí)行一輪DCS微調(diào)。這里還有一個工程細(xì)節(jié)航跡點之間直接用直線連接無人機(jī)實際飛的時候走的是弧線兩個航跡點連線的中垂線外側(cè)可能被建筑遮住但弧線路徑的實際掃掠區(qū)域比折線更“鼓”一點。如果安全裕度只有10米弧線掃掠可能把這10米吃光。所以我在安全檢測時采樣點額外向外偏移一個無人機(jī)安全半徑比如3米相當(dāng)于給檢測結(jié)果加了一層保險。4.3 多目標(biāo)沖突的處理心得我見過很多初學(xué)航跡規(guī)劃的人一上來就把四個約束的權(quán)重調(diào)來調(diào)去總想找到一組萬能權(quán)重。這個思路本身就錯了。權(quán)重和具體地形強相關(guān)高樓密集的CBD區(qū)域安全權(quán)重必須加大開闊平地長度權(quán)重可以更激進(jìn)。不可能有一組權(quán)重同時適合所有地圖。所以我在代碼里做了一個小設(shè)計把權(quán)重參數(shù)暴露成規(guī)劃函數(shù)的外層參數(shù)同時附帶一組合適的默認(rèn)值。默認(rèn)值適配中等密度的城市環(huán)境拿到其他地圖后先跑一次看結(jié)果再微調(diào)。這個思路比追求萬能權(quán)重靠譜得多。另外還有一個技巧如果某次規(guī)劃結(jié)果始終在某個樓角繞不過去大概率不是算法問題而是安全權(quán)重偏小導(dǎo)致最優(yōu)航跡貼著樓角走。把安全權(quán)重上調(diào)30%往往就能看到航跡自動繞開。5. Matlab代碼結(jié)構(gòu)與修改指南5.1 整個項目的模塊劃分拿到這個項目的Matlab代碼第一件事不是打開跑而是先看它是怎么組織的。一個可維護(hù)的航跡規(guī)劃項目至少要有這幾個模塊環(huán)境配置模塊、適應(yīng)度函數(shù)模塊、DCS算法主循環(huán)模塊、可視化與結(jié)果導(dǎo)出模塊。這里給出一個推薦的文件結(jié)構(gòu)flight_path_planning/ ├── main.m % 主腳本設(shè)置參數(shù)調(diào)用規(guī)劃輸出結(jié)果 ├── environment/ │ ├── setupEnvironment.m % 構(gòu)建城市障礙物參數(shù) │ ├── drawEnvironment.m % 繪制三維地圖 │ ├── checkCollision.m % 線段碰撞檢測 │ └── isPointInCollision.m% 點級碰撞檢測 ├── model/ │ └── fitnessFunction.m % 單條航跡的適應(yīng)度計算 ├── algorithm/ │ ├── dcs_main.m % DCS算法主循環(huán) │ ├── dcs_individualInit.m % 初始種群生成 │ └── dcs_update.m % 差異化變異更新 └── utils/ ├── smoothingSpline.m % B樣條平滑 └── export_plot.m % 保存三維視圖我實際用下來把環(huán)境配置和算法邏輯分開非常關(guān)鍵。因為每次實驗改動最多的是地圖參數(shù)——換一棟樓、改一個起點——而不是算法本身。如果所有代碼混在main里改一次地圖要找半天變量位置還容易改壞別的邏輯。分模塊之后改地圖只需要動setupEnvironment.m這一個文件。5.2 修改障礙物、起始點和目標(biāo)點的標(biāo)準(zhǔn)方式先說障礙物修改。打開setupEnvironment.m你會看到一個buildings結(jié)構(gòu)體數(shù)組。要新增一棟樓就多一行buildings(13).x 120; buildings(13).y -80; buildings(13).w 50; buildings(13).d 50; buildings(13).h 80;要刪除一棟樓把對應(yīng)那一行注釋掉就行。要調(diào)整樓的尺寸直接改w、d、h三個字段。這里有一個極易踩的坑當(dāng)你手動調(diào)整之后一定要檢查新建的樓是否擋住了起點或者終點位置。如果起點默認(rèn)在(-450, -450, 10)你把新建樓放在(-460, -460)無人機(jī)出生點在樓里算法再怎么迭代都找不到可行路徑。起點和終點的修改在main.m里找到類似這樣的變量startPoint [-450, -450, 10]; % 起點坐標(biāo)x,y,z endPoint [ 450, 400, 80]; % 目標(biāo)點坐標(biāo)直接改坐標(biāo)值。但除了坐標(biāo)本身還要留意兩個伴隨參數(shù)第一起點高度。城市環(huán)境里如果起點設(shè)在地面z0要確認(rèn)起點附近沒有樓體遮擋否則飛行器一出場就撞樓。第二航跡點數(shù)量N。如果起終點距離長8個中間點可能不夠路徑會繞很遠(yuǎn)的大彎。我的經(jīng)驗是起終點直線距離每增加300米中間點數(shù)量增加1到2個大致夠用。如果想把障礙物改成動態(tài)移動的比如模擬移動車輛、臨時塔臺可以給buildings結(jié)構(gòu)體加一個速度字段然后在碰撞檢測里按時間動態(tài)更新樓的位置。這種擴(kuò)展挺有意思但代碼復(fù)雜度會上一個臺階建議先把靜態(tài)場景吃透再碰。5.3 幾段不用重寫、拿走就能用的代碼片段我把自己調(diào)試時經(jīng)常用的幾個工具函數(shù)貼出來你在原項目基礎(chǔ)上補上就行。第一個是畫三維長方體樓宇的函數(shù)function drawBox(b, color) if nargin 2, color [0.3, 0.3, 0.35]; end x1 b.x - b.w/2; x2 b.x b.w/2; y1 b.y - b.d/2; y2 b.y b.d/2; z b.h; verts [x1 y1 0; x2 y1 0; x2 y2 0; x1 y2 0; x1 y1 z; x2 y1 z; x2 y2 z; x1 y2 z]; faces [1 2 3 4; 5 6 7 8; 1 2 6 5; 2 3 7 6; 3 4 8 7; 4 1 5 8]; patch(Vertices, verts, Faces, faces, ... FaceColor, color, EdgeColor, k, FaceAlpha, 0.7); end第二個是對航跡做三次B樣條平滑的函數(shù)骨架。Matlab自帶的spcrv或者曲線擬合工具箱可以直接用也可以自己實現(xiàn)De Boor遞推。骨架思路是這樣的function smoothPath smoothTrajectory(pathPoints) % 把離散航跡點變成B樣條控制點在相鄰點之間細(xì)分 k 3; % 三次B樣條 % 用曲線擬合工具箱或者自實現(xiàn)De Boor算法生成平滑曲線 % 返回的smoothPath是一個m×3的點列 end第三個是自適應(yīng)調(diào)整縮放因子F的核心片段。放在DCS每次迭代的個體更新之前% fitnessValues 已經(jīng)是當(dāng)前的適應(yīng)度數(shù)組 [~, rankIdx] sort(fitnessValues); F_min 0.2; F_max 0.9; F_array F_max - (F_max - F_min) * rankIdx / NP;這段代碼背后的邏輯對應(yīng)我在2.2節(jié)說的差異化搜索步長排名越靠后的個體F值越大探索步長越大。實測下來用固定F0.6跑同一個場景收斂代數(shù)平均比自適應(yīng)方案多30%左右。5.4 代碼運行流程與結(jié)果解讀主程序跑起來的流程是這樣的加載環(huán)境參數(shù)初始化種群進(jìn)入DCS迭代主循環(huán)達(dá)到最大代數(shù)后輸出最優(yōu)個體解碼得到航跡點做平滑處理重新做碰撞檢測最終繪制三維可視化結(jié)果。跑通之后你會看到一個三維圖里面有樓宇、起點終點標(biāo)記、還有一條穿過街道走廊的平滑航跡曲線。怎么看結(jié)果好壞第一眼看是否繞開所有樓體有沒有穿模。第二眼看航跡是否平滑有沒有明顯折角。第三眼看是否夠短——和起點終點的直線距離對比一下如果繞路太長說明算法可能陷入局部最優(yōu)或者安全權(quán)重過高。我曾經(jīng)在一個場景里規(guī)劃出來的航跡比直線距離長了2.3倍乍一看完全繞開了所有樓像模像樣但直覺告訴我這是爛結(jié)果。后來把起點往旁邊挪了50米重新規(guī)劃路徑縮短了40%。這讓我意識到當(dāng)規(guī)劃結(jié)果異常繞路時環(huán)境本身的地形設(shè)計往往也有問題——起點所在位置太刁鉆通道選擇太窄稍微調(diào)整環(huán)境地形往往立竿見影。6. DCS參數(shù)調(diào)優(yōu)與收斂性調(diào)試6.1 關(guān)鍵參數(shù)一覽與推薦取值DCS這個算法參數(shù)比PSO多不了太多但每一個參數(shù)的敏感性都要實際去摸。我把常用的參數(shù)和推薦區(qū)間列一下參數(shù)含義推薦區(qū)間備注NP種群規(guī)模30~80城市環(huán)境建議40~60太大計算慢太小收斂不穩(wěn)N中間航跡點數(shù)6~10維度3NN太大會指數(shù)級增大搜索難度F_min/F_max差異化縮放因子上下限0.1~0.4 / 0.7~1.0差距越大探索越強但收斂變慢CR交叉概率0.3~0.9城市地形建議0.6~0.8MaxGen最大迭代代數(shù)200~800視野范圍內(nèi)以實際收斂曲線為準(zhǔn)權(quán)重w1~w4適應(yīng)度子項權(quán)重0.3~0.6 / 0.1~0.2 / 0.1~0.3 / 0.05~0.1安全懲罰可以給一個較大固定倍數(shù)有一點必須強調(diào)參數(shù)不是越大越好也不是越小越好而是要和你地圖尺度匹配。地圖范圍500米和2公里同樣的飛行步長和航跡點數(shù)量規(guī)劃結(jié)果天差地別。拿到別人的項目代碼第一件事是看地圖尺度再決定要不要重新調(diào)整參數(shù)。6.2 收斂性判斷別讓算法白跑很多初學(xué)者跑完算法只會看最后那條航跡畫得好不好看。但調(diào)試的時候更該看的是收斂曲線也就是每一代全局最優(yōu)適應(yīng)度值的變化軌跡。畫這個曲線很簡單在DCS主循環(huán)里把每代的bestFitness存下來最后plot(bestHistory)就行。典型收斂曲線分三種形態(tài)第一種是快速下降后進(jìn)入平臺期這屬于正常且健康的收斂第二種是從頭到尾幾乎不下降說明搜索毫無進(jìn)展通常是初始種群生成有問題比如所有個體都在障礙物內(nèi)部或者搜索范圍設(shè)置錯誤第三種是前幾百代緩慢下降最后突然跳水像是有新個體跳進(jìn)了更優(yōu)區(qū)域這看著好但實際上說明前面的搜索效率偏低參數(shù)選得不合適。我的建議是先不急著追求最好航跡先把收斂曲線調(diào)成第一種形態(tài)。如果曲線長時間平坦先檢查是不是F_range太小個體飛不動再檢查是不是種群初始化范圍不均勻?qū)е鲁跏冀馊珨D在角落里。這兩處調(diào)整之后大部分收斂問題都能解決。6.3 拓?fù)浣Y(jié)構(gòu)與慣性權(quán)重的一點擴(kuò)展經(jīng)驗DCS做航跡規(guī)劃可以在基礎(chǔ)版本上做一個小改進(jìn)加入慣性權(quán)重策略也就是在第t代更新時讓當(dāng)前個體的部分信息得以保留new_X(i,:) w_inertia * X(i,:) F(i) * (X(r1,:) - X(i,:)) F(i) * (X(best,:) - X(i,:));w_inertia隨著迭代從0.9線性下降到0.3。前期慣性大個體不容易被全局最優(yōu)拉得過猛能保持探索后期慣性小個體快速匯向最優(yōu)域。這個改進(jìn)代碼改動量很小但對復(fù)雜地形的收斂穩(wěn)定性有明顯幫助。我在多個城市環(huán)境里測試加入慣性權(quán)重后航跡長度平均縮短了約8%而且最優(yōu)航跡的成功率更高。你可以在這個基礎(chǔ)上繼續(xù)擴(kuò)展比如加入航跡點的局部微調(diào)——收斂后期每隔幾代對當(dāng)前最優(yōu)航跡做一次鄰域搜索嘗試把個別航跡點稍微移動一點看能不能降低適應(yīng)度。這種局部搜索和全局搜索的嵌套結(jié)構(gòu)幾乎能覆蓋所有難纏的地形。7. 常見問題與排查技巧實錄7.1 問題速查表我整理了實際調(diào)試這個項目時遇到的幾個高頻問題按癥狀列出來方便你直接對照。癥狀可能原因排查方向規(guī)劃出的航跡穿樓體采樣步長過大或安全權(quán)重偏小調(diào)小sampleStep增大安全懲罰倍數(shù)算法卡住每代適應(yīng)度不變種群初始化范圍太小或F_range過小檢查初始向量范圍是否覆蓋整個地圖增大F_max航跡嚴(yán)重繞路地圖局部通道太窄或權(quán)重失衡嘗試挪動起點或微調(diào)障礙物位置再調(diào)節(jié)長度/安全權(quán)重每次運行結(jié)果差異巨大隨機(jī)種子影響未固定調(diào)試時固定rng(42)對比算法效果才有意義某些障礙物未顯示在圖上繪制函數(shù)忘記遍歷某個類型障礙物檢查drawEnvironment.m里是否涵蓋所有obstacle類型報錯索引越界航跡點數(shù)量與維度定義不一致檢查初始化個體長度是否等于3N67.2 三個幾乎必踩的坑第一個坑是初始化種群時的越界問題。算法生成的個體每個維度是隨機(jī)數(shù)但這個隨機(jī)范圍必須和地圖邊界匹配。如果生成x坐標(biāo)時用rand * 1000而地圖范圍是-500到500那么有相當(dāng)一部分初始個體落在地圖外。它們雖然也能計算適應(yīng)度但往往是無意義的極端路徑拖慢搜索進(jìn)程。解決辦法是把初始化范圍嚴(yán)格設(shè)為地圖范圍lb [xRange(1), yRange(1), zRange(1)]; ub [xRange(2), yRange(2), zRange(2)]; newInd lb (ub - lb) .* rand(1, dim);第二個坑是平滑后未重新檢測碰撞。B樣條平滑后的航跡看起來和原始折線很接近但中間個別點可能更貼近樓角。我在項目第一階段就吃過這個虧視覺檢查覺得沒問題實際飛的時候卻蹭到樓體邊緣。從那以后平滑步驟之后必接一輪碰撞檢測檢測不過就回到平滑前的折線狀態(tài)或者重新規(guī)劃。第三個坑是測試環(huán)境和真實飛行環(huán)境的差異。代碼里你用的樓體是規(guī)則的長方體但真實城市里有大量不規(guī)則的懸挑結(jié)構(gòu)、天臺遮擋。做演示或者畢設(shè)可以忽略但如果你要把這套代碼往實機(jī)上搬障礙物建模和碰撞檢測精度要求會高很多。至少要把樓體建模從單純的長方體升級為多面體把禁飛區(qū)、公共安全區(qū)也建模進(jìn)去并留出足夠的安全裕量。7.3 從生成航跡到可視化驗證的完整閉環(huán)建議代碼跑完只畫一張三維圖其實不夠。我建議再加兩個驗證環(huán)節(jié)。第一個是二維俯視圖把樓宇投影到x-y平面然后把航跡也投影上去這一下就能用肉眼看出航跡是否繞開所有樓體有沒有不必要的繞路。第二個是高度剖面圖畫出航跡的高度變化曲線方便檢查是否有過于劇烈的爬升或下降是否符合無人機(jī)動力系統(tǒng)的爬升率限制。我在一個模擬項目里做過一次完整的驗證閉環(huán)生成航跡俯視圖通過高度剖面發(fā)現(xiàn)有一段300米的航跡高度從90米驟降到15米爬升角接近20度超出了所選機(jī)型的最大爬升角。后來在適應(yīng)度函數(shù)里加了爬升角約束項才把這個問題徹底解決。這個教訓(xùn)提醒我航跡規(guī)劃不能只在x-y平面上看“繞沒繞開”z方向上的飛行性能約束同樣重要缺一個維度都是不完整的規(guī)劃。8. 項目擴(kuò)展方向與一些個人體會這個項目的擴(kuò)展空間很大。比較實用的方向有三個一是接入真實地理數(shù)據(jù)和地圖API讓環(huán)境模型從手動設(shè)置變成真實城市地形樓宇高度、街道寬度都有了真實依據(jù)規(guī)劃結(jié)果更貼近實際部署。二是增加動態(tài)障礙物處理把樓宇之間的飛行通道上可能出現(xiàn)的移動物體納入考慮引入時間維度算法從三維規(guī)劃升級為四維時空規(guī)劃難度會上一截但對實際應(yīng)用價值很大。三是把DCS和其他算法做混合——比如先用DCS粗搜索找到可行通道再用局部優(yōu)化算法在此基礎(chǔ)上做精細(xì)調(diào)整兩層架構(gòu)兼顧全局探索和局部收斂。我個人的實際體會是做這類航跡規(guī)劃項目最容易忽略的不是算法本身而是“規(guī)劃出來的航跡到底能不能飛”這個問題。算法花了很多力氣找到一條數(shù)學(xué)上最優(yōu)的路徑但如果它超出無人機(jī)的機(jī)動性能、續(xù)航能力或者路徑貼近樓宇的縫隙過于狹窄實際使用中就是廢航跡。所以每次調(diào)整參數(shù)、修改地形最終都要回到“無人機(jī)按這條航跡真的飛得過去嗎”來審視結(jié)果。最后再說一個小技巧規(guī)劃完成之后把航跡數(shù)據(jù)導(dǎo)出成文本或者KML格式然后在支持三維地圖的軟件里打開把樓宇粗略建模疊加進(jìn)去做一次虛擬飛行預(yù)覽。這一步能提前發(fā)現(xiàn)很多Matlab靜態(tài)繪圖看不出來的問題——比如某個轉(zhuǎn)彎點實際位置有微小的視野遮擋或者航跡在某棟樓的陰影區(qū)做了不合理的近地飛行。磨刀不誤砍柴工這個額外檢查很值得做。這個項目本身不算特別復(fù)雜但把DCS從零理解透、把城市環(huán)境建模做扎實、把參數(shù)調(diào)優(yōu)經(jīng)驗攢起來一通百通后續(xù)換算法做集群協(xié)同、做動態(tài)避障都能把基礎(chǔ)直接復(fù)用上。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
天天摸天天做天天爱天天爽| 99热国产这里只有| 26uu| 激情五月丁香在线观看直播| 色色日本| 99日韩| 亚洲精品久久久无码| 亚洲色99综合天堂| 婷婷第六色| www久久久| 欧美精品99久久久| 99热6这里之有精品| 久久婷婷桃花五月天| 日本三级中文字幕| 991国产精选视频在线播放下载| 九九碰九九爱97超| 九九Y精品热播| 五月成人网站| 丁香五月成人| 插插插色综合网| 五月丁香六月香香蕉| 久久性综合| 国产五月天婷婷| 超碰99在线| 激情五月伊人婷婷| 天天干电影| 色爽干| 天堂AV三级| 六月天无码网址| 99热综合色图| 九九精品少妇| 欧美va视频不用播放器的va视频网| 九九99热| 色九月婷婷丁香| 99热在线极品极品| 日韩成人电泉AV| 日本色色网站| 在线另类视频| 啪啪91| 久热99| 综合XX网| 色色色色欧美| 亚洲五月丁香综合网| 色婷婷99| 五月婷婷在线综合| 9月色婷婷| 91婷色| 九九热内射| 综合伊人久久| 婷婷天天婷婷天天澡| 大香蕉人妻| 9精品在线| 无码人妻一区二区一牛影视| 久狠日av| 一操久久| 伦乱天堂| 丁香六月开心| 成人网站高清无码| 亚洲精级| 色色性爱视频| 俺也去在线久久精品23欧美综合视频网站,丰满人妻一区二区三区在线视频53,丰满 | 91热久久| 色色婷婷综合网| 国产精品久久久久久久久久| 色吧综合网| 人妻九九九九| 五月丁香美女| 婷婷丁香先锋资源网站| 色色五月天婷婷| 天天噜天天爱| 成人国产网| 色婷婷综合中心| 五月丁香久久| 极品人妻VideOssS人妻| 色99日韩| 操人91| 五月婷婷第四色| 影院久久久| 丁香五月综合网亚洲综合欧美狠狠| 久久久网站| 亚洲综合婷婷五月| 久热这里只有精品6官网亚洲| 五月婷婷片| 在线五月色播| 人人综合91网| 五月天成人综合| 欧美毛片www| 激情综合网激情五月婷婷| 丁香五月婷婷啪啪视频| 久热这里只精品| 五月丁香六月婷婷亚洲激情综合| 成人AV中文字幕| 狠狠色综合网| 另类视在线| 五月婷婷久| 操日视频| 五月丁香在线婷婷蜜桃| 亚洲婷婷91丁香| 激情内射人妻1区2区3区| 婷婷五月天天aV| www99精品亚| 免费看欧美成人A片无码| 97色婷| 五月丁香在线综合| 婷婷六月综合在线| 99性视频| 色婷婷狠狠| 日日爽日日| 五月天开心色情网| 欧美人妻一区二区| 免费播放片大片| 日本色噜| 翔田千里 50岁 无码| 天天激情站| 国产一级婬片毛片| www.思思99热| 欧美综合婷婷欧美综| 色99综合视频| 色婷婷综合视频| 激情99| 欧洲亚洲午夜| 亚洲综合婷婷| 五月综合色| 激情婷婷九月| 五月色丁香激情| 亚洲av日韩无码| 大婷婷色呦呦噜噜色呦呦噜噜| 黄色99网| 日日插日日干| 久久99精品久| 六月丁香婷婷网| 亚洲婷婷在线播放十月| 婷婷丁香五月综合激情小说| 国产精品香蕉| 日韩无码AV电影网站| 婷婷综合伊人| 天天看夜夜看| 久久久天堂国产精品女人| 亚洲人成色A777777在线观看| 第一区久久网站| 色久天| A A色色| 五月天开心网| www.婷婷| 91丨九色丨老熟女激情| 日韩啊啊啊| 综合色播| 亚洲色网络| 精品色色网| 丁香六月成人| 久久五月激情| 色婷婷丁香五月| 久久精品国产AV一区二区三区 | 婷婷亚洲五| 97色女人在线| www.1024久久| 五月亚洲激情| 夜夜干夜夜操| 色天使久久综合| 色 丁香婷婷| www.狠狠| 五月婷色色| 日日噜狠狠色综| 色五月欧美| 五月天婷婷综合久久| 婷婷五月天开心激情网| 91人妻九色大屁股| 99久久精品视频女神1| 九九色影院| 五月婷婷在线视频观看| 五月丁香婷婷综合网| 五月丁香六月情| 九九九九九九热| 超碰91在线| av狠狠操| 五月丁香综合啪啪啪啪啪| 丁香九月婷婷| 思思热99er| 九九亚洲小视频| av国产精品偷| 久久婷婷色五月| 伊久大香蕉| 婷婷五点亚洲| 99,色| 亚洲熟女乱色综合亚洲网站| 五月天婷婷Av| pacopacomama 070722_670 素人奥様初撮りドキュメント 103 大久保純子 | 超碰93在线观看| 婷婷六久久| 久热A| 丁香五月天婷婷91| 丁香五月天激情网址| 久久WW| 九九色热| 国产热精品| 日本色道视频网站| 五月久久丁香| AA丁香综合激情| 激情五月综合网最新| 色五月综合网站| 91黄址| 五月天另类小说| 婷激情五月天视频导航| 国产精品人妻欲求不满| 99日在线观看视频| 色 色 色综合com| 天天爽天天日| 色五月超碰| 桔色成人官方网站| 米奇影视资源777狠狠色婷婷五月天激情网 | 九九热亚洲中文在线观看免费| 国产AV一区二区三区最新精品| 色色色色色综合| 九九五月天| 久久大香蕉视频| 92久操视频| 亚洲春色奇米影视| WWW.桔色成人.COM| 热99在线| 香蕉久久国产AV一区二区| 另类激情首页| 狠狠色噜噜| 天天操天天操天天操天天操天天操天天操天天操天天操天天操 | 天天插天天插天天插天天插 | 亚洲精品V天堂中文字幕| 色婷婷五月色| WWW99热| 26uuu欧美亚洲日韩| 久久婷婷亚洲| 奇米色大香蕉| 激情5月舔| 婷婷亚洲影院| 亚洲综合婷婷五月| 亚洲天堂九九九| AV在线中文| 久久九九99亚洲国产久精综合| 人妖色AV色综合| 色五月丁香91| 色色色色色热| 啄木鸟黑丝一区二区| 亚洲AV激情五月综合网| 亚洲激情免费视频| 亚洲国产精品VA在线看黑人| 97sese婷婷| 九九热a| 丁香五月婷婷无码AV| 91大屁股| 伊人激情AV一区二区三区| 天天久久婷婷| 色五月婷婷五月天激情综合| 91丁香综合| 日本在线播放97| 婷婷丁香综合| 强伦轩人妻一区二区电影| 任你爽免费视频| 噜综合| 99惹在线精品免费观看| 丁香五月91| 538在线精品| 伊人综合网站| 欧美在线视频免费播放| 人人妻人人澡| 几激情五月婷婷色五月色天堂| 五月丁香婷婷AV| 超碰人人99| 91日本在线观看| 波多婷婷久久| 九九色热视频| 久久久免费图片视频| 涩涩五月天综合| 久久男人网婷婷| 狠狠操之狠狠操| 伊人网啪啪| 大地资源色婷婷视频在线| 日韩AV大全| 狼人狠狠操| 五月情婷婷| 精品无码久久久久久久久| 女人天堂AV| 丁香av网| www激情婷婷com| 亚洲综合五月天| 色婷婷玖玖影院| 久久精品婷婷| 九九sese| 亚洲传媒在线观看| www.久久av.com| 久久99免费视屏| 色婷婷成人做爰A片免费看网站| 超碰AV成人| 欧美丁香婷婷五月天| 亚洲区1| 激情伊人五月天| 狠狠色噜噜狠狠狠狠狠色综合久久| 亚洲第一色色色| 欧美精品在线观看| 色播丁香| 丁香六月婷婷久久综合| 天天操天天日天天爱| 日韩成人中文字幕| 五月丁香婷婷人体| 亚洲顶级VA在线观看-高清完整版在线影院观看-S022AV | 日本高清综合网五月丁香| 久久婷婷东京热大香樵| 影音先锋91| 丁香六月天AV| 操草草草| 大香蕉九九| 久久机热/这里只有精品| 天天操狠狠操| 色婷婷综合视频| 五月丁香色综合| 色五月激情问网站| 色婷婷丁香| 在线观看国产高清视频免费网站| 五月天婷a| 亚洲激情在线| 热九九精品| 色色色色色色综合网| 五月婷婷婷丁香播| 色域五月婷婷丁香| 狠狠干无码| 成年AAAA色情| 激情五月天色网站| 色婷婷丁香五月天在线视频| 先锋资源91| 无码免费人妻A片AAA毛片西瓜| 亚洲最大视频| 99精彩视频| 激情四射五月天偷偷看婷婷| 激情综合网五月| 91一起操| 人人爱操| 五月丁香激情四射| 久久性刺激| 激情99热| 91免费看片| 变态另类色图| 色九九中文字幕| 激情久久丁香| 只有精品视频在线观看| 久久婷婷青草五月天| 婷婷天堂站| 另类五月婷婷| 五月丁香婷婷五月色| 成人网在线视频| 超碰操日| 成人短视频免费观看| 综合福利网| 色欧美一级| 欧美综合五月天婷婷tin| 国产精品久久久久久妇女6080| 九九九九这里只有精品| 丁香五月激情网| 天天干天天日天天操| www.夜夜操| 久久久精品色| 91中文狠狠综合| 亚洲天堂婷婷| 色色色色色五月| 丁香五月色激情| 久久综合五月情| 任你干aa| 伊人久久大香线蕉亚洲五月天,| 最新婷婷五月丁香| 久操大香蕉| 四虎婷婷五月天| 久久久久亚洲AV无码网影音先锋| 99啪啪网| 伊人丁香在线| 91超碰在线观看| 五月四色婷婷| 丁香五月社区| 五月婷婷69| 激情小说五月天| 99丁香五月| 九九综合88| WWW.久久久久久久| 怡红院院久久| 色丁香五月婷婷| A久久| 91丨九色丨熟女高潮| 亚洲人妻五月丁香婷婷| 五月丁香婷婷综合视频| 久久人人做人人妻人人玩精品va| 丁香五月色综合色播五月| 六月丁香综合| 一本九九色| 日韩按摩二区| 日本色色色色色色色色一色二色| a九九热www| 婷婷五月天成人基地| 26uuu亚洲欧美| 精品一二三区久久AAA片| 日日噜狠狠色综| 国产色网站| 任你搞免费视频观看| 久久精品4| 91n网站cad入口在线观看| 日本久久网| 五月花免费视频| 另类国产区| 5月丁香六月婷婷| 强辱丰满人妻HD中文字幕| 中文字幕综合色| 五月激情综合深爱| 99日视频在线| 99久久极情精品一区| 九九九九九九综合| 在线成人网址| 五月婷婷色情| 激情久久久久久| 99久久久99久久91熟女| 婷婷五月天福利| 人妻久久久久久久久妻久久久久久久久| 99热综合色图| 色五月亚洲| 天天日人人| 九色七七| 9色在线| 欧美一级色| 热久久视频99| 婷婷五月天va| 91九色视频| 色婷婷成人做爰A片免费看网站| 日韩一66精品| 九月丁香婷婷综合| 色综合婷婷| 五月色网| 99久久精| 玖玖婷婷视频| 激情六月天| 五月婷综合| 五月丁香 啪啪啪| 在线你懂的亚洲欧| 九九re视频在线视频| 亚洲精品V天堂中文字幕| 狠狠干综合网| 色五月综合在线| 久草a片| 久久丁香五月婷婷| 变态另类9| 玖玖综合网| 色五月首页| 色丁香婷婷美女视频网站| 婷色影院| 久久婷婷热| 麻豆AV一区二区三区| 久久人妻久久| 五月天激情久久| 亚洲六月婷婷| 色婷婷欧美| 激情综合网激情五月天| 激情内射人妻1区2区3区| 国产精品爽爽久久久久久| 亚洲性爱99在线| 亚洲激情网站无码| 欧洲日韩一区二区三区| 五月天中文网| 激情五月天免费视频| 五月草视频| 79色色色色| www.狠狠操.co m| 六月丁香综合网| 久久精热| 久久这里有精品| 免费观看欧美成人AA片爱我多深| 骚。com| 香蕉久久国产AV一区二区| 激情五月丁香婷婷| 五月激情天| 99热这里只有精品免费| 婷婷久久网| 婷婷久久六月天| 久久人妻www| 大香蕉综合在线| 精品热九九| 婷五月天丁香婷五月| 欧美激情xxxXX| 激情五月五月婷婷| 五月丁香777| 夜色.cnm| 激情五月五月五月婷婷| 性色做爰片在线观看WW| 91男人资源站| 婷婷综合另类小说| 激情99| 久综合4| 五月色亭丁香| 韩国婷婷丁香五月| 亚洲AV免费在线| 天天插天天玩天天干| 五月婷久久在线| 99日本黄站| 9999热精品| 婷婷五月天色网久| 亚洲综合网区| 精品无码久久久久久久久| 五月丁香色色| 日本三级大片| 怡红院91a√| 丁香六月欧美| 大鸡巴伊人网| 五月天成人网婷婷| 天天做天天爽| 日韩九区| 99碰超| 色 五月 天 婷婷 丁香 九月| 99热这里只有精品青草| 操操操B| 久久丁香五月天| 久久婷婷丁香六月天| 色五月综合| 婷婷激情网五月天| 中文字幕婷婷| 操操人人| 久久ab| 亚洲五月六丁香激情| 99精品成人无码A片观看金桔| 色播丁香五月婷婷操:屄| 久久99精品视频| 亚洲色无码| 91主播在线| 99热精品一区| 国产精品操| 国产肥白大熟妇BBBB视频| 亚洲激情淫网| 五月丁香人妻| 色色国产| 538任你爽| www.99成人视频| 激情五月天小说|五月天开心激情网|亚洲精品国产自在现线|黄色五月天 | 爱狠射| 久久这里99| 天天色情站| 99热精品9| 九九热99视频| 五月天天丁香婷婷| 色狠狠婷婷| 9久久久久久久久久久| 丁香婷婷色情| 色亚洲婷婷| 欧美天堂婷婷日韩| 国产精品第一国产精品| 久久99美女精彩视频| 久操97| 亚洲九九99精品视频在线播放| 激情另类综合| 色欲久久久久| 99福利导航| 久久久中文| 99久久精品视频女神1| 五月丁香 六月婷婷a| 欧美色偷偷大香| 狠狠色综合网| 午夜婷婷六月天| aaaaa黄色| 国产色色在线| 久久婷狠狠色| 婷婷久久性爱| 香蕉网久久| 丁香六月狠狠干| 丁香av网| 草草色情综合网| 99热免费| 久综合4| 六月婷婷五月丁香| 久操大香蕉| 思思视频这里是精品| 男人天堂AV在线一区二区| 26uuu欧美| 久久色9| 人人操99| 久久久久久婷| 伊人在线大香蕉网| 丁香婷婷婷五月综合色情| 色噜噜狠狠色综无码久久合欧美| 色婷婷电影| 丁香五月开心七月| 夜夜嗨一区二区三区直播内容 | 五月天婷久久| 日本色婷婷| 超碰av在线| 激情文学 综合 九月| 亚洲成人网站在线观看| 色99在线看| 日韩成人影片在线观看| 波多野结衣AV无码Porn| 婷婷丁香五月天中文字幕| 99er6热在线观看精品6| 久久99网| 国产精品18久久久| 色九九九综合| www.91.com处女在线直播| 亚洲性爱干干| 五月丁香六月久久| 中文在线成人| 久久视频在线视频| 久久东京热婷婷五月| 婷婷精品综合| 国产九月婷婷| WWW99热| 激情五月婷婷丁香| 99性爱视频| 99碰在线视频| 思思精品久久艹| 五月婷婷在线视频| 午夜色色色极品视频| www.minyis.com【JT】国内CDN落地页保证转化QQ2101460746 | 99亚洲日韩| 99热免费| 一区=区操屄高清大全av| 亚洲五月婷婷| 丁香五月婷婷色情综合| 第四色五月天| 久久五月情| 色色国产| 五月丁香六月婷婷综合| 我要看激情五月天| 亚洲成人影视在线观看| 超碰婷婷色| 呦呦v线| 九九久久99| 亚洲网综合在线| 久月丁香爱婷婷综合| 99日本黄站| 九 九九九AV| 五月丁香六月婷婷在线| 成人综合网站| 色5月婷婷| 超碰九热| 99色色网| 五月丁香天天| 99色爱| 丁香伊人综合| 婷婷久久色| 99在线小视频| 激情精品久久| 99免费热视频在线| 激情五月丁香婷婷夜夜操| jiZZdr| 色999亚洲人成色| 99re视频在线播放| 超碰人人干| 五月丁香久久| 超碰AV在线| 狠狠干在线视频| 色婷婷激情| 色婷婷婷婷| 99热精品中文字幕| 橾逼网| 亚洲av免费在线| 八戒青柠影视剧在线观看| 5月丁香六月婷婷| 色播综合| 婷婷五月激情欧美大胆视频| 一区二区乱码视频| 丁香五月婷婷六月婷| 色综合久久久综合久久网| 久久色情| 五月丁香六月婷精品视频| 人碰91| 国产精品成人AV在线| 凹凸7777操操操| 五月天激情综合网| 色婷婷网| 四色永久成人网站| 色五月天天在线观看资源站| 色人久夂| 爆乳熟妇一区二区三区四区| 天天cha成人综合网| 97超碰99热99| 91久久99久久91熟女精品| 色五月成人在线| 丁香五月婷婷av| 人人干人人操外国| 色色色色色网| 天天更新天天亚洲| 久久狠狠干| av网址在线| 伊人午夜综合色啪| 五月天色狠狠| 丁香五月激情综合网激情五月| 丁香五月婷婷五月基地| 中文字幕高清av| 噼里啪啦完整版中文在线观看| 成人丁香五月| 午夜不卡久久精品无码免费| 开心五月婷婷综合在线精品素人| 久人操| 婷香五月| 色婷婷五月影视| 激情综合网五月| 六月丁香激情综合网| 婷婷丁香77777| 丁香综合婷婷开心激情网| 色五月婷婷激情综合网| 婷婷综合成人五月天| 日日操天天操| 久色网| 日本V在线观看不卡视频网站| 欲求不满的人妻| www.婷婷五月.com| 国产激情久久| 欧美性爱五月天| 日日夜夜狠狠| 亚洲啪啪精品| 98永久精品| 成人美女网| 噜噜久| 97人人操人人爽| 成人无码髙潮喷水A片| 夜夜爽77777妓女免费下载| 久久久中文| 五月丁香成人网| 久久九九@| 婷婷色基地| 噜噜狠狠色| 五月天婷婷AV| 夜夜撸天天操| 五月激情综合网| 久久婷婷五月综合色欧美| 婷婷中文字幕欧美| 色欲AVV| 久久婷婷草| 日本三级日本三级三级人妇四虎| 少妇婷婷五月天| 五月婷婷之美女图片| 六月婷婷久久大全| 狠狠色狠狠色综合日日91| 久久五月婷婷电影| 无码区婷婷五月花开| 六月激情婷婷| 婷婷综合视频| 五月婷婷丁香五月亚洲色| 开心五月深爱五月婷| 五月婷婷七月丁香| 91操人| 1995年关宝慧版蜘蛛女| 九月色婷婷综合| 日本狠狠干| 五月色天情| 婷婷四色五月| 久久R激情| 久久精品五月天| 五月婷婷六月丁香首页| 日本综合久| 激情五月婷婷色| 婷婷五月激情网| 夜夜嗨一区二区三区直播内容| 丰满老熟妇BBBBB搡BBB| 久久免费试看120秒| 九九视频网| 99r这里只有精品在线观看| 99自拍视频| 五月丁香婷婷钟和色图| 伊人喵咪a V| 91精品久| 五月 丁香 欧美| 婷婷五月天改成什么了| 丁香六月婷| 久热免费| 99综合网| XX久久| 九九五月天| 天天操综合网站| 色婷婷丁香五月| 日韩中文字幕| 亚洲AV无码成人电影| 精品成人久久久久久久_一二三四视| 狠狠狠狠狠狠狠狠狠狠狠色宗合图片| site:esunnet.com| 99热日| 天天天天干| 4399欧美另类视频| WWW.色婷婷.COM| 99色热视频| 久久久婷| 国产av一区二区三区| 激情婷婷| 97久操| 婷婷五月天在线观看免费| 六月婷婷五月丁香| 超碰在线观看9| 亚州视频九九99| 日日干日日| 婷婷五月天影院| 久操大香蕉| 免费黄色片子| 日日夜夜小色哥| 婷婷丁香五月噜噜噜| 亚洲综合五月天| WWW.久久久久久久久久久久久| 五月丁香六月合| 日本不卡中文字幕| 97在线/亚洲| 婷婷色一二三区波多野结衣| 激情婷婷色五月| 色五月av| 激情综合播播| 99亚洲精品| 欧美情月伍月天| 久久综合干| 综合婷| 五月天网站免费欧美| 亚洲无码猫咪| 天天摸天天舔| 亚洲亚洲人成综合网络| 婷婷大美在线| 亚洲视频一区| 99热这里只有精品23| 日日影院 | 亚洲另类婷婷五月综合| 色日本颜射| 婷婷深爱网| 亚洲六月综合激情久久下卡| 情婷婷五月天| 97在线干| 欧美日本黄色| 日韩九区| 婷婷在线视频| 丁香玖玖| 五月天激情小说| 亚洲色爽| av操逼网| 丁香六月婷婷综合欧美| 婷婷激情小说| 久久五月丁香六月婷| 婷婷五月在线视频| 青青青在线视频国产| 97成人丁香婷婷| 精品夜夜澡人妻无码AV| 人人97碰| 五月婷婷色播| 日日干综合| httpwww色com日本| 四月丁香五月婷婷久久| www.刺激色网站www.| 超碰在线免费| 国内裸舞二区| 丁香五月偷拍| 婷婷五月天免费视频在线观看| 日本三级色| 天天搡日日搡aaaaⅩ| 婷婷五月天成人五月天| 婷婷五月丁香青青草在线| 亚洲国产精品VA在线看黑人| 99色在线视频| 欧美色片中文字幕久久久久| 色色亚洲无码| 超碰丁香五月| www.婷婷五月| 婷婷激情五月天小说校园| 亚洲欧美日韩另类| 99性视频| 狠狠草综合网| 久9视频| 综合久久婷婷99| 五月丁香精品| 五月婷婷精品无在线| 婷婷丁香97| 丁香五月婷婷高清| 亚洲综合激情五月久久| 亚洲国产va| 五月丁香综合| 国产精品美女久久久久AV超清| 亚洲色A| 色色色色综合网| 婷婷综合中文| 婷婷亚洲综合| 青青草原中文字幕| 欧美男女婷婷| 婷婷中文字幕| 亚洲成人在线综合| 99色热视频| 久久久99视频| 五月丁香色色色| 五月天无码视屏播放| 国产精品成人网站| 日本人妻伦在线中文字幕| 激情綜合網址| 色色色色色色色色五月先| 欧美日本不卡黄色片| 亚洲色综合| 国产精品久久久海的味道| 乱女乱妇熟女熟妇综合网站| 免费播放片大片| 色很久综合| 综合五月激情| 激情五月第四色| 亚洲超级碰| 成人电影在线免费试看| 1024操逼| 五月婷婷av| 狼人婷婷综合| 亚洲操b| 五月丁香色狠狠干大屄| 天天做天天爱天天搞| 亚洲色五月婷婷| 99热每日| 五月丁香六月婷| 99操无码视频观看| 亚洲另类日本| 开心激情网在线| 深爱激情网噜噜色| 99热这里只有精品268| 久久久性爱网| a免费在线| 色久五月天| 五月激情综合深爱| 深爱五月天婷综合| 色婷婷四色| 亚洲妇女熟BBW| 99激情视频| 九九精品热| 亚洲色啪| 九九九九这里只有精品| 天天操夜夜夜拍拍拍| 中文激情网| 99九无网码| pom538精品视频| 99热精品网| 久久婷综| AV亚洲在线| 超碰免费电影| 9 9 9色色| 丁香五月婷婷欧美激情-中文天堂最新版在线观看 | 日日操夜夜爽| 五月天婷婷成人| 高清视频一区| 伊人啪啪网| 激情色色| 熟女色色一区二区| 色婷婷激情视频| 热九九九九| 天天肏天天肏天天肏| 五月激情六月综合| 五月婷婷激情综合网| 五月天狠狠| 天天爽天天| 99五月香婷婷丁香在线视频| 色色色综合网| 国产古装妇女野外A片| 欧美成人猛片AAAAAAA| www.丁香黄色五月天人与| www.99.色| 婷婷视频网| 超碰免费人| 免费视频WWW在线观看网站| 色五月五月婷婷| 婷婷五月天xxx| 99视频在线观看欧| 激情综合网址| 99综合| 99热在线观看| 99免费在线视频| 亚洲AV无码电影| 九九这里只有精品在线视频| 丁香色六月| 狠狠色 综合色区| 日韩AAAAAAAAAAA片| 久久精典| 97在线观视频免费观看 | 色插综合网| 五月草视频| 精品乱码久久久久| www五月婷婷88导航| 国产日产亚系列精品版优势| 九九超碰人人| www,五月天com| 草做免费在线观看| 人人操AV| 综合狠久久| 99热官网精品在线| 开心五月天私房婷婷| 日韩在线婷婷五月天综合| 91色色色18| 碰97 久| 任你日热视频| 五月人妻婷婷| 丁香五月亚综合图片| 国产精自产拍久久久久久蜜| 九一牛视频探花| 久久综合丁香五月| 99热这里有精力| 五月天堂婷婷| 五月婷婷深深爱| 91精品国产综合久久久不卡电影| 超碰爱爱爱| 五月激情婷婷播播网| VA五月激情在线| 天天天综合网| 九九热最新| 99热热这里只精品996小说| 九九草热在线观看| 五月停停丁香| 中文av网| 激情 婷婷| 俺去也在线官网| 狠狠做婷婷| 色偷偷综合| 亚洲色就是色色色| 欧美欧盟性爱网| 九九久久污| 丁香伊人综合| 婷婷日日夜夜| 免费视频WWW在线观看网站| 97福利视频| 九九无码视屏| 成人国产欧美大片一区| XX久久| 开心激情网在线| 99久久国产宗和精品1上映| 超碰在线看| 激情綜合網址| 九九热最新地址| 成人亚洲精品久久久久| 99国产er热视频| 超碰免费成人| 人操人| 深爱五月婷婷开心中文字幕| 色婷婷五月在线| 第1影院之五月婷婷| 天天射夜夜骑| 国产做A爰片毛片A片美国| 久久五月婷婷电影| 五月婷在线影院| 天天操天天操天天操| 婷婷五月丁香久久| 老美AA片| 色色婷婷丁香五月天| 丁香五月婷婷综合激情哟哟哟| 五月丁香婷色| 亚洲精品久久久久久久久久吃药| 日本在线观看99| 久久婷婷五月天激情唯美| 色135综合网| 亭亭丁香aV| 综合激情啪啪| 免费观看的av| 一婬一伦一区二区三区| 丁香久久| 六月婷婷青青青视频| www 五月天 com| 99在线精品免费视频| 久久伊人日日夜夜| 久久se 综合网 | 一级性感黄色内射视频| 色五月婷婷五月| 色玖玖综合网| 99精品视频偷拍| 伊人超碰| 色色婷| 91九色首页| 五月丁香六月激情综合啪啪| 婷婷丁香六月| 五月间天堂综合| 思思热99er在线视频| 色三级色三级| 操碰97| 婷婷五月天激情在线观看| 最近中文字幕2019视频1| 婷五月天天| 丁香五月播播| 北条麻妃九九九国产精品视频| 精品综合久久久久久五月天| 激情五月婷婷五月| 免費亭亭成人| 亚洲99综合| 激情九色| 色色a| Av大香蕉| 九月丁香婷婷综合激情| 久久这里都是精品| 丁香六月激情| 久久人人看| 丁香五月综合高清在线| 欧美成人精品A片免费一区99| 99秘 在线| 国产精品色| 丁香婷婷五月基地| 610018岁成人视频| 午夜色丁香| 色射影院| 九九自拍网| 婷婷综合视频| 五月婷婷丁香成人网| 大香蕉久久综合网| 亚洲综合激| 久久98| 性按摩玩人妻HD中文字幕| 99re99热| 天天做天天爱天天高潮| 天天精品视频在线观看视频| 色爱亚洲| 最新久久网址| 综合色五月亭亭| 蜜桃婷婷五月| 97日韩无套内| 丁香激情网| 色吊丝av中文字幕| 天天爽夜爽| 狠狠操天天操| 五月婷婷六月丁香首页| 日日日日日| 无套内射极品大美女| 亚洲综合草草| 久久A极片| 免费黄色片子| 日本久久超碰| 成人.在线日韩| 五月丁香六月婷婷综合网站| bbwcuckold精品熟妇| 亚洲亚洲人成综合网络| 超碰在线观看9| 亚洲在线综合| 亚洲综合在线视频| 天天干-天天日| 久久精品系列| 99欧美| 天天色视频| 狠狠综合网| 色情五月天A片| 99热99网| 亚洲色夜| www99精品| 狠狠色丁香久久婷婷综合五月| 99视频色在线观看| 色五月婷婷AV| 婷婷五月,综合伊人| 开心五月深爱五月| 66精品成人免费网站在线观看| 综合色影| 深爱激情丁香五月| 九九黄色网| 激情综合99| 色婷婷丁香五月| 婷婷99狠狠躁| 天天撸夜夜爽| www婷婷| 91干| 玖玖午夜视频| 激情婷婷人妻| 激情五月综合色| 久久免费9| 久久久久亚洲AV无码网影音先锋| 色婷婷狠狠色| 五月丁香网av| 色综合久网| 91精品久| 大香蕉人人网| 99精彩视频在线观看| 91操碰| 婷婷五月AV| 色播五月丁香| 开心婷婷五月| 色婷婷先锋| 激情五月天开心网丁香无码| 91超级碰碰| 五月天婷婷小说| 久99久视频| 99久re热视频精品98| 性爱久久| 无套内射极品大美女| 日本狠狠爽| 插插干干干色| 开心五月婷婷在线视频免费观看| 狠狠做五月婷婷| 狠狠爱婷婷爱| 色综合av超碰| 激情亭亭五月| 日韩一级网站| 最新高清无码专区| 艹B高清无码| 婷婷丁香大香蕉| 日本熟妇乱妇熟色A片蜜桃| 天天天天操| 三人荫蒂添的好舒服A片 | 日本婷婷激情四射中文字幕在线观看| 久狠狠狠| 色婷网| 久热只有精品| 色婷婷久久| 人操91在线| 99热99色| 少妇AB又爽又紧无码网站| 亚洲综合网在线| 九月性爱网| av免费在线网站| 大香蕉久久草| 精品无码色| 深爱丁香激情| 岛国AV网站| 色婷婷瘦婷婷日韩| 99热这里都是精品| 婷五月天天| 婷婷五月天激情综合深爱| 精品久久久人妻| 色五月琪琪| 丁香色婷婷| 大香久久综合网| 九九99在线视频| 色色色欧美| 这里只有精品在线播放| 久久开心五月天激情| 成 久久| 久青操| av在线免费网站 | 狠狠色狠狠鲁| www.天天日| 天天爽天天日| 欧美性做爰大片免费看办公室| 丁香五月天婷婷激情| 极品人妻VIDEOSSS人妻 | 激情AV| a片在线免费观看一区| 亚洲第一成人无码A片| va亚洲中文在线| 开心五月深爱五月丁香五月激情五月 | 亚洲综合久| 欧美性爱特黄一级aaaassss| 五月婷婷六月色| 丁香色五月 97干| 在线视频区| caop在线| 色综合综合色| 日韩成人AV在线| 免费九九热| 五月天俺去也| 婷婷色五月激情强奸四射| 亚洲蜜桃精久久久久久久久久久久 | 五月丁香成人视频| 色婷婷电影网| 91疯狂操操操操| 这里只有精品99www| 超碰色综合| 丁香花大香蕉婷婷综合| 亚洲精品国产成人AV在线| 色综合综合网| 国产午夜一区二区三区| 九九热99熟女| 久久网址99热| 久久婷婷五月免费视频| 五月丁香婷婷激情在线| 婷婷中文字幕版| 婷婷五月久久| 日本久久婷| 午夜性做爰电影| 欧美人与性动交CCOO| 91日日日| 九九亚洲视频| 精品一区二区三区免费毛片爱| 五月天婷婷影院| 激情5月婷婷| 逼特逼在线免费播放| 99性视频| 五月天成人在线视频网站| 青青久在线视频免费观看| 色婷婷丁香女女| 九九热99精品在线| 夜夜谢天天干| 色综合色香蕉网| 91人妻视频| 久婷婷婷| 中国操逼99| 免费人人操|