簡介這份資源面向參加恩智浦智能車競賽及學(xué)習(xí)嵌入式控制的學(xué)生與工程師聚焦基于STM32的四輪電磁循跡小車PID調(diào)節(jié)方案幫助解決電感采集、舵機(jī)與電機(jī)協(xié)同控制中的參數(shù)整定難題。壓縮包共192個(gè)文件約5.76MB以C源碼與頭文件為主體涵蓋電感信號采集、MPU6050姿態(tài)解算、LCD顯示、定時(shí)器與Flash驅(qū)動等模塊并附帶Keil工程文件、編譯中間產(chǎn)物及可燒錄的hex固件便于直接編譯驗(yàn)證與二次開發(fā)。目前已有4689人學(xué)習(xí)下載熱度較高。資源完整呈現(xiàn)了從傳感器數(shù)據(jù)讀取到PID輸出控制舵機(jī)角度與電機(jī)轉(zhuǎn)速的實(shí)現(xiàn)鏈路讀者可據(jù)此理解比例、積分、微分三項(xiàng)對循跡穩(wěn)定性的影響并參考工程結(jié)構(gòu)快速搭建調(diào)試環(huán)境是備賽與課程實(shí)踐中較實(shí)用的參考案例。1. 電磁循跡小車PID調(diào)節(jié)從電感采集到舵機(jī)打角的閉環(huán)實(shí)戰(zhàn)很多人第一次接觸電磁循跡都會卡在同一個(gè)地方電感值讀回來了濾波也做了歸一化也算了可小車一上賽道要么畫龍要么在直道突然甩頭。問題往往不在算法本身而在 PID 參數(shù)和采集鏈路沒有對齊。這份資源圍繞恩智浦智能車競賽里最常見的電磁組方案展開核心是 STM32 主控 工字電感采集 舵機(jī)轉(zhuǎn)向 雙電機(jī)差速把「電感采集 → 偏差計(jì)算 → PID 輸出 → 舵機(jī)打角」這條閉環(huán)鏈路完整跑通。適合正在調(diào)車、準(zhǔn)備校賽、或者想把電磁循跡方案移植到自己板子上的開發(fā)者尤其是那些 PID 調(diào)了半天還是抖的選手。2. 硬件鏈路與工程結(jié)構(gòu)先看清信號從哪來、到哪去2.1 電磁循跡的物理鏈路電磁循跡的本質(zhì)是賽道中心通電導(dǎo)線產(chǎn)生交變磁場車頭布置的工字電感感應(yīng)出微弱交流信號經(jīng)過選頻、放大、檢波后變成直流電壓再送進(jìn) STM32 的 ADC。常見做法是左右各一個(gè)水平電感中間一個(gè)豎直電感三個(gè)通道一起判斷車體相對導(dǎo)線的橫向偏移和方向。這里有個(gè)容易被忽略的點(diǎn)電感采集的不是「位置」而是「磁場強(qiáng)度」。水平電感離導(dǎo)線越近感應(yīng)電壓越大豎直電感在導(dǎo)線正上方時(shí)感應(yīng)最強(qiáng)偏離后迅速衰減。所以偏差計(jì)算不是簡單做差而是要先歸一化再根據(jù)賽道寬度和電感布局做加權(quán)。工程里一般會這樣組織采集鏈路// 電感采集與預(yù)處理常見于 ADC 中斷或定時(shí)任務(wù)中 #define INDUCTOR_NUM 3 #define FILTER_DEPTH 8 static uint16_t adc_raw[INDUCTOR_NUM]; static uint32_t filter_buf[INDUCTOR_NUM][FILTER_DEPTH]; static uint8_t filter_idx 0; // 滑動平均濾波抑制電磁信號的高頻抖動 void inductor_sample(void) { for (int i 0; i INDUCTOR_NUM; i) { adc_raw[i] adc_read_channel(i); // 讀取原始 ADC filter_buf[i][filter_idx] adc_raw[i]; } filter_idx (filter_idx 1) % FILTER_DEPTH; } uint16_t inductor_get(uint8_t ch) { uint32_t sum 0; for (int i 0; i FILTER_DEPTH; i) { sum filter_buf[ch][i]; } return (uint16_t)(sum / FILTER_DEPTH); // 返回濾波后的值 }這段代碼的關(guān)鍵在于FILTER_DEPTH決定平滑程度太大響應(yīng)慢太小抖動大。電磁組常用 8 到 16 之間的滑動窗口。adc_read_channel需要根據(jù)實(shí)際板子的 ADC 通道映射來寫注意采樣時(shí)間要夠長否則高阻信號源會采不準(zhǔn)。2.2 工程目錄與模塊劃分拿到這份資源后先別急著編譯。打開目錄看一眼結(jié)構(gòu)能省掉后面很多找文件的麻煩。典型的電磁循跡工程會按下面這種方式組織目錄/文件作用Core/Src/main.c主循環(huán)、初始化、任務(wù)調(diào)度Core/Src/adc.cADC 多通道采集配置Core/Src/tim.cPWM 輸出、編碼器接口、定時(shí)中斷Hardware/inductor.c電感濾波、歸一化、偏差計(jì)算Hardware/motor.c電機(jī) PWM 與方向控制Hardware/servo.c舵機(jī)打角控制Control/pid.cPID 結(jié)構(gòu)體與計(jì)算函數(shù)Control/control.c循跡主控制邏輯這種劃分的好處是采集、執(zhí)行、控制三層分開調(diào) PID 的時(shí)候只動Control目錄不會把底層驅(qū)動攪亂。如果你用的是 CubeMX 生成的工程Core目錄基本是自動生成的Hardware和Control是自己加的移植時(shí)把這兩個(gè)目錄拷過去再改一下引腳定義就能用。2.3 偏差計(jì)算歸一化比濾波更重要很多人濾波做得很漂亮偏差還是跳原因是沒做歸一化。電感值會隨電池電壓、賽道高度、環(huán)境溫度變化直接拿原始值做差今天調(diào)好的參數(shù)明天就廢了。常見做法是先把三個(gè)電感值歸一化到 0 到 1000 之間// 歸一化把電感值映射到統(tǒng)一量綱消除供電和環(huán)境漂移 #define NORM_MAX 1000 static uint16_t norm[INDUCTOR_NUM]; void inductor_normalize(void) { uint16_t max_val 0, min_val 0xFFFF; for (int i 0; i INDUCTOR_NUM; i) { uint16_t v inductor_get(i); if (v max_val) max_val v; if (v min_val) min_val v; } if (max_val - min_val 50) { // 防止除零和全暗場景 for (int i 0; i INDUCTOR_NUM; i) norm[i] 0; return; } for (int i 0; i INDUCTOR_NUM; i) { norm[i] (uint32_t)(inductor_get(i) - min_val) * NORM_MAX / (max_val - min_val); } }歸一化之后再用左右水平電感的差值算橫向偏差用豎直電感判斷是否在十字或環(huán)島區(qū)域。偏差公式常見的是// 偏差計(jì)算左電感減右電感正負(fù)代表偏移方向 float error (float)norm[LEFT] - (float)norm[RIGHT];如果車頭電感布局不對稱還要加一個(gè)加權(quán)系數(shù)。這個(gè)系數(shù)不是拍腦袋定的而是把車放在賽道中心讀幾次左右電感值取比值作為基準(zhǔn)。3. PID 調(diào)節(jié)實(shí)戰(zhàn)從參數(shù)整定到舵機(jī)打角3.1 位置式 PID 的結(jié)構(gòu)與實(shí)現(xiàn)電磁循跡里最常用的是位置式 PID輸出直接對應(yīng)舵機(jī)打角。積分項(xiàng)用來消除靜態(tài)偏差微分項(xiàng)用來抑制過沖。工程里一般會把 PID 參數(shù)做成結(jié)構(gòu)體方便在線調(diào)// pid.h typedef struct { float kp; float ki; float kd; float integral; float prev_error; float integral_limit; // 積分限幅防止飽和 float output_limit; // 輸出限幅保護(hù)舵機(jī) } PID_Handle; float pid_calc(PID_Handle *pid, float error, float dt);// pid.c float pid_calc(PID_Handle *pid, float error, float dt) { float derivative; pid-integral error * dt; if (pid-integral pid-integral_limit) pid-integral pid-integral_limit; else if (pid-integral -pid-integral_limit) pid-integral -pid-integral_limit; derivative (error - pid-prev_error) / dt; pid-prev_error error; float output pid-kp * error pid-ki * pid-integral pid-kd * derivative; if (output pid-output_limit) output pid-output_limit; else if (output -pid-output_limit) output -pid-output_limit; return output; }dt是控制周期電磁組常用 5ms 到 10ms。integral_limit一般取輸出限幅的 1/3 到 1/2太大積分會拖慢響應(yīng)太小消不掉靜差。output_limit對應(yīng)舵機(jī)最大打角比如 ±300具體看舵機(jī)行程和機(jī)械結(jié)構(gòu)。3.2 參數(shù)整定的順序與血淚經(jīng)驗(yàn)調(diào) PID 最忌諱三個(gè)參數(shù)一起動。我一般按這個(gè)順序來先只開kpki和kd置零。從小往大加直到小車開始等幅振蕩記下這個(gè)臨界值然后取它的 60% 到 70% 作為初始kp。這一步?jīng)Q定小車能不能大致跟著線走。然后加kd。微分項(xiàng)是抑制振蕩的關(guān)鍵電磁組里kd往往比kp還大。加kd的時(shí)候觀察直道末端和入彎瞬間如果車頭開始「提前打角」說明微分起作用了如果出現(xiàn)高頻抖動說明kd太大把電感噪聲放大了。最后加ki而且要給得很小。電磁循跡對靜態(tài)偏差不敏感ki主要是消除彎道里的持續(xù)偏移。很多翻車案例都是ki給大了直道上積分飽和入彎直接甩出去。提示每次改完參數(shù)至少跑三圈再判斷。單圈偶然性太大電池電壓變化、賽道光線都會影響手感。3.3 舵機(jī)與電機(jī)的協(xié)同舵機(jī)負(fù)責(zé)轉(zhuǎn)向電機(jī)負(fù)責(zé)速度兩者必須配合。常見做法是舵機(jī) PID 輸出打角電機(jī)用編碼器做速度閉環(huán)直道加速、彎道減速。如果只調(diào)舵機(jī)不管速度入彎速度太高再好的 PID 也拉不回來。速度環(huán)一般用增量式 PI// 增量式 PI用于電機(jī)速度閉環(huán) typedef struct { float kp; float ki; float prev_error; float output; } SpeedPI; float speed_pi_calc(SpeedPI *pi, float target, float actual) { float error target - actual; pi-output pi-kp * (error - pi-prev_error) pi-ki * error; pi-prev_error error; if (pi-output 1000) pi-output 1000; if (pi-output -1000) pi-output -1000; return pi-output; }速度目標(biāo)值可以根據(jù)舵機(jī)打角動態(tài)調(diào)整打角越大目標(biāo)速度越低。這樣入彎自動減速出彎自動加速比固定速度穩(wěn)得多。4. 避坑與排查調(diào)車現(xiàn)場最常見的五個(gè)問題4.1 電感值跳變車在直道畫龍現(xiàn)象是直道上舵機(jī)左右小幅擺動車頭走 S 形。原因通常是電感采集沒有濾波或者濾波窗口太小ADC 噪聲直接進(jìn)了 PID。解決方法是加大滑動平均窗口或者在 ADC 后加一級一階低通濾波。另外檢查電感運(yùn)放電路的供電是否干凈電機(jī) PWM 干擾會串進(jìn)模擬通道。4.2 入彎反應(yīng)慢車沖出去現(xiàn)象是直道正常一到彎道就來不及打角。原因多半是kd太小或者控制周期太長。電磁組建議控制周期不超過 10ms最好 5ms。如果kd已經(jīng)很大還是慢檢查偏差計(jì)算是不是用了濾波后的滯后值歸一化窗口太長也會拖響應(yīng)。4.3 舵機(jī)抖動發(fā)出嗡嗡聲現(xiàn)象是舵機(jī)在原地高頻抖動車不動或者走得很別扭。原因是 PID 輸出變化太快或者kd把噪聲放大了。解決方法是給 PID 輸出加一階低通或者降低kd同時(shí)檢查舵機(jī)供電是否獨(dú)立電機(jī)電流拉低電壓會導(dǎo)致舵機(jī)復(fù)位。4.4 電池電壓下降后參數(shù)失效現(xiàn)象是剛充滿電跑得好跑幾圈后開始抖或者反應(yīng)遲鈍。原因是電感歸一化沒有做或者速度環(huán)目標(biāo)值沒有隨電壓補(bǔ)償。解決方法是確保歸一化在每次控制周期都執(zhí)行速度環(huán)可以加一個(gè)電壓前饋電池電壓低時(shí)適當(dāng)降低目標(biāo)速度。4.5 十字和環(huán)島誤判現(xiàn)象是直道過十字時(shí)舵機(jī)突然打角或者環(huán)島進(jìn)不去。原因是只靠水平電感算偏差沒有用豎直電感做區(qū)域判斷。常見做法是豎直電感值超過閾值時(shí)進(jìn)入特殊區(qū)域處理十字區(qū)域強(qiáng)制直行環(huán)島區(qū)域按固定方向打角直到出環(huán)。注意特殊區(qū)域的閾值要在賽道上實(shí)測不同賽道高度和導(dǎo)線電流都會影響別直接抄別人的數(shù)。5. 二次開發(fā)與移植把這套方案改成你自己的車5.1 換主控怎么移植這套工程的核心邏輯在Hardware和Control兩個(gè)目錄和 STM32 的耦合主要在 ADC 讀取、PWM 輸出和定時(shí)器中斷。換到別的 MCU 時(shí)只需要重寫這三個(gè)接口接口作用移植要點(diǎn)adc_read_channel讀電感 ADC改成目標(biāo)平臺的 ADC 驅(qū)動pwm_set_duty設(shè)電機(jī)/舵機(jī) PWM注意頻率和分辨率get_dt獲取控制周期用定時(shí)器或系統(tǒng)滴答PID 和歸一化邏輯是純 C直接拷過去就能用。我一般會先把這三個(gè)接口用空函數(shù)占位編譯通過后再逐個(gè)填實(shí)現(xiàn)這樣能快速定位是驅(qū)動問題還是算法問題。5.2 改電感布局后的參數(shù)重調(diào)如果你把三個(gè)電感改成五個(gè)或者把水平電感換成斜置偏差公式和 PID 參數(shù)都要重調(diào)。偏差公式可以改成加權(quán)和// 五電感布局的偏差計(jì)算示例 float error 0; error norm[FAR_LEFT] * (-2.0f); error norm[LEFT] * (-1.0f); error norm[RIGHT] * ( 1.0f); error norm[FAR_RIGHT] * ( 2.0f); // 中間豎直電感不參與偏差只做區(qū)域判斷權(quán)重系數(shù)根據(jù)電感間距和賽道寬度定間距越大外側(cè)權(quán)重越高。改完布局后kp和kd都要重新從小往大調(diào)不能沿用舊參數(shù)。5.3 加遙測把黑匣子打開調(diào)車最痛苦的是不知道 PID 中間量。我習(xí)慣在工程里加一個(gè)簡單的遙測通過串口把偏差、PID 輸出、電感值發(fā)到上位機(jī)。不用很復(fù)雜一個(gè) 10ms 的定時(shí)任務(wù)把幾個(gè) float 打包發(fā)出去就行// 簡易遙測每 10ms 發(fā)一幀 void telemetry_send(void) { uint8_t buf[16]; int16_t err (int16_t)(pid_steer.prev_error * 100); int16_t out (int16_t)(servo_output); int16_t ind (int16_t)(norm[LEFT] - norm[RIGHT]); memcpy(buf[0], err, 2); memcpy(buf[2], out, 2); memcpy(buf[4], ind, 2); uart_send(buf, 6); }上位機(jī)用串口示波器一畫PID 哪一項(xiàng)在抖、哪個(gè)電感先響應(yīng)一目了然。這比盯著車猜快十倍。5.4 一個(gè)我踩過的坑最早調(diào)車的時(shí)候我總覺得 PID 參數(shù)是「調(diào)」出來的后來才發(fā)現(xiàn)是「測」出來的。有一次車在直道怎么都調(diào)不穩(wěn)換了三組參數(shù)都沒用最后用遙測一看左電感在電機(jī)啟動瞬間會掉 30% 的值原因是電感和電機(jī)共用了一路電源電機(jī)電流把運(yùn)放供電拉低了。把電感供電單獨(dú)加一級 LDO 之后同樣的 PID 參數(shù)直接就跑穩(wěn)了。從那以后我每次調(diào)車都強(qiáng)制走一遍先看遙測確認(rèn)采集鏈路干凈再動 PID。參數(shù)不是玄學(xué)是采集質(zhì)量的鏡子。希望這份資源能幫你少走點(diǎn)彎路把車先跑起來再談?wù){(diào)得快不快。本文還有配套的精品資源點(diǎn)擊獲取