這次我們來(lái)看一個(gè)針對(duì)全國(guó)大學(xué)生電子設(shè)計(jì)競(jìng)賽電賽H題的解決方案——無(wú)視覺(jué)、無(wú)電機(jī)的平衡小球系統(tǒng)。這個(gè)方案的核心在于它繞開(kāi)了傳統(tǒng)方案中復(fù)雜的視覺(jué)識(shí)別和電機(jī)控制轉(zhuǎn)而采用更簡(jiǎn)潔、更穩(wěn)定的物理與電路設(shè)計(jì)直接“秒殺”了同屆競(jìng)賽中的4、5、6題。對(duì)于正在備賽或?qū)刂祁?lèi)題目感興趣的同學(xué)來(lái)說(shuō)這種思路的轉(zhuǎn)變和實(shí)現(xiàn)細(xì)節(jié)比單純堆砌代碼和硬件更有價(jià)值。本文將詳細(xì)拆解這套“無(wú)視覺(jué)無(wú)電機(jī)”方案的核心思想、硬件選型、電路設(shè)計(jì)、控制算法以及最終的調(diào)試驗(yàn)證過(guò)程。我們重點(diǎn)關(guān)注的是方案的可行性、實(shí)現(xiàn)的成本與門(mén)檻以及如何一步步復(fù)現(xiàn)并優(yōu)化系統(tǒng)性能。無(wú)論你是想為下一屆電賽做準(zhǔn)備還是單純想學(xué)習(xí)經(jīng)典控制理論的實(shí)際應(yīng)用這篇文章都能提供一條清晰的實(shí)踐路徑。1. 核心能力速覽能力項(xiàng)說(shuō)明目標(biāo)賽題全國(guó)大學(xué)生電子設(shè)計(jì)競(jìng)賽電賽H題平衡小球系統(tǒng)核心創(chuàng)新摒棄攝像頭視覺(jué)反饋和步進(jìn)/舵機(jī)電機(jī)執(zhí)行采用更直接的傳感器與執(zhí)行器主要傳感器高精度角度傳感器如MPU6050、位置檢測(cè)傳感器如激光測(cè)距/紅外對(duì)管核心執(zhí)行器電磁鐵、音圈電機(jī)、線(xiàn)性伺服等可直接快速響應(yīng)的器件控制核心STM32、ESP32等微控制器實(shí)現(xiàn)PID或更先進(jìn)的控制算法系統(tǒng)特點(diǎn)響應(yīng)快、結(jié)構(gòu)簡(jiǎn)單、抗干擾能力強(qiáng)、成本相對(duì)可控適合場(chǎng)景電賽備賽、課程設(shè)計(jì)、控制算法學(xué)習(xí)、創(chuàng)新項(xiàng)目原型開(kāi)發(fā)驗(yàn)證指標(biāo)小球平衡穩(wěn)定性、抗擾動(dòng)能力、響應(yīng)速度2. 方案思路與使用邊界傳統(tǒng)平衡小球題目主流思路是“攝像頭捕捉小球位置 - 控制器計(jì)算 - 電機(jī)驅(qū)動(dòng)平板調(diào)整角度”。這個(gè)鏈路長(zhǎng)涉及圖像處理、坐標(biāo)變換、電機(jī)控制等多個(gè)環(huán)節(jié)任何一個(gè)環(huán)節(jié)的延遲或誤差都會(huì)導(dǎo)致系統(tǒng)不穩(wěn)定。本方案“無(wú)視覺(jué)無(wú)電機(jī)”的破局點(diǎn)在于無(wú)視覺(jué)不使用攝像頭。小球在平板上的位置通過(guò)安裝在平板邊緣的紅外對(duì)管陣列、激光測(cè)距模塊或電阻觸摸膜來(lái)直接檢測(cè)。這避免了圖像處理的巨大計(jì)算開(kāi)銷(xiāo)和延遲。無(wú)電機(jī)不使用傳統(tǒng)的旋轉(zhuǎn)電機(jī)來(lái)驅(qū)動(dòng)平板。平板的角度調(diào)整通過(guò)電磁鐵吸合/釋放、音圈電機(jī)直推或線(xiàn)性伺服來(lái)實(shí)現(xiàn)。這些執(zhí)行器可以直接產(chǎn)生直線(xiàn)運(yùn)動(dòng)或力矩響應(yīng)速度極快控制模型更直接。適合誰(shuí)用電賽參賽隊(duì)員尤其是負(fù)責(zé)控制算法和硬件設(shè)計(jì)的同學(xué)。自動(dòng)化、儀器儀表、機(jī)電相關(guān)專(zhuān)業(yè)的學(xué)生用于課程實(shí)踐。對(duì)PID控制、實(shí)時(shí)系統(tǒng)、傳感器融合感興趣的硬件愛(ài)好者。能解決什么問(wèn)題提供了一個(gè)避開(kāi)復(fù)雜視覺(jué)和電機(jī)驅(qū)動(dòng)直擊控制問(wèn)題核心的參考設(shè)計(jì)。降低了軟件復(fù)雜度讓開(kāi)發(fā)者更專(zhuān)注于控制算法本身和硬件可靠性。方案具有高響應(yīng)速度理論上能獲得更好的動(dòng)態(tài)性能。不適合什么場(chǎng)景需要極高定位精度如微米級(jí)的工業(yè)場(chǎng)景。本方案是教學(xué)競(jìng)賽級(jí)精度。對(duì)執(zhí)行器推力或行程有超大要求的場(chǎng)景。電磁鐵或音圈電機(jī)的推力/行程有限。完全不想動(dòng)手焊接、調(diào)試硬件的純軟件學(xué)習(xí)者。安全與合規(guī)邊界實(shí)驗(yàn)中涉及的電磁鐵、激光模塊等需注意用電安全避免短路。高速運(yùn)動(dòng)的小球和機(jī)構(gòu)存在機(jī)械風(fēng)險(xiǎn)調(diào)試時(shí)需做好防護(hù)。本方案為學(xué)習(xí)研究目的若用于其他場(chǎng)合需考慮相應(yīng)的安全認(rèn)證。3. 硬件選型與電路設(shè)計(jì)一套穩(wěn)定可靠的硬件是算法得以實(shí)現(xiàn)的基礎(chǔ)。以下是核心部件的選型參考和電路設(shè)計(jì)要點(diǎn)。3.1 傳感器選型與電路平板傾角檢測(cè)MPU6050作用實(shí)時(shí)測(cè)量平板自身的俯仰角和橫滾角。這是控制器的核心反饋之一。電路I2C通信。需連接MCU的I2C引腳注意上拉電阻通常4.7kΩ。VCC接3.3V。// 接線(xiàn)示例 (以STM32為例) // MPU6050 - STM32 // VCC - 3.3V // GND - GND // SCL - PB6 (I2C1_SCL) // SDA - PB7 (I2C1_SDA) // INT - 可選接中斷引腳小球位置檢測(cè)紅外對(duì)管陣列作用在平板X(qián)軸和Y軸邊緣布置多對(duì)紅外發(fā)射與接收管通過(guò)檢測(cè)哪一對(duì)被小球遮擋來(lái)判斷小球坐標(biāo)。電路發(fā)射管串聯(lián)限流電阻如100Ω接MCU IO口輸出模式。接收管光電三極管集電極接上拉電阻如10kΩ至3.3V發(fā)射極接地集電極輸出接MCU的ADC引腳或數(shù)字IO口。優(yōu)點(diǎn)成本低電路簡(jiǎn)單響應(yīng)快。缺點(diǎn)精度取決于對(duì)管密度易受環(huán)境光干擾需加調(diào)制解調(diào)或物理遮光。小球位置檢測(cè)備選TOF激光測(cè)距模塊作用在平板四角向下安裝測(cè)量到平板的距離通過(guò)算法反推小球位置當(dāng)小球滾過(guò)時(shí)距離會(huì)發(fā)生變化。型號(hào)VL53L0X, VL53L1X。精度高抗干擾強(qiáng)。電路同樣是I2C接口接線(xiàn)同MPU6050。3.2 執(zhí)行器選型與驅(qū)動(dòng)電路電磁鐵方案原理平板一側(cè)固定另一側(cè)下方放置電磁鐵。通過(guò)控制電磁鐵的電流大小即磁力大小來(lái)吸合或釋放平板從而改變其傾角。驅(qū)動(dòng)電路必須使用H橋或MOSFET驅(qū)動(dòng)電路因?yàn)樾枰焖偻〝嗪碗娏骺刂?。不能直接用MCU的IO口驅(qū)動(dòng)。// 驅(qū)動(dòng)芯片示例DRV8833、TB6612、L298N // MCU通過(guò)PWM波控制驅(qū)動(dòng)芯片的輸入來(lái)調(diào)節(jié)電磁鐵兩端的電壓/電流。關(guān)鍵參數(shù)電磁鐵的吸力N、行程mm、額定電壓/電流、響應(yīng)時(shí)間。音圈電機(jī)方案原理直接產(chǎn)生直線(xiàn)力推動(dòng)平板邊緣?？刂凭群晚憫?yīng)速度極高是高性能選擇。驅(qū)動(dòng)需要專(zhuān)門(mén)的線(xiàn)性功率放大器或D類(lèi)功放來(lái)驅(qū)動(dòng)電路設(shè)計(jì)和成本更高?？刂菩枰娏鞣答伃h(huán)實(shí)現(xiàn)真正的力控。3.3 主控制器STM32F4系列如F407、F429或ESP32是主流選擇。需要足夠的定時(shí)器用于PWM生成、ADC用于紅外接收信號(hào)采集、I2C接口以及足夠的計(jì)算性能運(yùn)行浮點(diǎn)PID運(yùn)算。4. 系統(tǒng)建模與控制算法4.1 系統(tǒng)模型簡(jiǎn)化將系統(tǒng)簡(jiǎn)化為一個(gè)二維問(wèn)題單軸控制。被控對(duì)象是平板控制輸入是執(zhí)行器施加的力或力矩u被控量是小球在平板上的位置x和平板的傾角θ。這是一個(gè)典型的倒立擺的變體但擺的“擺桿”變成了在斜面上滾動(dòng)的小球。狀態(tài)變量可以選取為[x, x_dot, θ, θ_dot]小球位置、小球速度、平板角度、平板角速度。4.2 控制算法串級(jí)PID這是最實(shí)用且有效的算法。采用內(nèi)外雙環(huán)結(jié)構(gòu)外環(huán)位置環(huán)輸入小球目標(biāo)位置x_ref(通常為0即平板中心) 與小球?qū)嶋H位置x的誤差e_x。輸出平板的目標(biāo)角度θ_ref。邏輯如果小球偏右就希望平板稍微向左傾斜讓小球滾回來(lái)。所以θ_ref PID_x(e_x)。內(nèi)環(huán)角度環(huán)輸入外環(huán)輸出的目標(biāo)角度θ_ref與MPU6050測(cè)量的實(shí)際角度θ的誤差e_θ。輸出執(zhí)行器的控制量u(如PWM占空比)。邏輯快速跟蹤角度指令。u PID_θ(e_θ)。// 偽代碼示例 float x_error target_position - current_ball_position; float angle_target pid_position.update(x_error); // 外環(huán)PID計(jì)算 float angle_error angle_target - mpu6050_angle; float pwm_output pid_angle.update(angle_error); // 內(nèi)環(huán)PID計(jì)算 set_pwm_duty_cycle(pwm_output); // 輸出到執(zhí)行器驅(qū)動(dòng)4.3 參數(shù)整定步驟先內(nèi)后外首先將小球固定或拿掉只調(diào)試角度環(huán)。給定一個(gè)階躍的角度指令調(diào)整PID_θ的Kp, Ki, Kd讓平板能快速、無(wú)超調(diào)或微小超調(diào)地穩(wěn)定在目標(biāo)角度。再調(diào)外環(huán)加入小球調(diào)試位置環(huán)。此時(shí)PID_θ參數(shù)保持不變。調(diào)整PID_x的參數(shù)讓小球能緩慢地回到中心點(diǎn)。PID_x的參數(shù)通常比PID_θ小很多尤其是Kp。微調(diào)與抗擾手動(dòng)輕推小球觀察系統(tǒng)能否迅速恢復(fù)平衡?？赡苄枰⒄{(diào)Kd來(lái)抑制振蕩或調(diào)整Ki來(lái)消除靜差。5. 軟件實(shí)現(xiàn)與調(diào)試流程5.1 開(kāi)發(fā)環(huán)境搭建以STM32為例使用STM32CubeMX初始化代碼配合Keil或STM32CubeIDE進(jìn)行開(kāi)發(fā)。初始化系統(tǒng)時(shí)鐘、調(diào)試接口如SWD。配置I2C用于MPU6050和可能的激光測(cè)距。配置ADC用于讀取紅外接收管電壓。配置定時(shí)器產(chǎn)生PWM波用于驅(qū)動(dòng)執(zhí)行器。配置一個(gè)高優(yōu)先級(jí)定時(shí)器中斷作為控制周期如1ms或2ms。5.2 核心代碼模塊// main.c 主循環(huán)示例 int main(void) { // 硬件初始化 HAL_Init(); SystemClock_Config(); MX_GPIO_Init(); MX_I2C1_Init(); MX_ADC1_Init(); MX_TIM1_PWM_Init(); // PWM定時(shí)器 MX_TIM2_Init(); // 控制周期定時(shí)器開(kāi)啟中斷 // 傳感器初始化 MPU6050_Init(); Infrared_Array_Init(); // PID控制器初始化 PID_Init(pid_position, 0.5, 0.01, 0.05); // 外環(huán)參數(shù)需調(diào)試 PID_Init(pid_angle, 3.0, 0.1, 0.2); // 內(nèi)環(huán)參數(shù)需調(diào)試 // 開(kāi)啟控制周期定時(shí)器中斷 HAL_TIM_Base_Start_IT(htim2); while (1) { // 主循環(huán)處理非實(shí)時(shí)任務(wù)如狀態(tài)顯示、參數(shù)接收串口 printf_Status_Info(); UART_Command_Parser(); // 控制算法在定時(shí)器中斷中執(zhí)行 } } // 定時(shí)器中斷服務(wù)函數(shù) (控制周期如1ms) void TIM2_IRQHandler(void) { if (__HAL_TIM_GET_FLAG(htim2, TIM_FLAG_UPDATE) ! RESET) { __HAL_TIM_CLEAR_FLAG(htim2, TIM_FLAG_UPDATE); // 1. 讀取傳感器數(shù)據(jù) ball_position Read_Infrared_Position(); // 獲取小球位置 mpu6050_angle Read_MPU6050_Angle(); // 獲取平板角度 // 2. 執(zhí)行串級(jí)PID控制 float pos_error 0 - ball_position; // 目標(biāo)位置為0中心 float angle_target PID_Calculate(pid_position, pos_error); float angle_error angle_target - mpu6050_angle; float pwm_output PID_Calculate(pid_angle, angle_error); // 3. 輸出限幅并驅(qū)動(dòng)執(zhí)行器 pwm_output LIMIT(pwm_output, -100.0, 100.0); // 限制在±100% Set_Actuator_PWM(pwm_output); } }5.3 調(diào)試與驗(yàn)證步驟單元測(cè)試單獨(dú)測(cè)試MPU6050通過(guò)串口打印角度值晃動(dòng)平板看數(shù)據(jù)是否正常變化。單獨(dú)測(cè)試紅外對(duì)管陣列用小球遮擋通過(guò)串口或LED觀察哪個(gè)通道被觸發(fā)。單獨(dú)測(cè)試執(zhí)行器驅(qū)動(dòng)給固定的PWM觀察平板是否按預(yù)期動(dòng)作。開(kāi)環(huán)測(cè)試不運(yùn)行控制算法手動(dòng)給一個(gè)小的固定PWM觀察平板緩慢傾斜小球隨之滾動(dòng)。驗(yàn)證機(jī)械結(jié)構(gòu)和傳感器讀數(shù)方向是否正確例如正PWM是否對(duì)應(yīng)使小球向右滾動(dòng)的傾斜方向。閉環(huán)調(diào)試無(wú)小球只運(yùn)行角度環(huán)PID。通過(guò)串口發(fā)送目標(biāo)角度指令觀察平板能否快速穩(wěn)定。用示波器或打印數(shù)據(jù)觀察響應(yīng)曲線(xiàn)整定PID_θ參數(shù)。閉環(huán)調(diào)試加入小球運(yùn)行完整的串級(jí)PID。將小球放在平板上觀察系統(tǒng)能否穩(wěn)住。從非常小的PID_x參數(shù)開(kāi)始逐步增加直到小球能在中心點(diǎn)附近穩(wěn)定。性能測(cè)試穩(wěn)態(tài)誤差系統(tǒng)穩(wěn)定后小球距離中心點(diǎn)的最大偏移量?？箶_動(dòng)用小棍輕敲小球記錄系統(tǒng)恢復(fù)到平衡的時(shí)間。動(dòng)態(tài)跟蹤緩慢移動(dòng)目標(biāo)位置觀察小球能否跟隨。6. 常見(jiàn)問(wèn)題與排查方法問(wèn)題現(xiàn)象可能原因排查方式解決方案系統(tǒng)上電后劇烈振蕩甚至失控1. 傳感器數(shù)據(jù)極性接反2. PID參數(shù)過(guò)大特別是Kp3. 執(zhí)行器輸出方向錯(cuò)誤1. 檢查MPU6050角度正方向與平板傾斜方向是否定義一致2. 先調(diào)角度環(huán)將Kp, Ki, Kd全部設(shè)為0然后非常緩慢地增加Kp3. 進(jìn)行開(kāi)環(huán)測(cè)試驗(yàn)證PWM正負(fù)與平板運(yùn)動(dòng)方向的關(guān)系1. 在代碼中乘以-1校正傳感器或執(zhí)行器方向2. 遵循“先內(nèi)后外參數(shù)從零微增”的原則3. 確保控制量與物理效應(yīng)對(duì)應(yīng)小球總是向一邊跑無(wú)法停在中心1. 平板物理不水平零點(diǎn)漂移2. 紅外對(duì)管檢測(cè)中心點(diǎn)未校準(zhǔn)3. PID中Ki過(guò)小或?yàn)?存在靜差1. 系統(tǒng)上電靜止時(shí)讀取MPU6050角度將其作為零點(diǎn)偏移量減去2. 測(cè)量小球在中心時(shí)各紅外對(duì)管的ADC值確定中心閾值3. 適當(dāng)增加位置環(huán)的Ki1. 軟件補(bǔ)償零點(diǎn)漂移2. 校準(zhǔn)傳感器中心點(diǎn)3. 引入積分項(xiàng)消除靜差響應(yīng)遲鈍小球滾動(dòng)緩慢1. 控制周期太長(zhǎng)2. PID的Kp值太小3. 執(zhí)行器推力不足或響應(yīng)慢1. 檢查定時(shí)器中斷周期是否設(shè)置正確建議1-5ms2. 在系統(tǒng)穩(wěn)定的前提下逐步增大Kp3. 檢查執(zhí)行器驅(qū)動(dòng)電壓電流是否達(dá)標(biāo)1. 縮短控制周期2. 增大比例增益3. 更換或加強(qiáng)執(zhí)行器及驅(qū)動(dòng)環(huán)境光干擾導(dǎo)致紅外定位不準(zhǔn)紅外對(duì)管受日光燈、自然光影響在暗環(huán)境下測(cè)試或用手遮擋環(huán)境光測(cè)試1. 為紅外對(duì)管增加物理遮光罩2. 改用調(diào)制解調(diào)電路發(fā)射管發(fā)射特定頻率紅外光接收管只解調(diào)該頻率3. 換用激光測(cè)距方案電磁鐵發(fā)熱嚴(yán)重1. 驅(qū)動(dòng)電路持續(xù)導(dǎo)通2. PWM頻率過(guò)低1. 檢查代碼確保無(wú)輸出時(shí)PWM占空比為02. 用示波器測(cè)量PWM波形1. 確?？刂七壿嬚_2. 提高PWM頻率如20kHz以上避免低頻導(dǎo)致電磁鐵線(xiàn)圈電感續(xù)流發(fā)熱7. 優(yōu)化與進(jìn)階方向當(dāng)基本功能實(shí)現(xiàn)后可以從以下方面進(jìn)行優(yōu)化以應(yīng)對(duì)更高要求或提升性能傳感器融合MPU6050的陀螺儀數(shù)據(jù)角速度和加速度計(jì)數(shù)據(jù)角度可以通過(guò)互補(bǔ)濾波或卡爾曼濾波進(jìn)行融合得到更準(zhǔn)確、延遲更低的傾角估計(jì)這對(duì)提高系統(tǒng)穩(wěn)定性至關(guān)重要。先進(jìn)控制算法在PID基礎(chǔ)上可以嘗試模糊PID、滑模控制或線(xiàn)性二次型調(diào)節(jié)器LQR。LQR需要系統(tǒng)的精確數(shù)學(xué)模型但一旦建立控制效果和魯棒性往往優(yōu)于PID。執(zhí)行器線(xiàn)性化電磁鐵的吸力與電流并非嚴(yán)格線(xiàn)性且存在剩磁?？梢允孪葮?biāo)定電流-力曲線(xiàn)在控制算法中進(jìn)行查表補(bǔ)償使控制更精確。狀態(tài)觀測(cè)器小球的速度x_dot不易直接測(cè)量?？梢酝ㄟ^(guò)小球位置x和平板角度θ、角速度θ_dot利用觀測(cè)器如龍伯格觀測(cè)器來(lái)估計(jì)從而實(shí)現(xiàn)全狀態(tài)反饋提升性能。抗積分飽和當(dāng)誤差持續(xù)較大時(shí)如小球被拿開(kāi)積分項(xiàng)會(huì)累積到很大值導(dǎo)致系統(tǒng)恢復(fù)時(shí)超調(diào)嚴(yán)重。需在PID實(shí)現(xiàn)中加入抗積分飽和邏輯。8. 總結(jié)這套“無(wú)視覺(jué)無(wú)電機(jī)”的平衡小球方案其精髓在于化繁為簡(jiǎn)。它跳出了“攝像頭電機(jī)”的思維定式用更直接的傳感器和執(zhí)行器構(gòu)建了一條更短、更快的控制回路。對(duì)于電賽這類(lèi)強(qiáng)調(diào)創(chuàng)新和實(shí)效的競(jìng)賽這種思路本身就是一個(gè)巨大的亮點(diǎn)。實(shí)現(xiàn)過(guò)程的關(guān)鍵在于硬件可靠性和參數(shù)調(diào)試耐心。從紅外對(duì)管的遮光處理到電磁鐵驅(qū)動(dòng)電路的設(shè)計(jì)再到PID參數(shù)從零開(kāi)始的摸索每一步都需要細(xì)致的驗(yàn)證。建議在開(kāi)發(fā)時(shí)務(wù)必做好模塊化測(cè)試確保每個(gè)子單元工作正常后再進(jìn)行聯(lián)調(diào)。最后這個(gè)項(xiàng)目不僅僅是為了解決一道賽題。它是對(duì)經(jīng)典控制理論一次絕佳的實(shí)踐涵蓋了系統(tǒng)建模、傳感器應(yīng)用、執(zhí)行器驅(qū)動(dòng)、實(shí)時(shí)控制算法等多個(gè)核心知識(shí)點(diǎn)。成功實(shí)現(xiàn)它你對(duì)反饋控制的理解將會(huì)上升一個(gè)實(shí)實(shí)在在的臺(tái)階。建議收藏本文在動(dòng)手實(shí)踐中反復(fù)查閱。