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

ARTICLE DETAIL

資訊詳情

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

MATLAB VTVL姿態(tài)控制仿真與調(diào)參實戰(zhàn)解析

MATLAB VTVL姿態(tài)控制仿真與調(diào)參實戰(zhàn)解析 簡介本資源是一套面向高校自動化、航空航天類專業(yè)本科生及研究生的MATLAB課程設(shè)計與畢業(yè)設(shè)計實踐材料聚焦垂直起飛與垂直降落VTVL運載器姿態(tài)控制這一前沿工程問題系統(tǒng)解決飛行全過程的姿態(tài)穩(wěn)定性與精準(zhǔn)調(diào)控難題。壓縮包共32個文件涵蓋8個核心MATLAB腳本如遺傳算法優(yōu)化PID的optimize_pid_with_ga.m、火箭參數(shù)建模rocket_params.m、6個.fig可視化結(jié)果、9張.png性能對比圖含俯仰姿態(tài)與質(zhì)心平動聯(lián)合仿真圖、4個.mat參數(shù)文件含差分進(jìn)化與自適應(yīng)DE優(yōu)化結(jié)果、2個.asv仿真主程序及1段實機運行視頻.mov總大小12.73MB。已有60人學(xué)習(xí)下載。用戶可直接復(fù)現(xiàn)完整VTVL姿態(tài)控制仿真流程從彈道建模、內(nèi)外環(huán)PID控制器設(shè)計到GA/DE雙算法參數(shù)尋優(yōu)再到含執(zhí)行機構(gòu)延遲的閉環(huán)響應(yīng)驗證配套優(yōu)化歷史記錄、多組對比曲線及實時監(jiān)控圖像顯著降低算法調(diào)參門檻提升控制系統(tǒng)設(shè)計的工程落地性。 最近群里一個做火箭回收模擬的朋友發(fā)了個“基于matlab的VTVL姿態(tài)控制.zip”結(jié)果好多人在問怎么解壓、怎么跑、跑完怎么調(diào)。我看了一下這個壓縮包里的東西其實就是一個典型的垂直起降VTVL飛行器姿態(tài)控制仿真工程用MATLAB腳本加Simulink模型組合完成覆蓋了六自由度剛體建模、推力矢量執(zhí)行機構(gòu)、PID/LQR姿態(tài)控制律、批量打靶和可視化后處理。這篇文章不打算替你把代碼逐行注釋而是直接講清楚這個工程背后的控制邏輯、模型怎么搭、壓縮包拿到手后怎么正確運行以及我在實際調(diào)參過程中踩過的那幾個坑。1. 先理解VTVL姿態(tài)控制到底在解決什么問題1.1 為什么垂直起降的姿態(tài)控制這么難VTVLVertical Take-off and Vertical Landing飛行器通俗講就是能豎著起飛、豎著降落的火箭或驗證平臺最典型的代表就是一級火箭回收和各類亞軌道試驗飛行器。這種構(gòu)型在飛行的大部分時間里都沒有固定翼面提供氣動升力和穩(wěn)定力矩整個飛行器本質(zhì)上是靠發(fā)動機推力“頂著”飛行的。這里有一個非常反直覺的事實從控制角度看垂直起飛和垂直著陸階段飛行器就像一個倒立擺。發(fā)動機和推力矢量機構(gòu)在底部重心在中間偏上一旦箭體偏離垂直方向重力就會讓這個偏轉(zhuǎn)繼續(xù)增大而不是自動恢復(fù)。所以姿態(tài)控制系統(tǒng)的首要任務(wù)不是“保持姿態(tài)角盡量小”而是“讓姿態(tài)角能回到期望值”并且在擾動下不振蕩發(fā)散。此外VTVL飛行器的受力環(huán)境變化非常劇烈。上升段有稠密大氣著陸段經(jīng)歷速度從幾百米每秒降到接近零的過程氣動力、動壓、質(zhì)心位置、轉(zhuǎn)動慣量都在實時變化。再加上發(fā)動機推力大范圍節(jié)流、燃料消耗導(dǎo)致質(zhì)量變化、風(fēng)場擾動等不確定性姿態(tài)控制系統(tǒng)的魯棒性要求遠(yuǎn)高于普通飛行器。這個工程包的核心就是圍繞這些問題在MATLAB環(huán)境中建立一套完整的姿態(tài)控制仿真鏈路剛體姿態(tài)動力學(xué)、推力矢量執(zhí)行機構(gòu)、傳感器測量、控制律計算、數(shù)值積分和結(jié)果可視化。它解決的問題就是“在給定的推力、擺角約束和外界擾動下如何讓飛行器保持期望姿態(tài)并且最終穩(wěn)穩(wěn)落在著陸點”。1.2 姿態(tài)控制的任務(wù)拆解與通道劃分拿到這個工程后我建議先不要急著跑代碼先想明白姿態(tài)控制要管哪幾個量。一個剛體在空中的姿態(tài)可以用三個角度描述偏航角航向、俯仰角、滾轉(zhuǎn)角。但實際控制并不是三個角度各管各的而是按通道劃分俯仰通道和偏航通道一般由發(fā)動機擺動推力矢量控制。發(fā)動機噴管擺動一個小角度推力方向隨之改變產(chǎn)生一個繞重心的力矩從而改變飛行器的俯仰和偏航姿態(tài)。滾轉(zhuǎn)通道通常不通過發(fā)動機擺動來控制而是依靠RCS反作用控制系統(tǒng)或冷氣噴管實現(xiàn)。因為單臺發(fā)動機擺動無法有效產(chǎn)生繞箭體縱軸的滾轉(zhuǎn)力矩除非有多臺發(fā)動機差動擺動。這也就是為什么你在工程包里會看到兩個并行的控制回路一個用于俯仰/偏航的角度控制一個用于滾轉(zhuǎn)的角度控制。前者響應(yīng)快、力矩大后者精度高、但力矩小、工作占空比受氣源限制。姿態(tài)控制的任務(wù)階段也不一樣。上升段一般跟蹤程序角讓火箭按照預(yù)定的俯仰程序轉(zhuǎn)彎減速下降段需要讓飛行器保持接近垂直的姿態(tài)同時配合導(dǎo)航制導(dǎo)完成軌跡跟蹤最終著陸段對姿態(tài)角的誤差要求非常嚴(yán)格因為著陸時箭體傾斜太大直接就翻倒了。一個好的VTVL姿態(tài)控制仿真工程必須能體現(xiàn)這些階段的差異并且能夠切換控制目標(biāo)。1.3 坐標(biāo)系、姿態(tài)表示和MATLAB里的第一個坑這個工程里最“勸退”一部分人的是坐標(biāo)系和姿態(tài)表示沒搞清楚。我在幫朋友調(diào)試時發(fā)現(xiàn)出現(xiàn)“控制量符號反了”“角度一直在跳”“仿真數(shù)值爆炸”這類問題十有八九是坐標(biāo)系約定不一致。VTVL建模中至少涉及兩個坐標(biāo)系地面慣性坐標(biāo)系通常取北東地NED或東北天ENU用于描述位置和速度也是重力方向的定義基準(zhǔn)。彈體坐標(biāo)系原點位于飛行器質(zhì)心x軸沿箭體縱軸指向頭部y、z軸分別指向右和下方構(gòu)成右手系。姿態(tài)表示一般有三種方式歐拉角、旋轉(zhuǎn)矩陣、四元數(shù)。歐拉角最直觀工程包里的可視化和日志打印基本都用它。但歐拉角有兩個坑一是存在萬向節(jié)鎖奇異點當(dāng)俯仰角接近90度時滾轉(zhuǎn)和偏航無法區(qū)分二是有回繞問題角度從179度跳到-179度時看起來變化很大控制器如果直接拿這個誤差做PID輸出會出現(xiàn)劇烈跳變。四元數(shù)沒有奇異問題適合在仿真內(nèi)部做姿態(tài)遞推和誤差計算但是不直觀。很多工程包的策略是內(nèi)部狀態(tài)用四元數(shù)進(jìn)入控制律之前換算成歐拉角或誤差四元數(shù)顯示和記錄再用歐拉角。在MATLAB中從慣性系到彈體系的旋轉(zhuǎn)矩陣一般用三個歐拉角連續(xù)旋轉(zhuǎn)得到但這個旋轉(zhuǎn)順序定義因工程而異。常見的是ZYX偏航-俯仰-滾轉(zhuǎn)順序也有喜歡用ZYZ的。如果不懂這個讀代碼時經(jīng)常會出現(xiàn)“為什么我的滾轉(zhuǎn)角控制器生效了偏航也跟著動”這種迷惑。提示拿到工程包的第一件事是先找README或者在代碼開頭找坐標(biāo)系和歐拉角順序的定義。沒有這個定義的工程建議直接放棄因為姿態(tài)控制里的符號錯誤排查起來極其痛苦。2. 模型搭建從剛體動力學(xué)到推力矢量執(zhí)行機構(gòu)2.1 剛體姿態(tài)動力學(xué)方程姿態(tài)控制的物理基礎(chǔ)是剛體動量矩定理。在彈體坐標(biāo)系下姿態(tài)動力學(xué)方程可以寫成[ I \dot{\boldsymbol{\omega}} \boldsymbol{\omega} \times (I \boldsymbol{\omega}) \mathbf{M} ]其中(\mathbf{I})是轉(zhuǎn)動慣量矩陣(\boldsymbol{\omega} [p, q, r]^T)是彈體角速度在彈體系下的分量(\mathbf{M})是外力矩包括推力矢量力矩、氣動力矩這里通常先忽略或簡化為阻力力矩、RCS力矩。展開成標(biāo)量形式后你會看到很多“交叉項”比如滾轉(zhuǎn)角速度p影響偏航力矩、俯仰角速度q影響滾轉(zhuǎn)力矩。這就是陀螺力矩耦合。在快速旋轉(zhuǎn)時這個耦合非常明顯單純的三通道獨立PID難以兼顧需要在控制律里做解耦或者用LQR這類狀態(tài)反饋控制直接處理。這個工程包里的動力學(xué)模型通常用三種方式實現(xiàn)純腳本函數(shù)、S-function、Simulink里的6DOF模塊組。如果用的是腳本函數(shù)你會看到類似這樣的結(jié)構(gòu)function [omega_dot, quat_dot] rigid_body_dynamics(omega, quat, M) % 轉(zhuǎn)動慣量矩陣典型VTVL飛行器 I diag([Ixx, Iyy, Izz]); I_inv inv(I); omega_skew [0, -omega(3), omega(2); omega(3), 0, -omega(1); -omega(2), omega(1), 0]; omega_dot I_inv * (M - omega_skew * (I * omega)); % 四元數(shù)運動學(xué) quat quat / norm(quat); % 保持單位四元數(shù) quat_skew [0, -quat(3), quat(2); quat(3), 0, -quat(1); -quat(2), quat(1), 0]; quat_dot 0.5 * [0, -omega; omega, -quat_skew] * quat; end注意一點轉(zhuǎn)動慣量矩陣在你讀一下工程包時會被誤認(rèn)為是常數(shù)。實際上隨著燃料消耗飛行器質(zhì)量、質(zhì)心和轉(zhuǎn)動慣量都在變。工程代碼里如果假設(shè)I不變那就是在模型層面限制了控制方法的實用性。我在實際仿真時一般會在每個解算周期實時更新I和質(zhì)心位置具體方式是把質(zhì)量變化率按燃料秒耗量折算。2.2 推力矢量執(zhí)行機構(gòu)建模VTVL飛行器沒有翼面姿態(tài)控制力矩主要來自發(fā)動機擺動。發(fā)動機噴管相對箭體縱軸擺動一個角度δ推力F不再沿箭體縱軸方向而是分解為軸向分量和側(cè)向分量。在小角度假設(shè)下俯仰/偏航力矩近似為[ M_{pitch} F \cdot \delta_z \cdot L_{cg} ]其中(L_{cg})是發(fā)動機擺心到質(zhì)心的距離δ_z是噴管在俯仰平面內(nèi)的擺動角。從這里可以看出發(fā)動機擺動產(chǎn)生的控制力矩與推力成正比這就是為什么推力大時姿態(tài)控制“很有勁”推力節(jié)流到很低時比如著陸前懸停段即使?jié)M偏擺角產(chǎn)生的力矩也可能不足。工程包里的執(zhí)行機構(gòu)模型通常包含兩個環(huán)節(jié)一是擺角伺服機構(gòu)的動態(tài)特性一般簡化為二階環(huán)節(jié)或者帶延遲的一階環(huán)節(jié)二是擺角限幅和速率限幅比如最大擺角±10度最大擺角速率±30度/秒。% 發(fā)動機擺動執(zhí)行機構(gòu)簡化模型 delta_cmd saturate(delta_cmd, delta_max, -delta_max); % 位置限幅 delta_dot saturate((delta_cmd - delta_prev) / dt, delta_rate_max, -delta_rate_max); delta delta_prev delta_dot * dt;這里很容易被忽略的是速率限幅。姿態(tài)控制律算出的擺角指令如果變化太快執(zhí)行機構(gòu)跟不上就會出現(xiàn)“控制量發(fā)了實際動作滯后”的情況。要是仿真里沒建模這個滯后控制器設(shè)計出來可能很激進(jìn)到了實物階段一測就發(fā)散。RCS滾轉(zhuǎn)通道的執(zhí)行機構(gòu)建模則不同通常用開關(guān)式噴氣模型輸出力矩按脈沖寬度調(diào)制或者簡單的Bang-Bang控制。為了簡化很多工程會用線性化模型把RCS力矩直接描述為滾轉(zhuǎn)力矩指令加上一階慣性環(huán)節(jié)。這個工程包里大概率也做了這樣的簡化。2.3 傳感器測量和風(fēng)擾模型姿態(tài)控制的反饋來自傳感器主要是慣性測量單元IMU里的角速度陀螺和加速度計。一個完整的仿真工程不會假設(shè)傳感器完美無噪聲而是會加入零偏、比例因子誤差、白噪聲和重力耦合。這部分對調(diào)參影響很大尤其是陀螺零偏它會在積分過程中產(chǎn)生不斷累積的姿態(tài)誤差。風(fēng)場擾動建模也值得說一下。很多人以為VTVL在大氣層內(nèi)飛行時風(fēng)擾動主要影響位置其實風(fēng)還會產(chǎn)生氣動力矩。尤其是側(cè)風(fēng)作用在箭體表面上壓心與質(zhì)心不重合時會產(chǎn)生相當(dāng)大的干擾力矩。工程包里一般會用簡化的側(cè)風(fēng)模型或者直接給姿態(tài)動力學(xué)方程加一個隨機擾動力矩項。在MATLAB里噪聲和擾動通常用randn生成高斯白噪聲然后通過濾波器成形。比如gyro_measure omega_true gyro_bias randn(3,1) * gyro_noise_std;但要注意仿真里加噪聲的幅度不能只靠“經(jīng)驗拍腦袋”。如果噪聲設(shè)得太大整個控制性能看起來會很差設(shè)得太小又無法暴露真實飛行中的問題。合理的做法是先查你所模擬的IMU型號的指標(biāo)再把這些指標(biāo)換算成仿真噪聲參數(shù)。2.4 數(shù)值積分步長與離散化選擇最后是數(shù)值積分。這個工程包里可能同時出現(xiàn)定步長RK4、變步長ode45和離散遞推三種實現(xiàn)方式。我的建議是姿態(tài)控制的主仿真盡量用固定步長的RK4或者直接按離散周期遞推步長取控制周期的一半以下。為什么要固定步長因為控制律是離散的在每個控制周期里計算一次指令。如果仿真積分用變步長ode45而控制律定時更新兩者之間的時間對齊會變得很麻煩步長策略也影響仿真結(jié)果的確定性。固定步長仿真配上控制器的定時中斷邏輯更接近機載軟件的真實運行方式。步長怎么選如果控制頻率是100Hz也就是10ms一個控制周期那內(nèi)部物理模型的積分步長建議至少5ms最好1ms。積分步長太大會引入數(shù)值阻尼導(dǎo)致仿真結(jié)果看起來比實際情況更穩(wěn)定這會掩蓋控制器參數(shù)的缺陷。3. 控制律設(shè)計為什么從PID開始LQR又怎么加3.1 角速度阻尼是整個控制系統(tǒng)的地基在VTVL姿態(tài)控制里最容易犯的錯誤是只做角度反饋不做角速度反饋。例如只用俯仰角誤差給出發(fā)動機擺角指令系統(tǒng)一定會振蕩而且很可能單調(diào)發(fā)散。原因是只反饋角度時控制器相當(dāng)于一個“位置控制器”沒有阻尼系統(tǒng)的特征根落在虛軸附近任何一點擾動都會讓飛行器持續(xù)振蕩。在工程上這個問題用一句話概括就是“先加阻尼再提響應(yīng)”。角速度反饋的物理本質(zhì)是阻尼它把系統(tǒng)的特征根拉向左半平面。所以工程包里的控制器即使是最簡版也是一套角速度阻尼器加角度穩(wěn)定器。角速度阻尼器的實現(xiàn)可以直接把滾轉(zhuǎn)角速度p、俯仰角速度q、偏航角速度r分別乘以阻尼增益疊加到對應(yīng)通道的擺角指令上。調(diào)試時只看一個現(xiàn)象給飛行器一個初始姿態(tài)偏差如果它在沒有外環(huán)的情況下角速度能快速衰減到零阻尼器就調(diào)好了。3.2 姿態(tài)PID的雙環(huán)結(jié)構(gòu)有什么物理意義這套工程包里最常見的控制結(jié)構(gòu)是雙環(huán)PID。外環(huán)是姿態(tài)角回路輸入是期望姿態(tài)角與實際姿態(tài)角的誤差輸出是角速度指令內(nèi)環(huán)是角速度回路輸入是角速度指令與實際角速度的誤差輸出是擺角指令或RCS指令。外環(huán)為什么輸出角速度指令而不是直接輸出擺角指令因為角速度是控制姿態(tài)的一階導(dǎo)數(shù)通過外環(huán)P控制獲得角速度指令相當(dāng)于把姿態(tài)控制問題變成一個角速度跟蹤問題。這樣做的好處是只要內(nèi)環(huán)能可靠跟蹤角速度指令外環(huán)的參數(shù)設(shè)計就變得非常直觀% 外環(huán)姿態(tài)角誤差 - 角速度指令 omega_cmd Kp_att * (att_cmd - att) Kd_att * (att_cmd_dot - att_dot); % 內(nèi)環(huán)角速度誤差 - 力矩指令 Moment_cmd Kp_rate * (omega_cmd - omega) Ki_rate * integral(omega_cmd - omega); % 力矩指令 - 擺動角指令 delta_cmd Moment_cmd / (F * L_cg);調(diào)參順序也很固定先調(diào)內(nèi)環(huán)的Kp和Ki讓角速度響應(yīng)快速且無超調(diào)再調(diào)外環(huán)的Kp讓姿態(tài)角在期望帶寬內(nèi)收斂。一般的準(zhǔn)則是最內(nèi)環(huán)帶寬是外環(huán)帶寬的5到10倍這樣內(nèi)外環(huán)動態(tài)解耦。對于著陸階段的姿態(tài)控制外環(huán)積分項Ki要特別小心。因為在著陸期間如果持續(xù)存在穩(wěn)態(tài)偏差積分項會不斷累積最終引起超調(diào)和振蕩。更嚴(yán)重的是如果執(zhí)行機構(gòu)飽和了積分還在累積退出飽和后就會產(chǎn)生大幅超調(diào)這就是積分飽和windup。工程包里一般會加抗飽和邏輯比如積分限幅、PID輸出限幅或者更高級的條件積分法。3.3 LQR狀態(tài)反饋與PID的等價關(guān)系如果你在工程包里看到lqr這個函數(shù)不要覺得它是完全不同的另一套思路。它其實是在更系統(tǒng)地處理同一個問題。LQR把姿態(tài)誤差、角速度誤差放到一個狀態(tài)向量里通過設(shè)計Q和R權(quán)重矩陣求出一個最優(yōu)狀態(tài)反饋矩陣K使得給定的二次性能指標(biāo)最小。[ u -K x ]Q和R的物理意義是Q增大意味著你更重視姿態(tài)角和角速度誤差的快速收斂系統(tǒng)響應(yīng)更快R增大意味著你更重視控制量擺角、推力不要太大系統(tǒng)響應(yīng)更慢、更柔。在實際VTVL工程中LQR的實用價值有三點。第一它自動處理三軸之間的陀螺力矩耦合不會像三個獨立PID那樣橫滾和偏航打架第二它能直接考慮執(zhí)行機構(gòu)的位置限制通過R權(quán)重調(diào)整讓控制器輸出保持在合理范圍內(nèi)第三它的反饋矩陣K是線性狀態(tài)反饋計算量小適合在機載計算機上實時運行。用MATLAB寫起來非常簡單A [zeros(3), eye(3); zeros(3), zeros(3)]; B [zeros(3); inv(I)]; K lqr(A, B, Q, R);不過要注意lqr需要線性時不變系統(tǒng)而VTVL飛行器的轉(zhuǎn)動慣量、推力、質(zhì)心都在變化。工程上的做法是把它做成“增益調(diào)度LQR”把飛行過程分成若干工作點每個工作點離線算一組K在線根據(jù)當(dāng)前狀態(tài)插值選擇K。這個工程包里如果K是常數(shù)說明它只是給你看控制效果要用于真實場景還得做調(diào)度。3.4 前饋補償重力、推力變化和擺動角關(guān)系純反饋控制在擾動大的情況下會疲于奔命。一個提升性能的簡單手段是前饋補償。最典型的例子是重力前饋飛行器要保持垂直姿態(tài)發(fā)動機推力不僅要提供側(cè)向控制力還必須平衡重力。如果控制器只看姿態(tài)誤差那么姿態(tài)角誤差為零時控制指令可能也為零但此時發(fā)動機擺動角的靜平衡值并不為零因為發(fā)動機要抵消風(fēng)或重心偏移產(chǎn)生的靜力矩。前饋補償?shù)淖龇ㄊ窃诳刂坡奢敵龌A(chǔ)上疊加一個靜平衡擺角。比如風(fēng)擾模型計算出的氣動力矩是M_wind則前饋擺角為[ \delta_{ff} \frac{M_{wind}}{F \cdot L_{cg}} ]這個量加到反饋擺角指令上反饋環(huán)節(jié)只需要處理動態(tài)偏差控制負(fù)擔(dān)大幅減小。工程包里通常會把這部分寫成獨立函數(shù)因為后續(xù)如果要升級成自適應(yīng)控制前饋項可以替換成在線辨識的擾動補償。4. MATLAB工程化落地腳本、Simulink與批量調(diào)參4.1 用腳本實現(xiàn)還是用Simulink實現(xiàn)這個工程包里大概率同時包含腳本和Simulink模型。如果你問我姿態(tài)控制仿真到底該用哪種我的答案是快速驗證算法、批量掃參用腳本完整系統(tǒng)集成、考慮時序和接口用Simulink。腳本方式的優(yōu)勢是邏輯透明、可批量運行、方便用MATLAB的調(diào)試器逐行看。缺點是如果一個系統(tǒng)有多個子系統(tǒng)代碼組織不好會變成面條代碼。Simulink的優(yōu)勢是模塊化尤其是Aerospace Blockset里自帶六自由度運動方程模塊、重力模型、大氣模型、執(zhí)行機構(gòu)模塊可以快速搭出完整系統(tǒng)。缺點是版本兼容問題多換一個MATLAB版本模型可能打不開或布局錯亂。實際調(diào)試時我的習(xí)慣是先用腳本把控制律驗證通過然后把這個控制律原封不動搬到Simulink的MATLAB Function模塊里。這樣即使Simulink模型跑飛了也能確定問題出在模型封裝而不是控制算法。4.2 蒙特卡洛批量仿真與parfor并行加速VTVL姿態(tài)控制是不能只跑一次仿真就下結(jié)論的因為真實飛行中存在大量不確定性。工程包里一般會有一個批量仿真的入口腳本通過循環(huán)遍歷不同的初始偏差、質(zhì)量偏差、風(fēng)場強度、推力擾動等參數(shù)統(tǒng)計姿態(tài)控制的成功率。這就是蒙特卡洛仿真。如果直接用for循環(huán)跑幾百次每個case又包含幾萬步仿真MATLAB會慢到讓你懷疑人生。這時候可以用parfor但要先滿足MATLAB并行計算工具箱的并行池條件。parfor i 1:N % 每組參數(shù)計算一個仿真 results(i) run_single_case(params(i)); endparfor的使用有幾個坑最大的坑是“變量分類”。循環(huán)里的臨時變量會被識別為臨時變量不會傳回主循環(huán)如果你需要把每個case的姿態(tài)曲線都保存下來就得多花點心思。最穩(wěn)妥的方式是每個case只返回一個結(jié)構(gòu)體后續(xù)再匯總。另外如果你在虛擬機里跑MATLAB會發(fā)現(xiàn)整體性能很差這不是代碼問題而是虛擬機缺乏對CPU指令集和內(nèi)存帶寬的原生支持。并行池在這種環(huán)境下更容易出問題所以調(diào)試階段先用單核跑通再上parfor。4.3 結(jié)果可視化到底畫哪幾張圖能說明問題仿真跑完可視化是判斷控制律優(yōu)劣的關(guān)鍵。這個工程包里應(yīng)該有成體系的繪圖腳本但很多人在自己復(fù)現(xiàn)時只畫姿態(tài)角曲線這是不夠的。我認(rèn)為至少要畫這五張圖姿態(tài)角時間曲線俯仰、偏航、滾轉(zhuǎn)看角度跟蹤誤差和收斂時間。角速度時間曲線看角速度是否有高頻振蕩和峰值。發(fā)動機擺角指令與實際擺角曲線看執(zhí)行機構(gòu)是否頻繁飽和、是否出現(xiàn)抖動。推力指令曲線看推力變化是否劇烈。三維軌跡圖看飛行器整體是否按預(yù)期路徑下降和著陸。用MATLAB畫的時候推薦把多張圖用subplot排在一起統(tǒng)一x軸時間范圍。調(diào)試時可以直接從一張總覽圖里快速判斷是哪個環(huán)節(jié)出了問題。如果姿態(tài)角曲線振蕩小而擺角曲線一直頂在限幅處說明控制器輸出飽和需要增大R權(quán)重或降低外環(huán)帶寬。4.4 參數(shù)整定步驟從內(nèi)到外從線性到非線性最后說說參數(shù)整定。面對一堆Kp、Ki、Kd、Q、R新手最容易做的事是盲調(diào)——每次改一個參數(shù)跑一次仿真看曲線繼續(xù)改。這種方法效率極低而且容易陷入“這次看起來還行換一組擾動又不行”的循環(huán)。我建議的整定順序是鎖定執(zhí)行機構(gòu)模型只把舵機擺動角和推力設(shè)為階躍指令驗證執(zhí)行機構(gòu)響應(yīng)是否正常。斷開外環(huán)只閉環(huán)內(nèi)環(huán)角速度回路給定角速度階躍指令觀察跟蹤速度。先調(diào)內(nèi)環(huán)Kp直到角速度上升時間符合預(yù)期再加Ki消除穩(wěn)態(tài)誤差。閉環(huán)外環(huán)姿態(tài)角回路給定一個30度左右的姿態(tài)角階躍指令觀察超調(diào)量。超調(diào)大就降低外環(huán)Kp或者提高內(nèi)環(huán)帶寬。加入風(fēng)擾和噪聲觀察穩(wěn)態(tài)抖振量。抖振過大時優(yōu)先檢查傳感器噪聲是否被控制器高頻放大。最后做蒙特卡洛批量測試看參數(shù)在不同工況下的表現(xiàn)。在MATLAB里你可以用PID Tuner工具輔助初值計算但它給出的初值通常偏保守最后還是要手動微調(diào)。我個人最喜歡的方式是把參數(shù)統(tǒng)一放到一個結(jié)構(gòu)體里配一個參數(shù)表格腳本這樣每次調(diào)參只改配置不用去翻控制律代碼。5. 拿到zip之后解壓、目錄解讀和運行入口5.1 壓縮包的解壓姿勢與常見誤區(qū)這個工程以zip形式分發(fā)很多人第一時間雙擊zip在壓縮管理器里看到幾個.mat和.m文件就直接雙擊打開這是最常見的錯誤操作。MATLAB工程不能在壓縮文件內(nèi)直接運行必須先把整個zip解壓到本地目錄然后通過MATLAB的路徑設(shè)置加載。解壓工具的選擇Windows下我用7-Zip或者系統(tǒng)自帶資源管理器Linux/macOS直接用unzip命令。Linux下最常用的命令是unzip 基于matlab的VTVL姿態(tài)控制.zip -d ~/projects/vtvl解壓后務(wù)必確認(rèn)目錄下的文件都完整特別是.mat數(shù)據(jù)文件和Simulink的.slx/.mdl文件。如果解壓過程出現(xiàn)錯誤后面MATLAB里會報出一堆莫名其妙的“找不到文件”錯誤。5.2 解壓報錯的典型原因與排查鏈路我見過太多人卡在解壓這一步報錯信息看著五花八門其實主要就是下面幾類報錯信息根本原因處理辦法file is not a zip file下載不完整、文件頭被破壞或擴展名錯誤重新下載檢查文件大小是否與源文件一致invalid zip archive: could not find eocdzip壓縮包尾部損壞或文件被截斷用7-Zip打開測試確認(rèn)壓縮包完整性重新下載error opening zip file or jar manifest missing路徑包含中文/空格/權(quán)限問題或文件未被識別為合法zip把文件移到純英文路徑下用管理員權(quán)限解壓解壓后某些文件夾為空壓縮包內(nèi)容缺失或解壓工具過濾了部分文件名嘗試更換解壓工具比如7-Zip這里要特別提醒一下zip文件下載后最好先看大小。如果下載下來只有幾KB甚至幾十字節(jié)那基本不是真正的zip可能是一個網(wǎng)頁錯誤頁面被瀏覽器存成了zip后綴。這種情況下不要在解壓工具上浪費時間直接重新下載。還有一類情況是壓縮包設(shè)置了密碼。如果工程作者在共享時給zip加了密碼而你沒有密碼任何解壓工具都無計可施。這時候只能聯(lián)系作者不要花精力去研究所謂密碼移除工具既不安全也不可靠。5.3 目錄結(jié)構(gòu)里應(yīng)該有哪些文件運行入口在哪里解壓完成后先不要急著在MATLAB里點運行先看一眼目錄結(jié)構(gòu)。一個規(guī)范的VTVL姿態(tài)控制工程大致會有以下內(nèi)容項目根目錄/ ├── README.md ├── main.m ├── config/ │ ├── init_params.m │ └── trajectory_cmd.m ├── models/ │ ├── vtvl_6dof.m │ └── thrust_vector_model.m ├── controllers/ │ ├── controller_pid.m │ ├── controller_lqr.m │ └── observer_kalman.m ├── sim/ │ └── vtvl_sim.slx └── plots/ ├── plot_attitude.m └── animate_trajectory.m運行入口一般是main.m或RUNME.m。打開main.m后你通常能看到清晰的分步注釋初始化參數(shù)、加載模型、跑仿真、畫圖。如果作者規(guī)范一點還會在README.md里寫明MATLAB版本要求、工具箱要求和運行順序。在MATLAB中運行時第一步是把工程目錄連同子目錄加入路徑addpath(genpath(項目根目錄));如果不加路徑直接運行main.m大概率會報“未定義函數(shù)或變量”錯誤。這個錯誤在論壇里被問爛了但每次都會有人踩坑。5.4 運行時的版本兼容和常見報錯MATLAB版本差異帶來的問題比想象中多。老版本寫的腳本用了新版本才有的函數(shù)比如某些工具箱函數(shù)或類定義在新版本跑會報錯反過來新版本提供的腳本在舊環(huán)境里也可能不兼容。如果工程包是用MATLAB R2022b及以后版本寫的而你用的是R2020a出現(xiàn)兼容性問題的概率很高。另一個常見報錯是“無法打開Simulink模型”原因通常是缺少Simulink、Aerospace Blockset或Simscape工具箱。安裝MATLAB時默認(rèn)不會裝所有工具箱這一步需要檢查并補裝。運行Simulink模型時如果出現(xiàn)“Invalid Simulink object name”這類錯誤多半是模型名稱與文件名稱不一致或者模型文件有多個版本。直接在當(dāng)前目錄下輸入模型文件名看是否能打開先排除這個因素。如果仿真時間很長注意看是不是電腦啟用了CPU降頻又沒開并行池??梢韵日{(diào)低仿真終止時間跑通流程后再做完整仿真。6. 調(diào)參避坑手記仿真發(fā)散、歐拉角奇點和推力飽和6.1 仿真第一步就數(shù)值爆炸從哪里排查最讓人崩潰的調(diào)試場景是按下運行姿態(tài)角沒幾十步就直接飛到了幾萬度MATLAB畫圖窗口里全是NaN和Inf。這種“第一步就發(fā)散”的問題絕大多數(shù)情況下不是控制器參數(shù)問題而是模型或接口層的錯誤。排查順序我一般是這樣的檢查單位。角速度是用度/秒還是弧度/秒擺角是用度還是弧度。PID增益對單位極其敏感一個度/弧度混用增益數(shù)值差57倍直接發(fā)散。檢查姿態(tài)更新方程。四元數(shù)更新后是否歸一化歐拉角速率到體軸角速度的轉(zhuǎn)換矩陣是否寫對稱了這里一個符號錯姿態(tài)遞推就是發(fā)散的。檢查控制力矩符號。擺角正方向與姿態(tài)角正方向是否一致。工程里常見的是“正擺角產(chǎn)生負(fù)俯仰力矩”這種定義反饋符號反了整個系統(tǒng)就是正反饋必然發(fā)散。檢查執(zhí)行機構(gòu)限幅。如果限幅寫錯了范圍比如把±10度寫成了±0.1度控制力矩不足以糾正小誤差系統(tǒng)跑飛也是順理成章。排查的技巧是“最小化復(fù)現(xiàn)”把控制器輸出改成一個常數(shù)力矩看一個周期內(nèi)姿態(tài)更新是否正確如果正確再換成簡單的比例控制逐環(huán)加上去。這個方法雖然慢但能精準(zhǔn)定位問題層級。6.2 歐拉角奇異性與角度回繞的隱藏坑前面說過歐拉角在俯仰角90度時會出現(xiàn)萬向節(jié)鎖。VTVL飛行器在正常著陸段俯仰角接近90度反而特別容易踩進(jìn)這個坑。你以為飛行器幾乎直立俯仰角就是90度附近在這個區(qū)間用歐拉角做控制誤差計算誤差會變得極不穩(wěn)定。一個容易忽略的點是角度回繞。如果你的控制器存儲的姿態(tài)誤差是弧度值而姿態(tài)角是不斷轉(zhuǎn)過的當(dāng)誤差從179度變到-179度時直接相減得到的誤差是358度控制器以為要轉(zhuǎn)一個大圈實際只需要轉(zhuǎn)2度。表現(xiàn)在仿真里就是擺角指令突然加倍甚至飽和。處理辦法有兩個一是內(nèi)部用四元數(shù)計算誤差顯示和記錄才轉(zhuǎn)成歐拉角二是對所有角度誤差做wrapToPi處理讓誤差始終落在[-pi, pi]區(qū)間。MATLAB自帶wrapToPi函數(shù)但很多工程里控制律代碼是手工寫的要檢查有沒有做這一步。6.3 推力矢量飽和控制器輸出頂死的處理策略VTVL姿態(tài)控制最容易忽視的一個約束是推力矢量擺角限幅。當(dāng)飛行器初始姿態(tài)偏差很大或者外界擾動很強時擺角指令會長時間頂在±10度的限幅位置。如果這時PID里的積分項還在繼續(xù)累積等偏差減小后積分項已經(jīng)過頭會帶來一股錯誤的控制力矩導(dǎo)致姿態(tài)超調(diào)甚至發(fā)散。抗積分飽和的實現(xiàn)不復(fù)雜常見的有三種積分限幅只讓積分項輸出不超過一個固定邊界。條件積分當(dāng)控制器輸出飽和時停止積分累加。反饋抗飽和把實際執(zhí)行機構(gòu)輸出與指令的差值反饋回積分環(huán)節(jié)讓積分量自動衰減。工程包里如果用了PID大概率至少有積分限幅。沒有的話建議加一個代碼量不大但效果顯著。另外如果擺角一直飽和說明該通道的控制能力已經(jīng)不夠單純調(diào)PID沒用得考慮增大推力、加長力臂或降低控制帶寬。6.4 仿真步長對結(jié)果穩(wěn)定性的影響很多人在調(diào)參時遇到一個詭異現(xiàn)象同一組參數(shù)步長0.01s時姿態(tài)振蕩但能收斂步長0.001s時反而發(fā)散。這種情況不是控制器的問題而是積分算法穩(wěn)定性被步長和控制器延時的組合打破。固定步長離散化后控制回路存在一拍延遲。如果步長太大這個延遲相對系統(tǒng)時間常數(shù)來說就不可忽略等于給回路額外引入了一個純滯后環(huán)節(jié)。純滯后會降低相位裕度導(dǎo)致穩(wěn)定邊界變化。所以遇到步長變化引起結(jié)果大變的情況不是“步長越小越好”這么簡單而是要理解步長與控制周期的關(guān)系。一般建議固定步長取控制周期的五分之一到十分之一??刂祁l率100Hz時仿真步長5ms到10ms通常可用10ms往上是勉強超過20ms基本失真。如果你的模型里有剛性執(zhí)行機構(gòu)動態(tài)比如很強的彈簧約束還需要更小的步長這時可以考慮換用ode15s之類的隱式求解器。6.5 我實際調(diào)參后的幾點個人體會最后說幾個我在實際調(diào)參過程中積累的小經(jīng)驗這些經(jīng)驗書上不一定寫但非常管用。第一姿態(tài)控制器的“柔”比“快”重要。VTVL著陸段對姿態(tài)角速度峰值有嚴(yán)格要求如果為追求收斂時間把增益調(diào)得過高擺角和推力會產(chǎn)生明顯抖動干擾導(dǎo)航和觸發(fā)結(jié)構(gòu)振動。我通常用“無超調(diào)”作為調(diào)參目標(biāo)而不是“最短收斂時間”。第二外環(huán)P增益和外環(huán)帶寬要匹配執(zhí)行機構(gòu)能力。一個有用的驗證方法是做“大偏差測試”給定20度初始俯仰偏差看擺角指令最大峰值是否超過限幅值的70%。如果超過說明擾動稍微變大就會飽和需要降低外環(huán)帶寬或增大阻尼。第三每次調(diào)參都要記錄。把參數(shù)、仿真時間、蒙特卡洛成功率、姿態(tài)曲線峰值存成一個mat文件。批量掃參后復(fù)盤時你會慶幸自己做了記錄否則過了兩天連“這一組參數(shù)為什么好”都想不起來。第四仿真能過的指標(biāo)到了實物里至少留三倍裕度。這個工程包就算跑得再漂亮也只代表仿真環(huán)境下的控制效果。真實飛行里有結(jié)構(gòu)彈性、推進(jìn)劑晃動、執(zhí)行機構(gòu)非線性、傳感器延遲等一系列仿真里沒建模的東西。所以在仿真階段就保持保守別把增益推到極限。這個VTVL姿態(tài)控制工程往大了說是火箭回收和垂直起降驗證機的核心算法分支往小了說就是一套MATLAB下的剛體姿態(tài)控制完整案例。你把它跑通了等于把姿態(tài)動力學(xué)建模、執(zhí)行機構(gòu)建模、反饋控制設(shè)計、數(shù)值仿真和調(diào)參驗證這條鏈路走了一遍。以后換到無人機、導(dǎo)彈、機器人平衡等場景核心思路都是通用的。本文還有配套的精品資源點擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
日本激情五月天‘| 久碰婷婷视频| 91久久综合亚洲噜噜成人在线| VA婷婷| 婷婷丁香宗合888| 天搞天天天天天| 碰97 久| 色色哒五月婷婷六月丁香| 婷婷五月丁香五月| 久久久久亚洲AV成人无码电影| 噼里啪啦完整版中文在线观看| 日日肏天天操| 五月丁香啪啪啪| 久热精品免费视频4| 激情影院丁香五月| 丁香成人视频| 丁香五月婷婷激情123| 婷婷综合一二三| 色色热| 婷婷五月丁香六月| 婷婷丁香激情五月天色色| 91色五月| 天天色·欧美| 夜夜谢天天干| 777久久精品| 国产露脸150部国语对白| 欧美丁香五月| 人人草人人爱手机视频看看| 五月激激网w'w'w| 77777亚洲午夜久久| 六月丁香啪啪| 亚洲超碰在线| 九九99九九99偷拍视频免费看| 操丝袜视频影院导航| 国产超碰人人| 秋霞日本免费毛片A片| 亚洲成av人影院| 久久激情综合| 久久久97| 黄色五月婷| 97色吧| 成人一级片| 天天五月情| 亚洲久久视频| 五月色情婷婷开心五月色情| 丁香五月aV| 色噜噜狠狠色综合网| 丁香婷婷九月在线| 热久精品| 播播网色播播| 开心五月婷婷激情| 性做久久久久久久免费看| 日本不卡中文字幕| 久热这里只有| 免费AV播放| 五月婷婷激情综合网 | 播五月婷婷开心| 女人天堂久久| 97香蕉久久超级碰碰高清版| 激情九月婷婷| 六月婷婷六月天天在线免费| 丁香婷婷免费| 色五月亚洲开心网| 亚洲色五月天| 97超碰综合| 九九热最新地址| 色综合日日| 天天撸夜夜爽| 日本人人xxx| 日韩视频99| 中文网av| WWW.17C亚洲精品| 第四色婷婷丁香五月| 五月丁香激情婷婷综合| 婷婷香五月天| 99国产精品白浆在线观看免费| 色色色五月婷婷| 99燥99日| 五月婷久久综合| 日韩无码专区| 欧美色欲色欲天天天www| 亚洲AV影片在线观看| 九九热精品| 久久精典| 国外亚洲成AV人片在线观看| 中文超碰视在线| 操操操97| 影音先锋 一区| 9久操| 亚洲第二AV| 操久久精| 久久这里只有精品07| 日韩色色色99| 国产乱妇乱子伦| 色噜噜婷婷| 超碰成人黄色网| 亚洲妇女熟BBW| 日韩AV免费电影在线播放| 精品香蕉99久久久久网站| 免费看欧美成人A片无码| 成熟妇人A片免费看网站| 丁香五月激情六月综合| 五月丁香六月婷| 中文字幕,综合,91| 狠狠色丁香| 99玖玖在线视频| 99热大香蕉| 五月丁香啪啪网| 丁香五月天啪啪| 激情都市另类| 日本在线视频www色| 亚洲激情淫网| 秋霞AV淫| 色综合五月| 亚洲亚洲人成综合网络| 99碰网站| 色婷婷五月天天天干天天操天天爽 | 在线另类视频| 色婷婷丁香五月色综合网| 九九婷婷网五月天| 青青久在线视频免费观看| 欧美日韩中文国产一区发布| 亚洲av日韩无码| 久色资源| 99在线精品观看99| 五月婷婷在线视频| 天天干、天天日日| 97操操| 大香蕉久久久久| 激情99| 国产永久一黄| 熟女激情网| 五月丁香婷成人网| 男人天堂99| 大色鬼综合| 久久九九中文字幕| 色五月首页| 久久婷婷网站| 色99免费视频中文| 婷婷丁香五月天中文字幕| Av在线资源| 婷婷六月色丁香视频在线观看| 爽tv | 四川女人毛多水多A片| 97婷婷狠狠久久综合9色| 99热这是里只有精品| 婷婷情爱五月天6| 丁香五月婷婷在线| 丁香婷婷色情| 五月激情六月宗合| 婷婷最新地址| 婷婷六月中文字幕| 九月婷婷久久| 久色网| 日日舔夜夜操| 青青草婷婷五月天| www天天干| 婷婷色色综合| 亚洲国产无线乱码在线观看| 日本一道久久| 99在线精品视频| 日本一级淫| 五月天婷综合| 亚洲va国产va天堂va综合va| 婷婷狠狠青青| 五月丁香色狠狠干大屄| 婷婷五月在线视频| 丁香五月婷婷久久综合激情网| 99热这里精| 超碰99久久| 一级韩国产精品毛| 五月婷婷丁香综合网| 日韩成人电影AV| 色色色在线| 激情五月天com| 北条麻妃九九九国产精品视频| 婷婷九月色| 婷婷丁香五月综合免费视频百花| 五月婷婷激情综合网| 专区无日本视频高清8| 色碰碰| 欧美成人精品一区二区 | 婷婷久久五月| 思思视频这里是精品| 久久久久9| 五月天婷婷色色网| 九月丁香婷婷综合| 久久综合丁香五月| 婷婷激情五月| 久久99热这里只有精品首| a在线观看| 91性交在线播放| aa久久| www.jiujiujiu| 91色久| 欧美成人日韩| 色综合久久综合中文综合网| 激情综合啪啪| 五月天婷婷色| 丁香丝袜五月| av在线免费网站 | 高清无码中文字幕aVDV| www.婷婷五月.com| 激情五月天偷拍综合网| 九九精品99久久久| 99视频内射三四| 婷婷丁五月| 久久精品99| 五月婷婷六月丁香综合视频在线| 色色五月婷婷网| www.minyis.com【JT】国内CDN落地页保证转化QQ2101460746 | 99草在线免费观看视频| 激情五月婷婷在线观看| 淫视馆aV二区一区| 日韩人妻白浆视频系列| 五月丁香六月欧美综合网站| 丁香五月亚洲激情婷婷射| 国产无套精品一区二区| 五月色婷婷激情| 五月婷婷先锋| 久热九九| 夜夜撸日日骑| 99操逼| 亚洲精品色| 五月婷在线色视频| 丁香激情五月| 国产日韩欧美| 丁香激情五月| 69激情小说| 久久久久久18| 色情综合网| 中文字幕 久久9999| 日笨久久网| 中文字幕在线免费观看视频| 99热这里只有精品一区| 日本va欧美va欧美va精品| 国产真人做爰视频免费| 久久大香蕉同僚| 99热综合在线| 色五月婷婷天堂| 欧美日韩成人在线网| 在线日韩视频| 婷婷久久图片| 五月色情| 九九免费视频| 日本色色网站| 日日干干天天干| 久久99看免费| 婷婷大香焦| 91凹凸在线| 伊人久久婷婷五月天激情四射| 日本 色综合| 极品人妻VideOssS人妻| 五月丁香婷婷免费视频| 五月婷婷无码专区| 激情另类综合| 久久婷婷久久| 成人AV综合在线| 99视频精品在线| 久久婷婷六月综合| 天天拍夜夜爽| 99爱在线| 99热9| 国产精品A片| 五月丁香婷婷色色| 色9月| 人人摸人人摸| 九九 激情 网| www.99热这里只有精品| 亚洲五月婷天天操| 99热这里只有精品98| 成人AV中文字幕| 亚洲激情四谢| 九九亚洲视频| 亭亭五月丁香五月天激情| 五月婷婷丁香在线| 天天射夜夜骑| 五月婷婷,六月激情| 伊人久久五月天| 精品AV无码超碰| 五月婷婷六月激情| 亚洲色频| 婷婷伊人网| 亚洲第一综合| 1024成人免费看| 直接看的AV| 色婷婷六月精品| 亚洲一个色| 五月天丁香成人| 久久九九Com| 色婷婷狠狠| 婷婷色色婷婷| 激情www| 婷婷丁香人妻久久在线观看| 操逼123网| 99热日韩这里只有精品| 五月丁香婷婷综合在线| 26uuu.| 这里有精品99| 天天插天天狠| 五月丁香婷婷在线综合蜜桃| 丁香九月激情| eeuss人妻| 婷婷五月天色| 热久久思思热思思| 天天草天天爱| 婷婷的五月天另类视频| 99在线精品免费视频| 色色五月婷| 五月丁香啪啪| 97亚洲视频在线| 五月婷婷色| 五月婷婷综合激情| 天天色综网| 丁香婷婷五月份| 在线播放人妻| 成人做爰A片免费看视频| 色五月激情综合网| 丁香六月在线综合| 激情婷| www久久久久| 1024亚洲| 色五月大香蕉| 东北婷婷五月天| 婷婷五月天首页| 丁香五月六月婷婷殴美综合| va亚洲中文在线| 亚洲狠狠干| 99精品在线观看视频| 五月丁香六月婷婷中文版| 婷婷久久影院| 欧美三级欧美一级| 婷婷五月天国产手机在线视频观看| 久久综合激情五月天| 开心五月激情| www色五月天| 狠狠操狠狠做| 色哟哟精品| 激情久久久久久久久| 九九99九九99偷拍视频免费看| 五月婷婷免费在线视频| 狠狠色狠狠操| 欧洲综合一区| 久久婷综合| 国产色色网站网址| 丁香五月天久久| 久草婷妨| 亚洲成人影视在线观看| 五月丁香色播| 久99久在线| 9l视频自拍九色9l视频自拍九色9l社区| 五月激情啪啪| 影音先锋 萱萱| 综合 蜜月 婷婷| 亚洲、欧美、国产另类笫二区| 思思色播| 丁香婷婷视频| 99久久网站| 最近中文字幕大全免费版在线 | 超碰免费成人| 婷婷射婷婷舔| www.五月.com| 亚洲9久久精品| 无码髙清| 亚洲五月天狠狠| 婷婷五月草| 五月丁香综合激情网| 青青草视频福利| 丁香婷婷激情| 欧美成人猛片AAAAAAA| 99热国产婷婷| 色婷婷a三区麻| 五月丁香91| 夜夜嗨一区二区三区直播内容 | 九九爱这里只有精品| 牛牛碰免费| 色色色色综合| 婷婷99狠狠躁天天躁中文| 丁香五月激情宗合| 婷婷五月丁香欧洲| 影音先锋美国A| 另类在线观看视频| 99热青青草原| 色色色热热热| 天天操天天曰天天射| 千人斩操逼| 99在线视频精品| 免费超碰在线观看| 丁香六月 婷婷六月| 色亭亭五月天丁香综合AV - 百度 - 百度 | av线电影| 日日夜夜天天爽| www.国产色| 五月婷婷亚洲色图| 俺去也在线官网| 久久538| 99视频久久久| 夜夜操天天干| 色婷婷av综合网| 超碰93在线观看| 97很鲁在线视频| 久久久99免费视频| 开心五月天激情网站| 日本三级大片| 深爱激情中文五月天av| 五月色婷婷AV| 丁香五月婷婷六月婷| 丝袜激情网| 天天草婷婷五月| 国产成人av在线播放| 五月婷婷丁香五月| 可以观看的AV| 国产毛片精品一区二区色欲黄A片| 免费九九热| 激情五月色婷婷| av人人操| 五月第四色| 色婷婷五月天av在线| 亚洲天堂亚洲色色色| 婷婷导航| 偷偷狠狠久久婷婷五月天| 久青操| 日韩成人综合| 欧美Va日本Va| 九月婷婷综合网| 久久亚洲精品成人无码网站导航| 成人短视频在线观看| 91九色精品熟女内射| 日韩综合久久| 九九aV| 操九色| 五月天婷婷情色| 这里只有精品视频在线| www.日本91| 色婷婷丁香五月| 色婷av| 一级操逼内射在线视频| 9热在线视频精品| 丁香五月Av| www。久久久久一b。Cc| 天天影视色综合网| 亚洲AV永久无码影院黑人| 天天五月天综合网址| 69综合在线| 激情丁香五月| 噜噜噜噜噜在线| 丁香五月色| 99爱这里只有精品| 五月婷婷久久大片| 国产26uuu| 九九色之九九色之88| 色五月激情网| 99爱视频精品在线观看| 狠狠综合网| 婷婷六月色丁香视频在线观看| 99∨VTV| 伊人六月丁香婷婷| 激情色情五月天| 色日本综合| 中文字幕性爱视频| 婷婷五月天黄色| 久久女婷| 玖久精品视频9| 色约约视频一区二区三区四区五区 | 五月婷在线| 丁香五月天欧洲在线| 99精品视频在线观看| 天天噜天天爱| 狠狠久久婷| 区美毛片子| 五月天激情小说婷婷| 无人区码一码二码三码医生系列| 日日.c| 婷婷久久99| 成人无码髙潮喷水A片| 欧美激情-区二区三区| 91丁香婷婷综合资源| 色婷视频| 色婷婷色情| 视频久久9| 中文字幕在线资源| 先锋资源996| A1片久久| WWW.桔色成人.COM| 激情爱爱网站| 激情宗合网激情五月天| 思思热久久艹| 亚洲成人av中文| 任你爽精品免费视频6| 成人婷婷桔色| 亚洲欧洲午夜成人精品av| 丁香五月综合| 激情综合五| 99久久国产宗和精品1上映| 奇米影视777在线_在线观看午夜_h小视频在线观看_岛国大片 | 色色色在线观看| 99久久a线观| 婷婷五月丁香综合桃花色网| 涩涩五月天| 丁香婷婷六月| 99视频精品全部免费观看| 久久亚洲无码| 免费视频WWW在线观看网站| 免费观看大片视频 丁香婷婷 六月欧美| www激情网站| 成人在线99| 欧美色狠婷久| 丁香婷婷色情| 免费碰碰视频久| 五月婷婷婷婷| 亚洲性视频| 日韩激情人伦人| 丁香色色网| 另类亚洲电影| 白人荫道BBWBBB大荫道| www.婷婷.com| 丁香五婷婷| 5月丁香六月婷婷| 91狠狠综合久久久久久| 丁香婷婷超碰 | 五月丁香六月婷婷综合伊人| 亚洲婷婷在线播放十月| 丁香婷婷色九月| 丁香99| 9l视频自拍9l九色成人| 99综合在线| 成人五月天视频| 九九九午夜影院成人| www99热| 99色视频在线| va亚洲中文在线| 男人天堂伊人五月丁香| 色婷婷狠狠爱| 色播六月| 久久综合中文| 大香蕉久久久久| 99色免费| 色五月大香蕉婷婷| 九月婷婷综合在线| 激情婷婷激情在线不卡| 99在线免费观看| 色五月婷婷影院| 日韩AV片| www.婷婷亚洲基地| 性爱久久| 五月丁香婷婷成人网| 人人人人人人人草| 天天爽夜夜爽| 玖玖资源站视频| 久久这里只有精品无码| 亚洲一区先锋影音| 精品一区二区三区木瓜| 婷婷五月天深爱| 怡红院院在线导航网| 人妻射精AV| 九九热这里只有精品556| 8区视频在线| 人妻aV在线| 日韩精品成人在线| 色综合久久44| 九九热这里只有精品首页| 丁香五月天导航| 婷婷五月四狠狠| 大香蕉久久| 天天骑日日爽| 99色区| 这里只有精品日韩精品| 襙逼网| 狠色狠色综合久久| 人妻久久久久久久| 婷婷五月大香蕉| 日本精品99网站| 另类小说五月天| 成人版视频在线观看| 久草视频一,二三四| 丁香九月激情| 国自产拍偷拍精品啪啪一区二区| 狠狠一日| 亚洲顶级VA在线观看-高清完整版在线影院观看-S022AV | 亚洲国产精品二二三三区 | www99热| 精品久色| 情欲综合网| 性生活久久人妻| 99久久五月婷婷| 人人爱国产| 影音先锋噜一噜| 丁香九月婷| 另类天堂| 国产69久久久欧美黑人A片| 激情四射亚洲| 色色色婷婷| 丁香婷婷色五月| 亭亭五月丁香综合欧美| 欧美综合五月丁香六月婷| 色五月成人网| 九色PORNY自拍成人精彩视频| 五月天婷婷在线AN| 五月天色区| 特黄三级片| 国产欧美精品AAAAAA片| 99热九九九九| 五月婷婷av| 26UUU在线观看| 五月婷婷综合视频| 色色com| 影音 五月 婷婷 久久| www.久久久久久| 久久国产性爱A V| 丁香色综合| 99热在线观看精品| 婷婷五月丁香综合瑟瑟| 99热综合网| 天天操夜夜玩!| 91成人电影| 无码少妇高潮喷水A片免费| 五月婷婷97| 九九激情网| 日韩AAAAA| 婷婷五月色激情欧美激情| 欧美婷婷综合| 99视频综合网| 99热综合色图| 伊人狠狠狠综合| 狠狠色大香蕉| 狠狠干.com| www婷婷| 丁香五月婷婷综合网| 色欧美影院| 婷婷91视频| 亚洲激情av| 五月草视频| 99性爱| 综合色网站| 激情婷婷丁香色五月| 激情五月天 婷婷| 超热久碰.com| 丁香5月婷婷| 亚洲综合五月天| 婷婷操久久| 国产裸舞表演WWWW| 国产无遮挡又黄又爽免费网站| 性视频久久| 六月丁香影院| 色伊人91在线视频| 这里只有精品视频在线观看免费| 婷婷五月激情欧美| 青青日韩| 天天插,天天射| 国产全是老熟女太爽了| 婷婷五月深情丁香深爱日韩| 五月婷婷深深爱| 日日日影院| 五月天综合网| 婷丁五月| 91啪啪视频| 久久激情婷婷| 丁香涩涩爱| 激情综合丁香六| 操国产人妻| 人妻久久久久久久 | 欧美成人色婷婷| 婷婷六月丁香五月图区| 中文字幕日韩无码制服诱或| 久久婷婷五月天| 中文字幕九九九九| 色色丁香婷婷综合| 五月丁香六月综合基地| A在线观看| 91丨九色|PRNY熟妇| 久久综合人妻| 五月天大香蕉AV| 99re热视频这里只精品5| 婷婷六久久| 久99热| 99国产精品久久久久久久久久久| 色欲香综合网| 91九色PORNY肉丝在线| 99热精品在线播放观看| 日韩无码专区| 亚洲国产精品综合色区| 九九久99免费视频| 五月丁香另类图片| 在线视频99| 大香蕉婷婷久久| 日本波多野结衣视频| 亚州性爱99| 九月丁香婷婷网| 色99欧洲色19| 色亭亭丁香五月天| 婷婷色综合| 亚洲激情婷婷| 五月天丁香网| 婷婷日日天天| 色色综合五月| 久久九九@| 综合激情五月婷婷| 亚洲色在线观看| 婷婷色五月噜噜| 男人操女人高潮91视频| 国产精品热搜丁香五月婷婷| 五月婷婷色色爱| 五月第四色| 丁乡久久| 九九99精品| 丁香五月天激情综合网| 九月丁香久久网| 天天婷婷| 玖玖综合色| 99久久黄色顶级视频| 亚洲亚洲人成综合网络| 大地资源色婷婷视频在线| 91精品啪| 夜夜谢天天干| 激情小说 五月天| 丁香五月777| 99热这里是精品| 婷婷五月天手机版视频| 玖玖婷婷色| 日本va欧美va国产激情| 久久婷婷在线| 婷婷五月丁香香蕉| 天天插天天射| 日婷婷久久开心| 丁香婷婷五月天激情四射| 色婷婷丁香五月| 国产精品久久久丁香五月八戒视频| 久久久久久久久久久月丁| 亚洲人妻AV| 99热这里只有精品1998| 99精品人人| 国产成人精品亚洲线观看| 国产无套精品一区二区| 99在线观看亚洲| 色无婷婷| 99久热在线精品| 五月婷婷婷婷婷婷艺术| 黑人无码一区| caop视频| 五月天婷综合| 婷婷六月色情| 无码激情| 特黄三级又爽又粗又大| 五月丁香六月激情综合| 色丁香五月| 色青青五月| 久久婷婷五月天激情四射| 久久九网| 日本丁香五月| 丁香五月欧美| 午夜色丁香| 99久久黄色顶级视频| 色色色婷婷| 亚洲深喉AV| 中文字幕成人| 久久婷婷视频| 五月激情综合深爱| 激情深爱综合| av第一二区| 夜夜嗨一区二区三区直播内容| 五月婷婷九| 思思久日精品视频| 婷婷五月天激情在线观看| 丁香五月婷婷亚洲综合精品| 综久久久| 天天射天天插天天干| www.婷婷| 亚洲综合在线播放| 久久开心五月天激情| 狠狠色性| 天天操夜夜啊| 欧美日朝成人| 欧美在线视频免费播放| 丁香久久激情俄| 黄色视频网站在线播放| 激情综合网五月天| 99九九在线| 色色色热| 色偷偷色婷婷| 婷婷综合激情五月综合| 激情99。| 久久综合丁香| 丁香青青五月天| 99久久婷婷精品视频| 欧美槡BBBB槡BBB少妇| 婷婷狠狠操| 91丨九色丨国产打屁股| 久久综合影院| www.色婷婷| 天天影院色| 亚洲色色香蕉| 九九九午夜影院成人| 婷婷激情五月天在线视频| 婷婷九月色| 丁香婷婷六月天| 日韩操逼大片| 九热精品| 中美日韩成人在线| 久操热线| 开心婷婷五月激情网小说| 亚洲色婷婷| 天天骑日日爽| 日本色婷婷久久99精品91| 国产精品噜噜在线视频| 天堂五月婷婷| 99热亚洲精品66| 99热这里只有精品22| 婷婷五月天激情五月天深爱五月天| www.henhengan| 男女啪啪做爰高潮无遮挡| 丁香激情综合| chaopengdaxiangjiao| 丁香六月丁香婷婷激情| 亚洲中文AV| 在线免费观看激情视频| 另类 在线| 国产1区2区3区| 天天看A片| 99er国产| 这里只有精品69| 欧美丁香婷婷五月天| 色播五月综合网| 中文字幕人妻在线| 丁香五月综合婷婷| 五月激情在线| 成人AV播放| 九九热99熟女| 婷婷激情丁香五月婷婷激情丁香五月婷婷| 天天色综合色色色色色。| 五月天激情无码高清| 日本色色色| 日本爆乳片手机在线播放| 99视频内射三四| 狠狠操狠狠插| 日韩成人电影Av| 五月丁香激情四射| 婷婷5月天激情综合| 狠狠干综合网| 大香蕉综合在线| 五月天激情小说| 夜色.cnm| 夜夜 操无码| 成人精品一区二区三区四区五区| 日本性激情色播| 99热成人精品网站| 婷婷色综合| 色综久久久| 婷婷久久性爱| 中文av网| 超碰在线免费观看3 9| 卡视频1区2区| 7超碰自拍| oVV4WIB3vFi8D| 五月丁香婷婷基地| 91丨九色丨国产打屁股| AV亚洲在线| 久久婷婷网| 淫水导航| 97在线视频观看| 亚洲人成网站999综合| 色久女| 五月丁香综合精品| 色色丁香婷婷综合| 人人摸人人操人人爱| 久久久五月五丁香| 色婷婷久久综合丁香五月| 日韩欧美颜射| www.九月婷婷丁香.com| 97五月天婷婷午夜| 婷婷五月天成人网| 亚洲无码 图片区| www.99久| 五月天啪啪| WWW.久久.COM| 7超碰自拍| 激情5月婷婷| 久久久GOGO无码啪啪艺术| 十区AV| 精品久久久久久久人妻| 婷婷丁香五月天激情| 碰碰碰碰碰99| 天天摸,天天爽| 婷婷的色色五月天| 色都都狠狠色都都色综合色| 丁香六月AV| 中文字幕成人影视| 大香蕉丁香五月| 狠狠色丁香综合| 婷婷色九月| 97色碰碰公开视频| 国产欧美婷婷五月| 婷香五月激情视频| 伊人综合色干| 日韩AV大全| 97在线观视频免费观看| 99在线精品观看99| 五月天婷婷网站888| 99干在线视频| 丁香五月第四色88| 日本天天操| 91日本在线| 激情六月天婷婷| 亚洲婷婷综合视频| 99热99干| 一本大道伊人AV久久综合| 久碰视频| 婷婷中文字幕| 亚洲综合婷婷五月| 久色激情| 人人操人人看97干| 乱色色色| tingtingseav| 蜜臀嫩草| 欧美A片在线视频免费观看| 婷婷丁香五月天综合网| 色偷偷五月天| 天天激情综合| 99热97| site:901-07.com| 99天堂网| 密视AV综合在线| 玖玖资源在线视频| 香蕉五月婷婷| 精品久久人妻| 综合久久伊人| 婷婷在线播放| 啪啪操超碰| 欧美激情VA永久在线播放| 97碰成超视频免费视频| 激情综合激情综合| 99色精品| 爽极品色| 色色色国产| 99热国产这里只有精品| 99无码视频| 99爱爱| 这里只有精9| 久久婷综合| 成人婷婷五月天| 粉嫩AV久久一区二区三区| 青青草护士中出内射-欧美电影在线天堂新版| 婷婷五月天激情网| 婷婷五月天色| BBWCUCKOLD精品熟妇| 天天色综合色| 182tv992tv人之初午夜免费观看| 五月激情丁香| 久久精品天| 麻豆雪千夏| 91碰超| 成功精品影院| 丁香五月婷婷呀| 亚洲一区二区色图-亚洲精品国产精品乱码-成人AV | 狠狠久久婷五月| WWW.天天日| 性爱久久| 99re视频精品| 免费亚洲成人电影AV| 伊人玖玖婷婷| 婷婷综合网| 婷婷伊人綜合中文字幕| 五月激情黄色小说| 日本123区日韩欧美不卡在线看| 综合视频久久| 丁香婷婷五月天色综合| av在线播放网站| 色色色色热| 91精品久久久久| 欧美精品在线观看| 五月丁香六月婷婷综合网站| 91尤物九色在线| 五月天激情网站| 国产日日夜夜操| 日91高清无玛| 婷婷五月激情小说| 亚洲情a| 色天堂在线| 成人无码髙潮喷水A片| 十月丁香九月婷婷综合| 婷婷综合网站| www免费在线视频| www.yw色| 日本色婷婷综合| 五月婷综合| 五月天婷婷社区| A网在线欧洲| 久操无码| 日韩专区五月天婷婷丁香| 丁香久久综合| 天天操夜夜夜拍拍拍| 欧美色偷拍| 99色在线| 性综合网| 六月婷婷七月丁香| 日本成人综合| WWW.亚洲无码| 久月婷婷| 五月天综合婷婷| 99综合网| 久久五月婷婷视频| 免费观看18视频网站| 激情五婷网| 亚洲性爱干干| 色婷六月| 久久婷婷青青草| 婷综合| 五月婷婷天| 美女天天艹人人爽| 综合伊人久久| 色婷婷六月| 激情五月天小说网| 色婷婷的五月天| 色高清无码视频| 超碰人人操人人干| 九色综合网| 丁香婷婷久久 | 五月天亭亭俺也| 九九热在视频| 九九久久精品| 秋霞av不能| 综合欧美五月婷婷| 五月丁香综合| 亚洲操操操| 狠狠干伊人| 精品人妻在线| 五月色婷婷夜色| 国产精品久久久久久久久久| 成人婷婷| 婷婷五月天在线综合| 激情精品久久| 久久精品爱爱| 婷婷丁香宗合888| 日韩久综合| 91九色 熟| 久久色大香蕉| 日日爽夜夜爽| 96丁香六月婷婷蜜桃综合久久| 欧美Va婷色| 五月天色婷婷小说| 日韩砖区| 狠狠五月天| 五月丁香偷拍| 丁香五月天电影| 婷婷成人五月天成人文学小说| 婷婷六月爽| 很很色丁香久久停停| 97人人操com| 久久久宗合视频88| 国产精产国品一二三在观看 | 超碰婷婷色| AA片在线观看视频在线播放 | 五月天婷婷情色| ady狠狠入| jiuse91在线| 色婷婷久久9.com| 五月婷婷先锋| httpwww色com日本| 婷婷五月综合社区在线| 9久久狠狠的| 超碰在线50| 色www久视频| 99爱在线视频| 久久久婷婷婷| 国产精品18久久久| 欧美在线视频99| 免费观看欧美成人AA片爱我多深| 丁香五月天啪啪| 国产欧美熟妇另类久久久| 99热最新网址| 国产69久久久欧美黑人A片| 久久婷婷五月天| 播播网色播播| 久99热| 97夫妻超碰| 激情亚洲五月| 亚洲欧美国产A片免费观看| 九九久久腿| 国产精品成av人在线视午夜片| 97操在线| 久久曰9| 五月丁香久久婷| 99热www| 91精品综合久久婷婷九色| 日本乱论99| 91精品婷婷国产综合 | 色青青视频| AV五月婷婷露脸| 五月婷婷激情五月| 大香蕉婷婷色| 五月婷婷,六月丁香| 狠狠干狠狠干| 日韩AV免费电影在线播放| 久久99草五月婷婷| 六月丁香婷婷大香蕉| 久久激情五月婷婷| 久久免费精品小视频| 97涩涩丁香五月天| 日本五月视频| 99色五月| 狠狠干婷婷| 激情五月黄色| 97人妻人人| 六月丁香久久| 99热这是里只有精品| 99久久久| 97干在线观看视频| 婷婷综合激情| 久久丁香综合香蕉| 五月天色色婷婷| 丁香久色| 99热在线精品观看| WWW久久久| 精品国产乱码久久久久夜深人妻| 五月激情久久| 成人 在线 日韩| 六月婷婷私欲| 操骚货在线| 久久五月婷| 成人精品免费在线观看| 久草五月婷婷| AV 3P| 亚洲婷婷基地| 天天综合色| 99热销国产这里有精品| 黄色大片又大粗又爽| 新精品99| 9色视频在线| 97亚洲视频在线| 在线观看中文字幕亚洲| 日韩成人精品中文字幕电影| 久久99精品久| 无码se| 日本激情五月天‘| 成人丁香五月| 5月丁香综合图区| 狠狠色综合网| 深爱激情av| 久热99| 丁香五月花影院| 超碰男人色| 99热精品一| 任你爽免费视频| 影音先锋男人AV资源站| 激情综合婷婷| 99re这里| 激情五月天网站| 国产美女主播vip| 99久久国产宗和精品1上映| 色五月综合在线| 成人AV在线电影| 啪啪东京热| 五月丁香好婷婷A片网| 五月色丁香| 五月丁香六月激情欧美综合| 99这里| 91精品91久久久中77777久久玖玖九九| 99视频这里只有免费精品| 天天舔天天操| 激情婷婷| 97热精品| 这里只有精品69| 开心五月婷婷| AV在线观看网站| 天天操夜夜爱| 日日做A爰片久久毛片A片英语| 中文字幕综合网| 天天激情| 五月婷婷很很色| 丁香婷婷六月婷婷六月婷婷六月婷婷 | 婷婷丁香五月色偷偷| 婷婷五月天香蕉| 99精品成人无码A片观看金桔| 国产操碰| 五月丁香啪啪| 伦乱人妻| 婷婷六月天精品| 五月丁香激情综合网| 婷婷综合97| www.婷婷五月天| 天天综合网色欲香| 天天综合天天玩夜夜玩天天玩夜夜玩 | 97色色色视屏| 亚洲色网址| 五月婷婷中文字幕| 色色亚洲| 中文字幕av亚洲| 丰满熟女人妻一区二区三| 26uuu色五月| 五月婷婷成人w| 国产亚洲精品AAAAAAA片| 99久久9| 啪啪啪大香蕉| 婷婷伊人网| 涩综合网| 婷婷丁香九月| 中文AV在线观看| 蜜桃婷婷狠狠久久| 午夜九九九九九九九九九九九九九| 免费观看高清无码| 激情五月天色婷婷| 久久久久久久久久久-久五月天婷婷| 五月天激情小说电影| 99性爱视频| 五月婷婷偷| www.色婷婷| www.激情五月天.com| 成人 在线观看国产| 男人大jjc女人免费视频| 五月情综合| 99热在线观看| 婷婷五月天Av| 六月成人网| 五月丁香婷庭在线| 婷婷色色网站| 99热日韩| 久热精品9999| 天天插天天爽| 国产高潮白浆一区二区| 婷婷五月天电影区小说区| 婷婷日本色| 亚洲激情婷婷| 色婷婷五月综合在线| 久热91精品| 色婷婷狠狠爱| 国产毛片欧美毛片久久久| 日 日干 日日做| 色五月丁香91| 六月丁香色婷婷| 日本操片| 高清无码视频网址| 成人va在线观看视频| 国产伦亲子伦亲子视频观看| 小视频aaa久久久| 五月天丁香婷婷网| 婷婷六月丁香五月| 天天综合 99久久婷婷| 日本三级中国三级99人妇网站| 色婷婷丁香五月| 久久99综合| 噜噜噜精品欧美成人在线观看| 亚洲一级 片内射网站在线观看| 真实亲子乱子伦高清在线观看| 7777国产盗摄农村女人| 天天操婷婷| 91久久99久久91熟女精品| 亚洲精品亚洲人成人网| 天天干天天操天天爱| 色99网| 国产XXXX搡XXXXX搡麻豆| 精品色色网| 日本A片一区| 91人妻人人做人碰人人爽九色| 色五月综合| 97 天堂| 天天操天天操天天操天天操天天操天天操天天操天天操天天操 | 操一区| 丁香五月婷婷精品视频| 丁香六月综合| 狠狠操综合| 青青.com| 97碰碰九九视频| 婷婷五月香蕉| 都市激情五月婷婷综合| 91精品国产综合久久蜜芽解析速度| 亚洲免费婷婷| 五月综合六月婷婷|