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

ARTICLE DETAIL

資訊詳情

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

動(dòng)態(tài)環(huán)境下多無(wú)人機(jī)協(xié)同路徑規(guī)劃與防撞Matlab實(shí)現(xiàn)方案

動(dòng)態(tài)環(huán)境下多無(wú)人機(jī)協(xié)同路徑規(guī)劃與防撞Matlab實(shí)現(xiàn)方案 動(dòng)態(tài)環(huán)境下多無(wú)人機(jī)協(xié)同路徑規(guī)劃與防撞這套Matlab方案我是這么落地實(shí)現(xiàn)的多無(wú)人機(jī)協(xié)同路徑規(guī)劃與防撞前兩年還是實(shí)驗(yàn)室里的前沿課題現(xiàn)在幾乎成了無(wú)人機(jī)應(yīng)用落地的必答題。無(wú)論是物流配送、農(nóng)業(yè)巡檢還是編隊(duì)表演凡是涉及“多機(jī)同場(chǎng)”的場(chǎng)景都繞不開路徑規(guī)劃和防撞這兩個(gè)核心問(wèn)題。我在這塊斷斷續(xù)續(xù)做過(guò)幾個(gè)項(xiàng)目最近重新整理了一套基于Matlab的實(shí)現(xiàn)方案專門針對(duì)動(dòng)態(tài)環(huán)境也就是障礙物會(huì)動(dòng)、目標(biāo)點(diǎn)會(huì)變、甚至是多無(wú)人機(jī)之間彼此互為障礙物的場(chǎng)景今天把整個(gè)研究思路、代碼架構(gòu)和踩過(guò)的坑一次性說(shuō)清楚。這套方案適合誰(shuí)如果你剛接觸多智能體協(xié)同或者在讀論文時(shí)對(duì)“動(dòng)態(tài)環(huán)境下的協(xié)同路徑規(guī)劃”這個(gè)概念一頭霧水再或者你已經(jīng)寫好了單機(jī)路徑規(guī)劃但不知道怎么擴(kuò)展到多機(jī)這篇文章都能給你一個(gè)可以直接上手的參考。實(shí)現(xiàn)層面不用C也不用ROS純粹Matlab就能把核心邏輯跑通可視化調(diào)試也非常方便。1. 動(dòng)態(tài)環(huán)境下多無(wú)人機(jī)協(xié)同路徑規(guī)劃的整體設(shè)計(jì)思路1.1 為什么“動(dòng)態(tài)環(huán)境”是繞不開的關(guān)鍵詞很多入門教程教的是靜態(tài)路徑規(guī)劃障礙物位置固定目標(biāo)點(diǎn)位置固定無(wú)人機(jī)按規(guī)劃好的路線飛就行。但真實(shí)場(chǎng)景沒有這么友好——障礙物可能是在移動(dòng)的比如車輛、行人和飛鳥其他無(wú)人機(jī)本身也在動(dòng)甚至任務(wù)目標(biāo)都可能中途改變。動(dòng)態(tài)環(huán)境的核心難點(diǎn)在于一個(gè)“變化”的詞第一次規(guī)劃出的路徑第二次可能就不可用了因此系統(tǒng)必須具備實(shí)時(shí)重規(guī)劃能力。我在實(shí)際項(xiàng)目中感觸最深的一點(diǎn)是所謂“協(xié)同”并不是簡(jiǎn)單地把多架無(wú)人機(jī)各自規(guī)劃好的路徑拼在一起而是要處理路徑之間的耦合關(guān)系。舉個(gè)簡(jiǎn)單例子兩架無(wú)人機(jī)同時(shí)飛向同一個(gè)任務(wù)區(qū)域如果各自按最短路徑規(guī)劃大概率會(huì)在中間某個(gè)位置相遇此時(shí)必須有機(jī)制讓其中一架讓路或者雙方共同調(diào)整軌跡。這就是協(xié)同路徑規(guī)劃要解決的本質(zhì)問(wèn)題而防撞是協(xié)同的下層約束。1.2 協(xié)同規(guī)劃的核心架構(gòu)集中式還是分布式在設(shè)計(jì)這套Matlab方案時(shí)我首先面臨架構(gòu)選擇集中式還是分布式。集中式的思路是所有無(wú)人機(jī)的狀態(tài)匯總到地面站地面站統(tǒng)一規(guī)劃出所有無(wú)人機(jī)的軌跡再下發(fā)執(zhí)行。優(yōu)點(diǎn)是全局最優(yōu)性好但問(wèn)題在于計(jì)算量隨無(wú)人機(jī)數(shù)量呈指數(shù)增長(zhǎng)而且對(duì)通信依賴極強(qiáng)地面站一旦失效全盤癱瘓。分布式相反每架無(wú)人機(jī)獨(dú)立計(jì)算自己的路徑通過(guò)通信或其他無(wú)人機(jī)的位置信息達(dá)成協(xié)同。擴(kuò)展性好魯棒性強(qiáng)但容易出現(xiàn)局部最優(yōu)多機(jī)之間的協(xié)調(diào)也需要額外策略。這套實(shí)現(xiàn)方案我選的是“集中規(guī)劃分布式避障”的混合架構(gòu)任務(wù)分配和目標(biāo)點(diǎn)規(guī)劃集中在主控制器完成而實(shí)時(shí)防撞交給每架無(wú)人機(jī)的局部邏輯。這樣既保證了整體協(xié)同的效率又能在動(dòng)態(tài)環(huán)境中快速響應(yīng)突發(fā)障礙。對(duì)于中小規(guī)模無(wú)人機(jī)編隊(duì)10架以內(nèi)這個(gè)架構(gòu)在Matlab里跑起來(lái)性能完全能接受。1.3 模塊劃分與數(shù)據(jù)流設(shè)計(jì)整套代碼我按功能拆成四個(gè)模塊環(huán)境建模模塊、路徑規(guī)劃模塊、防撞決策模塊和可視化模塊。數(shù)據(jù)流是這樣的環(huán)境模塊負(fù)責(zé)維護(hù)靜態(tài)障礙物和動(dòng)態(tài)障礙物的實(shí)時(shí)位置路徑規(guī)劃模塊根據(jù)當(dāng)前環(huán)境為每架無(wú)人機(jī)生成參考路徑防撞決策模塊檢測(cè)參考路徑與障礙物或其他無(wú)人機(jī)是否沖突若有沖突則觸發(fā)局部重規(guī)劃可視化模塊做實(shí)時(shí)渲染把仿真過(guò)程展示出來(lái)。模塊化帶來(lái)的好處非常直接你可以單獨(dú)替換路徑規(guī)劃算法而不影響防撞邏輯也可以只調(diào)試防撞參數(shù)而不用把整個(gè)仿真重跑一遍。好多初學(xué)者容易犯的錯(cuò)誤是把所有功能寫在一個(gè)大腳本里后面改參數(shù)改算法都得層層翻找?guī)资畟€(gè)變量命名混亂到直接跑不動(dòng)。這種坑我踩過(guò)多次所以推薦模塊化分開寫。2. 核心算法選型與Matlab工具鏈解析2.1 路徑規(guī)劃主算法怎么選路徑規(guī)劃算法選擇直接影響協(xié)同效果。我在不同階段嘗試過(guò)A*、RRT、人工勢(shì)場(chǎng)法和粒子群優(yōu)化各有適用場(chǎng)景。A*算法適合柵格地圖的全局路徑搜索得到路徑質(zhì)量高但是擴(kuò)展無(wú)人機(jī)數(shù)量時(shí)需要維護(hù)多份地圖狀態(tài)內(nèi)存開銷不小。RRT及其變體適合高維空間和復(fù)雜約束隨機(jī)采樣的特性在動(dòng)態(tài)環(huán)境下反而容易產(chǎn)生不確定路徑實(shí)際工程不太好用。最終我給主規(guī)劃層選了人工勢(shì)場(chǎng)法Artificial Potential Field, APF加局部?jī)?yōu)化。人工勢(shì)場(chǎng)法的核心思路很直白目標(biāo)點(diǎn)產(chǎn)生引力障礙物產(chǎn)生斥力合力驅(qū)動(dòng)無(wú)人機(jī)運(yùn)動(dòng)。它的優(yōu)點(diǎn)在于計(jì)算快、適合實(shí)時(shí)控制、代碼實(shí)現(xiàn)簡(jiǎn)潔適合做動(dòng)態(tài)環(huán)境下的快速響應(yīng)缺點(diǎn)也明顯就是容易陷入局部極小值這在后文會(huì)詳細(xì)說(shuō)解決思路。輔助使用粒子群優(yōu)化PSO來(lái)做多機(jī)目標(biāo)分配。PSO在多目標(biāo)組合優(yōu)化問(wèn)題上表現(xiàn)穩(wěn)定多無(wú)人機(jī)任務(wù)分配可以編碼成每個(gè)無(wú)人機(jī)的目標(biāo)點(diǎn)序列適應(yīng)度函數(shù)綜合考慮總航程、時(shí)空沖突風(fēng)險(xiǎn)迭代出較優(yōu)分配方案。2.2 防撞策略速度障礙法為主力優(yōu)先級(jí)分配為兜底動(dòng)態(tài)環(huán)境下防撞我選用速度障礙法Velocity Obstacle, VO作為主策略。速度障礙法的核心思想是把無(wú)人機(jī)和障礙物的相對(duì)位置、相對(duì)速度映射到一個(gè)速度空間凡是會(huì)導(dǎo)致未來(lái)碰撞的速度向量都納入“禁入?yún)^(qū)域”當(dāng)前狀態(tài)可用的避障速度范圍就是可行速度集減去禁入?yún)^(qū)域從中選擇最優(yōu)速度即可。單說(shuō)概念可能比較抽象我用生活場(chǎng)景打個(gè)比方你在擁擠的人流中走路目標(biāo)方向在正前方但有個(gè)迎面走來(lái)的人你會(huì)在心里快速估算——以你我當(dāng)前的速度繼續(xù)走下去幾秒后會(huì)撞上于是你調(diào)整步伐減速、換個(gè)方向這個(gè)瞬間決策就是速度障礙法的思想。多無(wú)人機(jī)之間的防撞我在VO基礎(chǔ)上增加了優(yōu)先級(jí)分配機(jī)制為每架無(wú)人機(jī)設(shè)置動(dòng)態(tài)優(yōu)先級(jí)低優(yōu)先級(jí)的無(wú)人機(jī)負(fù)責(zé)避讓高優(yōu)先級(jí)的無(wú)人機(jī)。這樣避免了雙方同時(shí)避讓反而撞上的“乒乓效應(yīng)”。2.3 為什么選Matlab而不是其他語(yǔ)言多無(wú)人機(jī)協(xié)同仿真涉及大量矩陣運(yùn)算、繪圖和數(shù)值計(jì)算Matlab在這幾方面天然占優(yōu)。矩陣化編程讓運(yùn)動(dòng)學(xué)模型更新非常簡(jiǎn)潔內(nèi)置的繪圖接口讓實(shí)時(shí)可視化幾乎零成本。此外Matlab的調(diào)試環(huán)境比C友好太多你能隨時(shí)中斷查看每個(gè)變量的狀態(tài)這在調(diào)試防撞邏輯時(shí)太重要了。也有同事建議用C加ROS方案理由是可以直接移植到真實(shí)無(wú)人機(jī)。但真實(shí)環(huán)境本身也有Matlab的代碼生成工具可以轉(zhuǎn)C所以研發(fā)階段用Matlab驗(yàn)證算法、后期再轉(zhuǎn)工程語(yǔ)言是更高效的選擇。我的原則是驗(yàn)證階段追求的是快速迭代Matlab完勝。3. 基于Matlab的整套實(shí)現(xiàn)流程從參數(shù)初始化到結(jié)果分析3.1 環(huán)境初始化與參數(shù)設(shè)定環(huán)境初始化的關(guān)鍵是定義好所有全局參數(shù)。我按如下結(jié)構(gòu)組織參數(shù)% 環(huán)境參數(shù) simTime 100; % 仿真時(shí)長(zhǎng)(s) dt 0.05; % 控制周期(s) mapRange [-10, 10, -10, 10]; % 地圖范圍 % 無(wú)人機(jī)參數(shù) nUAV 4; safeDist 0.8; % 無(wú)人機(jī)間安全距離(m) maxSpeed 2.0; % 最大速度(m/s) maxAccel 1.5; % 最大加速度(m/s^2) % 人工勢(shì)場(chǎng)參數(shù) attGain 1.0; % 引力增益 repGain 2.5; % 斥力增益 repRadius 2.0; % 斥力影響范圍 % 動(dòng)態(tài)障礙物參數(shù) nObs 3; obsVel [0.3, -0.2; -0.4, 0.1; 0.2, 0.3];參數(shù)設(shè)定看似簡(jiǎn)單實(shí)際是整套系統(tǒng)最容易出問(wèn)題的環(huán)節(jié)。安全距離設(shè)得太小多機(jī)之間容易擦碰設(shè)得太大又會(huì)嚴(yán)重影響路徑效率導(dǎo)致無(wú)人機(jī)繞遠(yuǎn)路。我的經(jīng)驗(yàn)是先按無(wú)人機(jī)的物理尺寸乘以1.5倍作為基礎(chǔ)安全距離再根據(jù)仿真效果微調(diào)。斥力影響半徑同理太大會(huì)導(dǎo)致目標(biāo)點(diǎn)附近振蕩太小又對(duì)障礙物反應(yīng)遲鈍。3.2 無(wú)人機(jī)單體運(yùn)動(dòng)學(xué)模型搭建無(wú)人機(jī)運(yùn)動(dòng)學(xué)模型是仿真基礎(chǔ)。我不會(huì)引入過(guò)于復(fù)雜的空氣動(dòng)力學(xué)模型而是在三維環(huán)境下做簡(jiǎn)化的質(zhì)點(diǎn)模型加上加速度限制和一階速度響應(yīng)來(lái)模擬無(wú)人機(jī)的動(dòng)力特性。for i 1:nUAV % 根據(jù)加速度更新速度 uav(i).velocity uav(i).velocity uav(i).accel * dt; % 限制最大速度 speed norm(uav(i).velocity); if speed maxSpeed uav(i).velocity uav(i).velocity / speed * maxSpeed; end % 更新位置 uav(i).position uav(i).position uav(i).velocity * dt; end為什么要加加速度限制這一條我在帶學(xué)生做項(xiàng)目時(shí)反復(fù)強(qiáng)調(diào)過(guò)。如果你直接讓無(wú)人機(jī)的位置跳變到目標(biāo)點(diǎn)規(guī)劃算法確實(shí)能算出完美路徑但物理上根本飛不出來(lái)。加入加速度和速度限制才能讓仿真結(jié)果具備實(shí)際參考價(jià)值。3.3 協(xié)同層任務(wù)分配與路徑重規(guī)劃協(xié)同層負(fù)責(zé)兩件事初始的任務(wù)分配和運(yùn)行過(guò)程中按需觸發(fā)的前全局重規(guī)劃。任務(wù)分配我用PSO算法把nUAV架無(wú)人機(jī)分配到nTarget個(gè)目標(biāo)點(diǎn)上目標(biāo)是讓總飛行時(shí)間和風(fēng)險(xiǎn)最小。function assignment psoTaskAllocation(uavPos, targetPos, nUAV) % 粒子群任務(wù)分配 % 每個(gè)粒子的位置編碼為一個(gè)排列代表無(wú)人機(jī)到目標(biāo)的對(duì)應(yīng)關(guān)系 nParticles 50; nIter 100; % 初始化粒子群這里簡(jiǎn)化為隨機(jī)排列 particles repmat(1:nUAV, nParticles, 1); for p 1:nParticles particles(p, :) randperm(nUAV); end % 迭代優(yōu)化完整實(shí)現(xiàn)含速度更新和最優(yōu)記錄此處略 % 適應(yīng)度函數(shù)總航程 沖突代價(jià) assignment particles(bestIdx, :); end初始分配完成后若某架無(wú)人機(jī)發(fā)現(xiàn)原定目標(biāo)區(qū)域不可達(dá)比如動(dòng)態(tài)障礙物長(zhǎng)期占據(jù)通道會(huì)觸發(fā)協(xié)同層的重分配。這里有個(gè)實(shí)際遇到過(guò)的教訓(xùn)重分配不能太頻繁否則系統(tǒng)會(huì)陷入“分配-重規(guī)劃-再分配”的振蕩循環(huán)我加了一個(gè)最小重分配間隔參數(shù)10秒內(nèi)最多觸發(fā)一次效果明顯改善。3.4 防撞層動(dòng)態(tài)障礙檢測(cè)與避讓邏輯防撞層是動(dòng)態(tài)環(huán)境下協(xié)同規(guī)劃的重中之重。核心邏輯分三步?jīng)_突檢測(cè)、速度避讓計(jì)算、路徑修正。function newVel collisionAvoidance(uav, obsList, safeDist) % 基于速度障礙法的防撞 feasibleVel []; for vx -1:0.1:1 for vy -1:0.1:1 v [vx, vy]; conflict false; % 檢查每個(gè)障礙物 for j 1:length(obsList) obs obsList(j); relPos obs.position - uav.position; relVel uav.velocity - obs.velocity; % 計(jì)算最近相遇距離簡(jiǎn)化版 if norm(relPos) safeDist conflict true; break; end % 判斷相對(duì)速度方向是否指向障礙物 relativeSpeedDir relVel / norm(relVel); if dot(relPos, relativeSpeedDir) 0 distance abs(cross([relPos, 0], [relativeSpeedDir, 0])); if distance(3) safeDist conflict true; break; end end end if ~conflict feasibleVel [feasibleVel; v]; end end end % 從可行速度中選最接近期望速度的 if ~isempty(feasibleVel) [~, idx] min(vecnorm(feasibleVel - uav.desiredVel, 2, 2)); newVel feasibleVel(idx, :); else newVel [0, 0]; % 無(wú)法避讓時(shí)緊急懸停 end end這段代碼是個(gè)簡(jiǎn)化版本但核心邏輯清晰枚舉候選速度、檢測(cè)潛在沖突、選出最安全且最接近預(yù)期方向的速度。實(shí)際項(xiàng)目中我還加入了對(duì)不可行解的處理——如果所有候選速度都沖突就讓無(wú)人機(jī)緊急減速懸停而不是硬著頭皮往前沖。有一點(diǎn)必須提醒速度枚舉的分辨率直接影響了避讓質(zhì)量和計(jì)算開銷。分辨率設(shè)0.1時(shí)會(huì)非常細(xì)致但意味著數(shù)百次沖突判斷多機(jī)同時(shí)避讓時(shí)單步計(jì)算壓力很大。我的折中方案是先粗粒度枚舉找到可行區(qū)域再在最優(yōu)候選速度附近做一次細(xì)粒度搜索性能差不多能提升3到4倍。3.5 可視化與仿真結(jié)果分析可視化是Matlab做算法的巨大優(yōu)勢(shì)。我用Matlab的動(dòng)畫接口做實(shí)時(shí)軌跡渲染疊加靜態(tài)障礙物、動(dòng)態(tài)障礙物和無(wú)人機(jī)間的預(yù)測(cè)路徑。figure; hold on; grid on; axis(mapRange); % 初始化無(wú)人機(jī)繪圖句柄 uavPlots gobjects(nUAV, 1); trailPlots {}; for i 1:nUAV uavPlots(i) plot(0, 0, o, MarkerSize, 8, LineWidth, 2); trailPlots{i} animatedline(Color, colors(i, :), LineWidth, 1.5); end % 仿真主循環(huán) for t 0:dt:simTime % 更新各模塊狀態(tài)略 % 更新繪圖 for i 1:nUAV set(uavPlots(i), XData, uav(i).position(1), YData, uav(i).position(2)); addpoints(trailPlots{i}, uav(i).position(1), uav(i).position(2)); end drawnow limitrate; enddrawnow limitrate這個(gè)函數(shù)用法值得特別強(qiáng)調(diào)它限制了刷新率只保留最新幾幀顯著減小編排負(fù)擔(dān)。從我實(shí)測(cè)來(lái)看不加limitrate時(shí)仿真相對(duì)于加了的會(huì)明顯卡頓多機(jī)數(shù)量到了8架以上時(shí)差別非常明顯。運(yùn)行結(jié)束后我還會(huì)繪制每架無(wú)人機(jī)的飛行軌跡圖、速度曲線圖和航程統(tǒng)計(jì)表這部分的產(chǎn)出質(zhì)量直接決定了研究結(jié)論的可信度。表格化的結(jié)果輸出我一直保留后面的調(diào)試能少走好多彎路。4. 關(guān)鍵函數(shù)與代碼片段深度解析4.1 人工勢(shì)場(chǎng)主函數(shù)這篇文章里人工勢(shì)場(chǎng)函數(shù)是路徑規(guī)劃的基礎(chǔ)在這里詳細(xì)展開function accel apfForce(uav, target, obstacles) % 人工勢(shì)場(chǎng)計(jì)算合力加速度 repulsion [0, 0]; attraction [0, 0]; % 目標(biāo)點(diǎn)引力 vecToTarget target - uav.position; distToTarget norm(vecToTarget); directionToTarget vecToTarget / distToTarget; attraction attGain * directionToTarget; % 障礙物斥力 for k 1:size(obstacles, 1) obsPos obstacles(k, :); vecToObs obsPos - uav.position; distToObs norm(vecToObs); % 只有進(jìn)入影響范圍才產(chǎn)生斥力 if distToObs repRadius repulsionMag repGain * (1/distToObs - 1/repRadius) / (distToObs^2); repulsion repulsion repulsionMag * (vecToObs / distToObs); end end % 合力 accel attraction repulsion; % 限幅 if norm(accel) maxAccel accel accel / norm(accel) * maxAccel; end end勢(shì)場(chǎng)參數(shù)調(diào)節(jié)的經(jīng)驗(yàn)repGain和attGain的比例直接決定路徑形態(tài)。比例偏大無(wú)人機(jī)繞障礙半徑大路徑浪費(fèi)明顯比例偏小則有碰撞風(fēng)險(xiǎn)。我一般先調(diào)整斥力影響范圍讓路徑不至于穿過(guò)障礙物再微調(diào)兩個(gè)增益直到路徑自然順滑。4.2 多機(jī)間防撞判斷函數(shù)多機(jī)防撞和單機(jī)避障的最大區(qū)別是雙方都在運(yùn)動(dòng)所以沖突判斷要考慮相對(duì)運(yùn)動(dòng)趨勢(shì)。function needAvoid checkPairConflict(uav_i, uav_j, safeDist, dt) relPos uav_i.position - uav_j.position; relVel uav_i.velocity - uav_j.velocity; dist norm(relPos); % 當(dāng)前已經(jīng)小于安全距離必須避讓 if dist safeDist needAvoid true; return; end % 預(yù)測(cè)Δt時(shí)間后的相對(duì)位置 futureRelPos relPos relVel * dt; futureDist norm(futureRelPos); % 未來(lái)距離小于安全距離則觸發(fā)避讓 if futureDist safeDist needAvoid true; return; end % 考慮障礙能力添加緩沖 stoppingDist norm(relVel)^2 / (2 * maxAccel); if dist safeDist stoppingDist needAvoid true; return; end needAvoid false; end需要指出的是第三段判斷“停止距離”是我在實(shí)際仿真中加上去的。原因是兩架無(wú)人機(jī)高速相向飛行時(shí)即使當(dāng)前距離略大于安全距離留給反應(yīng)的時(shí)間也很短。加入基于速度的緩沖距離后系統(tǒng)能更早觸發(fā)避讓穩(wěn)定性顯著提升。4.3 仿真主調(diào)度循環(huán)主循環(huán)是整個(gè)系統(tǒng)的中樞負(fù)責(zé)按時(shí)間軸調(diào)度各模塊for t 0:dt:simTime % 1. 動(dòng)態(tài)環(huán)境更新障礙物移動(dòng)、機(jī)場(chǎng)狀態(tài)變化等 updateEnvironment(t); % 2. 檢查是否觸發(fā)協(xié)同層重規(guī)劃 if mod(t, replanPeriod) dt triggerReplan(); end % 3. 每架無(wú)人機(jī)獨(dú)立計(jì)算期望速度 for i 1:nUAV uav(i).desiredVel apfForce(uav(i), uav(i).target, obstacles); end % 4. 多機(jī)防撞協(xié)調(diào) for i 1:nUAV for j i1:nUAV if checkPairConflict(uav(i), uav(j), safeDist, dt) applyAvoidance(uav(i), uav(j), safeDist); end end end % 5. 動(dòng)態(tài)障礙物避讓 for i 1:nUAV newVel collisionAvoidance(uav(i), dynamicObs, safeDist); uav(i).velocity newVel; end % 6. 更新狀態(tài)與可視化 updateStates(dt); updateVisualization(t); end主循環(huán)的調(diào)度順序很重要必須先更新環(huán)境再規(guī)劃再防撞最后更新狀態(tài)。如果順序反了可能出現(xiàn)使用上一幀過(guò)時(shí)數(shù)據(jù)的情況動(dòng)態(tài)環(huán)境下這種延遲累積可能導(dǎo)致嚴(yán)重的避撞響應(yīng)滯后。5. 常見問(wèn)題與調(diào)試經(jīng)驗(yàn)實(shí)錄5.1 無(wú)人機(jī)陷入局部極小值人工勢(shì)場(chǎng)法最著名的坑就是局部極小值無(wú)人機(jī)在障礙物與目標(biāo)點(diǎn)的共同作用下受力平衡停在某處既不能前進(jìn)也不后退。我一開始遇到這個(gè)問(wèn)題時(shí)第一反應(yīng)是調(diào)大引力增益結(jié)果治標(biāo)不治本反而產(chǎn)生路徑振蕩。解決思路有兩個(gè)方向一是在勢(shì)場(chǎng)計(jì)算中加入額外的隨機(jī)擾動(dòng)當(dāng)無(wú)人機(jī)檢測(cè)到速度長(zhǎng)期趨零且未到達(dá)目標(biāo)時(shí)人為施加一個(gè)隨機(jī)方向的輔助力幫助跳出局部極小二是引入虛擬子目標(biāo)點(diǎn)在局部極小位置附近設(shè)置中間目標(biāo)引導(dǎo)。我實(shí)際用的是第二種加入虛擬子目標(biāo)后的效果明顯更穩(wěn)定。5.2 多機(jī)避讓時(shí)出現(xiàn)“振蕩和乒乓效應(yīng)”兩架無(wú)人機(jī)迎面相遇時(shí)如果雙方同時(shí)往同一方向避讓會(huì)出現(xiàn)反復(fù)橫跳最終相撞的“乒乓現(xiàn)象”。這個(gè)問(wèn)題的本質(zhì)是協(xié)同邏輯缺失每一方都不知道對(duì)方會(huì)選擇哪側(cè)避讓。我的解決方案是引入避讓方向約定在checkPairConflict函數(shù)中約定兩架相遇的無(wú)人機(jī)統(tǒng)一從對(duì)方右側(cè)通過(guò)。這個(gè)約定信息在初始化時(shí)寫入每架無(wú)人機(jī)遇到?jīng)_突時(shí)按約定方向計(jì)算避讓速度振蕩問(wèn)題迎刃而解。5.3 參數(shù)過(guò)于敏感改一處崩全盤協(xié)同系統(tǒng)的參數(shù)彼此關(guān)聯(lián)單獨(dú)調(diào)整一個(gè)可能引發(fā)連鎖反應(yīng)。比如減少安全距離防撞觸發(fā)變少路徑效率提高但多機(jī)距離過(guò)近時(shí)氣流干擾和飛控風(fēng)險(xiǎn)上升增大斥力增益路徑更保守但多機(jī)通過(guò)率下降重規(guī)劃更頻繁。我的做法是建立“參數(shù)參考表”把每類場(chǎng)景的關(guān)鍵參數(shù)記錄下來(lái)場(chǎng)景安全距離斥力增益速度上限說(shuō)明開闊巡檢1.02.03.0低密度追求效率城市物流1.53.02.0障礙密集保守飛行編隊(duì)表演0.81.52.5隊(duì)形保持優(yōu)先應(yīng)急救援1.22.54.0速度優(yōu)先容錯(cuò)較低這樣在復(fù)現(xiàn)實(shí)驗(yàn)或切換到新場(chǎng)景時(shí)不是盲目試參數(shù)而是以參考表為基礎(chǔ)做針對(duì)性微調(diào)效率高得多。5.4 仿真速度慢多機(jī)數(shù)量增加后幀率塌陷當(dāng)無(wú)人機(jī)數(shù)量從4架增加到8架時(shí)如果防撞邏輯依然使用全矩陣枚舉單步耗時(shí)會(huì)顯著增加。我嘗試過(guò)兩種優(yōu)化方式一是將避讓速度的候選集合從全平面網(wǎng)格改為扇形采樣即只考慮當(dāng)前速度方向附近的扇形區(qū)域能砍掉六成以上的候選數(shù)量二是使用平滑曲線插值替代部分逐幀防撞計(jì)算在路徑變化不劇烈的時(shí)間窗口內(nèi)直接沿用上一幀結(jié)果。實(shí)測(cè)效果明顯優(yōu)化前8架無(wú)人機(jī)單步計(jì)算約35毫秒優(yōu)化后降到約12毫秒基本可以保證實(shí)時(shí)仿真。5.5 動(dòng)態(tài)障礙物的“預(yù)測(cè)-避讓”滯后動(dòng)態(tài)障礙物移動(dòng)時(shí)只靠當(dāng)前位置計(jì)算避讓會(huì)讓無(wú)人機(jī)像在追逐陀螺一樣被動(dòng)反應(yīng)。改進(jìn)方式是在沖突檢測(cè)中加入障礙物運(yùn)動(dòng)趨勢(shì)預(yù)測(cè)% 預(yù)測(cè)障礙物未來(lái)位置用預(yù)測(cè)位置參與避讓計(jì)算 predictT 1.0; % 預(yù)測(cè)時(shí)間(s) predictedObsPos obs.position obs.velocity * predictT;這個(gè)預(yù)測(cè)時(shí)間也不算越高越好它受障礙物運(yùn)動(dòng)穩(wěn)定性影響障礙物速度較穩(wěn)取長(zhǎng)預(yù)測(cè)變化快取短值。我一般讓無(wú)人機(jī)在距離障礙物兩倍安全距離之外時(shí)才啟用預(yù)測(cè)避讓這個(gè)距離按當(dāng)前速度算出。6. 成果展示與實(shí)際效果評(píng)估仿真跑通后我習(xí)慣做三組對(duì)比實(shí)驗(yàn)來(lái)驗(yàn)證系統(tǒng)的有效性靜態(tài)環(huán)境基準(zhǔn)實(shí)驗(yàn)、動(dòng)態(tài)環(huán)境單機(jī)防撞實(shí)驗(yàn)、動(dòng)態(tài)環(huán)境多機(jī)協(xié)同防撞實(shí)驗(yàn)。靜態(tài)環(huán)境基準(zhǔn)實(shí)驗(yàn)用來(lái)檢驗(yàn)路徑規(guī)劃算法的正確性無(wú)人機(jī)從起點(diǎn)出發(fā)繞過(guò)固定障礙抵達(dá)目標(biāo)路徑長(zhǎng)度與理論最短路徑對(duì)比偏差不超過(guò)8%。動(dòng)態(tài)環(huán)境單機(jī)實(shí)驗(yàn)引入運(yùn)動(dòng)障礙物驗(yàn)證大部分時(shí)間無(wú)人機(jī)從初始規(guī)劃出發(fā)在探測(cè)到接近障礙時(shí)及時(shí)觸發(fā)避讓邏輯路徑平滑度有小幅損失但安全性完全滿足要求。最關(guān)鍵的第三組實(shí)驗(yàn)是多機(jī)協(xié)同我設(shè)置了4架無(wú)人機(jī)、2個(gè)動(dòng)態(tài)障礙物和一個(gè)共享目標(biāo)區(qū)域。系統(tǒng)運(yùn)行100秒內(nèi)累計(jì)發(fā)生了14次潛在沖突全部被防撞層成功化解沒有發(fā)生實(shí)際距離小于安全閾值的危險(xiǎn)事件同時(shí)任務(wù)完成率達(dá)到100%所有無(wú)人機(jī)都按時(shí)到達(dá)了指定區(qū)域。這套方案在實(shí)際項(xiàng)目中的價(jià)值不僅在于仿真圖看起來(lái)漂亮而是把“動(dòng)態(tài)環(huán)境”和“協(xié)同防撞”這兩件看起來(lái)復(fù)雜的事拆成了清晰可復(fù)用的模塊化流程。從規(guī)劃到防撞每一層都可以獨(dú)立調(diào)優(yōu)。7. 從這套研究中總結(jié)出的幾點(diǎn)個(gè)人體會(huì)最后分享幾個(gè)我個(gè)人在實(shí)踐中收獲比較大的體會(huì)。第一多無(wú)人機(jī)協(xié)同的難點(diǎn)不在算法本身而在對(duì)系統(tǒng)狀態(tài)的統(tǒng)一認(rèn)知。每架無(wú)人機(jī)對(duì)環(huán)境的認(rèn)知可能存在偏差防撞機(jī)制必須允許這種偏差存在并做兼容處理。速度障礙法本質(zhì)上就是在沒有絕對(duì)全局信息條件下的保守決策所以在分布式的動(dòng)態(tài)環(huán)境中表現(xiàn)得格外穩(wěn)定。第二仿真時(shí)的“理論最優(yōu)”和“工程可用”之間永遠(yuǎn)有距離。我在調(diào)試過(guò)程中最大的收獲就是學(xué)會(huì)給自己的規(guī)劃結(jié)果打上“物理可行性”的校驗(yàn)標(biāo)簽——不光是路徑能走還要看加速度、轉(zhuǎn)彎半徑、通信延遲這些工程約束能不能滿足。第三參數(shù)管理應(yīng)該從第一版代碼就重視起來(lái)。所有關(guān)鍵參數(shù)集中定義命名規(guī)范統(tǒng)一這樣后續(xù)無(wú)論是調(diào)試還是交接都能省下大量時(shí)間。這套Matlab代碼實(shí)現(xiàn)現(xiàn)在已經(jīng)整理成了固定版本對(duì)動(dòng)態(tài)環(huán)境下多無(wú)人機(jī)協(xié)同路徑規(guī)劃研究來(lái)說(shuō)我自己的體會(huì)是不需要一上來(lái)就追求多么高級(jí)的算法把基礎(chǔ)的勢(shì)場(chǎng)規(guī)劃、速度障礙防撞、優(yōu)先級(jí)仲裁做好配合合理的重規(guī)劃策略已經(jīng)能覆蓋大多數(shù)場(chǎng)景。后續(xù)如果你也想在這個(gè)方向深入可以從動(dòng)態(tài)目標(biāo)分配、通信約束建模、三維復(fù)雜環(huán)境擴(kuò)展到更多維度。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
欧美成人A片AAA片在线播放 | 超极99精品| 99九九热在线观看| 日韩色色视频| 婷婷丁香视频在线观看免费| 99热在线观看| 欧美综合激情五月天| 色五月天婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷婷 | 色婷综合| www.yw色| 密黄站| 99性色| 五月停停色色丁香| 亚洲色综合| 夜夜骑日日操| 伊人九九68| 性生活视频98791| 4399无码视频二区| 五月天婷婷在线AN| 成人在线网| 91成人性爱视频| 久久九九囯产| 91精品综合久久久久久五月丁香| 天天综合.com| 婷婷五月丁香综合桃花色网| 91九色网| 这里只有九九精品| 视频在线免费观看欧洲乱码| 五月婷婷色五月| 婷婷激情五月天在线视频| av亚洲国产小电影| 精品人妻久久久久久| www.色婷婷.com| 亚洲激情综合网| 色五月丁香五月天| 天天操天天操综合| 色狠狠综合网| 五月丁香激情综合六月涩涩爱| www.97碰碰com| 99热亚洲只有色| 日韩999| 婷婷深爱五月天在线| 国产精品国产| 91久久五月天| 久久久.COM| 亚洲日本三级片| 成人在线网| 99爱在线精品视频免费观看| 婷婷丁香五月综合激情视频| 99精吕视频在线观看了| 新五月天婷婷激情电影| 五月天激情综合10p| 丁香婷婷人妻| 久久人妻乱子伦| 欧美在线看| 97操男人的天堂| 色五月激情婷婷| 人妻久久久久久| 五月六月激情| 高清无码视频网址| 另类激情五月| 高清成人综合| 欧美天天搞| 91日本在线免费| 操操操B| 在线观看国产高清视频免费网站| 精品亚洲国产成AV人片传媒| www.丁香黄色五月天人与| 久久久久久欧美精品se一二三四| 亚洲欧洲中文日韩久久AV乱码| 日本一级一级一级一级| 99视频综合| 日本不卡高字幕在线2019| 9久久久久| 五月六月丁香激情| 91美女被操| 大香蕉九操| 丁香久久久| 五月婷婷婷婷婷| 99热欲| 99视频在线精品| 久久视频在线| 久久成人天| 激情五月综合| 精品九九网| 国产精自产拍久久久久久蜜| 日本色色网| 91精品久久久久久综合五月天| 激情网五夜婷婷| 97人妻碰碰碰碰碰久久久久久| 九九99精品视频在线观看| 天天天天天天操| 这里只有精品热| 久草狼人| 狠狠色狠狠爱| 中文字幕高清av| 狠狠操狠狠插| 五月婷婷人人人操| 成人va视频| 婷婷伊人五月| xfplayav在线| 97色色色色色色色色色色色色色| 免费国产VA国产免费| 99色久| 色综啪啪网| 天天插综合网| 丁香五月av在线| 极品 少妇 内射| 九九性视频| 五月久久婷婷| 另类婷婷五月天啪帕帕| 97精品综合久久| www。88热在线视频免费观看| 五月噜噜| WWW丁香五月| 五月丁香婷婷中文| 91丨九色丨东北熟女| av首页在线| 最近韩国日本免费高清观看| 国产亚洲在线| 亚洲视频在线观看| 亚洲无AV在线中文字幕| 99riav 亚洲| 婷婷色婷婷| 91狠狠综合久久| 99九九视频精彩在线| 美女五月天| 5月丁香六月婷婷| 五月丁香婷婷成人伊人网| 欧美婷婷六月丁香综合色| 影音先锋一区二区三区| 五月丁香六月色婷婷综合五月天| 五月天国产成人| 五月色婷| 噜综合| 日本99视频| 99ri在线| 99热香港| 无码四色色色| 99色婷婷视频| 丁香五月婷婷www..com| 五月丁香婷婷啪啪综合网| 久久新地址| 9色操| 免费精品66| 精品99在线| 97色五月婷婷在线| 丁香花五月天| 精品一二三区久久AAA片| 9精品在线| 丁香六月婷婷激情| 五月丁香在线观看国产| 九月婷婷丁香| 91夫妻网站九色| 天天爱天天做天天日| 99久久超级| 亚洲五月婷| 激情五月天社区| 九九色婷婷五月天| 五月天社区狠狠| 国产成人精品亚洲线观看| 色综合久久天天综合网| 思思热这里只有精品| www.婷婷亚洲基地| 俺去也婷婷| 日韩操逼大片| 99综合网| www.五月婷婷久久.com| 欧美美女视频| 九九精品这里只有| 狠狠爱夜夜| 婷婷久久精品| 激情婷婷丁香五月| 人人色婷婷| 99综合网| 色婷婷狠狠久久综合五月| 91seAV| 久久色9| 五月天婷婷基地| 婷婷丁香五月天欧美| 丁香五月成人在线| 操逼视频一区| 影音先锋高清无码资源网| 免费色婷婷| 啪啪色区| 一个色的综合| 99色色| 99色网站| 成人片在线免费看| 青青夜夜狠狠夜夜狠狠| 99色视频| 国产AV熟妇人震精品一品二区| 亚洲成AV人片在线观看| 久久久婷| 99久久极情精品一区| 伊人久久99| 99干在线视频| 五月色网| 色六月天| 久久婷婷亚洲| 久久全色| 人人舔人人色人人高潮| www.99精品在线| 狠狠操狠狠| 激情丁香久久| 五月婷婷婷婷婷婷艺术| 丁香啪啪| 日本99视频精品免费播放| 操操操www.com| 99亚洲色色| 色婷视频| 六月婷婷AV| 五月丁香激情综合啪| 五月天婷婷丁香社区| 色综合久久天天综合网| 超碰激情五月| 99在线看片| 伊人干综合| 五月丁香六月激情| 精品国产va久| 青青草激情网| 极品色丁香| 狠狠操.com| 五月丁香婷婷综合| 亚洲成人日韩无码精品| 在线不卡视频| 中文字幕人妻在线| 超爽内射| 99热这里只有精品一区| 狠狠干综合| 大香蕉婷婷丁香视频在线| 五月天激情网页| 人妻丰满精品一区二区A片| 亚洲九区| 97操碰在线视频| 婷婷中文无码| 天天摸天天肏| 五月婷婷六月丁香首页| 98永久精品| 9 9热这里有精品| 人人操人| 午夜九九九九九九九九九九九九九| 激情久久婷婷| 五月丁香色| 婷婷综合色五月天| 五月开行婷婷色五月| 五月丁香九九九综合| 色狠狠伊人久久五月丁香| 婷婷五月综合在线视频| 亚洲色网络| 中文成人在线| 成人片在线播放| 五月色婷婷综合丁香精品无遮挡| 成人色色视频| 99热这里精品| 婷婷色丁香五月| 99精品视频免费观看| 日韩一区二区A片免费观看| 丁香六月婷婷| 婷婷人人操| 丁香五月婷婷亚洲色图| 久久性爱视频免费| 久久这里只有国产视频| 五月天婷婷激情| 99精品国产热久久91色欲| 综合激情在线| 亚洲激情四射| 天天干天天日蜜臀av| 婷婷情色五月| www.色婷婷.com| 在线视频另类| 一根材五月婷成人| www999日韩精品| 五月丁香啪啪网| 极骚大香蕉伊人| 综合五月激情| 久久九九婷婷| 色五月婷婷少妇人妻| 五月婷导航| 色噜噜狠噜噜视频| 91人人操.COM| 亚洲一区国产传媒| 久久九九在线视频| 九九热在线精品视频| 婷婷四月 成人 狠狠干| 99热中文字幕久久| 嫩草AV久久伊人妇女超级A| 先锋男人91资源| 国产色色网站网址| 丁香五月电影| 婷婷丁香五月综合| 高清免费在线视频| 1995年关宝慧版蜘蛛女| 婷婷综合在线播放| 亚洲va欧洲va国产va不卡| 色色99| 日韩欧美老妇性视频91久久久| 密桃激情五月天综合网| 久热这里只有精品6| 精品五月花| AV九九| 思思热再线视频| 婷婷五月天丁香花| WWW.17C亚洲精品| 激情久久丁香| 亚洲天堂aaa| 丁香五月瑟瑟| 亚洲第一第二网站| 中文字幕日韩成人| 日日日影院| 狠色狠色综合久久| 丁香五月婷婷影院| 色婷婷五月基地在线| 丁香五月人妻| 亚洲一级AV在线免费播放| 五月五婷婷网| 日韩999| 五月丁香久久综合91| 欧美成人无码高清一区二区三区| 欧美大片| 成人片久久网站| 五月天精品视频| 99热国产精品| 亚洲操人| 深爱五月天 开心网| 久久天堂婷婷五月| 欧美激情五月天婷婷| 激情五月天婷婷五月天| 日韩啪| 婷婷丁香五月婷婷| 美女xx不卡| www,超碰| 国产免费AV网站| 婷婷五月成人| 色欲五月天| 色五月婷婷色| 亚美欧色影院| 青青草99re| 米奇影视资源777狠狠色婷婷五月天激情网| 九九热视频在线观看| 五月天婷婷久久日| 狠狠综合网| 激情网站五月| 欧美99| 色久婷婷网| 4399在线日本A片| 91爱操| 人妻中文在线| 色八月婷婷| 婷婷五月天99综合网站| 99热首页在线30| av在线观看网址| 天天爽天天操| 综合丁香婷婷五月天| 色噜噜狠狠色综无码久久合欧美| 丁香五月婷婷姐| 色久一| 天天擼久久擼在线| 无码九九| 五月花激情网| 日本少妇裸体做爰高潮片| AAAA网站| 激情五月天黄色小说| 婷婷五月激情欧美大胆视频| 精品激情| 亚洲狠狠狠色婷婷综合激情久久久| 精品成人无码A片观看香草视频| 亚洲色情在线| 五月婷婷综合在线亚洲视频| 激情婷婷六月天| 欧美精产国品一二三区| 久久99久久99精品,久国产,久久精品免费,99久在线,久久久久国产精品免费网站,9 | 丁香五月亚洲婷婷| 蜜乳AV成人| 五月婷婷影| 婷婷久久亚洲| www.精品99| 婷婷五月天AV网| 激情综合五月天| 另类综合婷婷五月天欧美视频| 99re免费精品视频| 噜噜五月天综合| www.99热这里精品| 狠狠色丁香婷婷基地| 久久久性爱网| 亚洲区在线| 伊人色综合网| 久久99网| 99操| 思思久久精品| 婷婷五月天久久| 蜜臀嫩草| 五月丁香欧美在线| 情欲综合网| 五月天激情四射网站| 天天日天天舔| 激情综合网激情五月丁香五月俺也去| 九九在线精品| 国产看真人毛片爱做A片| 婷婷午夜激情| 色婷婷成人丁香| 亚洲高清在线| 六月激情丁香一道本7777| 婷婷丁香花五月天| 停婷丁五月在线| 久99热| av免费在线观看0| 色五月婷婷在线| 九九性视频| 色婷婷操逼| 影音先锋男人站,影音先锋男人色资源网,影音先锋AV最新资源站,影音先锋AV资源 | 91成人电影| 99riav 亚洲| 亚洲亚洲人成综合网络| 91传媒无码人妻精| 久草丁香婷婷五月天婷| 久操97| 九色无码| 激情婷婷综合网| 欧美日韩国产一区二区| 欧美日韩国产伦精品日韩人妻一| 五六月婷婷久久| 国产亚洲av片| 91久久久久久久久久久| 这里都是精品99| 99热这里只有精品50| 久久九九免费大视频| 思思久日精品视频| www.伊人天堂偷偷婷婷| 婷婷五月在线综合| 操操操www.com| 97色婷| 日韩久热| 久久五月丁香六月婷| Xx色综合| 狠狠999| 六月婷婷之青青草| 国产精品美女| 大香久久综合网| 一区二区乱视频码| 综合婷婷久久| 99热97| 激情婷婷五月天| site:jszngf.com| 狠狠香婷婷五月| 亚洲婷婷五月天| 色色色色五月天| 激情五月六月婷婷| 9九九久久精品无码专区| 九九九热精品| 五月婷综合网| www91色网站| 天天干,天天操,天天射| 婷婷色五月婷婷姐妹| 99热这里只有精品26| 色五月五月天| 成人va在线播放| 激情五月天电影| 热久久999| 玖玖婷婷免费| 7777激情基地| 亚州精品久久久久AV无码| 另类国产综合| 丁香激情网| 丁香五月久久| 亚洲欧美在线观看| 97超级碰碰碰| 色啪影院| caopeng97日韩| 五月婷婷自拍| 天天艹夜夜艹| 色色色色色九九九九九| 激情四射婷婷色色色| 最新久久网址| 色 五月婷婷基地| 亚洲av网站在线观看| 五月天精品| 91综合网| 妻久久久久| 99热99这里有免费的精品| 激情五月色综合国产精品| 婷婷五月天堂| 久久性爱网| 777久久久| 久热99| 无码人妻一区二区三区免费九色| 91ncm视频| 欧州婷婷五月天综合| 六月激情丁香一道本7777| 午夜不卡成人一区二区| 天天插天天插天天插天天插| 色婷婷在线视频| 桃色激情五月天| 国色天香伊人狠狠色| 99在线观看精品视频| 玖玖玖婷婷婷| 少妇激情五月婷婷| 九九精品热| 超碰永久在线| 97涩涩丁香五月天| 五月丁香婷婷六月| 亚洲婷婷91丁香| 亚洲、欧美、国产另类笫二区| 99资源在线视频| 欧美成人AAA片一区国产精品| 久久精品99| 久久婷五月天| 视频综合网| 91色婷婷综合久久中文字幕二区| 久久机热这里只有精品| 亚洲天堂制| 思思99久久| 99热九九这里只有精品| 日产精品久久久久久久蜜臀| 五月丁香啪啪综合| 99re这里只有| 99人人操人人操人人精| 人人操av| 99热这里精| 日本色色网站| 538在线精品| 婷婷激情六月中文| 99国产欧美视频| 五月丁香色| 天天拍夜夜撸| 六月丁香婷婷在线波多| 毛片九九九九九九| 久草热在线视频| 色色操| 久久久ww| 人人操99| 華人性愛AV在線| 五月天婷婷小说| 99免费青青蜜臀| 精品皮股午夜AV| Blackedraw视频一区二区| 天天干天天日日| www.色色色com| 色综合天天| 色五月丁香网| 五月天另类小说亚洲| 亚洲AV人人操| 狼人伊人干| 六月丁香久久| 国产精品18久久久| 成人视频一区| 日本久久婷婷| 人人噜天天上| 热99精品视频在线观看| 色播五月网| 26uuu欧美亚洲日韩| 久9热在线免费观看| 99热这里只有精品一区| 九月av在线| 五月天四色房丁香亭亭| 色色色综合色| 五月天婷婷色| 人人噜天天上| 成人AV在线电影| 婷婷色婷婷| 婷婷香五月| 婷婷九月丁香久久| 丁香五月婷中字在线| 26uuu在线观看| 国产精品色色| 黄色五月婷婷| 五月综合色| 丁香六月毛片| wwww.色婷婷| 色综合久久99色| 性一交一乱一交A片久久四色| www.99在线| 五月婷婷在线网站| 97人人看一| 亚洲天堂99| 五月天综合视频| 欧美激情凹凸丁香网| 国产成人av在线| 如何安全看伊人婷婷| 91啪啪视频| 综合99综合久久久久久久| 99色人| 久久44| 久久码久久无清| 久久九九中文字幕| 丁香五月天.com| 五月天婷婷爱| 亚洲激情亚洲激情| 五月丁香六月婷婷,婷| 激情深爱婷婷网| 五月婷婷欧美激情| 欧美日韩成人在线网| 久热9| 日本色色影片| 丁香色色网| 97在线刺激| 激情宗合网激情五月天| 国产成人综合在线| 超级碰碰视频无码| 99视频综合网| 国产高清av黄色看片| 99人妻碰碰碰久久久久视| 五月婷婷精品无在线| 丁香婷婷啪啪| 99人人操人人操人人精| 牛色色碰| 女人被躁到高潮嗷嗷叫小| 婷婷五月天久久| 五月丁香另类网| 婷婷色色综合激情| 婷婷色色狠狠| 日本三级大片| 亚洲av免费在线| 91爱啪啪| 五月丁香婷婷综合久久| 91精品综合久久久久久五月天| 五月花婷婷| 色小说五月婷婷| 欧美25p| 这里只有精品视频99| 久久精彩视频| 色吧网综合| 狠狠爱婷婷| 五月久久丁香| 日韩综合网络男女香蕉a片| 久久精品99久久久久久| 俺也去综合| 五月开心婷婷网| 91九色无码内射| 婷婷五月欧美AA片免费| 涩婷婷视频快播人妻| 激情性爱网站| 99玖玖在线视频| www,色婷婷| 久久综合中文字幕| 4399在线观看免费毛片| 婷婷丁香视频| 香蕉大综综综合久久| 大香蕉婷婷五月| 久久这里面只有精品视频| 激情婷婷综合| 第四色婷婷色五月| 五月婷婷激情久久| 丁香五月六月婷婷综合| 丁香五月婷婷影院| 久久久com| 丁香五月婷婷激情小说| 96精品久久久久久久久| 五月丁香六月婷婷精品| 激情五月天之六月婷婷| 九九久久综合网站| 婷婷激情社区| 超碰爱爱爱| 九九九九毛片| 色综合色色| 婷婷爱五月| 天天射影院| 99热久久这里只有精品| 九九伦子片| 少妇高潮一区二区三区99欧美| 91人人爽狠狠狠| 第二色AⅤ| 久久婷婷五月丁香| 日本久久婷| 可以免费观看的AV| 草榴视频黄色网| 天天射夜夜骑| 色婷婷五月天| 丁香五月综合图片在线观看| 婷婷丁香成人色综合| 丁香激情合作五月| 国产精品激情五月天色婷婷| 欧美三级巜人妻互换| 免费国产VA国产免费| 大香蕉人妻| 性爱网五月天| 97精品在线| wWw色五月| 99er久久| 超碰爱爱爱| 丰满少妇乱A片无码| 五月 成人 婷婷| 99热久久这里只有精品| 99riAV国产精品视频| 97精品人人A片免费看| 在线99色| 婷婷五月18永久免费视频| 婷婷丁香18| 99精品偷自拍| 天天插综合| 99ri在线观看视频| 99色色网| 婷婷九月亚洲| 亚洲综合在线伊人婷| 东京热免费视频| 五月情涩综合婷婷| 97干欧美| 北条麻妃伊人 | 激情丁香淫荡婷婷| 91色在线/日韩| 久久一伦| 久久久区区一久久久久久| 伊人五月天在线| 婷婷欧美激情综合| 欧美成人精品老美女噜噜噜| 久久99久久99久久99人受| 99热天堂| 色 五月婷婷基地| 超碰免费在线| www.色五月| 婷婷在线播放av| www.yw色| 久久激情视频| 婷婷噜噜| 久热这里只有精品性色AV| 色婷婷yy久| 丁香五月六月综合激情| 99免费热视频| 99区视频| 色婷婷五月综合| 六月丁香激情| 99re这里只有精品免费| 中文字幕在线不卡视频| 九九热婷婷| 老妇操B| 桃色激情网| 大香蕉久久久久久久久| 色五月婷婷色五月| 国产乱轮一区二区三区| 5月婷婷性视频| 日美三级| 99∨VTV| 五月婷婷六月丁香首页| 丁香婷婷六月男男| 玖色色综合| 色色丁香五月婷婷| 色婷婷婷av| 五月丁香综合影院| 色开心五月婷婷丁香HD| 内射干少妇亚洲69XXX| 玖玖综合网| 91九色无码日韩| 99激情| 99精品在这里| 天天五月天综合网址| 少妇人妻人伦A片| 婷婷在线免费| 色婷婷丁香社综合| 亚洲精品99| 激情五月图| 国产99久久久国产精品免费看| 综合五月天天天天天五月| 婷婷香蕉视频| 五月婷婷影院| 丁香五月av在线| 五月丁香色综合| 99热精品在线在线| 五月激情丁香| 精品99视频| 性爱在线播放av| 91色呦哟| 婷婷五月天小说| 欧美成人网99网| 婷婷的99视频网站| 成人AV在线电影| 婷婷五月天桃花网| 丁香六月av| 伊人综合色干| 色婷视频| 玖玖精品视频99| 久久综合婷婷五月| 99在线精品免费视频| 欧美25p| 中文av网| 丁香五月97视频| 久久久久亚洲AV成人无码电影| 五月久久婷婷丁香| 伊人五月久久| 97色色网| 亚洲精品视频在线| 91综合色噜噜| 日本激情ⅩXX免费视频| 五月天婷婷高清无码| 五月丁香激情综合啪啪| 五月天大香蕉| 亚洲激情婷婷| 五月婷婷伊人在线| 婷婷大美在线| 96精品久久久久久久久| 中文成人在线| 色五月琪琪| www激情婷婷com| 色小说婷婷五月天天天| 五月综合激情| 婷婷中文字幕网站| 成人午夜无码视频| 丁香五月婷婷基地| 99热这里只有精品 搜| 五月婷婷与六月丁香图片激情| 激情丁香五月| 97在线观视频免费观看| 99性爱视频| 美欧日韩国产成人在战| 五月天激情www| 99热这只有| 色色狼人综合| 97超级免费无码| 99精品偷自拍| 狠狠狠狠狠| 国外亚洲成AV人片在线观看| 五月丁香影视| 色婷婷小说| 亚洲天堂啪啪| 精品婷婷| 亚州色婷婷| 国产婷婷综合| 色五月婷婷五月天| 色欲AV导航| 玖操97| 色亚洲婷婷| 丁香午月AV中文字幕| 26uuu美女三级视频| 五月丁香六月婷婷综合在线| 无码激情| 永久地址 色| 爱超碰性| 丁香五月激情视频在线| 激情五月天婷婷| 欧美激情丁香五月天久久婷婷一区| 五月婷婷亚洲色视频| 97精品人人A片免费看| 丁香无五月网| 亚洲国产99| 日本综合久| 超碰在线人人| 五月天激情图片| 天天操天天干天天日| 九九香蕉网| 99热99久久| 丁香五月激情综合| 激情五月综合| 五月婷丁香在线视频在线| 国产高清精品色| 丁香五月激情综合久久| 俺去也在线www色官网| 热99.com婷婷| 丁香五月天堂网| 丁香五月九九| 色五月婷婷操逼| 丁香五月婷婷基地| 欧美日韩aaa| 中文字幕日韩无码制服诱或| 亚洲春色奇米影视| 9久热在线视频精品| 色婷婷www| www.五月婷婷久久.com| 91热视频| 9有码中文| 《》【无码】想被搞到爽AV应募而来的超M素人 西纯子 10musume-011723-01 | 丁香婷婷老司机久操| 久久久久久欧美精品se一二三四| 五月丁香六月婷婷精品| 欧美大肥婆大肥BBBBB| 天天狠狠干| 4438成人电影| 激情五月婷婷| 五月丁香欧美在线| 日韩色五月| 婷婷视频在线| 大香蕉婷婷五月| VA五月激情在线| 激情综合在线播放| 天天插天天射| 五月综合色| 啪啪激情综合| 狠狠色噜噜狠狠狠888| 亚洲成人人人操| 在线成人网站| 亚洲精品第一国产综合亚AV | 亚洲色模骚货| 天天爽天天爽天天爽天天爽天天爽| 久久精品无码一区| 91视频一起草| se色99| 亚洲热久| 51精品国自产在线| 97色色网| 国产精品香蕉| 五月婷综合性中心| 日韩综合网络男女香蕉a片| www.99热在线观看| 北条麻妃伊人| 中文字幕成人| 婷婷亚洲欧美丁香五月| 国产亚洲色婷婷99精品| 亚洲婷婷久久综合| 五月婷婷色影院| 五月天色色色| 天天日天天插| 丁香五月AV| 亚洲三A| 亚洲国产色婷婷| 日韩成人网址| 五月天国产成人| 大香蕉中文| 亚洲无码猫咪| 婷婷六月五月天综合| 久久人妻熟女一区二区| www。五月天激情| 天天干夜夜谢| 久久久久久久久久8888| 性一交一乱一交A片久久四色| 91妻人人爽人人看片| 日韩色色色色色| 婷婷五月天激情网| 色激情综合狠狠婷婷| 任你草| 99热官网精品在线| 99精品偷拍视频| www.婷婷com| 99超超碰| 国产操B| yazhochengrenavwang| 天天插天天插| 婷婷五月天久久| 日韩婷婷| 97色色色| 大香蕉五月天婷婷| 秋霞av吧| 婷婷丁香五月基地| 99视频热99| 天天干狠狠艹| 天天肏天天肏天天肏| 激情五月天婷婷五月天| 免费AV在线网址| 久青草影院| 婷婷六月激情| 色欲婷婷五月天| 亚洲美女婷婷五月天| 岛国在线观看91| 久久人妻久久久久| 六月婷婷啪啪| 插插插丁香五月婷婷| 日本欧美成人片AAAA| 天天射综合网夜夜操| 亚洲区在线| 91丨九色丨熟女丰满| 色五月亚洲| 99国产这里只有精品| 丁香激情网| 五月综合激情网| 国产午夜伦鲁鲁| 久久99精品久久久久久青青AR| 亚洲丁香五月天视频| 91丨九色丨43老版熟女| 丁香五月日韩| 久久伊人五月天| 无语停婷丁香网| 丁香婷婷五月六月天| 97伊人综合婷婷| 国产AV一区二区三区最新精品| 色婷婷亚洲六月婷婷中文字幕| 3p久久| 亚洲人妻av| 深爱开心激情| 一起草av| 国产毛片欧美毛片久久久| 99热这里只有精品3| 五月婷婷99热| 啪啪九九色| 天天日天天舔| 秋霞电影理论| 综合网色| 精品9l九九九九九77777| 黄网免费看| 婷香五月网在线| 丁香五月天资源网| 色婷五月天| 婷婷免费无马| 色婷婷五月天激情在线观看| 99性爱| 五月丁香花激情综合网| 色婷婷丁香中文在线播放| 99亚州综合精品成人网| 牛牛色av| 六月丁香婷婷亚洲中文玖玖| 婷婷色中文字幕| 开心五月婷婷综合在线精品素人| 婷婷瑟五月天久久综合| 97久久人人操| 精a品a视a频| 婷婷操逼| 六月丁香婷婷综合影院| 99热九九热| 殴美97色| ji'qi'luan'ren'lun| 激情5月婷婷| 五月婷婷影视| 少妇高潮呻吟A片免费看软件 | 五月婷婷黄网站大全| 97色婷婷五月天| 噜噜五月天综合| 久操b网| 欧美人久久| 日本三级中国三级99| 91亚洲天堂| 中文在线视频久9| 色五月激情问网站| 五月婷婷综合网| 99热这里| 五月丁香啪啪啪| 操99| 午夜天堂啪啪| 大学生高潮无套内谢视频| 丁香五月色| 激情丁香五月天| 天天拍久久| 五月丁香WWW| 人妻狠狠操| 97人人草| 九九热这里只有精品5| 91视频精品99| 久久女婷| 婷婷六月丁香在线| 久久激情综合| 中文网AV| 日本熟女一区二区| 色婷婷成人| AV在线中文| 久久婷婷网| 欧美日本综合网| 色婷五月| 久久92| 日日爽日日| 免费看欧美成人A片无码| 亚洲中文字幕在线观看| 丁香五月天堂网| m色激情网| 五月丁香 啪啪| 色婷婷亚洲婷婷| 天天精品视频免费观看| 久久久91| 丁香激情五月天| 色狠狠色狠狠| 九九色中文| 182无码| 四虎成人精品永久免费AV九九| 在线成人网址| 五月伊人婷婷999| 五月婷综合| 996热re视频精品视频| 99超级碰碰| 另类视频五月天| 久久综合激情婷婷激情| 射久久丁香五月| 丁香五月婷婷亚洲综合精品| 开心五月婷婷婷美女| 射久久丁香五月| 久久九⑨| 五月天婷婷色色网| 色五月婷婷伊人| 金品在线视频99| 激情五月婷婷色色| 激情五月最新网址| 一本到不卡高清DVD| 丁香影院五月综合| 九九色婷婷五月天| 婷婷成人av| 五月香蕉网| 婷婷伊人视婷婷婷| 六月婷婷七月丁香| 九九人人精品| 久久曰曰| 99欧美| 99 色色吧| 丁香丁婷五月激情| 五月婷婷狠天天色综合| 26uuu国产精品| 5月婷婷六月丁香| 五月婷婷开心丁香| 怡红院一二三| 9久久久久久久久久久| 久久人人超| 天天爽人人综合免费7799| 无码少妇高潮喷水A片免费| 大香蕉九九| 图片区 小说区 区 亚洲五月| 国产操B| 狠狠色噜噜色狠狠狠综合色| 九九热99熟女| 操逼视频一区| 丁香五月婷婷啪啪| 黄涩毛片| 天天做天天摸| 九九综合伊人| 99热这里只有精品首页| 丰满少妇乱A片无码| 亚洲乱码日产精品BD| 亚洲啪啪自拍| 91玖玖| 狠狠香婷婷五月| 亚洲va在线| 五月天色不卡| 婷婷爱五月| 欧洲色区| 婷婷色基地在线看| 亚洲综合九九| 久久五月网| 丁香五月电影| 五月丁香婷婷色色| 91肏肏肏| 在线天堂9| 小视频aaa久久久| 欧美五月丁香| 中文字幕在线观看视频www| 午夜成人片400| 欧美日本97| 五月网激情| 色色色色网| 成人看片网站| 亚洲av电影网站| www.97碰碰com| 中国AV性爱观看| 久久久99免费视频| 99亚洲精品| 中日韩狠狠色| bbwcuckold精品熟妇| 婷婷五月六月丁香| 亚洲综合五月天婷婷丁香| 五月丁香婷婷激情爱爱| 色情五月天视频网| 26uuu欧美激情另类| 丁香五月性爱| 国产AV一区二区三区最新精品 | 五月丁香婷婷三级| 婷婷午夜| 亚洲日比视频| 五月婷婷色播视频| 五月婷婷免费在线观看视频| 99自拍网| 九九色网专区| 人妻22p| 亚洲综合婷婷六月丁香五月| 色色色色色色网站| 五月天怕怕| 玖玖在线资源视频| 亚洲成人影视在线观看| 无码AV免费精品一区二区三区| 久久综合影院| 看久久性爱视频| 欧美激情综合色综合啪啪五月| 日韩av网站在线观看| 亚洲美女婷婷五月天| 97极品在线| 天天操天天插天天射| 亚洲另类婷婷五月丁香在线播放| 婷婷五月天AV| 青柠影视免费高清电视剧| 丁香大香蕉| 天天爽天天操| 激情操逼婷婷| 99亚洲综合| 97人人干| 婷婷的色色五月天| 色色COm| 女人高潮内射99精品| 五月天综合久久| www.色九月| 九九色婷| 五月天婷婷开心| 激情久久综合| 中文字幕+中文在线| 天堂草在线观| 亚洲精品无码一区二区| 九九热a| 色播六月| 天堂亚洲 在线| 五月伊人婷婷| 天天爽天天日| 综合五月婷婷| 日韩AV片| 亚洲五月丁香综合网| 色婷婷成人网| www.sebowuyue| 欧美美美女性色视频| 亚洲精品第一国产综合亚AV| 91婷婷五月天综合视频| 午夜色婷婷| 五月份婷婷| 另类激情五月在线视频欧美| 国产三级在线播放| 99免费热视频| 婷婷五月综合国产精品| 综合热无码| 日韩乱轮AV| 五月丁六月香av| 久久久99精品免费观看| 六月婷婷狠狠| 天天操天天插| 麻豆科斗777| 超碰成人电影| 色婷五月| 网站免费一站二站| 91久久婷婷| 99热在线精品观看| 五月丁香六月婷婷精品| 久热9| 99视频超级精品| 亚洲无码色| 99热成人精品| 亚洲愉拍99热成人精品| 五月婷婷色吧!| 久婷狼色诱惑在线| 五月色色激情网| 日韩无码乱轮| 丁香六月婷| 亚洲最大在线| 深爱激情五月网| 91porn一起草| 精品久热| 成人五月天丁香婷| AV九九| 深夜婷婷五月丁香| 国产99久久久国产精品免费看| 婷婷丁香五月天色区| 91碰碰视频在线观看| 激情五月综合网最新 | tingtingseav| 99热只有| 丁香五月激情啪啪| 色婷婷五月天在线观看| 涩涩五| 九月婷婷激情久久| 久久人人妻| 婷婷五月天影院| 无码激情AAAAA片-区区| 欧美婷婷五月天综合| 丁香六月青青草| 婷婷激情综合网| 久久色五月天| a免费在线| 9热在线观看| 91日韩在线| 人妻第九页| 26uuu欧美| 9色在线| 人人人操 超碰| 天天日天天摸| 婷婷综合五月天| 丰满少妇猛烈A片免费看观看| 国产成人99久久亚洲综合精品| 九九综合网色全集| 婷婷丁香六月| 天天爽免费视频| 99超级碰碰| 99这里有精品视频| 激情www| 99热这里只有精品1025| 天天碰夜夜操| 丁香激情四射| 五月天六月丁香| 九九激情| 丁香五月偷拍| 五月婷婷网五月在线| 91五月天| 九九精品re免费视频|