1. 項目緣起為什么選擇FreeRTOS來做平衡小車如果你玩過或者聽說過平衡小車大概率知道它最核心的挑戰(zhàn)就是“平衡”二字。一個直立的兩輪小車本質(zhì)上是一個倒立擺系統(tǒng)它天生就是不穩(wěn)定的需要不斷地檢測自身的傾斜角度然后通過驅(qū)動輪子前后移動來“追”著重心從而維持直立。這個過程對控制系統(tǒng)的實時性要求極高。傳統(tǒng)的裸機編程用一個main函數(shù)里的while(1)大循環(huán)配合定時器中斷來處理傳感器數(shù)據(jù)、執(zhí)行控制算法、驅(qū)動電機在簡單任務時還能應付。但當你需要同時處理MPU6050的I2C數(shù)據(jù)讀取、編碼器脈沖計數(shù)、PID控制計算、藍牙串口通信、遙控指令解析甚至還想加個OLED屏幕顯示狀態(tài)時整個程序就會變得異常復雜中斷嵌套、時序沖突、邏輯耦合等問題會接踵而至代碼的可維護性和擴展性會急劇下降。這時候一個實時操作系統(tǒng)RTOS的價值就凸顯出來了。FreeRTOS作為一款輕量級、開源、在嵌入式領(lǐng)域應用最廣泛的RTOS它能把你的復雜任務拆分成多個獨立的“線程”在FreeRTOS里叫任務每個任務只關(guān)心自己的邏輯。比如一個任務專門以100Hz的頻率讀取MPU6050數(shù)據(jù)并做濾波另一個任務以50Hz的頻率執(zhí)行姿態(tài)解算和PID控制再有一個任務負責處理串口接收到的遙控指令。FreeRTOS的內(nèi)核會負責這些任務的調(diào)度、同步和通信讓你從繁瑣的時序管理中解放出來更專注于每個功能模塊本身的實現(xiàn)。所以基于STM32和FreeRTOS來做平衡小車不僅僅是為了“炫技”或者“堆砌技術(shù)棧”它是一個非常契合實際需求的工程實踐。它能讓你深刻理解多任務并發(fā)、實時調(diào)度、任務間通信隊列、信號量等核心概念而這些正是現(xiàn)代復雜嵌入式系統(tǒng)的基石。這個項目做完你對嵌入式系統(tǒng)的理解會從“單片機編程”躍升到“嵌入式軟件架構(gòu)”的層面。2. 硬件平臺搭建與核心器件選型做平衡小車硬件是骨架。選型不當軟件再精巧也無力回天。這里我們基于性價比和易用性給出一個經(jīng)典的方案。2.1 主控芯片STM32F103C8T6核心板為什么是它STM32F103C8T6江湖人稱“藍橋杯”或“最小系統(tǒng)板”價格低廉通常十幾塊錢資源對于平衡小車來說綽綽有余。它基于ARM Cortex-M3內(nèi)核主頻72MHz擁有64KB Flash和20KB RAM。運行FreeRTOS和基本的控制算法完全夠用。更重要的是它的資料和社區(qū)支持是STM32系列里最豐富的幾乎你遇到的任何問題都能在網(wǎng)上找到答案。注意購買時建議選擇帶USB轉(zhuǎn)串口芯片如CH340的核心板這樣只需要一根USB線就能完成供電、程序下載和串口調(diào)試非常方便。2.2 姿態(tài)傳感器MPU6050平衡小車的“眼睛”和“耳朵”。MPU6050是一個集成了3軸陀螺儀和3軸加速度計的六軸運動處理傳感器。陀螺儀測量角速度可以積分得到角度但存在漂移加速度計在靜止時可以通過重力分量解算出姿態(tài)角但運動時會有嚴重干擾。我們需要通過一種算法通常是互補濾波或卡爾曼濾波將兩者的數(shù)據(jù)融合得到一個相對穩(wěn)定、準確的傾角值。這是整個平衡控制的基礎。MPU6050通過I2C接口與STM32通信。市面上模塊很多建議選擇帶電平轉(zhuǎn)換通常模塊輸出3.3V和備用電池座用于保持DMP數(shù)據(jù)的版本。2.3 電機與驅(qū)動TT減速電機 TB6612FNG電機常用的是N20減速電機或普通的TT馬達黃色齒輪電機。TT電機價格便宜扭力尚可但轉(zhuǎn)速和一致性一般。對于學習項目完全足夠。如果追求更好性能可以考慮帶編碼器的直流減速電機這樣可以直接獲得速度反饋實現(xiàn)更精準的速度控制。驅(qū)動芯片TB6612FNG是驅(qū)動直流電機的明星芯片它比傳統(tǒng)的L298N效率更高、發(fā)熱更小、體積也更小巧。一片TB6612可以驅(qū)動兩個電機支持PWM調(diào)速和正反轉(zhuǎn)控制正好滿足我們兩個輪子的需求。2.4 電源管理18650鋰電池與降壓模塊小車需要移動必須使用電池供電。常見的方案是兩節(jié)18650鋰電池串聯(lián)約7.4V-8.4V。這個電壓不能直接給STM32核心板3.3V/5V和MPU60503.3V供電所以需要降壓模塊。電機供電電池電壓7.4V直接供給TB6612的VM引腳用于驅(qū)動電機?？刂葡到y(tǒng)供電電池電壓先經(jīng)過一個降壓模塊如LM2596降到5V這個5V給STM32核心板的5V引腳供電同時也可以給TB6612的VCC引腳邏輯供電供電。STM32核心板上的LDO會再將5V轉(zhuǎn)為3.3V供自身和MPU6050使用。實操心得電源是關(guān)鍵務必確保電機大電流和控制部分小電流的電源是分開的或者在電源入口處并聯(lián)一個大電容如470uF-1000uF來緩沖電機啟停造成的電壓波動。很多情況下小車無法穩(wěn)定不是代碼問題而是電源被電機拉垮了導致單片機復位或傳感器數(shù)據(jù)異常。2.5 車架與結(jié)構(gòu)可以購買現(xiàn)成的亞克力或鋁合金平衡小車套件車架也可以自己用洞洞板或3D打印制作。核心要求是重心要高于輪軸。這是倒立擺能立起來的前提。通常會把電池放在車體的最上方來抬高重心。完整的硬件連接清單如下模塊與STM32的連接引腳說明MPU6050SDA - PB7, SCL - PB6I2C1接口需接上拉電阻模塊通常已集成TB6612 (左電機)PWMA - PA8, AIN1 - PB12, AIN2 - PB13PA8用于PWM調(diào)速PB12/PB13控制方向TB6612 (右電機)PWMB - PA9, BIN1 - PB14, BIN2 - PB15PA9用于PWM調(diào)速PB14/PB15控制方向TB6612STBY - PC13使能引腳高電平有效可直接接VCC或MCU IO編碼器 (如有)左A相 - PA0, 左B相 - PA1使用定時器編碼器接口模式右A相 - PA6, 右B相 - PA7使用定時器編碼器接口模式串口1 (調(diào)試)PA9(TX) - USB轉(zhuǎn)串口RX, PA10(RX) - USB轉(zhuǎn)串口TX用于printf打印調(diào)試信息藍牙模塊 (可選)PA2(TX) - 藍牙RX, PA3(RX) - 藍牙TX串口2用于無線遙控3. FreeRTOS在STM32上的移植與基礎任務設計有了硬件接下來就是讓FreeRTOS在STM32上跑起來并設計好我們的任務骨架。3.1 工程創(chuàng)建與FreeRTOS移植現(xiàn)在最省事的方法不是手動移植而是使用STM32CubeMX工具。CubeMX可以圖形化配置引腳、時鐘、外設并一鍵集成FreeRTOS中間件。新建工程選擇MCU型號為STM32F103C8Tx。配置時鐘樹將HCLK設置為72MHz最大。配置外設I2C1: 用于MPU6050模式為I2C速度標準模式100kHz即可。TIM1 和 TIM8 (或 TIM3, TIM4): 配置為PWM Generation CH1/CH2用于驅(qū)動兩個電機。預分頻和周期值需要計算目標是產(chǎn)生一個頻率在10kHz-20kHz左右的PWM聽不到電機嘯叫為宜。USART1: 異步模式波特率115200用于調(diào)試。USART2: 異步模式波特率9600或115200用于連接藍牙模塊可選。如果使用編碼器TIM2和TIM3: 配置為Encoder Mode用于讀取編碼器脈沖。啟用FreeRTOS在Middleware選項卡中選擇FREERTOS接口選擇CMSIS_V2這是ARM為RTOS定義的通用接口標準更規(guī)范。在Configuration選項卡里可以設置內(nèi)核參數(shù)比如TOTAL_HEAP_SIZE: 堆大小設為1024 * 10即10KB對于我們的任務足夠。USE_PREEMPTION: 啟用搶占式調(diào)度。生成代碼點擊生成代碼選擇MDK-ARMKeil或IDE。CubeMX會自動生成包含F(xiàn)reeRTOS的完整工程以及所有外設的HAL庫初始化代碼。3.2 設計核心任務與優(yōu)先級在freertos.c文件或你自己創(chuàng)建的應用任務文件中我們創(chuàng)建幾個核心任務。任務優(yōu)先級數(shù)字越大優(yōu)先級越高在FreeRTOS默認配置下。姿態(tài)解算任務 (Task_IMU)優(yōu)先級最高例如osPriorityHigh。因為傾角數(shù)據(jù)是所有控制的基礎必須及時更新。功能以固定的頻率如100Hz讀取MPU6050的原始數(shù)據(jù)進行校準、濾波如互補濾波計算出當前小車的俯仰角Pitch和角速度。實現(xiàn)關(guān)鍵這個任務必須嚴格定時。我們可以使用vTaskDelayUntil()這個API來實現(xiàn)精確的周期執(zhí)行而不是簡單的vTaskDelay()。平衡控制任務 (Task_Balance)優(yōu)先級高僅次于IMU任務。功能以稍低的頻率如50Hz執(zhí)行。從IMU任務獲取最新的角度和角速度結(jié)合編碼器得到的速度如果有時進行直立環(huán)PD控制和速度環(huán)PI控制的串級PID計算最終輸出兩個電機的PWM控制量。任務間通信如何從IMU任務獲取數(shù)據(jù)這里就需要用到FreeRTOS的隊列Queue。IMU任務每計算完一次姿態(tài)就將數(shù)據(jù)一個結(jié)構(gòu)體包含角度、角速度等發(fā)送到隊列。平衡控制任務則阻塞在這個隊列上一旦有新數(shù)據(jù)到來就立刻取出進行計算。這保證了控制任務拿到的是最新數(shù)據(jù)且不會空跑。速度測量任務 (Task_Encoder)優(yōu)先級中。功能如果使用了編碼器這個任務負責定時如20Hz讀取定時器編碼器模式下的計數(shù)器值通過計算差值得到輪子速度脈沖數(shù)/時間。然后將速度值通過另一個隊列發(fā)送給平衡控制任務。注意讀取編碼器計數(shù)器是個“快照”操作可以在中斷中完成但速度計算和發(fā)送隊列放在任務中更安全避免在中斷中執(zhí)行過長的操作。通信任務 (Task_Comm)優(yōu)先級低。功能處理串口數(shù)據(jù)。例如解析藍牙APP發(fā)來的遙控指令前進、后退、轉(zhuǎn)向并將這些指令轉(zhuǎn)化為目標速度或轉(zhuǎn)向差速通過隊列或全局變量需注意互斥傳遞給平衡控制任務。同時也可以將小車當前的狀態(tài)角度、速度、PWM輸出等打包發(fā)回給上位機進行調(diào)試顯示。任務間通信關(guān)系圖文字描述[MPU6050] --I2C-- [Task_IMU] --(隊列:姿態(tài)數(shù)據(jù))-- [Task_Balance] [編碼器] --定時器中斷-- [Task_Encoder] --(隊列:速度數(shù)據(jù))-- [Task_Balance] [藍牙串口] --USART中斷-- [Task_Comm] --(隊列:遙控指令)-- [Task_Balance] [Task_Balance] --PWM輸出-- [TB6612] -- [電機]4. 核心算法實現(xiàn)從傳感器融合到PID控制這是平衡小車的“大腦”部分決定了它能否站穩(wěn)、走好。4.1 MPU6050數(shù)據(jù)讀取與校準首先你需要一個MPU6050的驅(qū)動庫能通過I2C讀取其寄存器中的原始數(shù)據(jù)加速度計AD值、陀螺儀AD值。在開始前必須進行校準。將小車靜止水平放置連續(xù)讀取數(shù)百個加速度計和陀螺儀樣本分別求平均值這些平均值就是零偏Offset。在后續(xù)讀取中每個原始值都要減去對應的零偏。// 示例讀取加速度計原始值簡化 HAL_I2C_Mem_Read(hi2c1, MPU6050_ADDR, ACCEL_XOUT_H_REG, 1, buffer, 6, 100); raw_accel_x (buffer[0] 8) | buffer[1]; accel_x (raw_accel_x - accel_offset_x) / ACCEL_SCALE; // 轉(zhuǎn)換為重力加速度g4.2 互補濾波算法這是融合加速度計和陀螺儀數(shù)據(jù)得到穩(wěn)定傾角的關(guān)鍵。原理很簡單利用加速度計在長期靜態(tài)下的準確性來修正陀螺儀積分產(chǎn)生的漂移。// 一階互補濾波偽代碼 float a 0.98; // 互補濾波系數(shù)通常0.98左右可調(diào) float dt 0.01; // 采樣周期對應100Hz即0.01秒 void ComplementaryFilter(float accel_angle, float gyro_rate) { static float angle 0; // 陀螺儀積分得到角度預測 angle a * (angle gyro_rate * dt) (1 - a) * accel_angle; return angle; }accel_angle由加速度計數(shù)據(jù)atan2(accel_y, accel_z)計算出的角度小車前后傾斜時主要看Y軸和Z軸。gyro_rate陀螺儀Y軸讀取的角速度值已減去零偏。系數(shù)a決定了你更相信誰。a越大相信陀螺儀動態(tài)響應好但會漂移a越小相信加速度計靜態(tài)準但動態(tài)干擾大。需要根據(jù)實際小車抖動情況調(diào)整。4.3 串級PID控制平衡小車通常采用兩個PID環(huán)內(nèi)環(huán)是直立環(huán)快速響應外環(huán)是速度環(huán)消除靜差。直立環(huán)PD控制輸入當前融合后的角度angle和目標角度通常就是0度直立狀態(tài)。輸出一個用于維持直立的基本電機出力balance_out。公式balance_out Kp1 * (angle - target_angle) Kd1 * gyro_rate;為什么用PD不用PID因為角度環(huán)本身是一個“位置”環(huán)積分項I容易引入滯后和超調(diào)在快速反應的直立控制中反而不好通常只用比例P和微分D。微分項直接用了陀螺儀的角速度這相當于對角度進行了“超前矯正”能有效抑制小車倒下。速度環(huán)PI控制輸入當前編碼器測得的速度speed和目標速度來自遙控指令靜止時為0。輸出一個用于調(diào)節(jié)速度的補償量speed_out。公式speed_out Kp2 * (target_speed - speed) Ki2 * speed_integral;作用如果小車因為地面輕微傾斜或電機差異導致在直立平衡時有一個緩慢的移動趨勢速度環(huán)會檢測到這個非零的速度并通過積分項I累積一個輸出去抵消這個趨勢讓小車最終能穩(wěn)定在原地。速度環(huán)的輸出是疊加在直立環(huán)輸出上的。轉(zhuǎn)向環(huán)單獨P控制輸入目標轉(zhuǎn)向差速來自遙控和當前轉(zhuǎn)向速率可以通過左右輪速差估算。輸出一個給左右輪附加的差動PWM值turn_out。最終輸出left_motor_pwm balance_out speed_out - turn_out; right_motor_pwm balance_out speed_out turn_out;注意要對left_motor_pwm和right_motor_pwm進行限幅不能超過PWM計數(shù)值范圍。PID調(diào)參順序非常重要先調(diào)直立環(huán)將速度環(huán)和轉(zhuǎn)向環(huán)的輸出置零。用手扶住小車給它一個傾斜角度觀察輪子反應方向是否正確應該往倒下的方向轉(zhuǎn)動。先調(diào)Kp1讓小車能有明顯的回正力度再調(diào)Kd1抑制小車回正過程中的抖動。目標是松手后小車能在原地小幅度高頻“抽搐”而不倒下。再調(diào)速度環(huán)直立環(huán)調(diào)好后加入速度環(huán)。將Kp2和Ki2從很小的值開始增加。你會發(fā)現(xiàn)小車變得更“穩(wěn)”了高頻抽搐減少能更長時間站立。但Ki2太大會引起低頻前后搖擺需要耐心微調(diào)。最后調(diào)轉(zhuǎn)向環(huán)這個相對簡單確保轉(zhuǎn)向控制方向正確比例系數(shù)不要太大導致轉(zhuǎn)彎過猛即可。5. 系統(tǒng)整合、調(diào)試與避坑指南將所有的硬件、FreeRTOS任務、算法整合在一起才是真正的挑戰(zhàn)。5.1 系統(tǒng)初始化流程在main.c的main()函數(shù)中合理的初始化順序是int main(void) { HAL_Init(); // HAL庫初始化 SystemClock_Config(); // 配置系統(tǒng)時鐘 MX_GPIO_Init(); // 初始化GPIO MX_USART1_UART_Init(); // 初始化調(diào)試串口 MX_I2C1_Init(); // 初始化I2C MX_TIM1_Init(); // 初始化PWM定時器 // ... 其他外設初始化 printf(System Init OK!\r\n); // 確認串口通信正常 MX_FREERTOS_Init(); // **FreeRTOS初始化創(chuàng)建任務** osKernelStart(); // **啟動FreeRTOS內(nèi)核調(diào)度** while (1) { // 這里不會執(zhí)行到因為調(diào)度器已經(jīng)接管 } }關(guān)鍵點所有外設硬件初始化必須在osKernelStart()之前完成。任務創(chuàng)建在MX_FREERTOS_Init()中完成。5.2 調(diào)試方法與工具串口打印大法好在關(guān)鍵任務中使用printf通過串口1打印變量值角度、角速度、PID輸出、電機PWM等。注意在FreeRTOS任務中頻繁打印會影響實時性最好能通過一個條件如按鍵觸發(fā)來開啟/關(guān)閉調(diào)試輸出或者將數(shù)據(jù)打包后由低優(yōu)先級的通信任務統(tǒng)一發(fā)送。邏輯分析儀/示波器如果條件允許用邏輯分析儀抓取PWM波形和電機驅(qū)動IO的變化可以直觀看到控制輸出的頻率和占空比變化對于排查電機驅(qū)動問題非常有效。上位機曲線顯示這是最高效的調(diào)試方式。你可以編寫一個簡單的上位機如用Python的PyQt5或Matplotlib讓STM32通過串口定時發(fā)送一組數(shù)據(jù)時間戳、角度、速度、PWM等上位機實時繪制成曲線。這樣你能清晰地看到PID調(diào)節(jié)過程中系統(tǒng)的響應比如超調(diào)量、震蕩頻率、穩(wěn)態(tài)誤差等。5.3 常見問題與避坑指南問題一小車一上電就“瘋轉(zhuǎn)”或朝一個方向猛沖。排查電機接線檢查TB6612的AIN1/AIN2和BIN1/BIN2是否接反或者PWM輸入線是否接觸不良?？梢杂靡粋€簡單的測試程序固定輸出一個方向的PWM看電機轉(zhuǎn)向是否正確。角度極性這是最常見的原因MPU6050安裝的方向?qū)е掠嬎愠龅慕嵌日撎柵cPID控制期望的相反。例如小車前傾時角度為負但你的PID控制邏輯可能期望為正。檢查互補濾波輸出的角度用手向前傾斜小車看串口打印的角度值是正是負其變化方向是否與你的控制邏輯匹配。不匹配就在角度或陀螺儀數(shù)據(jù)前加個負號。PID參數(shù)極性確保直立環(huán)的Kp1符號正確。如果角度為正前傾電機應該向前轉(zhuǎn)使小車前進以“追”上重心這個輸出應該是正還是負取決于你的電機驅(qū)動邏輯即PWM值增大是正轉(zhuǎn)還是反轉(zhuǎn)。問題二小車能站住但高頻劇烈抖動。原因直立環(huán)微分項Kd1太小或者比例項Kp1太大。微分項是抑制抖動的關(guān)鍵嘗試增大Kd1。同時過高的Kp1會讓系統(tǒng)過于“敏感”。也可能是電源問題電機快速正反轉(zhuǎn)導致電源電壓劇烈波動影響單片機穩(wěn)定工作。務必在電源輸入端并聯(lián)大電容。問題三小車站幾秒后就緩慢地向一個方向跑走無法靜止。原因速度環(huán)沒有起作用或者參數(shù)不對。這說明直立環(huán)讓小車平衡了但存在一個微小的靜差比如地面不平、電機細微差異導致平衡點不是一個零速度點。檢查速度環(huán)編碼器讀數(shù)是否正確速度計算是否有誤速度環(huán)的輸出是否正確地疊加到了最終電機輸出上增大速度環(huán)的積分項Ki2但要小心太大會引起低頻振蕩。問題四FreeRTOS任務運行不正常某個任務好像“卡死”了。排查堆棧溢出這是RTOS新手最常犯的錯誤。在FreeRTOSConfig.h中增大configTOTAL_HEAP_SIZE或者增大具體任務的堆棧大小在xTaskCreate參數(shù)中設置。FreeRTOS提供了堆棧溢出檢測鉤子函數(shù)可以啟用它來輔助排查。任務優(yōu)先級設置不當?shù)蛢?yōu)先級任務長時間占用CPU導致高優(yōu)先級任務無法及時運行。檢查是否有任務中沒有使用vTaskDelay或阻塞式API如xQueueReceive導致其一直處于就緒態(tài)。中斷優(yōu)先級沖突FreeRTOS管理的中斷優(yōu)先級有要求。對于Cortex-M3/M4需要調(diào)用HAL_NVIC_SetPriority()和HAL_NVIC_EnableIRQ()來設置中斷優(yōu)先級并確保系統(tǒng)滴答定時器Systick和PendSV中斷的優(yōu)先級是最低的。問題五MPU6050數(shù)據(jù)跳動很大角度不準。排查電源和地線確保MPU6050模塊供電穩(wěn)定地與STM32共地良好。I2C上拉電阻雖然模塊通常自帶但如果通信距離稍長或干擾大可以嘗試在SDA和SCL線上額外加4.7kΩ上拉電阻到3.3V。軟件濾波除了互補濾波在讀取原始數(shù)據(jù)后可以先進行一階低通濾波平滑加速度計數(shù)據(jù)。filtered_data a * filtered_data (1-a) * new_data。安裝位置盡量將MPU6050安裝在車體中心并減少電機振動傳遞到傳感器。可以在模塊和小車底板之間墊上海綿或軟膠減震。6. 功能進階與項目擴展當你的小車能夠穩(wěn)穩(wěn)立住之后就可以嘗試給它增加更多“技能”了這也是FreeRTOS多任務優(yōu)勢的體現(xiàn)。6.1 增加循跡功能購買五路或七路紅外循跡模塊安裝在車體底部。創(chuàng)建一個新的任務Task_Trace。任務設計該任務以較低優(yōu)先級如osPriorityBelowNormal運行定時如30Hz讀取紅外傳感器的IO狀態(tài)。算法根據(jù)中間、左、右等傳感器的黑白線檢測情況計算出一個偏差值然后通過修改Task_Balance中的turn_out目標值讓小車進行差速轉(zhuǎn)向從而實現(xiàn)沿黑線行走。任務通信Task_Trace可以通過一個全局變量或隊列將計算出的“期望轉(zhuǎn)向量”發(fā)送給Task_Balance。6.2 增加無線遙控與參數(shù)調(diào)試利用藍牙模塊如HC-05/06或Wi-Fi模塊如ESP-01S創(chuàng)建一個通信任務Task_Comm。協(xié)議設計定義簡單的串口通信協(xié)議。例如手機APP發(fā)送”SPD:50\n“表示設置目標速度為50”KP1:12.5\n“表示動態(tài)修改直立環(huán)的Kp參數(shù)。任務實現(xiàn)在Task_Comm中解析串口接收緩沖區(qū)可以在串口中斷中填充一個環(huán)形緩沖區(qū)的數(shù)據(jù)根據(jù)協(xié)議修改對應的全局變量。注意修改像PID參數(shù)這樣的關(guān)鍵變量時最好使用FreeRTOS的信號量Semaphore或互斥量Mutex進行保護防止在Task_Balance正使用該參數(shù)計算時被中途修改導致數(shù)據(jù)不一致。數(shù)據(jù)回傳Task_Comm也可以定時從其他任務獲取狀態(tài)數(shù)據(jù)打包后發(fā)送給手機APP實現(xiàn)實時波形顯示這將極大提升調(diào)試效率。6.3 使用DMP庫獲取更優(yōu)姿態(tài)MPU6050內(nèi)部自帶一個數(shù)字運動處理器DMP它可以自動完成傳感器數(shù)據(jù)融合和四元數(shù)解算直接輸出穩(wěn)定的歐拉角俯仰、橫滾、偏航。使用DMP可以省去自己編寫和調(diào)試互補濾波的麻煩效果通常也更穩(wěn)定。實現(xiàn)需要導入InvenSense公司提供的官方inv_mpu.c和inv_mpu_dmp_motion_driver.c等庫文件。初始化后DMP會通過一個FIFO輸出數(shù)據(jù)你只需要定時讀取這個FIFO即可獲得解算好的姿態(tài)。注意DMP庫的移植需要一定的耐心主要是適配I2C讀寫接口和延時函數(shù)。使用DMP后姿態(tài)解算任務Task_IMU的負擔會減輕代碼也更簡潔。從零開始將一堆散件變成一個能自主平衡、甚至聽從指令行動的小車這個過程充滿了挑戰(zhàn)也極具成就感。它強迫你去理解硬件的電氣特性、軟件的實時調(diào)度、控制理論的經(jīng)典算法。每一次調(diào)試每一次參數(shù)的微調(diào)看到小車從倒下到站穩(wěn)從抖動到平穩(wěn)都是對理論知識的絕佳驗證。這個項目最大的價值不在于結(jié)果而在于這個完整的、跨學科的實踐過程。當你親手調(diào)通的那一刻之前所有的疑惑和挫折都會化為扎實的經(jīng)驗沉淀下來。