欧美成人午夜精品久久久,国产?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
返回資訊列表
天天日天天草| 亚洲熟妇AV乱码在线观看| 婷婷欧美色| 五月天婷婷基地| 青青草六月丁香| 99日在线观看视频| 精品久9| 超碰猛烈的性猛交| 五月婷婷婷婷网| 久热久| 色综合视频在线| 色色色婷婷五月天| 久色激情| 久久99网| 精品无吗va视频免费观看| 丁香五月综合久久八| 高清无码.com| 五月天伊人久久| 欧美在线干| 日韩久热| 五月婷婷六月丁香色| 五月婷婷五月丁香综合| 欧美性二区| 性爱网六月丁香| 成人精品视频99在线观看免费| 在线另类视频| 在线另类视频| 激情九月婷婷| 久久久激情视频| www,26uuu,c0m,色情| 开心婷婷五月激情网小说 | 婷婷久久综合久色| 激情久久综合网| 2050人人操免费工开爱| 精品一二三区视频立| 中文字幕,综合,91| 色呦呦在线| 中文字幕丰满孑伦无码专区| 99婷婷精品推荐在线视频| 日日夜夜天天综合| 激情五月婷婷丁香| 97色吧| 久久这里只有精品热在99| 视频一二区| 九九久热| 国产精品色婷婷AV综合色色| 亚洲看av的网站| 1024人妻| 新99色色色色色色| 99精品爱| 久久精99| WWW.久久99| 任你干aa| 超碰色综合| 四射综合网| 久久久久视剧HD| 中文成人在线| 色色综合院| 色婷婷啪啪综合网| 99riAV国产精品视频| 婷婷五月色花丁香社区| 激情綜合網址| 这里只有精品视频视频在线观看| 99视频久久免费视频| 精品久久99码| 日日干夜夜撸夜夜骑| 天天日人人| 色婷婷婷综合五月天| 丁香五月婷婷六月婷| 天天操夜夜啊| 天干夜夜操| 噜噜五月天综合| 久久这里有精品| 思思精品视频| 色吧五月| 光棍影院日韩精品| 天天操夜夜夜夜爽| 六月丁香五月天| 这里只有精品免费| 色色性爱视频| 日韩精品一曲二曲三曲四曲五曲| 99操视频| 久久色这里只有精品| 99久久6| 另类视频五月天| 99热在线精品播放| 琪琪色网在线| 大香蕉综合| 激情五月深爱五月| 六月 丁香 视频| 五月丁香婷婷久久| 五月婷婷黄色网址| 天天婷婷综合| 激情婷婷丁香| 色婷婷丁香女女| 免费观看2018www黄色操逼网站| 天天日夜夜曹| 日韩色色视频| 91嫩草久久| 爱射综合| 五月婷婷激情综合| 91亚洲视频| 国产三级片91| 色综色五月天婷婷| 九九热精品| 婷婷五月丁香五月| 六九色综合婷婷五月天| 中文字幕日产A片在线看| 婷婷狠狠爱| 亚洲成人网站在线播放| 日本成人小说婷婷六月| 9+1视频网址| 九九草草逼| 99爽视频| 综合一本道| 日韩成人中文字幕| 五月丁香激情综合网官网| 97人人操| 99久久激情视频| 超碰在线成人| 琪琪色五月天| 性生活久久朋友人妻| 日韩欧美一级大黄网站| 亚洲AV无码影院| 丁香五色月婷婷网| 91碰碰碰| 久久久久婷婷五月热综合| 婷婷五月天黄色小说| 色五月网址| 色婷婷久久综合久色综| 五月丁香成人小说| 久久宗合影| 日日夜夜综合| 丁香五月激情图片婷婷| 大伊久久| 秋霞九九无码| 丁香五月亚洲| 五月丁香久久婷| 夜夜天天久久婷婷| 亚洲精品久久久无码| 综合网色| 91狠狠综合久久| 狠狠插狠狠操| 久久综合香蕉国产国产蜜臀AV| 五月天成人在线视频丁香| 狠狠爱婷婷丁香| 丁香婷婷婷婷十二月在线观看视频| 国产99精品免费视频| 伊人婷婷大香蕉| 久久综合色五月| 天天色激情| 一本色道久久88加勒比| 婷婷五月色丁香在线看| 97超喷视频在线观看| 丁香婷婷五月天色综合| 五月天精品| 亚色网站小视频| 狠狠干夜夜干| 777久久综合视频| 天天爽天天日| AV国产有码| 成人国产欧美大片一区| 婷婷中文字暮| 色色色色色五月丁香| 99精品视频在线观看| 亚洲成人av在线观看| 天天日日夜夜爽。| 婷婷综合色| 九九色99| 天天做天天干天天综合网 | 日日日日日| 天天日日夜夜爽| 丁香六月激情| 五月激情久久综合网| 九月婷婷人人操人人舔人人爱| 99青青草| 日本三级日本三级99| 色色亚洲视频| 六月久久狠狠| 免费亚洲婷婷中文字幕| 精品久久穴| 五月色婷婷激情| 婷婷九月丁香中文| 色色色综合色| 99免费视频网| 天天插天天玩天天干| 91成人品| 国产精品人成A片一区二区| 色国产五月| www天堂99| 五月婷婷性| 国精产品一区二区三区| 九九成人| 国产成人综合在线| 丁香五月冃欧美| 97婷婷狠狠久久综合9色| 大香蕉网站,大香蕉综合| 五月天伊人av| 国产午夜精品一区二区| 日韩99无码| 中文字幕AV网址| 综合亚洲色色| 天天干天天操天天射| 五月天婷婷av| 激情五月丁香五月| 日韩成人综合网| 久9无码视频| 婷婷亚洲天堂| 热热色色五月天婷婷| 免费观看欧美成人AA片爱我多深 | 欧美激情2025| 狠狠爱婷婷爱| 在线成人va| 九九热99热| 91人人超碰在线| 99精品在线| 日本91在线| 北条麻妃九九九国产精品视频| 香蕉人在线香蕉人在线 | 狠狠狠婷婷五月综合| 丁香婷婷老司机久操| 色五月网址| 人妻久久久久久久久久久| 99激情网| 亚洲成人免费在线| 99久久www| 婷婷91视频| 超碰人妻在线| 丁香五月中文字幕| 九九性爱网| 丁香婷婷久久老熟女综合网| 国产伊人五月天| 色婷婷影| 中文字幕欧美久久| 伊人色五月| 97色 五月天丁香| 五月丁香六月婷婷啪啪| av大香蕉| 日韩视频99| AA久久| 五月婷婷综合潮喷| 99r这里| 色五月天中文字幕| 五月婷婷天天色| 色五月综合网| 天天艹天天综合网| 国产99美少妇| 蜜桃婷婷丁香五月天狠狠久久综合| 久久久久亚洲AV无码网影音先锋| 色情婷婷。| 丁香9月婷婷| 国产99久久久国产精品免费看| 天天天天天天操| 国产avapp 网| 久草天堂| 亚洲va综合va国产va中文| 人妻视频在线| 激情六月综合| www.婷婷六月天| 激情五月婷婷丁香| 99热这里只有精品8| 开心激情网五月天| 大地9中文在线观看免费高清| 欧美成人精品A片免费一区99| 天天天天天天操| 99久久6| 九九热九九| 久久99网站| 91热爆在线| 激情视频网址| 久久这里只有精品视频15| 激情涩播| 久久婷网| 九九综合精品| 丁香五月婷婷俺也要去| 91久久色| 色九九综合| 国产FREESEXVIDEOS性中国| 99ER热精品视频| 国产古装妇女野外A片 | 3p久久| 91久久综合亚洲噜噜成人在线| 亚洲成Av人片乱码色第1集| 色婷婷影| 日本色婷婷综合| 六月婷婷色五月| 五月色精品| 色五月婷婷影院| 色五月激情综合| 狠狠综合网| 成人电影一区| 五月婷天堂视频| 色九月欧美| 伊人青草成人| 六月婷婷中文字幕| 五月天社区| 中文字幕成人网站| 99色网站| 丁香婷婷激情网站| 99热6这里只有精品| 成人做爰A片免费看视频| 97在线视频 欧美| 婷婷久久五月天丁香| 激情久久四色| 深爱激情丁香| 丰满少妇猛烈A片免费看观看| j五月香在线| 日韩日比视频| 色丁香五月综合网| 色婷婷丁香五月| 五月激情婷婷偷拍| 2025中文在线视频字幕免费观看| 国产毛片操B| 精品无码久久久久久久久| 亚洲亚洲人成综合网络| 亚洲天堂制| 婷婷成人在线| 亚洲sesesese| 婷婷射图五月天| 丁香六月伊人| 色五月婷婷av| 欧美黄色一级录像| 久久激情天堂| 丁香六月 婷婷六月| 热热久久久久久久久| 综合图区激情| 丁香婷婷五月天激情四射| 五月婷婷,六月丁香| 99在线精品视频| 欧美69久成人做爰视频| 色99色| 9.1综合网| 婷婷丁香五月天色区| 色欲AV导航| 丁香五月激情网| 大香蕉人妻| 日日夜夜天天| 久久综合首页| 91视屏在线观看com.wwwvv| www.99热. com这里只有精品| 无人精品在线视频| 五月天丁香网| 国产无人区大片| 99热国产在| 九九热国产| 久久aaaa片一区二区| 99色综合| 国产六月婷婷| 欧美成人AAA片一区国产精品| 五月婷婷av| 欧美激情五月天| 色色草97| 五月丁香中文| 日韩高清久久| 日本久久婷| 五月天丁香久久| 天天摸天天舔天天天天爽| 欧美日本不卡黄色片| 色婷婷丁香AV综合| 久久五月婷婷综合网| 久久久er热| 婷婷五月天小说| 99久热在线精品| 色五月综合激情| 伊人色综合影院视频| 色色无码| 伊人久久五月天| 成人 在线 日韩| 婷婷无码视频| 婷婷在线视频| 五月婷婷花| 97luluse| 丁香综合婷婷五月天| 天天射色五月天| 婷婷五月六| 日韩欧美一道四区中文字幕| 午夜大香蕉| 丁香五月激情宗合网| www五月| se色99| 丰满少妇猛烈A片免费看观看| 九九热视频免费的| 噜噜狠狠色综合久| 99这里只有精品| 91人人操| 这里只有免费的精品| 高清无码视频网址| 天天综合网91| 成人丁香色| 另类国产欧美视频| 婷婷丁香人妻天天| 久久涩视频| 99热 免费| 久久精典| 久久九九爽| 天天色天天日天天舔| 天天干天天日蜜臀av| 婷婷丁香六月五月天| 日本女人久久| 六月婷婷啪啪| 性视频久久| 婷婷五月天丁香久久| 青草激情在线| 国产一级黄色影片,| 色五月婷婷少妇人妻| 涩五月婷婷| 99啪| 五月婷婷激情网| 成人丁香五月| 日日撸夜夜操| 六月丁香啪| 五月天成人小说| 91操片| 色婷婷五月在线| xxx.色婷婷| 热久免费视频9| 思思久久青草热| 爱久久小说下载网| 操射国产日本| 婷婷五月天偷拍| 97成人在线视频| 99九九精品| 亚洲激情精品| 这里只有视频精品| 97久久久久| 97干在线视频精品店| 婷婷九月丁香| 五月婷婷影院| 十月丁香九月婷婷综合| 婷丁香五月天| 草综合网| 婷婷六月色开| 色婷婷丁香九月| 91男同视频| 婷婷六月啪啪| 看全色黄大色大片| 日本色视| 国产婷婷五月天| 日韩色色小视频| 色综合狠狠色| 伊人玖玖综合| 久久九九囯产| 日本在线观看91| 久久久天堂国产精品女人| 99re这里| 九九这里都是精品| 五月天开心色情网| 九色无码| 五月天色不卡| 久久黄色片| 五月天婷婷影院影院| 秋霞黄色一级久久| 轮奸综合网| 99激情在线| 1区2区视频| 极品嫩草| 97人人操com| 大香蕉在九| 色五月情| 国产AV熟妇人震精品一品二区| 色五月天成人| 五月 成人 婷婷| 日本人妻A片成人免费看片| 丁香涩涩五月天| 九九无码| 襙逼网| www.99热精品| 欧美成人AAA片一区国产精品| 激情深爱五月| 丁香五月天在线观看视频| 五月丁香婷婷伊人| 97碰在线| 国产裸舞表演WWWW| 激情综合女人网五月播播| 超碰在线免费观看3 9| 五月婷在线| 日操| 国产精品成人AV在线| 欧美丰满熟妇BBB久久久| 五月丁香偷拍| 草婷婷在线| 五月天丁香成人| 日韩一区二区A片免费观看| 婷婷五月综合网| 天天狠天天狠| 成人丁香色| 狠狠色无码| 欧美熟妇一区二区三区| 丰满老熟妇BBBBB搡BBB| 9色视频在线| 婷婷五月天另类网站| 九热精品| 激情 婷婷| 日韩AV免费电影在线播放| 日本久热| 人人爱人人添| www,五月丁,com| 91婷婷丁香| 五月天激情日色在线| 亚洲中文字幕在线观看| 久久XX| 成人色五婷婷| 婷婷丁香人妻久久在线观看| 色五月丁香一区在线| 婷婷丁香宗合888| 99久久婷婷五月| 欧美婷婷综合网| 99re久久| 五月丁香六月合| 色婷綜合网| 综合久久99| 99在线精品观看99| 操操综合网婷婷| 丁香五月开心亚洲| 99色视频在线观看| 九九久久五月天| 99视频| 五月天婷婷久草丁香| 九九色婷婷| 一区二区三区四区无码| 久久99久久99久久99人受| 色吧婷婷五月亚洲| 色一情一乱一乱一区91| 99久久精品视频女神1| 久99久热| 操逼综合激情网| 99综合在线| 人妻操在线看| 成人丁香五月| 丁香六月婷婷| 婷婷情色五月天| 91视屏在线观看com.wwwvv| 色综合久久88色综合天天99| 婷婷在线播放| 婷婷综合网| 色色 亚洲| www.色婷婷.com| 熟美女麻豆| 热的国产,热的综合,热的有码| 色婷婷五月婷婷五月婷婷五月| 六月婷婷激情图片| 久热精品9999| ss99热| 久99久在线| 狠狠色婷| 岛国av电影网站| 五月色影院| 亚洲热久| 五月婷婷丁香瑟瑟视频| 嫩草AV久久伊人妇女超级A| 久热伊人9| 日韩激情人伦人| 久久女婷| 熟女网站久久| 人人摸人人澡人人| 91九九精品| 亚洲成人乱码av网站| 色激情综合| www.色色com| 久久九精品| 五月天婷婷基地| 91九色无码日韩| 婷婷五月天播播| 婷婷五月天99综合网站| 亚洲开心激情网| 开心激情综合| 伊人五月天综合网| 超碰99在线观看| www.jiujiujiu| 99热这里只有精品66| 精品热九九| 婷婷黄色五月天在线视频| 玖玖热视频| 99热超碰| 色婷婷基地| 91精品久久久久久| 婷婷五月成人| 亚洲国产精品五月天| 九月丁香婷婷| 丁香婷最新动态| 色啪影院| 五月丁香久久综合| 天天干,天天日| 人人色人人摸人人看| 久机视频这只有精品| 久月婷婷| 26uuu欧美| 丁香激情合作五月| 九月丁香婷婷基地| 久久这里只有精品8| 9 1大香蕉| 久久婷婷五月免费视频| 亚洲视频图片婷婷五月| 伊人五月婷| 伊人丁香花综合影院| 日99网站| 狠狠狠狠狠狠狠狠| 国产白丝在线一区| 五月丁香网站| 五月婷婷免费视频| 午夜日日| 婷婷色色五月| 热99只有精品| 99在线视频女女视频| 日本色图综合| 婷婷五月天伦理| 艹B高清无码| 五月丁香六月婷婷视频| 91超碰九色| 五月天激情国产综合婷婷| 26uuu国产色| 99热热热天天人人人超超碰| 色五月五月婷婷| 久久久久久欧美精品se一二三四| 少妇高潮呻吟A片免费看软件 | 凹凸探花电影| 爱iii做iiii日日| 丁香五月激情综合| 成人婷婷五月天| 婷婷综合玖玖五月| 色噜噜狠狠色综无码久久合欧美| 五月综合六月婷婷| 人人97碰| 丁香婷婷综合影院| 五月开心久久| 99免费视频精品| 亚洲午夜一区二区| 精品国产乱码久久久久夜深人妻| a久久| 五月丁香亭亭成人电影| 好色婷婷| 丁香五月天久久| 色哟哟精品| 天天成人丁香美女AV| 9有码中文| 亚洲精品V天堂中文字幕| 偷拍91九色| 《》【无码】想被搞到爽AV应募而来的超M素人 西纯子 10musume-011723-01 | 99re视频精品| 天天日日人| 91热久| 激情五月婷婷五月| 五月天激情综合网| 久久99久久99精品免观看软件 | 射婷婷中文字幕| 狠狠综合网| 99热精品一| 操碰97| 丁香五月婷婷Av| 欧美槡BBBB槡BBB少妇| 婷婷五月天成人| 婷婷丁香五月天中文字幕| 婷婷激情中文综合| 六月婷久久| 超级碰碰99| 少妇性按摩无码中文A片| 婷婷丁香花五月天| 欧美Va日本Va| av性爱网站| 综合色色婷婷| 蜜桃婷婷狠狠久久综合| 欧美情色一区| 五月天激情网站| 日韩AAAAA| 久综合| 激情五月婷婷综合| 国语精品探花| 色 五月婷婷基地| 婷婷舔| a色色色色色| 97资源碰碰| 久久WW| 99 福利 导航| 99视频在线观看网址| 香港九九六区八区99| 香蕉AV777XXX色综合一区| 99热这里是精品| 色色免费网站| 无码操B| 九九色综合| 亚洲激情五月| 婷婷五月av| 性爱久久| 综合天堂AV久久久久久久| 性做久久久久久久免费看| 婷婷五月天社区| 亚洲第一综合| 成人无码精品1区2区3区免费看| 99热18| 欧美精品99久久久| 日逼AV影音先锋男人资源站| 99re欧美精品| 免费观看全黄做爰的视频 | 色玖玖综合网| 国产日比| 国产精品久久久爽爽爽麻豆色哟哟| 久操热| 超PEN精品在线| 久久久久久久久久久久久久久久一道本| 黃色三级三级三级三级 qixing300.shrkbk.com www.jinbozs.com tianmiaosw.com | 天天成人综合| 久热中文字幕在线线观看| 日日日天天干| 日本女人久久| 九九aV| 777米奇影视第四色| 1024操逼| 丁香婷婷浪潮AV久久综合| 六月丁香啪| 97丁香五月| 色综合网上班开心婷婷久久| 韩国情人在线电视剧免费观看高清版全集 | 婷婷色五月在线视频| 五月天丁香久久| 99热思思| 99九九这里有免费视频| 最新日韩久热免费视频看看| 九月丁香| 天天综合亚洲| 99A片| 超91热| 亚洲婷婷久久综合| 久久久er热| 最新丁香六月婷婷| 久久女婷| 久久五月丁香综合| www.久久爱.c n| 色色日韩网| 亚洲色欲AAAAAA| 精品久久这里热66| 五月色网| 99热99思午夜精品| 九九色色| 婷婷基地爱| 婷婷99狠狠| 久99久视频精品| 亚洲人人艹| 色久在| 国产日韩欧美| 国产精品久久久爽爽爽麻豆色哟哟| 色射7856五月天激情四射| 综合视频久久| 婷婷亚洲五月丁香综合在线| 91视屏在线观看com.wwwvv| 丁香五月成人网| 婷婷五月av| 色都都狠狠色都都色综合色| 五月婷婷激情综合在线| 人人操五月天| 大地资源色婷婷视频在线 | 思思热久久阴99| 天天综合五月天| 九九无码AV| 婷婷开心深爱五月天| 色五月婷婷影院| 婷婷伊人綜合中文字幕| 91精品91久久久中77777久久玖玖九九| 亚洲一区先锋影音| 亚洲人妻av| 99色.com| 五月婷婷综合潮喷| 玖玖在线视频| 性色婷婷| 在线视频99| 久久九九热re6这里有精品| 五月丁香久久综合| 狠狠色婷婷777| 91丨九色熟女丨首页| 五月开心婷婷| 国产AV一区二区三区最新精品| 久久婷五月婷| 91天天操天天干天天射| 1024操逼视频| 婷婷久久精品| 天久久久久| 丁香五月视频在线观看| 色情五月婷婷| 五月丁香免费视频| 激情四射婷婷| 五月婷婷七月丁香| 天天噜噜| 天天艹| 欧美成人精品一区二区| www.97视频| 怡红院院在线导航网 | 超碰99资源站| www.黄色片-久久成人国产精品在线播放-999AV | 2050人人操免费工开爱 | 婷婷伊人五月丁香天堂网| 99热无码首页| 日韩无码亚欧无码| 亭亭五月天黑人2014| 国产黄大片在线观看画质优化| 五月丁香婷婷在线综合蜜桃| 久久草大香蕉| 婷婷久久国产视频| 国产又色又爽又黄又免费| 十月丁香婷婷| 俺也去五月婷婷丁| 天天狠狠色噜噜| 久热在线中文字幕色999舞| 五月丁香六月色情网欧美| 国产精产国品一二三在观看| 天干干夜夜操| 大地9中文在线观看免费高清| 综合性视频99| 日韩欧美成人网| 丁香婷婷六月男男| 99九九在线精品热动漫| 天天爽夜爽| 激情五月天综合图片小说网站| 超PEN精品在线| 婷婷丁香综合成人| 看全色黄大色大片| 九九久久综合| 婷婷夜夜夜夜| 色色色9 9 9| 天天日综合| 日韩色色网| 亚洲精品成人| 婷婷六月久久综合导航| enecarbon-materials.comWu染请涟系Bao护@wip1688 | 日本一级| 色丁香五月婷婷| 亚洲欧美婷婷五月色综合| 亚洲超碰在线| 丁香5月婷婷| 久婷婷五月综合欧美| 在线不卡视频| 激情综合激情五月| 欧美久久久久久久久中文字幕| 激情五月婷黄版| 98毛片| 婷婷丁香五月综合久久| 人人人操| 97超碰9久热婷婷热| www.狠狠| 99色爱| 色色色色色色色色五月先| 色噜噜婷婷| 深爱激情丁香五月| www.超碰| 色综合色色色色色色综合| 大香蕉婷婷色| 5月丁香六月情| 五月婷婷偷拍| http:色情日本com| 14色综合婷婷| 五月丁香成人| 91人妻人人操人人爽| 丰满人妻妇伦又伦精品国产| 少妇性按摩无码中文A片| 五月天婷婷激情干干| 婷婷综合影院| 午夜伊人大香蕉| 色婷婷在线播放| 色五月首页| 99噜噜噜在线播放| 五月丁香久久呀| 99热热热99精品丁香| 色情综合| 五月花在线观看视频| 丁香婷婷人妻综合网| 一起草无码| 香蕉久日夜| 99热这里是精品| 久久丁香五月天| 五月丁香婷婷婷婷综合网| 五月久熟女| 国产女生爱爱AA| 天天做天天爱| 婷婷五月天综合网| 丁香婷婷影院| 激情九九综合网| 欧美天天爽| 91久久综合亚洲噜噜成人在线| 久色激情| 丁香婷婷久久| 伊人激情综合网| 亚洲天天操| 五月婷婷丁香狠狠撸久久| 五月天婷婷一起草| 99综合色色色| 九九九九毛片| 99热青青草| 色yeye色综合| 91九色在线观看免费| 99天堂在线观看免费视频| 这里有精品| 色色性爱视频| 婷婷激情五月| 亚洲AV成人片无码网站| 久久精品99久久久久久| 五月天六月色| 久久精热| 青青草成人网| 婷婷色片| 超碰人人99| 色婷婷综合亚洲| 激情六月婷婷| 天堂五月婷婷| 五月天狠狠色| 五月色色色| 色噜噜婷婷| 婷婷激情丁五月| 99热这里有精品2| 六月丁香婷婷尤物| 人人草人人爱手机视频看看| 色色色色色色综合| 欧美丁香五月| 狠狠做深爱婷婷久久综合一区| www.久久av.com| 国产综合网在线| 激情五月天开心总和网| 五月婷婷丁香在线| 国产精品色婷婷AV综合色色| 十月色综合| 色色色热| 变态另类9| 五月天开心网| 人妻丰满精品一区二区A片| 婷婷五月天桃花网| 婷婷五月激情小说| 激情文学第四色婷婷丁香五月| 久久草中文日韩欧美| 女人露出p毛视频www网站| 91狠狠综合网| 国产乱码久久| 丁香五月冃欧美| 丁香婷婷五月| 九九伊人网| 97五月天| 午夜av网| 久99热| 五月丁香六月婷婷不卡免费无码| 久久婷婷五月丁香| 欧美丁香婷婷五月天| 婷婷娌伦网| 五月丁香花视频| 色色网站| 九九久久玖玖爱| 免费国产视频| 超黄亚洲瑟瑟网站| 去干网最新版本亚洲版| 婷婷色五月在线视频| 亚洲AV网站| 成人午夜天| 婷婷五月天综合AV| 婷婷五月天在线看| 99热这里只有精品免费观看| jizzdr| www激情| 色婷婷丁香AV综合| 九九色色网| hd五月婷婷在线| 久久久久久人妻| 精品一二三区久久AAA片| 色婷婷狠狠禁久久| 91欧美日韩综合| 五月色丁香国产在线视频| 狠狠色成人影片| www.夜夜操| 91久女| 五月色网| 激情伊人五月天| 五月天丁香网| 六月丁香停| 第四色色六月色综合| 婷婷丁香五月亚洲免费| 在线另类| 99草在线免费观看视频| 丁香五月大香蕉| 丁香五月亚综合图片| 日本高清久久| 丁香五月婷婷天堂大香蕉| 99在线看片| 五月丁香激情啪啪| 69精品人人人人人人| 综合视频五月| 大香蕉人妻| 亚洲精品成人片在线播| 5月丁香综合网| 六月丁香婷| www.99精品日操伊人乱碰在线| 婷婷亚洲综合| 亚洲色vA| 亚洲综合婷婷| 91日本在线| 色五婷婷开心缴| 日本精品人妻无码77777| 99这里有精品视频| 免费在线观看欧美激情xx小视频| 国产成人一区二区三区在线观看| 99久在线精品99re8热| 久久人妻久久| 色欧美一级| 激情婷婷五月女| 九九色色网| 亚洲视频国产一区| 婷婷精品性视频| 热99.com婷婷| RenRenSe在线视频网站| 婷婷开心激情| 中文无码婷婷| 97碰碰视频| 极品另类| 婷婷欧美激情| 丁香婷婷综合影院| 五月天色婷婷网| 国产免费性爱| 久久网思思| 粉嫩AV久久一区二区三区| 六月丁香花婷婷| 婷婷五月成人| 激情婷婷色色| 色色色综合网| 综合啪啪| 99热自拍| www九九热| 五月丁香久久| 婷婷成人综合| 丁香五月播播| 丁香五月婷婷色| 欧美色婷婷| 色综合色婷婷色伊人| 夜夜骑夜夜操| 欧美激情Va| 日韩无码成人电影| 九九热这里都是精品6| 婷婷97狠狠成人网站| 天天草天天爱| 3p九色在线| 中文字幕婷婷五月天在线观看| 97luluse| 色99在线| 五月丁香久久呀| 成人AV在线网站| 天天综合情| www.色五月| 视色综合| 亚洲成人中文字幕| 六月丁丁香| 另类图片激情五月| 久久99久久99精品免视看婷婷| 久久久久亚洲A∨成人乱码电影| 久久婷婷视频| 噜噜噜色噜噜| 伦乱人妻| 国产亚洲色婷婷久久99精品91| 91久久精品无码一区二区三区| 亚洲第一第二网站| 婷婷丁香五月激情图片| 中文AV网站| 91视频一起草| 99热只有精品综合| 最近中文字幕2019视频1| 亚洲欧美另类在线23p| 五月婷婷精品| 色综合婷婷| 色五月婷婷婷婷| 在线成人av播放| 91碰碰| 色丁香婷婷美女视频网站| 9 1大香蕉| 东京热免费视频| 天天操天天日天天爽| 久热re在线视频| 99精色| 天天天日天天天干| Www99热| 精品爱欲五| 色五月丁香婷婷久草| site:xmssd.com| 日韩成人电泉AV| 天天日天天草| 成人精品一区二区三区四区五区| 色五月激情问网站| 99热这里是精品| 99热日韩| 婷婷五月天视| 色久一| 最近中文字幕大全免费版在线 | 五月婷婷婷婷| 久婷婷五月丁香在线观看| 91色碰| 亚洲色五月| 热久久这里只有精品| 久久欧洲久久| 超碰高清在线| 嫩草AV久久伊人妇女超级A| 色99在线观看| 欧洲亚洲欧洲99久久| 色婷婷五月综合在线| 91精品激情9| 一本色道久久综合狠狠躁小说| 一级操逼内射在线视频| 97亚洲色 torrent magnet| 丁香五月大香蕉在线99| www狠狠| 丁香五月天论坛| 九九热只有这里精品| 国产亚洲色婷婷久久99精品91 www.riverspirits.org www.hnnun.com www.changh | 色综合天天网| 国产激情av| 九九热99久久99| 7777国产盗摄农村女人| 丝袜大香蕉| 五月丁六月香| 先锋资源996| 狠狠爱综合| 成人在线高清| 欧美性爱丁香五月| 婷婷激情综合| 丁香婷婷月| 开心五月丁香啪| 色5在线| 国产成人高清| 日本人妻久久| 级人人91| 成熟妇人A片免费看网站| 久久婷五月| 99热资源在线| 天天干天干| 99在线观看视频| 久热这里只有精品视频6| 婷婷偷拍网| 天天操天天日天天爱| 婷婷久久性爱| 99日视频在线| 欧美操综合| 1769在线观看欧美国产| 婷婷丁香无码专区| 久久五月婷婷综合网| 国产精品男人AV不卡| 丁香 婷婷 亚洲 熟女| 色yeye欧美| 色九九综合色| 五月婷A V在线| 黑人糟蹋人妻HD中文字幕| 亚洲情欲| 伊人久久婷婷| 综合色色婷婷| 色99日韩| 丁香六月综合激情| 男女99免费视频| 操射国产日本| ,99视频久久| 五月婷婷综合网在线播放| 色婷婷影视| 色五月天.con| 婷婷五月天激情综合| 五月色无码| 九九视频精品在线免费| 亚洲激情免费视频| 婷婷丁香五月色| 狠狠干在线| 久操人妻| 久久久中文| 嫩草AV久久伊人妇女超级A| 在线理论片| 天天久久婷婷| 综合www色| 开心五月婷婷婷美女| 91九色熟女| 亚洲激情AV| 成人深爱丁香五月| 丁香激激情网| 丁香五月天激情视频| 99爱视频| 看片视频在线免费日产在线看| 99综合免费视频| 嫩草极品| 壅壅儕家a| 玖玖色资源| 天堂AV三级| www 五月天 com| 天天色综网| 中文字幕成人| 成人无码髙潮喷水A片| 亚洲精品**不卡在线播he| 亚洲精品视频电影| 色之综合网| 五月丁香六月情亚洲| 99精品超在线播放| 久久婷婷国产| 饮料下药迷倒漂亮女同事强干| 久久人妻视频| 人人超碰99| 久9久9久9久9久9久9| 五月天激情站| 色色网站| 五月婷在线观看| 丰满少妇猛烈A片免费看观看| 久久区区一二三av| 婷婷6月综合网| 狠狠干 狠狠操| 婷婷五月,偷窥偷拍网| 国产精品美女久久久久AV超清| 99九九这里有免费视频| 婷婷天堂视频| 人妻系列久久久久久久久久久| 亚洲经典小视频| PORNY九色9l自拍视频成人| 被强行糟蹋的女人A片| 亚洲狠9| 91久久久久久久久18| 第一区久久网站| 精品人妻一区二区| 五月婷婷深深爱| 日日做A爰片久久毛片A片英语| 色开心五月婷婷丁香HD| 91九九| 久久这里有精品99| 超碰免费成人| 99干免费视频| 激情五月天婷婷免费观看| 色偷偷色婷婷| 五月激情综合网| 9久国产精品| 久草五月天| 人妻丰满精品一区二区A片| 激情婷婷九月| 色999;丁香五月| 色婷婷99| 99在线免费视频| 天天xxxxxx天天日| 亚洲人妻av伦理| 综合久久影院| 婷婷五月天开心激情网| 久久在线视频免费观看| 激情AV在线| 天天天天爽爽天干| 国产欧美熟妇另类久久久 | 天天久| 欧美成人精品A片免费一区99| 五月丁香啪啪网| 成人丁香| 亭亭丁香97| 九九热99精品在线| 91超碰人人操| 婷婷久久综| 色五月综合在线| 丁香五月婷婷综合激情哟哟哟| 九月婷婷综合八月丁香在线观看| 日本在线视频播放91| 色婷小说| 可以直接看的AV网站| http:色情日本com| 丁香婷婷久久| 99久久久免费| 婷婷五月综合色拍| 五月天伊人综合| 99热精品网| 丁香五月婷婷视频| 综合五月激情| 婷婷丁香五月欧美人| 午夜少妇在线观看视频| 五月丁香怕啪啪| 国产免费AV在线| 大香蕉狼人久久| 色婷婷视频在线| 中文字幕五月久久婷婷| 五月婷婷久| 九九色黄色| 激情丁香六月| 五月丁香毛片|