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

ARTICLE DETAIL

資訊詳情

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

基于Matlab的固定翼無人機(jī)六自由度建模與視覺路徑規(guī)劃仿真實踐

基于Matlab的固定翼無人機(jī)六自由度建模與視覺路徑規(guī)劃仿真實踐 簡介本資源是一套面向高校自動化、航空航天及控制工程專業(yè)學(xué)生的Matlab小型固定翼無人機(jī)建模與仿真完整實踐方案聚焦飛行動力學(xué)建模、實時圖像顯示與多策略路徑規(guī)劃三大核心能力訓(xùn)練。壓縮包共34個文件含28個.m主控與算法腳本如dubinsParameters、planRRTDubins、autopilot等、3個Simulink系統(tǒng)模型文件mavsim.slx等用于動力學(xué)與控制閉環(huán)仿真、2幅環(huán)境/傳感器圖像predator.jpg、batcam.png及1張說明圖整體僅540KB輕量易部署。已有1086人學(xué)習(xí)下載資源結(jié)構(gòu)清晰從參數(shù)配置param.m、氣動建模forces_moments.m、狀態(tài)估計estimate_states.m到路徑生成planCoverRRTDubins.m、航跡跟蹤path_follow.m及可視化drawEnvironment.m、drawPathError.m全覆蓋所有模塊均可獨立運行或協(xié)同調(diào)試配套注釋詳實是理解固定翼無人機(jī)自主飛行系統(tǒng)設(shè)計與驗證的理想入門級工程范例。1. 項目緣起從零開始構(gòu)建一個“看得見”的無人機(jī)仿真世界幾年前當(dāng)我第一次接觸無人機(jī)項目時面對的是一堆冰冷的代碼和一堆抽象的數(shù)學(xué)公式??刂破髡{(diào)參像是在黑箱里摸索飛行動力學(xué)模型是否準(zhǔn)確只能等真機(jī)試飛時才能驗證成本高、風(fēng)險大。那時候我就在想如果能有一個“數(shù)字孿生”的沙盤在電腦里就能把飛機(jī)飛起來看到它的姿態(tài)、軌跡甚至模擬它“眼中”的世界那該多好。這就是我動手搭建這個Matlab小型固定翼無人機(jī)建模與仿真程序的初衷。這個程序遠(yuǎn)不止是一個簡單的動力學(xué)模型。它的核心價值在于構(gòu)建了一個從“物理內(nèi)核”到“視覺感知”再到“智能決策”的完整閉環(huán)仿真環(huán)境。你不僅能看到無人機(jī)按照六自由度方程在空中飛行還能通過一個虛擬的“機(jī)載攝像頭”觀察地面并讓無人機(jī)基于這些圖像信息或預(yù)設(shè)地圖自主規(guī)劃出一條從A點到B點的最優(yōu)或可行路徑。對于學(xué)生來說它是理解無人機(jī)原理、學(xué)習(xí)控制算法和路徑規(guī)劃理論的絕佳實驗平臺對于工程師它可以作為算法前期驗證、降低實物試錯成本的得力工具對于研究者它提供了一個高度可定制、模塊化的框架便于快速實現(xiàn)和測試新的想法。整個項目完全基于Matlab/Simulink環(huán)境構(gòu)建充分利用了其強(qiáng)大的數(shù)值計算、圖形顯示和工具箱生態(tài)。下面我將毫無保留地拆解這個系統(tǒng)的每一個模塊分享從建模、仿真到集成的完整過程以及那些在文檔里找不到的“踩坑”經(jīng)驗。2. 基石小型固定翼無人機(jī)的六自由度非線性動力學(xué)建模仿真系統(tǒng)的靈魂在于模型。一個失真的模型無論后續(xù)的控制器和規(guī)劃器多精妙得出的結(jié)論都可能是空中樓閣。對于固定翼無人機(jī)我們必須建立其六自由度6-DoF非線性動力學(xué)模型這包括了在三維空間中的三個平移自由度和三個旋轉(zhuǎn)自由度。2.1 坐標(biāo)系定義與轉(zhuǎn)換一切計算的起點建模的第一步是明確坐標(biāo)系。這里主要涉及兩個機(jī)體坐標(biāo)系Body Frame, B-frame和地面慣性坐標(biāo)系Earth Frame, E-frame通常為NED北-東-地。機(jī)體坐標(biāo)系 (B-frame): 原點在無人機(jī)質(zhì)心。X軸指向機(jī)頭Y軸指向右翼Z軸根據(jù)右手定則指向機(jī)身下方。在這個坐標(biāo)系下我們定義無人機(jī)的線速度[u, v, w]對應(yīng)X,Y,Z軸速度和角速度[p, q, r]滾轉(zhuǎn)、俯仰、偏航角速度。地面慣性坐標(biāo)系 (E-frame): 這是我們觀察無人機(jī)運動的全局坐標(biāo)系。通常采用北-東-地NED約定。無人機(jī)的位置[X_n, Y_e, Z_d]和姿態(tài)歐拉角滾轉(zhuǎn)角 Φ俯仰角 Θ偏航角 Ψ都是在這個坐標(biāo)系下描述的。兩者之間的轉(zhuǎn)換至關(guān)重要。線速度通過方向余弦矩陣DCM或旋轉(zhuǎn)矩陣進(jìn)行轉(zhuǎn)換。而角速度與歐拉角變化率之間的關(guān)系則由一個非線性微分方程描述其中包含著名的“歐拉角奇異點”當(dāng)俯仰角Θ±90°時。在仿真中我選擇了四元數(shù)來表示姿態(tài)它沒有奇異點計算也更高效最后再轉(zhuǎn)換為歐拉角用于顯示和理解。注意很多初學(xué)者會直接使用Simulink Aerospace Blockset里的“6DOF (Euler Angles)”模塊這很方便但要小心它的奇異點問題。對于可能做大機(jī)動如特技飛行的仿真強(qiáng)烈建議使用“6DOF (Quaternion)”模塊或者自己用四元數(shù)實現(xiàn)姿態(tài)更新。2.2 力與力矩的構(gòu)成氣動、重力、推力作用在無人機(jī)上的合外力與合力矩決定了其運動狀態(tài)。它們主要由三部分組成重力: 始終沿地面坐標(biāo)系的Z軸指向地心方向。需要在機(jī)體坐標(biāo)系下表示F_gravity_B DCM * [0; 0; mg]其中m是質(zhì)量g是重力加速度DCM是從地面系到機(jī)體系的旋轉(zhuǎn)矩陣轉(zhuǎn)置。推力: 由螺旋槳發(fā)動機(jī)產(chǎn)生。假設(shè)推力沿機(jī)體X軸方向其大小通常建模為油門指令δ_t的函數(shù)例如T T_max * δ_t線性模型或更復(fù)雜的包含空速影響的模型。推力作用點如果不在質(zhì)心還會產(chǎn)生俯仰力矩。氣動力與力矩: 這是最復(fù)雜也最核心的部分。它們?nèi)Q于無人機(jī)的氣動外形、飛行狀態(tài)空速、迎角、側(cè)滑角和控制面偏轉(zhuǎn)。迎角 (α)和側(cè)滑角 (β)這是連接機(jī)體速度與氣動力的關(guān)鍵橋梁。α arctan(w/u),β arcsin(v/V)其中V sqrt(u^2v^2w^2)為空速。氣動系數(shù): 力與力矩通常被無量綱化為系數(shù)。例如升力系數(shù)C_L阻力系數(shù)C_D俯仰力矩系數(shù)C_m等。這些系數(shù)是α, β, 馬赫數(shù)、控制面偏轉(zhuǎn)角升降舵δ_e副翼δ_a方向舵δ_r以及它們的變化率如俯仰角速度q的復(fù)雜函數(shù)。工程化處理對于小型固定翼無人機(jī)我們通常采用“系數(shù)線性化查表”的方式。在常規(guī)飛行包線內(nèi)可以假設(shè)C_L C_L0 C_Lα * α C_Lq * (q * c? / (2V)) C_Lδe * δ_e。其中C_L0, C_Lα等為氣動導(dǎo)數(shù)可以通過計算流體力學(xué)CFD或風(fēng)洞試驗獲得對于學(xué)習(xí)目的也可以參考公開的模型如Aerosonde UAV數(shù)據(jù)。對于非線性較強(qiáng)的區(qū)域則使用基于α, β等參數(shù)預(yù)計算好的多維查表Lookup Table。在我的實現(xiàn)中我將氣動力計算封裝成了一個獨立的Matlab函數(shù)模塊。輸入是當(dāng)前狀態(tài)u,v,w, p,q,r, 控制面偏角和氣動參數(shù)輸出是機(jī)體坐標(biāo)系下的三個氣動力X_a, Y_a, Z_a和三個氣動力矩L, M, N。這樣在Simulink中調(diào)用非常清晰。% 示例簡化的氣動力計算函數(shù)框架 function [F_aero_B, M_aero_B] calculateAeroForces(state, delta, aero_params) % state: [u, v, w, p, q, r] 在機(jī)體坐標(biāo)系下的速度與角速度 % delta: [delta_e, delta_a, delta_r] 控制面偏轉(zhuǎn)角 % aero_params: 結(jié)構(gòu)體包含翼面積S、翼展b、平均氣動弦長c_bar、氣動導(dǎo)數(shù)等 V norm(state(1:3)); % 空速 alpha atan2(state(3), state(1)); % 迎角 beta asin(state(2) / V); % 側(cè)滑角注意V0時的處理 % 1. 計算氣動系數(shù)這里以線性模型示例 C_L aero_params.C_L0 aero_params.C_L_alpha * alpha aero_params.C_L_q * (state(5) * aero_params.c_bar / (2*V)) aero_params.C_L_delta_e * delta(1); C_D aero_params.C_D0 aero_params.C_D_alpha * alpha; % 簡化阻力模型 C_Y aero_params.C_Y0 aero_params.C_Y_beta * beta aero_params.C_Y_delta_r * delta(3); C_l aero_params.C_l_beta * beta aero_params.C_l_p * (state(4) * aero_params.b / (2*V)) aero_params.C_l_delta_a * delta(2); C_m aero_params.C_m0 aero_params.C_m_alpha * alpha aero_params.C_m_q * (state(5) * aero_params.c_bar / (2*V)) aero_params.C_m_delta_e * delta(1); C_n aero_params.C_n_beta * beta aero_params.C_n_r * (state(6) * aero_params.b / (2*V)) aero_params.C_n_delta_r * delta(3); % 2. 計算氣動力與力矩在機(jī)體軸系 Q 0.5 * aero_params.rho * V^2 * aero_params.S; % 動壓 F_aero_B Q * [-C_D; C_Y; -C_L]; % 注意通常Z軸向下為正所以升力為負(fù) M_aero_B Q * [aero_params.b * C_l; aero_params.c_bar * C_m; aero_params.b * C_n]; end2.3 運動方程集成與Simulink實現(xiàn)有了力與力矩我們就可以根據(jù)牛頓-歐拉方程寫出完整的6-DoF運動方程。在Simulink中我采用“基于模型設(shè)計”的思路使用基本的數(shù)學(xué)運算模塊加、乘、積分和函數(shù)調(diào)用模塊如上述氣動力函數(shù)來搭建模型而不是完全依賴現(xiàn)成的6DOF模塊。這樣做的好處是模型完全透明便于調(diào)試和修改。核心的積分環(huán)路是這樣的上一時刻的狀態(tài)位置、速度、姿態(tài)、角速度 - 計算當(dāng)前所受合外力/力矩 - 通過運動微分方程 - 得到狀態(tài)變量的導(dǎo)數(shù) - 經(jīng)過積分器 - 更新為當(dāng)前時刻的狀態(tài)。這個環(huán)路由Simulink的求解器自動推進(jìn)。實操心得仿真步長的選擇至關(guān)重要。對于固定翼無人機(jī)動力學(xué)其模態(tài)頻率較高如短周期模態(tài)需要較小的步長才能準(zhǔn)確捕捉。我通常從0.01秒開始嘗試。使用變步長求解器如ode45可以兼顧精度和速度但在有離散控制器或規(guī)劃器時固定步長如ode4即四階龍格庫塔更穩(wěn)定。務(wù)必在仿真后檢查狀態(tài)量的變化是否平滑有無異常的數(shù)值振蕩。3. 讓無人機(jī)“看見”三維可視化與虛擬相機(jī)圖像生成一個只有數(shù)據(jù)曲線的仿真是枯燥且不直觀的。讓無人機(jī)“看見”是連接物理模型與高層智能路徑規(guī)劃的關(guān)鍵橋梁也是驗證感知算法的基礎(chǔ)。3.1 基于MATLAB Robotics System Toolbox的三維場景搭建我選擇使用MATLAB的Robotics System Toolbox來創(chuàng)建三維環(huán)境。它提供了robotics.OccupancyGrid用于二維路徑規(guī)劃和robotics.VectorFieldHistogram等工具但其三維可視化能力更適合我們構(gòu)建一個簡單的虛擬世界。首先創(chuàng)建一個三維的axes對象并設(shè)置好視角和光照。然后用基本的圖形對象patch,surf,plot3來繪制地形、障礙物和無人機(jī)模型。地形可以用meshgrid生成網(wǎng)格點再通過一個函數(shù)如peaks或自定義的高度圖賦予Z值最后用surf繪制。為了增加真實感可以根據(jù)高度映射不同的顏色。無人機(jī)模型為了可視化姿態(tài)我們不能只畫一個點。我創(chuàng)建了一個簡單的三維“飛機(jī)”圖形由幾個patch對象組成機(jī)身、機(jī)翼、尾翼。這個圖形對象的頂點坐標(biāo)定義在機(jī)體坐標(biāo)系下。在每一幀更新時根據(jù)無人機(jī)當(dāng)前的位置X_n, Y_e, Z_d和姿態(tài)旋轉(zhuǎn)矩陣R將機(jī)體坐標(biāo)系下的頂點坐標(biāo)變換到地面坐標(biāo)系V_earth pos (R * V_body)然后更新patch對象的Vertices屬性。軌跡用一個plot3對象來實時繪制無人機(jī)質(zhì)心的歷史位置形成飛過的軌跡線。3.2 模擬機(jī)載攝像頭與圖像生成這是項目的亮點之一。我們不僅要從第三人稱視角看無人機(jī)還要模擬第一人稱的機(jī)載視圖。思路是在三維場景中我們放置一個虛擬的相機(jī)其位置和朝向與無人機(jī)綁定比如安裝在機(jī)頭下方。然后獲取這個相機(jī)視角下的“快照”生成一幅圖像。相機(jī)參數(shù)標(biāo)定在MATLAB中我們可以用cameraIntrinsics對象來定義相機(jī)的內(nèi)參焦距、主點、畸變。對于仿真我們可以假設(shè)一個理想的針孔相機(jī)模型。focalLength [800, 800]; % 像素單位下的焦距 [fx, fy] principalPoint [320, 240]; % 圖像中心 [cx, cy] imageSize [480, 640]; % 圖像尺寸 [高度 寬度] intrinsics cameraIntrinsics(focalLength, principalPoint, imageSize);相機(jī)姿態(tài)設(shè)置相機(jī)的外參即相對于機(jī)體坐標(biāo)系的位置和朝向需要定義。例如相機(jī)安裝在機(jī)頭前下方0.1米光軸指向機(jī)體前方并略微下傾比如-10度俯仰。% 相機(jī)相對于機(jī)體坐標(biāo)系的位置和姿態(tài)旋轉(zhuǎn)矩陣 T_body_to_cam [eye(3), [0.1; 0; -0.05]; 0 0 0 1]; % 假設(shè)安裝在(0.1, 0, -0.05)m R_body_to_cam eul2rotm([0, deg2rad(-10), 0]); % 繞Y軸旋轉(zhuǎn)-10度俯仰向下 T_body_to_cam(1:3, 1:3) R_body_to_cam;渲染圖像這是最具挑戰(zhàn)的一步。純Matlab的圖形渲染并非為實時圖像生成設(shè)計。我探索了兩種方法方法A使用getframe和vision.AlphaBlender簡易但慢將三維axes的CameraPosition和CameraTarget設(shè)置為虛擬相機(jī)的位置和看向的點然后使用getframe(gca)捕獲當(dāng)前視圖作為圖像。但這種方法捕獲的是整個圖形窗口包含坐標(biāo)軸等需要裁剪且?guī)屎艿?。方法B使用pcplayer與自定義投影推薦更接近真實創(chuàng)建一個點云播放器pcplayer但將其用于顯示我們自定義的三維場景點云。首先將地形和障礙物的表面點采樣為點云。然后在每一仿真步根據(jù)無人機(jī)和相機(jī)姿態(tài)計算這些點在該相機(jī)視角下的投影坐標(biāo)。利用相機(jī)內(nèi)參將三維點投影到二維圖像平面。最后根據(jù)深度進(jìn)行簡單的可見性判斷如Z-buffer生成一幅“深度圖”或“特征圖”。雖然這不是真實的光照渲染圖像但對于許多路徑規(guī)劃算法如基于特征的視覺導(dǎo)航、障礙物檢測來說這種二維投影信息已經(jīng)足夠。我最終采用了方法B的變種。我創(chuàng)建了一個簡化的三維網(wǎng)格地圖占用網(wǎng)格每個網(wǎng)格單元有一個屬性如空地、障礙物、目標(biāo)點。虛擬相機(jī)的任務(wù)就是“看到”前方一定錐形范圍內(nèi)的網(wǎng)格并將其渲染成一張從上往下的二維俯視圖類似于一個高度壓縮的二維激光雷達(dá)掃描圖這非常適合用于后續(xù)的局部路徑規(guī)劃。踩坑實錄最初我試圖用getframe實現(xiàn)實時圖像流仿真速度立刻從實時降到了十分之一。原因是getframe和圖形重繪開銷巨大。教訓(xùn)是在仿真中視覺模塊的“逼真度”需要與“效率”權(quán)衡。除非專門研究圖像處理算法否則用簡化的幾何投影來提供必要的環(huán)境信息往往是更高效的選擇。將圖像更新頻率設(shè)置為比動力學(xué)仿真步長低一個數(shù)量級如動力學(xué)步長0.01s圖像更新0.1s也能顯著提升性能。4. 大腦從全局到局部的路徑規(guī)劃算法集成有了能“飛”的模型和能“看”的眼睛最后一步就是為無人機(jī)裝上“大腦”讓它能自主規(guī)劃路徑。我的程序集成了兩層規(guī)劃基于已知地圖的全局路徑規(guī)劃和基于機(jī)載“視覺”的局部實時避障。4.1 全局路徑規(guī)劃A*算法在三維空間的應(yīng)用全局規(guī)劃假設(shè)我們擁有一張先驗的二維或二維半地圖即每個XY位置有高度或通行代價。我選擇了經(jīng)典的A*A-Star算法因為它在網(wǎng)格地圖上非常高效且能保證找到最優(yōu)路徑如果存在。地圖表示使用一個二維矩陣map表示全局代價地圖。值0代表可通行空地1代表障礙物也可以使用0~1之間的值表示不同地形的通行代價如草地、水域。節(jié)點與啟發(fā)函數(shù)將地圖網(wǎng)格化每個網(wǎng)格中心是一個節(jié)點。A*算法需要定義移動代價g(n)和啟發(fā)函數(shù)h(n)。對于無人機(jī)我通常允許八方向移動包括對角對角移動代價設(shè)為sqrt(2)。啟發(fā)函數(shù)使用歐幾里得距離或曼哈頓距離。為了考慮高度可以將節(jié)點擴(kuò)展為三維(x, y, z)但搜索復(fù)雜度會立方增長。一個折中方法是在二維XY平面上規(guī)劃但將高度變化爬升/下降的代價融入到g(n)中例如增加一個與高度差成正比的懲罰項這樣規(guī)劃出的路徑會傾向于選擇平緩的路線。MATLAB實現(xiàn)雖然MATLAB沒有內(nèi)置的A*函數(shù)但實現(xiàn)起來很直接。需要維護(hù)openSet和closedSet以及每個節(jié)點的gScore,fScore和parent。MATLAB的矩陣操作優(yōu)化能讓代碼比較簡潔。規(guī)劃出的路徑是一系列連續(xù)的網(wǎng)格坐標(biāo)點(x_i, y_i)。% 簡化版A*算法核心框架偽代碼 function path aStar(start, goal, map) [rows, cols] size(map); openSet priorityQueue(); % 需要實現(xiàn)一個優(yōu)先隊列按fScore排序 gScore inf(rows, cols); fScore inf(rows, cols); cameFrom cell(rows, cols); % 記錄父節(jié)點 gScore(start(1), start(2)) 0; fScore(start(1), start(2)) heuristic(start, goal); openSet.insert(start, fScore(start(1), start(2))); while ~openSet.isEmpty() current openSet.pop(); % 取出fScore最小的節(jié)點 if isequal(current, goal) path reconstructPath(cameFrom, current); return; end neighbors getNeighbors(current, map); % 獲取8鄰域可通行節(jié)點 for i 1:length(neighbors) neighbor neighbors(i); tentative_gScore gScore(current(1), current(2)) cost(current, neighbor); if tentative_gScore gScore(neighbor(1), neighbor(2)) cameFrom{neighbor(1), neighbor(2)} current; gScore(neighbor(1), neighbor(2)) tentative_gScore; fScore(neighbor(1), neighbor(2)) tentative_gScore heuristic(neighbor, goal); if ~openSet.contains(neighbor) openSet.insert(neighbor, fScore(neighbor(1), neighbor(2))); else openSet.update(neighbor, fScore(neighbor(1), neighbor(2))); end end end end path []; % 未找到路徑 end4.2 局部實時避障人工勢場法APF的快速響應(yīng)全局路徑給出了一個粗略的參考但無人機(jī)飛行中可能會遇到未預(yù)料的障礙物動態(tài)障礙或地圖誤差。這就需要局部實時規(guī)劃。我選擇了人工勢場法Artificial Potential Field因為它計算量小適合在線運行。其核心思想是為目標(biāo)和障礙物分別構(gòu)造勢場引力場由目標(biāo)點產(chǎn)生勢能大小與到目標(biāo)的距離成正比引力方向指向目標(biāo)。U_att 0.5 * k_att * (distance_to_goal)^2對應(yīng)的引力F_att -gradient(U_att) k_att * (goal_position - current_position)。斥力場由障礙物產(chǎn)生只在障礙物周圍一定范圍內(nèi)有效勢能大小與到障礙物距離成反比斥力方向遠(yuǎn)離障礙物。U_rep 0.5 * k_rep * (1/distance_to_obs - 1/influence_distance)^2(if distance influence_distance)對應(yīng)的斥力F_rep gradient(U_rep)。無人機(jī)所受的虛擬合力F_total F_att ΣF_rep。將這個合力的方向作為期望的加速度或速度方向輸入給底層的飛行控制器。在我的實現(xiàn)中局部障礙物信息就來源于第3節(jié)中虛擬相機(jī)生成的二維局部地圖。算法每隔一個規(guī)劃周期如0.1秒就根據(jù)當(dāng)前位置、全局路徑的下一段子目標(biāo)、以及局部障礙物柵格圖計算出一個即時的期望航向角或橫向加速度指令傳遞給控制器。注意事項人工勢場法有個著名的問題——局部極小值。當(dāng)引力和斥力平衡時無人機(jī)可能會被困在某個點無法動彈。我的解決方法是結(jié)合全局路徑。當(dāng)檢測到無人機(jī)速度持續(xù)低于閾值且未到達(dá)目標(biāo)時就觸發(fā)一次局部重規(guī)劃或者在勢場函數(shù)中加入一個“切向力”或“隨機(jī)擾動”來幫助逃逸。更魯棒的方法是結(jié)合D* Lite等動態(tài)重規(guī)劃算法但計算開銷會增大。5. 系統(tǒng)集成與仿真循環(huán)讓一切協(xié)同工作將動力學(xué)模型、可視化、圖像生成、路徑規(guī)劃器集成到一個流暢的仿真循環(huán)中是最后的挑戰(zhàn)。我采用Simulink作為主引擎結(jié)合MATLAB Function塊和S-Function來實現(xiàn)混合系統(tǒng)仿真。5.1 Simulink模型架構(gòu)整個系統(tǒng)是一個典型的“感知-規(guī)劃-控制”閉環(huán)。Plant Model被控對象即第2節(jié)搭建的6-DoF無人機(jī)非線性動力學(xué)模型。輸入是控制面偏角[δ_e, δ_a, δ_r]和油門δ_t。輸出是所有狀態(tài)量位置、姿態(tài)、速度等。Flight Controller飛行控制器這是一個內(nèi)環(huán)控制器負(fù)責(zé)穩(wěn)定無人機(jī)姿態(tài)。我通常設(shè)計為串級PID控制。外環(huán)位置/高度/航向產(chǎn)生期望的俯仰角、滾轉(zhuǎn)角和空速指令內(nèi)環(huán)姿態(tài)角根據(jù)期望姿態(tài)和當(dāng)前姿態(tài)的偏差計算出所需的控制面偏轉(zhuǎn)角和油門量。這部分可以用Simulink的PID模塊搭建參數(shù)需要仔細(xì)整定。Path Follower路徑跟蹤器它接收規(guī)劃器給出的路徑點一系列[X, Y, Z]并計算出當(dāng)前無人機(jī)應(yīng)該執(zhí)行的“目標(biāo)狀態(tài)”比如目標(biāo)高度、目標(biāo)航向、目標(biāo)空速然后傳遞給飛行控制器。常用的跟蹤算法有純追蹤法Pure Pursuit或線性二次型調(diào)節(jié)器LQR。Global Local Planner規(guī)劃器這是一個由觸發(fā)事件或固定周期驅(qū)動的模塊。全局規(guī)劃器在仿真開始時運行一次給出全局路徑。局部規(guī)劃器以更高頻率如10Hz運行它從Visualization Image Module可視化與圖像模塊獲取當(dāng)前的局部障礙物信息并對全局路徑進(jìn)行微調(diào)或生成緊急避障指令。Visualization Image Module可視化與圖像模塊這是一個MATLAB Function塊或S-Function在每個仿真步或每N個步被調(diào)用。它從Plant Model讀取當(dāng)前無人機(jī)狀態(tài)更新三維動畫和虛擬相機(jī)圖像。圖像信息被傳遞給局部規(guī)劃器。5.2 仿真流程與參數(shù)調(diào)試心得啟動仿真后流程如下初始化加載無人機(jī)參數(shù)、地圖、設(shè)置初始狀態(tài)。全局規(guī)劃根據(jù)起點和終點運行A*算法得到全局路徑點序列。Simulink求解器開始推進(jìn)時間 a. 動力學(xué)模型根據(jù)當(dāng)前控制輸入更新狀態(tài)。 b. 可視化模塊更新3D視圖和虛擬相機(jī)圖像。 c. 在規(guī)劃周期到達(dá)時局部規(guī)劃器根據(jù)當(dāng)前圖像和位置計算局部路徑指令。 d. 路徑跟蹤器綜合全局和局部指令生成目標(biāo)狀態(tài)。 e. 飛行控制器根據(jù)目標(biāo)狀態(tài)和當(dāng)前狀態(tài)差計算新的控制輸入。 f. 控制輸入作用于動力學(xué)模型進(jìn)入下一個仿真步。仿真結(jié)束分析數(shù)據(jù)軌跡跟蹤誤差、控制量變化、圖像序列等。調(diào)試經(jīng)驗分享“分而治之”不要試圖一次性集成所有模塊并跑通。我的步驟是先讓動力學(xué)模型在開環(huán)下給定固定舵面能飛出一個合理的軌跡如平飛。然后關(guān)閉環(huán)控制器讓無人機(jī)能穩(wěn)定懸停或跟蹤簡單的指令如階躍高度變化。接著單獨測試路徑跟蹤器用一條預(yù)設(shè)的直線或圓弧路徑看無人機(jī)能否跟上。再單獨測試規(guī)劃器輸入一個簡單地圖看規(guī)劃出的路徑是否合理。最后再把所有模塊像拼圖一樣連接起來。參數(shù)整定順序控制器參數(shù)整定從內(nèi)環(huán)開始。先整定角速率環(huán)p, q, r再整定姿態(tài)環(huán)Φ, Θ, Ψ最后整定外環(huán)位置/速度環(huán)。使用Simulink的PID Tuner工具或手動調(diào)整時觀察階躍響應(yīng)的超調(diào)量、穩(wěn)定時間和穩(wěn)態(tài)誤差??梢暬菑?qiáng)大的調(diào)試工具當(dāng)無人機(jī)飛行動作怪異時仔細(xì)觀察三維動畫。是姿態(tài)劇烈振蕩還是根本朝錯誤方向飛結(jié)合繪制出來的狀態(tài)曲線如歐拉角、控制量能快速定位問題是出在控制器、規(guī)劃器還是模型本身。虛擬相機(jī)圖像也能幫你確認(rèn)局部規(guī)劃器“看到”的世界是否和你設(shè)想的一致。性能瓶頸如果仿真速度很慢使用Profiler工具分析耗時最多的函數(shù)。往往是可視化渲染或規(guī)劃算法尤其是搜索算法占了大頭。對于非關(guān)鍵模塊可以降低其更新頻率。對于A*算法如果地圖很大可以嘗試使用更高效的啟發(fā)函數(shù)如Diagonal distance或者采用跳點搜索JPS等優(yōu)化算法。通過這個完整的建模與仿真程序你獲得的不再是一個黑盒工具而是一個透明、可干預(yù)、可擴(kuò)展的無人機(jī)系統(tǒng)研發(fā)沙盤。它允許你以極低的成本深入理解從底層動力學(xué)到高層智能決策的每一個環(huán)節(jié)并安全、高效地測試你的算法創(chuàng)意。無論是用于教學(xué)、科研還是工程預(yù)研這套框架都提供了一個堅實的起點。本文還有配套的精品資源點擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
六月亭亭久久综合激情| 五月丁香亚洲综合| 色99欧洲色19| 99性色| 婷婷六月丁香色| 大香久久综合网| 久婷狼色诱惑在线| 五月婷婷欧美激情| 狠狠色综合五月| 婷婷网五月天| 九九免费精品在线视频| 婷婷丁香五月综合| 成人丁香五月天Av| 99热丁香五月| 丁香六月欧美| 色五月亚洲五月天| 成人免费黄色短视频| 五月丁香999| 亚洲欧洲另类| 人人人舔人人人操人人人摸人人人97| 丁香五月婷婷高清| 色五月激情| 色吊丝中文字幕| 婷婷五月激情五月激情| 99久超碰| 激情五月天网站| 九月婷婷人人操人人舔人人爱| 色六月天| 婷婷五月开心中文字幕在线| 国产VA播放| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 色五月大| 91人人爱| 成 人片 黄 色 大 片| 激情五月天网站| 天天综合网91| 99久久精品亚洲综合| 丁香久久| 久久久久人妻网址| 婷婷亚洲丁香五月| 综合欧美五月婷婷| 超碰在线看| 亚洲99一级无嗎特制在线| 99这里有精品| 丁香五月综合| 五月婷婷丁香| 亚州美女| 麻豆AV一区二区三区| 99精品综合视频| 开心五月激情| 丁香九月综合| 99色在线视频观看| 久久久97| 尤物一区二区| 99热精品无码| 婷婷99狠狠| 亚州美女| 99九九玖玖| 性色欲情 网站| 日韩一区二区A片免费观看| 天天天操天天天日| 久久99久久久久久| 4438全国最大视频成人网站在线观看| www狠狠| 激情综合婷婷| 久久婷综合网| 激情久久伊人| 色欲一区二区三区精品A片| 狠狠狠狠狠| 五月丁香婷婷成人综合网| 五月丁香 啪啪啪| 亚洲无码另类| 在线区区区| 欧美啪啪9| 色停停影院五月天| 亚洲在线操| 五月丁香六月婷婷a v| 天天干电影| 亚洲小视频免费观看| 人妻久久久久久久久妻久久久久久久久 | 日本波多野结衣视频| 九九热99精品| 久久HD| 伊人久久五月天| 婷婷免费无马| 亚洲五月丁香综合网| 这里只有精彩视频| 九色91美女| 人人插9| 高清无码入口| 丁香六月综合激情| 精品久热| 婷婷射婷婷舔| 伊人狠狠操| 五月天激情综合首页| 国产.亚洲.欧洲视频在线| 国产精品国产| 思思热AV| 丁香 婷婷五月| 99啪啪网| 五月丁香六月婷婷操操操| 色9色| 日本色色影院| 免费日本aⅴ中文字幕 | 国产毛片操B| 五月停亭六月,六月停亭的英语 | 色99热| 久热99狠| 亚洲AV影片在线观看| 人人干人人看| 亚洲操操| 国产又黄又爽又色的免费| 欧美激情综合五月色丁香| 婷婷精品综合| 日韩乱轮AV| 九九精品9| 色欲久久久久久综合网综合网| 色婷| 色色色色色色色色色999| 色欲久久久久| 婷婷五月天av| 超碰猛烈的性猛交| 婷婷五月综合啪| 天天干天天干天天干| 99热这里是精品| 无码少妇高潮喷水A片免费| 琪琪色网址| 性爱网五月天| 夜色爱爱亚洲| 日本色色图| 99热网站在线观看| 色情五月天丁香社区| 九九视频这里只有精品| 色色色色色五月| 成片免费观看视频大全| 天天干天天操天天爽| AV中文在线| 综合色播| 日本久久精品18| 99热在线这里只有精品| 色欲人妻综合aaaaaaaa网| 国产三级片91| 中文字幕永久免费| AV伊人青草丁香六月| 久久婷婷五月天大香蕉| 中文字幕AV网址| 色性综合| 婷婷五月天在线看| 色婷婷视频| 五月婷婷色播视频| 丁香五月婷婷亚洲另类| 99热无码| 午夜成人网站在线观看| 色综合九九色综合88| 五月婷婷开心网| 激情综合五月婷婷六月丁香| 精品人妻在线| 夜夜骑夜夜撸| 久久在线人妻| 天天色天天爱天天爱天天爱y| 色色色色色色97| 色9999日韩国产| 92久操视频| 狠狠999| 玖玖伦理电影| 丁香婷婷五色月| 五月丁香婷婷成人伊人网| 欧韩性爱| 五月天俺去也| AV片在线观看| 天天爽天天爽夜夜爽| 大香蕉啪啪啪| 这里只有精彩小视频视频网站| 亚美欧色影院| 丁香五月天婷婷大香蕉| 看久久性爱视频| 婷婷午夜| 人妻人人操| 欧美性猛交 XXXX 乱大交| 大香蕉久久视频久久视频 | 欧美综合五月丁香六月婷| 成人av中文字幕| 丁香婷婷老熟女综合网| 直接看的av| 五月六月丁香激情| 激情五月天婷婷| 国产精品扒开腿做爽爽爽A片唱戏| 亚洲黄色网址| 999婷婷综合| 人人操Av| 天天爽综合网| 久久五月丁香| 色婷婷综合丁香五月天| 久久六月天| 六月婷婷视频| 色色色com| 久久久婷婷| 香蕉AV777XXX色综合一区| 538任你爽| 久久久99精品免费观看| 久热A| 成人超碰网| 很很干在线视频| 欧美性色A片免费免费观看的| 五月天天丁香婷婷在线中| 99精品在线| 日韩一区二区在线播放| 婷婷碰碰| 色色色干| 激情五月婷婷在线区| 国精产品一区一区三区免费视频| 九九热99热| 永久免费一区二区三区| 婷婷大香蕉| 99热最新| 伊人久久丁香狠狠婷婷综合香蕉| 噜噜噜久久| 99日韩| 久久人妻精品| 丁香婷婷色五月天| 9999三级片| 丁香五月天堂| 日韩爱操视频| 婷婷激情伍月网| 无码日本精品XXXXXXXXX | 五月天开心色情网| 婷婷婷久久久| 欧美成人精品三区综合A片| 国产阿姨日皮艹逼内射视频| 国产欧洲欧洲精品久久| 免费观看全黄做爰的视频 | 久久五月综合| 日韩在线看AV| AV亚洲在线| 久热视频这里只有精品| 六月丁香婷婷五月天| 色五月天堂| 战争与艾拉电影免费观看| 欧美成人A片AAA片在线播放| 婷婷月综合| 九色色| 操91| 欧美群妇大交乱婬网| 少妇人妻人伦A片| 激情九月婷婷九月| www,色中色| 79精品视频在线观看,| 91久久电影| 狠狠撸激情综合丁香五月天俺来啦| 九月婷婷久久| 久久婷婷东京热| 五月丁香狠狠| 丁香五月天av| 人橾人| 成人综合网站| 人人爱国产| 欧美激情凹凸丁香网| 九九99免费视频| 夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂亚洲亚洲亚洲亚洲亚洲亚洲亚洲亚洲色 | 97天堂| 精品久9| 婷婷五月激情综合| 很很干天天干| 就去涩涩丁香五月天| 五月婷婷丁香大陆免费| 色97啪啪| 久久九九激情五月天 | 99热在线观看| a在线观看| 丁香桃色网| 思思99热在线| 性五月激情| 亚洲AV永久无码影院黑人| 日日干夜夜干| 欧日韩成人| 色五月在线视频观看| 六月丁香啪| 婷婷五月天激情综合深爱激情| 99精品网| 亭亭五月天黑人2014| 九九9久九9国产视频| 极品 少妇 内射| 国产高潮A片羞羞视频涩涩| 久久99久久99精品免视看婷| 激情图片婷婷| 久久超级碰视频| 色噜噜丁香| 久久久久9| 丁香六月婷| 欧美婷婷色五月| 南京搡BBBB搡BBBB| 色综合五月婷婷狠狠干| 六月色色综合| 颜射 精品性爱av| 亚洲另类电影| 99小视频| 激情综合五月激情XXXX| 婷香五月网在线| 伊人干综合| 99热1| 日韩淑女人妻luan伦激情精品一区二| 91啪啪啪啪| 久9热插入| 《亚洲操B久久免费在线观看,亚洲操B久久在线播放》在线播放 - 高清资源 - 97 | 99久久婷婷国产综合精品草原| 色综合色婷色基地| 欧美操综合| 九九热青青草| 综合激情专区| 91狠狠综合网| 亚洲激情AV| 久久久WWW| 爆乳熟妇一区二区三区爆乳照片| 九九99久久| 热九九精品| 狠狠操狠狠爱| 五月婷婷视频在线观看| 激情丁香九九五月综合网| 青青草成人网| 亚洲人妻五月丁香婷婷| 國語久久婷| 激情av| 91狠狠色丁香婷婷综合久久狠丁香综合久久精品| 爱射综合| 五月丁香啪啪| 97福利视频| AA片在线观看视频在线播放| 色婷婷超碰| 五月丁香六月色婷| 丁香五月婷婷激情蜜桃| 99热精品在线播放| 丁香五月婷婷乱| 久久网婷婷| 久久久久9999| 99国产这里只有精品| 大香蕉99| 中日韩美欧成人一区二区精品在线| 亚洲精品婷婷| 一本道综合网| 亚洲亚洲人成综合网络| 夜夜操加勒比| 色老久久| 五月婷高清视频| 色区域网站视频| 欧美日韩91| 久狠日av| 亚洲第一色色色| 99精品手机在线视频| 99热99色| 极品人妻VIDEOSSS人妻| 日韩无码色色| 天天色激情| 国产婷婷五月天| 天天日夜夜爽| 九月丁香欧美综合| 无码九九| 女人天堂 AV| 五月婷婷色影院| 亚洲爆乳无码精品AAA片蜜桃| 西西4r午夜剧场| 天天爱天天做天天舔| 色播色丁香五月| 五月激情在线| www.99热在线观看| 五月天啪啪| 欧美久草在线日本一级特黄大片做受9在线观看韩国电影《两个女人》未删减-毛片 | 久婷婷色| 五月天激情AV| 色综合爱综合| 婷婷五月激情四月综合| 久久五月婷婷丁香| 另类图片五月天婷婷| 精品人妻久久久久久| www.色五月天.com| 五月丁香久久精品在线观看| 永久热91| 久久99激情五月天| 色无婷婷| 国产人妻人伦精品一区二区| 99热在线播放| 97综合在线| 久久九九免费视频| 婷婷六月视频| 五月婷婷激情| 伊人久久综合| 艹| 中文字幕av在线| 人妻久久久久久| 99久久综合狠狠综合久久| 久久亚洲婷婷| 手机旧版看人妻1025| 亚洲在线免费成人| wwxx日本| 五月婷激情| WWW.久久久久久久久久久久久| 成人五月天综合网| 这里只有精品日韩精品| 91操片| 日韩精品一曲二曲三曲四曲五曲| 婷婷激情鹿城五月天| 91色噜噜狠狠狠狠色综合| 99热在线极品极品| 五月社区婷婷激情| 婷婷五月花| 精品久热| 日韩成人电影AV| 十区av| 国产精品视频久久99| 五月丁香婷婷啪啪| 操逼毛片国语对白| 一区二区乱码视频| 成人网在线视频| 久色五月| 九九草草逼| 五月丁香爱婷婷深深| 亚洲 六月 综合| 97色欧美| 久久玖玖综合| 五月天婷婷激情| Www.se.久久| 亚洲色vA| 久久丁香婷| 激情五月丁香激情综合网 | 99热这里是精品| 99色视频| 色五月五月婷婷| 丁香五月开心亚洲| 14色综合婷婷| 综合色色婷婷| 丁香五月婷婷深爱综合激情| Av大香蕉| 色五月网址| 亚洲午夜av| 97干免费视频| 五月丁香综合啪啪| 这里只有精品免费在线视频| 婷婷色五月天在线观看| 色五月婷婷狠狠撸| 欧美成人AAA片一区国产精品| 丁香婷婷浪潮AV久久综合| 卡视频1区2区| 思思99热这里只有精品6| 婷婷五月天在线一区| 色五月五月天| 欧洲激情精品婷婷| www.五月婷婷| 无码AV免费精品一区二区三区 | 亚洲黄色操逼| 色色无码日韩| 极品人妻VIDEOSSS人妻| 九九亚洲视频| 神马欧美精| 96精品久久久久久久久| 天天综合久久| 九九99久久精品| 囯产精品一品二区三区| 色啪久 | 久久9热| 色情综合网| 五月丁香少妇网| 丁香五月婷在线观看| 色色色网站| 激情5月婷婷狠狠干| 日韩成人电影AV| 久久狠狠色| 日本成人内射| 久久九色| 五月综合激情视频| 4438激情网| 久热婷婷| 五月天亭亭俺也| 色五月天堂| 大地资源色婷婷视频在线| 色婷婷久久综合丁香五月| 九色在线观看91av| 91蜜桃婷婷狠狠久久综合9色| 好激情在线综合网| 九色视频91疯狂| 大陆极品少妇内射AAAAAA| 九九亚洲视频| 色欲婷婷夜夜| 五月婷婷六月丁香首页| 婷婷成人五月天| 欧美大香蕉视频| 六月丁香五月天| 超碰69天堂| 婷婷综合色色| 五月婷av| 亚洲无AV在线中文字幕| 国产成人综合在线| 操操操AV| 日本3级片一区2区| 五月婷A V在线| 婷婷五月天免费99| 九久久九精品视频| 亚洲午夜一区二区| 丁香五月人妻| 激情五月天色色网| 中文字幕在线日亚洲9| 亚洲激情网站无码| 久久密臀婷婷| 蜜臀A∨在线水帘洞| 日本在线99| 99久久免费精品| 九九热99熟女| 久久99久久99精品,久国产,久久精品免费,99久在线,久久久久国产精品免费网站,9 | 婷婷六月天天| 五月婷婷中文字幕| 这里只有精品亚洲| 操骚货在线| 国产精产国品一二三在观看| 婷婷久久五月| 超级碰碰碰97免费| 日美三级| 五月天狠狠干| 香蕉久久国产AV一区二区| 五月婷婷熟女| 婷婷五月综合体验看| 搡BBBB搡BBB搡五十| 六月婷婷av| 激情綜合W W W,激情五月天| 婷婷.com| 免费久久这里只有精品99| 精品久热| 美国不卡视频| 丁香五月婷婷综合网| 老司机日日夜夜青草| 日韩AV中文字幕在线| 人人舔人人色人人高潮| 狠狠干婷婷| 亚洲综合久| 久久这里只有精品99| 亚洲日比视频| 久久机热这里只有精品| 97人妻超级碰碰碰碰碰| 亚洲色欲欧美一区二区三区| 99色在线视频| 色情·com| 五月丁香久久| 91精品久久久久久| 丁香五月成人| 99亚色色色| 五夜婷婷| 午夜色婷婷| 久久婷婷五月丁香网| 加勒比日本一区二区三区| 国产婷婷五月天| 色婷网站| 夜夜爽天操| 久久婷婷五月综合色丁香花| 婷婷色情小说| 五月婷色丁香| 五月婷婷丁香五月| 在线观看996精品| 99精彩视频| 久久免费试看120秒| 天天综合亚洲| 久久天堂女人| 五月丁香色六月激情干大屄| 日韩天堂久久| 五月天播播| 综合色吧| 色色色国产| 婷婷九月激情| 色五月在线观看| 高清无码.com| 色一情一乱一伦一区二区三区| 色色99色色| 五月天激情国产综合婷婷婷| 手机AVAV天堂看网| 丁香五月婷婷五月基地| 婷香五月激情视频| www.久久久久久久久久久| 婷婷五月天六月丁香| av激情在线| 婷婷六月啪啪| 天天色综合色色色色色。| 久久99国产综合精品免费| 99这里有精品免费| 婷婷无五月无码视频| 日本成人噜噜噜噜噜| 另类丁香五月天区图| 天天做 天天爱| 五月色丁香婷婷综合| 色色色99| 五月丁香999| 人人爱人人草| 美女亚洲五月丁香| 五月天色小说| 久久久久99精品成人片| 9久热在线精品| 欧美激情VA永久在线播放| 视频在线免费观看欧洲乱码| 99热综合网| 色呦呦美女| 五月激情站| 五月丁香成人| 久久婷中文字幕| 欧美色婷婷| 俺五月| 91精品久| 色五月在线观看| 怡红院院久久| 久9免费视频| 色噜噜狠狠色综无码久久合欧美| 涩涩婷婷五月| 九九精品综合| 国产做爰视频免费播放| 婷婷激情图片| 色五月丁香六月资源站| 桃色成人网| 综合丁香婷婷五月天| 激情综合网激情五月丁香五月俺也去| 91操片| 久久婷婷五月综合色播| 五月丁香六月婷婷成人| 亚洲成人无码专区| 久久婷婷综合基地| 伊人天天色| 91精产一区三区免费观看| 丁香五月婷婷色情综合| WwW天天干| 涩五月丝袜婷婷| 99热这里只有精彩| 丁香婷婷色五月天| 日本啪啪天堂| 天天揷综合网| 99玖玖在线视频| 色综合播放| 欧美黄色一级| 五月丁香婷婷综合久久| 久久婷婷五月综合激情国产| av成人在线播放| 99亚州综合精品成人网| 99热这里只有精品3| 亚洲免费看片| 九九成人电影婷婷| PORNY九色9l自拍视频成人| 九九色99| 久久久999精品| 久久婷婷一级片| 五月天色婷婷综合| 激情小说婷婷五月| 这里只有精品日韩| 啪啪黄页网| 99色人| 久久婷婷色| 射久久丁香五月| 久热只有这里精品| 日韩人妻无码一区二区| 久婷婷色| 在线播放成人| 人妻丰满精品一区二区A片| 九九综合伊人| 激情五月,激情综合网| 草美女在线观看视频在线播放 | 久久丁香综合精品综合| 亚洲国产无线乱码在线观看| 级情九色| 婷婷婷婷色| 五月天婷婷色播在线网| WWW夜夜| 激情五月综合网最新| 亚洲超碰中文字幕| 7EzOBIhNq85TO| 九九伊人网| 成人精品在线| 婷婷五月天成人| 九九热国产| 九九热九九| www91色网站| 这里只有精品久久| 久久大香蕉| 色婷婷偷拍| 思思热视频| 丁香六月av| ay2区| 久久婷婷热| 婷婷97碰碰| 婷婷大乡焦噜噜| 色色网91| 综合 蜜月 婷婷| 香蕉久操| 影音先锋五月婷婷| 欧美激情五月天| 久久综合五月天| 色色婷婷丁香| 亚洲综合在线视频| 天天爽天天| 99热精品在线| 精品一二三区久久AAA片| 久色| 色五月激情综合网| 五月天激情小说| 丁香五月婷婷色| 91精品综合久久久久久五月丁香| 婷婷午夜| 亚洲亚洲人成综合网络| 九九九九精品精| 狠狠爱青青草| 免费日本aⅴ中文字幕| 影音先锋 萱萱| 中文字幕视频色婷婷| 人妻第九页| 大香蕉色婷婷伊人在线| 岛囯综合激情网| 男人的天堂在线婷婷| 丁香五月婷婷www..com| 在线观看欧美3区| 久久五月天激情婷婷| 五月丁香趴趴| 精品久久9| 久久精典| 激情com| 婷婷丁香六月影视| 日韩精品色| 天天狠狠干| 激情网婷婷五月天| 91精品久久久久| 丁香五月久久| 女同在线9| 九月av在线| 色一情一乱一乱一区9| 91丨九色丨熟女| 天天爽在线视频| 婷婷性爱影院| 天天在线久久综合| 婷婷五月天在线观看第二页| 国产日韩欧美性爱| 婷婷五月天小说网| 久久精品凹凸分类| 五月天AV大香蕉| 五月天激情图片| 综合99在线| 婷婷五月免费观看| 色婷婷视频在线| 99九九综合久久九九| 国产亚洲色婷婷久久99精品91| 97干干干丁香| 91丨九色丨老农村| 婷婷久久欧美| 久热这里只有精品在线| 亚洲另类婷婷综合| 久久精品国产精品| www狠狠com| 《诡秘之主》在线观看| 天天天天天久久久久久| 日韩在线视频网站| 免费视频WWW在线观看网站| 亚洲成av人影院| 日韩熟女啪啪视频| 色婷婷五月色| 天天天天天操| 九九视频在线免费视频| 99热首页| 91欧美| 人人操婷婷| 丁香六月啪| 五月婷免费视频久久久| 九九视频在线观看| 99综合网| 毛片九九九九九九| aaa丁香五月天| AV天堂婷婷五月天| 9l视频自拍九色9l视频自拍九色9l社区| 九月婷婷| 91热视频| 成人短视频在线| 久久99热精品a片在线观看| 激情网五月| 韩国真做片在线观看| 少妇伦子伦精品无吗| 四色五月视频| 极品 少妇 内射| 久久大香蕉同僚| 超碰人人摸人人操| 婷婷五月天丁香| 99热在线这里| 丁香五月婷婷基地| 99碰网站| 色噜噜婷婷| 79精品视频在线观看,| 午夜福利成人AV91| 五月婷婷六月丁香激情综合网| 天天插天天爱| 国色天香成人网| 99干99| 天天成人综合视频| 亭亭玉月丁香| 日韩日比视频| 五月天伊人手机在线播放AV| 99久.| 婷婷色色宗合网| 婷婷久久国产视频| 色五月综合网| 六月丁香婷婷色狠狠久久| 深爱五月亚洲| 天天拍天天操| 九九激情综合| 99久久极情精品一区| 国产成人精品一区二区三区视频 | 三级三久久线久久99久目本WW| 另类综合网| 色色国产| 色之综合网| 九九精品99| 99爱爱网| 99思思| 噜噜在线| www色色色com| 99这里有精品视频| 婷五月天六| 97色伦另类图片小说视频 | 色情婷婷| 五月婷婷婷丁香播| 五月丁香婷婷钟和色图| 狠狠色婷婷7| 99色综合| 久久久99视频| 婷婷在线综合| 大香线蕉伊人| 99热综合| 激情五月天99色| 婷婷色五月丁香六月欧美啪| 在线观看视频1区| 狠狠狠激情网| 中文字幕在线免费看线人| 色天天综合天天综合频道。 | 99精品综合视频| 国产亚洲色婷婷久久99精品9j| 丁香五月婷婷欧美成人色图| 久久一级AV| 天天综合图片| 超喷97免费在线视频| 婷婷色五月亚洲| 五月综合久久| 五月天免费色| 欧美一级色| 99丁香五月婷| 熟妇无码乱子成人精品| 婷婷五月天无码视频| 国产亚洲在线| 天天粽合合合合| 欧美叉叉叉BBB网站| 5月丁香婷婷| 亚洲视频在线观看| 婷婷成人小说综合| 婷婷综合在线网| 色综合久久88色综合天天| 五月婷婷婷色| 亚洲亚洲永久无码777777| 丁香五月色色婷| 国产精品人人妻人人爽| 在线成人国产| 日本色视| 《久久综合九色综合97婷婷| 五月丁香六月激情在线| 狠狠99| 97资源欧美日韩大香蕉超碰一区| 黄色五月婷婷| 超碰久热| 婷婷久久五月| 日本V在线观看不卡视频网站| 婷婷开心激情综合五月天| 色啪久| 激情丁香五月婷婷啪啪| 热婷婷av| 成人在线综合| 婷婷五月天最新综合你懂的| 欧美性生交XXXXX无码小说| 丁香涩涩五月天| 91碰免费视频| 激情综合网激情五月天| 激情久久久久久久久| 91超级碰碰| 久久久久综合激动五月天| 色噜噜狠狠色综无码久久合欧美| 6月丁香婷婷激情| 精品一二三区久久AAA片 | 九九热在线观看6| 二色av| 永久地址 色| 字母不卡码人逼| www.久久爱.com| 五月天激情综合网俺也去| 无码AV久久久久久久久| 综合五月丁香六月婷婷| 久久多色| 精品一二三区久久AAA片| www.狠狠艹| 狠狠香蕉| 国产一二区爆乳_1国产日韩一区二区三-成人AV | 极品人妻VideOssS人妻| 精品一区二区三区木瓜| 婷婷丁香五月社区亚洲| 伊人五月婷婷| 妻久久久久| 丁香五月成人| 丁香五月天天日| 亚洲综合色成丁香五月色| 国产精品日韩十五区| 久9无码视频| 五月婷婷六月丁香| 天天爽综合| 在线不卡中文字幕| 久9视频| 欧美激情综合色丁香婷婷五月天| 先锋男人91资源| 天天干天天操天天拍| 99成人无码| 色婷婷狠| 变态 另类 在线 | 亚洲爆乳无码精品AAA片蜜桃| 丁香五月中文字幕久色| 国产精品人妻欲求不满| 大香蕉久久视频久久视频| 激情综合色婷婷啪啪六月天| 六月婷五月丁香| 婷婷综合九月| 国产精产国品一二三在观看| 2025天天日爽| 五月丁香在线国产| 久9精品视频| 777精品久无码人妻蜜桃| site:pnnrt.com| 欧美狠狠草| 密视AV综合在线| 思思热视频在线| 人人干人人操人人摸| 综合婷婷六月| 久re热视频| 日韩av手机在线观看| 秋霞成人毛片一级A片| 天天成人丁香美女AV| 九九热超碰| 婷婷自拍| 丁香五月花影院| 99热地址| 五月天婷婷在线视频| 丁香五月激情澎湃一区| 91久操| 99九精品| 9九九久久精品无码专区| 久久综合五月| 99色精品| 色狠狠色综合| AV五月丁香| 色色色欧美| 色噜久| 极品人妻VIDEOSSS人妻| 五月天丁香网| 久久人妻精品| 99热这里只有在线| 激情开心五月婷婷| 午夜天堂啪啪| 1024操逼视频| 久久99免费视屏| 99色综合| 五月丁香福利| 天天综合精品| 六月丁香激情综合| 天干天天干天天天天天| 九九色中文| 婷婷伊人综合中文字幕| 丁香五月www| 1级欧美日韩| www.色五月| 99久久婷婷国产综合| 人人人舔人人人操人人人摸人人人97| 99热偷拍| 人妻激情视频| 色婷五月| 日韩色五月| 六月丁香五月婷婷| 91人人爽久久涩噜噜噜| 开心五月色婷婷综合开心网| 天天狠狠插| 日本三级日本三级99| 激情色情五月天| 国产干逼片| 九九婷婷激情综合网| 精品亚洲国产成AV人片传媒| 99热久久这里只有精品| 99热在线观看| 色色五月婷| 丁香网五月天激情| 五月婷婷五月天天| 色色色综合视频| 五月天丁香六月综合| 婷婷四色五月| 色婷婷免费观看| 91视频五月丁香| 熟女啪啪视频| 91婷婷五月丁香碰| 欧美大道不卡| 国内一级精品| 99九九在线观看免费| 国产激情av| 五月婷婷七月丁香| www.日韩国产| 丁香六月激情| 国产精品久久..4399| 亚洲综合视频在线| 91日韩在线| 五月婷婷黄色| ss五月天激情| 久久99激情| 99视频在线观看视频| 五月色婷婷影院| 9.1综合网| 日韩精品视频中文字幕| 大香蕉久久婷婷| 色色九九五月天 | 99热这里只有精品50| 新97人人上人人| 超碰99热精品| 婷婷无码五月天| 日日日日日| 色色色婷婷五月天| 婷婷丁香人妻天天爽| 99激情视频| 婷婷情色开心五月天99| 五月婷护士| 久热9热| 97亚洲婷婷| 这里只有精品视频222| 日韩成人无码人妻| 99色综合网| 六月婷婷狠狠| 婷婷丁香五月精品| 九九热视频免费| 色婷婷亚洲六月婷婷中文字幕| 色爽九九| 99这里只有精品| 久草丁香婷婷1024| 久久久久久久久久久44| 国产精品电影| 日日想日日夜日日操| 亚洲天堂aaa| 久超超碰| 99亚洲天堂| 亚州成人综合在线| 久久精品五月天| 午夜理论片最新午夜理论剧| 97人人草| 开心久久xxx色| 色人妻五月| 99热99极品观看| 91精品久久久久久综合五月天| 九九九激情网| 综合网网欲色| 五月丁香啪啪网| 色婷婷丁香特级性爱视频| 亚洲日日日| 国产在这里只有精品| 久777| 五月天婷婷免费| 激情六月五月婷婷综合网| 色狠狠色噜噜AV天堂五区消防| 超碰爱爱爱| 五月婷婷之综合激情| 综合狠久久| 婷婷五月丁香啪啪| 亚洲人妻一区二区 | 婷婷五月天电影在线| 色婷婷狠| .青娱乐天天操B| 99狠狠色| 人人摸人人射| 久久伦乱| 国产精品18久久久| 婷婷丁香五月91| 丁香月五月天婷婷久久| 五月丁香六月婷婷激情视频在线观看免费| 激情久久久| 亚洲人成播放网站| 伊人久久五月天| 激情综合色| 91色久| 婷婷的五月天另类视频| 成人国产综合| 深爱五月最新网址| 五月丁香六月欧美综合网站| 欧美高潮9| 午夜一区| 中文乱子伦视频| 亚洲色啪| www.97干视频| 深爱丁香激情| 99热精品在线播放| 色婷婷无吗| 色五月久久成人婷婷| 91热视频色网站| 亚洲婷婷性爱| 婷婷六月激情小说网| 五月婷深深爱激情网| 97人人操| 97超级碰| 五月天激情影院| 丁香五月婷婷激情中文| 97热视频| 天天激情站| 婷婷五月天成人| 久久A V无码视频| 色五月av| 99久久99九九九99九他书对| 青草青青草| 任你躁XXXXX麻豆精品| 9精品视频在线| 久久性爰视频这里只有精品| 天天草天天爽| 色婷婷激情| 五月天另类视频| 久久艹 五月天| 综合五月天亚洲婷婷| 色狠狠综合网| 91精品久| 亚洲五月天伊人| www.婷婷五月| 色色色综合色| 成人电影AV在线观看| 97色色在线视频| 超碰在线观看三级片| 五月色丁香综合| 色播婷婷大香蕉| 丁香婷婷综合影院| 这里只有精品99视频| 国产激情久久| www.jiujiujiu| 色噜噜狠狠一区二区三区| 色五月,com| 人人干人人操人人摸人人做| 久久九九色| 激情丁香婷婷| 五月天 无码| 91丁香色五月| 一级A片天天操夜夜操| 99热66| 97碰久久| 99久视频| 色婷婷小视频| wwccc久久久| 99这里只有精品| 久热伊人| 亚洲在线综合| 国产婷婷五月天| 色婷婷精品视频| 婷婷97C| 久热视频这里只有精品| 搡BBBB搡BBB搡五十| 天天爽夜夜爽夜夜爽精品| 久热超碰91| 丁香五月激情啪啪啪| 天天爽综合网| 99视频综合网| 激情婷婷五月天日本系列 | 狼人婷婷综合| 99色五月| www.狠狠操| 五月天婷婷色情| 欧美成人日韩| 啪啪六月婷婷| 色色五月天丁香婷婷| 九九九九九九综合| 九九精品视频在线观看| 九九婷婷激情综合网| 五月涩涩网| www超碰com| 婷婷五月综合体验看| 五月丁香色色| 五月激情偷拍| 色。 日日日| 五月婷婷很很色| 人人摸人人干人人做| 激情五月天99色| 玖玖婷婷五月天| 色玖玖综合| 五月天伊人网| 99久久综合网| 久久99人人| 色小说五月天| 99久久婷| 激情丁香五月| 99热这里只有精品96| 色图亚洲91| 日本婷婷色日| 超碰人人操| 久久草大香蕉| 亚洲成色综合网站免费观看| 激情综合婷婷| 另类国产综合| 五月丁香日逼| 色五月色图| 婷婷五月天最新综合你懂的| 丁香五月成人| 五月婷婷开心亚州在线| 色婷婷文字幕| 91美女被操| 色综久久久| av操B网站| 夜色综合网| 国产激情久久久| 熟女人妻一区二区三区免费看| 五月婷婷丁香av| 婷婷五月天精品| 久久久性爱视频| 丁香网五月网| 日韩无码人妻一区二区| AV大香蕉| 99惹精品视频| 婷婷色五月大香蕉在线观看| 91超级碰碰碰| 婷婷 久综合| 射满了还射免费在线观看 -午夜版全集-新视觉影院 | 久久色天堂| 国产精产国品一二三在观看| 精品成人a v无码内射| 五月天婷婷av| 色婷婷成人做爰A片免费看网站| 五月天综合影院| 久操激情| 五月婷婷大香蕉| 久草xx性爱视频| 91大神操美女| 亚洲妇女熟BBW| 丁香五月伊人| WWW丁香五月| 大胆伊人久久| 婷婷精品视频| 人人妻久久妻| 淫荡家庭AV| 男人的天堂在线婷婷| 婷婷五月丁香五月| 开心五月天激情| 色婷婷六月天| 《亚洲操B久久免费在线观看,亚洲操B久久在线播放》在线播放 - 高清资源 - 97 | 无码啪啪| 97很鲁在线视频| 综合啪啪| 99热这里有精力| 精品婷婷五月天| 丁香五月天婷婷91| 婷婷五月激情黄色| 99久久九九| 情婷婷五月天| 天天爽夜夜爽夜夜爽精| 色久影院| a毛片二逼wwwwwwwwww| 色色色色网站| 狠狠色97| 精品无码99| 丁香五月色色色色| 99久久新视频| 丁香五月婷婷国产av| www.激情| 天天肏高清在线| 久久五月婷天天干| se99高清无码| 97操碰视频| 久久久潮喷-久久久九九-成人AV| 久久久久久人妻| 色色丁香婷婷综合| 婷婷射婷婷舔| 激情五月天色| 九九热av| 超碰97干|