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

ARTICLE DETAIL

資訊詳情

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

STM32+MPU6050數(shù)據(jù)濾波實(shí)戰(zhàn):從噪聲分析到姿態(tài)解算

STM32+MPU6050數(shù)據(jù)濾波實(shí)戰(zhàn):從噪聲分析到姿態(tài)解算 玩過MPU6050的朋友大概都有過這種經(jīng)歷明明小車放在桌面上靜止不動(dòng)串口打印出來的角度數(shù)據(jù)卻上下跳個(gè)不停像是傳感器自己在“發(fā)抖”。用這樣的數(shù)據(jù)去做自平衡車或者云臺穩(wěn)定結(jié)果就是電機(jī)不停抖動(dòng)、重心根本穩(wěn)不住。我也在這上面折騰過很長時(shí)間試過各種網(wǎng)上流傳的代碼最后才搞明白濾波這件事核心不是套用某個(gè)公式而是想清楚你手里的數(shù)據(jù)到底臟在哪里、你要的是哪一種“干凈”。這篇文章就基于stm32_mpu6050這個(gè)經(jīng)典組合把從原始數(shù)據(jù)到可用姿態(tài)角的完整鏈路捋一遍。內(nèi)容包括傳感器數(shù)據(jù)為什么會有噪聲、幾種常見濾波算法的原理和代碼、實(shí)際調(diào)參時(shí)的判斷方法以及一個(gè)綜合互補(bǔ)濾波的實(shí)用方案。適合剛接觸STM32和MPU6050的初學(xué)者也適合已經(jīng)跑通了例程但發(fā)現(xiàn)效果不理想、想系統(tǒng)搞懂濾波的開發(fā)者。1. MPU6050原始數(shù)據(jù)為什么會“抖”噪聲的來源與特性分析先說結(jié)論MPU6050輸出的原始值本身不是不能用的但它直接拿來做姿態(tài)控制時(shí)效果一定會讓你懷疑人生。這不是傳感器壞了也不一定是I2C讀取時(shí)序有問題而是數(shù)據(jù)里混著幾類性質(zhì)完全不同的干擾信號。1.1 傳感器噪聲白噪聲、隨機(jī)游走與固定偏差MPU6050內(nèi)部是MEMS結(jié)構(gòu)測量加速度和角速度依靠微小的硅結(jié)構(gòu)在慣性力下發(fā)生的形變再通過電容變化轉(zhuǎn)換成數(shù)字信號。這種微機(jī)械架構(gòu)決定了它對溫度、振動(dòng)、電源紋波都非常敏感。具體表現(xiàn)可以拆成三類第一類是白噪聲也就是高頻隨機(jī)抖動(dòng)。你把MPU6050放在桌面上用串口以100Hz的頻率打印原始加速度值會看到數(shù)據(jù)在某個(gè)均值附近來回跳跳動(dòng)的幅度通常在±0.02g左右。這類噪聲在頻域上表現(xiàn)為寬帶均勻分布屬于典型的隨機(jī)過程也是濾波算法要處理的主要對象。第二類是隨機(jī)游走也叫零偏不穩(wěn)定性。陀螺儀的零偏零輸入時(shí)的角速度輸出值不是固定不變的它會隨著時(shí)間緩慢漂移。比如剛上電時(shí)靜止?fàn)顟B(tài)的陀螺儀Z軸輸出是-1.2°/s通電半小時(shí)后可能漂到-2.5°/s。這種漂移是低頻的、緩慢的用高頻濾波器根本濾不掉需要在算法層面做補(bǔ)償。第三類是固定偏置也就是bias。每顆芯片出廠時(shí)的零偏都不完全一樣第一顆MPU6050的X軸加速度零偏可能是0.03g第二顆可能就是-0.02g。這個(gè)偏差可以通過上電靜止幾十次取平均值的方式估算出來然后在每次讀取時(shí)減去。1.2 運(yùn)動(dòng)中的測量誤差加速度計(jì)怕振動(dòng)、陀螺儀怕積分漂移傳感器的噪聲不是靜止時(shí)才有的真正麻煩的是運(yùn)動(dòng)過程中引入的誤差。加速度計(jì)測量的是“比力”也就是物體受到的加速度總矢量和。當(dāng)你的設(shè)備靜止時(shí)它測量的只有重力加速度g此時(shí)可以通過三角函數(shù)算出傾角。但設(shè)備一旦運(yùn)動(dòng)起來加速度計(jì)測到的不再是單純的重力分量而是疊加了運(yùn)動(dòng)加速度的混合值。這時(shí)候如果你直接用atan2(acc_y, acc_z)算角度得到的姿態(tài)會瞬間被運(yùn)動(dòng)加速度“帶跑”表現(xiàn)得非?!百\”——小車一加速角度就亂跳。陀螺儀的情況正好相反。陀螺儀測量角速度短期內(nèi)積分出來的角度非常平滑不會像加速度計(jì)那樣被運(yùn)動(dòng)加速度干擾。但它有一個(gè)致命問題積分會把零偏誤差也累加起來導(dǎo)致角度隨時(shí)間緩慢漂移。你可能只是把設(shè)備靜止放了一分鐘積分出來的角度已經(jīng)從0°漂到了20°。加速度計(jì)姿態(tài)“噪聲大但無漂移”陀螺儀姿態(tài)“短期平滑但長期漂移”這兩者的互補(bǔ)性正是后面所有濾波算法的根本出發(fā)點(diǎn)。1.3 數(shù)字層面的干擾I2C讀取與量化誤差除了傳感器本身的物理特性數(shù)據(jù)鏈路也會引入“假噪聲”。STM32通過I2C或SPI讀取MPU6050時(shí)如果使用了模擬I2C又沒有加延時(shí)控制讀到的數(shù)據(jù)可能偶發(fā)跳變。MPU6050的加速度計(jì)是16位ADC輸出如果配置的量程是±2g那么每個(gè)LSB代表的物理量是2g/32768≈0.000061g。聽起來分辨率非常高但實(shí)際系統(tǒng)的底噪遠(yuǎn)大于這個(gè)值低四位往往就是隨機(jī)的不必過度解讀。判斷抖動(dòng)是傳感器問題還是讀取問題有個(gè)簡單辦法在MPU6050靜止?fàn)顟B(tài)下連續(xù)讀500個(gè)加速度原始值如果數(shù)據(jù)呈近似高斯分布且重復(fù)試驗(yàn)時(shí)均值穩(wěn)定那就說明讀取鏈路沒有問題抖動(dòng)就來自傳感器本身濾波算法要解決的就是這個(gè)噪聲。2. 動(dòng)手之前先算清賬根據(jù)應(yīng)用場景決定濾波目標(biāo)很多教程上來就貼濾波代碼卻從不說清楚這個(gè)濾波器適合什么場景、截止頻率為什么取這個(gè)值。在我看來這是最要命的一個(gè)坑——你把別人調(diào)試好的參數(shù)抄過來但你的設(shè)備運(yùn)動(dòng)特性和別人的完全不同效果自然千差萬別。2.1 運(yùn)動(dòng)頻率與濾波截止頻率的關(guān)系每個(gè)實(shí)際系統(tǒng)都有自己的特征運(yùn)動(dòng)頻率。手持云臺上的人的抖動(dòng)頻率通常在1~10Hz無人機(jī)飛行時(shí)姿態(tài)變化的典型頻率在0.5~5Hz而自平衡小車的傾角修正頻率可以低到0.1~2Hz。一個(gè)性能合格的濾波器應(yīng)該讓“你要的姿態(tài)信號”無損通過同時(shí)把“你不要的噪聲”壓下去。這就是截止頻率要解決的事。我常用一個(gè)生活化類比來理解這個(gè)事你想從一碗粥里挑出紅棗但粥里混著米粒、水、碎渣。如果你用一個(gè)孔特別大的漏勺結(jié)果是紅棗和碎渣一起撈上來如果用一個(gè)孔特別小的濾網(wǎng)紅棗也被卡住了。濾波器就是在找一個(gè)合適的“孔徑”——它要匹配你要撈的東西的“尺寸”。對MPU6050的姿態(tài)數(shù)據(jù)來說你想要的姿態(tài)變化頻率是信號傳感器上的高頻抖動(dòng)和振動(dòng)是噪聲。設(shè)計(jì)濾波器時(shí)先估算信號最高頻率比如兩輪自平衡車的傾角控制周期是5ms傾角變化率一般不會超過2Hz那低通濾波器的截止頻率設(shè)在2Hz左右就相對安全。如果設(shè)在20Hz姿態(tài)響應(yīng)快了但噪聲也大量通過控制效果一定抖。2.2 不同應(yīng)用場景的濾波需求分級我把常見場景按對濾波的要求分成幾檔。如果你給無人機(jī)做姿態(tài)解算需要實(shí)時(shí)響應(yīng)性極好一階低通濾波的相位延遲就會比較傷腦筋需要用互補(bǔ)濾波或卡爾曼這類能提供“加速度計(jì)修正趨勢、陀螺儀提供短期動(dòng)態(tài)”的方案。如果只是做一個(gè)可視化角度計(jì)顯示當(dāng)前傾斜角度延遲幾百毫秒完全無所謂滑動(dòng)平均濾波就足夠了。如果做的是計(jì)步器關(guān)注的不是精確角度而是周期性特征那么重點(diǎn)應(yīng)該是帶通或閾值檢測而不是單純低通。很多初學(xué)者糾結(jié)“到底哪個(gè)濾波算法最好”但現(xiàn)實(shí)中算法沒有絕對的優(yōu)劣只有和“你要解決的具體任務(wù)”是否匹配。你得先回答一個(gè)問題這個(gè)數(shù)據(jù)是用來給人看、還是給控制回路用人眼可以接受一定延遲但控制回路對延遲和噪聲都極其敏感。這兩者的濾波策略會完全不同。3. 常見的濾波算法代碼實(shí)現(xiàn)與調(diào)參要點(diǎn)在這一節(jié)我給出幾種在STM32上跑過的濾波實(shí)現(xiàn)全部用C語言寫可以直接移植。涉及的變量名盡量保持通用方便你改到自己的工程里。3.1 滑動(dòng)窗口濾波簡單直接但延遲代價(jià)要認(rèn)滑動(dòng)窗口濾波也叫移動(dòng)平均是思路最樸素的一種保存最近N次傳感器的值每次輸出這N個(gè)值的平均值。窗口越大平滑效果越強(qiáng)但響應(yīng)也越遲鈍。#define FILTER_WINDOW_SIZE 16 float filter_buffer[FILTER_WINDOW_SIZE]; uint8_t filter_index 0; float filter_sum 0.0f; float sliding_window_filter(float new_value) { filter_sum - filter_buffer[filter_index]; filter_buffer[filter_index] new_value; filter_sum new_value; filter_index; if (filter_index FILTER_WINDOW_SIZE) { filter_index 0; } return filter_sum / FILTER_WINDOW_SIZE; }窗口大小怎么選我做過一組對比實(shí)驗(yàn)IMU靜止在桌面對Z軸陀螺儀的原始值分別做8點(diǎn)、16點(diǎn)和32點(diǎn)的滑動(dòng)窗口濾波。窗口越大輸出越平滑但給一個(gè)階躍輸入突然把傳感器旋轉(zhuǎn)90°時(shí)8點(diǎn)約80ms就能跟上32點(diǎn)則需要300ms左右。如果控制回路的周期是5ms這300ms的延遲意味著30多個(gè)控制周期你的姿態(tài)都還是“舊數(shù)據(jù)”輕則影響手感重則直接振蕩發(fā)散。所以滑動(dòng)窗口濾波只適合對延遲不敏感的場景比如顯示參數(shù)、記錄日志、離線分析。你要用它做實(shí)時(shí)反饋控制就得掂量一下延遲能不能接受。3.2 一階低通濾波輕量級數(shù)字濾波器和截止頻率計(jì)算一階低通濾波也叫指數(shù)移動(dòng)平均是最經(jīng)典的輕量濾波方式計(jì)算量極小適合STM32這類資源有限的MCU。算法核心是當(dāng)前輸出 上次輸出 × 系數(shù) 當(dāng)前輸入 ×1 - 系數(shù)用一個(gè)系數(shù)決定新舊數(shù)據(jù)的權(quán)重。#define LOWPASS_ALPHA 0.2f float lowpass_output 0.0f; float lowpass_filter(float new_value) { lowpass_output (1.0f - LOWPASS_ALPHA) * lowpass_output LOWPASS_ALPHA * new_value; return lowpass_output; }這個(gè)α系數(shù)和截止頻率之間是有公式的α 1 - exp(-2π × fc × dt)其中fc是期望的截止頻率單位Hzdt是采樣周期單位s。如果采樣頻率是100Hzdt0.01s想要截止頻率是5Hz代入計(jì)算α≈0.269。注意α越大說明當(dāng)前新數(shù)據(jù)的權(quán)重越高濾波器響應(yīng)越快平滑效果越弱α越小歷史數(shù)據(jù)的權(quán)重越大平滑更強(qiáng)但延遲也更大。我建議選α?xí)r不要拍腦袋取0.1或0.2這樣“看著順眼”的數(shù)而要根據(jù)你的采樣率和期望截止頻率算出來算完再結(jié)合實(shí)測微調(diào)。這里有個(gè)我自己的經(jīng)驗(yàn)先用公式算出理論值然后把它放大1.5~2倍再試因?yàn)閷?shí)際系統(tǒng)中采樣間隔往往不完全均勻I2C讀取時(shí)間會導(dǎo)致dt抖動(dòng)理論值會偏保守。3.3 卡爾曼濾波輕量一維實(shí)現(xiàn)工程中最常用的姿態(tài)濾波方案很多教程把卡爾曼濾波講得很玄乎但工程上最常用的其實(shí)是簡化成一維的版本。完整卡爾曼要算矩陣協(xié)方差即便STM32F103跑起來壓力不大但代碼復(fù)雜度和理解成本對多數(shù)項(xiàng)目來說并不劃算。做單軸角度濾波時(shí)一維卡爾曼就夠用。狀態(tài)量定義如下角度angle、角速度偏置bias。陀螺儀測量值作為控制輸入驅(qū)動(dòng)狀態(tài)預(yù)測加速度計(jì)計(jì)算出的角度作為觀測值做修正。typedef struct { float angle; // 角度估計(jì)值 float bias; // 陀螺儀零偏 float P[2][2]; // 誤差協(xié)方差 float Q_angle; // 角度噪聲協(xié)方差 float Q_bias; // 零偏噪聲協(xié)方差 float R_measure; // 觀測噪聲協(xié)方差 } Kalman_t; void kalman_init(Kalman_t *kalman) { kalman-angle 0.0f; kalman-bias 0.0f; kalman-P[0][0] 0.0f; kalman-P[0][1] 0.0f; kalman-P[1][0] 0.0f; kalman-P[1][1] 0.0f; kalman-Q_angle 0.001f; kalman-Q_bias 0.003f; kalman-R_measure 0.03f; } float kalman_get_angle(Kalman_t *kalman, float new_angle, float new_rate, float dt) { float rate new_rate - kalman-bias; kalman-angle dt * rate; kalman-P[0][0] dt * (dt * kalman-P[1][1] - kalman-P[0][1] - kalman-P[1][0] kalman-Q_angle); kalman-P[0][1] - dt * kalman-P[1][1]; kalman-P[1][0] - dt * kalman-P[1][1]; kalman-P[1][1] kalman-Q_bias * dt; float S kalman-P[0][0] kalman-R_measure; float K0 kalman-P[0][0] / S; float K1 kalman-P[1][0] / S; float y new_angle - kalman-angle; kalman-angle K0 * y; kalman-bias K1 * y; float P00_temp kalman-P[0][0]; float P01_temp kalman-P[0][1]; kalman-P[0][0] - K0 * P00_temp; kalman-P[0][1] - K0 * P01_temp; kalman-P[1][0] - K1 * P00_temp; kalman-P[1][1] - K1 * P01_temp; return kalman-angle; }卡爾曼里的三個(gè)噪聲協(xié)方差參數(shù)Q_angle、Q_bias、R_measure決定了濾波器的“性格”。Q_angle越大表示你對“模型預(yù)測角度”越不信任濾波器會更傾向于相信加速度計(jì)觀測值響應(yīng)快但輸出更嘈雜R_measure越大表示你覺得加速度計(jì)觀測噪聲越厲害濾波器會更相信陀螺儀預(yù)測平滑但延遲大。我的調(diào)參經(jīng)驗(yàn)是先把R_measure固定到0.01~0.1之間再調(diào)Q_angle觀察靜態(tài)下角度輸出是否抖動(dòng)適中然后轉(zhuǎn)動(dòng)傳感器看動(dòng)態(tài)響應(yīng)能否跟上而不產(chǎn)生明顯滯后。3.4 互補(bǔ)濾波加速度計(jì)和陀螺儀各取所長最推薦入門首選如果讓我給初次做姿態(tài)濾波的人推薦一個(gè)方案我會說互補(bǔ)濾波。它對參數(shù)不敏感效果穩(wěn)定代碼也簡單非常適合作為首個(gè)能“真正用起來”的姿態(tài)濾波算法?;パa(bǔ)濾波的思想是陀螺儀積分得到的角度高頻特性好但低頻會漂移加速度計(jì)計(jì)算的角度低頻準(zhǔn)確但高頻噪聲大。把兩者加權(quán)融合各取所長。權(quán)重由參數(shù)alpha決定alpha越大越信任陀螺儀角度越平滑但對加速度計(jì)的修正越慢。#define COMP_ALPHA 0.98f float comp_angle 0.0f; float complementary_filter(float acc_angle, float gyro_rate, float dt) { // 陀螺儀積分 comp_angle gyro_rate * dt; // 和加速度計(jì)角度互補(bǔ)融合 float weight 0.98f; // 越大越信任陀螺儀 comp_angle weight * comp_angle (1.0f - weight) * acc_angle; return comp_angle; }這里的0.98是經(jīng)驗(yàn)值意味著每一拍里只“相信”加速度計(jì)2%。假設(shè)采樣率是100Hz這個(gè)權(quán)重相當(dāng)于加速度計(jì)的修正時(shí)間常數(shù)約0.5秒也就是當(dāng)你靜止放置設(shè)備時(shí)大約0.5秒后濾波角度會被加速度計(jì)“拉”到正確的絕對值上——這個(gè)響應(yīng)速度對大多數(shù)人來說足夠。想深入理解這個(gè)參數(shù)的自動(dòng)調(diào)節(jié)邏輯可以去搜Mahony互補(bǔ)濾波的實(shí)現(xiàn)思路但初學(xué)階段手動(dòng)設(shè)一個(gè)固定權(quán)重完全夠用。4. 實(shí)測案例基于STM32F103C8T6的濾波前后對比與調(diào)參觀察在實(shí)際板子上驗(yàn)證一下濾波效果。我用的是一塊經(jīng)典的STM32F103C8T6最小系統(tǒng)板通過軟件模擬I2C也就是常說的GPIO口模擬時(shí)序連接MPU6050模塊采樣率設(shè)為100Hz。硬件接線很簡單PB6接SCLPB7接SDAVCC接3.3VGND接GND。測試場景分三種靜止桌面、快速翻轉(zhuǎn)、持續(xù)晃動(dòng)。每種場景分別記錄原始加速度計(jì)算角、滑動(dòng)窗口濾波輸出、互補(bǔ)濾波輸出。4.1 靜止?fàn)顟B(tài)濾波前后數(shù)據(jù)波動(dòng)對比把板子平放在桌面上靜止不動(dòng)分別采集500個(gè)數(shù)據(jù)點(diǎn)。原始角度直接用atan2計(jì)算的波動(dòng)范圍大約是±1.2°標(biāo)準(zhǔn)差約0.6°。這種波動(dòng)對于顯示來說尚可接受但如果直接作為PID控制器的輸入控制量會很不穩(wěn)定電機(jī)就會有明顯的嗡嗡聲。改用16點(diǎn)滑動(dòng)平均后波動(dòng)范圍縮小到±0.4°標(biāo)準(zhǔn)差約0.2°。改用互補(bǔ)濾波alpha0.98后靜態(tài)角度波動(dòng)范圍降到±0.3°以內(nèi)而且響應(yīng)仍然非常靈敏用手輕碰一下板子讓角度突變1°濾波輸出大約在0.1秒內(nèi)就跟蹤到位。所以如果你做的是靜態(tài)角度測量滑動(dòng)窗口就夠用如果要做實(shí)時(shí)控制必須上互補(bǔ)濾波或卡爾曼。4.2 動(dòng)態(tài)翻轉(zhuǎn)濾波器對劇烈運(yùn)動(dòng)的跟隨性能把板子拿在手里快速翻轉(zhuǎn)90°對比不同濾波器對階躍輸入的響應(yīng)?;瑒?dòng)窗口濾波的延遲明顯翻轉(zhuǎn)過程中濾波角度會“拖尾”大約需要150ms才能跟上真實(shí)角度互補(bǔ)濾波在翻轉(zhuǎn)瞬間也能快速跟隨但會略微過沖約2°隨后在幾十毫秒內(nèi)穩(wěn)定到真實(shí)角度。這個(gè)過沖來自加速度計(jì)的“慣性”——翻轉(zhuǎn)瞬間運(yùn)動(dòng)加速度分量混入加速度計(jì)測量值導(dǎo)致加速度計(jì)計(jì)算角瞬間跳變。互補(bǔ)濾波雖然給了加速度計(jì)較小權(quán)重但這個(gè)瞬間錯(cuò)誤還是會影響輸出。這也是為什么在強(qiáng)加速度場景比如無人機(jī)急速拉升、小車急加速下純互補(bǔ)濾波表現(xiàn)并不理想需要更復(fù)雜的算法來“察覺”并抑制這種運(yùn)動(dòng)加速度干擾。對于大多數(shù)入門項(xiàng)目兩輪車、云臺、機(jī)械臂互補(bǔ)濾波的這點(diǎn)過沖完全在可接受范圍內(nèi)不必為它過度設(shè)計(jì)。4.3 實(shí)際操作中的兩個(gè)小坑初始化姿態(tài)估計(jì)和數(shù)據(jù)幀間隔這里分享兩個(gè)在實(shí)測中踩過的小坑。第一個(gè)坑是初始化姿態(tài)估計(jì)。很多教程直接給濾波器狀態(tài)量賦0但如果設(shè)備上電時(shí)并不是水平放置的濾波輸出就會從一個(gè)錯(cuò)誤的初始值開始收斂導(dǎo)致前幾秒的角度輸出非常離譜。解決辦法很簡單上電后先連續(xù)讀50次加速度計(jì)取平均然后算出初始角度再把它作為卡爾曼或互補(bǔ)濾波的角度初值寫進(jìn)去。這樣一開機(jī)姿態(tài)就是靠譜的。第二個(gè)坑是數(shù)據(jù)幀間隔不均勻。STM32通過I2C讀取MPU6050并做串口打印時(shí)整個(gè)循環(huán)耗時(shí)不是固定值。如果用定時(shí)器中斷做采樣中斷里執(zhí)行I2C讀取、濾波、串口發(fā)送那么數(shù)據(jù)間隔相對穩(wěn)定如果你用while循環(huán)加delay(10)實(shí)際間隔可能從8ms到15ms不等。這種時(shí)間間隔抖動(dòng)對互補(bǔ)濾波和卡爾曼影響很大因?yàn)樗鼈兊念A(yù)測方程都依賴dt。我的建議是用一個(gè)固定頻率的定時(shí)器中斷作為采樣節(jié)拍濾波計(jì)算放在中斷里或者中斷置標(biāo)志位、主循環(huán)里處理但無論哪種方式都要保證兩次濾波之間的dt是穩(wěn)定值。我在實(shí)際工程里把采樣率設(shè)為1kHz并在MPU6050的FIFO配合下批量讀取數(shù)據(jù)然后降采樣到100Hz做濾波。這樣既保證了I2C讀取的時(shí)序穩(wěn)定性又保留了數(shù)據(jù)完整性效果比“定時(shí)中斷里慢慢讀”好很多但初學(xué)者不必一開始就上這個(gè)方案先把基礎(chǔ)流程跑通、數(shù)據(jù)穩(wěn)定再考慮更精細(xì)的時(shí)序控制。5. 濾波不只是濾鏡從濾波到姿態(tài)解算的完整鏈路前面講的都是對單一軸的獨(dú)立濾波實(shí)際操作中MPU6050輸出三軸加速度和三軸角速度要得到完整的橫滾角、俯仰角、偏航角還需要做“姿態(tài)解算”——也就是把多個(gè)軸的濾波結(jié)果融合成三維姿態(tài)。5.1 加速度計(jì)滾轉(zhuǎn)/俯仰角計(jì)算atan2的正確姿勢靜止或緩慢運(yùn)動(dòng)時(shí)橫滾角Roll和俯仰角Pitch可以直接用加速度計(jì)的三軸分量計(jì)算。注意這里一定要用atan2而不是atan因?yàn)閍tan2能根據(jù)輸入符號自動(dòng)判斷象限輸出完整的-π到π范圍角度。float roll atan2f(acc_y, acc_z) * 180.0f / 3.14159f; float pitch atan2f(-acc_x, sqrtf(acc_y * acc_y acc_z * acc_z)) * 180.0f / 3.14159f;這里有個(gè)細(xì)節(jié)值得解釋計(jì)算Pitch時(shí)分母用了sqrt(acc_y2 acc_z2)而不是直接用acc_z。這樣做的好處是當(dāng)pitch接近±90°時(shí)acc_z趨近于0直接用acc_z當(dāng)分母會導(dǎo)致數(shù)值爆炸。加上acc_y的分量后分母不會真的落到0計(jì)算結(jié)果也就穩(wěn)定了。這個(gè)公式只對“加速度計(jì)沒有運(yùn)動(dòng)加速度干擾”的假設(shè)成立。只要你的設(shè)備不是持續(xù)高速機(jī)動(dòng)這個(gè)假設(shè)在多數(shù)入門項(xiàng)目中是成立的。5.2 偏航角Yaw為什么不能用加速度計(jì)磁力計(jì)的必要性很多剛接觸的人會疑惑“我也是三軸加速度計(jì)為什么偏航角算不出來”原因很簡單加速度計(jì)測的是“重力方向”而重力方向是完全豎直的它不攜帶任何關(guān)于“繞豎直軸旋轉(zhuǎn)了多少度”的信息。你可以試著把設(shè)備平放在桌面上水平旋轉(zhuǎn)360°加速度計(jì)的三軸讀數(shù)幾乎不變因?yàn)闆]有重力分量變化可以用來計(jì)算yaw。想得到y(tǒng)aw需要引入磁力計(jì)電子羅盤來測量地磁場方向但這又會引入磁干擾、傾角補(bǔ)償?shù)纫欢研聠栴}。這就是為什么很多入門項(xiàng)目都只做Roll和Pitch兩軸姿態(tài)——對兩輪自平衡車、四軸飛行器的部分模式下這兩軸就足夠用了。如果你必須測yaw建議購買集成磁力計(jì)的九軸模塊比如MPU9250或ICM20948并單獨(dú)學(xué)習(xí)磁力計(jì)校準(zhǔn)流程。5.3 一個(gè)你可以直接抄作業(yè)的完整融合例程這里給出一個(gè)適用于STM32F103C8T6的基礎(chǔ)級完整例程框架把前面的知識點(diǎn)串起來。假設(shè)MPU6050的讀取函數(shù)已經(jīng)寫好定時(shí)器以5ms周期調(diào)用main_imu_update也就是200Hz采樣率。// 全局變量 Kalman_t kalman_roll, kalman_pitch; float roll_angle 0.0f, pitch_angle 0.0f; void imu_main_init(void) { mpu6050_init(); // 靜態(tài)采50次算初始角度 float acc_x_sum 0, acc_y_sum 0, acc_z_sum 0; for (uint8_t i 0; i 50; i) { mpu6050_read_raw(acc_x_raw, acc_y_raw, acc_z_raw, gyro_x_raw, gyro_y_raw, gyro_z_raw); acc_x_sum acc_x_raw; acc_y_sum acc_y_raw; acc_z_sum acc_z_raw; delay_ms(2); } float acc_x acc_x_sum / 50.0f / 16384.0f; float acc_y acc_y_sum / 50.0f / 16384.0f; float acc_z acc_z_sum / 50.0f / 16384.0f; float init_roll atan2f(acc_y, acc_z) * 57.2958f; float init_pitch atan2f(-acc_x, sqrtf(acc_y * acc_y acc_z * acc_z)) * 57.2958f; kalman_init(kalman_roll); kalman_init(kalman_pitch); kalman_roll.angle init_roll; kalman_pitch.angle init_pitch; } void main_imu_update(void) { int16_t acc_x_raw, acc_y_raw, acc_z_raw; // 實(shí)際類型按你的讀取函數(shù)修改 int16_t gyro_x_raw, gyro_y_raw, gyro_z_raw; mpu6050_read_raw(acc_x_raw, acc_y_raw, acc_z_raw, gyro_x_raw, gyro_y_raw, gyro_z_raw); // 加速度單位換算假設(shè)量程±2g所以除以16384 float acc_x acc_x_raw / 16384.0f; float acc_y acc_y_raw / 16384.0f; float acc_z acc_z_raw / 16384.0f; // 角速度單位換算假設(shè)量程±250°/s所以除以131.0 float gyro_x gyro_x_raw / 131.0f; float gyro_y gyro_y_raw / 131.0f; float gyro_z gyro_z_raw / 131.0f; float acc_roll atan2f(acc_y, acc_z) * 57.2958f; float acc_pitch atan2f(-acc_x, sqrtf(acc_y * acc_y acc_z * acc_z)) * 57.2958f; // dt為0.005s即5ms roll_angle kalman_get_angle(kalman_roll, acc_roll, gyro_x, 0.005f); pitch_angle kalman_get_angle(kalman_pitch, acc_pitch, gyro_y, 0.005f); }注意這里陀螺儀量程、加速度量程與實(shí)際配置必須一致否則算出來的物理數(shù)值是錯(cuò)的后續(xù)濾波再漂亮也沒有意義。我在調(diào)試時(shí)會先用串口把換算后的acc_x、gyro_x打印出來靜止應(yīng)該接近0減去零偏后垂直放置對應(yīng)值應(yīng)該約等于±1g確認(rèn)量換算正確后再跑濾波這個(gè)習(xí)慣能省一堆排查時(shí)間。6. 濾波參數(shù)怎么調(diào)一套可復(fù)用的調(diào)參方法與評價(jià)標(biāo)準(zhǔn)濾波算法的代碼實(shí)現(xiàn)不難難的是參數(shù)調(diào)節(jié)。不少讀者跑通代碼后發(fā)現(xiàn)自己調(diào)出來的效果還不如原始數(shù)據(jù)——這不是算法問題而是缺少一套“怎么調(diào)、調(diào)到什么程度算好”的方法論。6.1 先測清“噪聲底”每個(gè)系統(tǒng)都有自己的噪聲水平調(diào)參之前先把系統(tǒng)的底噪水平測清楚。方法很簡單設(shè)備靜止以實(shí)際工作采樣率采集原始加速度和角速度數(shù)據(jù)各采集1000個(gè)點(diǎn)計(jì)算標(biāo)準(zhǔn)差。標(biāo)準(zhǔn)差就是你的系統(tǒng)“噪聲底”。這個(gè)數(shù)值決定了濾波器的強(qiáng)度需求——如果加速度X軸靜止標(biāo)準(zhǔn)差是0.03g那濾波后標(biāo)準(zhǔn)差能降到0.01g就已經(jīng)是很好的效果不要指望能濾到0.001g那會導(dǎo)致嚴(yán)重延遲。記錄這個(gè)噪聲底以后做任何相關(guān)項(xiàng)目的濾波參數(shù)初值都能從這套歷史數(shù)據(jù)里找到起點(diǎn)而不是每次從零開始碰運(yùn)氣。6.2 給傳感器一個(gè)階躍信號觀察響應(yīng)速度制作一個(gè)簡易測試架把MPU6050固定在一根硬桿的一端手持另一端??焖傩D(zhuǎn)90°并保持靜止記錄濾波輸出角度隨時(shí)間的變化曲線。觀察兩個(gè)指標(biāo)從開始旋轉(zhuǎn)到濾波輸出首次接近目標(biāo)值的時(shí)間延遲/上升時(shí)間。穩(wěn)定后濾波輸出與真實(shí)角度的誤差穩(wěn)態(tài)精度。用MATLAB、Python的matplotlib或者直接用STM32的串口發(fā)送數(shù)據(jù)到匿名上位機(jī)都能畫出曲線。我的判斷標(biāo)準(zhǔn)是濾波后角度的延遲時(shí)間不應(yīng)超過控制周期的3~5倍穩(wěn)態(tài)誤差應(yīng)在±0.5°以內(nèi)。如果延遲過長說明濾波器對傳感器的信任過度偏向了平滑側(cè)需要調(diào)大新數(shù)據(jù)權(quán)重如果穩(wěn)態(tài)誤差偏大且波動(dòng)劇烈說明平滑不足需要調(diào)大平滑權(quán)重。6.3 一份快速排查指南現(xiàn)象與參數(shù)對應(yīng)關(guān)系我整理了一張表格記錄常見現(xiàn)象和對應(yīng)的調(diào)參方向供大家對照參考現(xiàn)象可能原因調(diào)參方向靜止時(shí)濾波輸出波動(dòng)大平滑權(quán)重不夠增大滑動(dòng)窗口/減小低通α/增大卡爾曼R_measure動(dòng)態(tài)響應(yīng)太慢跟不上動(dòng)作平滑過度減小滑動(dòng)窗口/增大低通α/減小卡爾曼R_measure短時(shí)間快速抖動(dòng)高頻振動(dòng)耦合先加低通濾波去掉高頻分量再進(jìn)姿態(tài)濾波角度緩慢漂移陀螺儀零偏未補(bǔ)償上電初始化時(shí)估算零偏并減去翻轉(zhuǎn)瞬間角度突變運(yùn)動(dòng)加速度干擾增加加速度計(jì)權(quán)重降低或者使用更復(fù)雜的運(yùn)動(dòng)加速度補(bǔ)償靜止穩(wěn)定但一通電就振蕩濾波延遲過大與PID耦合降低PID增益同時(shí)減小濾波延遲先讓控制穩(wěn)住再談濾波這張表解決的是“現(xiàn)象→參數(shù)”的映射問題排查效率比逐個(gè)參數(shù)盲調(diào)高很多。7. 避坑集合MPU6050濾波路上最常見的幾個(gè)錯(cuò)誤認(rèn)知最后聊聊我見過最多的幾個(gè)錯(cuò)誤認(rèn)知這些坑幾乎每個(gè)初做MPU6050濾波的人都會踩一遍。7.1 “濾波算法越復(fù)雜越好”的誤解卡爾曼不是萬靈丹Mahony也不是。算法越復(fù)雜計(jì)算量越大參數(shù)越多越難調(diào)到工作良好的狀態(tài)。對兩輪小車這種應(yīng)用一階互補(bǔ)濾波已經(jīng)夠用對四旋翼這種高速動(dòng)態(tài)系統(tǒng)Mahony互補(bǔ)濾波通常是更均衡的選擇只有對精度和響應(yīng)要求都比較高的系統(tǒng)才值得上全狀態(tài)卡爾曼。先跑通最簡單的看實(shí)測數(shù)據(jù)再?zèng)Q定要不要升級算法。7.2 “濾波代碼抄過來就能用”的誤解很多人從網(wǎng)上抄一段濾波代碼按原樣粘貼到自己工程里期望立刻得到平滑數(shù)據(jù)。結(jié)果往往不理想。原因包括你的采樣頻率和原代碼作者不同dt錯(cuò)位會導(dǎo)致算法行為完全不同你的運(yùn)動(dòng)場景不同原始信號帶寬不同你用的傳感器量程不同換算系數(shù)不同。抄代碼可以但必須自己核對采樣周期、量程、換算、初始值。這四件事沒問題代碼才有意義。7.3 “濾波可以解決所有噪聲問題”的誤解濾波處理的只是數(shù)據(jù)層面的噪聲硬件層面的問題濾波幫不了忙。電源紋波太大、地線接觸不良、I2C上拉電阻太小導(dǎo)致信號變形、傳感器安裝在劇烈振動(dòng)的電機(jī)旁邊且沒有減震——這些問題在源頭上就搞臟了數(shù)據(jù)再好的濾波器也只能把垃圾數(shù)據(jù)濾成“更平滑的垃圾數(shù)據(jù)”。處理噪聲問題的優(yōu)先級應(yīng)該是先改善硬件、再接好地、再做濾波而不是一上來就琢磨濾波。以我自己的經(jīng)驗(yàn)每次遇到“數(shù)據(jù)抖得離譜”的情況第一反應(yīng)永遠(yuǎn)是排查接線、電源、安裝方式而不是調(diào)濾波。等硬件問題解決了濾波這個(gè)環(huán)節(jié)會比你想象的輕松得多。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
欧美日韩婷婷中文| 色色色999| 久久久久亚洲av综合波多野制衣| 日欧亚洲二三区大片不卡| 成人网站 免费观看| av国产无码| 免费AV播放| 熟女丰满人妻一区| 男人天堂日日夜夜| 久久精品一区二区三区蜜桃臀| 色999亚洲人成色| 91色碰| caopeng97人妻| 97伪v| 亚洲双插| 久久丝袜| 国产欧美岛国精品一区| 婷婷色五月激情| 欧美性爱一内片一区二区三区| 亚洲网自拍| 青青草玖玖爱| 欧美人与动性人交a| 久久av无码| 国产欧美日韩在线不卡第一页| 高跟丝袜AV专区国产| 九九九九热| 亚洲欧美色图| 亚洲中文一区二区三区视频| 色九月| 天天碰操中国年青熟妇| 伊人宅男大香蕉| 84YTCOM性无码| 欧美专区日本专区| 狠插 制服 自拍| 亚州黄站| 久久亚洲中文字幕视频| 五月婷婷色| 伊人久久蜜月| 免费在线看黄片av| 亚洲色综合| 久久肏大逼| 99在线精品观看99| 伊人少妇久久久| 激情小说在线视频| 色丁香五月婷婷| 日韩99神马视频播放| 久久久999国产精品| 久久久久久久久久va| 最近的最新的中文字幕视频| 日韩伦理视频| 激情婷婷丁香网| 呦呦影院| 亚洲欧美爆| 久久线上视频免费看| 免费超碰97在线观看| 日韩激情电影中文字幕| 色色色网站| 99爱久久视频频| 亚洲自拍小说| 国产三级多多影院2022国产AA一级毛片无码| 亚洲综合春色| 久久二| 操逼日韩无码 | 99热这里只有精品18| 变态乱伦伪娘灌肠一区二区| 九久久九精品视频| 97在线免费看视频| 丁香五月电影| 久久久青草青青国产亚洲免观精品高清完整版_97久久综合区小说区图片区,国精品 | 福利偷拍视频-中文字幕2019国语完整视频大全-S91AV | 亚洲人久久久久日| 一本一道人妻久久一区二区三区| 夜夜嗨一区| 人人操人人干网页| 另类视频在线| 懂色天天爱天天日天天射天天澡| 超碰97久久观看| 欧洲黄色网| 久jiu久神马影院| 东京太热久久久| 欧美在线亚洲| 丁香九月激情| 麻豆一区二区AV天美| 亚洲黄色网址视频| 97情超碰色| 国产精品69人妻无码久久久| 欧美色图99| 在线人人人人人人精品超| 秋霞鲁丝午夜无码一区二区三| 欧美A片中文字幕| 2020视频1区2区3区| 91色宗合| baisiav| 一区二区高清视频| 91色五月俺来也| 久久久偷拍| 97人肏| 不卡在线一区,精品一区二区三区中| 91色伦| 九九aV| 亚洲丝袜少妇在线| 日本一区二区电影网站| 男人精品区| 九月丁香| 97亚洲精品| 国产精品经典一卡久久久| 91视频精品| 秋霞男人网| 777琪琪午夜免费A片| 国模不卡一本二本三电影| 18啪啪手机免费性爱| 天天天天天天天天综合| 乱欲一区二区| 大香蕉丝袜一级片| 久久久性爱| 色婷婷小说| 四虎在线观看视频| 免费成人在线熟妇网| 日日碰狠狠添天天爽超| 久久精品店| 久久9精品视频| 91色人妻| 99只有精品| 蜜桃av综合网发布| 中文一区二区三区影院| 伊人丝袜美腿高跟在线观看高清| 一区二区三区探花在线观看| 校园春色AV天堂| 国产不卡精品91| 99色骚| 在线a v| 91精品国| 久久这里都是精品| 国产女人和拘做爰视频| 狠狠入| 蜜臀久久99精品久久久久免费观| 久久九九国产精品| 狠狠爱综合网| 亚洲综合夜色| 欧美一级欧美三级在线观看| 国产精品一区二区 尿失禁| 国产精品丝袜在线| 东北女人| 婷婷丁香六月天| 成人小说视频在线精品欧美| 久久成人网站| 国产亚洲精品美女久久久| 国产吹潮女在线观看| 美女啊啊啊啊啊啊啊| 人人操人人摸人人看人人干| 亚洲黄色| 综合大香蕉美。| 97天天爽| 91GD.COM| 精品国产丝袜一区二区三区乱码| 另类天堂| 91四海无码日韩欧美| 啊啊啊啊啊啊啊好爽不要| 秋霞一级A片黄色视频| 啊啊啊啊,啊啊好多水| 多乙久久久久久| 乱老熟女一区二区三区| 蜜臀久久99精品久久久久| 大茄子熟女AV导航| 亚洲欧美啪啪| 精品免费囯产一区二区三区| 欧美 亚洲精品首页| 国产女同视频在线播放| 青娱乐手机日韩在线视频| 欧美黑人日韩少妇色情| 夜草欧美| 人妻乱仑一区二区三区| 在线免费观看日韩一区| 在线观看日韩av不卡| 日韩成人网址| 熟女中出视频| v91av| 夜夜躁狠狠躁日日躁av| 色色五月婷婷| 精品成人亚洲午夜电影| 少妇精品久久| 夜夜嗨免费视频| 久久青青草原免费视频| 国产在线综合福利网站| 97干在线| 欧洲性人爱视频| 亚洲综合有玛| 亚州成人A√| 久久久久久欧美精品se一二三四| 人人干人人操人人..com| 午夜福利1区2区3区| 超碰97丝袜| 91强在线播放| 老鸭窝黄色视频网站| 欧美日韩淫加| 97干天天| 97频视在线| 综合亚洲情色| 天天日天天舔东京热| 亚洲女毛多水多21P| 欧美一级久久久久久久大片动画| 成人免费毛片| 亚洲欧美日韩免费电影| av在线播放国产一区| 91久久久亚洲| 乱伦熟女论坛| 亚州中文字幕超碰97| 狠狠中文字幕| 极品五月天噜噜| 丁香婷婷久久 | 中文字幕精品一区欧美| 久久性爱视频免费看| 九九九九国产| 日韩在线观看三级电影| 欧美日韩黄色片一区二区三区四区人与兽做爱| 综合久久婷婷| 婷婷亚洲五月***久久| 欧美性爱视频免费一区一A| 国内偷自视频区视频综合| 在线人成亚洲视频免费观看| 久久精品国产99精品亚洲蜜...| av毛片aaaaa免费看| 狠狠91| 婷婷色综合欧美日韩| 蜜臀99久久精品久久久懂爱| 国内毛片欧美香蕉精品| 精品人妻一区二区三区四区石在线| 国产一国产一级毛片古装| 精品91摸| 高树玛利亚无码流出| 欧美亚洲第1页| 天天舔九色婷婷| 国产精品色哟哟| 亚洲日产专区婷婷| 抽插一区二区视频| 美女诱惑久久| 国产无码久久高清| 天天草夜夜草高潮片| 欧美日韩国产三级黄色| 国产日本久久免费精品| 天天天天干| 伊色综合天堂色97| 久久综合18p| 天天碰操中国年青熟妇| 囯产精品强| 骚逼一区二区| 亚洲AV色图| 天天射夜夜操| 亚洲一区二区三区中文字幕| 色一色综合网| 日本人体九九九九九九| 国产精品网站www| 中文字幕丝袜人妻| 欧美日韩222| 日韩三级性| 九t超碰| 人人弄人人摸| 思思热久久成人| 国产自偷自拍一区| 800zy一区二区| 97超碰亚洲| 欧亚韩国999| 蜜臀久久99精品久久久久| 天天插夜夜操| 五月丁香六月婷综合成人综合 | 久久久夜夜夜| 亚洲精品三区在线观看| 天天色,天天干,天天干| 五月婷婷六月天| 大香蕉伊人在线成人AV在线观看| 91综合国产精品| 亚洲中文字幕熟女少妇一区二区| 高清无码一区二区三区| 大香樵伊人网| www.av不卡中文字幕| 久久久久久九九九九| 美女极品一区二区三区| 激情五月天色播| 蜜臀久久99精品| 麻豆熟妇乱妇熟色A片在线看| 1769一区| 九九久久精品| 欧美少妇性乱| 曰韩人妻中文字幕在线| 亚洲国产一区二区三区四区国产| 东北女人| 欧美精品宗合| 操逼日韩无码 | 精品少妇人妻一区二区三区| 欧美日韩亚洲天堂| 97在线精品| 国产大片精久久久久久| 久久婷婷成人综合色怡春院| 亚洲午夜福利在线影院| 1204金沙人妻懂旧版免费| 精精品人妻一区二区三区| 十八禁成人网站在线观看| 性色乱AV一区二区| 久久精品高清无码一区| 国产久久天堂资源| 欧亚免费视频| 97色欧州| 香港澳门日本三级网站| 啊…啊…操我用力操我| chaopen97久久| 日本熟女免费視颖| 国产一区麻豆免费观看| 97干色| 九九亚洲视频| 色哟哟精品1精品2| 岛国黄| 亚洲图片偷拍视频区| 国产免费久久精品99re韩国| 亚洲日韩精品久久久久一区壹牛 | 日韩97P| 国产又爽又黄| 成人区人妻精品一| 亚洲精品成人激情在线| 99re99在线视频| 国产99久久99热这里只有精品15 | 午夜福利国产欧美日韩夜夜| 青青草日逼视频| 人妻欧美| 天天影视网综合少妇| 超碰导航97| HEYZO高无码国产精品227| 色眯眯射| 久久精品国产欧美日韩亚洲欧美日韩中文久久国产一区 | 91超碰在线播放| 精品毛片av一区二区| 亚洲AV高潮| 人妻一区二区三区四区视频| 久久秀这里有精品| 另类图片综合| 宅男91视频在线播放| 亚洲综合首页| 操逼日韩无码 | 内射白嫩美女| 黄页av| 丁香六月啪啪| 九九九九九九九九九国产精品| 无色无码| 精品十八在线观看| 91亚洲人电影| 色综合一本| 大香蕉伊人网WWWn0n| 91 丝袜在线播放| 色第一页| 欧美国产精品| 天天操熟妇| 婷婷丁香熟妇综合网| 国产后入清纯| 婷婷综合五月| 亚洲欧美首页| 日韩不卡码| 国产理论视频在线播放| 亚洲AV不卡在线观看| 婷婷AV一区二区三区| 夜夜国自区| 九热视频| 思思热国产高清| 欧美三级免费伊人| 欧美日韩一区二区三区四区蜜桃| 91在线丝袜| 99热精品在线在线| 欧美成年人性爱视频免费观看| 青青草色情网站视频| 成人美女av| 正宗无毛一线天嫩逼| 天天射,天天操,天天爽-国内精品一区二区三区-成人AV | 日韩大香蕉| 青青青国产| 精品丝袜无码一区二区三APP| 人妻黑丝袜电影| 欧美视频一区二区在线| 99在线精品观看视频中文| 亚洲欧洲综合视频在线| TS人妖另类精品视频系列 | 91精品91久久久久77777俄罗斯老妇姓x| 亚洲影视综合网| 欧美日韩大香蕉| 无码操逼天堂| 全球成人中文在线| 一起草三级AV电影在线观看 | 黄网在线播放| 东北少妇高潮zzzz| 超碰97亚洲区| 香蕉在线一区二区三区| 人妻少妇被猛烈进入中| 国产一二三福利视频网| 99国产精品久久久在线播放| 婷婷伊人綜合中文字幕| 一本精品日本在线视频精品| 久肏视频字幕| 另类av天堂| 717影院理论午夜伦八戒| www欧美91| 大香蕉伊人网WWWn0n| 少妇高潮对白在线观看| 黄骗免费网站| 久热99999| 啊啊啊啊啊啊啊国| 十八禁视频网站| 亚洲午夜未满十八勿入网站日本又色又爽又黄| 果冻传媒A片一二三区| 色婷婷成人| 视频国产成人精品日本亚洲18| 色踪合AV| 日韩二三区| 久久精品99| 老熟女搡BBBB搡BBBB视频| 欧美性高潮在线| 色 亚洲 91| 校园春色综合| 亚洲色色探花| 日本人妻丰满熟妇久久久久久| 人妻免费观看| 爱干爱射网啊啊啊| 久久女人一区二区三区| 午夜偷拍久久熟女| 好色综合| 色爱亚洲| 91超碰在线观看| 超碰色中文| 99亚洲精品| 久久6热视频免费观看| 国内毛片欧美香蕉精品| 9久久精品| 伊人在线大香蕉视频久久| 97超久碰| 久久这里精品国产99丫e6| 成人AV在线电影| 天天射日日干| 超碰精品97| 伊人 俄罗斯 a v| 97网址www| 色婷婷成人| 精品国产久热在线观看| 亚洲 日韩 丝袜 熟女 变态| 久久性爱视频| 九九黄色视频在线观看| 四虎国产精品永久地址入口| 射久久| 国产精品伦理| 丰满欧美放荡少妇在线| 嗯嗯嗯啊啊啊干死我吧| 精品一区二区三区四区女| 荡小穴在线观看| 日韩欧美视频青青| 色色亚洲| 青青操轻轻| 第四色奇米影视777| 欧美国产有色电影| 天天草夜夜草高潮片| 亚洲97| 久久99久久99精品天美传媒棢·纸:.| 日韩人人精品| 青青草原av| 蜜臀99久久精品| 91精品少妇搡搡搡| 男人天堂 天天射| 天天舔天天日天天射| 亚洲一本色码中文字幕| 日本高清加勒比| 天天草AV| 天天大干大香蕉| 97精品在线| 97欧美日韩中文| 国产精品色哟哟| 97精品97| 性交一区二区在线播放| 老熟妇一区二区三区| 后入式999| 欧美性天天影院| 天操天操夜操夜月操月年年操操| 青草伊人网| 大香蕉狠狠爱| 国产又粗又大硬免费色网视频| 日韩无码一级黄色av片| 色y情视频免费看| 人人人人插| 探花一区在线| 狠狠操狠狠爱| 欧美日韩222| 亚洲免费97免费| 日韩少妇在线视频| 久久超碰天天| 国产三级片在线观看| 超碰99re| 中文字幕在线免费观看2| 性暴力欧美猛交在线直播| 国产精品免费日韩| www.色操逼| 伊人AAA| 中美日韩毛片| 天天插夜夜爽| 巨乳特殊服务按摩| 欧美操人视频| hd成人一区二区在线| 亚洲另类在线观看| 欧色综合| 欧美色吧综合| 人人弄人人摸| 欧美极品性爱天天射| 九九综合久久| 欧美色图中文字幕| 大奶尤物鲍汁淫荡欧美视频粉嫩夜夜骚| 精品中文日韩字幕视频| 亚洲色电影在线| 成年人网站在线免费观看| 国产传媒操逼视频| 黄污污污污| 色五月第四色| 极品少妇久久久久| 国模私拍一区二区三区神乳| 久草视频分类在线| 91jk色拍| 麻豆一区二区三区在线看| V A在线| 国产色精品午夜大片| 国产在线76页| 麻豆影音天美视频| 日韩内| 最新亚洲人成网站在线影院| 天天日天天舔天天喷天天射| 超碰免费欧美7| 日韩欧美蜜桃精品久久中文字幕久久| 久久AV无码AV| 再深点灬舒服灬太大了好硬好爽| 91在线色| 搡老女人老熟女91老熟女综合网| 尹人免费观看视频在线| www.久久久久| 蜜臀AV成人精品蜜臀| 男人的天堂久久| 激情综合网激情综合| 亚洲av综合色区图片亚洲| 日韩肏逼视频| 亚洲激情在线| 欧美在线视频播放| 欧美精品精品一区二区| 深田咏美亚洲精品福利社| 99热精品国产| 特色a在线上| 免费操逼视频下载| 天天天天做夜夜夜夜做| 国产精品人妻免费精品| 天天做天天爱天天爽| 校园春色宗合网| 襙一襙| 97色色网| 97超级久久| 日韩在线观看字幕精品| 黄呦呦在线| 91狠狠综合| 99操视频| 性欧美第一页| 男女激情黄色网址| 欧美韩国你懂得在线 | 91熟女网| 人妻熟女av国产网站| 91AV天堂| 欧美一区二区一级岛国大片| 欧美日韩m| 日韩精品 欧美激情| 图片区小说区| 欧美综合区| 久久精品中文字幕女同| 国产精品久久久久无码A√| 人妻精品4K4K4K4K4| 在线看污网站| 黄色av一区二区在线| 国产精品在线一区二区| 浪人综合网| 久久婷婷欧美| 操操操日本的逼| 亚洲淫色网中文| 亚洲97成人在线观看| 美女啊啊啊啊pc| 青青草国产欧美非洲黑人 | 国产 大胆 对白| 国产精品久久久久无码Av网曝门| 久久久不能久久久久| 97欧美| 98一区二区精品| 欧美高清91| 97婷婷色| 久久精品国产亚洲av水密被窝| 欧美性爱三区二区| 99热国产精品| 自拍偷拍2025在线观看| 亚州,欧美在线| 婷婷综合五月| www.男人的天堂| 国产91影院| 九九九综合精品| 亚洲国产成人7777| 久久久久久波多野吉衣高潮| 国产日逼视频| 亚洲自拍欧美色综合| 人摸人人操人| 97色欧洲| 日韩欧美女优电影| 日韩成人高清一区二区| 中文字幕88av在线| 久久精品毛片免费不卡| 骚货 中文字幕 av| 婷婷六月色| 亚洲欧美色图片| 东北女人被操| 欧美少妇性爱网站| 午夜操一视频一区| 熟妇高潮一区二区免费视频| 极品综合| 中文字幕无码不卡啪啪| 婷婷综合激情| 成人五月天丁香激情综合| 999久久久九| 一区二区三区成人高清视频| 天天综合站| 日韩一级片在线看| 欧美色网| 日日日骚女人精品| 色色五月婷| 欧美性天天| 日韩一区二区三区四区五区| 精品人妻15区| 五月婷婷hd| 日韩AV无码中文一区二区| 欧美性夜| 欧美 日韩 另类 亚洲| 日本三级网页| 天天综合网在线91| 日韩无码嘿咻黑热久| 色黄污美女啪啪啪免费网站| 99re在线视频| 丝袜AV一二三区| 蜜乳中文字幕a在线| 60秒试看最爽10分钟网站| 欧美网站免费| 97超碰人人操人人操| 亚洲国产精品久久久男人的天堂| 97色色婷婷| 中国AV美女| 欧美成人精品一区| 亚洲第91页| 久久久久9| 91东京热男人的天堂| 97在线视频观看免费| 成人综合色网| 偷拍自拍在线视频观看| 女色综合| 亚洲欧美变态| 草b在线| 国产 v乱码一区二| 国产精品久久泡妞网站| 亚洲老司机123专区| 久久色人体 | 91三级理论片播放器| 好吊色综合| 国产91专区| 国产农村妇女精品一二区| 婷婷操逼| 99re国产精品视频| 美女裸体无遮挡永久免费观看网站| 精品人妻一二三四区视频| 日韩情色视频| 久热超碰| 嫖老熟女A片一二三区| 亚洲 欧美 日韩 国产一区二区| 大香蕉性欧美| 亚欧美综合网。| 啊啊啊啊免费视频| 国产三级日产三级韩国三级| 狠狠久久手机视频精品| 亚洲图片91| 久久久久久久9最新免费视频观看| 熟女在线视频| 啊啊啊不要好疼视频| 日韩不卡a级视频专区| 性色av大全| 日韩欧美亚洲自拍偷拍| 欧美 色 亚洲| 国产久9| 黄色片G G G| 免费人人搞97| 中文字幕91综合| 99性视频| 蜜臀AV网站| 激情小说成人日本无码一| 国产视频一区二区三区在线免费观看| 91天天| 一起草视频在线| 91精品久久久久| 久久色AV线| 樱花草社区www中国| 国产性感骚丝袜在线| 久久黄黄| 九九热精品免费视频| 久久久久9999| · —级AA伦aa坐爱午夜极速ⅴA一区天天噪天天噪天天噪 | 亚洲精品一区二区三区在线播放| 免费观看国产小粉嫩喷水精品午| 日韩电影在线观看网址| 清纯唯美亚洲| 精品九九九九| 91色图| 三上悠亚在线毛片91| 男人的天堂 在线一区| 欧美96精品在线| 成人国产二区三区在线,男女精品。| 中文精品少妇天堂| 欧美手机在线综合| 天天日熟妇| 精人妻无码一区二区三区伊人直播| 青青欧洲黑| 亚洲综合九| 亚洲天堂日本| 加勒比伊人影院| 久久爽爽精品| 美日韩在线不卡人妻| 久久超碰98| 伊人991| 中文字幕人乱码中文字的预防方法 | 另类专区加勒比| 人人插人人搞人人操| 久久亚洲精品成人av| 五月丁香社区婷婷日韩欧美精品影院 | 人人爽夜夜操| 台湾大香蕉99热| 素颜老阿姨乱情色| 加勒比综合a∨| 人妻人久久精品中文字幕| 2017天天操天天日| 日韩精品-原创伙伴| 综合97| 国产二区三区免费视频| 偷拍三区| 日本一区二区成人在线| 色播综合| 粉嫩不卡一区二区性爱| 99久久久久| 色区久久| 丰满人妻-区二区三区免费| 九色 人妻 大香蕉| 蜜桃久久久久久久| 操死我了嗯嗯嗯| 肉丝无码中文高清| 亚洲区 欧美区| 啊啊啊在线观看| 久久久久久久免费A片国产成a人亚洲精∨品无码 | 亚洲人成网www| 色五91| 久久精品免视看国产成人﹣蜜臀av一区. 久久精品免视看国产成人,蜜臀av一区 | 久草精品国产99| 国产亚洲日韩在线三区黑人| 亚洲乱码尤物193YW| 狠狠干狠狠干| 9久久精品| 少妇蜜汁| 国产中文日韩欧美一区二区三区人妻丝袜美腿 | 97超碰色情| 亚洲色婷婷久久91| 日韩精品人妻一| 99热超碰| 白丝AV网站| 免看60秒涩涩视频| 97免费在线| 国产家庭乱伦网址| 香蕉久久国产AV一区二区| 在线人妻熟女一区二区三区四区五区| 99re6国产精品99re| 国产精品久久泡妞网站| 久久精品国产AV一区二区三区| 亚洲欧美日韩精品久久久一区二区 | 1024人妻| 欧美日韩99精品麻豆传媒| 亚洲Av噜噜一区二区三区妖精| 亚洲情色 自拍| 四虎午夜影院| 中文字幕123| 亚洲强奸乱伦影视网| 操少妇很爽av| 亚州,欧美在线| 91亚洲人| 亚洲无992tv| 亚洲国产精品久久久男人的天堂| 中出后入| 欧美18老人禁| 国产青视频| 男人的天堂kva| 亚洲日韩国产精品| 嫩草影院性色| 久久国色天香香蕉| 嗯~啊~轻一点 视频| 欧美gv在线观看| 婷婷久久综合久| 成人精品一区二区三区| 国产精品午夜福利| 日本性爱欧美性爱| 欧美色棕合| 中出人妻中文字幕91在线| 夜夜草我| 69人妻精品一区二区绯色| 亚洲男人的天堂网| 日本操逼视频免费| 六月色色| 日韩人妻丝袜美腿中文| 玖玖爱在线视频免费观看| 白嫩国模丰满一二三区| 久久曰曰| 丁香七月婷婷| 日韩婷婷| 九七毛片九九毛片| 亚洲福利影院一区久久| 色999;丁香五月| 天美一区在线| 国产午夜精品理论片一二三区区| 国产一区二区三区久久久精品| 欧美日韩222| 亚洲国产av中文字幕久久 | AⅤ片水多多| 久久ww| 欧洲站一级二级三级h| 一区二区三区成人高清视频| 乱伦一二三| 精品无吗m| 国产女人与拘做受视频免费| 超踫中文字幕| 激情综合 婷婷五月 红杏| 日韩丰满熟妇| 夜夜操中文字幕| 中文色综合| 在线 亚洲 网爆 自拍| 精…码一二三区| 久久综合九九| 夜夜免费视频| 欧美午夜一区二区三区| 大香蕉综合在线| 伊人少妇久久久| AV不卡在线| 天天射夜夜| 国产精品久久久无码AV网站| 少妇内射www在线观看视频| AV一起草在线| 欧美se亚洲| 久久久久国产精品久久久| 日韩性爱网址| 男人下部插入女人下部 | 一级黄碟在线看| 曰韩操B| 超碰色图| 歐美一級亂黃99在綫精品| 无码操逼视频一下| 亚洲大胆人体av| 色五月综合| 97久久超碰亚洲| 91蜜臀人妻中文字幕在线| 精品人妻丰满熟妇一区二区三| 乱伦熟女区| 91操熟女视频 | 97 国产一区| 男人女人18禁片免费看网站| 亚洲欧美精品国产一区二区| 国产在线76页| 伊人天天久久动态图| 啊好大好舒服| 懂色Av| 欧色综合| 成人无码在线超碰网| 99色婷婷中文字幕乱色| 啊啊啊好多水| 极品后入免费视频| 人人看人人爰人人操| 亚洲成人妻日韩在线| 国产精品无码在线| 欧美女同在线| AV九九| 97久久超碰| 香蕉久久精品| 日本一区二区成人在线| 日本最新免费韩国1区2区视频播放| 亚洲精品xxx| 久久精品综合| 男人的天堂,欧美亚洲另类国产日韩,日本高清一区二区 | 国产操伦| 国产后入清纯| 五月婷婷激情网| 绯色一区二区三区不卡少妇| 综合色图区| 懂色av一区二区三区天美传媒| 色蜜AV| 久久精品国内Av熟女高清| 丝袜狠狠草尤物 91| 五月天大香蕉| a片在线播放| 久草国产在线视频| 天天爱综合网| 九九综合| 人人摸.人人色| 久久久久久免费电影| 成人资源中文字幕在线观看天天| 久久av无码| 骚妻少妇精品性色无码四色A V| 欧美日韩性爱精品| 91色拍| 精品中文日韩字幕视频| 色情五月婷婷| 亚洲欧美另类激情小说| 啊啊啊不要嗯嗯在线观看| 色婷婷亚洲婷婷| 五月天久久综合网| 狠狠色五月亚洲91| 日本97久久久精品| 综合啪啪| 九九九九热| 屁股久久久久久久久| 蜜臀久久99精品久久久久久久久| 国产强奸乱伦xd| 有码专区最新中文字幕有码| 人人综合| 美日韩成人| 中文人妻av高清一区| 五月天人妻综合| 天天综合AV| 欧美老妇曰批的视频| 婷婷五月天av| 蜜桃视频精品一区二区三区| 色盈盈影院| 久久精品国产99国产精品亚洲| 欧美国产视频| 97色视频在线| 97视频在线免费播放| 国产日韩美女小穴视频网站不卡| 中文字日本乱码| 青青青国产手线观看视频2| 亚洲情色无码一区二区三区| 国产一区96在线| 亚洲强奸乱伦影视网| 另类图片五月| 亚洲国产麻豆一区二区三区| 老熟妇乱轮| 亚洲十八禁止| 观看免费区二区三区二| 亚洲精品久久久久久久蜜桃臀| 探花精品 一区二区| 亚洲欧美另类少妇精品| 五月色综合| 黄色性爱网网| 97无码视频在线播放| 欧美综合综合| 精品人妻无码一区二区三区不卡-精品人妻无码一区二区...|精品少妇一区二区三 | 色九色久| 伊蕉97蜜桃97狠狠综合干| 亚洲情色电影网| 人人操人人舒服| 91色香| 97中文字幕一区| 夜夜操av亚洲一区二区| 午夜男女爽爽爽在线视频 | 亚洲色图欧美色图另类图片| 激情婷婷丁香网| 久久精品视频在线观看| 精品国产自在在线99| 99在线免费观看| 人人透人人操| 国人欧美精品一区二区| 亚洲97成人在线观看| 易易A毛视频| 综合大香蕉美。| 91无码人妻| 青娱乐手机日韩在线视频| 亚洲日韩电影| 蜜臀Av一区二区三区| 欧美aⅴ99久久黑人专区| 欧美|91色综合| 五月天色综合| 久久婷婷伊人| av一区二区三区不卡| 亚洲欧美日韩偷拍色图| 亚州男人天堂| 2017天天插| 一区二区不卡免费| 成人久久久精品| 国产女人9999| 亚洲人久久久网| 青青伊人加勒比海| 色九九九综合| 诱惑人妻欧美一区在线播放| 欧美综合色站| 久操视频免费在线观看| 激情四射婷婷四五月天| 国产天美欧美| 97人妻免费中文字幕| 在线播放成人高清免费视频| 色姑娘综合网| 黄片www视频免费| av影片在线观看不卡| 72av视频| 射久久| 懂色aV一区二区天美传媒| 91丝袜在线观看| 久久精品熟女亚洲AV麻豆软件| 麻豆亚洲AV成人无码久久精品| 最新制服中文第一页| 伦理第一页| 欧美天天射| 蜜臀99久久精品| 欧美三级一级| 超碰免费在线| 日韩草久视频| 一区二区三区 丝袜 高跟 美腿| 97亚洲一区| 久久免费老司机精品| 精品久久99| 国内91熟女人妻丝袜天天精品视频在线 | 静品嫩模一区二区| 在线啊v一区| 久久久久九九九| 亚洲中文字幕av| 91婷婷伊人狠人| 大香交伊人网| 亚洲中文字幕乱码无码一区二区| 二区熟妇韩日| 婷婷视频在线免费观看| 91free福利| 水澄无码AV| 三级三级三级日本99| 久久久久日本视| 欧美日韩亚洲天堂网| 九九九九九九免费视频| 日天天九九天堂666| 久久午夜色播影院免费高清| 亚洲欧洲日本精品中文a∨| 超碰97人妻免费在线| 欧美日韩操逼动图| 五月综合色| 久久久久久久久久久久久久久性生活视频| 久久色激情一区二区三区| 级品肉射| 亚洲AV在线资源| 91制服丝袜中文字幕| 亚洲国产成人精品999| 极品尤物女神在线观看| 丁香五月成人| 日韩内射视频| 麻豆伊人网| 好湿好紧视频| 国产精品人妻免费精品| 久久五十路熟女人妻| 日本福利二区视频| 欧洲色| 亚州再线| 人人操人人射人人干| 国产免费内射视频| 午夜性刺激视频免费观看| 在线欧美69V免费观看视频| 国产精品嫩草久久久久| 久久综合九九| 久久a久久| 99国产精品自在自在| 伊人九九九| 日韩偷拍一区二区三区| 男女一级A片大黄,一进一出| 天天添天天干电影| 性交一区二区在线播放| 婷婷午夜清品久久久久久久性色视频观| 国产精品日本无码A片| 99热啪啪| 欲香欲色天天天综合和网| 亚州性色| 视频一区二区免费在线| 欧美网站免费| 亚射在线| 精品在线78| 蜜桃成人1区2区3区| 超碰人人干| 欧美黄色大片在线观看| 99久久久无码精品国产人| 综合网亚洲| 特级丰满少妇一级AAAA爱毛片| 精品伊人久久久大香线蕉小说| 老鸭窝黄色视频网站| 欧美一级A片不卡视频。| 岛国小电影| 97超碰欧美手机在线| 人人妻人人爽一区二区三区| 中文字幕高清精品一区| 日韩欧美经典在线观看| 日韩少妇无吗| 性欧美91| 91丝袜视频在线观看| 一级@啪啪视频| 亚洲.欧美.丝袜.中文.综合| 人妻夜夜爽天天爽麻豆三区网站 | 后入式免费视频| 欧美一区二区| 天久久久噜噜噜久久国产精品爽爽 | 国产亚洲精品美女久久久久久2021| 午夜精品99久久久久传媒| 十八禁电影伊人网| 久操电影网| 人妻少妇久久中文| 色网1| 91亚洲网站| 日韩色欲久久一二三四区| 欧美色色色| 欧美在线55555| 超碰78| 亚洲色图在线视频| 国产高清在线自在拍69| 日本亚欧爱爱| 男人的天堂Va| 亚洲av成人精品一区| 欧美日韩操逼动图| 偷拍网站久久男女男| 亚洲欧美清纯| 性爱免费视频成人| 天天影视综合网欧美精品| 男人的天堂com| 青青免费在线视频一区| 97综合在线| 日本中文字幕一区| 欧美人人天天网| 密乳视频在线| 在线播放成人网站| 青青久久久| 国产成人91一区二区三区| 激情婷婷综合久久| 色五月婷婷色| 香蕉免费一区二区三区不读 | 91九久| 99久久9| 91福利网在线观看| 国产亚洲99久久精品| 欧美91精彩| 懂色av一区二区三区天美传媒| 婷婷综合网| 中文字幕文字幕无码一区二区三区电影99 | 日操粉逼逼| 呦女网站| 久热大香蕉| 亚洲精品 欧美97色色| 色色色欧美| 久久伊人青青草| 国产精品操| 狠狠五月天| 亚洲色综网| 伊人久久综合精品欧美| 夜夜久久| 无遮挡猛进视频免费无限观看| 9丨久久九九九| 91动漫操逼视频| 亚洲国产中文字幕| 日本女人操逼| 97碰碰色| 超碰激情808| 男女猛烈无遮掩视频免费软件| 少妇一区二区三区在线观看| 素人一区二区三区日韩|