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

ARTICLE DETAIL

資訊詳情

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

STM32 HAL庫(kù)移植MPU6050 DMP驅(qū)動(dòng):姿態(tài)解算實(shí)戰(zhàn)指南

STM32 HAL庫(kù)移植MPU6050 DMP驅(qū)動(dòng):姿態(tài)解算實(shí)戰(zhàn)指南 1. 項(xiàng)目概述為什么需要移植DMP庫(kù)如果你正在用STM32做四軸飛行器、平衡車或者任何需要姿態(tài)感知的項(xiàng)目MPU6050這個(gè)六軸傳感器三軸加速度計(jì)三軸陀螺儀大概率是你的老朋友。但拿到原始數(shù)據(jù)后姿態(tài)解算這塊硬骨頭——卡爾曼濾波、互補(bǔ)濾波、四元數(shù)、歐拉角——是不是讓你頭疼不已自己寫算法調(diào)參數(shù)光是處理零點(diǎn)漂移和噪聲就夠折騰幾個(gè)通宵了。這就是DMPDigital Motion Processor庫(kù)的價(jià)值所在。它本質(zhì)上是MPU6050芯片內(nèi)部的一個(gè)協(xié)處理器廠家InvenSense已經(jīng)把復(fù)雜的姿態(tài)解算算法固化在里面了。你只需要把DMP庫(kù)移植到你的MCU上它就能在傳感器內(nèi)部實(shí)時(shí)解算出穩(wěn)定的四元數(shù)或歐拉角通過(guò)I2C直接讀取結(jié)果極大減輕了主控MCU的運(yùn)算負(fù)擔(dān)也省去了自己調(diào)試算法的巨大工作量。用上DMP就相當(dāng)于給MPU6050裝上了“自動(dòng)駕駛”你直接獲取成熟、穩(wěn)定的姿態(tài)數(shù)據(jù)就行。然而官方提供的DMP驅(qū)動(dòng)庫(kù)示例代碼多是基于標(biāo)準(zhǔn)外設(shè)庫(kù)SPL或舊版IDE的?,F(xiàn)在STM32生態(tài)主推HAL庫(kù)其硬件抽象層更高初始化、讀寫接口與SPL有顯著差異。很多朋友在移植時(shí)卡在了I2C通信、中斷配置或者庫(kù)文件路徑設(shè)置上導(dǎo)致DMP初始化失敗讀出來(lái)的數(shù)據(jù)全是0。網(wǎng)上資料零散新舊混雜跟著做常常掉坑里。這篇內(nèi)容就是基于我多次在STM32F1、F4系列上成功移植的經(jīng)驗(yàn)為你梳理出一條清晰、可復(fù)現(xiàn)的HAL庫(kù)移植路徑。我的目標(biāo)很明確不深究DMP內(nèi)部數(shù)學(xué)原理只聚焦于“如何把官方庫(kù)在HAL環(huán)境下跑起來(lái)”這個(gè)工程問(wèn)題。只要你手頭有STM32開(kāi)發(fā)板以最常見(jiàn)的STM32F103C8T6為例、一個(gè)MPU6050模塊GY-521以及STM32CubeIDE或Keil MDK環(huán)境跟著步驟走就能成功讀出俯仰角pitch、橫滾角roll和偏航角yaw。2. 核心思路與準(zhǔn)備工作理解移植的本質(zhì)在動(dòng)手寫代碼之前我們必須搞清楚移植DMP庫(kù)到底在做什么。這能讓你在遇到問(wèn)題時(shí)知道該從哪里排查。2.1 DMP庫(kù)移植的核心任務(wù)移植的核心是搭建一個(gè)橋梁連接兩個(gè)部分MPU6050官方DMP庫(kù)文件這是一組由InvenSense提供的C語(yǔ)言源文件和頭文件主要是inv_mpu.c、inv_mpu_dmp_motion_driver.c、mpu6050.h等。它們包含了與DMP固件交互、加載、運(yùn)行的所有底層邏輯。但庫(kù)里的I2C讀寫函數(shù)是“空殼”或基于特定平臺(tái)的需要你來(lái)實(shí)現(xiàn)。你的STM32 HAL工程你使用STM32CubeMX生成的基于HAL庫(kù)的工程。它提供了硬件I2C的初始化配置MX_I2C1_Init和一套標(biāo)準(zhǔn)的HAL_I2C讀寫API如HAL_I2C_Mem_Write。因此移植工作 ≈ 實(shí)現(xiàn)DMP庫(kù)所需的底層I2C驅(qū)動(dòng)接口并將其整合到你的HAL工程中。具體來(lái)說(shuō)你需要修改或提供以下幾個(gè)關(guān)鍵函數(shù)i2c_write 向MPU6050的指定寄存器寫入數(shù)據(jù)。i2c_read 從MPU6050的指定寄存器讀取數(shù)據(jù)。delay_ms 毫秒級(jí)延時(shí)函數(shù)。get_ms 獲取系統(tǒng)毫秒時(shí)間戳用于某些超時(shí)判斷。2.2 材料與軟件準(zhǔn)備清單工欲善其事必先利其器。請(qǐng)確保你已準(zhǔn)備好以下物品和軟件環(huán)境硬件部分STM32最小系統(tǒng)板 如STM32F103C8T6BluePill、STM32F407VET6等。本文以F103為例但HAL庫(kù)的移植方法通用。MPU6050模塊 最常見(jiàn)的GY-521模塊。注意模塊上的電平轉(zhuǎn)換芯片確保其VCC與你的MCU邏輯電平匹配通常3.3V。連接線 杜邦線若干。ST-Link調(diào)試器 用于程序下載和調(diào)試。這是排查問(wèn)題的利器強(qiáng)烈建議使用。軟件部分STM32CubeMX 用于圖形化配置MCU引腳、時(shí)鐘、I2C等外設(shè)并生成HAL庫(kù)工程骨架。開(kāi)發(fā)環(huán)境 Keil MDK-ARMuVision5或 STM32CubeIDE 任選其一。本文操作會(huì)兼顧兩者進(jìn)行說(shuō)明。DMP驅(qū)動(dòng)庫(kù)文件 這是最關(guān)鍵的材料。你可以從InvenSense的官方開(kāi)發(fā)者網(wǎng)站、MPU6050數(shù)據(jù)手冊(cè)的應(yīng)用筆記頁(yè)面或者一些開(kāi)源項(xiàng)目如i2cdevlib中獲取。通常是一個(gè)包含inv_mpu.c、inv_mpu_dmp_motion_driver.c、dmpKey.h、dmpmap.h等文件的壓縮包。注意獲取正確的庫(kù)文件網(wǎng)絡(luò)上流傳的DMP庫(kù)版本眾多有些是針對(duì)特定型號(hào)如MPU9150裁剪過(guò)的。尋找名為MPU6050_6Axis_MotionApps_V6.12或類似版本的庫(kù)通常比較完整。如果找不到一個(gè)變通的方法是使用Arduino社區(qū)流行的MPU6050_light庫(kù)中的相關(guān)文件但可能需要更多適配工作。本文假設(shè)你已獲得一個(gè)相對(duì)完整的DMP庫(kù)文件包。硬件連接這是最容易出錯(cuò)的第一步務(wù)必核對(duì)三遍MPU6050 (GY-521) STM32F103C8T6 VCC - 3.3V GND - GND SCL - PB6 (I2C1_SCL) SDA - PB7 (I2C1_SDA)AD0引腳 接GND表示MPU6050的I2C從機(jī)地址為0x68接VCC則地址為0x69。我們通常接GND。INT引腳 中斷引腳用于DMP數(shù)據(jù)準(zhǔn)備好時(shí)觸發(fā)MCU中斷。在初步調(diào)試階段我們可以先不使用中斷采用輪詢方式。若要追求效率可以連接到MCU的任一GPIO如PA0并配置為外部中斷模式。3. 工程創(chuàng)建與底層驅(qū)動(dòng)適配這一節(jié)我們將從零開(kāi)始創(chuàng)建一個(gè)HAL工程并完成DMP庫(kù)底層驅(qū)動(dòng)的“嫁接”手術(shù)。3.1 使用STM32CubeMX創(chuàng)建基礎(chǔ)工程打開(kāi)STM32CubeMX新建工程選擇你的MCU型號(hào)例如STM32F103C8T6。配置系統(tǒng)核心SYS 在Debug下拉菜單中根據(jù)你的調(diào)試器選擇Serial WireST-Link使用。這會(huì)影響SWDIO和SWCLK引腳。配置時(shí)鐘RCC 將HSE高速外部時(shí)鐘設(shè)置為Crystal/Ceramic Resonator如果你的板子有外部晶振的話。然后在Clock Configuration標(biāo)簽頁(yè)將系統(tǒng)時(shí)鐘HCLK設(shè)置到MCU的最高主頻對(duì)于F103通常設(shè)為72MHz。穩(wěn)定的時(shí)鐘是I2C通信的基礎(chǔ)。配置I2C1在引腳圖界面找到PB6和PB7分別設(shè)置為I2C1_SCL和I2C1_SDA。在左側(cè)外設(shè)列表找到I2C1將Mode設(shè)置為I2C。在Parameter Settings標(biāo)簽頁(yè)主要關(guān)注兩個(gè)參數(shù)I2C Speed Mode: 選擇Standard Mode標(biāo)準(zhǔn)模式100kHz或Fast Mode400kHz。初次調(diào)試強(qiáng)烈建議選擇Standard Mode(100kHz)成功率更高通信更穩(wěn)定。I2C Clock Speed (Hz): 當(dāng)選擇標(biāo)準(zhǔn)模式時(shí)這里會(huì)自動(dòng)計(jì)算出一個(gè)值例如100000。保持默認(rèn)即可。配置一個(gè)串口USART1 為了打印調(diào)試信息我們需要一個(gè)串口。將PA9設(shè)置為USART1_TXPA10設(shè)置為USART1_RX。在USART1的參數(shù)設(shè)置中波特率設(shè)為115200字長(zhǎng)8 Bits無(wú)校驗(yàn)1停止位。生成工程代碼轉(zhuǎn)到Project Manager標(biāo)簽頁(yè)。設(shè)置Project Name和Project Location。選擇你的Toolchain / IDEMDK-ARM V5 或 STM32CubeIDE。在Code Generator部分務(wù)必勾選Generate peripheral initialization as a pair of ‘.c/.h’ files per peripheral。這會(huì)讓代碼結(jié)構(gòu)更清晰。點(diǎn)擊GENERATE CODE生成工程并打開(kāi)你的IDE。3.2 將DMP庫(kù)文件添加到工程在IDE中我們需要把下載的DMP庫(kù)文件導(dǎo)入到工程里并建立正確的包含路徑。在工程目錄下創(chuàng)建文件夾 在你的工程根目錄與Core、Drivers同級(jí)新建一個(gè)文件夾命名為MotionDriver或MPU6050。復(fù)制庫(kù)文件 將你獲取的DMP庫(kù)文件至少包括inv_mpu.cinv_mpu_dmp_motion_driver.cinv_mpu_dmp_motion_driver.hmpu6050.h以及dmpKey.hdmpmap.h等復(fù)制到這個(gè)新建的文件夾中。在IDE中添加文件組和包含路徑Keil MDK在Project窗口右鍵點(diǎn)擊Target 1選擇Add Group...命名為MotionDriver。右鍵點(diǎn)擊新建的MotionDriver組選擇Add Existing Files to Group...將剛才復(fù)制到文件夾里的.c源文件添加進(jìn)來(lái)。右鍵點(diǎn)擊工程名選擇Options for Target...轉(zhuǎn)到C/C標(biāo)簽頁(yè)。在Include Paths一欄添加你創(chuàng)建的MotionDriver文件夾路徑。STM32CubeIDE在Project Explorer中右鍵點(diǎn)擊工程名選擇New-Folder創(chuàng)建一個(gè)名為MotionDriver的虛擬文件夾或鏈接到物理文件夾。將庫(kù)文件拖入該文件夾或在文件夾上右鍵Import-File System導(dǎo)入。右鍵點(diǎn)擊工程名選擇Properties。在C/C Build-Settings-Tool Settings-MCU GCC Compiler-Includes中添加MotionDriver文件夾的路徑。3.3 實(shí)現(xiàn)底層接口函數(shù)關(guān)鍵步驟這是移植的核心。我們需要修改DMP庫(kù)中的一個(gè)文件通常是inv_mpu.c來(lái)填充HAL庫(kù)的I2C讀寫函數(shù)。找到inv_mpu.c文件搜索i2c_write和i2c_read函數(shù)。它們通常被定義為_(kāi)_weak弱函數(shù)或者以空函數(shù)的形式存在。我們需要用HAL庫(kù)的函數(shù)來(lái)實(shí)現(xiàn)它們。方案一修改inv_mpu.c推薦直接明了在inv_mpu.c文件的開(kāi)頭添加HAL庫(kù)的頭文件#include “main.h” // 這包含了 stm32f1xx_hal.h然后找到或?qū)崿F(xiàn)以下函數(shù)// 替換或?qū)崿F(xiàn) i2c_write 函數(shù) int i2c_write(unsigned char slave_addr, unsigned char reg_addr, unsigned char length, unsigned char const *data) { HAL_StatusTypeDef status; status HAL_I2C_Mem_Write(hi2c1, // 你的I2C句柄在main.c中定義為 hi2c1 slave_addr 1, // HAL庫(kù)需要7位地址左移1位 reg_addr, I2C_MEMADD_SIZE_8BIT, // 寄存器地址是8位 (uint8_t*)data, length, HAL_MAX_DELAY); // 使用最大延時(shí)等待傳輸完成 return (status HAL_OK) ? 0 : -1; // DMP庫(kù)期望成功返回0失敗返回-1 } // 替換或?qū)崿F(xiàn) i2c_read 函數(shù) int i2c_read(unsigned char slave_addr, unsigned char reg_addr, unsigned char length, unsigned char *data) { HAL_StatusTypeDef status; status HAL_I2C_Mem_Read(hi2c1, slave_addr 1, reg_addr, I2C_MEMADD_SIZE_8BIT, data, length, HAL_MAX_DELAY); return (status HAL_OK) ? 0 : -1; }方案二在main.c中重寫保持庫(kù)文件純凈如果你不想修改原始的inv_mpu.c文件可以在main.c中重新實(shí)現(xiàn)這些函數(shù)并確保它們被正確鏈接。但需要注意函數(shù)聲明和編譯器的鏈接規(guī)則對(duì)于新手方案一更簡(jiǎn)單可靠。實(shí)現(xiàn)延時(shí)和獲取時(shí)間戳函數(shù)同樣在inv_mpu.c中找到delay_ms和get_ms函數(shù)或類似函數(shù)用HAL庫(kù)的函數(shù)實(shí)現(xiàn)// 毫秒延時(shí) void delay_ms(unsigned long num_ms) { HAL_Delay(num_ms); // 直接調(diào)用HAL的延時(shí)函數(shù) } // 獲取系統(tǒng)滴答計(jì)數(shù)毫秒 unsigned long get_ms(unsigned long *count) { *count HAL_GetTick(); // HAL的滴答計(jì)數(shù)器每毫秒加1 return 0; }實(shí)操心得I2C地址左移問(wèn)題這是移植中最常見(jiàn)的坑MPU6050的7位I2C地址是0x68AD0接GND。但HAL庫(kù)的HAL_I2C_Mem_Write/Read函數(shù)內(nèi)部會(huì)自動(dòng)處理讀寫位即最低位所以傳入的從機(jī)地址需要是7位地址左移1位后的值即0x68 1 0xD0。很多移植失敗就是因?yàn)檫@里沒(méi)搞清楚直接傳了0x68導(dǎo)致通信失敗。上面的代碼slave_addr 1就完成了這個(gè)操作。3.4 解決編譯錯(cuò)誤與警告添加文件并修改代碼后編譯工程你可能會(huì)遇到一些錯(cuò)誤和警告。常見(jiàn)問(wèn)題及解決方法#include “mpu6050.h”路徑錯(cuò)誤 檢查inv_mpu.c或inv_mpu_dmp_motion_driver.c中頭文件包含路徑。如果它們寫的是#include “mpu6050.h”而你的mpu6050.h在MotionDriver文件夾通常需要改為#include “mpu6050.h”并確保包含路徑已添加。更穩(wěn)妥的做法是使用相對(duì)路徑或統(tǒng)一在IDE中設(shè)置包含路徑。數(shù)據(jù)類型重定義 DMP庫(kù)中可能定義了uint8_t、int16_t等類型與STM32標(biāo)準(zhǔn)庫(kù)定義沖突。解決方法 確保在DMP庫(kù)的頭文件中包含了stdint.h或“stm32f1xx_hal.h”并且避免重復(fù)定義。通常注釋掉庫(kù)文件中自己的類型定義即可。未使用的參數(shù)警告 DMP庫(kù)中的某些函數(shù)參數(shù)可能未被使用編譯器會(huì)產(chǎn)生-Wunused-parameter警告。這通常不影響功能可以在IDE的編譯器設(shè)置中降低警告等級(jí)或者在函數(shù)開(kāi)始處添加(void)parameter_name;來(lái)顯式忽略該參數(shù)。4. DMP庫(kù)的初始化與數(shù)據(jù)讀取流程底層驅(qū)動(dòng)適配好后我們就可以在主程序中調(diào)用DMP庫(kù)的高級(jí)API進(jìn)行初始化和數(shù)據(jù)讀取了。4.1 主程序初始化步驟詳解在main.c的/* USER CODE BEGIN 2 */和/* USER CODE END 2 */之間即外設(shè)初始化完成后主循環(huán)開(kāi)始前編寫DMP初始化代碼。這是一個(gè)標(biāo)準(zhǔn)的流程/* USER CODE BEGIN 2 */ uint8_t dev_id; // 設(shè)備ID int8_t result; // 函數(shù)執(zhí)行結(jié)果 // 1. 初始化MPU6050復(fù)位、喚醒、設(shè)置時(shí)鐘源等 result mpu_init(NULL); // 參數(shù)為NULL表示使用默認(rèn)I2C地址(0x68) if (result ! 0) { printf(“mpu_init failed! Error code: %d\r\n”, result); Error_Handler(); } // 2. 驗(yàn)證設(shè)備ID確認(rèn)通信正常 mpu_get_device_id(dev_id); printf(“MPU6050 Device ID: 0x%02X\r\n”, dev_id); // 正確應(yīng)為0x68或0x69 if (dev_id ! 0x68 dev_id ! 0x69) { // 根據(jù)你的AD0接線判斷 printf(“Wrong Device ID! Check I2C connection.\r\n”); Error_Handler(); } // 3. 設(shè)置傳感器量程根據(jù)你的應(yīng)用選擇 mpu_set_gyro_fsr(2000); // 陀螺儀量程: ±2000 °/s mpu_set_accel_fsr(2); // 加速度計(jì)量程: ±2g (平衡車常用) 或 ±4g, ±8g, ±16g // 4. 設(shè)置數(shù)字低通濾波器(DLPF)帶寬 mpu_set_lpf(42); // 帶寬42Hz數(shù)值越小濾波越強(qiáng)延遲越大 // 5. 設(shè)置采樣率 mpu_set_sample_rate(100); // 設(shè)置采樣率為100Hz // 6. 加載DMP固件最關(guān)鍵的一步 result dmp_load_motion_driver_firmware(); if (result ! 0) { printf(“dmp_load_motion_driver_firmware failed! Error: %d\r\n”, result); Error_Handler(); } // 7. 寫入DMP配置方向矩陣、特征輸出等 // 這一步通常需要調(diào)用一系列 dmp_set_xxx 函數(shù)。 // 一個(gè)常見(jiàn)的配置是使能6軸姿態(tài)加速度計(jì)陀螺儀融合 result dmp_enable_feature(DMP_FEATURE_6X_LP_QUAT | // 6軸低功耗四元數(shù) DMP_FEATURE_SEND_RAW_ACCEL | // 同時(shí)輸出原始加速度 DMP_FEATURE_SEND_RAW_GYRO | // 同時(shí)輸出原始陀螺儀 DMP_FEATURE_TAP); // 可選使能敲擊檢測(cè) if (result ! 0) { printf(“dmp_enable_feature failed! Error: %d\r\n”, result); Error_Handler(); } // 8. 設(shè)置DMP輸出速率應(yīng)與采樣率匹配或?yàn)槠湔麛?shù)分頻 result dmp_set_fifo_rate(100); // 設(shè)置DMP輸出到FIFO的速率也為100Hz if (result ! 0) { printf(“dmp_set_fifo_rate failed! Error: %d\r\n”, result); Error_Handler(); } // 9. 最后啟動(dòng)DMP result mpu_set_dmp_state(1); // 參數(shù)1為開(kāi)啟 if (result ! 0) { printf(“mpu_set_dmp_state failed! Error: %d\r\n”, result); Error_Handler(); } // 10. 清零FIFO準(zhǔn)備接收數(shù)據(jù) mpu_reset_fifo(); printf(“MPU6050 DMP Init Success!\r\n”); /* USER CODE END 2 */4.2 主循環(huán)中的數(shù)據(jù)讀取與解析初始化成功后DMP會(huì)以設(shè)定的速率如100Hz將解算好的數(shù)據(jù)包推入其內(nèi)部的FIFO緩沖區(qū)。我們的任務(wù)就是定期或通過(guò)中斷去讀取這個(gè)FIFO并解析出我們需要的姿態(tài)數(shù)據(jù)。在主循環(huán)while (1)中添加以下代碼/* USER CODE BEGIN WHILE */ while (1) { uint8_t fifo_buffer[64]; // FIFO數(shù)據(jù)緩沖區(qū)大小至少為包大小 uint16_t fifo_count 0; // FIFO中等待讀取的數(shù)據(jù)字節(jié)數(shù) uint8_t more 0; // 是否還有更多數(shù)據(jù)待讀 float q0, q1, q2, q3; // 四元數(shù) float pitch, roll, yaw; // 歐拉角 // 1. 獲取當(dāng)前FIFO中存儲(chǔ)的數(shù)據(jù)長(zhǎng)度字節(jié)數(shù) mpu_get_fifo_count(fifo_count); // 2. 如果FIFO中的數(shù)據(jù)足夠一個(gè)數(shù)據(jù)包大小取決于使能的特征 // 對(duì)于使能了6軸四元數(shù)和原始數(shù)據(jù)的配置一個(gè)包通常大于42字節(jié) if (fifo_count 42) { // 這個(gè)閾值需要根據(jù)你的實(shí)際配置調(diào)整 // 3. 從FIFO中讀取一個(gè)數(shù)據(jù)包 mpu_read_fifo(fifo_buffer, more); // 4. 解析數(shù)據(jù)包獲取四元數(shù) // 注意dmp_read_fifo() 函數(shù)內(nèi)部會(huì)調(diào)用mpu_read_fifo并解析 // 這里我們演示更底層的解析方式。通常使用 dmp_read_fifo 更方便。 // 假設(shè)我們直接解析原始FIFO緩沖區(qū)中的四元數(shù)數(shù)據(jù)小端格式 // 四元數(shù)在FIFO包中的偏移量和格式需參考DMP庫(kù)定義dmpmap.h // 更推薦使用庫(kù)函數(shù) long quat[4]; // 四元數(shù)用long型存儲(chǔ)是Q30定點(diǎn)數(shù)格式 unsigned long sensor_timestamp; short sensors; // 標(biāo)識(shí)哪些傳感器數(shù)據(jù)在本包中 unsigned char fifo_packet[64]; if (dmp_read_fifo(quat, NULL, NULL, sensor_timestamp, sensors, fifo_packet) 0) { // 5. 將Q30格式的四元數(shù)轉(zhuǎn)換為浮點(diǎn)數(shù) q0 (float)quat[0] / 1073741824.0f; // 2^30 q1 (float)quat[1] / 1073741824.0f; q2 (float)quat[2] / 1073741824.0f; q3 (float)quat[3] / 1073741824.0f; // 6. 將四元數(shù)轉(zhuǎn)換為歐拉角俯仰pitch橫滾roll偏航y(tǒng)aw單位弧度 pitch asin(-2 * q1 * q3 2 * q0 * q2); roll atan2(2 * q2 * q3 2 * q0 * q1, -2 * q1 * q1 - 2 * q2 * q2 1); yaw atan2(2 * q1 * q2 2 * q0 * q3, -2 * q2 * q2 - 2 * q3 * q3 1); // 7. 弧度轉(zhuǎn)角度可選 pitch pitch * 180.0f / 3.14159265358979f; roll roll * 180.0f / 3.14159265358979f; yaw yaw * 180.0f / 3.14159265358979f; // 8. 通過(guò)串口打印輸出 printf(“Pitch: %.2f, Roll: %.2f, Yaw: %.2f\r\n”, pitch, roll, yaw); } } // 延時(shí)或執(zhí)行其他任務(wù)避免過(guò)度占用CPU HAL_Delay(10); /* USER CODE END WHILE */ /* USER CODE BEGIN 3 */ } /* USER CODE END 3 */注意事項(xiàng)FIFO讀取策略上面的代碼是“輪詢”方式不斷檢查FIFO長(zhǎng)度。這簡(jiǎn)單但效率不高。更高效的方式是使用MPU6050的INT引腳中斷。當(dāng)DMP有新的數(shù)據(jù)包準(zhǔn)備好時(shí)INT引腳會(huì)產(chǎn)生一個(gè)脈沖。你可以將這個(gè)引腳連接到STM32的外部中斷引腳配置上升沿或高電平觸發(fā)。在中斷服務(wù)函數(shù)中設(shè)置一個(gè)標(biāo)志位如dmp_data_ready 1然后在主循環(huán)中檢查這個(gè)標(biāo)志位再去讀取FIFO。這樣可以做到精確的、無(wú)延遲的數(shù)據(jù)同步并且讓MCU在等待數(shù)據(jù)時(shí)有空處理其他任務(wù)。5. 調(diào)試技巧與常見(jiàn)問(wèn)題排查實(shí)錄即使嚴(yán)格按照步驟操作第一次成功前也難免遇到問(wèn)題。這里我把自己踩過(guò)的坑和解決方法整理出來(lái)你可以像查字典一樣對(duì)照排查。5.1 初始化階段問(wèn)題排查表問(wèn)題現(xiàn)象可能原因排查步驟與解決方案mpu_init()失敗1. I2C物理連接錯(cuò)誤線松、接反。2. I2C引腳配置錯(cuò)誤未上拉、速度過(guò)快。3.I2C從機(jī)地址錯(cuò)誤最常見(jiàn)。4. 電源問(wèn)題模塊未供電或電壓不足。1.萬(wàn)用表檢查測(cè)量VCC3.3V、GND、SCL/SDA電壓空閑時(shí)應(yīng)為高電平約3.3V。2.邏輯分析儀/示波器抓取I2C波形看起始信號(hào)、地址幀、ACK應(yīng)答是否正常。這是終極手段。3.打印調(diào)試在i2c_write/read函數(shù)里加入printf打印傳入的地址和狀態(tài)。確認(rèn)傳入HAL庫(kù)的地址是0xD0或0xD20x691。4.簡(jiǎn)化測(cè)試先不移植DMP寫一個(gè)最簡(jiǎn)單的HAL_I2C讀寫測(cè)試函數(shù)嘗試讀寫MPU6050的WHO_AM_I寄存器地址0x75其默認(rèn)返回值應(yīng)為0x68。dmp_load_motion_driver_firmware()失敗1. 之前的mpu_init等步驟已失敗。2. DMP庫(kù)文件不完整或版本不對(duì)。3. I2C通信在傳輸大量固件數(shù)據(jù)時(shí)不穩(wěn)定。4. 系統(tǒng)堆棧Stack大小不足。1. 確保mpu_init、mpu_set_xxx等函數(shù)都返回0。2. 檢查dmpKey.h和dmpmap.h是否存在且被正確包含。嘗試尋找更可靠的DMP庫(kù)源文件。3.降低I2C速度在CubeMX中將I2C速度從400kHz改為100kHz。4.增大堆棧在啟動(dòng)文件或IDE的鏈接器配置中將堆Heap和棧Stack大小適當(dāng)調(diào)大例如Stack設(shè)為2048Heap設(shè)為1024。設(shè)備ID讀取正確但DMP初始化后數(shù)據(jù)全為01. DMP固件加載成功但后續(xù)配置如dmp_enable_feature失敗。2. FIFO讀取邏輯錯(cuò)誤解析的偏移量不對(duì)。3. 傳感器模塊本身放置不水平初始姿態(tài)角不為0。1. 檢查dmp_enable_feature和dmp_set_fifo_rate的返回值。2.使用庫(kù)函數(shù)解析優(yōu)先使用dmp_read_fifo()這個(gè)高層函數(shù)來(lái)解析FIFO而不是自己計(jì)算偏移量。3.觀察原始數(shù)據(jù)在使能DMP前先嘗試讀取原始加速度計(jì)和陀螺儀數(shù)據(jù)看是否正常變化。確保模塊靜止時(shí)Z軸加速度約等于1g16384 LSB/g ±2g量程。4.進(jìn)行傳感器校準(zhǔn)雖然DMP有一定自校準(zhǔn)能力但上電靜止幾秒讓陀螺儀零偏穩(wěn)定能提升初始精度。5.2 數(shù)據(jù)輸出階段問(wèn)題排查表問(wèn)題現(xiàn)象可能原因排查步驟與解決方案歐拉角數(shù)據(jù)漂移Yaw軸尤其明顯這是MEMS陀螺儀的通病——零偏漂移。雖然DMP進(jìn)行了融合但長(zhǎng)時(shí)間運(yùn)行尤其是Yaw軸無(wú)重力參考積分誤差會(huì)累積。1.上電校準(zhǔn)模塊上電后務(wù)必保持絕對(duì)靜止2-3秒讓DMP完成初始零偏校準(zhǔn)。代碼上可以在初始化后加長(zhǎng)HAL_Delay(3000)。2.磁力計(jì)融合對(duì)于需要絕對(duì)航向的應(yīng)用如無(wú)人機(jī)必須融合MPU9250內(nèi)置磁力計(jì)或外接HMC5883L等磁力計(jì)為Yaw軸提供絕對(duì)參考。DMP庫(kù)也支持9軸融合但配置更復(fù)雜。3.定期重置對(duì)于非關(guān)鍵應(yīng)用可以設(shè)定運(yùn)行一段時(shí)間后在系統(tǒng)靜止時(shí)軟件重置DMP或重新初始化。角度響應(yīng)遲鈍或有滯后感數(shù)字低通濾波器DLPF帶寬設(shè)置過(guò)低或DMP輸出速率太慢。1.調(diào)整DLPFmpu_set_lpf()的參數(shù)數(shù)值越大帶寬越高延遲越小但噪聲越大。對(duì)于平衡車、四軸常用42Hz或98Hz??梢試L試調(diào)高。2.提高采樣率mpu_set_sample_rate和dmp_set_fifo_rate同步提高如從100Hz提到200Hz。注意不能超過(guò)規(guī)定最大值通常約200Hz。3.檢查主循環(huán)速度確保你的while(1)循環(huán)執(zhí)行一次的時(shí)間遠(yuǎn)小于數(shù)據(jù)更新周期如100Hz對(duì)應(yīng)10ms。如果主循環(huán)里有耗時(shí)任務(wù)考慮用中斷方式讀取數(shù)據(jù)。角度值在某個(gè)方向始終有固定偏差1. 傳感器模塊安裝有物理傾斜。2. DMP的坐標(biāo)系與你的應(yīng)用坐標(biāo)系不匹配。1.物理調(diào)平確保模塊安裝基準(zhǔn)面與你的載體基準(zhǔn)面平行。2.軟件旋轉(zhuǎn)矩陣DMP庫(kù)允許通過(guò)dmp_set_orientation()函數(shù)設(shè)置一個(gè)旋轉(zhuǎn)矩陣來(lái)補(bǔ)償安裝差異。你需要根據(jù)模塊相對(duì)于載體的安裝方向如旋轉(zhuǎn)90度、180度計(jì)算并傳入對(duì)應(yīng)的矩陣。這是進(jìn)階操作需要理解坐標(biāo)系變換。串口打印數(shù)據(jù)導(dǎo)致系統(tǒng)卡頓printf函數(shù)重定向到串口輸出是阻塞式的且速度較慢。在100Hz下連續(xù)打印浮點(diǎn)數(shù)會(huì)占用大量CPU時(shí)間。1.降低打印頻率每10次或20次循環(huán)打印一次數(shù)據(jù)。2.使用DMA串口發(fā)送將串口發(fā)送改為DMA模式非阻塞。3.上位機(jī)調(diào)試考慮使用匿名的上位機(jī)、VOFA等工具通過(guò)特定協(xié)議發(fā)送二進(jìn)制數(shù)據(jù)效率遠(yuǎn)高于字符串打印。5.3 進(jìn)階優(yōu)化與穩(wěn)定性提升當(dāng)基本功能跑通后可以考慮以下優(yōu)化讓系統(tǒng)更穩(wěn)定、更專業(yè)使用中斷讀取FIFO如前所述將MPU6050的INT引腳連接到STM32的EXTI中斷引腳。在CubeMX中配置該引腳為上升沿觸發(fā)外部中斷并生成代碼。在中斷服務(wù)函數(shù)中僅設(shè)置標(biāo)志位。在主循環(huán)中查詢?cè)摌?biāo)志位然后讀取FIFO。這能實(shí)現(xiàn)精準(zhǔn)的定時(shí)數(shù)據(jù)讀取并釋放CPU。加入溫度補(bǔ)償MPU6050的零偏會(huì)隨溫度變化。雖然DMP有在線校準(zhǔn)但對(duì)于高精度應(yīng)用可以讀取芯片溫度傳感器數(shù)據(jù)建立溫度-零偏查找表或公式進(jìn)行軟件補(bǔ)償。與RTOS結(jié)合在FreeRTOS等實(shí)時(shí)操作系統(tǒng)中可以將MPU6050的數(shù)據(jù)讀取任務(wù)放在一個(gè)高優(yōu)先級(jí)的線程中通過(guò)中斷信號(hào)量來(lái)同步姿態(tài)解算放在另一個(gè)線程實(shí)現(xiàn)模塊化。校準(zhǔn)加速度計(jì)比例因子雖然DMP使用了加速度計(jì)進(jìn)行重力對(duì)齊但加速度計(jì)各軸的比例因子可能存在微小差異??梢酝ㄟ^(guò)在多個(gè)已知重力方向下靜止測(cè)量計(jì)算并補(bǔ)償這個(gè)比例因子提升傾角精度。移植成功只是第一步把它穩(wěn)定、高效地融入你的實(shí)際項(xiàng)目才是真正的挑戰(zhàn)。我個(gè)人的體會(huì)是嵌入式開(kāi)發(fā)中傳感器調(diào)試占了大半時(shí)間而清晰的調(diào)試思路和耐心的排查比盲目嘗試代碼更重要。當(dāng)你看到串口穩(wěn)定輸出變化的角度值并且用手轉(zhuǎn)動(dòng)模塊時(shí)數(shù)據(jù)能快速、平滑地跟隨那一刻的成就感就是對(duì)之前所有折騰的最好回報(bào)。最后一個(gè)小技巧在調(diào)試初期不妨把I2C時(shí)鐘速度降到最低比如50kHz雖然慢但波形穩(wěn)定能排除很多時(shí)序上的幽靈問(wèn)題等一切穩(wěn)定后再逐步提速。
返回列表
PREV
查看更多資訊
NEXT
返回資訊列表
色六月天| www.99热| 综合五月亭亭9| 我淫我色婷婷五月天激情四射| 99re思思在线视频| 99视频久久久| 99国产97在线,| 欧美色婷婷| 五月天电影网| 久热这里只有精品在线观看| 色五月天堂| 成人 在线观看国产| 婷婷色色丁香五月天| 五月天亚洲最大成人| avv在线| 看片视频在线免费日产在线看| 五月天伊人手机在线播放AV| 久久性爱视频免费| 91Chinese在线| 亚洲无码 图片区| 日本久久婷婷| 精品女人九九九| 婷婷深爱色五月| 欧美三日本三级少妇三99| 91碰免费视频| 久久精品凹凸分类| 久久精品A片777777| 丁香五月欧美色综合| 狠狠爱综合网| 99色在线| 内射在线CHINESE| 久久丁香五月| 女高怪谈在线观看| 看久久性爱99视频| 六月婷婷开心| 五月天婷婷深深爱| 天天狠狠色噜噜| 色9999日韩国产| 婷婷五月天大香蕉在线视频观看| 一本婷婷丁香久久 | 婷婷五月天影院| 九九色播五月丁香| 日婷婷久久开心| 五月婷婷精品视频| 岛国av电影网站| 综合色天天| 噜噜噜狠狠色综合| 婷婷五月成年人| 日本情色一区二区| www.97干视频| 欧美色色色色色色色色色色| 激情五月综合久久| 色综合久久综合| 丁香深五月婷婷| 国产真人做爰视频免费| 中文字幕有多少字| 五月丁小婷婷激情四射| 色在线免费观看| 亚洲中字AV电影在线网站| 丁香六月五月天| 久久人人九| 天天操综合网| 91热爆在线| 婷婷成人AV| 俺去也在线视频| 激情久久四色| 六月丁香五月亭亭| 五月开心啪啪| 色婷婷久久综合久色综| 91丨九色丨白浆秘| 免费视频无码| 99福利视频导航| 黄色av网站在线免费播放| www,99视频| 亚洲一二三网| 久久五月天视频| 久久 婷婷 五月天| 久久这里面只有精品视频| 九九热这里只有精品556| 色老久久| 丁香五月婷婷色情综合| 久久这里只有精品07| 人人舔天天| 色婷婷瘦婷婷日韩| 另类小说五月天| 色色热99| 五月激情五月婷婷五月天在线| 天天操狠狠操| 另类专区在线观看| 国产真人做爰视频免费| 啪啪五月综合| WWW·天天操·视频?| 五月天伊人av| 噜噜精品| 五月丁香六月激情综合| 日韩一级一片内射视频4K| 久久婷婷五月天丁香| 久99精品视频| 综合激情五月综合激情五月激情1 天天爱天天做天天舔 | 熟女人妻一区二区三区免费看| 精品二区| 色婷婷小说| 五月丁香六月色情网欧美| 99热这里只有精品最新地址获取| 殴美激情综合网| 色婷婷亚洲婷婷| 玖玖九九超碰| 丁香六月综合激情| 五月婷婷六月丁香综合| 国产成人+综合亚洲+天堂| AA片在线观看视频在线播放| www.maotanji.com| 久香草视频在线观看| 久色婷婷200| 生活片五区| 99色| 色婷婷97| 天天天天天天操| 五月丁香婷婷成人网| 琪琪色五月婷婷老师| 丁香六月婷婷色播| 天天干天天玩天天夜天天射天天操天天日蜜臀少妇 | 午夜日韩久久久网站| 亚洲精品无码久久| 欧州色色| 97很鲁在线视频| 五月激情射| 777久久综合视频| 99亚洲日韩| 色婷视频| 超碰在线观看9| 在线综合婷婷| 少妇性按摩无码中文A片| 色玖玖玖| 色综合色综合色综合| 9+1视频网址| 99热10在线高清播放| 色色丁香婷婷| 欧美激情五月天| 欧美美女视频| 天天性视频| 色天天综合| 91狠狠综合久久久久久| 久操综合| 久久免费操| 丁香五月综合网| 亚洲综合婷婷| 香蕉国产2013| 色婷婷激情四射视频| 婷婷的五月天另类视频| 99视频精品在线| 激情九九九九| 五月天综合婷婷| 九九色影院| 激情五月份婷婷| 天天天天爽爽天干| 色图亚洲91| 国产xxxxx在线观看| 色欧美影院| 4399无码视频二区| 色人妻五月| 五月丁香激情综合| 第2色五月婷| 国产97色在线| 大香蕉婷婷久久| 久久精品亚洲一级牲爱综合| 久久丁香综合精品综合| 久久这里只有欧美| 激情综合五月丁香六月婷婷| 婷婷激情五月天视频在线| 人妻AV中文系列| 成人在线网| 五月婷婷日| 五月丁香色色色| 丁香婷五月| 九久9精品| 五月天激情综合网俺也去| 91九色欧美| 97艹| 操逼六区| 狠狠色婷婷7777久| 国产暴力强伦轩1区二区小说| 婷婷亚洲日本| www.五月婷婷| 丁香5月激情网| 99热这里是精品| 日韩无码人妻一区二区| 五月婷婷综合久久| 他改变了拜占庭| 五月天综合久久| 久久精彩综合视频| 五月丁香激情综合| 五月天综合区| 五月天丁香欧美激情| 五月丁六月香| 五月丁香精品| 欧美日韩欧美| 婷婷六月激情在线视频| 婷婷丁香五月天色色| 日韩精品色| 综合六月久久| 九九热视频这里只有精品| 丁香五月手机视频| 色五月激情婷婷| 婷婷欧美激情综合| 玖玖婷婷五月天毛片| 亚洲综合色色| 99超级碰免费视频| 丁香婷婷五月香蕉91| 天天爽天天摸| www.99热在线观看| 无码人妻AV久久久一区二区三区 | 丁香五月123| 99热热这里只精品996小说| 人妻九九九九| 国产麻豆视频| 婷婷五月天亚洲综合| 五月丁香好婷婷A片网| 亚州色色色| VA国产在线综合网站| 婷婷综合九色伊人| 激情六月丁香| 日日操日日爽| 97视频91| 97成人在线视频| 五月婷婷丁香六月| 五月天快乐开心激情网| 色丁香五月婷婷综合久久| 伊人色综在线| 亚洲综合视频在线| 亚洲日韩成人三级av| 婷婷激情图片| 五月丁香婷婷激情在线视频| 超碰中文字幕在线| 成人国产欧美大片一区| 色女人久久| 99无码视频| 久久精品国产精品| 五月天丁香网| 婷婷九月丁香| 天天撸夜夜爽| 99热精品在线播放| 综合激情sV| 激情五月天色色网| www.夜夜操.com| 麻豆科斗777| 五月婷婷性爱网| 丁香五月婷婷色情综合| 五月大香蕉| 天天日,天天射,天天舔| 婷婷激情另类| 久月婷婷| yazhochengrenavwang| 热九九精品| 99久久6| 丁香五月婷婷啪| 综合五月丁香97| 内射人妻视频国内| 大香蕉AV在线| 九九热99免费视频| 色色色成人网| 狠狠色婷婷六月激情网| 欧美色骚婷婷五月天| 激情熟女网| 精品一区二区三区免费毛片爱 | 久久综合首页| 六月婷婷色综合| 激情五月丁香色婷婷| 丁香婷婷五月综合影院| 欧美激情伊人| 久久一操| 九月色婷婷婷| 99激情视频| www.9797国产| 亚洲精品永久久久久久| 亚洲五月天婷婷综合| 男人天堂99| 国产色香蕉精品五夜婷| 丁香婷婷成年| 亚洲色无码A片一区二区麻豆| 久99热| 丁香五月天婷婷中文字幕| 丁香婷婷少妇| 五月色丁香国产在线视频| 成人在线视频一区| 六月婷婷AV| 激情五月综合| 亚洲综合激情五月久久| 久久综合九九| 午夜不卡久久精品无码免费| 91狠狠色丁香婷婷综合久久| 超碰人妻在线| 变态另类9| 亚洲婷婷欧美婷婷| 色综合天天综合成人网| 欧美影院| 99日本黄站| 荷兰av一级| 密乳视频| 日韩在线五月天婷婷| 99视频精品8 | 亚洲有码在线视频| 久久99激情| xxxx五月天色色| 久久综合9| 精品综合网在线| 婷婷丁香九色| 狠狠久综合| 久久综合色情网站| 色色婷婷五月天| 成人 在线 日韩| 亚洲成人AV在线播放| 99热丁香| 九九综合视频在线观看| 日日鲁鲁夜夜爽爽| 五月婷婷六月丁香综合| 九九99九九99| 99久久婷婷国产综合| 五月天激情综合| 人妻久久久| 人人爱人人草| 思思9久久| 国产97在线日韩亚洲女人被黑人巨大| 激情五月天99色| 99狠狠操一| 五月综合激情| 九九99视频精品| 五月天成人网婷婷| 五月婷婷免费在线观看视频| 超碰三级片| 天天摸色吧天天摸色吧| 天天操无码| 99热91| 大香蕉久久| W色综合| 狠狠草网| 欧美欧盟性爱网| 超碰AAAAAAV| 丁香五月婷婷色播艳门照| 日韩欧美一级大黄网站| 久久9视频欧美| 天天做天天爱天天爽| 69超碰在线| 狠狠爱丁香婷| 久久婷婷视频| 人妻VideOssS人妻高清| 在线婷婷| 久久久久视剧HD| 综合久久五月天| 久久精品爱爱| 丁香六月婷婷色XXXXX| 91丨九色丨丰满人妖| 久草热在线视频| 五月婷婷视频| 久久久久网站| 热的无码综合视频| 九九这里都是精品| 91VIP在线观看| 中美日韩成人在线| 99热老司机| 成人婷婷桔色| 婷婷五月情天| 中文字幕黄色片| www.韩日视频| 亚洲激情综合色站| 成人丁香五月天Av| 日韩限制级大尺度黑料泄密大尺度视频一区二区在线观看 | 日韩成人精品中文字幕| av中文网站| 欧美久久网| 精品香蕉99久久久久网站 | 丁香五月香蕉| 在线观看亚洲AV| 欧美色六月婷婷| 精品99在线| 无码激情AAAAA片-区区| 国产综合色婷婷精品久久| 夜夜天天久久婷婷| www.99热| 色伊人婷婷| 思思久久99热只有频精品66| 大香蕉综合在线| 丁香六月婷婷色XXXXX| 梁铮版蜘蛛女在线观看| 婷婷九月激情| 婷婷欧美激情| 天天激情| 丁香九月婷婷| 啪啪综合| 五月天婷婷免费视频| 偷拍丁香九月激情| 开心久久爱五月天| 99ri在线视频| 亚洲婷婷五月天在线激情综合网| 另类 在线| 丁香五月瑟瑟| 另类综合国产| 丁香五月综合| 欧亚色色| 婷婷色网| 四色永久成人网站| 色播婷婷五月天| 久久激情婷婷| 五月婷婷激情久久| 国产免费av网站| 五月情综合| 99热精品无码| 男人的天堂999| www99精品| 麻豆精品| 欧美色五月| 97偷拍对白视频| 小视频一区 | 六月丁香开心婷婷欧美| 思思国产99| 亚洲宗合激情| 人人干AV| 九日日夜夜69| 十月丁香九月婷婷综合| 亚洲性爱AV| 色综合播放| 五月天色丁香| 色五月天中文字幕| 亚洲亚洲人成综合网络| 久久这里99| 国产精品久久久久久久久久免费 | 丁香五月激情五月| 5月婷婷综合| 激情第四色| 久久天天天| 日韩视频99| 激情婷婷丁香五月天小说| 色婷网| 91vip在线观看| 激情五月综合视频| 亚洲亚洲人成综合网络| 求可以看的AV网址| 狠狠精品干练久久久无码中文字幕| 婷婷亚洲五| 欧美日本日韩| 婷婷五月天在线观看第二页| 99热久97| 香蕉综合在线| 思思久久精品视频| 婷婷婷婷午夜| 五月天久久综合婷婷| 综合www色| 成人在线综合| 七七九九色色| 337久久| 激情www| 99久re热| 天天日天天舔| 亚洲色综合性| 久久五月天色婷婷| 激情第四色| 五月天夜夜爱夜夜操| 日本wwww在线| 丁香大香蕉| 99久久99热| 岛国在线观看91| 激情五月婷婷丁香| 99久久综合网| 丁香五月婷婷免费视频| 欧美日韩AAA| 久久激情天堂| 五月天综合| 亚州性爱99| 99热只有精品在线| 丁香五月性| 五月丁香基地| 色色色干| 丁香花综合永久入口| 囯产精品久久欠久久久久久九大| 激情综合青草| 一区二区三区XXXXXX| 色99在线视频| 婷婷五月天激情AV影院| 色色综合网站| 玖玖综合色区在线观看| 99热在线观看精品| 色宗合久久五月婷婷| 第四色网婷婷| 色欲一区二区三区精品A片| 99re这里| 五月婷婷这里都是精品| 丁香狠狠色婷婷| 中文成人在线| 亚洲九九夜夜| 丁香六月五月天| 久草大| 精品婷婷丁香五| 能直接看的av网站| www.婷婷五月天| 婷婷丁香五月天欧美| 色婷婷影| 极品少妇高潮啪啪AV无码| 天天插天天插天天插天天插| 五月在在观看| 婷婷五月色| 丁香九月综合在线| 青青草婷婷五月天| 婷婷丁香六月| 色综合大香蕉| 婷婷金品综合视频| 西瓜美女a片| 亚洲网视屏| 九 九九九AV| 老司机日日夜夜青草| 开心色五月天久久久久久久| 色五月丁香激情视频| 99手机在线精品视频| 九月丁香八月婷婷加勒比| AA丁香综合激情| 五月婷婷开心丁香| 青青草蜜臀| 日本九九九九| 成人在线综合| 亚洲综合成人网站| 丁香五月婷婷高清| 激情小说在线视频| 亚洲激情av| 色色色热热热| 五月天久久网站| 婷婷五月丁香基| 国产精品大香蕉| 五月99久久| 99ri视频在线观看| 超碰啪啪网| 国产精品色情AAAAA片软件| 99这里有精品视频| 五月丁香综合激情网| 97欧美在线| 亚洲色视频| 丁香五月婷婷欧美成人色图| 这里只有精品视频看看| 婷婷综合成人五月天| 亚洲激情综合色站| 久久精彩免费视频精彩免费视频| 91狠狠综合久久| 大香蕉人在线65| 在线看av| 婷婷丁香五月天影院 | 逼特逼在线免费播放| 久久婷婷五月天| 日韩无码成人电影| 久久小视频| 99色视频| 中文字幕婷婷9月天| 99热这里只| 婷婷久久综合| 久久xxxx| 国产SUV精品一区二区883| 综合色色网| 激情四射网| 五月丁香六月婷综合成人综合| 色玖玖综合网| 午夜丁香婷婷| 亚洲成人在线综合| 国产在线黄色| 婷婷中文字幕| 丁香激情五月| 99在线视频操999| 色播激情| 色综合丁香婷婷| 热久久91| 天天色综合色| 五月婷婷丁香综合| 久久亚洲无码| 日日色综合| 深爱激情综合网| 操人无码| 色爱爱综合网| 婷婷99狠狠躁天天躁中| 天天色综合色色色色色。| 另类图片 五月激情| 激情五月四色| WWW.17C亚洲精品| 丁香五月久久| 国产AV一区二区三区最新精品| 色色欧美色色色| 区啪精品| 99热只有精品综合| 老司机午夜福利视频金瓶梅| 天天开心婷婷丁香五月| 人人做天天爱| 色色激情五月| 久久综合久色欧美综合狠狠| 99久久97| 91久久久久久久久| 欧美视频在线观看噜噜| 天天爽天天操| 99热这里只有精品8| 影音先锋男人站,影音先锋男人色资源网,影音先锋AV最新资源站,影音先锋AV资源 | 色色色综合网| 人五月天婷婷喷水| 中文字幕av久久爽一区| 亚洲综合婷婷| 色色色色色色色色综合网| 激情图片婷婷| 99原创自拍视频在线观看| 伊人久热91网| 99re这里只有精品视频6| 婷婷综合精品视频97| 996er热| 天天揷综合网| 久久永久视频| 亚洲综合婷婷六月丁香五月| 99精品热视频| 91午夜婷婷狠狠久久综合9色| 9热精品| 亚洲成色综合网站免费观看| 亚洲婷婷五月天| 强壮公让我夜夜高潮A片视频| 久久九九re热| 99热在这里只有免费精品| 精品人妻一区二区三区四区不卡在| 激情久久久| 亚洲春色奇米影视| 色婷婷五月影视| 亚洲色在线观看| 五月丁香综合啪啪| 色情五月天导航| 色婷婷五月丁香在线观看| 五月婷婷六月丁香| 九色视频九色九色91jiuseshipin| 日本超碰在线| 天天爱天天狠天天透| 久九男女天堂| 丁香婷最新动态| 天天爽免费视频| 中文毛片无遮挡高潮免费| 国产精品成人AV在线| 天天干夜夜欢| 伊人五月天| 国产av影片| 99热这里只有精品国产首页| 最近中文字幕2019视频1| 中美日韩成人在线| 五月天色区| 国产毛多水多女人A片| 中文精品在| 狠狠色丁香久久婷婷综合五月| 五月天色综合| 色~性~乱~伦~噜| 婷婷久久色| 屁股翘好撅高迎合跪趴| 99re这里只有精品国产99| 丁香婷婷六月天| 97香蕉人人在线观看| 婷婷中文字幕版| 日本一级一级一级一级| 五月亭亭六月色| 亚洲成人一区| 97碰免费精采视频| 99免费| 九九色video| 婷婷五月中文字幕国产| 99精品偷自拍| 丁香五月成人论坛| 九九综合| 狠狠狠人妻| 伊人99热| 日韩成人精品中文字幕| 五月天激情图片| 金品在线视频99| 五月丁香六月婷婷无码| 午夜福利8055| 99精品无码| 国产精品丝| 亭亭玉月丁香| 久热99热| 97干婷婷| 婷婷激情性爱| 99精在线| 五月激情丁香六月狠狠干| 变态另类9| 五月丁香六月婷| 亚洲99热| 婷婷色五月天第7色| 激情开心五月天| 天天AV导航网| 江苏少妇性BBB搡BBB爽爽爽| 人人操A| 久久久全国免费视频| 26uuu激情五月天| 亚洲狠9| 五月天婷婷亚洲| 操日本三片99| 秋霞性爱AV| 99热欧美在线观看| 国产精品第一国产精品| 亚洲成人噜噜| 丁香五月激情网| 亚洲av网站| 天天激情综合| 色色99| anquye五月| 久碰久| 99热99热在线| 午夜成人AV在线| AA丁香综合激情| AV天堂婷婷五月天| 六月婷婷香蕉| 色婷五月| 洗浴中心操B视频| 99在线公开视频| 超碰在线观看99| 亚洲 日韩色色| 另类婷婷五月天啪帕帕| 日韩在线99| 久久免费丁香| 天天操婷婷| 丁香五月婷婷六月婷| 色综合色色色色色色综合| 色色激情五月| 日日操,日日爽| 中文av在线观看| 色色色色色综合| 婷婷激情综合网| 国产精品岛国片在线观看免费| 久热久| 丁香五月婷婷激情视频播放| 97五月婷婷| 涩五月婷婷| www,五月天激情| 中文字幕丰满人妻无码专区| 超碰v| 狠狠操狠狠操AV| 丁香五月婷婷婷婷欧美综合| 超碰97色| 国产精品99久久久久久久女警| 五月综合六月婷婷| 久9热| 婷婷婷五月香蕉| 五月丁香六月色| 丁香五月激情视频在线| 亚洲小电影在线观看黄999| 丁香婷婷综合激情五月色| 另类激情五月在线视频欧美| 亚洲开心激情网| 91精品无码久久久久久五月天| www.婷婷六月天| www.夜夜操| 五月天婷五月天综合网在线观| 久久婷婷夜| 中字幕视频在线永久在线观看免费 | 99久久精品视频女神1| 五月丁香婷婷久久| 琪琪色网址| 九九色色| 97操碰视频| 五月婷婷开心综合| 丁香六月婷婷综合麻豆| 99热老网站| 综合99在线| 少妇被躁爽到高潮无码文| 亚洲av成人在线| 丁香狠狠色婷婷久久无码视频| 开心婷婷中文字慕| 一起草无码| 色婷婷av综合网| 色婷婷香蕉| 爆乳熟妇一区二区三区爆乳照片| 人人射人人高潮| 久久视频婷婷视频| 那里有AV网址| 色射影院| 日本久久极品| av五月天婷婷丁香| 久久R激情| 日日夜夜干| 激情综合网五月天| 91九色在线| 久久色五月| 丁香五月在线观看| 成人五月天视频播放| 97干婷婷五月天| 综合婷婷六月| 九九人妻福利| 天天操夜夜爽天天操| 国产精品社区| 五月婷婷色综图片| 色吊操色妞| 欧美色必爱| 欧美成人猛片AAAAAAA| 婷婷亚洲天堂| 午夜一区| 丁香六月综合激情| 99日韩| 中文字幕在线免费观看视频| 狠狠操综合| 婷婷六月丁| 99九九视频精彩在线| 五月丁香六月玩女人| 色婷婷五月天激情在线观看| 26UUU欧美| 99色亚洲| 五月婷婷中文字幕| 五月色色激情网| 午夜微拍福利| 久热精品免费视频4| 人操综合| 在线综合91| 丁香六月婷婷开心婷婷网| www,99色| 国内久久亭亭| 欧美大香蕉视频| 另类图片色五月| 久久99精品日本| 婷婷丁香激情综合色情| 97人人射| 少妇激情五月婷婷| 亚洲激情99| 色VA| 亚洲综合色五月| 开心激情播播五月天| 五月天激情丁香| 超碰爱爱爱| av在线资源| 99操视频| 超碰色热| 天堂网色婷婷| 无码A片一区二区免费| WWW色色色COm| 亚洲综合网区| 五月婷婷激情69| 六月婷婷激情小说网| 激情五月天激情五月天| 五月婷婷丁香综合| 精品无码久久久久久久久| 日曰躁夜夜躁2026| 夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂夂亚洲亚洲亚洲亚洲亚洲亚洲亚洲亚洲色 | 婷婷丁香色五月久久88| 99操逼| 五月丁香琪琪| 色色热| 91人人爱| 人人97碰| 丁香六月天婷婷色| 久久综合五月| 婷婷五月天激情小说| 亚洲综合五月天| 怡春院天天干| 日本99久久| 五月婷婷激情69| 思思久久青草热| 五月丁香激情四射| 少妇搡BBBB搡BBB搡毛茸茸| 最新久久99视频网站| 大香蕉520| 婷婷五月伦理| 91狠狠综合久久| 9视频在线成人网站| 国产精品色婷婷久久久精品| 婷婷五月成年人| 成人开心五月天| 开心五月激情网| 激情婷婷综合网| 亚洲第一色色色| 色色综合色| 六月婷婷中文字幕| 婷婷五月激情欧美大胆视频| 久久总和99| 婷婷激情五月综合基地| 婷婷操久久| 色五月婷婷成人| 9久久精品| 九九精品在线观看视频6| 思思99久久| 国产免费一区二区三州老师F1……| 91VIP在线观看| 五月天天天综合| 婷婷六月激情丁香| 91精品久久久久久综合五月天| 极品人妻VIDEOSSS人妻| 五月婷婷啪啪网| 影音先锋人妻出差| 影音先锋色婷婷| 五月激情综合网婷婷| 婷婷丁五月| 天天爽夜夜爽夜夜爽精| 色噜噜五月天| 丁香五月停停av| 都市激情蜜桃婷婷五月天| 五月天六月色| 中文字幕一色哟哟哟哟| 日韩人妻无码专区| 日韩AAAAAAAAAAA片| www.色五月| 99精品热视频只有精品10| 丁香六月婷婷五月婷婷| 狠狠久久婷五月综合色| 精品国产va久久久久| 大香线蕉伊人| 十二区无码| 精品综合久久久久久五月天| 99精品在这里| 婷婷五月花| 99 热| 97视频久久| 日本毛片内射| 啪到高潮激情丁香五月| 欧美日韩精品人妻狠狠躁免费视频| 九九热av| 五月婷婷激情性爱| 九九精品99久久久| 欧美成人网99网| 日韩人妻白浆视频系列| 亚洲avjiujiur91| 26UUU欧美| 久热成人| 激情五月天色网站| 一区二区免费看| 色婷婷AV久久久久久久| 99色视频| 26uuu欧美日韩| 丁香色色网| 91超级碰在线视频| 噜噜操操| 久久 婷婷 五月天| 中文AV在线播放| 天天操中文字幕| 91无码高清| www.婷婷,com| 色五月婷婷91| 黄色成人网站在线播放| 久久婷婷五月天激情四射| 超碰在线超碰| 色你久久| 99色在线视频| 五月天偷拍| 日本91在线| 久久99网| 五月婷婷高清| 极品少妇高潮啪啪AV无码| 一个色的综合| 91狠狠综合久久久| 婷婷五月成人| 五月丁香婷婷色| 五月丁香六月激情狠狠| 色色欧美色色| 五月天色网站| 欧美成综合在线观看| 五月天婷五月天综合网在线观| 99精品视频在线观看| 五月天激情婷婷五月天久久| 少妇被下春药玩弄A片| 欧美韩日AAA网站| 婷婷激情五月| 婷婷五日b| 嫩草免费视频| 人人播| 9人人操人人看| 丁香五月五月婷婷| 天天在线天天综合网色| 日本女色人人| 亚洲99精品欧美一区| 伊人激情网| 日韩 中文 欧美| 九九热视频精品2| 激情丁香九九五月综合网| 午夜丁香| 欧美黑人巨大性生话| 天插天啪天啪天啪| 五月深情久久| 99热| 激情五月天婷婷| av九九| 五月草影视| 欧美图片丁香五月天| 激情五月天在线视频| 久久狠狠欧美| 婷婷色五月大香蕉在线| 五五月丁香花激情综合网| va婷婷在线| 婷婷99视频在线| 99综合| 丁香婷婷久久| 91无码色色| 天天插天天射| 五月天开心婷婷久久| 天花AV无码| 婷婷六月色| 亚洲va在线| 99视频久久久| 婷婷综合五月| 五月丁查人人| 色情五月天小说| 成人免费超碰| 97资源碰碰| WWW.开心五月天.COM| 51成人| www日本熟妇99在线视频| 久99久在线观看| 天天操夜夜夜拍拍拍| 亚洲午夜一区二区| 黑人糟蹋人妻HD中文字幕| 婷婷五月天无码| 欧美在线骚货| 日本久碰| 国产精品涩涩涩视频网站| 精品人妻伦一二三区久| 秋霞电影一级黄| 丁香花婷婷五月天| 疯狂做受XXXX高潮A片| 九九综合色综合| 1995年关宝慧版蜘蛛女| 熟女激情网| 色婷婷五月综合激情中文字幕| 综合大香蕉| 99精品在线下载| 婷婷丁香社区网| 婷婷五月精品中文| 色婷婷电影网| 九九色大香蕉| 久热网在线视频| 五月天六月天| 91久久久久久久久18| www.99色在线| 这里只有精品视频在线| 五月丁香自拍| 亚美欧色影院| 狠狠操天天操综合| 另类亚洲2| 婷婷综合网性| 丁香五月婷婷影视先锋| 婷婷人人操| 丁香六月亭亭久久综合| 婷婷五六月丁香| 97色色婷婷| 日本丁香久在线| 婷婷狠狠香蕉综合| 97人妻超级碰碰碰碰碰| 狠狠五月天| 色99在线观看| 99视频在线| 中国激情网| 色丁香五月综合网| 国产99精品免费视频| 亚洲无码成人网| 97干视频| 亚洲婷婷基地| 91色碰| 色五月激情综合网站| 日韩av手机在线观看| 99九九精品| 任你爽精品免费视频6| 五月天伊人网| www.综合久久| 婷婷丁香五月天综合在线日韩| 精品夜夜澡人妻无码AV| 久久97| 免费无码毛片一区二区A片| 色综合激情| 综合五月丁香六月婷婷| 久久婷婷五月| 色99网| 婷婷色情六月| 天天操狠狠操| 欧洲亚洲激情五月天在线| 天天日夜夜爽。| 亚洲九九99精品视频在线播放| 五月色欧洲| 怡红院院在线导航网| 激情六月丁香综合| 五月天婷婷久色| 六月婷五月丁香| 亚洲精品五月| 夜夜操激情| 激情婷婷五月天日本系列| 天天免费日日夜夜夜夜| 五月婷婷啪啪网| 99视频只有这里精品| A久网| 日本婷婷色日| 日韩色色视频| 亚洲欧洲午夜成人精品av| 九九爱激情| 另类五月激情| 婷婷五月天电影网| 69久久99精品久久久久婷婷| 色99在线视频| 五月激情婷婷综合| 91操片| 色色射| 97人人草| av九九| 国产精品24r| 欧美婷婷九月| 91丨九色丨43老版熟女| 六月丁香五月激情亚洲AV| 激情 婷婷 插| 五月成人天| 六月婷婷啪啪| 久久五月天婷婷| 极品人妻VIDEOSSS人妻| 狠狠干.com| 日本黄色精品| 99操视频| 激情综合网,婷婷| 欧美综合激情五月天| 婷婷五月天激情电影| 思思热在线精品视频| 丁香五月婷婷综合啪啪| 日日噜噜久久婷婷五月天| 久综合色| 日本在线免费中文com.| 免费试看小视频 99| 噜噜色婷婷| 91久久久久久久久久久| 极品少妇高潮啪啪AV无码| 91精品刘玥| 永久免费视频| 六月综和久久| 五月花婷婷丁香| 9久精品视频| 色色激情五月天| 久久丁香九| 热99这里只是精品| 激情五月天婷婷视频| 日韩黄色电影| 国产肥白大熟妇BBBB视频| 69人人操人人爽| 五月天啪啪视频| 26uuu另类| 日本不卡中文字幕| 五月天丁香婷婷视频网址| 色婷婷色九月| 青青草婷婷综合五月| 色情五月婷| 国产在线网| 日韩一级网站| 成人婷婷五月| 99狠狠色| 男女啪啪做爰高潮无遮挡| 久Se视频在线观看| 六月婷婷色五月| 五月婷精品| 99热传媒| 五月婷婷与六月丁香图片激情| 人人草人人视| 亚州美女| 五月婷婷亚洲| 人人爱人人添| 人人操AV| 狠狠色噜噜狠狠狠狠狠色综合久久| 色婷婷导航| 狠狠五月激情丁香六月| 欧美经典片免费观看大全| 欧美人人女女精品综合五月天| 九九视频精品视频精品| 99精品久久久久久久婷婷| 69人人操人人爽| 色五月天中文字幕| 日韩性视频| 婷婷五月激情基地| 丁香五月天偷拍| 天天爱天天操| 五月天丁香久久综合| 丁香五月激情六月欧亚激情综合导航| 五月婷色啪| 久久99精品视频| 欧美啪啪9| 五月激情六月综合| 天天色视频| 丁香五月激情啪| 五月婷婷丁香狠狠撸久久| 大香蕉啪啪网| 五月天激情网图片| 99免费视频| 玖热精品综合视频| 99久久极情精品一区| 色色欧美色色| 99亚色色色| 成人欧美日韩| 人人看人人97| 97色色色色色| 91|疯狂丨高潮丨对白| 轮奸综合网| 九九热中文| 日本色色视频| 五月的婷婷六月丁香| 亚洲最大在线| 婷婷欧美激情| 玖热精品综合视频| 色色色99| www.99精品在线| 99无码黄色视频| 久9精品视频在线| 人人天堂操| 九九碰九九爱97超碰| 久久xxxx| 婷婷五月香蕉| 任你搞网站| 99在线免费视频| 色婷婷五月天成人网| 四色五月婷婷| 色婷婷91| 五月六月伦理| 99热超| 丁香五月婷婷影院| 九九99偷拍视频| 91久久婷婷人人澡草| 婷婷色五月91啪啪| 丁香五月亚洲无码| 五月天色五月| 丁香婷婷性爱| 婷婷天堂综合| 99热这里都是精品| 大香网伊人久久综合| 久婷| 九九热视频在线观看| 久久只有精| 国产精品18久久久| 五月天六月天| AA片在线观看视频在线播放| 天天操天天爽天天爱| 99噜噜噜在线播放| 五月天婷五月天综合网在线观| 婷婷六月色| 99热久久这里只有精品| 麻豆AV一区二区三区| 亚洲成人乱码av网站| 日本英国美国欧美亚洲国产精亚洲日韩精品在线观看 | 婷婷五月中文在线视频| 色 噜噜 九月 婷婷| 五月天综合视频网| 一起草av在线观看| 激情久久五月天| 色婷婷99| 国产又爽又猛又粗的视频A片| 婷婷五月丁香五月天| 婷婷9月天| 五月婷婷69| 五月丁香另类图片| 五月 激情视频| 天天摸天天舔在线视频| 亚洲亚洲人成综合网络| 婷婷娱乐丁香综合网| 91伦| 99色亚洲| www.无码com| 99亚洲视频| 丁香五月1页| 成人午夜视频精品一区| 五月天激情中文字幕| 五月深情久久| 99九九久久| www天天干| 欧美精品A片一区在线观看| WWW99热| 涩涩五月天综合| 日韩AV无码影片| 99日韩网站| 庭庭久久内射| 免费观看全黄做爰的视频| 五月婷婷开心综合| 综合久久五月天| 人妻丰满精品一区二区A片| http://www.sd-xiangsu.com/| 91vip在线观看| 免费无码毛片一区二区A片 | 国产午夜精品一区二区三区嫩草| 欧美日韩aaaa| www.久久久.com|