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