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

ARTICLE DETAIL

資訊詳情

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

STM32F407氣壓計定高四軸實戰(zhàn):從濾波到串級PID完整解析

STM32F407氣壓計定高四軸實戰(zhàn):從濾波到串級PID完整解析 簡介本資源是一套基于STM32F407微控制器的四軸飛行器飛控源碼工程面向嵌入式開發(fā)者、無人機愛好者及高校電賽/畢業(yè)設(shè)計實踐者聚焦氣壓計與超聲波雙模融合定高控制這一核心難點。壓縮包共590個文件含317個C源碼含傳感器驅(qū)動、PID定高算法、電機控制邏輯、88個頭文件定義硬件接口與參數(shù)結(jié)構(gòu)、48個編譯中間文件.o/.d及Keil工程配置.uvproj/.uvopt、啟動匯編cstart_thumb2.asm、固件鏡像.axf/.hex等完整覆蓋從底層驅(qū)動到閉環(huán)控制的全鏈路實現(xiàn)包體大小為8.53MB。已有269人學(xué)習(xí)下載源碼中已集成氣壓計溫度補償、超聲波回波濾波、多傳感器數(shù)據(jù)融合策略及可調(diào)PID參數(shù)表配合ANO調(diào)試工具支持實時高度曲線觀測與參數(shù)在線調(diào)優(yōu)是深入理解飛控姿態(tài)與高度協(xié)同控制的高質(zhì)量參考工程。1. 為什么是F407氣壓計這套方案從姿態(tài)到高度的第一個臺階做四軸定高這件事看起來只是一個“飛控里加一個傳感器”的改動但真正把它從Demo推進到能穩(wěn)定懸停中間涉及的坑比想象中多得多。這篇東西我想把整套基于STM32F407飛控板、ANO飛控框架、氣壓計定高的實現(xiàn)思路和調(diào)試過程完整捋一遍適合已經(jīng)在跑姿態(tài)環(huán)、想往更上層加功能的新手也適合手頭正好有F407板子、想從零把一個定高四軸立起來的人。先交代一下背景。定高這個概念本身不難理解飛機在遙控器不給油門變化的時候高度維持在一個給定值附近。但為什么要用F407而不是更便宜的F103答案很直接F407主頻168MHz帶硬件浮點運算單元FPU跑ADC采樣、I2C總線讀取氣壓計、姿態(tài)解算、串級PID控制四個任務(wù)疊加起來CPU占用率仍然能壓在40%以內(nèi)。F103做姿態(tài)解算還能湊合再加上高度融合、氣壓計濾波、速度估計這些任務(wù)就開始吃緊了尤其在中斷退出延遲上容易讓控制環(huán)出現(xiàn)抖動表現(xiàn)出來就是油門響應(yīng)鈍、懸停掉高度。ANO這套框架我用了挺長時間匿名科創(chuàng)社區(qū)最初開源的ANO_FC就是基于F407做的。它的架構(gòu)清晰度在同類開源飛控里屬于比較友好的那種任務(wù)調(diào)度分成傳感器讀取任務(wù)、姿態(tài)解算任務(wù)、控制任務(wù)、通信任務(wù)。我加定高功能時主要是在傳感器任務(wù)里加入氣壓計采樣和外置濾波在控制任務(wù)里疊加高度/速度雙閉環(huán)思路就是外環(huán)高度環(huán)輸出期望垂直速度內(nèi)環(huán)速度環(huán)輸出期望油門。這一套結(jié)構(gòu)現(xiàn)在很多商業(yè)飛控也這么用只是參數(shù)和融合方式各家有差異。定高四軸的核心價值是讓操作者從“時刻都得盯著油門”里解放出來。飛姿態(tài)模式時哪怕油門打了同一個位置電池電壓從4.2V掉到3.7V電機轉(zhuǎn)速下降飛機就會緩慢下沉有了定高不用人手微調(diào)油門遙控器油門桿只需要管升降方向或者直接交給高度設(shè)定這對于航拍、室內(nèi)懸停、編隊飛行都是剛需。所以這篇的落點不只是“把代碼下載進去能起飛”而是拆開講清楚氣壓計的原始數(shù)據(jù)怎么變成可信的高度、高度怎么變成一個穩(wěn)定的控制量、控制量怎么變成不抖動的油門輸出。2. 硬件選型和飛控板布局氣壓計最容易被忽視的“命門”2.1 飛控板和傳感器選型邊界我用的是ANO系列經(jīng)典的F407飛控板主控為STM32F407VGT6板上集成了MPU6500六軸IMU和MS5611氣壓計。MS5611是個很老練的型號24位ADC輸出分辨率可以做到10cm級實際能穩(wěn)定撲捉到的高度變化約15-20cm量程從10mbar到1200mbar對應(yīng)海拔覆蓋從-1000米到20000米左右家用和航拍機完全夠用。相比之下BMP280雖然便宜但它主要是為手機氣象服務(wù)設(shè)計的氣壓噪聲和溫漂性能比MS5611差了一個檔次同樣是高度輸出BMP280在一米高度上數(shù)據(jù)能抖出±30cm的跳動MS5611同樣環(huán)境下能壓到±10cm這個差距在控制環(huán)里會被放大導(dǎo)致油門來回抽動。因此定高項目里氣壓計首選MS5611預(yù)算特別緊才考慮SPL06。選好氣壓計之外飛控板布局的判斷更重要。MS5611對氣流極其敏感但也怕熱、怕風(fēng)、怕光。在飛控板上它離電源模塊和主控芯片至少要保持5mm以上間距否則MOS管和穩(wěn)壓芯片的熱量會直接抬高氣壓計局部溫度造成漂移。我見過一款山寨飛控把MS5611貼著4A降壓芯片放開機兩分鐘高度數(shù)據(jù)就虛漂了3米。所以硬件到手先做靜態(tài)測試上電后把板子放桌上靜止不動串口打印高度值觀察兩分鐘內(nèi)高度是否漂移超過50cm。如果漂移很大第一懷疑對象不是算法而是板子的熱源干擾。2.2 氣壓計安裝的“遮風(fēng)”與“透氣”矛盾螺旋槳的下洗氣流是定高最大的物理干擾源。電機一轉(zhuǎn)動大量氣流直接沖刷飛控板頂部的氣壓計封裝。MS5611的芯片頂部有一個微小的通氣孔外部氣壓就是通過這個孔感知的。如果不做遮擋處理下洗氣流會形成局部壓強波動高度數(shù)據(jù)會像喝醉了一樣上下亂跳。常規(guī)做法是給氣壓計蓋上一塊密度適中的泡棉泡棉厚度在5mm左右內(nèi)部要有一塊空腔。注意泡棉不是把孔堵死而是緩沖氣流的急變。我試過三種方案方案做法實測效果裸奔不遮氣壓計直接暴露波動±50cm完全不可用薄海綿緊貼2mm薄海綿覆蓋封口波動±20cm仍不夠穩(wěn)空腔泡棉蓋5mm泡棉挖出5x5mm空腔覆蓋氣孔波動±8cm懸停穩(wěn)定空腔泡棉的原理是泡棉本身濾掉高頻氣流擾動內(nèi)部空腔給氣壓變化一個緩沖時間相當(dāng)于給氣壓計加了一個機械低通濾波器。這個方法成本幾乎為零效果卻立竿見影。安裝時還要注意側(cè)面也要遮擋風(fēng)向室內(nèi)開風(fēng)扇測試時側(cè)風(fēng)也會從泡棉邊緣鉆進去影響讀數(shù)。2.3 供電與I2C總線細節(jié)MS5611是I2C接口飛控板上通常作為I2C總線上的唯一或之一設(shè)備。F407的I2C外設(shè)歷史上飽受吐槽很多人直接用GPIO模擬I2C來規(guī)避硬件I2C的怪癖。我的經(jīng)驗是在ANO框架里直接用硬件I2C其實問題不大但必須把I2C時鐘配置在200kHz左右太高的時鐘在長線纜上容易出ACK丟失。另外MS5611的VDD腳要并接100nF和10uF電容這一點很多自制PCB圖省事只放一個百納法電容上電瞬間電壓跌落會導(dǎo)致傳感器初始化失敗串口讀到固定值0x0000排查半天其實是供電不足?,F(xiàn)在我需要強調(diào)一個布局順序飛控板供電一般由分電板或電源模塊通過杜邦線引出線長超過15cm時I2C數(shù)據(jù)線SDA/SCL建議和電源線分開走線避免電機大電流變化在電源線上產(chǎn)生壓降尖峰耦合到I2C線上干擾通信。成品飛控板一般已經(jīng)考慮好了但我見過不少自己改線導(dǎo)致I2C偶發(fā)卡死的情況卡死表現(xiàn)為氣壓計數(shù)據(jù)停止刷新飛控三秒后觸發(fā)失控保護。3. 氣壓計原始數(shù)據(jù)如何變成可信高度從I2C讀取到濾波融合3.1 MS5611讀取時序與代碼骨架先把氣壓計的底褲看清。MS5611內(nèi)部有兩個測量通道壓力通道和溫度通道。它的工作流程是發(fā)送轉(zhuǎn)換指令啟動壓力測量等待轉(zhuǎn)換完成典型時間由OSR決定讀取24位壓力原始值再啟動溫度測量讀取24位溫度原始值然后利用芯片出廠時燒錄的6組校準系數(shù)C1-C6做補償計算得到真實氣壓值和溫度值。我的做法是定高循環(huán)里用讀取優(yōu)先級輪詢的方式每次調(diào)度周期只發(fā)起一種測量然后讀上一次的結(jié)果避免阻塞等待。偽代碼框架如下// 每5ms調(diào)用一次 void baro_poll(void) { static uint8_t state 0; uint32_t raw_press, raw_temp; switch (state) { case 0: ms5611_start_conv(MS5611_PRESS, OSR_2048); state 1; break; case 1: if (ms5611_read_adc(raw_press) 0) { pressure_raw raw_press; ms5611_start_conv(MS5611_TEMP, OSR_2048); state 2; } break; case 2: if (ms5611_read_adc(raw_temp) 0) { temp_raw raw_temp; pressure ms5611_compensate(pressure_raw, temp_raw); state 0; } break; } }OSR過采樣率是個關(guān)鍵參數(shù)。MS5611支持256/512/1024/2048/4096五檔過采樣率OSR越高內(nèi)部ADC積分時間越長輸出噪聲越低但同時單次轉(zhuǎn)換時間越長。用OSR_2048對應(yīng)轉(zhuǎn)換時間約5ms噪聲幅度約0.06mbar折算高度噪聲約0.5米RMS。這個值從原始噪聲看并不算小所以不能直接用瞬時值必須先經(jīng)過濾波。3.2 高度換算與溫度補償細節(jié)從氣壓值換算高度的公式是國際氣壓測高公式altitude (1.0 - pow(pressure / 101325.0, 0.190295)) * 44330.0;注意公式里的101325Pa是標準海平面氣壓。很多人都知道這個公式但忽略了一個重要問題天氣變化和飛行環(huán)境溫度差會導(dǎo)致基準氣壓漂移。所以正確的做法是開機時鎖定當(dāng)前氣壓為H0之后所有高度輸出都相對于H0計算這樣就不需要知道絕對海拔基準公式變成relative_altitude (1.0 - pow(pressure / pressure_takeoff, 0.190295)) * 44330.0;其中pressure_takeoff是解鎖時記錄的基準氣壓。這個邏輯一定要在起飛瞬間鎖定基準否則你在地面站里校準完、通電后放了一小時氣壓變化5米再起飛時高度就偏了。溫度補償同樣不能省。MS5611的補償函數(shù)會利用C1-C6做二階補償保證從-40°C到85°C范圍內(nèi)精度在±1.5mbar以內(nèi)。忽略補償直接拿原始值用的后果是飛控板子發(fā)熱后高度會緩慢正漂移看起來像飛機自己在往上爬定高變成“緩慢爬升模式”。3.3 濾波方案從滑動平均到限幅互補氣壓計原始高度數(shù)據(jù)直接用于控制是災(zāi)難性的。我在OSR_2048下實測原始高度數(shù)據(jù)每25ms跳動大約±0.5米而這個跳動頻率和電機轉(zhuǎn)速、結(jié)構(gòu)振動、機架彈性都有關(guān)系。直接把這個值送進PIDP項會讓油門瘋狂抖動機身高頻率顫抖。基礎(chǔ)處理是滑動平均濾波窗口取20個點每10ms一個點窗口200ms能把高頻抖動壓縮到±8cm。但滑動平均有個天然的滯后問題窗口越長滯后越大飛機從2米快速爬升到3米時濾波后的高度值要拖后將近半秒才到2.8米這個滯后同樣會降低控制穩(wěn)定性。我最終用的是兩級組合先做5點中值濾波剔除離群點再做20點加權(quán)滑動平均最后和加速度計積分高度做一次互補濾波?;パa濾波的思路是height_fused alpha * height_baro (1 - alpha) * (height_prev vel_vertical * dt);alpha取值在0.02到0.05之間。氣壓計負責(zé)長期穩(wěn)定加速度計積分負責(zé)短期響應(yīng)。氣壓計長期漂移但是短期噪聲大加速度計積分短期精準但是長期會漂。兩者互補一個管長期一個管短期alpha就是信任權(quán)重。這套結(jié)構(gòu)跑下來高度數(shù)據(jù)的響應(yīng)延遲從直接濾波的200ms降到了80ms以內(nèi)懸停時高度波動能控制在±15cm左右。關(guān)于加速度計積分這部分多說一句豎直方向的加速度是機體坐標系下z軸加速度和姿態(tài)角的三角函數(shù)關(guān)系需要在姿態(tài)解算算出四元數(shù)后把機體系加速度投影到世界系取世界系z軸方向分量減去1g重力加速度然后再積分。這一步做錯了會導(dǎo)致高度振動最常見的錯誤是忘了減重力。我剛開始調(diào)試時高度融合曲線像波浪一樣上下竄排查半天發(fā)現(xiàn)是加速度z軸沒補償重力項。3.4 氣壓計噪聲診斷先分清是“讀數(shù)噪聲”還是“飛控振動”很多人在定高不穩(wěn)的時候一上來就調(diào)PID其實要先把噪聲源分清楚。排查方法很簡單飛機上鎖放在桌上螺旋槳不轉(zhuǎn)讀取濾波前氣壓計原始高度數(shù)據(jù)序列。如果此時波動都超過±30cm那說明是傳感器自身干擾或硬件布局問題優(yōu)先做遮擋、濾波、電源去耦。接下來螺旋槳油門加到30%不推桿飛機還在地上壓著讀取同樣的數(shù)據(jù)。如果波動顯著加劇那就是氣流沖擊和機體振動通過PCB傳導(dǎo)給氣壓計造成的影響。這時候調(diào)泡棉位置、加橡膠減震柱比調(diào)PID更管用。最后才是飛起來看高度曲線的毛刺確認濾波和融合參數(shù)。這個排查順序能省掉至少兩天的瞎調(diào)時間。4. 定高控制閉環(huán)外環(huán)高度、內(nèi)環(huán)速度與油門前饋的設(shè)計路徑4.1 串級PID結(jié)構(gòu)為什么外層只輸出速度而不是直接輸出油門定高控制最忌諱的就是高度誤差直接映射到油門。這種單環(huán)控制在小型四軸上幾乎必炸因為高度到油門之間的傳遞函數(shù)嚴重非線性同樣高度的偏差電池電壓高時油門修正一點點就夠電壓低時油門加2%都不夠四個電機轉(zhuǎn)速變化對升力的貢獻又受電池內(nèi)阻和環(huán)境溫度影響。所以這里使用內(nèi)外環(huán)串級控制這是工程上被反復(fù)驗證的結(jié)構(gòu)外環(huán)高度環(huán)期望垂直速度 Kp_h * (目標高度 - 當(dāng)前高度) Ki_h * 高度誤差積分當(dāng)高度低于目標時這個值是正的向上高于目標時是負的向下。這個速度指令作為內(nèi)環(huán)的輸入。內(nèi)環(huán)垂直速度/加速度環(huán)油門修正 Kp_v * (期望垂直速度 - 當(dāng)前垂直速度) Ki_v * 垂直速度誤差積分當(dāng)前垂直速度的來源可以用高度差分求導(dǎo)但我更推薦用融合后的垂直速度估計值就是互補濾波里那個積分量因為它減掉了很多氣壓計高頻噪聲讓內(nèi)環(huán)控制的微分項不那么暴躁。整個結(jié)構(gòu)看下來外環(huán)保高度穩(wěn)定內(nèi)環(huán)保高度變化速率這本質(zhì)上是“位置-速度”控制的嵌套抗擾能力強很多。4.2 垂直速度估計與高度微分的取舍通俗解釋高度環(huán)相當(dāng)于開車時看與前車的距離來控制車速速度環(huán)相當(dāng)于踩油門讓實際車速跟上期望車速。如果你只看距離去直接踩油門路一顛簸車就會一頓一頓但你先把距離換成期望車速再一腳一腳微調(diào)油門去匹配這個車速順暢得多。四軸定高也是同一個道理。垂直速度估計用互補濾波里得到的vel_vertical它融合了加速度積分和高度的差分修正。我實際測試時速度估計的延遲在60ms以內(nèi)這足以支撐內(nèi)環(huán)PID控制在120Hz頻率下運行得比較平滑。4.3 油門前饋懸停油門的重要作用定高控制里PID只是修正量真正的力量來源是一個恒定懸停油門基線。這個值是飛機懸停時能穩(wěn)定維持高度所需的油門百分比取決于機架重量、電機效率、螺旋槳螺距、電池電壓每個機器都不一樣。我習(xí)慣的做法手動模式下把飛機飛到1.5米左右基本穩(wěn)住高度讀出遙控器油門通道原始值換算成油門百分比例如遙控器1000-2000懸停油門在1450附近則懸停油門(1450-1000)/100045%。把這個值寫入?yún)?shù)throttle_hover。定高模式下總油門輸出 throttle_hover PID修正。沒有這個前饋PID只能從頭去“找”懸停油門的位置每次起飛懸停點都有偏移就會看到飛機升上去、掉下來、再升上去越晃越厲害。有了前饋PID只負責(zé)修正擾動修正量從±20%降到±5%穩(wěn)定性一目了然。4.4 定高PID參數(shù)整定的實操順序參數(shù)整定必須按“從內(nèi)到外”的規(guī)則來。先只跑內(nèi)環(huán)速度環(huán)把外環(huán)去掉給定一個固定的期望垂直速度比如0.5m/s觀察飛機是否能勻速上升/下降。此時Kp_v從0.5開始加加到期望速度和實際速度的響應(yīng)快、超調(diào)小Kp_v大約在0.8-1.2之間Ki_v加0.1左右用于消除穩(wěn)態(tài)誤差。內(nèi)環(huán)調(diào)好后再啟用外環(huán)Kp_h從0.5開始給一個0.5米的高度階躍比如從1.5米目標高度改成2.0米觀察高度響應(yīng)曲線。理想響應(yīng)是在1-2秒內(nèi)平滑到達目標高度附近在一個窄帶內(nèi)穩(wěn)住不來回穿越。如果高度在目標值附近以明顯的周期震蕩通常K作用不足或I作用過大如果高度到達目標特別慢但最后也穩(wěn)了可以適當(dāng)加大Kp_h和I。我最后落地的參數(shù)組合是高度環(huán)Kp_h1.2Ki_h0.05速度環(huán)Kp_v0.9Ki_v0.1控制頻率外環(huán)50Hz內(nèi)環(huán)100Hz。這個組合在我這個400mm軸距、1080g起飛重量的機架上表現(xiàn)穩(wěn)定懸停高度波動±15cm推力波動小于±5%。換機架時參數(shù)不一定通用但整定順序和現(xiàn)象判斷方法是通用的。5. 實測中的坑與調(diào)參記錄起飛掉高、洗槳效應(yīng)與溫度漂移5.1 起飛瞬間掉高氣壓計被下洗氣流“壓住”了嗎第一次試飛定高時我遇到了一個很典型的坑接通定高模式后飛機先迅速向上躥了30cm然后又突然掉下來接近50cm最后才算晃晃悠悠穩(wěn)住。第一反應(yīng)是PID參數(shù)過激但串口打印數(shù)據(jù)顯示了一個更有趣的現(xiàn)象氣壓計高度在起飛瞬間上升了30cm而實際飛機高度并沒有動。原因是起飛瞬間油門加大螺旋槳下洗氣流沖擊地面再反彈在飛控板附近形成了一股瞬時高壓氣流氣壓計感受到的壓強比環(huán)境高換算出的高度自然往上跳。飛控以為飛機高了就減小油門結(jié)果高度又往下掉。這就是“起飛掉高”的一個重要誘因。解決方法分三層在解鎖后到起飛前不急著把期望高度設(shè)置到當(dāng)前高度可以先記錄起飛瞬間的高度偏移作為基準。油門切換瞬間速度環(huán)飽和限制要加限制期望垂直速度最大±1.5m/s避免高度計算錯誤時輸出極端油門。起飛前在地面晚幾秒再切定高讓氣壓計完成“地面氣流擾動”到“空中流動場”的過渡。5.2 洗槳效應(yīng)低空懸停時的“地面效應(yīng)”非線性在距離地面30cm以內(nèi)低空懸停時定高非常容易抽風(fēng)表現(xiàn)為飛機上下來回竄。這是地面效應(yīng)在作祟近地時螺旋槳下洗氣流撞擊地面后向外擴散相當(dāng)于在飛機下方墊了一個氣墊同樣油門提供的升力會突然變大。這個非線性環(huán)節(jié)和高度環(huán)的PID產(chǎn)生耦合如果PID響應(yīng)太快就會在氣墊效應(yīng)區(qū)域形成振蕩。處理經(jīng)驗是定高高度的生效死區(qū)設(shè)置為±10cm。當(dāng)高度誤差小于死區(qū)時PID輸出保持上一值不變這樣避免微小抖動讓執(zhí)行機構(gòu)來回動作。另外可以降低低空段的外環(huán)P項這點我通過一個高度相關(guān)的增益衰減系數(shù)實現(xiàn)高度小于0.5米時Kp_h按(實際高度/0.5)的平方衰減。5.3 溫度漂移與“假高度”問題定高飛行到第三塊電池時我發(fā)現(xiàn)了一個隱蔽問題飛控在暖機狀態(tài)下高度自己慢慢從1.5米漂到了2.1米但是視覺上飛機并沒有明顯上升。這就是氣壓計溫漂帶來的“假高度”。排查過程很有意思我先是懷疑濾波算法把alpha調(diào)小沒用換成雙濾波還是漂。最后用溫度數(shù)據(jù)一對比恍然大悟MS5611的溫度在開機三十秒內(nèi)從27°C升到42°C溫差15°C帶來的零點偏移足以換算成1米的高程差。雖然傳感器做了補償?shù)寮壘植繙囟忍荻纫廊淮嬖?。解決方案在硬件層面是加大氣壓計泡棉和主控之間隔熱軟件層面有三個補充手段開機預(yù)熱飛控上電后至少等待40秒再解鎖觀察溫度變化速率小于0.5°C/3s時才算穩(wěn)定。溫漂校正建立溫度和高度漂移的查表每30秒記錄一次溫度值和高度值用線性擬合消除相關(guān)性部分。起飛前鎖基準解鎖瞬間重新鎖定初始高度消除長時間靜態(tài)積累的漂移。這個方法結(jié)合之后我測試中連續(xù)飛行8分鐘定高漂移被壓在40cm以內(nèi)主要還是由于正常環(huán)境氣壓變化的部分在可接受范圍。5.4 油門響應(yīng)不平順的排查區(qū)分“傳感器噪聲”還是“控制極限環(huán)”調(diào)試后期遇到另一個怪問題定高時油門總是輕微周期性抽動每0.5秒左右一次幅度大約油門值的3%肉眼可見螺旋槳轉(zhuǎn)速在細微地一變一變的。這個現(xiàn)象持續(xù)存在不是偶發(fā)。通過地面站回看數(shù)據(jù)發(fā)現(xiàn)高度曲線其實很平滑說明傳感器融合沒問題但速度內(nèi)環(huán)的目標速度和控制輸出的差值在周期性波動。進一步分析是內(nèi)環(huán)速度控制頻率100Hz但高度環(huán)輸出頻率50Hz兩個環(huán)數(shù)據(jù)同步時序上差了半個周期導(dǎo)致速度目標指令里面的更新帶有鋸齒狀的臺階內(nèi)環(huán)對臺階比較敏感就產(chǎn)生了0.5秒周期的極限環(huán)。解決辦法是在高度環(huán)和速度環(huán)之間加一級速度指令平滑緩沖用一個二階低通濾波器處理期望垂直速度截止頻率大約3Hz讓高度環(huán)輸出的速度階躍變成平滑斜坡速度內(nèi)環(huán)的抖動徹底消失。如果遇到類似油門周期性抽動不要第一時間懷疑氣壓計先檢查兩個控制環(huán)之間的信號同步和指令平滑這是我調(diào)過眾多飛控后最深刻的經(jīng)驗之一。5.5 調(diào)試飛行過程的記錄方法整個調(diào)試過程中串口日志和地面站數(shù)據(jù)回放幫了大忙。我會在飛控代碼里把以下幾個變量以100Hz頻率輸出nudged高度濾波后融合高度、期望高度、期望垂直速度、實際垂直速度、油門輸出百分比、電機PWM原始值。每次飛完一個架次把日志拉下來用MATLAB離線畫圖圖和圖對照看幾乎每個異常現(xiàn)象都能定位到具體環(huán)節(jié)。記得有一次飛機定高時明顯前傾俯仰看日志才發(fā)現(xiàn)油門修正過程中姿態(tài)角被干擾了0.5度導(dǎo)致水平方向分力把飛機推走。這個現(xiàn)象如果只看高度曲線是完全看不出來的必須把姿態(tài)角、油門、高度三張圖疊在一起看。這也是為什么我一直建議不要只依賴機上飛行效果判斷而是要建立完整的遙測日志習(xí)慣。6. 最后的調(diào)參心得與可復(fù)用的參數(shù)模板調(diào)試了這么長時間我最大的體會是定高四軸的難度不在于某個單一環(huán)節(jié)而在于傳感器、融合、控制三個層面的耦合。氣壓計數(shù)據(jù)臟后面所有環(huán)節(jié)都會跟著遭殃融合滯后嚴重PID參數(shù)調(diào)到天上也壓不住振鈴前饋油門不準一切修正都像是蒙著眼睛開車。所以永遠記得自底向上排查先把數(shù)據(jù)變干凈再談控制?,F(xiàn)在給出一份可直接上手的參數(shù)模板供參考具體機架還需微調(diào)參數(shù)取值說明氣壓計OSROSR_2048采樣時間約5ms噪聲與速度均衡氣壓計采樣周期10ms每次輪詢一種測量融合alpha0.035氣壓計權(quán)重響應(yīng)與穩(wěn)定性折中高度環(huán)頻率50Hz外環(huán)更新率速度環(huán)頻率100Hz內(nèi)環(huán)更新率高度環(huán)Kp_h1.2高度誤差到期望速度的比例高度環(huán)Ki_h0.05消除靜態(tài)誤差速度環(huán)Kp_v0.9速度誤差到油門修正速度環(huán)Ki_v0.10消除速度積差懸停油門throttle_hover45%左右依據(jù)實際機架測量填入期望垂直速度限幅±1.5m/s防止大誤差時輸出極端油門高度死區(qū)10cm避免微小抖動觸發(fā)控制這份模板在400mm軸距穿越機機架、1080g起飛重量、MS5611 空腔泡棉、F407飛控板、ANO飛控框架下實現(xiàn)了懸停高度波動±15cm、給一個0.5m高度階躍、1.5秒內(nèi)穩(wěn)定到目標高度±5cm的實測效果。電池電壓從滿電4.2V一路降到3.6V定高無需重新調(diào)整懸停油門前饋已經(jīng)自動把電量影響吸收掉。最后再分享一個小技巧定高代碼加好后不要急著飛在地面做一個“假裝起飛”測試。用一根細繩把機架吊在支架上讓四個電機離地3-5cm人不去推油門只把期望高度改成1米這時四個電機轉(zhuǎn)速同步升高繩子拉住機身不讓上升高度環(huán)感受到高度不變、速度為零應(yīng)該會把油門推到一個穩(wěn)定值附近。這個測試能驗證整個定高控制鏈路的完整性和穩(wěn)定性又不會炸機非常值得在每次改參數(shù)后做一輪比直接上實飛安全得多。本文還有配套的精品資源點擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
少妇搡BBBB搡BBB搡毛茸茸 | 日本强伦片中文字幕免费看| 天天操天天爱天天日| 天天日天天爽| 日本久久人人| 丁香六月啪啪| 色五月丁香在线| 色婷婷五月综合激情中文字幕| 丁香五月激情六月综合| 97se在线视频| 蜜臀99精品| 99热欧美精品| 婷婷综合五月| 综合久久丁香婷婷,五月婷婷六月丁香,开心激情综合网,六月丁香在线观看,婷婷丁 | 久久9视频| 99人人操| 五月婷婷影院| 婷婷涩涩网| 久久久天堂国产精品女人| 秋霞黄色一级久久| 丁香五月婷婷av影院| 乱轮A片| 97色干在线观看| 蜜乳国产网站| www.99热精品| 在线不卡视频| 狠狠插日日干撸| 欧美啪啪五月天| 伊人色综合网| 色婷婷激情小说网| wwww.9免费视频| 色婷婷小说| 91日视频| 色区久久| 婷婷五月综合在线视频| 丁香五月天天| 久久久久久人妻| 99爱免费在线观看| 久9精品| 这里有精品99| 色色色com| 成人超碰AV| 婷婷欧美| 日韩啊啊啊| 九九这里是免费的视频5| 婷婷成人综合| 婷婷五月天六月| 《丁香激情综合久久伊人久久》影视在线观看 -高清预告手机免费播放 -三妹影院 | 色五月婷婷亚洲最大| 日韩成人中文| 五月婷在线视频免费播放| 色情播放| 婷婷六月天国产综合| www夜夜操wwwcon| 丁香婷婷浪潮AV久久综合| 人妻啪啪啪| 日韩成人无码人妻| 色色色五月天婷婷| 五月婷婷无码| 天天草天天摸| 天堂婷婷五月在线| 欧美三级视频| 狠狠爱婷婷| 91超级碰碰碰| 天堂在线婷婷| 噼里啪啦在线观看免费完整版视频 | 79精品视频在线观看,| 男人综合网| 亚洲乱啪| 激情婷婷丁香五月| 色婷婷亚洲婷婷| 色五月天天| 婷婷五月天性爱视频| 激情综合五月婷婷| 亭亭五月天黑人2014| 非洲一级AV| 九九在线视频| 色色免费网站| 婷婷五月天激情诱惑| 噜噜噜噜噜在线| 婷婷中文字幕欧美| 亚洲五月婷婷| 武则天精品久久| 26UUU在线观看| www.婷婷.com| 丁香婷婷激情四射五月| AV中文在线| 亚洲久久激情| 久狠日av| 五月丁香狠狠爱婷婷综合| 国内久久亭亭| 超碰天堂网| 午夜激情综合| 天天综合在线网| 九九国产视频| 五月天丁香综合在线| 激情综合网激情五月天| 天天色亚洲| 狠狠色综合久久| 九九精品热播| 天天色中文字幕女优AV| 中字幕视频在线永久在线观看免费| 五月天激情婷婷| 丁香五月宝贝激情网| 9精品在线| 999热在线观看视频| 婷婷激情六月| 色爱综合网| 五月色丁香成人| 一级性感黄色内射视频| 天堂久久婷婷| 亚洲AV第二区国产精品| 亚洲五月天色色| 日韩中文字幕| 丁香五月花| 高清无码入口| 99热这里只有精品66| 日本欧美成人片AAAA| 婷婷五月天第四色| 99精品久久久久久久婷婷久久 | 亚洲AV日韩在线观看| 五月婷婷六月色| 91九色欧美| 婷婷五月天激情综合深爱激情| 丁香五月网络网络| 五月丁香综合激情在线观看| 丁香五月婷婷亚洲色图| 婷婷在线操| 久热久色| 色亚洲视频| 妇激情基地| 婷婷伊人75| 天堂呦 呦百度搜索-百度搜索| 99久久99久久综合| 少妇激情五月天| 色六月婷婷| 另类激情综合| 久久婷婷国产| 五月丁香成人网| 亚洲成人高清在线| 久操热线| 97精品综合久久| 99热这里只有精品2| 日本色久| 91婷色| 久久hd| 国产精品久久在线观看技巧| 色情综合| 亚洲综合激| 色VA| 久久这里99| 婷婷五月精品在线| 伊人久久五月天综合| 婷婷丁香五月天中文字幕| 这里只有精品视频一区| 激情丁香五月天图片| 欧美久久婷婷| 五月丁香婷婷成人网| 久久婷婷五月免费视频| 狠狠狠狠狠狠色| 91操网| 色色五月天丁香| 伊人五月综合网| 激情综合五月开心狠狠| 色丁香久久| 色欲人妻综合aaaaaaaa网| 秋霞性爱AV| 99热网站| 欧美97p| 五月天色婷婷成人| 色色免费网站| 日韩啊啊啊| 人妻丰满精品一区二区A片| 久热这里| 婷婷丁香六月天激情四射网| 天天操婷婷| 久久伊人五月天| 国内婷婷丁香社区在线播放| www夜夜操comwww| 色五月AV| 五月天色图| 免费无码毛片一区二区A片 | 五月婷激情| 国产无套精品一区二区| 色色五月天丁香婷婷| 色婷婷久久综合| 日日干日日| 国产精品久久久久久久久久久久 | 激情久久久久久久久久| 色色色99韩| 国产婷婷五月中文字幕高清| 天天综合中文| 超碰99在线观看| 激情五月丁香五月色| 欧美性色A片免费免费观看的| 久久综合五月天激情小说网站| 激情婷婷22月间| www.五月婷婷.com| 久久机热这里只有精品| 九九色综合九九色| 色婷婷AV久久| 五月天婷婷色| 东京热免费视频网站| 色噜噜狠狠色综合无码久久欧美| 婷婷五月天成人网站| 色婷婷狠| 狠狠色婷| 婷婷欧美色| 99免费热视频| 99在线免费观看| 无码一级片| 久久永久网址| 久久色亭亭五月天| 婷婷最新地址| 99九九在线精品热动漫| 天天狠狠色综合| 99色天堂| 丁香五月婷婷五月基地| 色五月xxx| 橾逼网| 思思热在线观看| ww超碰在线| 婷婷的激情五月| 色婷婷丁香| 丁香五月AV| 黄急一级视频| 蜜臀av无码久久久久久久久| 婷婷五月天开心网| 激情小说五月天| 九九美女视频| 99久久综合精品五月天| 久久久久婷婷| 日韩不卡DvD| 国产,欧美,日韩,性爱| 五月婷婷中文字幕| 91精产品自偷自偷综合| 久热在线中文字幕色999舞| 在线观看免费狠狠色丁香香综合| 都市激情小说婷婷| 丁香五月在线观看| w婷婷五月婷婷w| 五月情色天| 激情五月婷婷综合| 九九国产精视频| 婷婷五月天成人| 亚洲爆乳无码精品AAA片蜜桃| 性爱五月丁香| 色偷偷五月天| 爱狠射| 激情五月丁香色婷婷| 99在线播放视频| 日本A片一区| 婷婷六月天精品| 91婷婷五月天嫩女| 永久AⅤ1| 五月天激情色色| 91狠狠色丁香婷婷综合久久精品| 色五月超碰| 99日本视频在线观看专区| 精品视频99看在线视频| 狠狠干夜夜干| 九九热这里只有精品7| 免费视频无码| 亚洲xx网| 久久久久久久久99精品| 色5月婷婷色| 五月色影院| 丁香五月婷婷啪啪视频| 五月天激情社区| 99操| 婷婷综合五月天激情| 丁香五月激情五月| 婷婷色五月激情| 狠狠干狠狠色| wWwCom夜操wwW| 99人妻碰碰碰久久久久禁片| 久久婷婷激情| 天天操天天操天天操天天操天天操天天操天天操天天操天天操 | 美女激情婷婷| 欧美天堂婷婷日韩| www婷婷| 99re思思久久| 9九热视频| 五月丁香婷婷基地| 亚洲色色图片| 草草夜夜操| 欧美日本黄色| 香蕉久操| 久久99精品久久久久久青青AR| 婷婷久久六月费| 婷婷爱五月天人人爱| 天天视频亚洲| 九月av在线| 狠狠色综合精品视频在线| 99热在线播放精品| 色五月激情网| 99小视频在线观看| 欧美婷婷九月| 丁香五月婷婷亚洲天堂| 天天日天天插天天操| 五月天激情四射| 日本人妻伦在线中文字幕| 久久思思精品| 婷婷丁香五月激情| 色天天综合成人网| 99热爆在线| 991国产精选视频在线播放下载| 超碰成人影视| 久久玖玖综合| 秋霞A V毛片| 久久婷婷五月激情综合| 婷婷伊人综合| 婷婷97C| 色综合久久天天综合网| 99自拍视频在线观看| 色婷婷免费观看| 99操免费视频| 五月婷六月| 婷婷久久色| 久久这里只有精品视频26| 亚洲激情视频在线观看| 99re热精品在线视频| 99热这里只有精品9| 五月婷婷中文网| 色婷婷第四色| 影音先锋激情网| 成 久久| 久久免片| 国产午夜精品一区二区三区四区| www开心激情网| 婷婷丁香五月综合网| 骚。com| 99热超| 久久资源网五月婷| 天天撸夜夜爽| 9999三级片| 九九激情网| 久久99成人性爱高清视频| 日韩欧美一道四区中文字幕| 天天操天天插| 激情五月天在线视频| 99激情在线| 亚洲乱码日产精品BD| 色五月天综合网| 亚洲激情在线| 激情国产五月| 夜夜干夜夜操| 开心五月婷婷婷美女| 天天搞天天色综合| 99视频这里有精品| 超碰人人色| 亚洲狠9| 婷婷五月天激情网| 五月天激情图| www.丁香五月| 日本欧美999久久久三级片| 久久婷婷热| 提提热五月天婷婷| 91精品久久久久| 亚洲AV成人在线观看| 久色网址| 熟女激情网| 99热偷拍| 99热亚洲综合| AV五月丁香| 人人添人人| 久久新地此| 欧洲电影在线观看免费版英语版| 久久在这里99| 99久在线精品99re8热| jiujiu无码五区| 婷婷综合精品| 久久宗合影| av高清无码| 成人AV在线电影| 丁香六月天婷婷开心综合| 91色婷婷综合久久中文字幕二区| 探花搜索结果 - 黄上黄| 婷婷五月天成人| 五月丁香影院 | 久久婷婷五月综合激情国产| 久久久久久久丁香五月天婷婷| 青青999| 精品成人无码A片观看香草视频| 开心五月综合激情网| 夜丁香五月婷婷| 亚洲avjiujiur91| 97色久| 超碰高清在线| 日韩在线一级| 青青日韩| 99久久終合| 性做久久久久久久免费看| 99性视频| 丁香五月综合婷婷| 99精品免费| 操射国产日本| 欧美爆乳一区二区三区| 呦呦AV| 思思视频这里是精品| 99日韩| 丁香婷婷色九月| 日韩黄色AV无码| 色婷婷激情视频| 日碰日| 做爰丰满少妇1313| 98国产精品综合一区二区三区| 色婷婷五月综合| 五月婷网| 欧美影院| 99精品无码| 91pornav在线| 操操日韩| 久色五月天| 色五月色五天色情网址| 9久热在线精品| 红桃91人妻爽人妻爽| 婷婷五月天综合亚洲| 成人AV在线中文版| 久久44| 91中文狠狠综合| 九九综合影音先锋| 久热A片| 亚洲无码猫咪| 97操男人的天堂| 啪啪视频99| 婷婷亚州综合| 玖玖精品婷婷| 婷婷五月天色色| 婷香五月| 久久这里在精品视频| 激情五月综合| 五月天天堂久久| 色和综合网| 婷婷五月天干干| 国产综合丁香五月天| 婷婷亚洲综合| 亚洲午夜Av| 九色地址91视频| www.99热在线观看| 婷婷五月丁香六月| 五月天婷婷综合网| 婷婷五月天 丁香五月天 裸体| 欧美S码亚洲码精品M码| 亚洲色频| 97人人操在线| 久久婷婷成人视频| 五月婷婷九月婷婷九月婷婷| 狠狠操狠狠操| www.超碰| 婷婷丁香综合网| 激情婷婷99| 婷婷五月天亚洲综合| 色婷婷丁香| 激情综合网之激情五月| 天天爽夜夜爽天天爽夜夜爽| 五月天婷婷色| 婷婷五月天AV| 91综合色噜噜| 综合激情五月丁香| 久热只有这里精品| av色婷婷| 玩熟女五十AV一二三区| 91人人操| 99久热这里有精品| 丁香五月,激情五月,深爱五月| 亚洲综合五月天婷婷| 99ri国产| 91久女| www综合久久| 五月天激情黄色小说在线观看| 色婷婷伦理| 婷婷五月天电影网| 久久激情视频| 超碰免费人人肏| 色综合区| 成人国产综合| 一级片操逼视频| 国产永久一黄| 三区激情四射av| 久久久精品人妻录| 97热这里只有精品| 成人 在线观看国产| 另类亚洲电影| 大香蕉久久| 天天爽天天干天天| 婷婷九九| 91无码一区人妻A片蜜| 久久婷婷丁香| 五月WWW| 伊人久久大香线蕉av一区| 国产在线aaa片一区二区99| 91窝窝| 99在线观看视频免费| 去干网最新版本亚洲版| 丁香五月久久| 狠狠99| 9久精品| 六月婷婷视频| 婷婷五月伦理| 八戒青柠影视剧在线观看| 无码色综合| 性小说五月天| 91精品久久久久| 97干在线免费| 噜噜噜噜婷婷五月天| 这里只有精品1| 五月色综合| 六月久久婷婷| 激情欧美五月丁香| 欧美交换配乱吟粗大25P| 亚洲无码黄色| 色五月色五天色情网| 4399亚洲视频| 五月天另类图片区99| 五月丁香婷在线| 久久婷婷视频| 人妻精品在线| 思思热在线| 碰碰人人人| 热热久久精品视频| 天天日天天爽夜夜爽| 丁香五月综合久久| 深爱激情av| 天天精品视频免费观看| 久久98热re| 激情五月天婷婷视频| 婷色五月| 九九国产精视频| 婷婷的色色五月天| 性爱五月婷婷| 99热这里只有免费精品| 五月天色婷婷av| 青青操丝袜美腿| 激情图片婷婷丁香五月| 乱色色色| 97人人操人人插| 激情五月图| 久99久视频| 五月丁香自拍| 久久与婷婷| 国内久久亭亭| 五月婷婷综合视频| 六月婷婷最新网址| 99热加勒比| 五月深爱激情网| 91蝌蚪窝视频在线| 这里只有九九精品| 激情AV网| 丁香五月婷婷乱| 97精品综合久久| 深爱五月月天| www久| 天天激情综合| 久热这里| 丁香月五月天婷婷久久| 国产欧美精品AAAAAA片| 99re这里只有精品免费| 俺也去色| 五月婷婷免费| 国产69久久久欧美黑人A片| 国内裸舞二区| 国产毛片欧美毛片久久久 | 亚洲欧美综合7777色婷婷| 91操在线视频| 免费AV播放| 五月婷色| 五月丁香婷婷无码A∨| 五月丁香成人网| 丁香六月婷婷综合激情欧美| 激情六月天| 十月丁香婷婷| 久久9情免费| 亚洲激情免费视频| 五月丁香婷婷婷激情爱爱| 激情丁香五月天图片| 五月丁香六月婷婷的女人| 五月天播播| 麻豆雪千夏| 激情综合网五月婷婷| 26uuu欧美日韩| 疯狂做受XXXX高潮A片动画| 五月丁香成人| 中文婷婷狠狠| se影音资源在线观看| 91在线操| 久久人妻视频| 丁香五月在线视频黑人| 九九中文字幕九| 婷婷五月综激情| 成人一级片| 九九亚洲| 亚洲综合在线丁香五月| 五月天激情视频| 伊人综合网站| Aα在线免费观看| 97精品自拍| 五月丁香婷婷久久| 日本99热| 丁香婷婷人妻综合网| 亚韩精品视频1区| 丁香 婷婷 亚洲 熟女| 五月天丁香久久| 激情图片五月天| 婷婷激情综合网| 九九精品re免费视频| 五月丁香999| 婷婷天天综合| 大香蕉五月天婷婷丁香91| 五月婷婷无码| 丁香五月天激情免费在线观看AV777| 国产ava| 亚洲国产精品二二三三区| 丁香六月婷婷综合啪啪| www超碰| 丁香五月色激情| 五月天久久婷婷| 26uuuavcom| 九九综舍久久| 乱岳熟女50岁| 五月婷婷在线观看黄| 小视频aaa久久久| 人人97操| 丁香婷婷色五月| 婷婷亚洲综合| 色欲香综合网| www.五月天色色.com| 精品亚洲国产成AV人片传媒| AV网站免费在线| 亚洲成人乱码av网站| 六月撸婷婷| 亚洲中文字幕AV在线| 色婷婷伊人| 深爱五月日韩| 色五月激情问网站| 无码yw| 天天射天天插天天干| 亚洲av网站在线观看| www.minyis.com【JT】国内CDN落地页保证转化QQ2101460746 | 久久五月天综合| 五月丁香六月情| 久久98| 涩涩婷婷五月| 狠狠色丁香乆乆| 99这里只有精品|v| 丁香六月综合激情| 国产色网站| 337p午夜影院| www.zbzhongsen.com| 9久国产精品| 亚洲欧美999| 精品少妇人妻AV无码专区偷人| 五月婷婷色| 五月婷久久草| 9999综合99综合人| 色级停停| 亚洲国产无线乱码在线观看| 在线不卡视频| 蜜桃人妻无码AV天堂三区| 99热这里只有精品最新网址| 天天在线久久综合| 99噜噜噜在线播放| 啪啪激情综合| 婷婷五月天丁香社区| 丁香色色五月| 狠狠ri| 五月丁香六月激情| 婷婷五月天亚洲| 51国精产品自偷自偷综合| 九九这里精品| 激情图片婷婷| 九九热在视频| 激情五月天色| 日本色道视频网站| 96丁香六月婷婷蜜桃综合久久| 97香蕉人人在线观看| 超碰69天堂| 久久97久久99久久综合欧美| 国产在线aaa片一区二区99| 人妻熟妇国产精品| 天天综合网91| 一起草Av| 亚洲av成人在线| 色婷婷成人网| 婷婷五月丁香六月| 91婷婷在线| 99九九99九九九视频精彩| 中文字幕丰满人妻无码专区| 婷婷色操| 91人人网| 九九青青草成人| 久婷| 99热综合| 996热| 婷婷五月天成人| 婷婷五月丁香六月| 欧美一级色| 日本99视频| 精品无码久久久久久久久 | 久久久婷婷五月亚洲97号色| 亚洲啪啪视频| 欧美天天草人人草| 天天天操天天天爰| 青青草深爱激情网| 夜夜撸天天日| www.99情趣网| 久久精品夜色噜噜亚洲a∨| 国产在线黄色| 亚洲激情另类| 香蕉久久av一区二区三区| 五月丁香婷婷国产精品综合| 日韩乱轮AV| 久久久这里有精品| 色五月首页| 韩国不卡AC视频| 强奸幻女毛片| 亚洲色激情| 欧美影院婷婷| 色波激情五月天| 综合久久丁香婷婷,五月婷婷六月丁香,开心激情综合网,六月丁香在线观看,婷婷丁 | 伊人网碰碰| 日日干天天射| 久久99热这里只有| 色区域网站视频| 泰州成人视频| 91精品久久久久久77777| 久久9久久| 99性爱视频| 丁香成人色情五月天| 爆乳熟女一区二区三区爆乳 | 91婷色| 免费视频WWW在线观看网站| 日本婷婷色日| 色婷婷六月激情| 偷拍九九热| 久久婷五月影院| www.久久爱.com| 五月天五月色婷婷综合| 国产精品视频久久99| 天天综合色| 99热精品中文字幕| 婷婷5月久久综合网站| 久久jiuwww| 久久精品性爱视频,| 五月婷综合网| 色玖玖综合网| 搡BBBB搡BBB搡五十| 激情视频综合| 91久久精品国产91性色TV| 97人操人免费视频| 色婷婷亚洲精品天天综| 婷婷精品综合| 亚洲丁香五月天视频| 丁香六月婷婷缴情欧美| 亚洲一区二区色图-亚洲精品国产精品乱码-成人AV | 亚洲VA在线| 午夜五月天| 五月天婷婷色在线视频免费观看| 色综合久| 久久狠狠干| 国产人妻人伦精品一区二区| 97丁香五月| 激情久久久久| 欧美怡红院黄站| 五月丁香久久久| 99热精地址| 97香蕉碰碰人妻国产欧美| 久久在线视频免费观看| 99人人干人人| 婷婷五月丁香婷婷| 色婷婷成人网| 任你弄在线视频免费| 婷婷放心五日爱| 激情五月色综合| 久久机热/这里只有精品| 午夜在线成人网站免费观看| 五月婷婷深深的爱| 婷婷性爱五月天| 久久人妻视频| 色婷婷a v| 岛国av网| 色综合九九| 亚洲成人综合网在线免费观看| 欧美色狠婷久| 国产激情av| 国产精品成人网址| 色婷婷五月六月丁香综合视频| 深爱五月激情| ztEJj| 99久久66| 激情啪啪五月| 久热视频97AV在线观看| 狠狠人人| 91热爆在线| 欧美久久久久久久久中文字幕| 亚洲性受XXXX五月丁香| 婷婷激情丁香六月| 国产美女视频久| 丁香婷婷五月色成人网站| 九九99热| 五月天基地| 日日日天天干| 久9热插入| 色婷婷裸体色性在线| 黄网免费观看| 超碰免费人人肏| 丁香久久五月天视频在线观看| 婷婷在线视频| 天天婷婷天天| 欧美丁香五月| 久色视频首页| 成人丁香五月| site:901-07.com| 久久只有18视频| 久久66er久久| 色五月婷婷av| 丁香婷婷综合激情五月色,开心五月丁香花综合网,激情综合五月亚洲婷婷,五月天 | 激情婷婷丁香| www.色婷婷。com| 五月天色综合| 婷婷丁香五月天色区| 五月婷婷色| 91视频综合网| 亚洲精品中文字幕成人片| 天天综合图片| 亚洲深喉AV| 亚洲激情五月丁香久久久久| 亚洲中文字幕av| 色情五月天视频网| 91男同视频| 26uuu国产| 99综合在线| 日本色色色| 99噜噜| 伊人久久艹| 99热99日天天干| www激情| 欧洲一区二区| 伊人综合网站| 丁香六月情| 丁香六月激情综合| 思思热精品在线| 色 五月婷婷基地| 九月婷婷综合色干| 成人视频一区| 久久机热这里只有精品| 99九九玖玖| 丁香六月在线| 初夜av| 97碰久久| 风流少妇A片一区二区蜜桃| 婷婷六月天激情影院| 五月激情网站| 大香蕉520| 天天干天天玩天天夜天天射天天操天天日蜜臀少妇 | 久久大香蕉同僚| 色综合五月婷婷狠狠干| 一本道在线电影| 1024操逼视频| 六月婷婷五月丁香首页| 五月停停大香蕉| 深爱激情五月网| 六月丁香五月激情婷婷| 婷婷香香五月| 天堂久久久久天堂网| 成人片在线播放| 亚洲综合另类| 五月婷婷偷| 97碰| 欧美日韩五月婷婷| 狠狠婷婷综合| 免费看欧美成人A片无码| 这里只有精彩视| 久久久久人妻中文| 婷婷色播六月无码| 无码髙清| 99网址在线观看| 噼里啪啦在线观看免费完整版视频| 青青福利网| 久久久久久激情| 色九月综合| 激情综合婷婷五月| 午夜天堂一区人妻| 久久婷婷五月综合啪| 夜夜爱网站| 天天爽爽日日做做| 成人丁香五月| 久操大香蕉| 熟女国产在线一区二区三区四区| 日日夜夜干| www.99婷婷| 丁香五月婷中字幕| 五月天激情小说电影| 天天射天天干天插色综合| 丁香五月婷婷激情97| 九九热精品视频| 狠狠穞A片一區二區三區| 亚洲va综合va国产va中文| 婷婷成人五月天一区| ss五月天激情| 久久性爱视频| 伊人久久大香线蕉av一区| 丁香久久综合| 99热 这里只有精品 国产 日韩| 色五月天丁香婷婷色| 碰碰碰97免费精彩视频| BlACKEDRAW视频一区二区| 最熟少妇乱码| 97亚洲婷婷| 99视频在线啪| 成人资源在线| 婷婷丁香五月综合| 丁香婷婷偷拍| 深爱婷婷丁香五月激情| 色婷婷亚洲在线| 人人草人人爱| 激情五月六月婷婷| 亚洲激情五月天| 爱草视频在线| 欧美99热| 久久精品爱爱| 99热 这里只有精品 国产 日韩| 五月色丁香| 五月婷视频久久| 综合激情开心五月| 五月天停停成人网| 亚洲免费av在线| 五月天婷婷綜合院| 内射人妻视频国内| 狠狠色综合五月人人| 神马久久五月天| 91啪啪| 日本九九热| 亚洲天天| 丁香五月天视频| 停停综合色色| 色五月婷婷、老熟女| 玖玖午夜视频| 激情亚洲五月| 亚洲成人网无码| caopeng97日韩| 狠狠xx| 51精品国自产在线| 国产色视频网站2| 久久久精品99亚洲综合| 日韩精品无码99| 另类小说五月天| 久久九九思思| 人人操Av| 婷婷色五月激情| AV片在线观看| 在线婷婷| 天天综合色| 亚洲av综合在线| 桃色激情五月天| 五月丁香婷婷AV天堂| 99久久激情视频| 热99视频精品| 丁香五月AV| 91久女| 99re最新地址视频| 99爱这里只有精品免费视频| 欧美丁香婷婷五月| 久久XX日本综合| 伊人久久婷婷| 欧美丁香五月| 老美AA片| 色香五月天| 少妇AB又爽又紧无码网站| 欧美三级欧美一级| 久久成人人妻| 亚洲精级| 99久久a线观| 97香蕉碰碰人妻国产欧美| 人妖色AV色综合| 第四色婷婷五月| 久久大香蕉| 日日色五月天| 人与禽A片啪啪| 欧美婷| 婷婷99视频在线| 99成人网站| 97人人草| 99热新网址| 草草视频91| 少妇丁香婷婷 | 思思热久久阴99| 色婷婷六月| 精品综合久久久久久五月天| 任你躁XXXXX麻豆精品| WWW.开心五月天.COM| 欧美人人草草| 激情开心五月天| 亚洲成人AV在线观看| 青青草成人网| 亚洲色涩视频| 亚洲精品亚洲人成人网| 激情丁香五月激情婷婷| 99热在线观看精品| 先锋影音av色五月天资源站| 色色网站免费在线视频| 嫩BBB搡BBBB榛BBBB| 婷婷丁香在线播放| 大香蕉久久婷婷精品综合| 久婷婷色| 99热精品10| 青青草免费公开视频| 97色五月天| 国产操逼网站| 无码啪啪| 四色女婷婷| 任你干嘛免费视频播放| 亚洲a色| 欧美久草在线日本一级特黄大片做受9在线观看韩国电影《两个女人》未删减-毛片 | 6月丁香婷婷激情| 狠狠久久婷| 99在线观看| 色婷婷色人人射| 高清资源站日A美A欧亚…| 色狠狠色噜噜AV天堂五区消防| 日韩AV在线影片| 婷婷深爱五月丁香| 丁香五月天激情婷婷丁香六月| 丁香五月狠狠在线观看| 超碰人人色| 天天插夜夜爽| 精品一区二区三区三区| 九九AV| 亚洲视频操| 亚洲情a| 99免费视频久久| 69色婷婷| 涩五月婷婷| 五月丁香六月婷婷国产视频| 五月婷婷中字在线| 我去色色网五雨天| 99精彩视频在线观看| 99丁香五月| 五月婷婷啪啪啪| 激情五月,激情综合网| 九九亚洲综合| 影音先锋五月婷婷| 337p大胆噜噜噜噜噜91Av| 天堂AV在线看| 六月香五月婷| 激情综合5| 97超喷视频在线观看| 人人播| 五月激情婷婷丁香天堂| 爱性综合网| 久久婷婷东京热大香樵| 久久婷婷五月天| 99精色| 久久激情综合| 99免费热视频在线| 欧美极品999| 男人天堂AV在线一区二区| 五月丁香婷婷成人网| 欧美内射AAAAAAXXXXX| 99免费在线视频| 久久婷婷综合色丁香| 丁香五月av| 欧洲亚洲午夜| 热99一二三| 天天操天天插天天射| 色色9 9| 9久热精品在线视频| 1000部毛片A片免费观看| 六月激情婷婷| 97精品人人A片免费看| 色色亚洲视频| 午夜成人天堂久久无码日韩久久| 韩国情人在线电视剧免费观看高清版全集| 香蕉久久国产AV一区二区| 国产精品久久久久久喷浆| 久久99热这里只频精品6学生| 五月丁香六月婷综合成人综合| 五月婷婷色综图片| 五月丁香啪啪啪| 亚洲AV综合在线观看| 伦乱人妻| 久99999热视频在线观看免费| 免费观看全黄做爰的视频| 九九热在线视频,| 丁香六月成人| 日本在线观看aaa 99| 99啪99| 热99国产精品| 五月天五月色婷婷综合| 亚洲射激情| 五月亭亭性| 99热综合色图| 337p大胆噜噜噜噜噜91Av| 婷婷五月天成人| 久久婷婷五月天激情新地址| 色情五月| 九九综合久久丁香婷婷,开心激情综合网| 婷婷播播五月天| 97九色视频| AV成人在线网站| 久久性刺激| 密臀久久| 婷婷在线视频| www婷婷色| 超碰女人天堂| 国产五月天欧美色| www.夜夜操| 六月婷婷色色色| 香蕉久久国产AV一区二区| 婷婷五月视屏| 国产毛片精品一区二区色欲黄A片 欧美交换配乱吟粗大25P | 婷婷99丁香| 色情久久久| 免费看欧美成人A片无码| 国产毛多水多女人A片| 影音先锋91视频| 永久无码色| 激情五月少妇| 色综合五月天| 毛片蕉地一二| 深爱五月激情综合| 九月丁香亭亭| 4438成人电影| 丁香五月综合网亚洲综合欧美狠狠| 五月激情天| 丁香五月天.com| 麻豆123区| 五月婷婷久久综合| 中文字幕在线日亚州9| 色碰干| 久久女人九九| 开心五月天激情网站| 亚洲精品又粗又大又爽A片| 中文字幕av在线播放| 色色色无码| 99caobi| 色99热| 五月天丁香婷婷网| 一级黄色影片| 色婷婷五月综合| 综合久久伊人| 深爱激情69热| 中文字幕91,综合| 五月激情开心婷婷| 伊人综合网站| 日夜夜天天| 大香蕉在九| 色婷婷在线视频综合| 日韩久久成人| 婷婷五月天BBw| 丁香综合日产精品久久| 我爱婷婷五月天综合88| 丁香五月婷婷色综合| 天天爽夜夜爽天天爽夜夜爽| 伊人九九68| 五月天国产婷婷精品视频在线| 俺去婷婷 丁香| 色播婷婷五月天| 九九久久精品國產| 欧美啪啪9| 大香蕉久久久久| 丁香婷婷社区| 伊人狠狠干| 99国产欧美视频| 婷婷色在线播放| 天天色丁香| 97热视频| 99热在线观看| 国产成人片| 99热在线只有精品| 97碰| 亚洲天堂99| 天天干天天操天天爱| 婷婷色在线视频| 亚洲精品午夜国产va久久成人| 色碰碰| 色婷婷综合视频| 日本久久色| 天天插天天日| 日日骑夜夜撸| www.久操| 丁香五月婷婷五月| 国产婷婷五月在线视频| 九九精品热播| 丁香婷婷大香蕉| 五月丁香av在线| 亚洲成AV人片在线观看| 丁香色五月天| 2020夜夜操天天爽| 久久久大香蕉| 国产真人做爰视频免费| 综合啪啪| 伊人丁香婷婷东京| 六月丁香婷婷综合影院| 婷婷五月,综合伊人| 色色a| 婷婷五月天在线综合| 99视频在线观看视频| 激情丁香婷婷| 婷婷娱乐丁香综合网| 丁香九月久久| 4399无码视频| 99在线热| 婷婷五月丁香五月综合网| 亚洲区在线| 婷婷综合激情| 九九这里只这里只有精品| 色婷婷在线视频观看| 狠狠爱综合网| 成人性爱无码| 丁香婷婷六月婷婷六月婷婷六月婷婷| 色五月噜噜| 99热这里只有精品22| www.狠狠艹| 99re热| 九九99免费视频| 婷婷五月综合性爱| 夜夜嗨一区二区三区直播内容 | 五月伊人综合| 在线网黄| 91丨九色丨老农村| 91丨九色丨大屁股| 久操婷婷| 色五月婷婷影院| 9久视频| 激情六月婷婷| 荷兰av一级| 天天爽天天干| 操一操干一干| 婷婷五月天亚洲综合网| 色色色色av777| 亚洲久久婷婷| 狠狠色噜噜狠狠狠888了| 五月婷婷婷自由综合| 六月色狠狠色| 狠狠狠狠狠操| 五月婷婷婷婷婷婷艺术| caopeng97日韩| 五月婷导航| 丁香五月综合在线播放 | 在线五月色播| 婷婷五月丁香婷婷| 狠狠激情五月天| 丁香五月人妻| 琪琪色五月天| 狠狠干综合| 激情小说五月天| 开心五月天激情网| 国产97在线日韩亚洲女人被黑人巨大| 丁香狠狠干| 99偷拍视频在线日本| 狠狠色大香蕉| 亚洲色图81p| 精品在线| 天干干夜夜操| 99热九九在线| 狼人婷婷综合| 99综合免费视频| 久久婷婷五月| 色婷婷综合在线| 999热在线视频| 五月丁香久久久| 国产日韩亚洲欧美在线观看| 黄网免费看| 欧美性生交xXxX久久久| 五月天五月婷五月激情网|