日韩精品一区二区三区在线视频放-无码中文字幕V?一区二区-成年片免费观看视频-国内少妇人妻丰满av-国产精品中文字幕免费观看-亚洲成人久久一区二区三区-国内少妇偷人精品视频无缓冲-一区二区国产精品日本一区二区三区在线网

ARTICLE DETAIL

資訊詳情

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

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

基于Matlab的固定翼無人機(jī)六自由度建模與視覺路徑規(guī)劃仿真實(shí)踐 簡介本資源是一套面向高校自動(dòng)化、航空航天及控制工程專業(yè)學(xué)生的Matlab小型固定翼無人機(jī)建模與仿真完整實(shí)踐方案聚焦飛行動(dòng)力學(xué)建模、實(shí)時(shí)圖像顯示與多策略路徑規(guī)劃三大核心能力訓(xùn)練。壓縮包共34個(gè)文件含28個(gè).m主控與算法腳本如dubinsParameters、planRRTDubins、autopilot等、3個(gè)Simulink系統(tǒng)模型文件mavsim.slx等用于動(dòng)力學(xué)與控制閉環(huán)仿真、2幅環(huán)境/傳感器圖像predator.jpg、batcam.png及1張說明圖整體僅540KB輕量易部署。已有1086人學(xué)習(xí)下載資源結(jié)構(gòu)清晰從參數(shù)配置param.m、氣動(dòng)建模forces_moments.m、狀態(tài)估計(jì)estimate_states.m到路徑生成planCoverRRTDubins.m、航跡跟蹤path_follow.m及可視化drawEnvironment.m、drawPathError.m全覆蓋所有模塊均可獨(dú)立運(yùn)行或協(xié)同調(diào)試配套注釋詳實(shí)是理解固定翼無人機(jī)自主飛行系統(tǒng)設(shè)計(jì)與驗(yàn)證的理想入門級工程范例。1. 項(xiàng)目緣起從零開始構(gòu)建一個(gè)“看得見”的無人機(jī)仿真世界幾年前當(dāng)我第一次接觸無人機(jī)項(xiàng)目時(shí)面對的是一堆冰冷的代碼和一堆抽象的數(shù)學(xué)公式??刂破髡{(diào)參像是在黑箱里摸索飛行動(dòng)力學(xué)模型是否準(zhǔn)確只能等真機(jī)試飛時(shí)才能驗(yàn)證成本高、風(fēng)險(xiǎn)大。那時(shí)候我就在想如果能有一個(gè)“數(shù)字孿生”的沙盤在電腦里就能把飛機(jī)飛起來看到它的姿態(tài)、軌跡甚至模擬它“眼中”的世界那該多好。這就是我動(dòng)手搭建這個(gè)Matlab小型固定翼無人機(jī)建模與仿真程序的初衷。這個(gè)程序遠(yuǎn)不止是一個(gè)簡單的動(dòng)力學(xué)模型。它的核心價(jià)值在于構(gòu)建了一個(gè)從“物理內(nèi)核”到“視覺感知”再到“智能決策”的完整閉環(huán)仿真環(huán)境。你不僅能看到無人機(jī)按照六自由度方程在空中飛行還能通過一個(gè)虛擬的“機(jī)載攝像頭”觀察地面并讓無人機(jī)基于這些圖像信息或預(yù)設(shè)地圖自主規(guī)劃出一條從A點(diǎn)到B點(diǎn)的最優(yōu)或可行路徑。對于學(xué)生來說它是理解無人機(jī)原理、學(xué)習(xí)控制算法和路徑規(guī)劃理論的絕佳實(shí)驗(yàn)平臺對于工程師它可以作為算法前期驗(yàn)證、降低實(shí)物試錯(cuò)成本的得力工具對于研究者它提供了一個(gè)高度可定制、模塊化的框架便于快速實(shí)現(xiàn)和測試新的想法。整個(gè)項(xiàng)目完全基于Matlab/Simulink環(huán)境構(gòu)建充分利用了其強(qiáng)大的數(shù)值計(jì)算、圖形顯示和工具箱生態(tài)。下面我將毫無保留地拆解這個(gè)系統(tǒng)的每一個(gè)模塊分享從建模、仿真到集成的完整過程以及那些在文檔里找不到的“踩坑”經(jīng)驗(yàn)。2. 基石小型固定翼無人機(jī)的六自由度非線性動(dòng)力學(xué)建模仿真系統(tǒng)的靈魂在于模型。一個(gè)失真的模型無論后續(xù)的控制器和規(guī)劃器多精妙得出的結(jié)論都可能是空中樓閣。對于固定翼無人機(jī)我們必須建立其六自由度6-DoF非線性動(dòng)力學(xué)模型這包括了在三維空間中的三個(gè)平移自由度和三個(gè)旋轉(zhuǎn)自由度。2.1 坐標(biāo)系定義與轉(zhuǎn)換一切計(jì)算的起點(diǎn)建模的第一步是明確坐標(biāo)系。這里主要涉及兩個(gè)機(jī)體坐標(biāo)系Body Frame, B-frame和地面慣性坐標(biāo)系Earth Frame, E-frame通常為NED北-東-地。機(jī)體坐標(biāo)系 (B-frame): 原點(diǎn)在無人機(jī)質(zhì)心。X軸指向機(jī)頭Y軸指向右翼Z軸根據(jù)右手定則指向機(jī)身下方。在這個(gè)坐標(biāo)系下我們定義無人機(jī)的線速度[u, v, w]對應(yīng)X,Y,Z軸速度和角速度[p, q, r]滾轉(zhuǎn)、俯仰、偏航角速度。地面慣性坐標(biāo)系 (E-frame): 這是我們觀察無人機(jī)運(yùn)動(dòng)的全局坐標(biāo)系。通常采用北-東-地NED約定。無人機(jī)的位置[X_n, Y_e, Z_d]和姿態(tài)歐拉角滾轉(zhuǎn)角 Φ俯仰角 Θ偏航角 Ψ都是在這個(gè)坐標(biāo)系下描述的。兩者之間的轉(zhuǎn)換至關(guān)重要。線速度通過方向余弦矩陣DCM或旋轉(zhuǎn)矩陣進(jìn)行轉(zhuǎn)換。而角速度與歐拉角變化率之間的關(guān)系則由一個(gè)非線性微分方程描述其中包含著名的“歐拉角奇異點(diǎn)”當(dāng)俯仰角Θ±90°時(shí)。在仿真中我選擇了四元數(shù)來表示姿態(tài)它沒有奇異點(diǎn)計(jì)算也更高效最后再轉(zhuǎn)換為歐拉角用于顯示和理解。注意很多初學(xué)者會(huì)直接使用Simulink Aerospace Blockset里的“6DOF (Euler Angles)”模塊這很方便但要小心它的奇異點(diǎn)問題。對于可能做大機(jī)動(dòng)如特技飛行的仿真強(qiáng)烈建議使用“6DOF (Quaternion)”模塊或者自己用四元數(shù)實(shí)現(xiàn)姿態(tài)更新。2.2 力與力矩的構(gòu)成氣動(dòng)、重力、推力作用在無人機(jī)上的合外力與合力矩決定了其運(yùn)動(dòng)狀態(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ā)動(dòng)機(jī)產(chǎn)生。假設(shè)推力沿機(jī)體X軸方向其大小通常建模為油門指令δ_t的函數(shù)例如T T_max * δ_t線性模型或更復(fù)雜的包含空速影響的模型。推力作用點(diǎn)如果不在質(zhì)心還會(huì)產(chǎn)生俯仰力矩。氣動(dòng)力與力矩: 這是最復(fù)雜也最核心的部分。它們?nèi)Q于無人機(jī)的氣動(dòng)外形、飛行狀態(tài)空速、迎角、側(cè)滑角和控制面偏轉(zhuǎn)。迎角 (α)和側(cè)滑角 (β)這是連接機(jī)體速度與氣動(dòng)力的關(guān)鍵橋梁。α arctan(w/u),β arcsin(v/V)其中V sqrt(u^2v^2w^2)為空速。氣動(dòng)系數(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òng)導(dǎo)數(shù)可以通過計(jì)算流體力學(xué)CFD或風(fēng)洞試驗(yàn)獲得對于學(xué)習(xí)目的也可以參考公開的模型如Aerosonde UAV數(shù)據(jù)。對于非線性較強(qiáng)的區(qū)域則使用基于α, β等參數(shù)預(yù)計(jì)算好的多維查表Lookup Table。在我的實(shí)現(xiàn)中我將氣動(dòng)力計(jì)算封裝成了一個(gè)獨(dú)立的Matlab函數(shù)模塊。輸入是當(dāng)前狀態(tài)u,v,w, p,q,r, 控制面偏角和氣動(dòng)參數(shù)輸出是機(jī)體坐標(biāo)系下的三個(gè)氣動(dòng)力X_a, Y_a, Z_a和三個(gè)氣動(dòng)力矩L, M, N。這樣在Simulink中調(diào)用非常清晰。% 示例簡化的氣動(dòng)力計(jì)算函數(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、平均氣動(dòng)弦長c_bar、氣動(dòng)導(dǎo)數(shù)等 V norm(state(1:3)); % 空速 alpha atan2(state(3), state(1)); % 迎角 beta asin(state(2) / V); % 側(cè)滑角注意V0時(shí)的處理 % 1. 計(jì)算氣動(dòng)系數(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ì)算氣動(dòng)力與力矩在機(jī)體軸系 Q 0.5 * aero_params.rho * V^2 * aero_params.S; % 動(dòng)壓 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 運(yùn)動(dòng)方程集成與Simulink實(shí)現(xiàn)有了力與力矩我們就可以根據(jù)牛頓-歐拉方程寫出完整的6-DoF運(yùn)動(dòng)方程。在Simulink中我采用“基于模型設(shè)計(jì)”的思路使用基本的數(shù)學(xué)運(yùn)算模塊加、乘、積分和函數(shù)調(diào)用模塊如上述氣動(dòng)力函數(shù)來搭建模型而不是完全依賴現(xiàn)成的6DOF模塊。這樣做的好處是模型完全透明便于調(diào)試和修改。核心的積分環(huán)路是這樣的上一時(shí)刻的狀態(tài)位置、速度、姿態(tài)、角速度 - 計(jì)算當(dāng)前所受合外力/力矩 - 通過運(yùn)動(dòng)微分方程 - 得到狀態(tài)變量的導(dǎo)數(shù) - 經(jīng)過積分器 - 更新為當(dāng)前時(shí)刻的狀態(tài)。這個(gè)環(huán)路由Simulink的求解器自動(dòng)推進(jìn)。實(shí)操心得仿真步長的選擇至關(guān)重要。對于固定翼無人機(jī)動(dòng)力學(xué)其模態(tài)頻率較高如短周期模態(tài)需要較小的步長才能準(zhǔn)確捕捉。我通常從0.01秒開始嘗試。使用變步長求解器如ode45可以兼顧精度和速度但在有離散控制器或規(guī)劃器時(shí)固定步長如ode4即四階龍格庫塔更穩(wěn)定。務(wù)必在仿真后檢查狀態(tài)量的變化是否平滑有無異常的數(shù)值振蕩。3. 讓無人機(jī)“看見”三維可視化與虛擬相機(jī)圖像生成一個(gè)只有數(shù)據(jù)曲線的仿真是枯燥且不直觀的。讓無人機(jī)“看見”是連接物理模型與高層智能路徑規(guī)劃的關(guān)鍵橋梁也是驗(yàn)證感知算法的基礎(chǔ)。3.1 基于MATLAB Robotics System Toolbox的三維場景搭建我選擇使用MATLAB的Robotics System Toolbox來創(chuàng)建三維環(huán)境。它提供了robotics.OccupancyGrid用于二維路徑規(guī)劃和robotics.VectorFieldHistogram等工具但其三維可視化能力更適合我們構(gòu)建一個(gè)簡單的虛擬世界。首先創(chuàng)建一個(gè)三維的axes對象并設(shè)置好視角和光照。然后用基本的圖形對象patch,surf,plot3來繪制地形、障礙物和無人機(jī)模型。地形可以用meshgrid生成網(wǎng)格點(diǎn)再通過一個(gè)函數(shù)如peaks或自定義的高度圖賦予Z值最后用surf繪制。為了增加真實(shí)感可以根據(jù)高度映射不同的顏色。無人機(jī)模型為了可視化姿態(tài)我們不能只畫一個(gè)點(diǎn)。我創(chuàng)建了一個(gè)簡單的三維“飛機(jī)”圖形由幾個(gè)patch對象組成機(jī)身、機(jī)翼、尾翼。這個(gè)圖形對象的頂點(diǎn)坐標(biāo)定義在機(jī)體坐標(biāo)系下。在每一幀更新時(shí)根據(jù)無人機(jī)當(dāng)前的位置X_n, Y_e, Z_d和姿態(tài)旋轉(zhuǎn)矩陣R將機(jī)體坐標(biāo)系下的頂點(diǎn)坐標(biāo)變換到地面坐標(biāo)系V_earth pos (R * V_body)然后更新patch對象的Vertices屬性。軌跡用一個(gè)plot3對象來實(shí)時(shí)繪制無人機(jī)質(zhì)心的歷史位置形成飛過的軌跡線。3.2 模擬機(jī)載攝像頭與圖像生成這是項(xiàng)目的亮點(diǎn)之一。我們不僅要從第三人稱視角看無人機(jī)還要模擬第一人稱的機(jī)載視圖。思路是在三維場景中我們放置一個(gè)虛擬的相機(jī)其位置和朝向與無人機(jī)綁定比如安裝在機(jī)頭下方。然后獲取這個(gè)相機(jī)視角下的“快照”生成一幅圖像。相機(jī)參數(shù)標(biāo)定在MATLAB中我們可以用cameraIntrinsics對象來定義相機(jī)的內(nèi)參焦距、主點(diǎn)、畸變。對于仿真我們可以假設(shè)一個(gè)理想的針孔相機(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í)時(shí)圖像生成設(shè)計(jì)。我探索了兩種方法方法A使用getframe和vision.AlphaBlender簡易但慢將三維axes的CameraPosition和CameraTarget設(shè)置為虛擬相機(jī)的位置和看向的點(diǎn)然后使用getframe(gca)捕獲當(dāng)前視圖作為圖像。但這種方法捕獲的是整個(gè)圖形窗口包含坐標(biāo)軸等需要裁剪且?guī)屎艿?。方法B使用pcplayer與自定義投影推薦更接近真實(shí)創(chuàng)建一個(gè)點(diǎn)云播放器pcplayer但將其用于顯示我們自定義的三維場景點(diǎn)云。首先將地形和障礙物的表面點(diǎn)采樣為點(diǎn)云。然后在每一仿真步根據(jù)無人機(jī)和相機(jī)姿態(tài)計(jì)算這些點(diǎn)在該相機(jī)視角下的投影坐標(biāo)。利用相機(jī)內(nèi)參將三維點(diǎn)投影到二維圖像平面。最后根據(jù)深度進(jìn)行簡單的可見性判斷如Z-buffer生成一幅“深度圖”或“特征圖”。雖然這不是真實(shí)的光照渲染圖像但對于許多路徑規(guī)劃算法如基于特征的視覺導(dǎo)航、障礙物檢測來說這種二維投影信息已經(jīng)足夠。我最終采用了方法B的變種。我創(chuàng)建了一個(gè)簡化的三維網(wǎng)格地圖占用網(wǎng)格每個(gè)網(wǎng)格單元有一個(gè)屬性如空地、障礙物、目標(biāo)點(diǎn)。虛擬相機(jī)的任務(wù)就是“看到”前方一定錐形范圍內(nèi)的網(wǎng)格并將其渲染成一張從上往下的二維俯視圖類似于一個(gè)高度壓縮的二維激光雷達(dá)掃描圖這非常適合用于后續(xù)的局部路徑規(guī)劃。踩坑實(shí)錄最初我試圖用getframe實(shí)現(xiàn)實(shí)時(shí)圖像流仿真速度立刻從實(shí)時(shí)降到了十分之一。原因是getframe和圖形重繪開銷巨大。教訓(xùn)是在仿真中視覺模塊的“逼真度”需要與“效率”權(quán)衡。除非專門研究圖像處理算法否則用簡化的幾何投影來提供必要的環(huán)境信息往往是更高效的選擇。將圖像更新頻率設(shè)置為比動(dòng)力學(xué)仿真步長低一個(gè)數(shù)量級如動(dòng)力學(xué)步長0.01s圖像更新0.1s也能顯著提升性能。4. 大腦從全局到局部的路徑規(guī)劃算法集成有了能“飛”的模型和能“看”的眼睛最后一步就是為無人機(jī)裝上“大腦”讓它能自主規(guī)劃路徑。我的程序集成了兩層規(guī)劃基于已知地圖的全局路徑規(guī)劃和基于機(jī)載“視覺”的局部實(shí)時(shí)避障。4.1 全局路徑規(guī)劃A*算法在三維空間的應(yīng)用全局規(guī)劃假設(shè)我們擁有一張先驗(yàn)的二維或二維半地圖即每個(gè)XY位置有高度或通行代價(jià)。我選擇了經(jīng)典的A*A-Star算法因?yàn)樗诰W(wǎng)格地圖上非常高效且能保證找到最優(yōu)路徑如果存在。地圖表示使用一個(gè)二維矩陣map表示全局代價(jià)地圖。值0代表可通行空地1代表障礙物也可以使用0~1之間的值表示不同地形的通行代價(jià)如草地、水域。節(jié)點(diǎn)與啟發(fā)函數(shù)將地圖網(wǎng)格化每個(gè)網(wǎng)格中心是一個(gè)節(jié)點(diǎn)。A*算法需要定義移動(dòng)代價(jià)g(n)和啟發(fā)函數(shù)h(n)。對于無人機(jī)我通常允許八方向移動(dòng)包括對角對角移動(dòng)代價(jià)設(shè)為sqrt(2)。啟發(fā)函數(shù)使用歐幾里得距離或曼哈頓距離。為了考慮高度可以將節(jié)點(diǎn)擴(kuò)展為三維(x, y, z)但搜索復(fù)雜度會(huì)立方增長。一個(gè)折中方法是在二維XY平面上規(guī)劃但將高度變化爬升/下降的代價(jià)融入到g(n)中例如增加一個(gè)與高度差成正比的懲罰項(xiàng)這樣規(guī)劃出的路徑會(huì)傾向于選擇平緩的路線。MATLAB實(shí)現(xiàn)雖然MATLAB沒有內(nèi)置的A*函數(shù)但實(shí)現(xiàn)起來很直接。需要維護(hù)openSet和closedSet以及每個(gè)節(jié)點(diǎn)的gScore,fScore和parent。MATLAB的矩陣操作優(yōu)化能讓代碼比較簡潔。規(guī)劃出的路徑是一系列連續(xù)的網(wǎng)格坐標(biāo)點(diǎn)(x_i, y_i)。% 簡化版A*算法核心框架偽代碼 function path aStar(start, goal, map) [rows, cols] size(map); openSet priorityQueue(); % 需要實(shí)現(xiàn)一個(gè)優(yōu)先隊(duì)列按fScore排序 gScore inf(rows, cols); fScore inf(rows, cols); cameFrom cell(rows, cols); % 記錄父節(jié)點(diǎn) 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é)點(diǎn) if isequal(current, goal) path reconstructPath(cameFrom, current); return; end neighbors getNeighbors(current, map); % 獲取8鄰域可通行節(jié)點(diǎn) 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 局部實(shí)時(shí)避障人工勢場法APF的快速響應(yīng)全局路徑給出了一個(gè)粗略的參考但無人機(jī)飛行中可能會(huì)遇到未預(yù)料的障礙物動(dòng)態(tài)障礙或地圖誤差。這就需要局部實(shí)時(shí)規(guī)劃。我選擇了人工勢場法Artificial Potential Field因?yàn)樗?jì)算量小適合在線運(yùn)行。其核心思想是為目標(biāo)和障礙物分別構(gòu)造勢場引力場由目標(biāo)點(diǎn)產(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。將這個(gè)合力的方向作為期望的加速度或速度方向輸入給底層的飛行控制器。在我的實(shí)現(xiàn)中局部障礙物信息就來源于第3節(jié)中虛擬相機(jī)生成的二維局部地圖。算法每隔一個(gè)規(guī)劃周期如0.1秒就根據(jù)當(dāng)前位置、全局路徑的下一段子目標(biāo)、以及局部障礙物柵格圖計(jì)算出一個(gè)即時(shí)的期望航向角或橫向加速度指令傳遞給控制器。注意事項(xiàng)人工勢場法有個(gè)著名的問題——局部極小值。當(dāng)引力和斥力平衡時(shí)無人機(jī)可能會(huì)被困在某個(gè)點(diǎn)無法動(dòng)彈。我的解決方法是結(jié)合全局路徑。當(dāng)檢測到無人機(jī)速度持續(xù)低于閾值且未到達(dá)目標(biāo)時(shí)就觸發(fā)一次局部重規(guī)劃或者在勢場函數(shù)中加入一個(gè)“切向力”或“隨機(jī)擾動(dòng)”來幫助逃逸。更魯棒的方法是結(jié)合D* Lite等動(dòng)態(tài)重規(guī)劃算法但計(jì)算開銷會(huì)增大。5. 系統(tǒng)集成與仿真循環(huán)讓一切協(xié)同工作將動(dòng)力學(xué)模型、可視化、圖像生成、路徑規(guī)劃器集成到一個(gè)流暢的仿真循環(huán)中是最后的挑戰(zhàn)。我采用Simulink作為主引擎結(jié)合MATLAB Function塊和S-Function來實(shí)現(xiàn)混合系統(tǒng)仿真。5.1 Simulink模型架構(gòu)整個(gè)系統(tǒng)是一個(gè)典型的“感知-規(guī)劃-控制”閉環(huán)。Plant Model被控對象即第2節(jié)搭建的6-DoF無人機(jī)非線性動(dòng)力學(xué)模型。輸入是控制面偏角[δ_e, δ_a, δ_r]和油門δ_t。輸出是所有狀態(tài)量位置、姿態(tài)、速度等。Flight Controller飛行控制器這是一個(gè)內(nèi)環(huán)控制器負(fù)責(zé)穩(wěn)定無人機(jī)姿態(tài)。我通常設(shè)計(jì)為串級PID控制。外環(huán)位置/高度/航向產(chǎn)生期望的俯仰角、滾轉(zhuǎn)角和空速指令內(nèi)環(huán)姿態(tài)角根據(jù)期望姿態(tài)和當(dāng)前姿態(tài)的偏差計(jì)算出所需的控制面偏轉(zhuǎn)角和油門量。這部分可以用Simulink的PID模塊搭建參數(shù)需要仔細(xì)整定。Path Follower路徑跟蹤器它接收規(guī)劃器給出的路徑點(diǎn)一系列[X, Y, Z]并計(jì)算出當(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ī)劃器這是一個(gè)由觸發(fā)事件或固定周期驅(qū)動(dòng)的模塊。全局規(guī)劃器在仿真開始時(shí)運(yùn)行一次給出全局路徑。局部規(guī)劃器以更高頻率如10Hz運(yùn)行它從Visualization Image Module可視化與圖像模塊獲取當(dāng)前的局部障礙物信息并對全局路徑進(jìn)行微調(diào)或生成緊急避障指令。Visualization Image Module可視化與圖像模塊這是一個(gè)MATLAB Function塊或S-Function在每個(gè)仿真步或每N個(gè)步被調(diào)用。它從Plant Model讀取當(dāng)前無人機(jī)狀態(tài)更新三維動(dòng)畫和虛擬相機(jī)圖像。圖像信息被傳遞給局部規(guī)劃器。5.2 仿真流程與參數(shù)調(diào)試心得啟動(dòng)仿真后流程如下初始化加載無人機(jī)參數(shù)、地圖、設(shè)置初始狀態(tài)。全局規(guī)劃根據(jù)起點(diǎn)和終點(diǎn)運(yùn)行A*算法得到全局路徑點(diǎn)序列。Simulink求解器開始推進(jìn)時(shí)間 a. 動(dòng)力學(xué)模型根據(jù)當(dāng)前控制輸入更新狀態(tài)。 b. 可視化模塊更新3D視圖和虛擬相機(jī)圖像。 c. 在規(guī)劃周期到達(dá)時(shí)局部規(guī)劃器根據(jù)當(dāng)前圖像和位置計(jì)算局部路徑指令。 d. 路徑跟蹤器綜合全局和局部指令生成目標(biāo)狀態(tài)。 e. 飛行控制器根據(jù)目標(biāo)狀態(tài)和當(dāng)前狀態(tài)差計(jì)算新的控制輸入。 f. 控制輸入作用于動(dòng)力學(xué)模型進(jìn)入下一個(gè)仿真步。仿真結(jié)束分析數(shù)據(jù)軌跡跟蹤誤差、控制量變化、圖像序列等。調(diào)試經(jīng)驗(yàn)分享“分而治之”不要試圖一次性集成所有模塊并跑通。我的步驟是先讓動(dòng)力學(xué)模型在開環(huán)下給定固定舵面能飛出一個(gè)合理的軌跡如平飛。然后關(guān)閉環(huán)控制器讓無人機(jī)能穩(wěn)定懸停或跟蹤簡單的指令如階躍高度變化。接著單獨(dú)測試路徑跟蹤器用一條預(yù)設(shè)的直線或圓弧路徑看無人機(jī)能否跟上。再單獨(dú)測試規(guī)劃器輸入一個(gè)簡單地圖看規(guī)劃出的路徑是否合理。最后再把所有模塊像拼圖一樣連接起來。參數(shù)整定順序控制器參數(shù)整定從內(nèi)環(huán)開始。先整定角速率環(huán)p, q, r再整定姿態(tài)環(huán)Φ, Θ, Ψ最后整定外環(huán)位置/速度環(huán)。使用Simulink的PID Tuner工具或手動(dòng)調(diào)整時(shí)觀察階躍響應(yīng)的超調(diào)量、穩(wěn)定時(shí)間和穩(wěn)態(tài)誤差??梢暬菑?qiáng)大的調(diào)試工具當(dāng)無人機(jī)飛行動(dòng)作怪異時(shí)仔細(xì)觀察三維動(dòng)畫。是姿態(tài)劇烈振蕩還是根本朝錯(cuò)誤方向飛結(jié)合繪制出來的狀態(tài)曲線如歐拉角、控制量能快速定位問題是出在控制器、規(guī)劃器還是模型本身。虛擬相機(jī)圖像也能幫你確認(rèn)局部規(guī)劃器“看到”的世界是否和你設(shè)想的一致。性能瓶頸如果仿真速度很慢使用Profiler工具分析耗時(shí)最多的函數(shù)。往往是可視化渲染或規(guī)劃算法尤其是搜索算法占了大頭。對于非關(guān)鍵模塊可以降低其更新頻率。對于A*算法如果地圖很大可以嘗試使用更高效的啟發(fā)函數(shù)如Diagonal distance或者采用跳點(diǎn)搜索JPS等優(yōu)化算法。通過這個(gè)完整的建模與仿真程序你獲得的不再是一個(gè)黑盒工具而是一個(gè)透明、可干預(yù)、可擴(kuò)展的無人機(jī)系統(tǒng)研發(fā)沙盤。它允許你以極低的成本深入理解從底層動(dòng)力學(xué)到高層智能決策的每一個(gè)環(huán)節(jié)并安全、高效地測試你的算法創(chuàng)意。無論是用于教學(xué)、科研還是工程預(yù)研這套框架都提供了一個(gè)堅(jiān)實(shí)的起點(diǎn)。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
五月天婷婷欧美三区| 欧美精品自慰系列寂寞少妇| 操逼视频亚洲| 欧美亚洲丝袜美女电影| 九久9精品| 夜夜草我| 色色色色电影网| 中文字暮97| 久草久日| 国产精品999zyz| 国产黄a三级三级三级av在线看| 97超碰中文| 操逼www.| 亚洲AV无码乱码在线观看性色| 久久人爽| 在线岛| 蜜桃成人1区2区3区| 极品人妻少妇综合| 岛国激情视频在线观看| 亚洲码专区| 欧美后进式| 色欲久久综合| 日韩青久久| 把腿张开老子CAO烂你| 亚洲人在线| 97免费视频在线观看| 激情久久久| 久久久久久久六六| 国产精品一区二区久久精品| a男人的天堂| 久久久久久精| 金典av| 大香蕉视频一二三区| 久草精品国产蜜臀| 插欧洲美女欧美精品| 龙兴卡官方查询| 亚洲最大成人a毛毛片| 91+欧美| 一二三区操逼国产91| 91人人爽人人爽| 丰满少妇一区二区三区免费看| www色婷婷| 日日嗷| 18禁无码永久免费无限制| 99re这里只有精品3| 亚洲无码成人精品| 日韩AV噜噜噜一区二区三区四区| 婷婷综合| 超碰99在线| 五月婷婷AV| 99999国产| 丁香六月天| 97色碰| 操逼内射干逼白丝91| 第四色奇米影视777| 成人AV素股で擦久久| 色操逼网| 天天久久久久久| 26uuu最新| 天天综合影院91| 天天视频综合在线观看视频| 情色大香蕉| 欧美中文字幕男人天堂久久精品| 日韩在线性爱免费视频| 淫纸中9区| 啊啊啊不要好疼视频| 极品销魂美女一区二区| 91l欧美在线| aⅴ日韩成人电影av在线免费看av大全| 亚洲综合在线91| 精品无码久久久| 国产高清午夜成人在线观看| 亚洲91综合| 天天综合网日韩7799| 美日韩一二三区| 91色久| 97亚洲在线| 大香蕉在线免| 99re6久热只有精品6在线直播| 午夜a成v人电影| 破处bbq| 天天干2019| 午夜理论片在线观看免费| 黑人性欧美| av午夜玫瑰| 色综合久久88色综合久久天天| 国产精品扒开腿做爽爽爽视频| 久久爽爽精品| 九久9热| 免费一级欧美片片线观看| 岛国不卡超碰护士AV在线播放| 国产精品电影| 欧美日本一区二区a人| 国产无码成人无码| 久区视频| 91色s| 成人精品电影| 在线观看十八禁| 国产日韩在线播放| 无码操逼网| 91肉丝| 热久久无毒不卡| 国内精品久久国产,www香蕉久久五月丁香,亚洲欧美日韩精品永久在线,日本精品一 | 人人操人人肉久久精品| 亚洲少妇在线影音| 精品一区二区三区最新| 精品人妻美妇91job| 少妇啪啪自拍| 国产尤物在线三区| 使劲用力艹少妇视频一区二区| 最新欧洲欧美日本激情网站| 久久久成人国产精品无码| 91丝袜在线播放| 桃色人妻在线视频| 97欧美精品综合| 大香蕉综合| 人人妻人射| 国产精品人妻无码久久久老鸭窝| 日韩人妻无码不卡网站| 天天干18禁| 91欧美性| 色综合久久夜色精品国产天堂| 欧美日韩国产传媒在线精品| 欧亚综合一卡二卡中文字幕| 殴美牲| 天天影视综合网欧美精品| 中文字幕 国产区| 中文字幕成人| 欧美日综合| 色婷婷六月| 亚洲天堂五月天国产| 色婷婷国产精品一区在线观看| 蜜臀久久久99久久久久| 丝袜视频网国产90| 精品97久久| 久久久内射良家| 龙兴卡官方查询| 99re在线视频| 怡红院亚洲怡春院av| 无毛精品| 婷婷五月天色网| 亚洲综合色图欧美| 97国产精品一区| 亚洲丨在线| 视频在线97| 91成人亚洲色图| 久操| 水滴偷拍| 成人五月天丁香激情综合| 免费国产视频| 国产精品爽爽v| 91九色蝌蚪在线观看| 老熟乱一区二区三区四区| 高清不卡视频| 亚洲精品1区| 久久久久久九九九九九九| 精品久久9| 久久人妻一区二区三区高清| 夜夜爽夜夜| 丝袜人妻av一区二区| 日本高清免费一本视频在线观看| 日日操免费视频| 青青草自拍视频在线播放| 久久久久久中文字幕中文字幕最新| 天天看少妇| 99re9这里只有精品| 中文字幕日韩人妻视频一区二区三区交换夫妻| 亚州欧美一区| 这里只有97精品| 中文有码9| 日韩97在线| 国产呦精品系列在线观看| 影视综合无码少妇| 我爱大香蕉| 密桃99999| 99.色网| 夜草欧美| 操逼操逼操| 国产精品嫩草久久久久| 日韩 欧美 视频 在线 一区| 五月大香蕉| 久久久久久国产精品| 亚洲人成网www| 中文字幕日韩国产传媒欧美精品| 97AV在线免费观看| 78超碰| 国产成人精品无码久久| 亚州色交| 激情婷婷丁香| 强奸乱伦亚洲第一页| www.丁香五月| 麻豆 亚洲 97| 公司1区2区3区精产精| 蜜臀久久99精品久久久久| 99久久精品无码一区二区毛片免费| 在线观看综合精品亚洲| 97国产伦理| 欧美淫乱视频| 岛国在线国产| 亚洲伊人久久精品狠狠在线| 香蕉大久久久| 97视频网站| 天天做日日爱夜夜爽| 久久9亚洲| 欧美另类丝袜熟女| 中国一区二区亚洲人妻| 熟女精品一区二区三区| 国产AV天美传媒一区二区三区 | 欧美性爱网97| 超碰97综合| 亚洲国产婷婷在线播放| 国产在线不卡导航| 日韩精品一二三| 欧洲成人性爱视频| 九九热五区| 老司机免费视频在线91| 亚洲欧美国产va在线播放频| 亚洲天堂,男人| 97欧美色| 操逼操逼逼操操逼91| 国产AV天美| 免费操逼91| www.色婷婷.com| 超碰69| 美日韩男女操屄视频| 婷婷色色网| 亚洲脚交| 亚洲性爱无码乱伦av| 天天天天做夜夜夜夜做| 欧美五十路熟| 成人精品视频一区二区| 少妇综合网| 老司机老司机午夜影院| 亚洲丝袜B诱惑| 蜜臀久久99精品久久久久久-DVD| www.激情| 国产精品久久| 激情综合五月| 日本黄页视频在线观看| 草莓精品视频在线免费观看| 久久久精品91八戒| 久9爱经典视频| av大香蕉| 日va操| 91色色网站| 国产精品一二三| 欧美78| 日韩美女啪啪一区| 五月天婷婷成人网| 欧美日韩中国x| 色色毛片| 约操熟妇| 91中出在线| 色综合色欲色综合色综合色综合| 精品丰满熟妇人妻一区| 日本理论在线| 天天澡天天爽日日av| 亚洲色欲天天天堂色欲网女| 美女露胸露奶头| 欧天美中出| 色哟哟-国产专区| 色五月婷婷在线| 思思在线免费视频| 亚洲图片偷拍视频区| 91日韩| 久久精品国产久精国产| 任你草| 91狠狠综合久久久久久| 精品国产av一区二区三区四区入口| 九九九九97| 久久偷偷色综合蜜桃| 韩国一级AAA| 肉丝无码中文高清| 久久亚州精品成人Av无| 亚洲涩涩| 日本性一区| 青青草玖玖爱| 国产9熟妇视频网站| 青青青草伊人精品| 91日韩网站| 亚91网| 中文字幕欧美精品亚洲日韩蜜臀| 亚洲中文字幕一区| 亚洲日韩一区电影| 99这里只有精品| 青青草视频在线观看一区二区| 99re综合伊人| 蜜桃色色网站视频三区| 操B视频日韩无码| 亚洲美女精品| 国产精品精品系列在线观看| 国产噜噜噜噜噜久久久久久久久| 啊啊啊啊嗯嗯嗯用力好爽| 天天狠操| 亚洲资源一区| 伦理弟一页| 网页导航五月天免费一二三区| 超碰碰97资源站| 91色图片| 97啪啪| 欧美成人免费在线观看| 欧美女同在线| 9热9热综合网| 激情丁香五月婷婷| 亚洲蜜乳av| 91综合网站| 欧美成人国产精品| 国产白领连续中出在线观看| 性爱精品一区| 久久αⅴ| 日韩精品一区,二区 九九...老司机| 床上啊啊啊一区二区三区| 成人性爱av| 欧美九九九九九| 97超碰久| 六月色婷婷| 十八禁的黄污污免费网站| 欧美中出| 欧美性色网| 亚欧视频在线| 玖玖人人爱| 艹比视频国产精品| 秋霞一级A片黄色视频| 亚州性色| 色97干| 舔舔啊| 欧美91在线+|+欧美| 极品五月天噜噜| 太久视频| 欧美精品一区二区少妇免费A片 | 啊啊啊啊啊啊啊好爽不要| 九九色热| 高清无码国产亚洲| 搡老女人老妇女AAA一VU麻豆 | 成人五月天丁香激情综合| 97超碰人人模人人拍人人| 日本熟妇熟色97一本在线观看| 亚洲砖码砖专无区2023| 日韩在线一区二区| 一区二区三区美女超清| 97天天综合| 日本高清视频在线观看黄已三辽| 大香蕉92| 9ⅰ久久久天天| 中文字幕日韩人妻视频一区二区三区交换夫妻| WWW4虎| 青青网三级视频| 久久精品99| 欧美色图20p| 91网站18+| 日本日日色视频| 欧美 亚洲 制服 精品| 992这里有精品| 美女国产一区二区久久| 91影库| 国产精品com| 91天天美女| 久草久日| henhen91| 在线视频亚洲无码| 久久av无码| 国产家庭乱伦表演| 免费福利视频中文字幕| 日本 色 导航| 欧美强奸乱能| 97色在线| sss视频华人在线| 最新AVzaixian| 91亚洲精品青草| xxx亚洲午夜天堂| 亚欧中文字幕在线视频| 日本熟妇色熟妇在线视频播放| 日韩无码久久熟女一级片| 亚洲凸凹超碰成人| 91天天美女| 99精品九九九九九九| 国产蜜臀在线| 丝袜美腿操av| 超碰在线综合97| 日本不卡一区二区三区| 亚欧美综合网。| 后入式五六区| 日本色日夜干| A级在线视频| www国产无码| 一个色导综合| 97啪啪| 九色 人妻 大香蕉| 九九热精彩视频| 日韩欧美中文字亚洲慕| 国产60页| 五月天婷婷激情| 国产精品视频内谢女人| 狠狠搞 亚洲91| 91天堂| 久久99手机免费视频| 大香蕉97久久| 一区二区偷拍拍视频| 综合欧美日韩在线观看| 日韩精品国产一区二区| 制服乱伦| a在线观看| 黄片在线免费在线观看| 7777欧美成是人在线观看| 97伊人| 欧美图片色五月天| 噜噜噜亚洲精| 91亚洲欧美激情| 亚洲成人在线乱码色午夜| 99re在线视频国产| 欧美午夜色妇色鬼| 韩日自拍| 日韩免费三级黄片电影| 免费的黄片有限公司| 亚州色图片在线色| 国产一区二区啪啪视频| 久久久久久国产精品| A级国产欧美激情在线| 亚洲成成熟女人综合一区二区| 日1区2区3区2020| 韩日精品福利视频一区不卡在线免| 中文字幕123| 日本午夜久久电影| 高精欧美色| 69精品| 精品人妻夜夜草| 白嫩91在线亚洲| 久久发布国产伦子伦精品| 亚洲系列第一页| 96精品久久久| 人妻精品一区二区在线| 婷婷五月花| 一区二区三区四区姦女| 激情婷婷丁香网| 久久精品电影| 深爱五月婷婷| 日韩资源网| 人人操人人色网| 亚洲av乱伦色图网站| 特污精品女优骚货黄色视频在线免费观看| 天天天肏屄欧美| 欧美综合天堂| 欧美偷拍区| A啊啊在线观看| 97精品人妻一二三四| 久久av一级av少妇av高潮| 97免费在线视频在线观看| 加勒比伊人综合| 久久人妻视频网| 99操逼| 蜜乳AV.COM| 激情综合久久| 成人在线永久| 色综合久久夜色精品国产天堂| 天天做天天爱| 色色五月丁香| 精品制服美女中文一区二区三区| 国产操逼逼网| 久草免费在线一区二区| 老司机午夜精品福利视频一区二区| 中国的操老妇女| 亚洲综合春色| 伊人操| 伊人久久婷婷| 东京热AV男人的天堂| 中美日韩毛片| 美女干逼2| 成视频在线观看免费看| 搞中出久久| 久久仑合| 日韩无码a片| 极品人妻少妇综合| se,,,亚洲欧美| 97亚洲综合| 秋霞鲁丝午夜无码一区二区三| 绯色AV粉色AV蜜臀AV| 成人在线午夜视频一区| 啊啊啊啊啊好多水| 亚洲 综合 第一页| 久久婷婷五月天| 人妻天天操天天爽视频免费| 91色图片| 人人贴人人摸| 欧美熟女丝袜| 最近2019中文字幕国语免费版| 搡老女人老91妇女熟女| 亚洲欧美大| 亚洲自拍青操视频| 亚洲女毛多水多21P| 天天射天天色成人| 深夜操逼网| 青娱乐淫乱1314| 欧美日韩精品久久| 国产成人无码高清| 国产亚洲精品美女| 91老女人| se,,,亚洲欧美| 欧美亚洲中文字幕| 久久久久久久97| 亚洲aw毛茸茸在线| 无套内射人妻在线播放| 超碰导航97| 天天狠| 蜜臀久久99精品久久久电影| 青青草色插素人| 牛黄色久午久| 国产捆绑一区| 亚洲黄色网址| 九九在线视频| 国模不卡| 男人的天堂com| 亚洲情色电影网| 7777奇米影视久久| 美女裸体麻豆天美蜜桃91| 免费亚洲黄色视频在线观看| 亚洲电影中字一区二区| 久久久久久九九九九九九| 亚洲少妇色| 乱操乱伦AV| 久热99999| www.狠狠干.coom | 久热婷婷| 日韩三级一区| 国产亚洲精品无码三区| 欧美亚男人的天堂| 日日碰狠狠添天天爽超| 欧美性爽xyxOOOO| 亚洲人久久久网| 91九色精品熟女内射| 少妇色欲综合网2| 一区二区三区日韩欧美 | 秋霞成人一级在线观看| 欧美丝袜91| 高潮综合网| 亚洲黄网在哪免费看| 亚洲日韩美女丝袜美腿人妻视频| 东方亚洲在线操逼天堂| 中文字幕乱碼在线| 色婷婷丁香五月| 亚洲AV无码AV吞精久久久久| 中国操逼无码| 亚欧成人一级片在线播放| 亚洲素人网| 亚洲男人天堂网久久| 久99久视频| 你想操日本小逼吗| 99老司机精品视频在线观看| 麻豆精品一区二区三区四区免费观看| 欧美桃色网| 9长久久精品| 中文字幕少妇色| 四虎影院成年人片| 欧美日韩性爱操大逼| 屁股久久久久久| 精品少妇人妻一区二区三区| 60秒免费小视频| 高清无码久操视频| 大香久久| 插插综合网天天影视网| 亚州综合色图| 另类 综合 日韩 欧美 亚洲| 日韩久久超碰色| 手机在线看片免费人成视频| 人妻 中文 日韩| 黄色片A级一区二区三区| 亚洲另类天堂| 色与欲影视| 操一对老熟妇爽上天视频| 97综合久第一页| 综合激情一一91| 性爱欧美五月| 很很很很操| 蜜桃视频一区二区三区| 99国产精品久久久在线播放| 中文字幕人妻色偷偷久久皮| 绯色AV粉色AV蜜臀AV| 天天干天天干天天干| 岛国片在线观看视频亚洲| 亚洲成A∨人影院在线欢看| a v网站在线播放| 1级午夜影院费免区| 强奸乱伦AV网址| 青草草免费网站av| 高清一区AV无码| 中文字幕在线免费观看| 777超碰| 肥佬影院91| 欧美丝袜中文字幕07在线| 亚洲无码成人精品| 亚州宗合另类| 中文欧丝袜诱惑| 欧美一级A一级a爱片久久| 黄色电影在线播放综合网站| 嗯啊不要在线观看嗯啊| aaa淫乱视频| 操逼999| 超碰97在线中文| 丝袜狠狠草尤物 91| 亚洲精品国产av天美传媒| 26uuu性物| 欧美色图97| 国色天香av| 五月丁香啪啪| 久久久蜜桃一区二区三区| 精品人妻1237| 日本A级视频| 久久久久久久久久久久久久久性生活视频| 抽插无码高清一区| 大香蕉色网| 91高跟美女在线播放| 久久久久久久久久久久久久久久9| 美女91av| 麻豆精品.欧美精品.日韩精品.| 精品传媒在线一区| 伊人丁香五月婷婷| 亚洲超碰AV| 唐山老熟妇露脸啪啪叫| 精品国产乱码久久久久久影片| 九九无码视频| 日韩一999精品| 天天日美女的B| 东京热综合久久一区二区| 五月天婷婷在线看| 亚洲AV无码成人精品久久| 91久久久久免| 欧美五区| 欧美91网| 插入逼91| 日韩一级免费性爱| 日欧美色| 97色欧洲| 亚洲欧美首页| 精品中文字幕一区二区l - 百度| 男人的天堂啪啪啪啪啪蜜桃不卡| 夜夜福利| 国产97在线视频| 日韩av在线免费网站| 不卡超碰护士AV在线免费播放| 91欧美长吊| 精品人妻视频一区二区三区蜜桃视频| 久草电影网| www.亚洲成人一区| 五月天婷婷成人网| 日日摸天天爽夜夜欢| 无码一区二区精品视频久久久春药| 欧美 日韩 另类 亚洲| 久久精品国产72国产精品福利| 少妇天堂| 国内97干免费看| 亚洲 小说 欧美 激情 另类| 成人天天爽| 亚洲成人免费中文字幕| 日韩精品电影| 操国产逼| 久久免费中文字幕在线观看| 大香蕉懂9| 依人大香蕉| 97精品国产97久久久久久免费| 长久操视频| 亚洲精品一区二区日本| 亚洲国产精品无码AV在线| 国岛片视频| 四月丁香婷婷| 欧美色97| 日本中文字幕在线视频| 日韩天天本| 自拍偷拍第26| 青娱乐亚洲热| 亚洲黄色AV电影| 亚洲精品aa久久伊人| 欧美视频激情久久久久久| 国产自制av蜜乳| 伊人AAA| 久久久免费视频18| 日韩美女操b| 日韩人妻无码专区| 1024手机看片欧美日韩| 天堂无码| 国产少妇与亚洲av| 99re在线视频这里只有精品| 一区二区三区四区免费视频| 亚洲日韩久久精品一区| 交换娇妻呻吟声不停中文字幕| 色婷婷五月天| 热热色91| 91狠狠综合久久久久久| 九九九九九九视频免费| 成年人一级黄色毛片大全在线观看| 日本精品国产视频| www.亚洲黄色| 刺激精品视频| 俄罗斯一区二区视频在线观看| 国产污视频麻豆传媒一区二区| 福利视频香蕉免费一区二区在线| · —级AA伦aa坐爱午夜极速ⅴA一区天天噪天天噪天天噪 | 无码人妻1727| 天美精品av| www.久久99| 国产又操| 国产精品农村妇女精品| 九月色婷婷| 深夜视频| 亚洲影视综合网| 青青草中文字幕| 成年女人一区| 91啦人妻| 亚州 综合 色图| 99国产精品视频尤物| 日韩欧美中文字| 男女日B国产| 日本不卡码黄色 | 91亚.色| 久久三| 情色大香蕉| 亚洲天堂区| 秋霞一集毛片观看| 超碰天天操| 天天看,天天做| 久久97精品久久久久久久不卡| 凹凸视频特色日本特黄| 久久精品久久久久久久| 精品大久久| JIZZJIZZ亚洲女人被躁| 欧美午夜视频| 97久久久| 日本伦乱九九九综合| 99re3这里只有精品| 大香蕉www.超碰| 天天操熟妇| 国产成人网址| 欧美日不卡| 亚洲色人妻综合| 国产亚洲精品无码三区| 国产精品电| 最新欧美色网| 国产成年女人免费视频播放a| 午夜精品久久久久久久99| 天天爱天天操| 日韩激情毛片一级久久久| 天堂资源站| 婷婷久久大香蕉| 成人a v在线播放免费| 色在线69堂| 成人午夜无码视频| 亚洲一区二区在线观看91| 亚洲精品1区| 国产成人精品日本亚洲语言| 91 亚洲情侣偷拍 久久| 九九av| 国产一级内射无挡观看| 高潮综合网| 人妻少妇久久久| 天天操人人操狠狠插| 欧美日韩人妻精品一区二区三区| 日本不卡三级网在线播放| 国人欧美精品一区二区| 热热色91| 99re热| 大香蕉伊人网WWWn0n| 激情国产乱伦Av| 久热一区二区| 影音资源男人日韩| 另类亚洲图色| 国产精品一区二区校花| 日日爱99| 999九九精品| 国产精品对白内射| 激情av| 中文字幕一区电影在线观看| 变态综合色| 69AV女优男人的天堂| 凹凸视频特色日本特黄| 狠狠操夜夜| av三级电影在线播放| 亚洲日韩东京热一区| 日韩三四五区| 国产a级午夜毛片| 国产传媒午夜理伦精品| 国产强奸乱伦第1页| 亚洲丰满很很操| 人人澡综合涩| 97国产色综合| 男人的天堂亚洲| 亚洲四虎熟女精品| 强奸乱伦 亚洲一区| 美女黄站| 色香网| 亚洲天堂资源| 久久久久78| 精品超碰中文在线| 啪啪一区| 啪啪资源网| 成人性爱免费播放| 青草成人免费视频一com| 国产一区二区精品在线视频| 欧美视频激情久久久久久| 免费看毛片操穴| 国产少妇肉丝在线观看| 99热伊人| 久久香蕉国产线看观看猫咪av| 91人妻中文| 老熟妇一区二区三区…| 高清国产性猛交xxxx乱大交| 性色AV蜜色av色欲av| 国产精品自拍视频| 欧美色图 色综合图| 日骚逼视频| 超碰色97| 亚欧免费| 天天天天天天天天综合| 日韩av色图综合| 玖玖在线视频| AAAAAAAAA黄片| 亚洲网站一区二区在线| 久久AV无码AV| 日韩免费簧片| 亚洲欧洲无码bt精品合集| 精品一区二区国产日韩| 亚洲天堂男人的天堂| 中文字幕一区二区三区50路| 91亚洲综合| 亚洲午夜未满十八勿入网站日本又色又爽又黄 | 少妇熟女1区2区3区| 免费精品国偷自产在线在线| 3PAV乱伦视频| 亚洲男人综合| 久操网址| 思思热免费视频观看| 丁香九月激情啪| 亚洲综合中文字幕有码| 中文字幕在线免费观看视频| 水野优香在线观看| 欧美日韩国产中文精品字幕自在自线, | 亚洲精品无码成人久久久99| 国产精品久久久久久久毛片1| 天天干夜夜一操| 亚洲激情在线| 厕所偷拍在线| 日日橹狠狠爱欧美超碰| 国产小炒后入式| 日日骚精品视频| 中文字幕av片| 五月天亚洲色图| 亚洲久久久久| WWW操逼| 大学生美女口爆| 精品国产Av无码久久久亚洲| 欧美熟妇成人一区二区| a级成人毛片免费视频高清| 超碰久热| 久久久98网站免费视频| 台湾佬激情综合| 亚洲综合97中文网| 黄呦呦在线| 曰韩香蕉97| 日本一二三免费久久| 熟女熟妇一区二区三四区| 中文字幕97| 无码高清操逼网址| 999岛国大片| 亚洲精品丝袜| 国产精品一级二级在线| 国产三级片在线观看| 无码精品久久久天天影视| 国产自产自拍| 极品白嫩美女白浆成人福利在线看| 色五91| 日韩精品电影| 日韩一级二级三级在线不卡观看完整| 国产毛片片精品天天看视频| 亚洲色图尤物视频 | 98人妻精品一区二区色欲| 亚洲成a人在线观看久| 大稥蕉免费视频这里只有精品| 九一屌逼| 天天综合~91| 欧美亚洲第一页| 亚洲人妻一区二区三区| 加勒比五月天| 在线二区不卡| 乱伦一二三区| 人妻丰满熟妇一区二区三| 99热婷婷| 97视频在线视频| 97网色| 一级毛片久久久久久久女人18| 激情网五月天| 久久人妻少妇| 一二三区操逼国产91| 日逼国产| 麻豆AV96熟妇人妻| 欧美在线亚洲| 家庭乱伦国产精品| 激情五月综合网| 女人天堂AV五区在线| 日韩成人小视频| 中文字幕伊人| 岛国福利在线精品播放| 韩国久久97| 国产青青综合伊人| 黄色片,com| 婷婷五月天福利| 日日AAvv| 色成人Www精品永久观看| 99re不伦| 中文字幕三四区| 欧美日韩操逼嗦吊| 91大神电影天堂| 综合网 欧美| 激情五月天视频| 色综合99999| 国产精品女aA片爽爽视频| 久色网| 人妻精品一区一区三区蜜桃91| 国产精品内射婷婷一级二| 国产精品色色| 日韩精品人妻中文字幕不卡乱码| 国产操逼逼网| 偷拍五区| 黄色AAAAA欧美| 国产AV人人 夜夜人人澡| 深夜激情 | 91狠狠综| 综合激情五月丁香| 加勒比色99999| 日韩精品一区的| 亚洲在线综合| 中文字幕精品资源在线| 人妻大香蕉| 欧美性爱视频免费一区一A| 久久久久久久六六| 黑人无码一区二区| 人妻少妇久久中文| 精品无码不卡视频| 欧美激情色婷婷花野真衣一区二区| AA级电影三区| 青青草乱入乱欲视频在线观看| 熟妇xxxxx性春色| 人人澡综合涩| 岛国A V在线免费看| 国产乱码久久久| 1204av韩国| 亚洲欧洲综合av在线| 一区二区三区日韩欧美 | 亚洲中文字母在线播放| 欧美天天综合站| 国产极品一区二区三区三州| 亚州欧美总和| 91精品国产麻豆国产自产在| 欧美 色 亚洲| 九九热精品在线| 综合色区偷拍| 不卡九肏| 成人无码在线视频网站| 亚洲国产丝袜在线观看| 国产小视频91| 欧美色综合网| 中文字幕91综合| 一本色道综合久久欧美| 蜜臀AV成人精品蜜臀AV久久| 天天操人人操狠狠插| 国产又大又粗又色生活片亚洲国产精品成人久久久综合免费 | 久久久精品91八戒| 高清无码网址| 精品国产Av无码久久久亚洲| 久久久111| 国产精品女生av| 少好三P| 无码9区| 美国日韩黄片| 手机av亚洲丝袜美腿日韩第一页二页| 色综合网1| 99re这里只有| 日韩精品高清资源在线| 东京热男人的天堂精品| 国产精选视频| 91人人看| av网页一区二区三区| 中文字幕视频二区| 亚洲欧美九九九| 人妻色偷色噜| 中文字幕第95页| 日本 成 人 小说 电影 一区二区| 一级人妻性爱视频| 91亚.色| 日本一二区免费| 看一级特黄a大一片| 大香蕉综合网| 麻豆 亚洲 97| 91 刺激在线| 国产成人精品必看| 日天天九九天堂666| 国产久久一区二区三区野外在线| 老熟女搡BBBB搡BBBB视频| 加勒比伊人综合| 亚洲性爱无码乱伦av| 天天日天天操天天射河南省| 亚州欧美综合| 大香蕉520| 午夜乱轮操逼视频免费看| 东北女人高潮视频| 老熟妇综合| 国产成人无码高清| 久久国产AⅤ| 国产一二三福利视频网| 99re69综合| 欧美色婷婷| 韩国一级AAA| 探花精品 一区二区| 日本三级韩国三级美三级91| 97视频在线免费看| 岛国在线一区二区三区| 美女诱惑久久| 国产精品久久久久久9999| 欧洲中文字幕| av资源在线播放天堂| 欧美午夜视频免费观看| 大茄子熟女AV导航| 亚洲蜜臀视频精品久久| 江都AV在线| av天堂手机版追回| 东京热双插| 91影视亚洲| 久久久中文| 69精品久久久久中文字幕| 丁香九月 婷婷| 国产强奸乱伦第1页| 欧美综合色图网| 青青草久久在线| 国模不卡一本二本三电影| 欧美日韩情色一区二区| 丁香婷婷久久| 日本色色的视频| 精品国产丝袜一区二区三区乱码| 日本孕妇一区二区视频操逼免费看 | 夜夜夜夜夜夜夜夜夜狠狠狠狠狠狠狠| www.色五月| 国产精品视频白浆免费| 大黄片做爱的大的| 国产女s强制榨精视频| 国产美女高潮| 国产9l 大屁股| 久操视频免费观看| 熟女一区二区三区| 97香蕉人人乳| 亚洲一区二区三区麻豆传媒| 97久精品| 精品四五区| 亚洲熟女精品| 无码 黑人一区二区三区| 欧美色www亚洲国产阿娇要播| 91另类| 精品人妻高清麻豆av| 爱妻综合网| 一二三卡欧美日韩人妻免费精品| 色综合久久夜色精品国产天堂| 久久久久ab| 97亚洲欧美日韩| 九九热免费国产视频婷婷伊人五月 | 久久成人东京热人妻| 大香交| 玖玖综合视频| 精品国产乱码久久久影院| 色拍偷亚洲| 大香蕉青青9| 中文日韩欧美熟| 91美女小视频| 曰本精品久久久| 亚洲国产高清福利视频| 欧美亚洲宗合色性图| 午夜欧美神马久久久久| 福利风月五月天影院| 蜜臀99精品国产高清在线观看| 夜夜 中文视频rt| 伦理日韩国产久久| 亚洲影视第一页| 黑丝制服中文字幕| 亚洲丝袜少妇在线| 五月天日日操夜夜操| 天天综合站| 日日躁夜夜躁狠狠躁超爽| 91制服丝袜中文字幕| 人人摸人人入| 一二三区精品视频| 欧美综合亚洲综合| 69国产对白刺激| 成人性爱AV在线免费观看| 亚洲一级特黄大片在线播放91| 亚洲成人精品在线一区| 久久欧美按摩999| 久久综合亚洲色1080p| 97视频播放| 天天日日日射| 99热婷婷| 无色无码| 婷婷在线视频在线观看| 美女91网| 超碰无码五月97| 日本日日色视频| 五月天婷婷综合网| 户外裸露刺激视频第一区| 国产精品直播在线观看直播| 桑老女人九区| 校园春色中文字幕AV| 激情综合久久| 乱伦3P视频| 美女黄站| 久久久久国产精品久久久| 久久久久久裸体| 啊啊啊啊啊操我视频| 婷婷AV一区二区三区| 中文字幕高清精品一区| 欧美肥臀在线| 操逼短片| 91色插| 岛园激情| 亚洲亚洲亚洲天堂天堂 | 超碰成人公开| 亚洲啪啪性视频| ,国产乱人伦精品一区二区三区| 久久久91福利姬| 偷拍精品一区二区三区| 青娱乐亚洲自拍| av在线一区二区三区| 性色一线| 欧美视频激情久久久久久| 欧美男人的天堂| 内射小黄片| 少妇高潮特黄A片| 在线观看一卡二卡| 久久久一区二区| 插入逼91| 国产无套粉嫩白浆在| av亚洲天堂资源网站| 激情四射婷婷六月天| 国产精品不卡一区二区三区av| 日本福利二区视频| 1204av韩国| 好爽视频在线观看视频| 草莓精品视频在线免费观看| 日韩熟妇二区| 91网站在线播放| 麻豆视频国产一区二区| 96久久精品一二三区色欲| 天天天肏屄欧美| 综合色欧美| 91人妻素女| 久久综合精品一区二区三区| 中文字幕、久久精品国产2020、久久综合久久自在自线精品自、亚洲 | 久久久精品一区二区| 视频国产成人精品日本亚洲18| 日本在线不卡一二区| 天堂射| 超碰日韩人妻| 欧美三级一级| 淫淫综合网| 无码抄逼网| 九九九影院| 91色香| 成人网址在线观看|