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

ARTICLE DETAIL

資訊詳情

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

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

STM32F407氣壓計(jì)定高四軸實(shí)戰(zhàn):從濾波到串級(jí)PID完整解析 簡介本資源是一套基于STM32F407微控制器的四軸飛行器飛控源碼工程面向嵌入式開發(fā)者、無人機(jī)愛好者及高校電賽/畢業(yè)設(shè)計(jì)實(shí)踐者聚焦氣壓計(jì)與超聲波雙模融合定高控制這一核心難點(diǎn)。壓縮包共590個(gè)文件含317個(gè)C源碼含傳感器驅(qū)動(dòng)、PID定高算法、電機(jī)控制邏輯、88個(gè)頭文件定義硬件接口與參數(shù)結(jié)構(gòu)、48個(gè)編譯中間文件.o/.d及Keil工程配置.uvproj/.uvopt、啟動(dòng)匯編cstart_thumb2.asm、固件鏡像.axf/.hex等完整覆蓋從底層驅(qū)動(dòng)到閉環(huán)控制的全鏈路實(shí)現(xiàn)包體大小為8.53MB。已有269人學(xué)習(xí)下載源碼中已集成氣壓計(jì)溫度補(bǔ)償、超聲波回波濾波、多傳感器數(shù)據(jù)融合策略及可調(diào)PID參數(shù)表配合ANO調(diào)試工具支持實(shí)時(shí)高度曲線觀測與參數(shù)在線調(diào)優(yōu)是深入理解飛控姿態(tài)與高度協(xié)同控制的高質(zhì)量參考工程。1. 為什么是F407氣壓計(jì)這套方案從姿態(tài)到高度的第一個(gè)臺(tái)階做四軸定高這件事看起來只是一個(gè)“飛控里加一個(gè)傳感器”的改動(dòng)但真正把它從Demo推進(jìn)到能穩(wěn)定懸停中間涉及的坑比想象中多得多。這篇東西我想把整套基于STM32F407飛控板、ANO飛控框架、氣壓計(jì)定高的實(shí)現(xiàn)思路和調(diào)試過程完整捋一遍適合已經(jīng)在跑姿態(tài)環(huán)、想往更上層加功能的新手也適合手頭正好有F407板子、想從零把一個(gè)定高四軸立起來的人。先交代一下背景。定高這個(gè)概念本身不難理解飛機(jī)在遙控器不給油門變化的時(shí)候高度維持在一個(gè)給定值附近。但為什么要用F407而不是更便宜的F103答案很直接F407主頻168MHz帶硬件浮點(diǎn)運(yùn)算單元FPU跑ADC采樣、I2C總線讀取氣壓計(jì)、姿態(tài)解算、串級(jí)PID控制四個(gè)任務(wù)疊加起來CPU占用率仍然能壓在40%以內(nèi)。F103做姿態(tài)解算還能湊合再加上高度融合、氣壓計(jì)濾波、速度估計(jì)這些任務(wù)就開始吃緊了尤其在中斷退出延遲上容易讓控制環(huán)出現(xiàn)抖動(dòng)表現(xiàn)出來就是油門響應(yīng)鈍、懸停掉高度。ANO這套框架我用了挺長時(shí)間匿名科創(chuàng)社區(qū)最初開源的ANO_FC就是基于F407做的。它的架構(gòu)清晰度在同類開源飛控里屬于比較友好的那種任務(wù)調(diào)度分成傳感器讀取任務(wù)、姿態(tài)解算任務(wù)、控制任務(wù)、通信任務(wù)。我加定高功能時(shí)主要是在傳感器任務(wù)里加入氣壓計(jì)采樣和外置濾波在控制任務(wù)里疊加高度/速度雙閉環(huán)思路就是外環(huán)高度環(huán)輸出期望垂直速度內(nèi)環(huán)速度環(huán)輸出期望油門。這一套結(jié)構(gòu)現(xiàn)在很多商業(yè)飛控也這么用只是參數(shù)和融合方式各家有差異。定高四軸的核心價(jià)值是讓操作者從“時(shí)刻都得盯著油門”里解放出來。飛姿態(tài)模式時(shí)哪怕油門打了同一個(gè)位置電池電壓從4.2V掉到3.7V電機(jī)轉(zhuǎn)速下降飛機(jī)就會(huì)緩慢下沉有了定高不用人手微調(diào)油門遙控器油門桿只需要管升降方向或者直接交給高度設(shè)定這對(duì)于航拍、室內(nèi)懸停、編隊(duì)飛行都是剛需。所以這篇的落點(diǎn)不只是“把代碼下載進(jìn)去能起飛”而是拆開講清楚氣壓計(jì)的原始數(shù)據(jù)怎么變成可信的高度、高度怎么變成一個(gè)穩(wěn)定的控制量、控制量怎么變成不抖動(dòng)的油門輸出。2. 硬件選型和飛控板布局氣壓計(jì)最容易被忽視的“命門”2.1 飛控板和傳感器選型邊界我用的是ANO系列經(jīng)典的F407飛控板主控為STM32F407VGT6板上集成了MPU6500六軸IMU和MS5611氣壓計(jì)。MS5611是個(gè)很老練的型號(hào)24位ADC輸出分辨率可以做到10cm級(jí)實(shí)際能穩(wěn)定撲捉到的高度變化約15-20cm量程從10mbar到1200mbar對(duì)應(yīng)海拔覆蓋從-1000米到20000米左右家用和航拍機(jī)完全夠用。相比之下BMP280雖然便宜但它主要是為手機(jī)氣象服務(wù)設(shè)計(jì)的氣壓噪聲和溫漂性能比MS5611差了一個(gè)檔次同樣是高度輸出BMP280在一米高度上數(shù)據(jù)能抖出±30cm的跳動(dòng)MS5611同樣環(huán)境下能壓到±10cm這個(gè)差距在控制環(huán)里會(huì)被放大導(dǎo)致油門來回抽動(dòng)。因此定高項(xiàng)目里氣壓計(jì)首選MS5611預(yù)算特別緊才考慮SPL06。選好氣壓計(jì)之外飛控板布局的判斷更重要。MS5611對(duì)氣流極其敏感但也怕熱、怕風(fēng)、怕光。在飛控板上它離電源模塊和主控芯片至少要保持5mm以上間距否則MOS管和穩(wěn)壓芯片的熱量會(huì)直接抬高氣壓計(jì)局部溫度造成漂移。我見過一款山寨飛控把MS5611貼著4A降壓芯片放開機(jī)兩分鐘高度數(shù)據(jù)就虛漂了3米。所以硬件到手先做靜態(tài)測試上電后把板子放桌上靜止不動(dòng)串口打印高度值觀察兩分鐘內(nèi)高度是否漂移超過50cm。如果漂移很大第一懷疑對(duì)象不是算法而是板子的熱源干擾。2.2 氣壓計(jì)安裝的“遮風(fēng)”與“透氣”矛盾螺旋槳的下洗氣流是定高最大的物理干擾源。電機(jī)一轉(zhuǎn)動(dòng)大量氣流直接沖刷飛控板頂部的氣壓計(jì)封裝。MS5611的芯片頂部有一個(gè)微小的通氣孔外部氣壓就是通過這個(gè)孔感知的。如果不做遮擋處理下洗氣流會(huì)形成局部壓強(qiáng)波動(dòng)高度數(shù)據(jù)會(huì)像喝醉了一樣上下亂跳。常規(guī)做法是給氣壓計(jì)蓋上一塊密度適中的泡棉泡棉厚度在5mm左右內(nèi)部要有一塊空腔。注意泡棉不是把孔堵死而是緩沖氣流的急變。我試過三種方案方案做法實(shí)測效果裸奔不遮氣壓計(jì)直接暴露波動(dòng)±50cm完全不可用薄海綿緊貼2mm薄海綿覆蓋封口波動(dòng)±20cm仍不夠穩(wěn)空腔泡棉蓋5mm泡棉挖出5x5mm空腔覆蓋氣孔波動(dòng)±8cm懸停穩(wěn)定空腔泡棉的原理是泡棉本身濾掉高頻氣流擾動(dòng)內(nèi)部空腔給氣壓變化一個(gè)緩沖時(shí)間相當(dāng)于給氣壓計(jì)加了一個(gè)機(jī)械低通濾波器。這個(gè)方法成本幾乎為零效果卻立竿見影。安裝時(shí)還要注意側(cè)面也要遮擋風(fēng)向室內(nèi)開風(fēng)扇測試時(shí)側(cè)風(fēng)也會(huì)從泡棉邊緣鉆進(jìn)去影響讀數(shù)。2.3 供電與I2C總線細(xì)節(jié)MS5611是I2C接口飛控板上通常作為I2C總線上的唯一或之一設(shè)備。F407的I2C外設(shè)歷史上飽受吐槽很多人直接用GPIO模擬I2C來規(guī)避硬件I2C的怪癖。我的經(jīng)驗(yàn)是在ANO框架里直接用硬件I2C其實(shí)問題不大但必須把I2C時(shí)鐘配置在200kHz左右太高的時(shí)鐘在長線纜上容易出ACK丟失。另外MS5611的VDD腳要并接100nF和10uF電容這一點(diǎn)很多自制PCB圖省事只放一個(gè)百納法電容上電瞬間電壓跌落會(huì)導(dǎo)致傳感器初始化失敗串口讀到固定值0x0000排查半天其實(shí)是供電不足。現(xiàn)在我需要強(qiáng)調(diào)一個(gè)布局順序飛控板供電一般由分電板或電源模塊通過杜邦線引出線長超過15cm時(shí)I2C數(shù)據(jù)線SDA/SCL建議和電源線分開走線避免電機(jī)大電流變化在電源線上產(chǎn)生壓降尖峰耦合到I2C線上干擾通信。成品飛控板一般已經(jīng)考慮好了但我見過不少自己改線導(dǎo)致I2C偶發(fā)卡死的情況卡死表現(xiàn)為氣壓計(jì)數(shù)據(jù)停止刷新飛控三秒后觸發(fā)失控保護(hù)。3. 氣壓計(jì)原始數(shù)據(jù)如何變成可信高度從I2C讀取到濾波融合3.1 MS5611讀取時(shí)序與代碼骨架先把氣壓計(jì)的底褲看清。MS5611內(nèi)部有兩個(gè)測量通道壓力通道和溫度通道。它的工作流程是發(fā)送轉(zhuǎn)換指令啟動(dòng)壓力測量等待轉(zhuǎn)換完成典型時(shí)間由OSR決定讀取24位壓力原始值再啟動(dòng)溫度測量讀取24位溫度原始值然后利用芯片出廠時(shí)燒錄的6組校準(zhǔn)系數(shù)C1-C6做補(bǔ)償計(jì)算得到真實(shí)氣壓值和溫度值。我的做法是定高循環(huán)里用讀取優(yōu)先級(jí)輪詢的方式每次調(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過采樣率是個(gè)關(guān)鍵參數(shù)。MS5611支持256/512/1024/2048/4096五檔過采樣率OSR越高內(nèi)部ADC積分時(shí)間越長輸出噪聲越低但同時(shí)單次轉(zhuǎn)換時(shí)間越長。用OSR_2048對(duì)應(yīng)轉(zhuǎn)換時(shí)間約5ms噪聲幅度約0.06mbar折算高度噪聲約0.5米R(shí)MS。這個(gè)值從原始噪聲看并不算小所以不能直接用瞬時(shí)值必須先經(jīng)過濾波。3.2 高度換算與溫度補(bǔ)償細(xì)節(jié)從氣壓值換算高度的公式是國際氣壓測高公式altitude (1.0 - pow(pressure / 101325.0, 0.190295)) * 44330.0;注意公式里的101325Pa是標(biāo)準(zhǔn)海平面氣壓。很多人都知道這個(gè)公式但忽略了一個(gè)重要問題天氣變化和飛行環(huán)境溫度差會(huì)導(dǎo)致基準(zhǔn)氣壓漂移。所以正確的做法是開機(jī)時(shí)鎖定當(dāng)前氣壓為H0之后所有高度輸出都相對(duì)于H0計(jì)算這樣就不需要知道絕對(duì)海拔基準(zhǔn)公式變成relative_altitude (1.0 - pow(pressure / pressure_takeoff, 0.190295)) * 44330.0;其中pressure_takeoff是解鎖時(shí)記錄的基準(zhǔn)氣壓。這個(gè)邏輯一定要在起飛瞬間鎖定基準(zhǔn)否則你在地面站里校準(zhǔn)完、通電后放了一小時(shí)氣壓變化5米再起飛時(shí)高度就偏了。溫度補(bǔ)償同樣不能省。MS5611的補(bǔ)償函數(shù)會(huì)利用C1-C6做二階補(bǔ)償保證從-40°C到85°C范圍內(nèi)精度在±1.5mbar以內(nèi)。忽略補(bǔ)償直接拿原始值用的后果是飛控板子發(fā)熱后高度會(huì)緩慢正漂移看起來像飛機(jī)自己在往上爬定高變成“緩慢爬升模式”。3.3 濾波方案從滑動(dòng)平均到限幅互補(bǔ)氣壓計(jì)原始高度數(shù)據(jù)直接用于控制是災(zāi)難性的。我在OSR_2048下實(shí)測原始高度數(shù)據(jù)每25ms跳動(dòng)大約±0.5米而這個(gè)跳動(dòng)頻率和電機(jī)轉(zhuǎn)速、結(jié)構(gòu)振動(dòng)、機(jī)架彈性都有關(guān)系。直接把這個(gè)值送進(jìn)PIDP項(xiàng)會(huì)讓油門瘋狂抖動(dòng)機(jī)身高頻率顫抖?;A(chǔ)處理是滑動(dòng)平均濾波窗口取20個(gè)點(diǎn)每10ms一個(gè)點(diǎn)窗口200ms能把高頻抖動(dòng)壓縮到±8cm。但滑動(dòng)平均有個(gè)天然的滯后問題窗口越長滯后越大飛機(jī)從2米快速爬升到3米時(shí)濾波后的高度值要拖后將近半秒才到2.8米這個(gè)滯后同樣會(huì)降低控制穩(wěn)定性。我最終用的是兩級(jí)組合先做5點(diǎn)中值濾波剔除離群點(diǎn)再做20點(diǎn)加權(quán)滑動(dòng)平均最后和加速度計(jì)積分高度做一次互補(bǔ)濾波?;パa(bǔ)濾波的思路是height_fused alpha * height_baro (1 - alpha) * (height_prev vel_vertical * dt);alpha取值在0.02到0.05之間。氣壓計(jì)負(fù)責(zé)長期穩(wěn)定加速度計(jì)積分負(fù)責(zé)短期響應(yīng)。氣壓計(jì)長期漂移但是短期噪聲大加速度計(jì)積分短期精準(zhǔn)但是長期會(huì)漂。兩者互補(bǔ)一個(gè)管長期一個(gè)管短期alpha就是信任權(quán)重。這套結(jié)構(gòu)跑下來高度數(shù)據(jù)的響應(yīng)延遲從直接濾波的200ms降到了80ms以內(nèi)懸停時(shí)高度波動(dòng)能控制在±15cm左右。關(guān)于加速度計(jì)積分這部分多說一句豎直方向的加速度是機(jī)體坐標(biāo)系下z軸加速度和姿態(tài)角的三角函數(shù)關(guān)系需要在姿態(tài)解算算出四元數(shù)后把機(jī)體系加速度投影到世界系取世界系z軸方向分量減去1g重力加速度然后再積分。這一步做錯(cuò)了會(huì)導(dǎo)致高度振動(dòng)最常見的錯(cuò)誤是忘了減重力。我剛開始調(diào)試時(shí)高度融合曲線像波浪一樣上下竄排查半天發(fā)現(xiàn)是加速度z軸沒補(bǔ)償重力項(xiàng)。3.4 氣壓計(jì)噪聲診斷先分清是“讀數(shù)噪聲”還是“飛控振動(dòng)”很多人在定高不穩(wěn)的時(shí)候一上來就調(diào)PID其實(shí)要先把噪聲源分清楚。排查方法很簡單飛機(jī)上鎖放在桌上螺旋槳不轉(zhuǎn)讀取濾波前氣壓計(jì)原始高度數(shù)據(jù)序列。如果此時(shí)波動(dòng)都超過±30cm那說明是傳感器自身干擾或硬件布局問題優(yōu)先做遮擋、濾波、電源去耦。接下來螺旋槳油門加到30%不推桿飛機(jī)還在地上壓著讀取同樣的數(shù)據(jù)。如果波動(dòng)顯著加劇那就是氣流沖擊和機(jī)體振動(dòng)通過PCB傳導(dǎo)給氣壓計(jì)造成的影響。這時(shí)候調(diào)泡棉位置、加橡膠減震柱比調(diào)PID更管用。最后才是飛起來看高度曲線的毛刺確認(rèn)濾波和融合參數(shù)。這個(gè)排查順序能省掉至少兩天的瞎調(diào)時(shí)間。4. 定高控制閉環(huán)外環(huán)高度、內(nèi)環(huán)速度與油門前饋的設(shè)計(jì)路徑4.1 串級(jí)PID結(jié)構(gòu)為什么外層只輸出速度而不是直接輸出油門定高控制最忌諱的就是高度誤差直接映射到油門。這種單環(huán)控制在小型四軸上幾乎必炸因?yàn)楦叨鹊接烷T之間的傳遞函數(shù)嚴(yán)重非線性同樣高度的偏差電池電壓高時(shí)油門修正一點(diǎn)點(diǎn)就夠電壓低時(shí)油門加2%都不夠四個(gè)電機(jī)轉(zhuǎn)速變化對(duì)升力的貢獻(xiàn)又受電池內(nèi)阻和環(huán)境溫度影響。所以這里使用內(nèi)外環(huán)串級(jí)控制這是工程上被反復(fù)驗(yàn)證的結(jié)構(gòu)外環(huán)高度環(huán)期望垂直速度 Kp_h * (目標(biāo)高度 - 當(dāng)前高度) Ki_h * 高度誤差積分當(dāng)高度低于目標(biāo)時(shí)這個(gè)值是正的向上高于目標(biāo)時(shí)是負(fù)的向下。這個(gè)速度指令作為內(nèi)環(huán)的輸入。內(nèi)環(huán)垂直速度/加速度環(huán)油門修正 Kp_v * (期望垂直速度 - 當(dāng)前垂直速度) Ki_v * 垂直速度誤差積分當(dāng)前垂直速度的來源可以用高度差分求導(dǎo)但我更推薦用融合后的垂直速度估計(jì)值就是互補(bǔ)濾波里那個(gè)積分量因?yàn)樗鼫p掉了很多氣壓計(jì)高頻噪聲讓內(nèi)環(huán)控制的微分項(xiàng)不那么暴躁。整個(gè)結(jié)構(gòu)看下來外環(huán)保高度穩(wěn)定內(nèi)環(huán)保高度變化速率這本質(zhì)上是“位置-速度”控制的嵌套抗擾能力強(qiáng)很多。4.2 垂直速度估計(jì)與高度微分的取舍通俗解釋高度環(huán)相當(dāng)于開車時(shí)看與前車的距離來控制車速速度環(huán)相當(dāng)于踩油門讓實(shí)際車速跟上期望車速。如果你只看距離去直接踩油門路一顛簸車就會(huì)一頓一頓但你先把距離換成期望車速再一腳一腳微調(diào)油門去匹配這個(gè)車速順暢得多。四軸定高也是同一個(gè)道理。垂直速度估計(jì)用互補(bǔ)濾波里得到的vel_vertical它融合了加速度積分和高度的差分修正。我實(shí)際測試時(shí)速度估計(jì)的延遲在60ms以內(nèi)這足以支撐內(nèi)環(huán)PID控制在120Hz頻率下運(yùn)行得比較平滑。4.3 油門前饋懸停油門的重要作用定高控制里PID只是修正量真正的力量來源是一個(gè)恒定懸停油門基線。這個(gè)值是飛機(jī)懸停時(shí)能穩(wěn)定維持高度所需的油門百分比取決于機(jī)架重量、電機(jī)效率、螺旋槳螺距、電池電壓每個(gè)機(jī)器都不一樣。我習(xí)慣的做法手動(dòng)模式下把飛機(jī)飛到1.5米左右基本穩(wěn)住高度讀出遙控器油門通道原始值換算成油門百分比例如遙控器1000-2000懸停油門在1450附近則懸停油門(1450-1000)/100045%。把這個(gè)值寫入?yún)?shù)throttle_hover。定高模式下總油門輸出 throttle_hover PID修正。沒有這個(gè)前饋PID只能從頭去“找”懸停油門的位置每次起飛懸停點(diǎn)都有偏移就會(huì)看到飛機(jī)升上去、掉下來、再升上去越晃越厲害。有了前饋PID只負(fù)責(zé)修正擾動(dòng)修正量從±20%降到±5%穩(wěn)定性一目了然。4.4 定高PID參數(shù)整定的實(shí)操順序參數(shù)整定必須按“從內(nèi)到外”的規(guī)則來。先只跑內(nèi)環(huán)速度環(huán)把外環(huán)去掉給定一個(gè)固定的期望垂直速度比如0.5m/s觀察飛機(jī)是否能勻速上升/下降。此時(shí)Kp_v從0.5開始加加到期望速度和實(shí)際速度的響應(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開始給一個(gè)0.5米的高度階躍比如從1.5米目標(biāo)高度改成2.0米觀察高度響應(yīng)曲線。理想響應(yīng)是在1-2秒內(nèi)平滑到達(dá)目標(biāo)高度附近在一個(gè)窄帶內(nèi)穩(wěn)住不來回穿越。如果高度在目標(biāo)值附近以明顯的周期震蕩通常K作用不足或I作用過大如果高度到達(dá)目標(biāo)特別慢但最后也穩(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。這個(gè)組合在我這個(gè)400mm軸距、1080g起飛重量的機(jī)架上表現(xiàn)穩(wěn)定懸停高度波動(dòng)±15cm推力波動(dòng)小于±5%。換機(jī)架時(shí)參數(shù)不一定通用但整定順序和現(xiàn)象判斷方法是通用的。5. 實(shí)測中的坑與調(diào)參記錄起飛掉高、洗槳效應(yīng)與溫度漂移5.1 起飛瞬間掉高氣壓計(jì)被下洗氣流“壓住”了嗎第一次試飛定高時(shí)我遇到了一個(gè)很典型的坑接通定高模式后飛機(jī)先迅速向上躥了30cm然后又突然掉下來接近50cm最后才算晃晃悠悠穩(wěn)住。第一反應(yīng)是PID參數(shù)過激但串口打印數(shù)據(jù)顯示了一個(gè)更有趣的現(xiàn)象氣壓計(jì)高度在起飛瞬間上升了30cm而實(shí)際飛機(jī)高度并沒有動(dòng)。原因是起飛瞬間油門加大螺旋槳下洗氣流沖擊地面再反彈在飛控板附近形成了一股瞬時(shí)高壓氣流氣壓計(jì)感受到的壓強(qiáng)比環(huán)境高換算出的高度自然往上跳。飛控以為飛機(jī)高了就減小油門結(jié)果高度又往下掉。這就是“起飛掉高”的一個(gè)重要誘因。解決方法分三層在解鎖后到起飛前不急著把期望高度設(shè)置到當(dāng)前高度可以先記錄起飛瞬間的高度偏移作為基準(zhǔn)。油門切換瞬間速度環(huán)飽和限制要加限制期望垂直速度最大±1.5m/s避免高度計(jì)算錯(cuò)誤時(shí)輸出極端油門。起飛前在地面晚幾秒再切定高讓氣壓計(jì)完成“地面氣流擾動(dòng)”到“空中流動(dòng)場”的過渡。5.2 洗槳效應(yīng)低空懸停時(shí)的“地面效應(yīng)”非線性在距離地面30cm以內(nèi)低空懸停時(shí)定高非常容易抽風(fēng)表現(xiàn)為飛機(jī)上下來回竄。這是地面效應(yīng)在作祟近地時(shí)螺旋槳下洗氣流撞擊地面后向外擴(kuò)散相當(dāng)于在飛機(jī)下方墊了一個(gè)氣墊同樣油門提供的升力會(huì)突然變大。這個(gè)非線性環(huán)節(jié)和高度環(huán)的PID產(chǎn)生耦合如果PID響應(yīng)太快就會(huì)在氣墊效應(yīng)區(qū)域形成振蕩。處理經(jīng)驗(yàn)是定高高度的生效死區(qū)設(shè)置為±10cm。當(dāng)高度誤差小于死區(qū)時(shí)PID輸出保持上一值不變這樣避免微小抖動(dòng)讓執(zhí)行機(jī)構(gòu)來回動(dòng)作。另外可以降低低空段的外環(huán)P項(xiàng)這點(diǎn)我通過一個(gè)高度相關(guān)的增益衰減系數(shù)實(shí)現(xiàn)高度小于0.5米時(shí)Kp_h按(實(shí)際高度/0.5)的平方衰減。5.3 溫度漂移與“假高度”問題定高飛行到第三塊電池時(shí)我發(fā)現(xiàn)了一個(gè)隱蔽問題飛控在暖機(jī)狀態(tài)下高度自己慢慢從1.5米漂到了2.1米但是視覺上飛機(jī)并沒有明顯上升。這就是氣壓計(jì)溫漂帶來的“假高度”。排查過程很有意思我先是懷疑濾波算法把a(bǔ)lpha調(diào)小沒用換成雙濾波還是漂。最后用溫度數(shù)據(jù)一對(duì)比恍然大悟MS5611的溫度在開機(jī)三十秒內(nèi)從27°C升到42°C溫差15°C帶來的零點(diǎn)偏移足以換算成1米的高程差。雖然傳感器做了補(bǔ)償?shù)寮?jí)局部溫度梯度依然存在。解決方案在硬件層面是加大氣壓計(jì)泡棉和主控之間隔熱軟件層面有三個(gè)補(bǔ)充手段開機(jī)預(yù)熱飛控上電后至少等待40秒再解鎖觀察溫度變化速率小于0.5°C/3s時(shí)才算穩(wěn)定。溫漂校正建立溫度和高度漂移的查表每30秒記錄一次溫度值和高度值用線性擬合消除相關(guān)性部分。起飛前鎖基準(zhǔn)解鎖瞬間重新鎖定初始高度消除長時(shí)間靜態(tài)積累的漂移。這個(gè)方法結(jié)合之后我測試中連續(xù)飛行8分鐘定高漂移被壓在40cm以內(nèi)主要還是由于正常環(huán)境氣壓變化的部分在可接受范圍。5.4 油門響應(yīng)不平順的排查區(qū)分“傳感器噪聲”還是“控制極限環(huán)”調(diào)試后期遇到另一個(gè)怪問題定高時(shí)油門總是輕微周期性抽動(dòng)每0.5秒左右一次幅度大約油門值的3%肉眼可見螺旋槳轉(zhuǎn)速在細(xì)微地一變一變的。這個(gè)現(xiàn)象持續(xù)存在不是偶發(fā)。通過地面站回看數(shù)據(jù)發(fā)現(xiàn)高度曲線其實(shí)很平滑說明傳感器融合沒問題但速度內(nèi)環(huán)的目標(biāo)速度和控制輸出的差值在周期性波動(dòng)。進(jìn)一步分析是內(nèi)環(huán)速度控制頻率100Hz但高度環(huán)輸出頻率50Hz兩個(gè)環(huán)數(shù)據(jù)同步時(shí)序上差了半個(gè)周期導(dǎo)致速度目標(biāo)指令里面的更新帶有鋸齒狀的臺(tái)階內(nèi)環(huán)對(duì)臺(tái)階比較敏感就產(chǎn)生了0.5秒周期的極限環(huán)。解決辦法是在高度環(huán)和速度環(huán)之間加一級(jí)速度指令平滑緩沖用一個(gè)二階低通濾波器處理期望垂直速度截止頻率大約3Hz讓高度環(huán)輸出的速度階躍變成平滑斜坡速度內(nèi)環(huán)的抖動(dòng)徹底消失。如果遇到類似油門周期性抽動(dòng)不要第一時(shí)間懷疑氣壓計(jì)先檢查兩個(gè)控制環(huán)之間的信號(hào)同步和指令平滑這是我調(diào)過眾多飛控后最深刻的經(jīng)驗(yàn)之一。5.5 調(diào)試飛行過程的記錄方法整個(gè)調(diào)試過程中串口日志和地面站數(shù)據(jù)回放幫了大忙。我會(huì)在飛控代碼里把以下幾個(gè)變量以100Hz頻率輸出nudged高度濾波后融合高度、期望高度、期望垂直速度、實(shí)際垂直速度、油門輸出百分比、電機(jī)PWM原始值。每次飛完一個(gè)架次把日志拉下來用MATLAB離線畫圖圖和圖對(duì)照看幾乎每個(gè)異常現(xiàn)象都能定位到具體環(huán)節(jié)。記得有一次飛機(jī)定高時(shí)明顯前傾俯仰看日志才發(fā)現(xiàn)油門修正過程中姿態(tài)角被干擾了0.5度導(dǎo)致水平方向分力把飛機(jī)推走。這個(gè)現(xiàn)象如果只看高度曲線是完全看不出來的必須把姿態(tài)角、油門、高度三張圖疊在一起看。這也是為什么我一直建議不要只依賴機(jī)上飛行效果判斷而是要建立完整的遙測日志習(xí)慣。6. 最后的調(diào)參心得與可復(fù)用的參數(shù)模板調(diào)試了這么長時(shí)間我最大的體會(huì)是定高四軸的難度不在于某個(gè)單一環(huán)節(jié)而在于傳感器、融合、控制三個(gè)層面的耦合。氣壓計(jì)數(shù)據(jù)臟后面所有環(huán)節(jié)都會(huì)跟著遭殃融合滯后嚴(yán)重PID參數(shù)調(diào)到天上也壓不住振鈴前饋油門不準(zhǔn)一切修正都像是蒙著眼睛開車。所以永遠(yuǎn)記得自底向上排查先把數(shù)據(jù)變干凈再談控制。現(xiàn)在給出一份可直接上手的參數(shù)模板供參考具體機(jī)架還需微調(diào)參數(shù)取值說明氣壓計(jì)OSROSR_2048采樣時(shí)間約5ms噪聲與速度均衡氣壓計(jì)采樣周期10ms每次輪詢一種測量融合alpha0.035氣壓計(jì)權(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ù)實(shí)際機(jī)架測量填入期望垂直速度限幅±1.5m/s防止大誤差時(shí)輸出極端油門高度死區(qū)10cm避免微小抖動(dòng)觸發(fā)控制這份模板在400mm軸距穿越機(jī)機(jī)架、1080g起飛重量、MS5611 空腔泡棉、F407飛控板、ANO飛控框架下實(shí)現(xiàn)了懸停高度波動(dòng)±15cm、給一個(gè)0.5m高度階躍、1.5秒內(nèi)穩(wěn)定到目標(biāo)高度±5cm的實(shí)測效果。電池電壓從滿電4.2V一路降到3.6V定高無需重新調(diào)整懸停油門前饋已經(jīng)自動(dòng)把電量影響吸收掉。最后再分享一個(gè)小技巧定高代碼加好后不要急著飛在地面做一個(gè)“假裝起飛”測試。用一根細(xì)繩把機(jī)架吊在支架上讓四個(gè)電機(jī)離地3-5cm人不去推油門只把期望高度改成1米這時(shí)四個(gè)電機(jī)轉(zhuǎn)速同步升高繩子拉住機(jī)身不讓上升高度環(huán)感受到高度不變、速度為零應(yīng)該會(huì)把油門推到一個(gè)穩(wěn)定值附近。這個(gè)測試能驗(yàn)證整個(gè)定高控制鏈路的完整性和穩(wěn)定性又不會(huì)炸機(jī)非常值得在每次改參數(shù)后做一輪比直接上實(shí)飛安全得多。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
91撸色网 玖玖网 欧美| 白嫩嫩一区| 欧美午夜视频| 午夜久久一区二区无码中出| 在线观看国产黄色| 熟女人妻精品一区二区视频| 91N综合网在线| 性色av婷婷久久一区二区点复制| 我要色综合网| 中文子幕一二三| 亚洲图片 91| 国产尤物AV尤物在线观看不卡| 欧美天天综合在线| 91人妻素女| 九九九九日本 | 中文字幕 一区二区 亚洲无码| 欧美成人性爱视频在线播放| 无码九九九九| 99爱久久视频频| 国产精品久久久久久久黄无码| 97鸡把在线视频| 91N综合在线| 人成午夜免费大片| 日韩啪啪视频| 这里只有精品久久| 蜜臀久久久99久久久久| 91在线丝袜视频| 日本三级大片| 欧美一区二区三区日韩| 17c在线成人免费A片观看| 97天天| 97精品久久久久中文字幕| 国产刺激视频| 亚洲欧美日韩综合在线尤物| 天天躁日日躁AAA片李宗瑞| 亚洲无码偷拍| 91日韩| 一区二区三区在线日韩影院观看| 国产地址二三| 精品久久久久黄少妇| 国产高清免费不卡av| 久久69| 国产精品亚洲日韩骚欢乐谷最新地址发布页huanieguty性屋娱乐妖精视频 | av在线观看不卡网站| 在线亚洲丝袜视频网站| 爱干爱射网啊啊啊| 伊人aaa| av亚洲天堂资源网站| 精品国产一区二区久久| 久久乐| 偷窥自拍亚洲天堂网爆| 极品尤物在线观看| 亚洲熟妇乱女区二区三区| 亚洲va综合va国产va中文| 97人妻免费中文字幕| av在线播放国产一区| 国产强奸无码乱伦| 丰满高潮18xxxx| 国产成人无码啪| 嗯嗯啊好大| 97超碰碰碰| 精品人妻1237| 欧美91网站| 岛国999| 殴美日韩m| 久久久精品,3| 99碰碰| 亚洲人码13| 人人操人人操人人操人人操人人操人人人11.CM | 美美91成人国产精品欧美精品久久久久久久| 狠狠干婷婷| 人人摸人人添人人操| 999综合色| 国产三级资源在线观看| 97久久久久久久精| 日韩一性一交一A片俄罗斯| 日韩字幕一区| 亚洲视频小说| 校园春色综合色| 天堂精品| 在线小说视频一区| 免费a v| 国产日韩久久| 少妇厨房愉情理伦片bd在线观看| 在线观看无码三级少妇| 国产精品香蕉热久久新品| 女人喷水视频在线观看| 欧美性爱五月天| 大香交伊人网| 97操b| 欧美综合传媒| 欧美亚洲天堂| 岛国网址国产| 亚洲熟妇自偷自拍另欧美| 免費人妻夜夜爽天天爽爽一区| 操香逼| 激情专区综合| 日本天天操| 91最新综合| 日日碰视频网| 欧美日韩啪啪电影| 九九热精品视频在线观看| 97 亚洲 日韩 欧美 在线| 亚洲第91页 | 老熟女乱伦一区| 久久精品国产欧美日韩亚洲欧美日韩中文久久国产一区 | 亚洲日韩97| 中文字幕乱码在线| 男女激情黄色网址| 欧美亚洲涩涩| 摸奶性爱视频网站在线免费播放| 97色色网| 日韩高清黄片| 成人天天看站长推荐| 二对二中文字幕。| 久久69| 欧美黄片欧美黄片xxx| 操人妻逼91| 色香综合| 激情四射五月天| 激情情色五月天| 三级日本一区二区三区| 欧美第一页性| 高清视频一区| 嗯啊不要在线| 东北女人高潮视频| 99热最新| 欧美性夜| 韩日欧亚a级| 亚洲最大成人a毛毛片| 美女尤物福利视频| 91视频在线观看18| 人妻夜夜爽天天爽麻豆三区网站 | 97操在线| 欧美日韩亚洲五月天婷婷| 日本性爱视频一级| 超碰 国产熟女精品一区| 日本肉体xxxx裸交| 偷拍三区| 伊人嫩草| 日韩视频小说在线观看| 国产欧美日韩在线观看麻豆传媒公司 | 欧美日韩另类激情图片| 一二三区在线| 日韩无码操逼片| 干B| 美腿色图| 久草成人福利导航| 盗摄 精品 另类 一区| 男啪女色黄无遮挡免费观看| 久久三区四区| 不卡啪啪视频| 久久这里精品国产99丫e6| 国产精品女aA片爽爽视频| 嗯嗯啊啊用力视频免费| 日韩乱伦影音先锋| 亚洲色婷婷久久91| 在线亚洲丝袜视频网站| 狼人综合婷婷激情四射 | 五月婷在线| 国产色产精品在线观看| 大肥女高潮bbwbbwhd视频| 97国产精选| ai欧美亚洲小说| 天天干少妇| 国产激情在线| 欧美日韩99| 日本操逼视频免费| 日韩综合成人免费视频| 欧美白嫩女HD| 久久亚州高清| 欧美曰韩国产精品| 骚逼高潮久久精品| 97在线观视频免费观看| 女生看匆91网站| 久一区久久蜜桃| 91综合网站| 99国产人成精品| 天天草天天干天天日| 熟女人妻av在线资源,黄色的资源| 久久久久久AⅤ无码免费肉站| 多毛小伙内射老太婆 | 蜜乳AV网址| 免费一级欧美片片线观看| 加勒比综合在线| 欧美热图99| 欧美在线播放| 日本在线不卡v二区| 亚洲色图欧美视频| 久久这里精品国产99丫e6| 国产剧情在线| 亚欧操逼片在线观看 | 日日夜夜精品| 超碰亚洲97| 老女人91| 五月天婷婷在线看| 日韩乱码Av| 小明看看网址| 男女性无套 免费九一| 欧美中出1| 男人的天堂在线2| 日韩啪啪啪啪啪| 开心五月婷婷激情| 91综合色噜噜| 国产 无码 一区二区| 极品色电影院| 欧美日韩1234| 久99热| 亚洲精品乱码久久久久久蜜桃麻豆| www.成人无码| 欧亚在线视频| 色欧美在线| 国产 v乱码一区二| 国产精品宅男免费| 亚洲凸凹超碰成人| 成人激情无码在线视频| 丝袜翘臀后入欧美校园亚洲自拍另类小说一区中文字幕少妇诱惑 | 色情亚洲日本成人| 岛国片在线视频网站| 骚乳在线| 欧美性巨大╳╳╳╳╳高跟鞋| 熟女欧美日韩综合婷婷| 中国女人内射6XXXXX| 亚洲爱爱视频一区二区| 老女人91| 欧美操逼一二三区| 偷拍 精品另类 凸凹了四区| 日韩有码回春沙龙第一页| 欧美黑人极品高潮喷吹熟女黑人性暴力日韩在线欧美极品一区二区老师黑人潮喷一 | 精品人妻一区二区三区视频| 黄色大香焦1级‘′‘| 日本最新1区2区3区| a片偷拍视频| 久草色悠悠在线视频| 亚洲欧美中文一区二区三| 又黄又硬又粗又长国产视频| 九九av| 色性荡荡荡荡视频| 99re6在线视频播放免费精品| 日韩精品在线观看网站| 啊啊嗯嗯好爽| 国产一级舔足在线观看| 蜜臀亚洲中文| 丁香六月激情| 啊啊啊啊免费视频| 亚洲妇色| 久久婷婷五月| 91看黄片| 天天操天天干一区二区 | 亚洲五区熟女| 欧美传媒一区| 91xingse| 大香蕉碰| 日韩激情啪啪| 妇女性内射冈站HDWWWCOM| 尤物av网站| 国产成人网址| 牛黄色久午久| 中文字幕中文字幕一区二区| 日本三级A片网站com| 97chaopengongkai| 亚洲国产日韩精品久久久| 九九久久国产精品| 91在线美女| 97精品国产97久久久| 亚洲AV无线| 性久久久| 黄色AAAAAAAAAAA大片| 人人操人人干网页| 日韩一级二级在线| 午夜偷拍久久熟女| 亚洲aV无码成人在线观看| 99久久久久| 91殴美大片| 中文在线视频| 国产成人超碰在线| 五月天色五月| 9999久久久久| 欧美日韩不卡a片| www久| 蜜臀久久在线视频| 黑人娇小av在线播放| 国产成人一级av88| 欧美加勒比| 99综合自拍| 国产白丝网站| 中文字幕后石码三区四区| 口爆吞精在线观看| 欧美色图中文字幕| 日韩字幕一区| 亚洲精品欧美专业| 欧美色人| 久久久久久久少妇| 超碰78| 久久无码精品| 日夜尻逼网| 欧美大香蕉久| 91精品网站| 中日韓欧美高清| 欧美亚洲中文| 中文字幕乱码在线| 亚洲天堂五月天国产| 人人干黄色| 欧美日韩国产高清在线一二三区 | 五月天AV资源| 九九九一二三| 日韩免费福利在线观看| 在线国产福利网址导航| 天天插天天干| 超碰在线在公开超碰在线在公开| 传媒免费一区二区三区| 日本免费二区三区| 久久久久久久伊人精品| 神马福利久草| 欧美激情1区| 国产精品直播在线观看直播| 亚洲av噜噜噜噜噜噜| 在线情色电影 91大 | 精品精品精品| 九色 蝌蚪 熟女自| 91深夜夜| 骚熟女吞| 亚洲一区二区性爱电影| 久久国99999| 麻豆国产97在线| 国产嫩草精品A88AV在线| 试看日韩黄片| 青青草天天亲夜夜操网| 人妻熟女一区二区三区在线| 大香蕉乱级| 麻豆啪啪啪视频| 久久久免费高清中文视频| 国产综合网站在线播放 | 激情综合五月天| 蜜桃久久一区| 亚洲色图日韩精品| 中文字幕国产在线天堂| 天天综合网合集91| 99久re热视频精品98| 天天综合网亚洲综合网| 黑人精品XXX一区一二区| 麻豆久久久久久久久丝袜| 思思热国产高清| 九月色婷婷| 蜜臀久久99精品久久久电影| 国产福利夜| 白嫩国模丰满一二三区| 最新日本中文字幕| 4虎在线视频| www.91色综合| 亚洲无码?第一页| 美女天天干| 一区二区播放| 秋霞一级视频在线观看免费| 本道综合精品| 91成人久久| 久热这里| 青椒国产97在线熟女| 欧美 亚洲 综合 制服 另类| 欧美组图日韩亚洲中文字幕| av在线一区二区三区| www.97在线| h无码动漫在线观看| 色噜噜综合在线| 美女主播色欲91抠b在线播放| 久久久久亚洲Av无码专区老牛影视| 国产老熟女| 婷婷爽人人婷婷爽视频| 久久人爽| 97公开久久| 日本女厕偷拍| 久久久999国产精品| 岛国AV一区二区电影| 色婷婷综合久久久久中文国产精品一区中文字幕,国产福利电影一区二区三区 | 精品久久久九九九孕妇| 国产成人自拍视频在线| 天天操天天射天天日| 黑人娇小av在线播放| 久久是精品| 亚洲欧美一区二区三区在钱蜜桃| 啊啊啊好舒服视频| 操久久久久| 91bbbbbb| 日韩中文字幕国产| α√在线| 精久久久| 欧亚洲精品有视频| 午夜精品99久久久久传媒| 日韩偷拍色图| 欲女人妻性色av| 热久日综合| 97一本大道亚洲一区| 亚洲性少妇| 大屁股熟女一区二区三区| 亚热日本熟女| 干美女人妻| 91高清日| 国产精品乱码久久久久| av三级电影在线播放| 97综合久久| 丁香久久| 久插综合| 怡红院成人视频| 日韩精品三级片长长久久| 亚洲性图91| 中文字幕精品三级久久久| 双插在线| 校园春色宗合网| 午夜噜噜噜| 人妻无一区二区三区| 九九色图| 人妻人久久精品中文字幕| 日本高清视频xxxx| 中日高清无码操逼视频| 国产乱子伦一区二区三区免看| 亚洲图片 欧美电影| 免费A片三p视频| 国产无马视频| 欧美日韩理论一区| 亚洲怡春院| 97色伦97色伦国产欧美| 天天操女人| 91蜜臀人妻中文字幕在线| 精品人妻一区二区免费蜜桃视频| 欧美日韩操操操| 免费岛国一级片| 婷婷尹人大香蕉免费| 欧美色图自拍| 在线v中文字幕一区二区三区| 欧美97视频| 乱伦AVxx| 另类图片五月天| 全球成人中文在线| 草草草草视频| 人人操人人舒服| 91九久| 中文字幕蜜乳av| 91女网站| 中国乱伦一区二区| 人妻喷水| 东京太热男人的天堂久久久| 国产情侣自拍在线播放| 久久超碰天天| 久久蜜桃综合网| 人人看人人摸人人色| 欧美亚洲自拍另类人妻| 亚洲精品一卡二卡三卡福利视频网站| 爱做久久久久久| 精品一级| 国内精品久9| 亚洲男人天堂Av| 日韩综合成人免费视频| 农村妇女精品一区二区| 久久久久亚洲Av无码专区老牛影视| 国产在线视视频有精品| 97操b| 日本不卡二三区| 蜜桃网熟妇| 精品一久久久| 丁香五月成人| 强奸乱伦动态污图免费 | 黑丝少妇在线观看| 激情抓乳插进去啪啪啪日韩| 久久超碰98| 又大又长又爽| 欧美亚洲丝袜美女电影| 天天爽天天爽| 五月婷在线| 综合色啪| 91大胆欧美| 天天日日舔舔| 亚州操操穴网| 一区二区三区在线资源| 精品熟女一区=区三区| 日韩精品作爱导航| 校园春色综合| 日韩偷拍色图| av东京热男人的天堂| 91精品导航| 97天天操| 国产在线观看91精品一区| 九九九热| 99re在线观看| 爱欲AV| 老司机免费视频在线91| 女沟厕偷窥piss小便| 色综合九九| 夜夜草网站| 婷婷六月色| 久久黄色网址| 日日摸天天爽夜夜欢| 男啪女色黄无遮挡免费观看| 中文字幕久久婷婷丁香五月天| 欧美色91| av一区二区三区不卡| 天天谢天天干| 日韩AV中文字幕电影| 91天射| 色爱亚洲| 国产精品一区二区 尿失禁| 亚洲欧洲国产综合av| 99精品久久| 久久中文色图| 91色插| 成人三一级一片aaa| 国内自拍 日韩激情 99| 一及黄久一点| 色欧洲| www黄片免费看com| 韩日精品四区| 日本性一区| 国产高清成人mv在线观看| 精品超碰国产| 夫妻天天操岛国视频| 午夜免费视频1000| 外国免费性情大片| 亚洲蜜乳av| 激情文学 国产一二三aV| 亚洲国产天堂| 色狠狠综合噜一二三区| 久久久久921| 97资源视频| 91人妻视频在线| 精品久久久av| 久操免费观看| 欧美狠狠弄| 久热影视| 男人久久精品| 亚洲国产午夜真人一级片中文字幕精品黄网站 | 天美精品原创av片国产| 强奸乱伦 亚洲一区| 久久婷婷视频| www.91欧美| 亚洲av影音先锋| 亚洲男人的天堂网| 午夜精品探花| 99久久久无码| 亚洲不卡三级手机播放| 啊啊啊啊在线观看网址| 国产v片在线免费观看| 国模吧 一区二区三区| 裸体美女久久久| 国产乱人伦AVA麻豆软件.| 亚洲精品人伦一区二区| 日本污ww视频网站| 欧美成不卡网| 青青草乱入乱欲视频在线观看| 久久久久九九九| 美女黄码视频午夜| 久久人体一区二区| 天天色综合天天操| 天天干人人看综合| 中文字幕av片| 欧美激情久| 99色热| 日本操逼视频导航| 日韩精品资源专区二区| 亚91网| 男生女生啊啊啊啊| 97在线免费看| 99这里都是精品| 超碰诱惑| 亚洲AV无线| 精品成人女人久久| 99操视频| 国产精选三级在线观看| 精品午夜福利国产一区二区在线观看| 91日韩网站| 射丝袜大香蕉| 午夜精品久久久久久久99热影院| 啊好大好舒服| 裸体美女国产免费久久久网站| 欧美 亚洲 综合 制服| 又粗又长又爽在线观看| 欧美少妇色图| 精品美女少妇一区二区| 欧洲色综合| 亚洲情色综合网| 97资源制服丝袜| 国产免费一区在线观看| 人妻 丝袜美腿 中文字幕| 黄片www视频免费| 欧美日韩一区二区三区四区蜜桃| 亚洲中文字幕熟女少妇一区二区| 超碰97.com| 亚洲精品丝袜-不卡成人免费……| 日本成熟少妇A∨网站| 在线不卡视频| 91精品电影18| www.色五月| 狠狠穞A片一區二區三區| 9999久久久久| 久久婷婷五月天| 青青青国产| 超碰97男人| 国内成人圈中文字幕无码视频| 中文字幕第二页| 东北毛片| 顶级丝袜熟女一区二区三区 | 黄色大片免费在线| 日韩欧美亚洲一区二区三区影院| 亚洲。日韩。欧美| 97一本大道亚洲一区| 亚洲女人91| 日韩一级成人毛片免费观看 | 成人影 天天操 亚洲| 国产丸一视频| 男人成人黄色视频在线观看免费下载| 久久久久久久人妻丝袜| 26UUU欧美激情一区二区| 久久久久久午夜男人的天堂| 欧美体内射精| caopeng97| 天天操熟妇| 黄在线| 2011国产精品| 亚洲精品第一| 国产精品一二三区福利| 欧美日韩国产电影| 欧美精品二区视频在线| 久久天天摸| 国产精品另类| 岛国片在线观看视频亚洲| 精品国产乱码久久久兰草影视| 神马久久久久| 91老熟女逼| 日本亚欧爱爱| 国产精品探花在线| 欧美91色| 久久精品国产亚洲AV无码电影| 国产精品视频播放| 亚洲图片欧洲图片aⅴ| 十八禁电影伊人网| 国产免费一区二区在线A片视频| 亚瑟国产精品久久无码| 色色热| 大JI巴好深好爽又大又粗视频| 在线一道啪| 亚洲熟女少妇免费视频| 六九九九| 国产亚洲美日韩Aⅴ中文字幕无码成人| 伊人一区二区三区| 3D污黄视频在线观看| 亚洲综合20p| 亚洲情色图片区| 国产美女口爆吞精视频| 九九九九免费高| 日韩人妻一二三区视频| 密臀在线视频| 1024久久高清视频| 91骚熟女| 亚洲网污污污污| 韩国久久97| 久久无码电影| 黑人狂躁日本妞一区二区三区| 一区二区三区麻豆| 亚洲图片欧美另类综合免费视频大大香| 成人无码专区精品视频| 精品一区二区三区丰满熟女-亚洲欧美一区| 亚洲av无码国产精品字幕| 人人插人人搞人人操| 青青草好吊色| 操B久久| 东京热男人的天堂精品| 欧美亚洲色的图| 超碰在线国产| 亚洲无码 国产无码| 91少妇高潮| 欧美性爱网97| 色婷婷丁香五月| 黑人精品XXX一区一二区| 后入式999| 亚洲男人天堂2012| 天天日老熟妇| 操b网站亚洲无码| 午夜精品视频777| 3d成人精品一区二区| 国产一区二区成人av在线播放| 久草新免费| 色色色综合网| 免费97视频| 久久精品免视看国产成人﹣蜜臀av一区. 久久精品免视看国产成人,蜜臀av一区 | 亚洲欧美天| 亚洲欧美国产中文视频| 欧美日韩国产在线| 操逼天美3区| 欧美姓爱综合网| 巨乳特殊服务按摩| 欧洲精品一级二级精品综合视频综合 | 欧美日韩亚洲少妇寂寞影院正在播放 | 中文字幕 一区二区 亚洲无码| 九九热男人天堂| 久久蜜色情在线视频xxx免费观看| 亚洲综合九| 婷婷久久综合久| 超碰亚洲97| 天天舔天天日天天射| 精品日韩产品在线,日韩在线不卡视频,欧美日韩免费专区/久, | 台湾佬中文娱乐网久久久久久久久久com | 国产 无码 一区二区| 粉嫩av在线一区二区| 综合激情婷婷| 美女91在线观看| 夜夜春夜夜操| 家庭乱伦网站国产| 久久五月视频| 999 久久久| 超碰久在线天天做| 免费精品无码一级毛片牛牛影视| 欧美日韩免费性爱| 精品无人区麻豆乱码1区2区图片| 啊啊啊啊在线播放| 免费试看60秒| 五月天婷婷激情| 欧洲无码一区二区| 蜜臀久久99精品久久久久久成人小说| 操逼逼一区视频| 亚洲av影音先锋| 日韩性爱播放| 欧美亚洲韩国视频十五区| 国产亚洲精品无码三区| 亚洲图片色图欧美另类| 五月激情天| 超碰97男人| 91快色色色色色| 91天美传媒精品| 久操综合在线| 一区二区首页| 大肥女高潮bbwbbwhd视频| 国产少妇与亚洲av| 色臀AV| 青青草无码视频| 国产网红精品| 国产熟女一区二区| 蜜桃久久一区二区三区| 欧美性夜| 欧色性第一页| 探花激情视频| 精品1区2区3区| 国产做?爰片久久毛片?片美国| 日韩性爱一级片| 全球成人中文在线| 情色五月天网| 99re视频在线观看这里只有精品| 欧美在线天堂| 白丝少妇一区二区| 夜夜草网站| 免费av高清无码| 日日爽熟女| 一本正道久久熟女| 亚洲超碰AV| 国产精品视频内谢女人| 美女9118禁| 闷骚老熟女15P| 日本三级中国三级99人妇网站| 无码操逼网| 伊人操你| 99热在线观看| 东京热不卡视频| 欧美色五月| 亚洲 一区二区 自拍| 久久久亚洲| 97超碰超| 精品美女少妇一区二区| 亚洲青色欧美| 夜夜久久| 97爱b| 欧美18禁91| 亚州色交| 日韩女优中文字幕| 99婷婷| 欧美少妇熟女| 亚熟在线| 日日干男人的天堂| 超碰在97| 蜜区区视频79| 一品道视频一区二区三区| 久久精彩视频| 亚洲无码色| 手机看av网站在线看| 久久精品中文字幕观看| 国产女人高潮嗷嗷嗷叫小说 | 青操影院| 婷婷20月天青娱乐| 99在线精品视频| 91精品91久久久中77777| 后入式免费视频| 无码人妻精品一区二区三区99不卡 | 中国一级操逼视频| 免费少妇一区二区| 艹少妇网站| 欧美久热| 日韩欧美成人大香蕉| 久久99手机免费视频| 婷婷导航| 超碰激情808| 超碰成人公开| 日本成a人v网站在线观看| 校园春色综合网| 日本色色色网站免费看不卡| 99老司机精品视频在线观看| 国模吧 一区二区三区| 九九九九久久久| 操屄不卡视频| 日韩内| 人人操,人人液| 成人日韩欧美| 伊人伊人LD| 人人妻人人爱人人玩| 亚洲九九九| 99在线无码精品秘 入口黑人| 97久精品| 88在线一区二区三区| 俄罗斯及免费在线看| 五月天婷精品激情| 神马久久网| 国产自产自拍| 日韩精品区二区三区不卡| 欧美性生活内射| 人人操 欧美| 婷婷色网| 日本免费专区| 性综合网| 九九拍拍精品视频在线播放| 欧美乱伦专区| 久久日本熟女精品一区| 国产精品一二三在线看| 精久久久| 精品人妻一区二区三区-国产精品 一个人在线看的黄色电影网站 | 人妻色偷色噜| 久污| 黄aaaaaaaaaaaaaaaaaa色网站| 色天天野狼综合社区| 淮穴色AV| 女人喷水视频在线观看| 日本精品一区二区不卡| 翘臀vidoes| 熟女精品va中文字幕| 东京热大香焦| 蜜桃视频精品一区二区| 国产日韩色综合| 久久久久女教师免费一区| 操香逼| 久久思思热| 亚洲蜜桃V妇女| 国产AAAAAABBBBB| JuliaAnnXXX888| 午夜精品久久久99| 人人色97| 熟妇操花| 国产熟女乱论| 美女写真| 精品久久久高清无码| 九热中文字幕| 欧美爱国产综合、| 老女人老91妇女老热女| 淫色网综合| 五月天色图影视| 色婷婷色99国产综合精品| 91夜色| 91丨人妻丨国产丨丝袜| 91亚洲影视| 麻豆天天躁天天揉揉AV| 日本精品久久久久久久| 美腿丝袜高跟网免费视频免费视频| 男人的天堂,欧美亚洲另类国产日韩,日本高清一区二区 | 91日韩网站| 国产操逼逼网| 欧美爆乳精品一区二区| 综合 亚洲 欧美| 91是天天| 超碰97COm中文| 精品人妻15区| rivers-china.com| 国产精品探花在线| 干少妇视频| 国产精品99精品视频网站| 人爽不卡视频| 亚洲 暴爽 AV人人爽日日碰| 国产在线能看的你懂的| 亚洲 自拍偷拍 欧美| 色婷婷综合久久久久中文一区二区| 国产黄色 A 片免费看| 亚洲三区视频| 综合色99| 欧美狠狠弄| 97中文字幕一区| se吧提供91精品国产91久久久久久 | 亚洲αv一区二区三区| 女人喷水视频在线观看| 色五月综合| 男人天堂站| 国产精品久久泡妞网站| 无码直播久久久| 久久高清欧美国产| 亚洲瓯美色图| 狠狠97| 美国日韩黄片| 色青青久久影视| 无码免费在线观看黄色片| 久久久久久综合久久伊人蜜月| 超碰97欧美日韩| 国内一级精品| 国语对白露脸XXXXXX| 色五月综合网| 欧美 熟女 日韩| 色姑娘综合网| 亚欧操逼片在线观看 | 亚洲熟女乱色一区二区三区| 色婷五月| 18+91网站| 亚洲日韩美国人妻| 第四色色综合91| 超碰9 7女人 | 日韩免费中文字幕视频| 日本一区二区三区欧美日韩中文字幕| 日韩精品人妻中文字幕不卡乱码| 岛国1区2区3区在线观看| 99色在线观看| 精品99999| 97综合在线观看| 欧美同性恋 的搜索结果 - 91n| 久久久久亚洲Aⅴ无码| 熟女色图在线| 日韩AV无码网站| 亚洲诱惑| 成人麻豆av电影网站| 欧美 亚洲 91| 日韩午夜精品一区二区三区电影| 久久精品成人一区二区三区蜜臀| 不卡一区二区日本视频| 99re综合伊人| 五月婷婷丁香| 国产成年女人免费视频播放a| 成人黄页| 国产青一二三| 性爱精品一区| 97亚洲精品| 九色 蝌蚪 熟女自 | 精品无码产区一区二| 色婷婷狠狠| 欧美自拍偷拍综合图片| 中出91视频| 午夜后入| 97香蕉人人乳| 熟女突然公开看18禁影片| 97亚洲综合| 99热 按摩 日韩| 欧美中文字幕男人天堂久久精品| 天天日天天干天天摸天天操| 中文字幕乱码人妻一区二区三区,99精品 | 国产成自自拍在线观看| 蜜乳AV.COM| 全国男人天堂网| 在线黄色污污网站| 久操99| 伊人久久大香大香线蕉中文 | 无遮挡男女激烈动态图| 97伊人超碰| 操逼免费视频无码国产| 超碰人人干天天射| 熟女熟妇一区二区三区视频| 亚洲图片91| 久久99精品国产| 操香逼| 天天综合香 ld视频| 清清一区二区三区四区不卡视频| 中文伊人大香蕉视频| 青青操97| 亚洲棕合电彰| 亚洲的天堂网| 吉川爱美亚洲二区在线| 330Dv国产女人终合视频极品人与兽| 丁香五月综合| 午夜成人爽爽爽爽A片李冰冰| 97操综合| 欧美高清91| 国产无码成人无码| 无码久久亚洲高清,| 奇米四色网| 九色视频91| 日本韩国一本产品小视频日本韩国一本产品久久久产品小视频日本韩国一本产品久 | 亚洲性综合| 91天天爽| 大香蕉一区二区在线观看.| 国产操伦| 国产原创剧情在线丝袜| 婷婷色色五月天福利| 综合网~91综合网| 丝袜翘臀后入欧美校园亚洲自拍另类小说一区中文字幕少妇诱惑 | 人人看欧美性爱| 精品伊人久久久大香线蕉小说| 亚洲激情AV| 九九十八精品| 亚洲精品黄码久久久久| 天天插夜夜操| 男女性扦B| 黑人猛交| 屌逼麻豆| 人妻激情在线视频| 91肉丝| 欧美十八禁在线看| 天天日美女的B| 少妇一级婬片免费放一级a性色.| 国产亚洲99久久精品| 99国产精品免费| 午夜福利激情在线视频| 久久99热这里只频精品6学生| 人妻内射一区二区在线视频| 亚洲三级。日韩三级| 日本性爱少妇| 亚洲不卡不卡中文字幕不卡| 久久欧美激情| 亚洲免费人妻在| 91熟女视频网| 成人亚欧免费视频| 97天天爽| 蜜臀久久99精品久久久久久-DVD| 啊灬快c我灬啊灬用力灬啊灬-国产精品性做久久久久久-成人AV | 久久久久9999| 啊啊啊啊啊啊在线| 亚洲Av无码成人精品国产| 伊人97色天使| 尤物视频视频官网| 欧亚第一综合网| 久久欲| 东京热伊久| 国产一级操B视频| 91美女精品| 一区二区三区在线资源| 中文字幕在线免费观看2| 精品妇女一区二区三区| 久久产精品一区二区三区电影| 午夜舔阴达高潮视频免费看| 激情专区综合| 亚州欧美在线| 91日日| 亚洲欧美另类少妇精品| 久久首页| 妇女一区二区三区| 久久久网一区| 精品中文字幕一区二区l - 百度| 久久9999 | 嗯啊视频免费在线观看| 成人日本片久久久蜜桃| 五月丁香六月| 99色热国产视频精品| 麻豆婷婷成人一二三| 色啪网| 久久一区二区高清免费| 男人在线天堂| 久久久男人的天堂| 四虎影视在线| 久久欧美性爱视频| 人人操 欧美| 色欲天香天天综合网-成年人三级片网站-欧美乱妇狂野-日韩国产专区-久久久久久 | 欧美图片偷拍| 日韩一性一交一A片俄罗斯| 久久华人网| 青青草自拍视频在线播放| 亚洲一区二区三区AV无码| 天天色图| 高清有码一区二区| 伊人9| 亚州欧美综合| 激情终合网| 欧美美女在线高潮999| 日韩人妻操B| 久久美女福利是上海美女| 奇米狠999| 中文字幕亚洲永久精品| 91搞逼视频| 白丝被操91| 在线看的av| 性色av婷婷久久一区二区点复制| 精品人妻一区二区三区在| 国内外内射高清视频| 91高潮| 岛国福利在线精品播放| 眼镜人妻101.com| 强奸乱伦动态污图免费| 国产午夜无码片在线观看影视 | 18禁在线视频| 日韩精品碰碰| 国产亚洲精品自在线亚洲情侣| 黑人白女精品一区| 377p欧洲日本亚洲大胆| 日韩av在线播放不卡| 97色婷| 亚洲综合另类欧美久久久| 超碰中文字幕人妻草一区| 丝袜天堂网| 国产精品嫩草影院午夜两性| 在线国产探花| 精品97久久综合| 91性片| 天天激情干| 亚欧日韩成人| 97操97色| 欧美日韩国产精品久久色婷婷| 国产综合色精品在线观看| 伊人影院综合是一个与深夜成人在线 | 国产中文日韩欧美一区二区三区人妻丝袜美腿 | 老色鬼成人精品视频下载大在线观看| AV丝袜东京热| 成人自拍三级在线观看| 99免费视频| 欧洲亚洲天堂精品| 青娱乐国产剧情av一区| 欧美色色色| 欧美久久久15P| 干我久操| 亚洲Av噜噜一区二区三区妖精| 97在线看| 富二代亚洲精品99| 四虎免费在线播放| 国产主播福利| 久久久久久久少妇| 超碰97久久| 欧美不卡在线美女| 91精品无码久久久久久久| 色妹子A V| TS人妖另类精品视频系列| 欧美中文字幕男人天堂久久精品| 成人免费性爱视视| 天天爽夜夜欢视| 黄色AAAAA欧美| 超碰在线97国产| 日韩视频啪啪| 97久久超碰日韩精品| 97干在线| 男女无套 免费网站| 久久精品72| 国产成人bd在线观看| 插老姨肥穴| 中文久久爆乳| 久久啊啊啊| 美日韩一二三区| 欧美激情综合色综合啪啪五月| 夜夜精品视频一区二区| 久久久久久久九九九九九九| 国产狂喷潮在线精品| 欧美日本视频一区| 久久色人体| 国产亚洲精品农村妇女| 99在线免费公开视频| 任你干在线视频| 五月丁香久久| 国产精品99久久久www| 91精品人妻| 天天干人妻视频| 九九国产热| 美骚妇av高清在线| 综合色色婷婷| 人人看人人插| 国产成年女黄特黄| 性色av一区二区| 久久国产AⅤ| 九九九九九九九九九国产精品 | 99re只有精品|