簡(jiǎn)介ICM20948資料(手冊(cè)代碼demo).rar 是一份面向運(yùn)動(dòng)追蹤、姿態(tài)控制與機(jī)器人導(dǎo)航開(kāi)發(fā)者的完整資料包。內(nèi)容圍繞 InvenSense ICM20948 九軸慣性測(cè)量單元展開(kāi)除加速度計(jì)、陀螺儀外還集成磁力計(jì)、氣壓計(jì)與溫度傳感器包含官方 datasheet、MEMS 器件處理與裝配指南、EVB 原理圖等技術(shù)文檔以及官網(wǎng) demo 與 Arduino 示例庫(kù)覆蓋從硬件規(guī)格、通信協(xié)議到軟件驅(qū)動(dòng)的全鏈路。壓縮包共 19 個(gè)文件類(lèi)型以 PDF 技術(shù)手冊(cè)、ZIP 官方工程包和 Arduino 庫(kù)源碼為主另有 .ino/.h/.cpp 程序文件與 .properties 庫(kù)描述文件整體約 48.94MB結(jié)構(gòu)清晰便于按需取用。目前已有 1878 人學(xué)習(xí)適合從入門(mén)到進(jìn)階的嵌入式開(kāi)發(fā)者。通過(guò)閱讀數(shù)據(jù)手冊(cè)可掌握量程、精度、I2C/SPI 接口、引腳定義與功耗管理官方 demo 演示了初始化、數(shù)據(jù)讀取、校準(zhǔn)及卡爾曼或互補(bǔ)濾波融合流程Arduino 代碼則提供 begin()、readAccel() 等簡(jiǎn)易 API方便快速搭建原型并調(diào)試姿態(tài)數(shù)據(jù)適用于無(wú)人機(jī)、機(jī)器人、VR/AR 等場(chǎng)景。 做IMU開(kāi)發(fā)這么多年下載過(guò)、解壓過(guò)、最后又默默關(guān)掉的技術(shù)資料包兩只手?jǐn)?shù)不過(guò)來(lái)?！癐CM20948資料(手冊(cè)代碼demo).rar”就是其中很有代表性的一個(gè)。這包東西看起來(lái)體量不算大但里頭拆開(kāi)是三塊一份上百頁(yè)的英文手冊(cè)一套封裝得很厚的官方驅(qū)動(dòng)源碼再加一兩個(gè)demo工程。作為一直在用MPU6050的老用戶(hù)我當(dāng)時(shí)以為可以像以前一樣倉(cāng)庫(kù)里找找現(xiàn)成驅(qū)動(dòng)、改改I2C地址、跑個(gè)串口就能看到數(shù)據(jù)了。結(jié)果頭兩天基本就是對(duì)著datasheet來(lái)回翻頁(yè)demo編譯也是報(bào)錯(cuò)疊報(bào)錯(cuò)。這顆TDK InvenSense的九軸IMU集成了三軸加速度計(jì)、三軸陀螺儀和三軸磁力計(jì)AK09916還內(nèi)置DMP數(shù)字運(yùn)動(dòng)處理器規(guī)格上比MPU6050高了不止一檔。但它最坑人的地方在于寄存器重新做了bank分組I2C從機(jī)地址雖然還是0x68/0x69但外設(shè)結(jié)構(gòu)變了磁力計(jì)還掛在芯片內(nèi)部的一個(gè)獨(dú)立I2C通道上。如果誰(shuí)以為“MPU6050驅(qū)動(dòng)改改就能跑”那基本都會(huì)翻車(chē)。這篇文章我就從自己折騰這套資料包的實(shí)際經(jīng)驗(yàn)出發(fā)講講怎么把壓縮包里的東西變成真正能用的數(shù)據(jù)流以及那些手冊(cè)里沒(méi)寫(xiě)透、只有調(diào)過(guò)才知道的坑。1. 從壓縮包到第一幀有效數(shù)據(jù)資料包結(jié)構(gòu)和datasheet閱讀路線拿到這個(gè)rar先別急著雙擊demo工程然后按F7編譯。我第一天的教訓(xùn)就是太性急結(jié)果報(bào)錯(cuò)信息根本看不懂因?yàn)閴焊恢肋@個(gè)demo依賴(lài)哪些文件。其實(shí)官方資料包的邏輯很清晰就三層手冊(cè)層、驅(qū)動(dòng)層、應(yīng)用層。手冊(cè)層就是那份PDF重點(diǎn)不是從頭讀到尾而是先鎖定三個(gè)部分。第一是引腳定義確認(rèn)你的板子上I2C接哪幾個(gè)腳、AD0有沒(méi)有拉高、INT中斷腳是幾號(hào)。第二是Register MapICM20948的寄存器是按Bank 0到Bank 3分組管理的和MPU6050那種平鋪式寄存器完全不一樣這個(gè)建議把REGISTER MAP那幾頁(yè)單獨(dú)打印出來(lái)。第三是上電時(shí)序和I2C時(shí)序圖很多人忽略這部分導(dǎo)致上電后直接讀寄存器讀到全零。這份手冊(cè)本身不難讀難在結(jié)構(gòu)它把加速度計(jì)配置放在Bank 2陀螺儀配置放在Bank 1FIFO和中斷又回到Bank 0來(lái)回翻頁(yè)很痛苦所以我建議自己整理一張寄存器速查表。驅(qū)動(dòng)層是官方封裝的傳感器驅(qū)動(dòng)代碼通常包括寄存器定義、I2C/SPI讀寫(xiě)函數(shù)、以及高層的開(kāi)啟傳感器和讀取數(shù)據(jù)接口。官方代碼的抽象層級(jí)比較多但最核心的就是底層那個(gè)I2C或SPI讀寫(xiě)函數(shù)移植的時(shí)候只需要把這個(gè)函數(shù)和你自己的硬件抽象層對(duì)接。demo工程則是給某個(gè)特定平臺(tái)比如STM32或Arduino準(zhǔn)備的示例主要價(jià)值是演示初始化順序和數(shù)據(jù)讀取流程別指望能直接燒進(jìn)你的板子。資料包里的demo基本都遵循同一個(gè)邏輯先初始化I2C然后復(fù)位芯片等待芯片穩(wěn)定讀取WHO_AM_I確認(rèn)通信正常再配置電源管理、量程、采樣率最后循環(huán)讀取加速度、角速度和溫度。我建議拿到手的第一步不是跑通DMP也不是讀磁力計(jì)而是先跑通最基礎(chǔ)的“WHO_AM_I 加速度 陀螺儀”這一條鏈路。WHO_AM_I讀出來(lái)是0xEA這條鏈路通了說(shuō)明I2C時(shí)序、地址、寄存器bank切換都正常了后面的工作才有意義。2. 三板斧解決MPU6050老用戶(hù)遷移時(shí)的“寄存器陷阱”如果你和我一樣是從MPU6050遷過(guò)來(lái)的最大的敵人不是芯片本身而是腦子里的固有經(jīng)驗(yàn)。ICM20948在寄存器層面至少有三個(gè)地方和MPU6050完全不同踩中任何一個(gè)都會(huì)浪費(fèi)時(shí)間。第一個(gè)是bank切換機(jī)制。MPU6050所有寄存器都在一個(gè)平面里直接傳寄存器地址就能讀寫(xiě)。ICM20948把寄存器分成了4個(gè)Bank訪問(wèn)目標(biāo)寄存器前必須先往0x7F這個(gè)Bank選擇寄存器寫(xiě)入對(duì)應(yīng)的Bank編號(hào)。比如你上電后想配置陀螺儀量程得先把Bank切到1再操作陀螺儀配置寄存器想配置加速度計(jì)量程就得切到Bank 2想配中斷、電源管理和FIFO又得切回Bank 0。很多老用戶(hù)尤其是從上位機(jī)轉(zhuǎn)過(guò)來(lái)的第一次讀寄存器時(shí)沒(méi)切Bank讀回來(lái)全是0或者0xFF還以為芯片是壞的。這個(gè)問(wèn)題的排查方法也簡(jiǎn)單先讀WHO_AM_I確認(rèn)芯片活著再逐項(xiàng)檢查是不是每次切換寄存器組之前都正確設(shè)置了0x7F。第二個(gè)是電源管理和復(fù)位邏輯。ICM20948上電后默認(rèn)處于睡眠模式你得通過(guò)電源管理寄存器清除SLEEP位芯片才開(kāi)始正常工作。復(fù)位操作也有講究要先置位DEVICE_RESET位然后等待一段時(shí)間這段時(shí)間至少給100ms然后再去配置其他寄存器。我遇到過(guò)一種情況復(fù)位置位后沒(méi)有等待足夠時(shí)間馬上就去配置傳感器結(jié)果配置寫(xiě)進(jìn)去了但芯片狀態(tài)異常輸出全是固定值。這種問(wèn)題datasheet里其實(shí)寫(xiě)了時(shí)序參數(shù)但demo代碼里通常用delay函數(shù)處理移植的時(shí)候容易忽略。第三個(gè)也是最容易忽略的就是磁力計(jì)AK09916的訪問(wèn)方式。ICM20948內(nèi)部的加速度計(jì)和陀螺儀是直接掛在主I2C總線上的但磁力計(jì)AK09916是通過(guò)芯片內(nèi)部的一個(gè)輔助I2C接口I2C Master掛在里面的。這意味著你要讀磁力計(jì)數(shù)據(jù)不是直接通過(guò)0x0C這個(gè)地址去讀當(dāng)然你可以把AK09916單獨(dú)引線出來(lái)接到MCU上但很多模塊并沒(méi)把引腳引出來(lái)而是需要配置ICM20948內(nèi)部的I2C Master接口讓芯片去幫你讀磁力計(jì)然后把數(shù)據(jù)放到ICM20948的某個(gè)寄存器段里你再?gòu)腎CM20948的寄存器里把磁力計(jì)數(shù)據(jù)取出來(lái)。這個(gè)過(guò)程比MPU6050時(shí)代要繞得多很多demo程序里專(zhuān)門(mén)寫(xiě)了一大段配置I2C Slave地址、數(shù)據(jù)寄存器地址的代碼看著頭疼但邏輯上就是這樣。如果忽略這三個(gè)“寄存器陷阱”你大概率會(huì)在同一個(gè)問(wèn)題上卡好幾天明明I2C通信正常WHO_AM_I也對(duì)但加速度計(jì)和陀螺儀數(shù)據(jù)就是不動(dòng)或者磁力計(jì)永遠(yuǎn)讀不出有效值。說(shuō)白了ICM20948不是MPU6050的簡(jiǎn)單升級(jí)它是重新設(shè)計(jì)的系統(tǒng)遷移的時(shí)候建議把所有寄存器相關(guān)邏輯全部重寫(xiě)千萬(wàn)不要在舊驅(qū)動(dòng)上打補(bǔ)丁。3. 官方demo庫(kù)初始化鏈路拆解別跳過(guò)任何一步把資料包里的能用的東西理順之后我從自己的調(diào)試經(jīng)驗(yàn)出發(fā)把官方demo的初始化流程拆解了一遍整理出一個(gè)可靠的順序照著走基本能跑通。先是一段基礎(chǔ)的初始化流程偽代碼方便對(duì)照// 1. 初始化I2C/SPI硬件 icm20948_platform_init(); // 2. 復(fù)位設(shè)備: 寫(xiě)寄存器0x06 (PWR_MGMT_1) 的 bit7 1 icm20948_write_reg(0x06, 0x80); delay_ms(100); // 3. 驗(yàn)證通信: WHO_AM_I 應(yīng)返回 0xEA uint8_t who icm20948_read_reg(REG_WHO_AM_I); if (who ! 0xEA) { error_handler(); } // 4. 喚醒并配置時(shí)鐘源: 寄存器0x06 清除sleep位 icm20948_write_reg(0x06, 0x01); // 自動(dòng)選擇最佳可用時(shí)鐘源 // 5. 配置陀螺儀: 切Bank 1 設(shè)置量程和采樣率 icm20948_set_gyro_fsr(FULL_SCALE_500DPS); icm20948_set_gyro_sample_rate(100); // 6. 配置加速度計(jì): 切Bank 2 設(shè)置量程和采樣率 icm20948_set_accel_fsr(FULL_SCALE_4G); icm20948_set_accel_sample_rate(100); // 7. 配置低通濾波(DLPF) icm20948_set_gyro_dlpf(BANDWIDTH_50HZ); icm20948_set_accel_dlpf(BANDWIDTH_50HZ); // 8. 循環(huán)讀取 while (1) { int16_t accel[3], gyro[3], temp; icm20948_read_accel_raw(accel); icm20948_read_gyro_raw(gyro); icm20948_read_temp_raw(temp); // 轉(zhuǎn)換成物理量: 加速度除以對(duì)應(yīng)靈敏度角速度除以對(duì)應(yīng)靈敏度 delay_ms(10); }這段流程看著簡(jiǎn)單但有幾個(gè)細(xì)節(jié)必須在移植時(shí)注意。先說(shuō)是復(fù)位等待。芯片執(zhí)行軟復(fù)位后內(nèi)部邏輯需要時(shí)間重新初始化等待不足會(huì)出現(xiàn)一種很隱蔽的現(xiàn)象第一次讀WHO_AM_I能成功但繼續(xù)配置量程和采樣率時(shí)寫(xiě)入操作沒(méi)生效。這不算通信錯(cuò)誤而是芯片還在復(fù)位狀態(tài)中。官方驅(qū)動(dòng)里的等待時(shí)長(zhǎng)通常是幾十到幾百毫秒我參考的這個(gè)示例代碼給的100ms實(shí)測(cè)穩(wěn)一點(diǎn)。再說(shuō)寄存器Bank切換。官方驅(qū)動(dòng)里封裝了類(lèi)似set_bank的函數(shù)但容易忽略的是切換Bank是一個(gè)“非原子”操作。舉個(gè)例子你配置陀螺儀時(shí)切到Bank 1寫(xiě)完寄存器后如果下一個(gè)操作是讀取加速度計(jì)數(shù)據(jù)你忘了切回Bank 2讀回來(lái)的數(shù)據(jù)就是錯(cuò)的。正確做法是讓封裝層能感知當(dāng)前Bank狀態(tài)每次讀寫(xiě)寄存器時(shí)都先確保Bank正確。我自己習(xí)慣在每個(gè)功能函數(shù)開(kāi)頭都調(diào)用一次bank_select雖然多了一點(diǎn)I2C開(kāi)銷(xiāo)但排障時(shí)能少很多痛苦。還有低通濾波配置的位置。ICM20948的陀螺儀和加速度計(jì)低通濾波器配置在各自的Bank里不像MPU6050是單獨(dú)的一個(gè)寄存器。采樣率和濾波帶寬需要搭配著用假如你采樣率設(shè)到1000Hz但低通設(shè)到10Hz大量高頻信號(hào)被濾掉數(shù)據(jù)響應(yīng)就會(huì)遲滯動(dòng)態(tài)場(chǎng)景下會(huì)覺(jué)得“傳感器跟不上手”。反之采樣率很低但濾波帶寬很高就等于沒(méi)濾波噪聲反而更大。demo里給的默認(rèn)值不一定適合你的應(yīng)用這個(gè)后面會(huì)細(xì)說(shuō)。資料包里還有一個(gè)經(jīng)常被忽略的東西I2C讀函數(shù)里那個(gè)“repeated start”機(jī)制。不少M(fèi)CU的HAL庫(kù)在連續(xù)讀多個(gè)字節(jié)時(shí)如果中間沒(méi)處理好start/stop信號(hào)會(huì)導(dǎo)致器件內(nèi)部寄存器地址指針漂移。這個(gè)問(wèn)題在MPU6050時(shí)代就存在ICM20948也一樣。移植時(shí)如果發(fā)現(xiàn)讀出來(lái)的數(shù)據(jù)順序總是錯(cuò)亂比如X軸跑到Y(jié)軸位置就去查一下I2C讀取時(shí)序里有沒(méi)有正確使用restart而不是每次讀字節(jié)之間都發(fā)送stop再重新start。當(dāng)初始化鏈路全部走對(duì)你會(huì)在靜止?fàn)顟B(tài)下看到加速度計(jì)的X/Y軸接近0Z軸接近1g即讀數(shù)約為8192對(duì)應(yīng)±4g量程陀螺儀各軸接近0溫度值在合理區(qū)間。到這個(gè)狀態(tài)基本鏈路就算通了可以進(jìn)入下一步。4. DMP輸出的四元數(shù)只是半成品磁力計(jì)融合沒(méi)人替你完成ICM20948內(nèi)置DMP數(shù)字運(yùn)動(dòng)處理器這是它相比MPU6050最吸引人的地方。很多人以為DMP就是“芯片內(nèi)部直接輸出姿態(tài)角主控躺著收數(shù)據(jù)”實(shí)際用下來(lái)會(huì)發(fā)現(xiàn)事情沒(méi)那么簡(jiǎn)單。DMP確實(shí)能在芯片內(nèi)部完成姿態(tài)解算輸出四元數(shù)主控不需要再跑Mahony或者M(jìn)adgwick算法這能省下不少算力和代碼復(fù)雜度。但I(xiàn)CM20948的DMP默認(rèn)融合的是六軸數(shù)據(jù)也就是加速度計(jì)和陀螺儀。磁力計(jì)AK09916的數(shù)據(jù)在DMP內(nèi)部并不會(huì)被自動(dòng)用于航向修正。也就是說(shuō)如果你直接拿DMP輸出的四元數(shù)轉(zhuǎn)成歐拉角短時(shí)間內(nèi)看Yaw還能用時(shí)間一長(zhǎng)就會(huì)慢慢漂移因?yàn)橥勇輧x的零偏和溫度變化一直在累積誤差而磁力計(jì)沒(méi)參與進(jìn)來(lái)把這個(gè)漂移拉回去。要解決Yaw漂移有兩個(gè)選擇。一是完全不用DMP在MCU端自己寫(xiě)九軸融合算法把加速度計(jì)、陀螺儀、磁力計(jì)都納入Mahony或Madgwick的融合框架實(shí)時(shí)補(bǔ)償。二是繼續(xù)用DMP輸出四元數(shù)但磁力計(jì)數(shù)據(jù)自己?jiǎn)为?dú)讀出來(lái)然后利用磁力計(jì)求出的磁航向和DMP輸出的Yaw做一個(gè)角度互補(bǔ)加權(quán)。這樣能保證DMP的低延遲優(yōu)勢(shì)同時(shí)又讓Yaw不會(huì)一直漂。很多開(kāi)源飛控項(xiàng)目實(shí)際也是這么干的不是全部依賴(lài)某一端。DMP初始化的順序也比普通模式更嚴(yán)格需要先加載DMP固件鏡像再啟動(dòng)DMP數(shù)據(jù)流而且啟動(dòng)之后FIFO行為和數(shù)據(jù)輸出頻率都會(huì)由DMP接管之前手動(dòng)配置的采樣率、濾波帶寬可能會(huì)被DMP覆蓋。我用這套demo調(diào)試時(shí)一開(kāi)始按普通模式把采樣率配好再去啟動(dòng)DMP結(jié)果發(fā)現(xiàn)輸出間隔完全不對(duì)后來(lái)才意識(shí)到DMP有自己的定時(shí)配置得從庫(kù)的配置接口里設(shè)置不能只改普通寄存器。還要注意DMP和低功耗模式的關(guān)系。ICM20948的低功耗設(shè)計(jì)本來(lái)很誘人但如果你啟用了DMP進(jìn)入睡眠模式或者低功耗模式的限制就比較多即便切回去了DMP需要重新初始化而不是簡(jiǎn)單寫(xiě)一個(gè)寄存器就能恢復(fù)。所以產(chǎn)品規(guī)劃時(shí)要想清楚到底是用DMP做姿態(tài)輸出還是用普通模式自己做融合不要在兩者之間來(lái)回橫跳。如果你只是做一個(gè)靜態(tài)姿態(tài)讀取的儀表DMP是省心的選擇但如果你要做帶航向功能的機(jī)器人、需要長(zhǎng)期穩(wěn)定的四元數(shù)DMP輸出只能當(dāng)半成品磁力計(jì)融合這條重要邏輯得自己補(bǔ)上。這個(gè)認(rèn)知直接決定你后續(xù)的代碼架構(gòu)。5. 零偏校準(zhǔn)、量程和濾波讓數(shù)據(jù)真正能用的最后幾公里跑通數(shù)據(jù)鏈路只是開(kāi)始真正讓數(shù)據(jù)達(dá)到可用狀態(tài)還需要處理三個(gè)問(wèn)題量程選對(duì)、零偏校準(zhǔn)、噪聲抑制。三個(gè)問(wèn)題按順序處理順序反了會(huì)多走彎路。量程選擇直接影響分辨率。ICM20948加速度計(jì)有±2g、±4g、±8g、±16g四檔陀螺儀有±250、±500、±1000、±2000dps四檔。ADC是16位量程越大每單位物理量對(duì)應(yīng)的LSB數(shù)越小分辨率越低。以加速度計(jì)為例±2g時(shí)靈敏度約16384 LSB/g±16g時(shí)就只有2048 LSB/g。不是所有場(chǎng)景都該選最大量程靜態(tài)傾角測(cè)量選±2g或±4g更合適而無(wú)人機(jī)這類(lèi)可能做大幅動(dòng)作的設(shè)備如果量程太小數(shù)據(jù)會(huì)削頂就必須選±8g以上。陀螺儀同理一般手持姿態(tài)設(shè)備±500dps夠用快速旋轉(zhuǎn)的設(shè)備就得±2000dps。選量程的原則是在不超過(guò)滿(mǎn)量程的前提下盡量選小量程換取分辨率。然后是零偏校準(zhǔn)。陀螺儀的零偏問(wèn)題是長(zhǎng)期穩(wěn)定性的大敵靜止時(shí)陀螺儀輸出不是絕對(duì)的0會(huì)有一個(gè)偏移量。校準(zhǔn)方法很簡(jiǎn)單設(shè)備靜止水平放置采集幾百個(gè)樣本取平均值作為零偏運(yùn)行時(shí)把原始讀數(shù)減去這個(gè)平均值。但有幾個(gè)細(xì)節(jié)要注意。第一剛上電的幾分鐘內(nèi)芯片溫度會(huì)上升陀螺儀零偏會(huì)隨著溫度變化所以最好等熱機(jī)穩(wěn)定后再校準(zhǔn)。第二校準(zhǔn)時(shí)的姿態(tài)要覆蓋實(shí)際使用中最常見(jiàn)的姿態(tài)不能校準(zhǔn)時(shí)是水平放在桌上使用時(shí)是垂直裝在設(shè)備上兩者零偏會(huì)有差異。加速度計(jì)的零偏校準(zhǔn)也可以類(lèi)似做靜止時(shí)Z軸讀數(shù)應(yīng)接近1g如果偏差明顯就需要做六面校準(zhǔn)但大部分應(yīng)用不做也能湊合。磁力計(jì)校準(zhǔn)也要做。AK09916本身是霍爾傳感器容易受周?chē)F磁性物質(zhì)影響裸板校準(zhǔn)和裝進(jìn)外殼以后校準(zhǔn)的結(jié)果都不一樣所以要在最終裝配狀態(tài)下校準(zhǔn)。簡(jiǎn)單做法是繞X/Y/Z軸各旋轉(zhuǎn)幾圈記錄每個(gè)軸的最大最小值然后計(jì)算偏移量offset (max min) / 2scale (max - min) / 2之后按(raw - offset) / scale歸一化。更精確一點(diǎn)用橢球擬合但絕大多數(shù)場(chǎng)景用剛才這組公式已經(jīng)夠用了。濾波處理放在校準(zhǔn)之后。校準(zhǔn)解決的是確定性誤差濾波解決的是隨機(jī)噪聲。ICM20948本身的噪聲控制比MPU6050好不少如果只是顯示姿態(tài)、做緩動(dòng)交互直接讀原始數(shù)據(jù)就夠不一定要加濾波。如果程序里確實(shí)需要平滑優(yōu)先用一階低通濾波代碼也很短float alpha 0.2f; // 越小越平滑但延遲越大 filtered_value alpha * raw_value (1.0f - alpha) * filtered_value;alpha的取值要根據(jù)場(chǎng)景調(diào)。動(dòng)態(tài)響應(yīng)要求高的場(chǎng)景alpha可以大一點(diǎn)比如0.5靜態(tài)傾角測(cè)量alpha設(shè)小到0.05都不過(guò)分。但要注意濾波會(huì)帶來(lái)延遲假如你在做需要快速響應(yīng)的控制濾波太重會(huì)讓系統(tǒng)明顯“遲鈍”甚至引起振蕩。我見(jiàn)過(guò)有人把a(bǔ)lpha設(shè)成0.1用在無(wú)人機(jī)上結(jié)果飛起來(lái)姿態(tài)滯后嚴(yán)重怎么調(diào)PID都不穩(wěn)最后才發(fā)現(xiàn)是濾波延遲的問(wèn)題。另外ICM20948的加速度計(jì)和陀螺儀低通濾波帶寬也要結(jié)合采樣率設(shè)置如果你需要100Hz的輸出低通帶寬設(shè)到50Hz左右比較合理如果采樣率只有50Hz低通還設(shè)到50Hz就沒(méi)有濾波效果了。datasheet和demo庫(kù)里面都有帶DLPF配置的組合表按照推薦配置來(lái)選就行別自己拍腦袋配一個(gè)奇怪組合。最后還有一個(gè)小經(jīng)驗(yàn)調(diào)試時(shí)把原始數(shù)據(jù)、校準(zhǔn)后數(shù)據(jù)、濾波后數(shù)據(jù)分別通過(guò)串口打印出來(lái)對(duì)比一眼就能看出是哪個(gè)環(huán)節(jié)出了問(wèn)題。我自己調(diào)試時(shí)發(fā)現(xiàn)加速度原始數(shù)據(jù)里有一個(gè)規(guī)律的抖動(dòng)后來(lái)確認(rèn)是電源紋波的影響給模塊的VDD多加一個(gè)100nF電容就基本消除了。數(shù)據(jù)好看了后面做姿態(tài)融合、運(yùn)動(dòng)識(shí)別都會(huì)順暢很多。本文還有配套的精品資源點(diǎn)擊獲取