1. 項目概述從零到一打造你的第一臺自平衡小車幾年前我第一次接觸平衡車項目時被那種“違反直覺”的穩定感深深吸引。一個看似隨時會倒下的兩輪結構竟然能通過電機和算法的配合穩穩立住甚至載人行駛。這背后是微控制器實時處理傳感器數據、快速做出決策并驅動執行機構的經典閉環控制案例。對于電子、嵌入式或自動化領域的學習者來說親手做一臺平衡車是理解PID控制、姿態解算、電機驅動等核心概念的絕佳實踐。這個項目的主角是STM32和MPU6050。STM32作為意法半導體的主流ARM Cortex-M系列微控制器以其豐富的外設、強大的性能和活躍的社區生態成為眾多電子愛好者和工程師的首選。而MPU6050則是一款集成了三軸陀螺儀和三軸加速度計的六軸運動處理傳感器價格親民數據接口標準是獲取物體姿態信息的入門神器。將兩者結合我們就能搭建一個感知自身傾斜角度、并通過驅動輪子來對抗傾斜、維持平衡的智能系統。整個制作過程你會經歷硬件選型與焊接、傳感器數據采集與濾波、姿態角解算、PID控制器設計與調試、電機驅動與PWM控制等多個環節。這不僅僅是焊幾根線、寫幾行代碼那么簡單它要求你對系統有一個整體的認識并理解每個環節如何影響最終“站不站得穩”這個結果。無論你是在校學生想做一個亮眼的畢業設計還是工程師想夯實自己的嵌入式控制功底亦或是純粹的硬件DIY愛好者這個項目都能帶給你滿滿的成就感和技術提升。2. 核心硬件選型與電路設計思路硬件是系統的骨架穩定的硬件平臺是算法得以流暢運行的基礎。在開始焊接之前我們需要對每個模塊的選型理由和連接方式有清晰的認識。2.1 主控芯片為什么是STM32在眾多單片機中我選擇了STM32F103C8T6也就是常說的“藍色藥丸”核心板。這個選擇基于幾個現實的考量。首先它基于Cortex-M3內核主頻72MHz對于需要每秒數百次循環讀取傳感器、計算PID并更新電機輸出的平衡車應用來說性能完全夠用且游刃有余。其次它擁有足夠多的定時器資源來生成多路高精度的PWM波驅動電機同時其SPI和I2C接口方便與MPU6050通信。最重要的是它的生態極其豐富標準庫、HAL庫、LL庫以及各種第三方教程和開源項目俯拾皆是極大降低了學習和調試的門檻。注意STM32F103系列有多個型號如C8T664K Flash20K RAM和RCT6256K Flash48K RAM。對于平衡車項目C8T6的資源已經足夠。購買時請認準正版芯片或信譽好的店鋪市面上有些劣質仿冒芯片可能導致程序運行不穩定。2.2 姿態傳感器MPU6050的潛力與局限MPU6050是這個項目的“眼睛”。它通過I2C接口與主控通信實時提供三個軸的角速度陀螺儀和加速度數據。陀螺儀測量的是旋轉的角速度積分后可以得到角度變化但存在累積誤差漂移加速度計測量的是包括重力在內的各軸加速度在靜止或勻速運動時可以通過反三角函數計算出相對于重力方向的傾斜角但對運動引起的加速度非常敏感動態下誤差大。因此單一使用任一種數據都無法獲得穩定、準確的姿態角。這就需要我們進行“傳感器融合”。MPU6050內部自帶一個數字運動處理器DMP可以運行官方的傳感器融合算法直接輸出解算好的四元數或歐拉角這大大簡化了我們的工作。如果不用DMP我們也可以在STM32上實現互補濾波或卡爾曼濾波算法來融合數據。對于初學者強烈建議先從使用DMP開始快速獲得穩定角度數據把精力集中在控制算法上。2.3 動力與執行機構電機、驅動與電源平衡車的“手腳”是電機和驅動電路。我推薦使用帶有減速箱的直流編碼電機。減速箱可以增大扭矩讓小車有足夠的力量對抗傾斜。而編碼器則用于測量電機的實際轉速為后續的速度環PID控制提供反饋是實現平穩移動和轉向的關鍵。電機驅動芯片我選用的是TB6612FNG。相比傳統的L298NTB6612效率更高、發熱更小、體積更小巧并且支持大電流連續1.2A峰值3.2A。它只需要兩個PWM信號和一個方向信號就能控制一個電機的正反轉和速度接口非常簡潔。電源部分至關重要且容易被忽視。整個系統包括STM323.3V、MPU60503.3V、TB6612邏輯部分3.3-5V電機部分需更高電壓和電機。一個常見的方案是使用一塊7.4V或11.1V的鋰電池作為總電源然后通過一個DC-DC降壓模塊如LM2596產生一個穩定的5V電壓再通過AMS1117-3.3等LDO芯片為STM32和傳感器提供3.3V。TB6612的電機驅動電壓VM直接接電池電壓以獲得最大驅動力。2.4 電路連接與布局心得具體的引腳連接需要根據你的核心板型號來定但思路是通用的。以下是一個基于STM32F103C8T6的參考連接表模塊引腳/接口連接到STM32備注MPU6050VCC3.3V絕對不要接5VGNDGNDSCLPB6 (或其它I2C1 SCL)需配置為上拉模式SDAPB7 (或其它I2C1 SDA)需配置為上拉模式INT可選如PA0用于DMP中斷讀取TB6612 (左電機)PWMAPA8 (TIM1_CH1)生成PWM波AIN1PB12方向控制1AIN2PB13方向控制2STBY接高電平(3.3V/5V)使能芯片AO1, AO2接左電機兩極VM接電池正極(如7.4V)電機驅動電源VCC接5V邏輯電源GND接電源地TB6612 (右電機)PWMBPA11 (TIM1_CH4)BIN1PB14BIN2PB15BO1, BO2接右電機兩極電機編碼器 (每路)VCC5V注意編碼器工作電壓GNDGNDA相如PA0, PA1 (配置為編碼器模式)接到定時器的CH1, CH2B相如PA6, PA7 (配置為編碼器模式)實操心得1布線時電機驅動線連接TB6612 AO/BO到電機的線要盡量粗、短并且最好與信號線如I2C、編碼器線分開走避免電機大電流開關產生的噪聲干擾敏感的傳感器和編碼器信號。電源入口處記得并聯一個容量較大的電解電容如470uF/16V來緩沖電機啟動時的電流沖擊。3. 軟件架構與核心算法解析硬件搭建好后大腦軟件的設計決定了小車的“智商”。平衡車的軟件核心是一個多層閉環控制系統我們需要從底層到上層逐一實現。3.1 系統軟件框架設計一個穩定可靠的平衡車程序通常采用“前后臺”或基于實時操作系統如FreeRTOS的結構。對于初學者一個清晰的前后臺循環配合定時中斷就能很好地工作。我建議的軟件框架如下初始化層配置系統時鐘、GPIO、中斷、定時器、PWM、I2C、編碼器接口等所有外設。數據采集層在定時中斷如1ms一次中通過I2C讀取MPU6050的DMP數據解算出當前車體的俯仰角Pitch和角速度。在另一個定時中斷或主循環中讀取編碼器數值計算電機的實際轉速。控制算法層這是核心。在一個固定的控制周期如5ms中斷中執行控制算法。最內環是直立環角度環根據目標角度通常為0度即豎直和當前角度偏差通過PID計算出一個基礎電機輸出值目的是讓車體保持直立。中間環是速度環根據目標速度通常為0即靜止和編碼器測得的速度偏差通過另一個PID計算出一個補償值。這個補償值會疊加到直立環的輸出上目的是消除直立環的靜差讓小車能在靜止時真正站穩而不是緩慢移動。最外環是轉向環根據遙控器指令或自動巡線等需求計算出左右電機的速度差實現轉向。輸出執行層將最終計算出的左右電機PWM占空比和方向寫入對應的定時器寄存器驅動電機轉動。通信與調試層通過串口將關鍵數據如角度、角速度、PWM值、PID參數發送到電腦上位機如匿名科創地面站、SerialPlot等方便實時觀察波形和調試參數。3.2 姿態解算獲取準確的傾斜角如前所述使用MPU6050的DMP庫是最快最穩的方式。你需要從官方或開源社區獲取inv_mpu.c、inv_mpu_dmp_motion_driver.c等文件并移植到你的工程中。移植的關鍵是實現i2c_write和i2c_read函數以及提供準確的延時函數。成功初始化DMP后你可以設置其輸出頻率如100Hz然后在中斷中調用dmp_read_fifo函數來獲取解算好的四元數。再將四元數轉換為歐拉角我們主要關心俯仰角pitch。// 示例從DMP讀取數據并計算Pitch角部分代碼 if (dmp_read_fifo(gyro, accel, quat, sensor_timestamp, sensors, more)) { // 讀取失敗處理 } if (sensors INV_WXYZ_QUAT) { // 將四元數轉換為歐拉角單位度 float q0 quat[0] / q30; // q30是DMP輸出數據的縮放因子 float q1 quat[1] / q30; float q2 quat[2] / q30; float q3 quat[3] / q30; // 計算俯仰角Pitch (繞Y軸旋轉) pitch asin(-2 * q1 * q3 2 * q0 * q2) * 57.3f; // 57.3是弧度轉度數的系數 }實操心得2DMP輸出的數據穩定性很高但上電后需要幾秒鐘的初始化時間。在程序開始時確保小車靜止放置讓DMP完成自檢和校準。此外安裝MPU6050時要確保其芯片平面與小車的主平面平行否則解算出的角度基準會不對需要在你計算的pitch角上加上一個固定的安裝誤差補償值。3.3 控制核心PID算法的理解與實現PID控制器是平衡車的靈魂。它根據設定值Setpoint和實際值Feedback的偏差Error通過比例P、積分I、微分D三個環節的運算得到控制輸出Output。比例P與當前偏差成正比。P越大糾正偏差的力度越大響應越快但過大會引起振蕩。積分I與偏差的累積和成正比。用于消除靜態誤差比如小車總是緩慢朝一個方向走但過大會導致系統反應遲鈍和超調。微分D與偏差的變化率成正比。具有預見性能抑制振蕩提高穩定性但對噪聲敏感。在平衡車中我們通常使用兩個串聯的PID直立環角度環和速度環。直立環是基礎它讓小車有站起來的趨勢速度環是修正它讓小車站住后不會偷偷溜走。typedef struct { float Target; // 目標值 float Feedback; // 反饋值 float Kp, Ki, Kd; // PID參數 float Error; // 當前誤差 float LastError; // 上次誤差 float Integral; // 積分項 float Output; // 輸出值 float IntegralLimit; // 積分限幅 float OutputLimit; // 輸出限幅 } PID_TypeDef; float PID_Calculate(PID_TypeDef *pid) { pid-Error pid-Target - pid-Feedback; // 比例項 float p_out pid-Kp * pid-Error; // 積分項抗飽和處理 pid-Integral pid-Error; if (pid-Integral pid-IntegralLimit) pid-Integral pid-IntegralLimit; if (pid-Integral -pid-IntegralLimit) pid-Integral -pid-IntegralLimit; float i_out pid-Ki * pid-Integral; // 微分項常用不完全微分或對反饋值微分 float d_out pid-Kd * (pid-Error - pid-LastError); pid-LastError pid-Error; // 總和并限幅 pid-Output p_out i_out d_out; if (pid-Output pid-OutputLimit) pid-Output pid-OutputLimit; if (pid-Output -pid-OutputLimit) pid-Output -pid-OutputLimit; return pid-Output; }直立環PIDTarget設為0度Feedback就是MPU6050解算出的pitch角。其輸出直接決定電機的力度和方向。速度環PIDTarget設為0期望靜止Feedback由編碼器測得的電機轉速經過處理得到如左右輪速度的平均值。速度環的輸出不是直接給電機而是疊加到直立環的目標值上或者作為一個修正量加到直立環的輸出上。這是一種“串級PID”的變體速度環的輸出改變了直立環的平衡點從而讓小車通過微微前傾或后仰來加速或減速最終使速度趨于零。4. 分步實現與調試全記錄理論需要實踐來驗證。下面我們一步步完成從工程創建到小車站立的整個過程。4.1 工程創建與基礎外設驅動首先使用STM32CubeMX工具初始化項目非常高效。選擇你的芯片型號STM32F103C8Tx在圖形化界面中配置SYS: Debug選擇Serial Wire用于ST-Link下載調試。RCC: HSE選擇Crystal/Ceramic Resonator如果你的板子有外部晶振。時鐘樹: 將HCLK設置為72MHz。GPIO: 配置TB6612的方向控制引腳如PB12, PB13, PB14, PB15為輸出模式。定時器:配置TIM1的CH1和CH4為PWM Generation模式用于驅動兩個電機。預分頻和自動重載值設置為產生頻率在10-20kHz的PWM超出人耳聽覺范圍電機噪音小。配置TIM2和/或TIM3為Encoder Interface模式用于讀取左右電機的編碼器。配置一個基本定時器如TIM4用于產生系統時基例如1ms中斷。I2C: 配置I2C1為標準模式100kHz或快速模式400kHz用于連接MPU6050。USART: 配置一個串口如USART1用于打印調試信息波特率115200。生成代碼后在Keil或STM32CubeIDE中打開項目。首先確保基礎功能正常編寫測試代碼讓LED閃爍用邏輯分析儀或示波器檢查PWM波形是否正確讀取編碼器值是否隨電機轉動變化通過I2C掃描函數確認能檢測到MPU6050的地址0x68或0x69。4.2 MPU6050 DMP庫的移植與角度讀取這是關鍵一步。將DMP庫文件添加到你的工程并實現i2c_write和i2c_read函數通常直接調用HAL庫的HAL_I2C_Mem_Write和HAL_I2C_Mem_Read。按照庫提供的示例流程進行初始化初始化I2C。復位MPU6050。設置陀螺儀和加速度計量程例如陀螺儀±2000°/s加速度計±2g。加載DMP固件。配置DMP輸出速率如100Hz并啟用所需輸出如四元數。使能DMP。成功初始化后在定時中斷如1ms中調用讀取函數并計算pitch角。通過串口將pitch角實時發送到上位機軟件觀察波形。用手緩慢傾斜小車模塊看角度變化是否平滑、響應是否及時。靜止時角度曲線應是一條平穩的直線噪聲越小越好。4.3 直立環PID的單獨調試在調試PID之前務必確保機械結構牢固電池電量充足并將小車車輪懸空用架子架起來防止調試時小車突然失控沖出。首先只調試直立環。將速度環和轉向環的輸出置零。參數初始化將直立環PID的參數Kp,Ki,Kd全部設為0。速度環目標Target設為0。先調P比例逐漸增大Kp。你會發現當Kp小到一定程度時用手推動車輪車輪會緩慢地朝你推的反方向轉動試圖“抵抗”你的推動但力度很弱。繼續增大Kp這個抵抗的力度和速度會變強。找到一個臨界點當Kp增大到某個值時你一推車輪車輪會快速地來回振蕩幾次才停下。這個值就是臨界Kp。將最終使用的Kp設為這個臨界值的50%-70%。例如臨界Kp是120那么可以先設定Kp60。再調D微分微分項能抑制振蕩。在已有Kp的基礎上逐漸加入正的Kd。你會發現車輪的響應變得更“沉穩”用手快速撥動時振蕩會明顯減弱。Kd能提高系統的阻尼。但Kd過大會導致系統反應遲鈍。通常Kd的值在Kp的十分之一到幾十分之一之間試探。最后調I積分在平衡車直立環中積分項Ki通常很小甚至可以為0。因為我們的目標角度是0且傳感器有噪聲積分容易累積誤差導致系統不穩定。可以先設為0。調試時通過串口實時繪制pitch角、pitch角速度、直立環輸出Output的波形至關重要。觀察當你給小車一個擾動用手輕推時這些量的變化是否迅速且平穩。4.4 加入速度環與參數整定當直立環能讓小車在懸空時有明顯的“平衡反應”后可以嘗試將小車放在地上做好保護防止跑飛。此時只有直立環的小車可能會朝一個方向加速跑出去直到倒下因為它沒有“想停下來”的意愿。此時加入速度環。速度環的Feedback是編碼器測得的轉速單位可以是編碼器計數/控制周期。速度環的Target設為0。速度環的Output不是直接給電機而是加到直立環的Target上。即直立環目標角度 0 速度環輸出值這樣當小車因為微小偏差開始移動時編碼器測到速度速度環輸出一個值這個值會改變直立環的平衡點。比如小車向前移動速度環輸出一個負值使得直立環的目標角度變成微微向后傾小車就會向后加速以糾正向前的速度最終達到靜止平衡。速度環的調試同樣遵循PID順序先調P從小開始慢慢增大。目標是讓小車在受到輕微推力后能自己慢慢回到原點停下而不是持續振蕩或跑飛。速度環的P通常比直立環的P小很多。再調I速度環的I項很重要用于消除靜態誤差。如果調好P后小車總是停不住有恒定的速度就需要加入I。I值也要從小加起過大會引起低頻振蕩。D項速度環的D項一般不加因為編碼器速度信號噪聲較大微分會放大噪聲。這個過程需要極大的耐心。一個實用的技巧是“階躍響應法”用手將小車抬離地面然后突然放下觀察小車的反應。理想情況是它輕微晃動幾下就穩穩站住。如果倒下可能是直立環P不夠或D不夠如果持續前后擺動可能是直立環P太大或速度環參數不合適如果朝一個方向勻速跑開可能是速度環P太小或I不夠。5. 常見問題排查與進階優化即使按照步驟操作你也一定會遇到各種問題。下面是我在多次制作中踩過的坑和解決方案。5.1 硬件與基礎驅動問題排查現象可能原因排查方法MPU6050無法初始化/讀取1. I2C線路接觸不良2. 上拉電阻未接或失效通常模塊已集成3. 電源電壓不對必須3.3V4. I2C地址錯誤AD0引腳電平決定1. 用萬用表檢查連線。2. 使用I2C掃描程序檢查總線設備地址。3. 檢查MPU6050的VCC引腳電壓。4. 嘗試地址0x68和0x69。電機不轉或只振動1. PWM頻率不對太低會聽到嘯叫2. TB6612的STBY引腳未使能3. 電機驅動電源VM電壓不足或電流不夠4. 電機損壞1. 用示波器或邏輯分析儀查看PWM引腳波形。2. 檢查STBY引腳是否接高電平。3. 檢查電池電量測量VM電壓。4. 直接給電機加電測試。編碼器讀數不變或亂跳1. 編碼器AB相接反2. 定時器未配置為編碼器模式3. 編碼器電源電壓不對4. 信號線受電機干擾1. 交換A、B相線序試試。2. 確認TIMx的通道1、2配置為Encoder Mode。3. 檢查編碼器VCC電壓通常是5V。4. 編碼器線使用雙絞線或屏蔽線遠離電機線。小車一上電就猛轉1. PID參數極不合理2. 角度傳感器數據異常如安裝方向反了3. 電機輸出極性接反1.務必懸空調試先調小所有PID參數。2. 通過串口打印角度值檢查靜止時是否接近0傾斜方向是否正確。3. 交換電機的兩根線或交換TB6612的AIN1/AIN2邏輯。5.2 軟件與算法調試技巧角度數據波動大首先檢查MPU6050是否安裝牢固避免振動。其次可以軟件上對DMP輸出的角度進行低通濾波例如angle_filtered 0.9 * angle_filtered 0.1 * angle_new。但DMP本身已經融合了數據通常不需要額外濾波。小車平衡點不在正中可能是機械重心不在兩輪軸線上。可以通過在軟件中給直立環的目標角度Target加一個固定的偏移量來補償。例如小車總是向后倒就把Target設為0.5度前傾。響應遲鈍或振蕩這是PID參數不匹配的典型表現。響應遲鈍可能是P太小或D太大振蕩可能是P太大或D太小。使用上位機觀察波形至關重要。觀察當你施加擾動時角度偏差、輸出PWM的變化曲線。理想的響應應該是快速上升并平滑地回到零點超調量小。速度環引起低頻擺動小車能站住但會以大約1-2秒的周期緩慢地前后擺動。這通常是速度環的I值過大引起的。嘗試減小速度環的Ki或者給速度環的積分項加上一個泄漏系數即每次計算時讓積分項乘以一個略小于1的數如0.995防止其無限累積。5.3 從“能站”到“站得穩”的進階優化當小車基本能站立后還可以從以下幾個方面提升其性能控制周期優化確保你的主要控制循環讀取傳感器、計算PID、更新電機在一個固定的、盡可能短的周期內執行如2ms或5ms。使用定時器中斷來觸發這個循環保證實時性。數據同步確保在同一個控制周期內使用的角度、角速度、編碼器數據是同一時刻采集的避免使用“過時”的數據進行計算否則會引入相位滯后影響穩定性。輸出平滑對最終輸出給電機的PWM值進行限幅和斜坡處理。突然的PWM大幅跳變會導致電機扭矩突變引起振動。可以限制單個控制周期內PWM的最大變化量。加入“死區”處理當角度偏差和角速度都非常小時可以令電機輸出為零。這樣可以避免電機因微小的噪聲而持續嗡嗡作響也能節省電量。電池電壓補償電池電壓下降會導致電機在相同PWM下的轉速下降。可以實時監測電池電壓并對輸出的PWM值進行比例補償使小車性能在不同電量下保持一致。最后機械結構的對稱性、重心的高低、輪胎的抓地力都會極大影響最終效果。一個重心低、結構緊湊、輪子摩擦力適中的小車調試起來會事半功倍。這個項目最大的魅力在于它完美地體現了“軟硬結合”的思想。每一個參數的調整都能直觀地反映在小車的動態行為上。當你經過無數次調試看到它終于穩穩立住的那一刻所有的努力都值了。