欧美成人午夜精品久久久,国产?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
返回資訊列表
久久精品婷婷| 波多野结衣AV无码Porn| 一本大道熟女人妻中文字幕在线| 天天激情夜夜干| 久久99久久99精品,久国产,久久精品免费,99久在线,久久久久国产精品免费网站,9 | 丁香五月天啪啪| 99热 免费| 久在线88综合| 熟女激情五月天 | 久久精品噜噜噜成人A∨色欲| 婷婷开心综合人妻小说网址| 97婷婷丁香五月天激情图片| 久9热| 色婷婷丁香五月天在线视频| www.婷婷com| 99热这里只有精品86| 婷五月天| 国产一级片色色| 五月天激情小说欧美激情| 久久亭亭电影| 精品国产乱码久久久久久免费| 蜜臀av无码久久久久久久久| 丁香五月激情综合久久| 久久婷婷五月综合激情国产| 青草久久五月婷伊人| 欧洲MV日韩MV国产| 色色色五月婷婷| 婷婷婷婷婷婷婷五月丁香| 色香久久| 婷婷之玖玖| 亚洲日韩乱码一区二区三区四区| 99ri视频在线播放| 婷婷久久草| 五月天综合网| 中文字幕av在线| 六月色婷婷欧美| 久操福利| 草一草avb| 成人精品免费在线观看| 五月色综合| 66色在线日韩| 超碰猛烈的性猛交| 噜噜干日本| 夜夜躁爽日| 丁香六月天婷婷在线| 少妇AB又爽又紧无码网站| 天天视频亚洲| 99热的无码| 六月婷婷视频| 中文aV网| 婷婷开心激情五月激情网| 六月撸婷婷| 久久香视频| 96丁香婷婷九月蜜桃综合久久| 天天草天天爽| 人人澡玖玖一| 9|无码久久久久久| 玖玖爱资源站| WWW.99热| 婷婷五月丁香综合| 991精品在线视频| 久久人妻视步| 开心婷婷丁香五月| 小色小蛇伊人婷婷色香五月| 风流少妇A片一区二区蜜桃| 99热这里只有精品33| 国产亚洲色婷婷久久99精品91 www.riverspirits.org www.hnnun.com www.changh | 欧美性生交XXXXX无码小说| 日本婷色| 狠狠香蕉| 五月丁香网站| 亚洲欧美成人在线观看| 日产精品一线二线三线芒果| 国产欧美精品AAAAAA片| 亚洲热视频| 丁香五月天成人网站| 99热欧| 丁香五月视频在线观看| 99热在线爱| 另类天堂| 久久亚洲色导航| 婷婷五月天激情综合婷婷五月天激情综合| 婷婷丁香激情五月天色色| 亚州精品色情无码A片| 丁香婷婷综合喷| 激情丁香久久| 九九精品re免费视频| 久操操| 丁香五月社区| 五月天伊人av| 婷婷色日本| www.六月丁香看AV| 五月丁香91| 粉嫩av懂色av蜜臀av熟妇| 婷婷干五月综合在线播放| 九九99视频精品| 99亚洲大片精品永久在线观看| 97色色婷婷| site:xmssd.com| 深爱激情五月天色婷婷| 韩国久久少妇视屏| 久久性爱视频| 热99玖玖99玖玖99九九| 久久密臀婷婷| 综合欧美五月婷婷| 色婷婷亚洲五月天| 日产精品一线二线三线芒果| 欧美性猛交XXXX乱大交极品| 最近中文字幕2019视频1| 五月天啪啪| 国产69久久久欧美黑人A片| 久久激情综合| 日本99婷婷| 九九99九九99九九99视频网| 九九伊人网| 他改变了拜占庭| 日韩婷婷五月| 天天天天天天操| 丁香五月欧美午夜视频| 婷婷刺激综合| 久久桃花网色婷婷| 天天色综合天天| 色婷婷丁香五月色综合网| 精品九九视频| 丁香五月欧美激情| 99ri精品在线观看| 欧美激情Va| 色综合色色色色色| 丁香五月AV| 密视AV综合在线| 激情影院内射| 丁香五月欧美激情| 久久综合九色综合97婷婷| 色婷婷小说| 大香蕉九九操| 婷婷五月18永久免费视频| 国产VA亚洲VA96| 亚洲操b| 色综合网页| 久久丁香婷婷五月天| 欧美97色| 久久 天天| 丁香性爱在线视频| 久久综合热17c| 色色日本| 欧美日韩婷婷五月天| 中文字幕久久婷九女同| 99久久免费性爱视频`| 婷婷天天舔| 久久99精品久久只有精品| 96精品久久久久久久久| 国产XXXX搡XXXXX搡麻豆| 国产精品成av人在线视午夜片| 久久成人亚洲欧美电影| 五月婷婷黄色| 另类小说五月天| 五月丁香六月婷婷综合| 九九99热| 婷婷亚洲综合| 久婷自拍视频| 天天综合中文| 日本久碰| 丁香五月激情视频在线| 99热最新网址| 久久九九热re6这里有精品| 色综合久久综合| 色五月婷婷激情五月| 五月丁香在线观看| 小泽玛利亚视频一区二区| 婷婷香香五月| 色五月涩涩婷婷| 99cao婷婷| 日日干日日s| 激情综合五月| 91视屏在线观看com.wwwvv| 综合网激情| 成人久碰| 五日激情综合| 九九自拍网| 色偷偷五月天| 五月丁香综合中文| 97香蕉久久超级碰碰高清版| 99操不停| 99在线观看精品视频| 天天日天天舔| 很很干在线视频| 久久婷婷六月综合| 五月丁香六月激情综合啪啪| 99碰碰| 大香蕉99热| 久久综合影院 | 五月天第四色开心色播| 99热综合网| 五月天色色色网| 五月停停激情网| 日日爽夜夜爽| 日本在线噜噜| 久久久九九视频精品18| www.五月丁香av| 国产毛片精品一区二区色欲黄A片| 天天操加勒比| 丁香五月婷婷基地| 五月婷婷综合潮喷| 91久久久久久久久久| 六月天无码网址| 97超碰,人人舔,人人操,人人摸| 综合色色婷婷| 日本熟妇乱妇熟色A片蜜桃| 五月天堂色| 亚洲综合九九| 玖玖国产视频一区| 久久加勤综合| 六月丁香av| 久久9久久| 激情五月天综合网| 99久久a线观| 91se视频| 精品成人在线观看| 色天天综合色| 婷婷综合影院| 久久久久9| 九九热这里只有精品12| 熟惀91九色在线| 天天色宗合| 久久婷婷五月综合啪| 亚洲五月停停| 99热成人精品| 99超碰在线免费| 97久久超碰| 天天做天天爱天天爽在| 亚洲欧美日韩VIP| www.婷婷.com| AAAA亚洲| 婷婷六月视频| 天天日天天插| 成人精品人妻| 操日挥操日日| 久久机热这里只有精品免费视频| 日欧一片内射VA在线影院| 中文无码婷婷| 久久这里只有精品无码| 五月天另类小说久久小说网| 精品无吗va视频免费观看| 婷婷天天五月天| 97五月久久丁香婷婷| 99re久热只有精品6在线直播.com| 丁婷婷五月天在线播放| 亚洲天堂热| 成人在线观看精品| 色婷婷电影网| 天天爱天天狠天天透| 激情婷婷综合网| 伊人婷婷五月天| 综合婷婷五月丁香在线观看| 精品视频网| 一本色道久久综合狠狠躁小说| 天天日天天干天天爱| 一本大道熟女人妻中文字幕在线| 天天日夜夜夜操操操操| 99热色婷婷| 超碰a女人的天堂| 大香蕉精品视频| 欧美天堂婷婷日韩| 精品久热| 五月丁香婷婷啪啪| 久久综合影院 | 久久五月天激情婷婷| 国产成人精品亚洲线观看| 我要色综合五月婷婷| 亚洲欧洲另类| 婷婷五月综合激情| 天天舔天天摸天天透| 六月丁香成人| 天天色五月婷婷91久久久久久久| 中文字幕成人| 婷香五月| 五月天婷婷AV| www,天天干| 99在线观看这里都是精品| 色播jjjj| 国产毛片精品一区二区色欲黄A片| 五月丁香做爱视频| 狠狠干思思热| 久久五月丁香激情综合| 九九九色综合| 丁香九月综合| 成人在线不卡| 亚洲精品国产成人AV在线| 成人精品视频99在线观看免费| 思思w99| 五月婷六月综合在线观看| 殴美97色| 97超碰99热99| AV在线收看| 99国产99| 91丨九色丨国产| 人妻丰满精品一区二区A片| 婷婷五月天开心激情网| 婷婷五月天成人动漫 | 日韩黄色影院| 九久久九精品视频| 1级欧美日韩| 婷婷俺去也| 欧美婷婷| 激情小说五月天| 精品思思久久| 婷婷丁香射射| 激情婷婷丁香色情五月天| 99色精品| 久久久久99精品成人网站| 丁香六月综合激情| 99热最新网址| 久久婷婷五月综合色欧美| 九九色大香蕉| 99久在线精品99re8| 五月婷婷激情四月| 色色色网站| 狠狠色综合精品视频在线| 婷婷五月天无码熟女| 久久男人网婷婷| 亚洲精品第一色色色色色色| 精品一二三区久久AAA片| 丁香五月六月综合激情| 免费观看欧美成人AA片爱我多深 | 新激情五月天色播| 九九爱激情| 久久草大香蕉| 少妇AB又爽又紧无码网站| 五月综合激情| 思思热在线视频精品| 中文字幕综合网| 91天天操天天干天天射| 色五月婷婷网| 在线视频你懂得| 国产无套精品一区二区| 成人电影AV在线观看| A网在线欧洲| 五月婷AV| 久操大| 色婷婷香蕉| 狠狠色色| 九九热99久久99| 美女网黄| 五月天婷婷色播| 丁香五月无码| 开心五月婷婷婷美女| 99精品视频免费观看,| AV伊人青草丁香六月| 天天婷婷操| 亚洲狠狠狠| 99无码精品| 好色婷婷| 国产精品色| 激情五月丁香五月色| 六月丁花香啪啪激情欧美| 蜜桃五月天| 综合色色综合| 亚洲综合色网| 超碰天堂网| 丁香五月欧美激情| 五月涩涩网| 亚洲丁香网| 五月香婷婷| 97极品在线| 大香蕉九九| 日比视频91| 99手机在线精品视频| 九九99偷拍视频| 色综合区| 欧美婷婷精品激情| 亚洲国产精品VA在线看黑人| 婷婷五月丁香四射| 丁香六月 婷婷六月| 开心久久xxx色| 99热最新网址| 天天日天天操心| 五月婷婷先锋| 激情网站五月| 欧洲亚洲最新精品| 五月天成人综合| 九九RE视频在线精品| 色欲丁香| xxx.色婷婷| 99这里有精品视频| 久久在线大香蕉| 五月婷婷开心色伊人| 狠色狠色狠色狠色狠色网| 丁香激情六月天婷婷| 欧洲第一久色| 丰满老熟妇BBBBB搡BBB| 免费V片在线| 丁香五月网络网络| 色婷婷九月| 热久久婷婷| 伊人五月人妻精品| 丰满人妻一区二区三区| www.com任你艹| 婷婷黄色五月天在线视频| 六月丁香色婷婷| 99热91| 日本九九网| 天天成人综合视频| 中文字幕成人| av九九| 99激情在线| 久久香蕉福利| 亚洲精品又粗又大又爽A片| 九九操操| 亚洲A片成人无码久久精品青桔| 丁香五月综合婷婷| 综合久久十三| 人妻熟妇国产精品| 久99热| 色综合久久88色综合天天99| 天天爱综合网| 欧洲不卡视频| JlZZJlZZ8JlZZ亚洲熟女| 人妻videos人妻高清| 色屌丝中文字幕| 日逼免费视频 | 久香草视频在线观看| 五月丁香啪啪啪| 成人五月天在线观看| 97热视频| 天堂草在线看www| 97色色婷婷| www.99色在线| 超碰99在线| 99色网站| 五月婷婷伊人久久| 天天操夜夜爽天天操| 99视频只有精品| 狠狠五月天婷婷激情网。| 亚洲电影在线观看| 香蕉综合在线| 99这里有精品视频| A A色色| 人人澡玖玖一| 久久99久久久| 4438亚洲欧美| 婷婷五月花| 99视频在线观看网址| 金品在线视频99| AA片在线观看视频在线播放| 一级黄色尤物综合视频手机在线观看| 99热99思午夜精品| 国产成人网址| 超碰9在| 精品综合网在线| 色综合九九| 79色色| 人妻系列久久久久久久久久久| 深夜婷婷 丁香| 五月丁香六月激情欧美综合| www国产亚洲色婷婷com| 色色狼人综合| 亚洲久艹| 国产44页| 777久久久| 婷婷丁香18| 五月婷婷色色| 久久这里只有精品8| 丁香五月精品视频| 九热视频| 99免费综合网| 操人无码| 操碰91| 激情国产五月| 99热在线观看成人| 中文字幕丰满乱孑伦无码专区| 舔色婷婷| 狠狠五月天婷婷| 大香蕉久久伊人婷婷五月丁香| 电影91久久久| 99精品视频在线观看| 婷婷五月天伊人| 桔色成人在线| jiZZdr| 激情五月色播五月| 四色五月婷婷| 成人av在线网站| 色五月综合| 夜夜操,天天撸| 婷婷五月天香蕉| 激情丁香五月婷婷啪啪| 六月丁香成人| 色人久久| 丁香五月婷婷丫| 99在线爽| 丁香婷婷色五月天| 五月婷婷六月丁香在线视频免费在线观看| 亚洲精品婷婷| 91精品综合久久久久久五月丁香| 日狠狠| 伊人色综合网| 人人干av| 婷婷色色网站| 色色丁香色五月| 香焦网五月天| 99re这里只有精品免费| 大香蕉啪啪啪| 天天综合天天玩夜夜玩天天玩夜夜玩 | 激情婷婷在线中文字幕| 激情电影五月婷婷| 久久免费少妇高潮99精品| 五月天激情久久| 狠狠狠狠狠狠狠狠狠狠狠色宗合图片 | 亚洲AV永久无码影院黑人| 爱久久小说下载网| 成人AV综合在线| 五月天久久www| 国产伦理精品高清在线观看网站一区二区 | 婷婷五月丁香六月天亚洲综合| 日本在线99| 97人人射| 婷婷情色激情| 狠狠综合| 色综合女人99| 丁香5月激情网| 99久久精品网| 五月婷色色| AA片在线观看视频在线播放| 日韩一区二区A片免费观看| 五月丁香大香蕉| 日韩aⅴ视频| 日韩另类| 九九热免费| 淫视馆aV二区一区| 91刘玥视频在线观看| 六月丁香啪| 久久婷色| 婷婷五月中文在线视频| 久热免费| 超碰在线日夜| 久久综合九九| 播播网色播播| 波多野结衣不卡AV| 日韩色色小视频| 丁香午夜天| 99热最新| 91超级碰在线视频| 色欲天天综合| 拍真实国产伦偷精品| 日本强伦片中文字幕免费看| 丁香九月色| 五月天婷亚洲天综合网综合| 婷婷爱婷婷| 亚洲欧洲另类| 1024婷婷综合久久五月天| 99综合久久| 99精色| 狠狠穞A片一區二區三區| 99九九在线精品热动漫| 九月丁香| 99热18| 婷婷伊人久久综合| 亚洲人妻av伦理| 色婷婷国产精品综合在线观看| 操比激情五月综合| 激情六月天婷婷| 激情AV综合| 婷婷五月综合欧美在线播放| 日韩欧美一级大黄网站| 伊人啪啪网| 九艹在线| 综合XX网| 91丨九色熟女丨首页| 色丁香五月天射婷婷爱婷婷| 天堂草在线观看| 精品国产AV色一区二区深夜久久 | 天天做天天双| 99热这里有精品| 婷婷色网站| 成人电影在线免费试看| 久久香蕉影院| 91人人人人人人人| 99爱视频在线免费观看| 99人碰碰碰| aaa9区免费在线观看| 五月丁香无码| 久久婷婷六月综合| 婷婷色五月激情| 国产精品色| 色综合久久88| 96精品久久久久久久久| 开心五月激情网| 五月丁香啪综合| 欧美性爱一区| 九9九9无码| 五月天激情视频| 无码动漫av| www夜夜操| 亚洲国产网站| 99热精品在线| 久久久久激情| 色色五月婷婷| 五月婷婷九| 91久久精品国产91性色TV| 婷婷射综合| 色色色国产| 色九月婷婷综合| 日韩aaa| 99热国产在| 色欧美一级| 日日夜夜小色哥| 久久婷婷原创视频| 亚洲人妻电影| 激情文学天天| 玖玖伊人网| www.色婷婷.com| 91干视频| 夫妇交换刺激做爰| WWW.夜夜| 国产精品操| 99人妻碰碰碰久久久久禁片| 亚洲小电影在线观看黄999| 天天干天干| 婷婷九九| 色www久视频| 俺去也五月| 99热最新精品| 国外亚洲成AV人片在线观看| 九九热这里都是精品6| 91狠狠综合久久久久久| 99九九精品| 国产亚洲成AV人片在线观黄桃| 99精品视频推荐| 天天天天操| 欧美久久婷婷| 99热最新| 26uuu欧美| 色综合色色| 思思色播| 激情啪啪五月天| 婷婷精品| 国产性色蜜乳| 九色视频91| 日B日潘金莲BB| 丁香五月久久| 色综合色色色| 激情五月五月五月婷婷| 天天色中文字幕女优AV| 丁香五月婷婷影院| 狠狠色婷婷在线| 欧美黄色一级| 激情99| 欧美日韩成人在线网| 久久92| 欧美槡BBBB槡BBB少妇| 色婷婷五月天堂资源| av操B网站| 色五月五月婷婷| 激情五月婷| 天天操,天天插| 久久久香| 超碰国产av| www99精品在线观看| 丁香六月欧美| 五月婷婷福利| 欧美丁香六月激情视频| 91色碰| 激情亚洲五月| 最近中文字幕2019视频1| 久久网站免费亚洲| 国产成人av在线播放| 色99在线| 激情第四色| 九九综合精品| 男人天堂99| 99视频精品在线| 五月婷婷自拍视频| 天天操天天日天天爽| 日韩情色在线观看| 日本英国美国欧美亚洲国产精亚洲日韩精品在线观看| 天天日,天天插| 激情久久久久久| www.色五月| 丁香六月色婷婷| 婷婷丁香激情| 这里只有精品在线免费视频| 欧美精品999| 五月丁香久久呀| 婷婷久久18| 狠狠久久婷婷| 欧美激情伊人| 九洲一级A片| 2017人人操| 六月丁香色色色| 99狠狠| 色狠狠色综合久久久绯色AⅤ影视 大香蕉五月天婷婷丁香91 | 综合九九中文字幕| 色播五月丁香综合| 婷婷丁香社区| 五月天丁香婷| 激情婷婷| 六月综和久久| 亚洲麻豆乱码国产2028| 丁香5月激情网| 激情六| www.xtbsty.cn.com蜜乳AV| 五月丁香视频色色| 日韩操逼大片| 色频玖玖五月天| 激情五月激情综合网一级丸片| 天天综合色丁香| 久久 婷婷 五月天| 激情综合女人网五月播播| 99热精品网| 991精品在线视频| 亚洲久久日| 色区久久| 天天噪夜夜爽| 天天爽夜爽| 色欲婷婷五月天| 久色网| 双性美人被调教到喷水A片| 欧美色碰| 99精品在线| 99视频网| 丁香五月婷婷深五月| 丁香六月五月天| 在线观看玖玖资源免费观看| 久久综合婷婷激情| 99热99热不卡| 五月天激情影院| 新激情五月天| 五月婷婷久久综合| 337午夜福利| 超碰人人色| 97人碰人操| 激情九月综合| 天天五月情| 激情五月婷婷| 99热九九九九| 日日日日日| 5月婷婷6月六月丁香| 五月婷婷婷| 裸体做A爰片毛片A片免费| 色色色99韩| Caop在线| 五月丁香花成人社区| 亚洲视频图片婷婷五月| 五月婷婷久久久久| 综合久久五| 高清成人综合| 亚洲成av人影院| WWW99热| 四虎婷婷五月天| 91avse| 三日本无码| 婷婷五月天伊人| 欧美成人va| 欧美色欲色欲天天天www| 午夜福利8055| 色欧洲| 激情人妻综合| 九九热这里只有精品在线观看| 色婷婷狠狠久久YY| 草了bav视频在线观看| 天天干天干| 五月丁香伊人网| 女人露出p毛视频www网站| 成人综合网站| 色五月婷婷老师| 欧美乱码国产一级A片| 五月婷婷高清| 玖玖婷婷五月天| 色色色五月婷| 久久久久久18| 九色激情| 国产黄大片在线观看画质优化 | 91丨九色丨高潮丰满日本| 丁香婷婷久久| 91欧美日韩综合| 一级视频网址| 欧美婷婷丁香社区在线播放| 久久婷婷网| 亚艹艹| 天天日天天做天天操| 色激情五月| 98色丁香五月婷婷综合网| 婷婷中文无码| 久久婷婷五月综合| 五月丁香五月婷婷| 五月丁香六月婷婷激情视频在线观看免费 | 丁香婷婷人妻| 亚洲丁香花色| 激情五月天色色| www.99久| 涩五月婷婷| 亚洲综合视频在线| 六月婷婷七月丁香| 色噜噜五月天| 狠狠第四色| 91.com男女操| 成人五月天丁香| 丁香五月婷婷日本| 狠狠摸狠狠摸| 99精品在线观看| 五月天成人在线播放| 袁子仪视频观看| 久久小视频免费| 九九久久综合| 1024人妻| 精品五月丁香| 亚洲久久视频| 日日干干天天干| 五月婷婷六月奇米网丁香| 99操碰| www.粉嫩av.com| 五月丁香五月丁香| 天天爽天天弄| 婷婷五月天视频小说| 六月色色| 91丨九色丨熟女高潮| 偷拍九九五月丁香婷婷| 色婷婷播放| 国精产品一区二区三区| 青青久久五月天丁香婷婷| 五月婷婷激情| 狠狠色噜噜狠| 牛牛色av| 啪啪激情综合| 99r这里只有精品哦| 亚洲天堂热| 9久精品| www.99热国产| 日本熟女内射| 99ri精品在线| 俺去也五月天| 爆乳熟妇一区二区三区四区| 无码激情AAAAA片-区区| 97久久视频| 亚洲激情四射色| 国内久久亭亭| 桃色Av色哟哟| 天天更新天天亚洲| www.99热这里只有精品| 天天婷婷色六月| 五月天com| 五月天色丁香| 伊人高清无码| 国产婷婷综合| 婷香五月网在线| 国产高清精品色| 日韩超碰在线| 免费看欧美成人A片无码| 99在线精品免费视频| 国产成人精品123区免费视频| 另类视频综合| AV在线观看网站| 国产暴力强伦轩1区二区小说| 91综合在线| 久艹久| 夜夜夜天天操| 99九九精品视频| 五月丁香六月婷婷色情| 丁香婷婷激情五月天无毒不卡蜜桃| 天天色2017| 丁香五月最新网址| 久久亚洲网| 五月丁香六月激情综合| 婷婷九月亚洲| 免费无码毛片一区二区A片| 99精品视频在线观看| 色综合77777| 色婷婷亚洲婷婷| 操啊操av| 色色色综合色| 人妻六月天| 中海油常州环保涂料有限公司| 九九人妻福利| 亚洲操操操| 国产真实乱了老女人视频| 色五月色综合| 久久婷婷激情五月天一区二区| 欧美色骚婷婷五月天| 欧美婷婷五月天综合| 99青青草| 九九这里有精品| 色色色色色综合| 我爱婷婷五月天综合88| 五月天婷婷在线播放| 啪啪 综合网| 99riAV成人在线视频| 五月久久丁香| mmm1717.6dbm人人爱人人操| 人人看人人要| 超碰人人草| 色狠狠999综合| 五月亭亭六月激情| 在线视频激情网站| 九九美女视频| 亚洲性色XXXXX| 99激情视频| 激情五月综合第一页| 噜综合| 五月天婷婷爱| 日韩在线观看亚洲| 99热这里只有精彩| 狠狠干.com| 思思久久精品视频| 色吧五月婷婷| 日本99热| 黄色片区子| 91人碰| 五月丁香六月情| 91综合视频丁香| www。五月天激情| 亚洲综合激情五月久久| 97日本在线播放| 激情五月婷婷在线区| 色五月激情综合| 六月丁香天堂| 激情婷婷五月社区| 久久色午夜在线导航| 久9视频| 狠狠色狠狠| 五月丁香激| 99九九视频| 69精品无码一区二区三区| XXXX岛国| 熟妇天天综合| 日韩野外 无套| 亚洲精品V天堂中文字幕| 婷婷五月欧美| 五月丁香婷色| 人妻日日日| 亚洲色域网| 电影蜘蛛女| www.zbzhongsen.com| 免费观看2018www黄色操逼网站| 伊人网碰碰| 天天爱天天做天天操| 色综合色| 久久久久久久97| 天天射影院| 午夜亚洲AV日韩无码| 久久99精品久久只有精品| 丁香五月综合无码趴趴| 亚洲精品白浆高清久久久久久| 91日韩在线| 五月天婷婷激情| 久久99大| 精品牛仔裤超碰| 97人人干| 99久久er| 五月婷婷综合久久| 久久女婷| 色久一| 国产VA播放| 国产精品婷婷午夜在线观看| 亚洲激情无码久久| 五月婷婷新网站| 操啊操av| 激情综合区| 黄色AAAA韩国guochansanji | 狠狠操狠狠爱| 国产探花AV在线| 五月天激情国产综合婷婷| 久99热| 色婷婷综合久久久久| 九九久久精品| 在线超碰免费| 天天肏视频| 婷婷无码视频| 丁香九月婷| 日日做A爰片久久毛片A片英语| 亚洲国产精品VA在线看黑人| 亚洲精品V天堂中文字幕| www.色五月| 色一情一乱一乱一区9| 欧美日韩国产一区二区| 午夜丁香综合婷婷| 婷婷开心六月| 大香蕉综合在线| 日日噜噜久久婷婷五月天| 男人視頻站| 色五月天天| 97人人搞| 91av成人| 七七九九色色| 9久热免费视频99| 8050一级网| 国产阿姨日皮艹逼内射视频 | 99日本黄站| 涩五月色婷婷| 99五月香婷婷丁香在线视频| 亚洲视频码| 五月六月丁香婷婷在线观看| 丁香婷婷六月激情综合| 老司机日日夜夜青草| 婷婷五月天激情电影| 五月丁香激情综合| 91精品人妻少妇无码影院| 99这里有精品久久97| 俺去也在线官网| 五月婷婷色播| 人人操9| 丁香五月久久综合| 天天日天天插| 九九色大香蕉| 99亚洲精品视频| 99在线视频操999| 婷婷六月激情丁香| 九九AV| 久热这里只精品| 久热91精品| 99热欧美精品| 婷婷情色五月| 色亚洲视频| 五月婷婷综合网| www.jiujiujiu| 色色五月丁香婷婷| 婷婷六月综合| 六月丁香网| 青草青草久9视频在线视频| 九九热精品99| 在线中文字幕视频| 99在线资源| 26UUU欧美激情一区二区| 99国产精品久久久久久久久久久| 91综合在线观看| 五月天五月婷五月激情网| 日本色图综合| 婷婷丁香激情综合色情| 五月婷婷狠狠干| 99热人人艹| 色色色色综合| 99在线视频女女视频| 婷婷色色综合激情| 国产高潮A片羞羞视频涩涩| 91互操| 婷婷五月综合久久中文字幕| 婷婷丁香五月综合网| 99热自拍| 久久久97| 五月丁激情| 日本A片一区| 天天爱天天吃狠天天透| 99久久户外勾搭| 久久99成人性爱高清视频| 天天干天干| 激情丰满熟妇五月| 粉嫩AV久久一区二区三区| 激情婷婷久久| 激情综合网色播五月| 久久无码成人| 五月丁香好婷婷A片网| 婷婷五月天色色| 99热99日…..| www99精品日韩| 丁香五月色欲| 97超碰在线免费观看| 一本色道久久综合狠狠躁小说| 五月天久久色| 五月婷婷官网色| 人人操插| 色综合视频在线| 五月丁香六月激情在线| 欧美日韩国产一二区| 爱草视频在线| 日韩AV中文字幕在线| 五月草视频| 999婷婷综合| www.99热| 久久99热久久99精品| ady狠狠入| 色欲婷婷五月天| VA国产在线综合网站| 91久久久久久久| 九九色99| 丁香婷婷六月天| 国产在线aaa片一区二区99| 久久婷婷青草五月天| 超碰免费人人| 狠狠色婷婷777| 久久香蕉影院| 婷婷色色网站| 啪啪激情网| 伊人久久五月天综合| 丁香五月色激情| 久久99久久99精品免观看粉嫩| 婷婷五月丁香超碰| 99爱精品| 五月婷婷丁香啪啪| 亚洲综合丁香五月| 激情视频综合| 丰满女老板BD高清A片| 伍月激情天| 婷婷九九视频| AA片在线观看视频在线播放| 丁香五月精品| 亚洲视频a| 婷婷五月六月丁香| 天天操夜夜操| 性一交一乱一交A片久久四色| 色丁香五月婷婷| 91精品久| 五月天激情国产综合婷婷婷| 日日肏夜夜干| 九九热视频精品2| 97超碰欧美中文字幕| AV色婷婷| 98毛片| 激情五月小说婷婷| 可以直接看的AV| 国产免费AV网站| 91碰免费视频| 激情五月激情综合网| 久久婷婷五月综合色播| 麻豆忘忧草午夜| 五月丁香六月婷婷啪啪| 国产真实乱了老女人视频| 开心激情站婷婷五月天| 激情超碰网| 日欧一片内射VA在线影院| 天天日综合| 秋霞影音91人妻久久| 丰滿爆乳一区二区三区| 国产精品色色| 一区二区三区四区无码| 97碰碰人人| 91人碰| 久久久久久久久久久久久久久久久精典| 综合99久久天天综合| 人妻在线中文字幕久久| 五月丁香趴趴| 任你爽视频| 97色在线| 丁香婷婷六月| 丁香五月手机在线| 色五月五月天色婷婷色五月| 射婷婷中文字幕| 丁香色色网| 97久久超碰| 婷婷五月情| 高清无码视频网址| 日本色色网站| 婷婷内射视频在线| 丁香五月婷婷AV在线| 99热久只有| 国产亚洲色婷婷久久99精品91| 日韩成人无码| 疯狂做受XXXX高潮A片| 婷婷五月,偷窥偷拍网| 久色五月| 亚洲一区二区无码蜜乳av| 91avse| 丁香婷婷六月天| 婷婷五月激情的图片| 色射7856五月天激情四射| 日韩婷婷| 婷婷五月天福利| 丁香五月天久久| 爱操天堂| www.激情五月天.com| 婷婷五月欧美综合| 99热8在线| 色婷婷狠狠禁久久| 在线看的免费网站| 99久久婷婷五月| 色五月,婷婷大香蕉| 九九一区| 麻豆精品| 97人人操| www.激情.com.| 激情四射五月天偷偷看婷婷| 探花搜索结果 - 黄上黄| 丁香六月成人| 五月天色欧美| 在线观看的av| 精品无码av丁香五月激情| 9191avse| 伊人99热| 呦呦视频无码播放| 色99在线视频| 97在线视频人妻九色| 玖玖在线视| 第五色婷婷| 色135综合网| 婷丁香五月天| 色婷婷五月开心六月综合| 久久九九中文字幕| 九九色逼| 逼逼AV| 五月天婷婷社区| 综合激情五月天| 超碰cap| 另类激情四射| WWW.久久久久久久| 欧美毛片www| 激情婷婷五月| www.激情五月| 亚洲乱码日产精品BD在线观看| 色色com| 狠狠爱深色婷婷综合| 日本三级99人妇网站| 欧美亚洲色色色色| 五月婷婷黄| 亚洲国产精品五月天| 亚洲小视频免费看| 丁香五月激情视频| 亚洲综合激情五月久久| 五月婷婷激情五月| 国产激情视频在线观看| 日本99久久| 影音先锋男人站,影音先锋男人色资源网,影音先锋AV最新资源站,影音先锋AV资源 | 婷婷五月婷婷| 色综合激情图区| 武则天精品久久| 伊人婷婷五月| 人妻内射视频| 99在线精品免费视频| enecarbon-materials.com污K127封锁请涟系@wip1688 | 色婷婷激情五月天| 丁香五月婷婷基地| 五月婷婷色白丝| 777久久综合视频| 狼人狠狠操| 五月丁香本色在线观看| 97午夜一区二区| 婷婷丁香成人在线视频| 色婷婷六月性| 婷婷五月天中文字幕| www.99视频| 成人无码髙潮喷水A片| 碰97 久| www九九热| 天天爽天天| 国产AV一区二区三区最新精品| 婷婷五月成人| 精品国产乱码久久久久夜深人妻 | 激情五月激情综合网| 91男女视频在线观看| 99亚洲精品综合在线| 精品网站:999WWW| 色婷婷九月| 狼人久草| 五月婷婷啪啪| 天天爽天天操| 色婷婷狠狠禁18久久| 狠狠狠狠狠狠色| 欧美啄木乌丝袜人妻系列| 日韩狠狠色| 免费啪啪啪网站| 婷婷六月天亚州| 99婷婷狠狠成为人免费视频| 五月伊人婷婷999| 久久成人天| 97干干干丁香| 色情·com| 九九碰九九爱97| 人人操91| 五月天停婷基地| 色天使久久综合| 五月好婷婷| 色色婷婷综合| 丁香社区婷婷五月| 成人做爰高潮A片免费视频| 丁香婷婷婷| 亚洲va欧洲va国产va不卡| 九月丁香婷婷| aa久久| 人人干人人看| 狠狠大香婷婷爱|