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

ARTICLE DETAIL

資訊詳情

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

MPU6050六軸姿態(tài)解算從寄存器配置到互補(bǔ)濾波與工程避坑指南

MPU6050六軸姿態(tài)解算從寄存器配置到互補(bǔ)濾波與工程避坑指南 簡介這是一份面向Arduino開發(fā)者的MPU6050六軸傳感器庫資源旨在解決陀螺儀與加速度計(jì)數(shù)據(jù)讀取、解析及基本姿態(tài)解算的入門問題常用于小型機(jī)器人、無人機(jī)平衡與運(yùn)動(dòng)姿態(tài)跟蹤項(xiàng)目。壓縮包共8個(gè)文件主要包含cpp/h源文件實(shí)現(xiàn)核心讀寫邏輯、ino示例程序演示調(diào)用方式、庫配置文件以及配套的說明文檔整體僅6KB結(jié)構(gòu)精簡。已有5277人學(xué)習(xí)下載實(shí)用性和穩(wěn)定性得到一定驗(yàn)證。該庫封裝了I2C通信、寄存器配置和數(shù)據(jù)轉(zhuǎn)換等底層細(xì)節(jié)使用者只需調(diào)用簡單接口即可獲取三軸角速度和線性加速度適合希望繞過復(fù)雜時(shí)序、快速集成傳感器或深入學(xué)習(xí)嵌入式運(yùn)動(dòng)數(shù)據(jù)處理的創(chuàng)客與開發(fā)者。通過閱讀示例和源碼還可了解傳感器初始化、數(shù)據(jù)校準(zhǔn)及誤差處理的基本思路具備較好的教學(xué)參考價(jià)值。1. MPU6050 不是插上就能用的先認(rèn)清它在項(xiàng)目里的位置我第一次調(diào) MPU6050 的時(shí)候抱著“六軸傳感器插上 I2C 就能讀角度”的想法結(jié)果讀回來的數(shù)據(jù)讓我很困惑把它平放在桌上Z 軸加速度計(jì)讀數(shù)不是 9.8 而是 16384 附近跳陀螺儀明明沒動(dòng)輸出卻在 ±5 左右來回漂更別提想直接拿到一個(gè)穩(wěn)定的角度了。后來才明白MPU6050 本質(zhì)上是一個(gè)“輸出原始加速度與角速度的器件”它不直接給你角度也不負(fù)責(zé)消除漂移所有“能用”的姿態(tài)數(shù)據(jù)都靠你把它配置好、校準(zhǔn)好、再用濾波算法算出來。這篇文章面向的是正在做平衡車、機(jī)械臂、云臺(tái)、體感交互或者姿態(tài)檢測相關(guān)項(xiàng)目的開發(fā)者。我會(huì)從寄存器配置、I2C 讀取、零偏校準(zhǔn)、姿態(tài)融合講到最終的數(shù)據(jù)幀設(shè)計(jì)和模組驗(yàn)證盡量讓新手能一步步調(diào)通也讓有經(jīng)驗(yàn)的工程師看到一些容易忽略的邊界參數(shù)。整篇內(nèi)容基于我對(duì)這顆芯片的實(shí)測經(jīng)驗(yàn)代碼可以直接落在你的開發(fā)板上改。2. 讀懂 MPU6050 的寄存器再動(dòng)手從 I2C 尋址到數(shù)據(jù)手冊的配置路徑2.1 為什么是它六軸、自帶的 DMP 與“開箱即用”的真相MPU6050 屬于六軸慣性傳感器內(nèi)部集成了一個(gè)三軸陀螺儀和一個(gè)三軸加速度計(jì)。它之所以在 DIY 和產(chǎn)品原型階段被大量使用靠的是三個(gè)特點(diǎn)價(jià)格便宜、功耗不高、在同一個(gè)封裝里同時(shí)給出了角速度和線加速度。角速度用來做短時(shí)間積分可以得到姿態(tài)變化加速度計(jì)用來感知重力方向兩者互補(bǔ)之后就能得到一個(gè)相對(duì)穩(wěn)定的橫滾角和俯仰角。芯片內(nèi)部還有一個(gè)叫做 DMP 的數(shù)字運(yùn)動(dòng)處理器可以理解成一個(gè)專門做姿態(tài)解算的硬件單元。很多人以為 DMP 是“開箱即用”的實(shí)際不是。DMP 需要你先寫入固件然后通過特定的寄存器訪問方式才能拿到四元數(shù)而且原廠并沒有開放完整的寄存器說明社區(qū)里流傳的驅(qū)動(dòng)大多是逆向出來的。我一般不太建議新手直接上 DMP后面第 5 章會(huì)細(xì)講為什么。選擇 MPU6050 而不是單軸陀螺儀或者九軸傳感器核心邏輯是你的系統(tǒng)需要同時(shí)知道“轉(zhuǎn)得多快”和“傾斜了多大角度”而六軸正好能用兩種不同特性的數(shù)據(jù)互補(bǔ)。九軸雖然多了磁力計(jì)能補(bǔ)償偏航角但磁力計(jì)在電機(jī)和鐵質(zhì)結(jié)構(gòu)旁邊很容易被干擾如果硬件沒做隔離多出來的軸反而會(huì)給你添麻煩。所以對(duì)大多數(shù)室內(nèi)、近距離、電機(jī)驅(qū)動(dòng)的原型項(xiàng)目來說MPU6050 的性價(jià)比和復(fù)雜度最合適。2.2 最小硬件連接與 I2C 初始化代碼先看硬件。MPU6050 最常見的模組把芯片、穩(wěn)壓、上拉電阻都做好了你只需要接四根線VCC 接 3.3V、GND 接地、SCL 和 SDA 分別接主控的 I2C 時(shí)鐘和數(shù)據(jù)線。如果你的主控 I2C 引腳內(nèi)部沒有上拉模組上一般自帶 4.7k 或 10k 上拉但如果用的是自己畫的板子SCL 和 SDA 必須各放一個(gè) 2.2k 到 10k 的上拉電阻否則總線電平不穩(wěn)通信時(shí)好時(shí)壞。還有一個(gè)經(jīng)常被忽略的引腳是 AD0它決定芯片的 I2C 地址。AD0 接低電平時(shí)地址是 0x68接高電平是 0x69。如果你的總線上掛了兩個(gè) MPU6050就靠這個(gè)引腳區(qū)分。我習(xí)慣把 AD0 留一個(gè)跳線電阻調(diào)試的時(shí)候隨時(shí)能切。下面這段代碼用 Python 的 smbus2 庫在樹莓派或者任何 Linux 板子上都能直接跑目的是完成最小初始化并讀取原始數(shù)據(jù)。先安裝依賴pip install smbus2。import smbus2 import time bus smbus2.SMBus(1) # 1 對(duì)應(yīng) /dev/i2c-1根據(jù)實(shí)際平臺(tái)改 addr 0x68 # AD0 接 GND 時(shí)是 0x68接 VCC 是 0x69 # 復(fù)位設(shè)備寫 0x80 到電源管理寄存器讓芯片恢復(fù)默認(rèn)狀態(tài) bus.write_byte_data(addr, 0x6B, 0x80) time.sleep(0.1) # 退出休眠并選擇內(nèi)部時(shí)鐘PWR_MGMT_1 寫 0x00 bus.write_byte_data(addr, 0x6B, 0x00) # 配置數(shù)字低通濾波器和采樣率分頻 # 先寫 CONFIG 0x03表示 DLPF 截止頻率約 44Hz bus.write_byte_data(addr, 0x1A, 0x03) # SMPLRT_DIV 0x04采樣率 1000 / (1 4) 200Hz bus.write_byte_data(addr, 0x19, 0x04) # 陀螺儀量程設(shè)為 ±250°/sGYRO_CONFIG 0x00 bus.write_byte_data(addr, 0x1B, 0x00) # 加速度計(jì)量程設(shè)為 ±2gACCEL_CONFIG 0x00 bus.write_byte_data(addr, 0x1C, 0x00) # 從加速度計(jì)和陀螺儀數(shù)據(jù)寄存器連續(xù)讀取 14 字節(jié) # 寄存器地址從 ACCEL_XOUT_H 0x3B 開始順序是 AX, AY, AZ, TEMP, GX, GY, GZ def read_raw(): data bus.read_i2c_block_data(addr, 0x3B, 14) ax (data[0] 8) | data[1] if ax 32767: ax - 65536 # 這里只列了 X 軸Y/Z 軸按同樣方式處理 return ax while True: print(AX , read_raw()) time.sleep(0.01)這段代碼里有兩個(gè)參數(shù)需要留意。SMPLRT_DIV 的計(jì)算公式是采樣率 1000 / (1 SMPLRT_DIV)它只在 DLPF 開啟的時(shí)候成立。如果把 CONFIG 寄存器的 DLPF 關(guān)閉采樣率會(huì)被強(qiáng)制固定在 8kHz。很多人遇到的“數(shù)據(jù)更新頻率和預(yù)期不符”基本都是這個(gè)公式?jīng)]搞對(duì)。GYRO_CONFIG 和 ACCEL_CONFIG 的低三位是量程選擇默認(rèn) 0 對(duì)應(yīng)陀螺儀 ±250°/s 和加速度 ±2g這也是數(shù)值最靈敏但最容易超出范圍的檔位后面會(huì)講怎么改。2.3 量程、采樣率與低通濾波三個(gè)寄存器決定數(shù)據(jù)長相這三個(gè)配置直接決定了你后續(xù)所有算法的輸入質(zhì)量值得把每個(gè)寄存器透一次。第一個(gè)是量程。陀螺儀有 ±250、±500、±1000、±2000°/s 四檔對(duì)應(yīng)的靈敏度分別是 131、65.5、32.8、16.4 LSB/(°/s)。加速度計(jì)有 ±2、±4、±8、±16g 四檔靈敏度分別是 16384、8192、4096、2048 LSB/g。比如你的平衡車快速傾倒時(shí)角速度很容易超過 ±250°/s如果量程選小了讀到的數(shù)值會(huì)直接限幅姿態(tài)解算瞬間出錯(cuò)。反過來選太大的量程低速轉(zhuǎn)動(dòng)時(shí)量化噪聲會(huì)被放大。我給一個(gè)經(jīng)驗(yàn)值機(jī)器人平衡類項(xiàng)目用 ±500°/s 起步云臺(tái)和手勢識(shí)別用 ±250°/s撞擊或彈跳場景直接上 ±1000°/s 以上。第二個(gè)是數(shù)字低通濾波器。CONFIG 寄存器低三位可以選 DLPF 截止頻率代碼里寫的 0x03 大約是 44Hz。內(nèi)部采樣先跑在 1kHz然后經(jīng)過 DLPF 濾波后輸出。濾波頻率越低數(shù)據(jù)越平滑但相位延遲越大。對(duì)平衡車這種需要快速響應(yīng)的系統(tǒng)44Hz 是一個(gè)常見折中如果是做靜態(tài)姿態(tài)傾角測量可以選更低一檔比如 10Hz 左右把高頻振動(dòng)基本濾干凈。第三個(gè)是采樣率。除了我剛才說的 1000/(1SMPLRT_DIV) 公式還要注意 DLPF 的配合關(guān)系SMPLRT_DIV 設(shè)得太大輸出數(shù)據(jù)率太低姿態(tài)環(huán)路的帶寬會(huì)被拖死。我的習(xí)慣是控制環(huán)路跑 100Hz 到 200Hz也就是 SMPLRT_DIV 設(shè) 4 或 9。等你把 PID 的頻率也確定下來再回頭統(tǒng)一調(diào)整這個(gè)數(shù)值。寄存器位段關(guān)鍵參數(shù)影響GYRO_CONFIGFS_SEL[1:0]0±250°/s1±500°/s2±1000°/s3±2000°/s角速度量程與靈敏度ACCEL_CONFIGAFS_SEL[1:0]0±2g1±4g2±8g3±16g加速度量程與靈敏度CONFIGDLPF_CFG[2:0]0關(guān)閉值越大截止頻率越低數(shù)據(jù)平滑度與延遲SMPLRT_DIV全部 8 位采樣率1000/(1SMPLRT_DIV)數(shù)據(jù)輸出頻率這里有一個(gè)我一直強(qiáng)調(diào)的原則先決定你的控制周期和運(yùn)動(dòng)幅度再去配這四個(gè)寄存器而不是反過來。你不先想清楚項(xiàng)目需求光靠“默認(rèn)配置”調(diào)出來的系統(tǒng)后面一定會(huì)因?yàn)閯?dòng)態(tài)響應(yīng)或者噪聲問題推倒重來。3. 從原始值到角度零偏校準(zhǔn)與互補(bǔ)濾波的落地參數(shù)3.1 靜止的“假數(shù)據(jù)”加速度計(jì)噪聲與陀螺儀零漂把 MPU6050 平放在桌上你會(huì)看到所有輸出都不穩(wěn)定。加速度計(jì) X、Y 軸接近 0Z 軸接近 16384但每個(gè)值都在上下跳動(dòng)陀螺儀三個(gè)軸則在一個(gè)非零的均值附近波動(dòng)。這個(gè)非零均值就是零偏屬于制造過程中晶體和電路的不一致造成的系統(tǒng)誤差。陀螺儀零偏的量級(jí)通常在 ±0.5°/s 到 ±2°/s 之間。聽起來不大但如果你直接對(duì)它積分去算角度一分鐘就能積出 30° 到 120° 的誤差這完全不能用。加速度計(jì)的問題是另一類它信噪比在高頻段很差輕微的機(jī)械振動(dòng)就會(huì)讓它讀數(shù)劇烈上下跳但它的低頻響應(yīng)是準(zhǔn)確的因?yàn)橹亓Ψ较蛟陟o止時(shí)是恒定的。所以六軸融合的基本思路很樸素短期角度變化靠陀螺儀積分長期漂移用加速度計(jì)的靜態(tài)角度來校正。互補(bǔ)濾波就是把這兩個(gè)來源按頻率分開各取所長。網(wǎng)上有大量現(xiàn)成代碼但參數(shù)不貼合你的安裝朝向和運(yùn)動(dòng)特性直接套用就是玄學(xué)必須自己理解每一個(gè)系數(shù)。3.2 零偏校準(zhǔn)靜態(tài)取樣的平均法零偏校準(zhǔn)最簡單可靠的辦法是靜態(tài)采樣取平均。把模組水平靜置采集足夠多幀數(shù)據(jù)累加后求平均這個(gè)平均值就是當(dāng)前溫度下陀螺儀的零偏。通常每軸采集 500 到 1000 幀就夠。我這里用 Python 寫一個(gè)采集腳本方便你跑一次然后記下結(jié)果寫到固件里。import smbus2 import time bus smbus2.SMBus(1) addr 0x68 # 假設(shè)已經(jīng)完成初始化這里直接連續(xù)讀取 1000 次 sum_gx 0 samples 1000 for i in range(samples): data bus.read_i2c_block_data(addr, 0x3B, 14) gx (data[8] 8) | data[9] if gx 32767: gx - 65536 sum_gx gx time.sleep(0.005) avg_gx sum_gx / samples # 在 ±250°/s 量程下需要除以 131 才能換算成 °/s print(GYRO_X zero offset:, avg_gx / 131.0, deg/s)這里有兩個(gè)細(xì)節(jié)。第一采樣期間模組必須保證絕對(duì)靜止桌面如果有共振或者你在用手扶平均值里會(huì)混入真實(shí)運(yùn)動(dòng)分量校準(zhǔn)就不準(zhǔn)。第二零偏會(huì)隨溫度變化芯片內(nèi)部雖然有溫度傳感器但一般項(xiàng)目不需要做全溫補(bǔ)償。我一般在校準(zhǔn)后把模組靜置 5 分鐘再看一次數(shù)據(jù)如果零偏變化超過 0.5°/s說明你的使用環(huán)境溫差太大需要考慮加溫度補(bǔ)償或者改用更高等級(jí)的傳感器。把零偏存到你的數(shù)據(jù)結(jié)構(gòu)里之后每次讀取都要減掉它再進(jìn)入后續(xù)積分和濾波。這一步不做后面所有姿態(tài)數(shù)據(jù)都是空談。3.3 互補(bǔ)濾波一段 C 代碼把六軸合成橫滾與俯仰互補(bǔ)濾波的離散形式很簡單新角度 互補(bǔ)系數(shù) × (舊角度 陀螺儀角速度 × dt) (1 - 互補(bǔ)系數(shù)) × 加速度計(jì)角度?;パa(bǔ)系數(shù)通常在 0.95 到 0.98 之間代表你信任陀螺儀的短期積分但慢慢用加速度計(jì)把它拉回來。這里我用 C 寫一份可以直接嵌入 MCU 的代碼以橫滾角為例。#include math.h #include stdint.h typedef struct { float roll; float pitch; float gyro_zero_x; // 校準(zhǔn)后的陀螺儀零偏單位 deg/s float gyro_zero_y; float dt; // 采樣周期單位 s float alpha; // 互補(bǔ)濾波系數(shù)0.95 ~ 0.98 } attitude_t; static float atan2_deg(float y, float x) { return atan2f(y, x) * 180.0f / (float)M_PI; } // acc 單位是 LSBgyro 單位是 LSB需要先減零偏再換算成 deg/s // 量程 ±250°/s 時(shí)陀螺儀靈敏度為 131 LSB/(deg/s) void attitude_update(attitude_t *att, int16_t ax, int16_t ay, int16_t az, int16_t gx_lsb, int16_t gy_lsb) { float gx (gx_lsb / 131.0f) - att-gyro_zero_x; float gy (gy_lsb / 131.0f) - att-gyro_zero_y; // 由加速度計(jì)計(jì)算靜態(tài)角度 // 注意坐標(biāo)系這里默認(rèn)芯片水平放置繞 X 軸旋轉(zhuǎn)是橫滾繞 Y 軸旋轉(zhuǎn)是俯仰 float acc_roll atan2_deg(ay, sqrtf((float)ax * ax (float)az * az)); float acc_pitch atan2_deg(-ax, sqrtf((float)ay * ay (float)az * az)); // 互補(bǔ)濾波 att-roll att-alpha * (att-roll gx * att-dt) (1.0f - att-alpha) * acc_roll; att-pitch att-alpha * (att-pitch gy * att-dt) (1.0f - att-alpha) * acc_pitch; }這份代碼里最重要的不是公式而是兩個(gè)容易踩坑的地方。第一個(gè)是加速度計(jì)角度公式和芯片安裝朝向必須對(duì)上你換一個(gè)模組安裝方向X、Y 軸的符號(hào)和 atan2 的參數(shù)都要跟著改否則靜止時(shí)角度不為零動(dòng)起來還會(huì)反號(hào)。第二個(gè)是 dt 必須是你實(shí)際的數(shù)據(jù)采樣間隔如果你用定時(shí)器中斷保證每 5ms 讀一次那 dt 就寫 0.005如果你只是輪詢讀寄存器實(shí)際間隔可能飄到 8ms 甚至 10ms角度就會(huì)忽快忽慢。alpha 這個(gè)參數(shù)怎么調(diào)把模組拿在手里快速晃動(dòng)如果角度跟手但靜止時(shí)有明顯回漂說明 alpha 太大加速度計(jì)校正太弱如果角度響應(yīng)滯后、感覺肉肉的說明 alpha 太小陀螺儀被壓得太死。從 0.98 開始往下試每次減 0.01直到靜止穩(wěn)定和動(dòng)態(tài)跟手都能接受為止。這個(gè)調(diào)參過程沒有什么公式能替代我建議你直接做個(gè)可視化界面把角度畫出來比盯串口數(shù)字直觀得多。4. 避坑MPU6050 從寄存器雷區(qū)到數(shù)據(jù)打架的排查清單4.1 讀 WHO_AM_I 全是 0xFF地址、上拉與虛焊三板斧現(xiàn)象調(diào)用 I2C 讀寫接口讀 WHO_AM_I 寄存器得到 0xFF 或者總線異常報(bào)錯(cuò)。原因通常是三個(gè)I2C 地址不對(duì)、SCL/SDA 缺少上拉電阻、焊接或接觸不良。先查 AD0 引腳的電平如果它懸空有些模組會(huì)讀到不確定地址確保它是明確接地或接 VCC。再拿萬用表量一下 SCL 和 SDA 對(duì)地的電壓正常應(yīng)該在 3.3V 附近如果接近 0V就是上拉沒接。排除了這兩個(gè)最后才懷疑接觸問題把模組引腳重新加焊一遍特別是用杜邦線的時(shí)候接觸不良的概率比你想的高得多。4.2 采樣率對(duì)不上SMPLRT_DIV 與 DLPF 的連帶關(guān)系現(xiàn)象程序里算的 200Hz實(shí)際用示波器或者統(tǒng)計(jì)時(shí)間戳發(fā)現(xiàn)只有 100Hz甚至更慢。原因基本上是把 SMPLRT_DIV 公式用在了 DLPF 關(guān)閉的場景或者 CONFIG 寄存器寫錯(cuò)了導(dǎo)致 DLPF 沒有按預(yù)期工作。解決辦法是回讀 CONFIG 和 SMPLRT_DIV 確認(rèn)寫入值再核對(duì)數(shù)據(jù)手冊里的采樣率關(guān)系表。如果你把 DLPF 配成 0x03約44Hz采樣率公式?jīng)]問題如果你追求最高輸出速率并關(guān)掉了 DLPF采樣率會(huì)被強(qiáng)制拉到 8kHz但這時(shí)的輸出數(shù)據(jù)噪聲會(huì)明顯增加我不建議這么干保持 DLPF 開啟更省心。4.3 角度往一邊飄零偏沒去掉還是積分發(fā)了瘋現(xiàn)象靜態(tài)放置時(shí)互補(bǔ)濾波輸出的角度從 0 慢慢漲到 30° 甚至更多而且方向固定。先別急著改濾波參數(shù)第一步確認(rèn)你是否減了零偏。如果你校驗(yàn)過零偏沒問題那看安裝朝向和濾波頻率。有些模組在水平放置時(shí)加速度計(jì) Z 軸讀數(shù)不是理論的 16384而是 16000 附近這會(huì)直接導(dǎo)致計(jì)算的靜態(tài)角度偏幾度看起來就像角度“飄”了。解決方法是做一次完整的加速度計(jì)六面校準(zhǔn)把每一軸的偏移和縮放都測出來而不僅僅是相減。4.4 振動(dòng)環(huán)境加速度計(jì)毛刺大濾波在信號(hào)鏈的位置現(xiàn)象電機(jī)一轉(zhuǎn)融合出來的角度就開始抖甚至明顯跳變。原因不是陀螺儀壞而是加速度計(jì)對(duì)振動(dòng)太敏感振動(dòng)的頻率遠(yuǎn)高于真實(shí)運(yùn)動(dòng)經(jīng)過互補(bǔ)濾波后會(huì)直接污染角度。解決思路有兩個(gè)一是在硬件上加減振墊或遠(yuǎn)離電機(jī)安裝二是把 DLPF 截止頻率調(diào)低比如從 44Hz 降到 10Hz 到 20Hz 區(qū)間把電機(jī)的高頻振動(dòng)濾掉。注意 DLPF 調(diào)低后相位延遲增加要在平滑和響應(yīng)之間重新找平衡這也是為什么我要在 2.3 里強(qiáng)調(diào)先定控制周期再配寄存器。4.5 芯片燙得不對(duì)勁、數(shù)據(jù)每隔一會(huì)兒跳變電源紋波與 I2C 時(shí)序現(xiàn)象模組工作時(shí)芯片溫度明顯偏高且數(shù)據(jù)呈周期性跳變偶爾整個(gè) I2C 總線卡死。原因大多數(shù)是 VCC 供電紋波太大特別是用 DC-DC 直接供電的時(shí)候開關(guān)噪聲會(huì)串進(jìn)傳感器內(nèi)部。MPU6050 的模擬供電對(duì)紋波敏感解決辦法是在 VCC 和 GND 之間加一個(gè) 100nF 陶瓷電容最好再加 10uF 鉭電容或電解電容濾波如果主控和傳感器共用一個(gè)電源還要注意電機(jī)驅(qū)動(dòng)瞬間的大電流拉低電壓。另外I2C 總線不要拉太長超過 20cm 建議降低通信速率到 100kHz否則總線電容會(huì)造成時(shí)序不穩(wěn)定。5. 把 MPU6050 接進(jìn)一個(gè)真正的小系統(tǒng)數(shù)據(jù)幀設(shè)計(jì)與信號(hào)鏈5.1 數(shù)據(jù)幀設(shè)計(jì)時(shí)間戳、校驗(yàn)和與原始值打包當(dāng) MPU6050 的成本和功耗已經(jīng)不再是瓶頸真正讓系統(tǒng)難用的往往是數(shù)據(jù)傳輸和解析環(huán)節(jié)。裸數(shù)據(jù)直接通過串口發(fā)出來也能看但一旦接入到上位機(jī)、記錄日志或者跑閉環(huán)控制你就需要一套明確的數(shù)據(jù)幀格式。我?guī)F(tuán)隊(duì)做模擬項(xiàng)目 X 的時(shí)候定義過一套簡單但完整的幀結(jié)構(gòu)核心思路是幀頭 序號(hào) 時(shí)間戳 原始值 姿態(tài)角 校驗(yàn)和。#include stdint.h #pragma pack(push, 1) typedef struct { uint8_t head; // 固定 0xAA用于幀同步 uint16_t seq; // 包序號(hào)用于檢測丟包 uint32_t ts_ms; // 時(shí)間戳單位 ms int16_t ax, ay, az; // 加速度原始值 int16_t gx, gy, gz; // 陀螺儀原始值 float roll; // 融合后的橫滾角 float pitch; // 融合后的俯仰角 uint8_t crc; // 對(duì)前面所有字節(jié)的簡單校驗(yàn) } imu_frame_t; #pragma pack(pop) uint8_t imu_frame_crc(imu_frame_t *f) { uint8_t crc 0; uint8_t *p (uint8_t *)f; for (uint8_t i 0; i sizeof(imu_frame_t) - 1; i) { crc ^ p[i]; } return crc; }為什么要帶時(shí)間戳和序號(hào)我在實(shí)際調(diào)試中遇到過數(shù)據(jù)卡頓上位機(jī)畫出來的波形一眼看去沒問題但放大后才發(fā)現(xiàn)時(shí)間間隔不均勻控制環(huán)按固定周期算就產(chǎn)生了抖動(dòng)。有了時(shí)間戳你就能統(tǒng)計(jì)每幀到達(dá)的間隔立刻發(fā)現(xiàn)調(diào)度問題。CRC 校驗(yàn)雖然簡單但在電機(jī)強(qiáng)干擾環(huán)境下能擋住大部分錯(cuò)誤幀別省。這個(gè)結(jié)構(gòu)體用了 #pragma pack(1)是因?yàn)榍度胧胶蜕衔粰C(jī)不同編譯器默認(rèn)對(duì)齊方式不一樣不加這個(gè)指令結(jié)構(gòu)體的字段之間會(huì)多出填充字節(jié)上位機(jī)解析出來就全錯(cuò)位了。5.2 自己寫濾波器還是啃 DMP兩條路的取舍我在第 2 章提過 DMP 不是開箱即用這里展開講。DMP 的好處很明顯解放主控算力直接輸出四元數(shù)而且內(nèi)部有硬件濾波角度比裸寫互補(bǔ)濾波更穩(wěn)。但它的問題也突出固件本身是閉源的寄存器說明靠社區(qū)逆向升級(jí)主控平臺(tái)后驅(qū)動(dòng)要重新移植出了問題你很難定位是固件問題還是配置問題。我自己的經(jīng)驗(yàn)是如果你的產(chǎn)品要量產(chǎn)且姿態(tài)解算不是核心賣點(diǎn)用 DMP 或者直接買帶姿態(tài)輸出的模組更劃算但如果你在做研究原型、學(xué)校競賽或者需要深入理解姿態(tài)解算邏輯自己寫互補(bǔ)濾波或者卡爾曼濾波更好因?yàn)閿?shù)據(jù)鏈路全透明哪里有問題一眼就能看到。這里不貼 DMP 代碼是因?yàn)轵?qū)動(dòng)移植工作量大且平臺(tái)相關(guān)建議你確認(rèn)主控平臺(tái)后直接參考社區(qū)成熟的移植方案不要自己從零碰固件。5.3 從姿態(tài)到控制量平衡類應(yīng)用的輸出鏈路姿態(tài)融合不是終點(diǎn)把角度變成執(zhí)行機(jī)構(gòu)的控制量才是。以兩輪平衡車為例典型控制鏈路是MPU6050 輸出原始數(shù)據(jù) → 濾波得到角度和角速度 → PID 控制器輸出 PWM → 驅(qū)動(dòng)電機(jī)。其中角速度可以直接用陀螺儀的原始值不用再微分一次這樣可以減少噪聲。下面是一段極簡的 PD 控制偽代碼。// balance_control: 輸入目標(biāo)角度與當(dāng)前角度輸出電機(jī) PWM float balance_pd(float target_angle, float current_angle, float current_gyro, float kp, float kd) { float err target_angle - current_angle; return kp * err kd * (-current_gyro); }注意我這里的速度項(xiàng)直接用負(fù)的陀螺儀值而不是角度的差分因?yàn)橥勇輧x本身就是角速度做了差分反而把噪聲放大??刂祁l率建議和姿態(tài)數(shù)據(jù)頻率一致比如 MPU6050 輸出 200Hz控制環(huán)就跑 200Hz不要額外開一個(gè)更快的定時(shí)器去讀舊數(shù)據(jù)那只會(huì)增加延遲。整條鏈路中最大的瓶頸通常不是傳感器和 PID而是數(shù)據(jù)在 I2C 總線上的讀取時(shí)延和主控調(diào)度抖動(dòng)所以有條件的話把 I2C 速率調(diào)到 400kHz并保證讀取任務(wù)占用獨(dú)立且確定的時(shí)隙。6. 驗(yàn)證一套 MPU6050 模組能不能用五步測出底噪、零偏與溫度穩(wěn)定性拿到一個(gè)新模組或者自己畫的板子別急著寫算法先花二十分鐘做一輪快速驗(yàn)證能避免后面調(diào)試時(shí)懷疑人生。我把驗(yàn)證步驟整理成五步。第一步靜態(tài)底噪測試。芯片平放連續(xù)采集 1000 幀加速度計(jì)數(shù)據(jù)統(tǒng)計(jì)每個(gè)軸的標(biāo)準(zhǔn)差。以 ±2g 量程為例靜止時(shí) X、Y 軸的標(biāo)準(zhǔn)差如果在 0.01g 以內(nèi)Z 軸在 0.02g 以內(nèi)說明模組狀態(tài)健康。如果標(biāo)準(zhǔn)差超過 0.05g先檢查供電和焊接再考慮是不是翻新芯片。第二步零偏重復(fù)性測試。每次上電后靜置一分鐘記錄陀螺儀零偏然后斷電重新上電重復(fù)五次。如果每次零偏變化超過 1°/s說明該模組的溫漂或啟動(dòng)穩(wěn)定性較差用在控制環(huán)里會(huì)一直有殘留漂移。同一批模組做十片對(duì)比能幫你篩出供應(yīng)商的產(chǎn)品一致性。第三步數(shù)據(jù)率測試。在代碼里記錄每幀的時(shí)間戳統(tǒng)計(jì) 200 幀的平均間隔。設(shè)定 200Hz實(shí)測應(yīng)該在 5ms 正負(fù) 0.5ms 以內(nèi)。波動(dòng)超過這個(gè)范圍說明你的主控定時(shí)器不準(zhǔn)或者 I2C 讀取偶爾被中斷搶占先解決實(shí)時(shí)性問題再談控制。第四步快速翻轉(zhuǎn)響應(yīng)測試。用手快速翻轉(zhuǎn)模組 90°觀察融合角度是否快速跟到位是否出現(xiàn)過沖或顯著滯后。這一步能同時(shí)驗(yàn)證互補(bǔ)濾波系數(shù)和 DLPF 延遲是否合適。第五步溫度穩(wěn)定性測試。用一個(gè)吹風(fēng)機(jī)在遠(yuǎn)距離慢慢給模組加熱觀察零偏和加速度計(jì)輸出的變化。溫度升高 20°C 時(shí)陀螺儀零偏漂移在 2°/s 以內(nèi)算可接受超過這個(gè)數(shù)說明芯片體質(zhì)一般需要加溫度補(bǔ)償或者在軟件里定期重新校準(zhǔn)。這個(gè)測試不用追求精確關(guān)鍵是確認(rèn)你的產(chǎn)品在可能的工作溫區(qū)內(nèi)不會(huì)失控。我把這套驗(yàn)證流程沉淀成了習(xí)慣之后項(xiàng)目調(diào)試時(shí)間至少省掉三分之一。以前我拿到模組就往算法里懟結(jié)果底噪大、零偏不穩(wěn)、數(shù)據(jù)率波動(dòng)各種問題混在一起根本分不清是哪一層的鍋?,F(xiàn)在先花二十分鐘做靜態(tài)和動(dòng)態(tài)驗(yàn)證后面每一步都有明確的數(shù)據(jù)依據(jù)。也希望這個(gè)思路能幫到你讓你在 MPU6050 上少走幾個(gè)彎路。本文還有配套的精品資源點(diǎn)擊獲取
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
五月综合久久| 久久婷婷五月综合伊人| 色婷婷av在线观看| 婷婷五月18永久免费视频| 91精品久久久久久久久| 天天干在线播放| 日本久久人| 男人天堂伊人五月丁香| 国产激情在线| 日本nghangse中文字幕| 激情婷婷五月天| 97夫妻超碰| 欧美色爱五月天| 六月丁香婷婷五月天| 亚洲天堂青草| 五月婷婷丁香日韩在线| 韩国真做片在线观看| 九九成人| 国产婷婷色综合AV蜜臀AV| 五月天天天操天天爽夜夜操| 久久久com| 亚洲亚洲人成综合网络| 五月激情影视| 久久色区| 久久婷婷五月综合激情国产 | 色色色色综合| 丁香六月激情四射| 丁香五月av| 五月天婷婷色在线视频免费观看| 99久在线观看| 国产 亚洲 在线| 亚洲无码猫咪| 五月天色色色网| 久久99热这里只频精品6学生| 女人被男人吃奶到高潮| 丁五月激情视频免费| 99热日本| 精品成人无码A片观看香草视频| 丁香五月婷婷亚洲综合精品| 五月久久婷婷丁香| 五月天操逼网| 亚洲综合婷婷五月| 中文字幕在线免费| 99色久| 98国产精品综合一区二区三区| 伊人碰碰碰| 五月婷婷成人| 最新亚洲色色网| 热九九精品| 国产亚洲色婷婷久久99精品91 www.riverspirits.org www.hnnun.com www.changh | 狠狠干五月天| 五月天天天天天天天天天天天婷婷婷| 激情綜合W W W,激情五月天| 激情综合五月色丁香婷婷 | 五月开心网| 激情五月丁香综合网站| 五月丁香六月香综合激情| 五月综亚洲| www.国产亚洲69ty.久久久久久久久久久久| 欧美日朝成人| 热99精品视频在线观看| 先锋男人99资源| 另类色视频| 激情久久久| 曰曰久久| 色玖玖爱| 亚洲一色色色色色色色色| 五月总合激情网| 色情五月丁香| 婷婷色五月噜噜| 97色婷婷成人综合在线观看| 九九精品在线视频观看| 九九这里只这里只有精品| 性五月激情| 丁香五月综合高清在线| 五月婷婷久久开心网| 亚洲色五月天在线| 欧洲激情精品婷婷| 五月天婷婷丁香| 婷婷激情五月综合| 操比激情五月| 91综合在线| 色婷婷丁香网| 天天擼久久擼在线| 狠狠久久婷五月| 亚洲操精品| 亚洲激情AV| 亚洲激情综合| 9|在线观看视频| 人妻在线网站| 九九RE视频在线精品| 婷婷色女| 99爱视频在线观看这里只有精品| 丁香久久| 97婷婷五月| 日本少妇AA一级特黄大片| 国产永久一黄| 色色色视频免费无码| 激情黄色五月天| 丁香五月在线看| 五月久久婷婷成人网| 99在线视频播放| 婷婷深爱五月天| 超碰日日操| 久久国产色| 成人视频网| 日韩中出视频| 亚洲国产成人综合| 五月天 另类图片| 激情综合五月婷婷| 国产偷人爽久久久久久老妇APP| 色狠狠色噜噜AV天堂五区| 久久受www免费人成| 婷婷九九视频| 五月婷丁香亚洲| www五月| 思思久久精品| 九草性爱| 亚洲九九在线| 国产成人亚洲综合A∨婷婷| 少妇熟女视频一区二区三区| 亚洲久久日| 天天爽天天爽天天爽天天爽天天爽天天爽天天| 丁香五月电影| 久久99国产综合精品免费 | 7月婷婷六月丁香| 色色免费网战视频| 激情综合五月| 亚洲激情网| 欧美综合五月丁香五月天| 久9免费视频| 亚洲视频一区| 婷婷五月天丁香综合网| 久久99最新| 第四色婷婷色五月| 婷婷九月色| 九九精品婷| 99综合色色色| 深夜男女福利刺激影院一区完整| 丁香久久激情俄| 一本大道嫩草AV无码专区| 丁香婷婷浪潮AV久久综合| 五月丁香色色网| 大地资源色婷婷视频在线| 久久久99久久| 免费看片在线观看| 天天干天天爽天天爽| 狠狠色噜噜狠狠狠狠综合| 五月婷婷婷色| www.丁香五月| 嫩草免费视频| 综合六月激情婷婷| 亚洲婷婷性爱| 五月天夜夜爱夜夜操| 色欲久久久久久综合网综合网| 8050一级网| a色色片| 五月婷丁香| 色五天综合| 日本激情ⅩXX免费视频| 97自拍视频在线| 97人操人免费视频| 久久99激情| 日韩无码亚欧无码| 欧美激情综合五月色丁香| 亚洲V国产V欧美V久久久久久| 日韩一级网站| 日本婷婷| 丁香五月成人| 国产婷婷久久| 久色大| 丁香五月天激情四射网络不好| 婷婷五日b| 五月天成人综合| 99色.com| 久久婷婷五月丁香网| 丁香五月婷婷Av| 久久开心五月天激情| 色色色激情网| 另类综合婷婷五月天欧美视频| 嫩草极品| 天天夜天天色天天| 五月丁香啪。| 久99久视频| 综合激情在线| 超碰人人操在线| 在线成人视频免费| 九九热只有精品| 五月色网| 图片区 小说区 区 亚洲五月| 性爱综合网| 91超碰九色| 精品牛仔裤超碰| 97操碰视频| 亚洲天99| 激情综合网激情五月天| 97色色色视频| 日hao1区| 国产黄大片在线观看画质优化| 天天射色五月天| 无码AV大香线蕉伊人| 色波激情五月天| 熟女人妻一区二区三区免费看| 五月总合激情网| www.狠狠操| 天天婷婷综合| 丁香五月婷婷色综合| 五月天婷婷永久免费视频| 九月丁香网婷婷| 九九亚洲视频| 国产av影片| 日韩视频99| 国产日产成人亚洲欧美国产VA| 五月丁香亭亭| 五月天,激情四射,婷婷频道| 超碰人人艹| 五月天播播| 日本色婷婷久久99精品91| 精品人妻久久久| 国产午夜精品AV一区二区麻豆| 99久久综合精品五月天| 婷婷六月激情| 91九色最新视频| 久久9热好| 日韩av网站在线观看| 五月色丁香| www99热| 精品人妻久久久久久| www.丁香黄色五月天人与| 午夜做爱影院| 操人无码| 影音先锋91视频| 另类激情五月在线视频欧美| 另类五月婷婷| 色婷婷影| 秋霞少妇AV网站| 亚洲激情综合| 五月婷婷,六月激情| 五他月天啪啪啪| 五月婷啪啪| 久久黄A片| 婷婷五月天无码| 激情综合啪啪| 婷婷中文字暮| 日韩成人无码| 一级性爱视频| 婷婷五月综合视频免费播放| 五月丁香久久| 欧美激情-区二区三区| 91日本在线观看| 狠狠干青青草| 五月天激情综合网站| 亚洲最大视频网站| 激情五月天影院| 五月丁香六月激情啪| 99久在线精品99re5热视频| 色婷婷基地| 五月天狠狠网| 五月综合六月婷婷| 色五月av伊人| 综合大香蕉| 99精品视频播放| 激情小说五月天社区丁香 | 国产av天堂| 人人干女人| 婷婷五月丁香基| 日韩色五月| 狠狠色综合图片| 99久久6| 亚洲色无码| 天天拍夜夜撸| 国产色色在线| 99热精品在线| 亚洲精品电影| www久久艹| 天天干天天日蜜臀av| 五月婷婷激情五月| 超碰人人操人人干| 欧美综合123区| 五月丁香基地| 日日操,夜夜爽| 秋霞午夜理论 | 婷婷激情小说| 激情五月丁香五月| 色五月第四色| 夜夜干夜夜操| 久久久久人妻网址| 丁香婷婷成人网| 夜夜天天天天天干天天爽| 热99这里只是精品| 婷婷六月色开| 五月婷婷综合激情| 色亚洲无码| 大香蕉人人人| 五月天社区婷婷丁香社区| 色色色1网址| 婷婷婷婷午夜| 久久婷婷免费| 婷婷五月欧美AA片免费| 久久婷婷五月综合一| 婷婷伊人五月天| 丁香婷婷九月在线| 天天谢天天操| 91丨九色丨熟女|新版| 日韩 mm 不卡| 99啊精典免费视频| 我去色色网五雨天| 综合久久97| 99资源在线视频| 色黄啪啪| 91狠狠色丁香| 中文字幕成人| 日本熟女三区| 夜夜爽天天日| 五月婷婷丁香五月 | 婷婷狠狠青青| 丁香五月激情欧美| 九九精品自拍| 99精品视频免费在线播放| a色色色色色| 九九伊人网| 曰曰久久| 五月综合婷婷开心网| 色五月天综合| 欧美成人网99网| 韩国天天婷婷| 久久电影4399| 综合色色婷婷| WWW夜夜| 97操在线视频| 五月婷婷狠天天色综合| 玖玖资源站蜜臀| 久热这里只有精品6| 五月丁香六月| 久久久18| 成人无码精品1区2区3区免费看| 91se精品国产| 久久新| 涩五月婷婷| 综合五月草 | 五月天色婷好好| 婷婷六月插屄激情| 天天激情欧美美女| 色婷婷五月综合| 伊人网色婷婷五月天| 久久99免费视频| 成人免费高清在线播放| 欧美黑人大吊| 99性爱视频网站| 99热免费在线| 成人AV在线电影| 五月丁香久久综合91| 99在线综合视频| 亚洲色人妻| 五月天婷亚洲天综合网综合| 美女丁香五婷婷| A片一曲| 婷婷丁香六月| 桃色五月婷婷| 久久99久久99精品免视看婷婷| 激情婷婷五月久久| 五月天激情婷婷| 五月丁香在线| 久九九热| 五月婷婷六月丁香综合视频在线| www.色婷婷| 可以看的av| 久久九九99.www| 九九热黄色| 日本欧美国产| 99久久99九九99九九九| 欧美日韩国产日本精品四虎网网站物| 天堂爱爱| 成人丁香五月| 99超碰人人| 亚洲久久视频| 婷婷五月天Av| 婷婷干六月综合旧址| 超碰人人操人人干| 色五月婷婷小说亚洲中文字幕组| 图片区 小说区 区 亚洲五月| 超碰在线观看成人视| 久久久久久久久久久久久久人妻视频| 色五月婷婷操逼| http://www.com久久久精品一区| AAA久久久| 99久久er| 性无码专区无码| 日本黄色在线观看| 国产玖玖资源| 天天色2017| 婷婷色五月婷婷姐妹| 丁香五月在线看| 五月天开心网| 亚洲人成网亚洲欧洲无码久久| 色色网站毛片| 婷婷久久综合久| 色色色区| 99热97| 色色婷婷丁香| 91综合在线| 丁香五月天婷婷中文字幕| 国产精品第一国产精品| 夜夜涩涩涩| 色五月色五天色情网| 五月婷av| 五月婷婷六月丁香激情| 丁香五月综合狠狠| www.五月天性.com| 蜜桃五月天| 色99网| 97色女人在线| 91精品无码久久久久久五月天| 久久这里有精品视频在线免费观看| www.婷婷六月天| 色色操| 久久作爱| 草一草avb| 五月丁香成年黄色| 亚洲情色一区| 99福利导航| 草草影院爱爱| 午夜九九九九九九九九九九九九九| 亚洲综合视频八| 亚洲AV无码久久精品色欲| 亚洲精品成人| 婷婷爱综合| 久久99综合| 狠狠色五月激情| 性综合网| 97色五月天| 中文字幕欧美日韩VA免费视频| 欧美久草在线日本一级特黄大片做受9在线观看韩国电影《两个女人》未删减-毛片 | 亚洲字幕AV一区二区三区四区| 九九家庭影院| 大香焦啪啪啪| 天天日日夜夜爽。| 97色啪| 色在线99| 日韩 中文 欧美| 久久综合激情| 三区激情四射av| 久色网| 婷婷综合五月激情| 5Www色5夜| 真实亲子乱子伦高清在线观看| 99资源人人| 婷婷五月精品中文字幕| 丁香色五月直播| 激情AV| 五月天婷婷丁香花| www.久操| 久久久久激情| 五月丁香少妇网| yirenjiqingshiping| 1024亚洲| 开心激情站婷婷五月天| 射久久丁香五月| 婷婷色情六月| 超碰超碰在线| yazhoujiqingav| 婷婷五月天欧美| 成人在线高清| 99热这里| 99久久玖玖| 激情婷婷五月| 丁香花社区av| 夜夜大香蕉婷婷丁香| 黄色aaaaa| 91碰碰碰| 欧美精品18| 99亚色色色| 碰超亚洲| 色色色9| 天天操天天谢| 婷婷伊人综合中文字幕| 日本熟妇乱妇熟色A片蜜桃| 六月丁香婷婷色综合| 婷婷五月激情综合啪啪| 丁香色色网| 色欲天天综合| 婷婷五月天堂网| 久久久全国免费视频| 亚洲无码11| www.色婷婷。com| 99热 在线播放| 激情小说婷婷| 精品久久人妻| 亚洲 在线 性爱| 超色欲天天| 天天干天天插| 丁香激情网| 丁香五月天激情综合网| 色999五月色| 99久久欧美| 夜夜干 夜夜操| 婷婷色成人| 99热国品免费| 久热丁香| 日日夜夜亚洲一区| 婷婷在线视频| 日韩成人无码人妻| 很很干天天干| 内射激情在线| 久久婷婷六月| 性爱五月丁香| 五他月天啪啪啪| 成人做爰A片免费看视频| 丁香五月天AV| 开心五月丁香婷婷| 色色网站观看| 亚洲九区| 99视频网址| 亚洲字幕AV一区二区三区四区| av久热| 2025色婷婷| 亚洲AAAA网| 青青热视频| 日本丁香久在线| 日本婷婷激情四射中文字幕在线观看| wwwss在线观看| 日韩在线99| 天天插插天天| www色中色综合| 青青热久精品视频在线观看| 婷婷五月大| 99爱99操| 91AV婷婷| 伊人超碰| 日本啪啪网| 亚洲精品成人片在线播| 狠狠色丁香久久综合婷婷亚洲成人福利| 亚洲精品字幕在线观看| AV电影在线播放| 欧美日韩99| 五月六月丁香激情| 免费观看的婷婷五月视频在线| 婷婷激情啪啪| 亭亭五月天黑人2014| 丁香成人综合| 岛国av网| 99热精这里只有精品| 综合婷婷六月| 人色五月天婷婷| 丁香婷婷五月天网站| 婷婷香香五月| 天天爽成人综合网站| 玖玖色综合| 97黑人精品区| 丁香五月手机在线| 狠狠综合网| 色婷婷丁香综合中文字幕| 久久婷婷东京热| 日本nghangse中文字幕| 99 福利 导航| 五月天激情久久| 啪啪综合| 亚洲av综合网| 99九九在线| 在线99热| 婷婷五月天va| 26uuu欧美激情另类| 婷婷五月天电影区小说区| 色色 亚洲| 免费播放99性爱视频| 亚洲激情免费视频| 停停五月色宗合| 日本不卡中文字幕| 婷婷丁香六月| www.色99| 97操碰人免费| 色情开心五月| 久热伊人| 色五月婷婷中文字幕在线观看| 99er这里只有精品视频| 婷婷深爱五月天在线| 狠狠干青青草| 丁香五月综合在线视频| 日狠狠| 亚洲激情综合| 热久精品| 久久九九99视频| 激情骚五月| 99在线热| 草婷婷在线| 色色色综合色| 色欲色香综合网| 乱岳熟女50岁| 99re热在线视频观看| 九九久久99| 青娱乐美女福利视频美臀| 亚洲另类噜噜| 俺去也五月| 欧美成人AAA片一区国产精品| 五月天堂六月丁香亚州中文字幕久久| 丁香五月婷婷亚洲综合精品| 欧美噜噜噜草| 婷婷丁香基地在线| 综合久久影院| 婷婷伊人五月天| 综合性爱网| 狠狠干天天内射| 骚。com| 久99在线视频| 欧美婷婷色| 91丨九色丨熟女丰满| 婷婷色色狠狠| 国产密乳av一区二区三区四区| 天天操天天操天天操天天操天天操| 激情综合网激情五月俺也去| 91九色精品熟女内射| 99这里只有精品在线观看| 久久婷婷丁香| 操逼电影免费看| 三级黄网站| 色色哒五月婷婷六月丁香| 色一情一乱一乱一区91Av| 五月天久久婷| 《诡秘之主》在线观看| 99这里| 日本精品人妻无码77777| 人人操人人爽成人AV| 综合五月亭亭9| 99婷婷国产最新视频| 蜜桃成语时李时珍 免费| 夜夜久久综合网| 俺去也在线官网| 伊人久久婷婷| 婷婷综合日本| 五月婷婷福利| 欧美成人精品三区综合A片| 日本一毛片| 可以免费看AV网站| 国产成人一区二区三区在线观看| 九九热re99re6在线精品| 婷婷五月天美女视频| 色情综合| 国产精品操| 丁香婷婷啪啪啪| 99色在线| 婷婷五月丁香花综合| 26uuu另类| 熟女人妻一区二区三区免费看| 超级碰碰一区| 婷婷五月天熟妇| 五月天婷婷综合网| 丁香六月婷婷综合欧美| 日日噜狠狠色综合久| 天天综合精品| 色99色| 丁香六月婷婷色XXXXX| 狠狠插.com| 天天射夜夜爽| 色播五月丁香| 亚洲区视频| 欧美在线视频免费播放| 九九99香蕉在线视频播放| 色五月激情婷婷| 极品人妻VIDEOSSS人妻| 天天激情综合| 91九色精品熟女内射| 天天肏视频| 亚洲成人AV在线播放| 综合激情在线观看| 五月婷婷开心网| 人操人| 五月婷婷色激情| 国产AV熟妇人震精品一品二区| 色色色99韩| 色播丁香| 婷婷综合五月激情| 久久久国产精品黄毛片| 天天插夜夜爽| 丁香五月婷婷啪啪视频| 影音先锋人妻出差| 综合久久十| 99热6精品| 中文字幕精品推荐免费在线观| 婷婷五亚洲| 国产看真人毛片爱做A片| 五月婷婷成人网首页| 嫩草AV久久伊人妇女超级A| 综合狠狠五月婷婷| 成人精品免费在线观看| 丁香五月成人社区| 成人婷婷| 日日噜噜夜夜狠狠久久丁香五月| 夜夜骑操AV| 深夜婷婷 丁香| 69色色视频| 9久久网| 天天爱天天做天天爽| 色七七九九| 激情综合啪啪| 五月香婷婷| 丁香伊人综合| 色综合久久久综合久久网| 久久欧洲综合网| 激情内射人妻1区2区3区| 天天干-天天日| 久久婷婷五月综合色和| 开心五月色婷婷综合开心网| 亚洲啪啪精品| 色色操| 色。 日日日| 99热日本精品| 日本三级中国三级99人妇网站| 这里只有精品视频在线观看免费| 超碰人人插| www.婷婷五月天| 最新日本A片| 丁香婷婷影院| 色色免费网站| 六月天无码网址| 玖玖爱导航| 激情综合网五月| 99爱最新免费视频在线观看| 国内久久久精品99| 久色| 色丁香五月婷婷| 亚洲色涩视频| 婷婷激情五月天桃花网| 色婷婷视频在线| 天天干天天玩天天夜天天射天天操天天日蜜臀少妇 | 操碰91| WWW.开心五月天.COM| 玖玖激情五月天| 国产精品美女久久久久AV超清| 婷婷成人五月天成人文学小说| 色九月| 亚韩精品视频1区| 天天噜日日噜综合无码| 日韩99色99| 九九这里只有精品在线视频| 99视频在线啪| 99久久国产宗和精品1上映| 女人天堂AV| 六月婷婷色宗合| 丁香六月婷婷开心| 色yeye欧美| 国产FREESEXVIDEOS性中国| a久久| 婷婷丁香五月视频| Av大香蕉| 一操久久| 白度黄视频| 色婷婷色99国产综合精品| 婷婷狠狠操| 日在线V视频在线播放| 美女激情综合| 午夜色丁香| 免费观看全黄做爰的视频| 色婷婷激情| 天天干天天干天天干天天干天| 久久久妻人人人| 日本乱论99| 五月丁香 狠狠爱| 99噜噜噜在线播放| 99热在线看| 偷偷操99| 五月天激情婷婷久久| caopeng97日韩| 99er这里只有精品视频| 天天噜日日噜综合无码| 99热高清在线| 91seAV| 99热xx| 欧美成人猛片AAAAAAA| AV大香蕉| 色婷婷综合网| 欧美日韩99| 亚洲国产成人在线| 九月婷婷激情| 99久久玖玖| 婷婷五月天天天| 人妻久久久久久久久久| 成人性爱精品视频| 国产精品色色色色| 婷婷激情五月综合在线视频| 99热日| 激情婷婷人妻| 五月天久久婷婷婷| 99久久a线观| 色色色色色级无码| 丁香月五月天婷婷久久| 婷婷五月天视| 五月香蕉婷婷| 婷婷六月网| 婷婷成人丁香色情基地30 | 婷婷五月丁香色播| 97在线日本| 操人视频91| av在线免费网站 | 性做爰A片免费视频A片直播| 99国产精品久久久久久久久久久| 欧美内射AAAAAAXXXXX| 国产亚洲精品久久久久久郑州| 五月丁香激情综合| 爽tv | 五月天丁香婷婷久久九| 丁香五月影| 99青青草99| 免费在线a| 亚洲成人另类| 婷婷亚洲日本| 亚色网站小视频| 婷婷五月俺要去| 操熟女成人网| 婷婷五月丁香五月综合网| 五月丁香影院| www.婷婷五月| 五月婷婷激情综合| 电影91久久久| www.激情五月天.com| 97久人人| 99色综合网| 99在线看片| 五月丁香六月综合激情无码软件亮点| 操操熟女| 丁香五月婷婷欧美激情-中文天堂最新版在线观看 | 99久久精品免费精品国产_国产精品久久久久久_国产在线|日韩_久久国产精品电影 | 天天草女人| 青青草99re| 9 1在线视频| 激情综合五月丁香| AV五月丁香| www.国产色| 综合久久影院| 激情五月综合网| 九九99热精品| 97人人看| 五月丁香啪啪啪啪| 婷婷成年人免费视频| 在线观看亚洲AV| 婷婷五月综合在线| 亚洲欧洲美女在线观| 激情六月天婷婷| 天天拍夜夜撸| 色色亚洲视频| 色情五月综合婷婷| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 777影视理论片大全在线观看| 99热国产在线| 人人妻人人澡人人爽| 久久久久久激情| henhencao国产在线| 丁香五月天在线| 大香蕉五月丁香| 成人无码精品1区2区3区免费看| 婷婷久久天堂网| 九九色热| 亚洲成人五月天| 五月婷婷六月丁香综合在线| 婷婷狠狠香蕉综合| 开心婷婷中文字慕| 五月亚洲| 五月丁香综合| 热久久色| 婷婷天天综合| 久久久久久综合88| 91呦呦呦| 99热99ai| 国产激情在线| 日韩AV无码影片| 9久热在线精品| 婷婷狠狠久久| 亚洲综合在线播放| 91黄色五月天视频| 亚洲日本激情| 成人短视频在线免费观看| 国产AV熟妇人震精品一品二区| 婷久久| 欧美久久婷婷| 婷婷激情四射| 99 re视频一区| 国语精品探花| 成人无码髙潮喷水A片| 91丁香五月| 婷婷五月成人系列| 五月天色五月| 五月丁香久久呀| 婷婷激情欧美| 色婷婷在线视频| 综合视频久久| 免费观看的婷婷五月视频在线| 国产精产国品一二三在观看| 一区二区成人电影| 一级片操逼视频| 曰曰久久| 久久色五月天激情小说| 欧美日本免费一道免费视频| 色欲婷婷五月天| 激情第四色| 色九四色| 99亚洲大片精品永久在线观看| 五月丁香久久| 婷婷激情九月| 丁香六月婷婷色播| 成人VAV视频在线观看| 国产热精品| www.久久久久| 婷婷丁香五月亚洲欧美| 亚洲成人高清在线| 超碰在线观看9| 久色婷婷200| 9色小视频在线观看| 丁香婷停五月激情综合深爱| 精品夜夜澡人妻无码AV| 这里只有精品视频222| 俺也去在线视频| 五月综合激情网| 99色热视频| 中字幕视频在线永久在线观看免费| 丁香五月婷婷激情小说| 婷婷久久综合| 丁香九月久久| 婷婷六月色| 日本三级韩三级99久久| 97人妻碰碰中文无码久热丝袜| 婷婷激情六月综合| 六月婷婷八月丁香| 色一情一乱一乱91Av| 亚洲色视频| 丁香五月成人丝袜| 五月丁香中文| 丁香五月开心亚洲| 激情爱爱网站| 影音先锋一区二区三区| 操碰99| 国产亚洲在线观看| 五月天综合视频| 久热久色| 五月丁香六月| 26uuu亚洲欧美另类| 俺去也五月| 亚洲爱爱无码婷婷色五月| 国产免费性爱| 狠狠操性爱av| 激情五月天99色| 99在线精品视频| 91偷拍视频| 超碰碰碰碰| 九九热10| 五月天婷婷狂暴白浆| 激情小说视频图片网| ...婷婷五月综合不卡,国产在线手机| 婷婷中文字幕网| 免费婷婷| 亚洲综合成人网| 26UUU欧美激情一区二区| 天天射天天操天天干| 久久视频这里有精品99| 色五月自偷自拍婷婷婷婷| 超碰国产AV| 九九亚洲视频| 久久久亚洲精品一区二区三区浴池 | 激情丁香五月天综合| 成人国产欧美大片一区| 五月天激情婷婷小说| 色色丁香五月| 啪啪91| 天天日夜夜操五月| 五月色激情综合网| 久久激情五月| 激情5月婷婷狠狠干| 丁香婷婷婷| 91要啪| 亚洲综合干| 99玖玖精品| 九九99久久| 久久99这里只有精品视频| Caop在线| 日韩啪啪视频| 婷婷色情小说| www.日本91| 丁香六月婷婷久久综合| 激情小说之五月| 婷婷精品综合| 99性视频| 99这里有精品| 丁香五月天在线直播观看| 在线不卡中文字幕| 99这里只有精品| 天天色宗合| 欧美久草在线日本一级特黄大片做受9在线观看韩国电影《两个女人》未删减-毛片 | 99 热国产在| 五月丁香亚州综合网| 色综合色五月| 久久欧洲综合网| 色五月色五天色情网| 伊人久久丁香狠狠婷婷综合香蕉 | 日本熟妇人妻在线| 成人视频在线免费播放| 国产精品久久久爽爽爽麻豆色哟哟| 婷婷九月丁香| 久久er+| 玖玖婷婷视频| 久九男女天堂| AAA久久久| 婷婷五月综合视频免费播放| 丁香五月花婷婷开心| 九久久精品视频99| 少妇被躁爽到高潮无码文| 99热日| 99热这里只有精品2016| 色色五月婷婷| 激情五月天色色色| 亚洲无AV在线中文字幕| 欧美视频五区| 色狠久| 国产精品久久在线观看技巧| 久久天堂| 99精品久久久久久| 婷婷久久综合久| 婷婷大乡焦噜噜| 五月丁香花激情综合网| 激情文学 综合 色| 91精产品自偷自偷综合| 91麻豆国产三级精品福利在线观看| 亚洲a色| 婷婷五月天色播| 爱婷婷五月| 开心婷婷五月激情网小说| 五月婷婷色播| a毛片二逼wwwwwwwwww| 在线观看免费人成视频无码| 色婷婷香蕉| 天天综合网站| 天天操天爱综合| 婷婷丁香五月视频| 五月婷婷丁香| 六月婷久久| 久久久婷丁香五月| 人妻丰满精品一区二区A片| 久久a热| 超碰不卡在线| 这里只有精品1| 26uuu另类| 五月天婷婷丁香花| 久久只有精品| 丁香五月婷婷亚洲人| 久久婷婷啪啪视频| 色综合香蕉| 7777精品伊人久久久大香线蕉最新版| 在线免费视频caop| 国产黄色在线| 色播综合| 激情五月小说婷婷| 九九热最新地址| 久久久激情视频| 天天综合网91| 五月丁香花视频| 99久久99久久| 五月天激情啪啪| 久艹大香蕉| 五月色综合| 五月天天综合| 天天干天天操天天拍| 婷婷天天色| www.天天干| 成年人最刺激的综合网| 天天搞天天色综合| 波多野结衣AV无码Porn| 人人操97| 97操视频| 五月婷婷六月丁香在线| 亚洲AV免费在线| 99成人在线观看| 97资源欧美日韩大香蕉超碰一区| 激情九月综合| 狠狠搞狠狠操| 婷婷五月色| 国产午夜成人免费看片无遮挡| 做爰丰满少妇1313| 久久5 9视频免费观看| 婷婷丁香18| 另类图片五月天婷婷| 九九九九中文字幕| ′久久99一| 超碰在线免费9| 亚洲AV综合网| 狠狠色狠狠干| 99热99日…..| 日日夜夜天天爽| 色情综合网| 男人的天堂五月丁香| 91色在线/日韩| 亚洲AV免费在线| 久久久99精品免费观看| 国产一级黄色影片,| 99久久精品亚洲综合| 在线观看996精品| 激情五月天婷婷图| 婷婷五月天 偷拍| 天天视频亚洲| 性色天| 99精品综合视频| 五月天福利影院导航| 五月丁香天堂| 97碰在线| 99视频久久免费视频| 婷婷五月成人系列| 99在线精品视频| 婷婷性爱影院| 97福利视频| 91聚色综合网| 五月天婷综合| 伊人婷婷大香蕉| 狠狠色丁香综合| 天天日日爽| 日韩综合天堂| 99热9| 91亚洲免费片| 高清无码.com| 激情网婷婷婷| 五月婷色色| 色伦专区97中文字幕| 日韩av网站在线观看| 色婷婷五月天av在线| 婷婷成人丁香色情基地30| 99国产精品久久久久久久久久久| 婷婷激情四射| 丁香婷婷五月激情四射网| 色色婷| 国产精品视频久久99| 五月天伊人| 色香欲综合| 潮汕成人AV片在线| 色婷婷97| 天天色综合图片| 91久久久久久久久| 综合狠久久| 婷婷在线免费| 婷婷娱乐丁香综合网| 91碰视频| 丁香五月婷婷激情97| 97色在线观看视频| 夜夜夜叫天天天做| 91色逼| 丁香狠狠干| 97色婷婷| 丁香六月色婷婷综合| 能看的AV| 五月婷综合| av婷婷丁香 六月| 五月花婷婷| 1024在线一区| 1024人妻| 色五月婷婷丁香五月| 久久婷婷五月| a九九热www| 成人丁香婷婷五月天| 激情五月天丁香| 97色图片中文字幕视频在线观看 | 狠狠色狠狠干| 久久伦乱| 91麻豆国产三级精品福利在线观看| 97干在线| 伊人婷婷色| 久久大香蕉丁香| 99re这里只有精品国产99| 天天综合网站| 少妇水多A片太爽了| 婷婷五月播| 99在线精品视频| 五月天久久婷| 婷婷伊人綜合中文字幕| 思思久久精品| 丁香狠狠色婷婷久久无码视频| 99综合色色色| 色婷婷久久综合| 超碰在线网站| 婷婷丁香五月天中文字幕| 丰满老熟妇BBBBB搡BBB | 99热大香蕉| 欧美激情中文字幕| 狠狠色丁香久久婷婷综合五月| 国产成人精品一区二三区熟女在线 | 亚洲熟妇无码乱子AV电影| 琪琪狠狠干| 色婷五月| 日日夜夜干| 色丁香五月婷婷婷| 欧美综合五月丁香六月婷| 玖玖爱导航| 99热手机在线精品| 无码碰碰| 天天五月情| 五月婷婷影视| 99综合婷婷五月| 色五月婷婷中文字幕| 成人av免费观看| 六月婷婷激情| 午夜成人网站在线观看| 丁香婷婷五月天在线视频| 五月丁香婷色| 激情五月婷婷在线| www。久久久久一b。Cc| 无码人妻一区二区三区四区| 另类小说五月天| 久热只有这里有精品| 五月丁香婷婷综合网| 欧美精品999| 婷婷五月激情五月激情| 激情丁香五月天综合| 欧美一级色| 99热这里只有精品268| 国产成人AV在线| 另类专区在线观看| 婷婷五月天久久久| 91操人| 五月综合视频| 狠狠999| 《亚洲操B久久免费在线观看,亚洲操B久久在线播放》在线播放 - 高清资源 - 97 | 欧美综合123区| 大香蕉99热| 99精在线| 99热国产这里只有| 欧美精品XXXXBBBB| 五月天五月色| 久久99免费视频网站| 5月婷婷激情网| 91日韩美女被插视频| 欧洲不卡视频| 欧美99| 成人做爰高潮A片免费视频| 久久人妻情侣| 婷婷五月丁香四射| 可以看的av网站| 婷婷激情综合色五月久久91| www.色婷婷.com| 国产操碰| 狠狠色噜噜狠狠狠狠综合| 激情五月综合ì香亚洲| 丁香五月熟女| 婷婷丁香五月天激情| 婷婷视频网| AA片在线观看视频在线播放 | 国产成人精品一区二三区熟女在线| 伊人狠狠干| 怡红院成人AV| 深爱五月激情| 九九视频热| 丁香五月天社区婷婷| 99综合在线| 天天婷婷操| 日本波多野结衣视频| 五月丁香在线| 亚洲成人网站在线观看| 欧美大片免费播放器| 婷婷五月丁香综合人妻| 中文在线成人| 欧美黄色AA片哗啦啦啦| 婷婷5月天激情综合| 99热99精品在线观看| 六月丁香中文字幕| 天天干天天日日| 日本操B片| 激情欧美五月丁香| 开心五月色婷婷综合开心网| 在线日韩av| 99在线小视频| 五月天婷婷人妻| 天天操天天插| 激情开心五月婷婷| 九九久久高清|