STM32F4 FOC 編碼器電機角度與轉速詳解TIM3 四倍頻、機械角度、電角度與測速做 FOC 無刷電機控制最基礎也最容易出問題的就是電機轉子位置和速度的獲取。位置不對電流環(huán)解算出來的方向就是錯的速度反饋不準速度環(huán)和位置環(huán)根本調不起來。而對于 STM32F4 跑 FOC 的項目來說使用正交編碼器配合定時器接口模式是最常用、最穩(wěn)定的方案之一。這次的核心是搞清楚三件事TIM3 怎么配置成編碼器模式并實現四倍頻機械角度到電角度之間怎么換算以及基于編碼器脈沖如何做轉速測量。文章偏向實戰(zhàn)會給出 CubeMX 配置、寄存器說明、代碼實現和常見問題排查適合正在做 FOC 控制、無感/有感矢量控制或者對編碼器測速有需求的開發(fā)者參考。我會重點展開以下內容STM32F4 定時器編碼器模式的工作原理TIM3 四倍頻的實現方法與計數方向判定機械角度、電角度與極對數之間的關系編碼器零位與角度初始化M 法與 T 法測速的實現對比常見問題與排查思路1. 核心概念速覽能力項說明主控平臺STM32F4 系列以 STM32F407 為例其他型號類似編碼器類型增量式正交編碼器常見 200~4096 線定時器模塊TIM3可選 TIM1/TIM2/TIM4/TIM5/TIM8 等四倍頻原理利用 A/B 兩路信號的 4 個邊沿提高分辨率角度類型機械角度、電角度電角度需乘極對數測速方法M 法測頻率、T 法測周期、M/T 法綜合資源需求1 個四倍頻定時器 簡單數學運算無額外傳感器用于場景FOC 電流環(huán)、速度環(huán)、位置環(huán)反饋云臺/機器人/伺服驅動T 法測速適合低速場景M 法測速適合中高速場景M/T 法適合寬速度范圍場景。實際項目中可以根據電機最高轉速和編碼器線數選擇最合適的方案。2. 為什么 FOC 必須要位置信息以及編碼器接口模式的原理FOC 的核心是把三相交流電機的定子電流通過 Clarke 變換和 Park 變換解耦成 d 軸和 q 軸兩個直流分量去控制。而 Park 變換中需要用到轉子的電角度這個角度來源通常有幾個方向霍爾傳感器、編碼器、磁編碼器如 AS5047P、或者無感觀測器如滑模觀測器 SMO、龍伯格觀測器。編碼器的優(yōu)勢在于精度高、響應快、抗干擾能力強。增量式編碼器輸出 A、B 兩路相位相差 90° 的正交脈沖通過判斷 A、B 的相對相位先后來確定旋轉方向。STM32F4 的通用定時器有一個非常實用的特性編碼器接口模式。這種模式下定時器硬件會自動處理 A、B 兩路信號的邊沿檢測、方向判斷和計數方向切換不需要 CPU 額外干預而且支持四倍頻。四倍頻的意思是在編碼器線數為 N 的情況下A 相和 B 相各有上升沿和下降沿也就是每個完整的 A/B 周期可以產生 4 個計數脈沖。最終的分辨率就是4 * N。以常見 1000 線編碼器為例四倍頻后每圈脈沖數為 4000角度分辨率可以達到360° / 4000 0.09°。對于大多數 FOC 應用來說這個精度已經完全夠用。在編碼器接口模式下TIM3 根據 A、B 相的電平組合自動切換向上計數或向下計數CNT 寄存器直接反映位置增量而 CR1 寄存器的 DIR 位則可以反饋當前方向。// 以 HAL 庫獲取當前方向為例 uint8_t direction __HAL_TIM_IS_GET_DIRECTION(htim3);這個方向信息在測速和角度解算中會很常用。3. STM32F4 定時器編碼器模式與 TIM3 四倍頻配置3.1 TIM3 引腳映射在 STM32F4 上TIM3 的通道 1CH1默認映射到 PA6通道 2CH2默認映射到 PA7但通過 AF 復用配置也可以映射到 PC6 和 PC7。使用編碼器接口模式時通常讓通道 1 接編碼器 A 相通道 2 接編碼器 B 相。使用 STM32CubeMX 配置方法如下使能 TIM3將 Channel1 和 Channel2 均配置為Encoder Mode。配置Combined Channels為Encoder Mode TI1 and TI2這是最常用的四倍頻模式。配置計數周期Counter Period這個值決定 CNT 的最大計數值一般設為四倍頻后的單圈脈沖數減 1例如 4000 線對應 16000。配置輸入濾波器和預分頻器。在 CubeMX 中定時器配置界面相關參數如下Counter Period等于四倍頻之后的單圈總脈沖數減 1。Input Filter建議設置 2 到 8可以濾掉數字噪聲。Input Prescaler通常設為 1即不分頻。這里的關鍵是理解編碼器模式下定時器計數值是在 0 和 Counter Period 之間往復計數當計數到達上限后如果繼續(xù)正轉會回繞到 0。這就是角度計算中取余的基本邏輯。3.2 TIM3 編碼器模式寄存器配置如果不想用 CubeMX也可以直接用寄存器配置。核心寄存器包括TIM_CR1設置計數方向編碼器模式下由硬件自動管理DIR 位只讀。TIM_SMCR選擇從模式為編碼器模式SMS 0011。TIM_CCMR1設置通道 1 和通道 2 的輸入捕獲映射到 TI1、TI2。TIM_CCER使能捕獲并配置極性通常兩個通道的極性相同。TIM_ARR設置計數周期。TIM_CNT清零作為位置計數器使用。一個簡化配置示例void TIM3_Encoder_Init(void) { RCC-APB1ENR | RCC_APB1ENR_TIM3EN; GPIO_InitTypeDef GPIO_InitStruct {0}; __HAL_RCC_GPIOA_CLK_ENABLE(); GPIO_InitStruct.Pin GPIO_PIN_6 | GPIO_PIN_7; GPIO_InitStruct.Mode GPIO_MODE_AF_PP; GPIO_InitStruct.Pull GPIO_PULLUP; GPIO_InitStruct.Speed GPIO_SPEED_FREQ_VERY_HIGH; GPIO_InitStruct.Alternate GPIO_AF2_TIM3; HAL_GPIO_Init(GPIOA, GPIO_InitStruct); TIM3-PSC 0; TIM3-ARR 4000 * 4 - 1; // 1000線編碼器四倍頻 TIM3-CCMR1 | TIM_CCMR1_CC1S_0 | TIM_CCMR1_CC2S_0; TIM3-CCMR1 | TIM_CCMR1_IC1F_2 | TIM_CCMR1_IC2F_2; TIM3-CCER | TIM_CCER_CC1E | TIM_CCER_CC2E; TIM3-SMCR | TIM_SMCR_SMS_0 | TIM_SMCR_SMS_1; // 編碼器模式3 TIM3-CR1 | TIM_CR1_CEN; }3.3 四倍頻方向判定邏輯編碼器接口模式下定時器的硬件邏輯比較特殊計數器并不是單純地在每個上升沿或下降沿加一而是根據 A、B 兩相的電平狀態(tài)組合來決定是加一、減一還是不變。在四倍頻模式下每個信號周期的 4 個邊沿都會觸發(fā)一次更新每次更新的方向由當前時刻兩路信號的電平狀態(tài)決定。方向判定完全由硬件完成不需要在中斷里讀取兩路 GPIO 電平來判斷方向這降低了中斷負載。實際測試中當電機正轉時TIM3 的 CNT 寄存器遞增反轉時 CNT 遞減。反轉越過零后會從 ARR 值往下回繞表示角度取模時的自然流轉。4. 機械角度與電角度的關系及代碼實現4.1 機械角度計算機械角度也就是電機轉軸實際旋轉的物理角度。增量式編碼器沒有絕對零位所以上電后默認機械角度為 0需要先校準零點例如上電時讓電機對齊到一個確定的電角度再清零編碼器計數或者在編碼器 Z 相Index 信號到來時清零。機械角度計算公式角度計數原始值 TIM3-CNT 機械角度 (TIM3-CNT / 單圈總脈沖數) * 360° 機械角度 (TIM3-CNT % 單圈總脈沖數) * 360° / 單圈總脈沖數在 STM32F4 上用一個 uint16_t 讀取 CNT 值即可范圍已經限制在 ARR 以內。注意CNT 計數器是回繞計數的所以讀取后需要立即與 ARR 計算取?；蛘甙呀Y果存為連續(xù)累加位置。為了提高計算速度FOC 程序中盡量避免浮點運算可以使用 Q15 或 Q24 格式表示角度。例如將 360° 映射到 Q15 的 0~32767或者直接存儲在 int32_t 變量中每圈累計一個固定增量。示例代碼#define ENCODER_PULSE_PER_REV (1000 * 4) // 1000線編碼器四倍頻 float Encoder_GetMechanicalAngle(TIM_HandleTypeDef *htim) { uint16_t cnt __HAL_TIM_GET_COUNTER(htim); float angle_deg ((float)cnt / ENCODER_PULSE_PER_REV) * 360.0f; return angle_deg; }4.2 電角度計算電角度的核心公式是電角度 機械角度 × 極對數Pole Pairs對于永磁同步電機PMSM極對數是電機磁極對數。例如一個 4 極電機極對數為 2電機每轉一圈電角度變化 720°。在實際 FOC 解算中更常用的是電角度的周期形式電角度電角周期整數部分 (機械角度計數 × 極對數) / 單圈總脈沖數 電角度剩余值 (機械角度計數 × 極對數) % 單圈總脈沖數以 TIM3 計數值為例#define POLE_PAIRS 4 // 4對極即8極電機按實際填寫 uint16_t mechanical_cnt __HAL_TIM_GET_COUNTER(htim3); uint32_t electrical_cnt (uint32_t)mechanical_cnt * POLE_PAIRS; electrical_cnt % ENCODER_PULSE_PER_REV; float electrical_angle ((float)electrical_cnt / ENCODER_PULSE_PER_REV) * 2.0f * PI;這里有一個 FOC 開發(fā)中很常見的坑電角度計算的超前滯后問題。編碼器安裝后A 相與電機 U 相之間的相位關系不是固定的如果電角度算出來電流環(huán)無法正常出力通常需要調整一個非常量偏移角度。比較穩(wěn)妥的做法是在電機對齊到任意一個已知電角度后記錄編碼器計數然后計算實際電角度偏移。一個常用的校準流程給電機施加 U 相正方向電流例如 d 軸電流正向讓轉子鎖止到一個已知位置。讀取當前編碼器值記錄為encoder_zero_offset。在運行時電角度 (編碼器計數 - encoder_zero_offset) * 極對數 * 角度系數。這樣可以在代碼中統(tǒng)一處理安裝偏移。4.3 方向對角度的影響編碼器方向與電機 FOC 方向相反時最直觀的表現是電流環(huán)調試時電機飛車、過流或者完全轉不動。處理方法有兩個在電機側交換其中兩相線使電機實際轉向與編碼器方向一致在軟件側把編碼器計數取反即cnt -cnt然后再參與角度計算。第二種方法改動小適合調試階段快速驗證。注意取反后要處理負數取模問題int32_t enc_raw (int16_t)(__HAL_TIM_GET_COUNTER(htim3)); int32_t enc_direction_corrected -enc_raw; enc_direction_corrected % (int32_t)ENCODER_PULSE_PER_REV; if (enc_direction_corrected 0) { enc_direction_corrected ENCODER_PULSE_PER_REV; }5. 位置累加與連續(xù)角度跟蹤增量式編碼器天然只提供增量信息在角速度較高時如果直接讀取 CNT 寄存器可能會面臨一個問題兩次讀取之間計數器可能已經回繞了一次?；乩@會導致角度跳變。解決方式有兩種用 STM32 的定時器溢出中斷Update Interrupt在回繞時維護一個encoder_overflow_count變量把位置擴展為 32 位。在高速控制循環(huán)中假設每次讀取 CNT 的間隔足夠短例如 FOC 電流環(huán) 10kHz~20kHz兩次讀取之間最多只回繞一次因此可以通過判斷 CNT 變化量是否大于 ARR 的一半來判斷是否回繞。推薦使用 32 位位置累計方式這也是工業(yè)伺服驅動中常見做法volatile int32_t encoder_raw_count 0; volatile int32_t encoder_overflow_count 0; uint16_t last_cnt 0; void Encoder_UpdateOverflow(void) { uint16_t current_cnt __HAL_TIM_GET_COUNTER(htim3); int16_t diff (int16_t)(current_cnt - last_cnt); if (diff (int16_t)(ENCODER_PULSE_PER_REV / 2)) { encoder_overflow_count--; } else if (diff -(int16_t)(ENCODER_PULSE_PER_REV / 2)) { encoder_overflow_count; } encoder_raw_count (int32_t)encoder_overflow_count * ENCODER_PULSE_PER_REV current_cnt; last_cnt current_cnt; }注意如果定時器 ARR 設置為四倍頻單圈總脈沖數減 1那么溢出中斷頻次在電機高速轉動時可能較高需要在中斷函數中只做簡單的累加運算避免浮點計算和長耗時分支。更簡單的方式是利用定時器的 TI1 或 TI2 邊沿觸發(fā) DMA 或中斷但會占用 CPU 資源。實際項目一般把編碼器溢出更新放在 FOC 主循環(huán)中而不是中斷服務函數中。6. 基于 TIM3 編碼器的轉速測量M 法、T 法與 M/T 法6.1 M 法測速M 法測速的基本思路是在固定時間窗口內統(tǒng)計編碼器脈沖數然后用脈沖數除以時間得到頻率再乘以每個脈沖對應的角度增量得到轉速。公式轉速 (RPM) (脈沖數 / 時間窗口秒) * 60 / 單圈總脈沖數M 法適合高速場景因為高速時脈沖數多量化誤差相對較小。低速時如果脈沖數太少測出的轉速會跳躍非常嚴重。示例代碼uint16_t cnt1, cnt2; int32_t pulse_count; float rpm; cnt1 __HAL_TIM_GET_COUNTER(htim3); HAL_Delay(10); // 時間窗口 10ms cnt2 __HAL_TIM_GET_COUNTER(htim3); // 注意處理圈內回繞 pulse_count (int32_t)(int16_t)(cnt2 - cnt1); // 每10ms計一個數對應的轉速 脈沖數 / (單圈總脈沖數 * 0.01) * 60 rpm (float)pulse_count / (ENCODER_PULSE_PER_REV * 0.01f) * 60.0f;HAL_Delay 實際項目中不推薦在 FOC 控制循環(huán)中使用建議使用 SysTick 或固定中斷周期來獲取時間窗口。6.2 T 法測速T 法測速是測量兩個相鄰脈沖或指定數量脈沖之間的時間間隔然后用角度變化量除以時間得到轉速。公式轉速 (RPM) (角度增量 / 時間間隔) * 60 / 360°T 法適合低速場景因為低速時脈沖間隔長時間測量精度高而高速時如果脈沖間隔太短定時器計數可能不夠精準。T 法的實現通常依賴輸入捕獲功能捕獲相鄰兩次脈沖邊沿的時間戳計算間隔。在 STM32F4 上可以用定時器的輸入捕獲通道來實現也可以借助外部中斷加 DWT 周期計數。示例思路uint32_t t1, t2; uint32_t time_diff; // 在輸入捕獲中斷中獲取時間戳 t1 last_capture_time; t2 current_capture_time; if (t2 t1) { time_diff t2 - t1; } else { time_diff 0xFFFFFFFF - t1 t2; } // 每個脈沖對應的角度 360 / 單圈總脈沖數 float speed_deg_per_s (360.0f / ENCODER_PULSE_PER_REV) / (time_diff / TIMER_CLOCK_MHZ); float rpm speed_deg_per_s / 360.0f * 60.0f;6.3 M/T 法測速M/T 法結合了 M 法和 T 法的優(yōu)點在低速和高速下都能保持較高精度。實現邏輯是先選定一個目標時間窗口在窗口結束后等待捕獲到下一個脈沖邊沿然后同時統(tǒng)計該時間段內的脈沖數和定時器時鐘周期數。M/T 法適合寬速度范圍場景但實現復雜度高一檔。對于大部分 FOC 興趣項目如果電機運行在幾百到幾千 RPMM 法其實就夠用。6.4 速度環(huán)采樣周期選擇速度環(huán)采樣周期一般比電流環(huán)慢很多。FOC 電流環(huán)通常運行在 10kHz~20kHz速度環(huán)可以放在 1kHz 下運行位置環(huán)可以更慢。編碼器測速在這個采樣周期內如果 M 法測速脈沖少于 5 個建議增大時間窗口或者切換到 T 法。7. FOC 電流環(huán)、速度環(huán)、位置環(huán)中的角度與速度接口最終在 FOC 算法中角度和速度要接入到以下位置控制流程 位置環(huán)可選- 速度環(huán) - 電流環(huán)Id/Iq- Park 變換 - SVPWM - 三相逆變器 - 電機 角度和速度反饋 - 編碼器 - TIM3 計數 - 角度/速度解算在實際代碼中Park 變換和逆 Park 變換都需要電角度這個電角度必須來自編碼器換算結果而不是直接使用機械角度。如果直接使用機械角度電機在帶載時會發(fā)生明顯的轉矩波動嚴重時甚至無法啟動。典型調用流程// FOC 中斷 10kHz void FOC_ISR(void) { // 1. 獲取編碼器計數 uint16_t enc_cnt __HAL_TIM_GET_COUNTER(htim3); // 2. 計算機械角度和電角度 float mech_angle Encoder_GetMechanicalAngle(enc_cnt); float elec_angle Encoder_GetElectricalAngle(enc_cnt); // 3. 采樣相電流 - Clarke - Park使用 elec_angle // 4. PI 調節(jié) - 逆 Park使用 elec_angle // 5. SVPWM 輸出 } // 速度環(huán) 1kHz void SpeedLoop_1kHz(void) { float rpm Encoder_GetSpeedM(); speed_pi_output Speed_PI(rpm, target_rpm); }注意這兩個函數中Encoder_GetElectricalAngle需要提前完成極對數換算和零點偏移補償否則電流環(huán)角度與實際轉子位置有偏差矢量控制效果會打折扣。8. 常見問題與排查方法問題現象可能原因排查方式解決方案上電后角度跳變編碼器沒有絕對零位上電默認值為隨機打印上電 CNT 值做零點校準或使用 Z 相歸零電機反轉時角度計算異常方向未處理CNT 負數取模錯誤打印原始 CNT 和計算角度加方向糾正負數處理角度抖動明顯編碼器信號有毛刺濾波不足用示波器看 A/B 波形增加輸入濾波檢查接線和共地M 法測速低速跳變時間窗口內脈沖數太少打印脈沖數換 T 法或加長時間窗口電流環(huán)無法正常出力電角度零位偏移未校準對齊后記錄編碼器值初始化時計算 offset 并補償計數器到邊界回繞未處理溢出打印 CNT 原始值加溢出計數或 32 位位置累計TIM3 編碼器模式不計數引腳復用配置錯誤或未開啟編碼器模式打印 CR1、SMCR 寄存器檢查 CubeMX 或寄存器配置電機噪音大、發(fā)熱電角度方向反了或偏移不對檢查轉向和 FOC 波形調整方向/零偏排查順序建議如果 FOC 電機轉不起來建議先從編碼器原始數據排查再做角度換算最后才排查電流環(huán) PI 參數。順序如下打印 TIM3-CNT手動旋轉電機軸確認計數是否遞增/遞減。打印機械角度確認一圈對應 0~360°。打印電角度緩慢旋轉電機確認電角度變化是機械角度的極對數倍。給一個固定電壓開環(huán)測試確認電機轉動方向。閉環(huán)測試先用低速速度環(huán)試再切換位置環(huán)。這一步一步排查下來編碼器相關的 90% 問題都能定位到原因。9. 調參建議與工程實踐9.1 編碼器濾波參數STM32 定時器編碼器模式的輸入濾波可以有效抑制抖動。濾波值不是越大越好過大會導致真實邊沿被濾掉尤其在高速下會出現丟步。建議低速場景使用中等濾波高速場景使用較小濾波或關斷。電機最高轉速建議濾波設置 500 RPM8~15500~3000 RPM4~8 3000 RPM0~4實際數值需要在示波器輔助下調整避免盲目取值。9.2 編碼器線數選擇做 FOC 時編碼器線數選擇需要平衡成本和性能200~500 線入門實驗級四倍頻后分辨率 800~2000低速表現一般。1000 線大多數 DIY FOC 項目和教學實驗的主流選擇四倍頻后分辨率 4000。4096 線以上或磁編碼器用于高性能伺服。磁編碼器如 AS5047P通常直接輸出 SPI 或 ABZ 信號配合 STM32F4 也很方便但那是另一套配置方式。如果手頭只有 200 線的編碼器做 FOC 低速實驗會明顯感覺到轉速波動。9.3 定時器溢出中斷中不要做浮點運算FOC 控制對實時性要求很高如果編碼器溢出中斷頻率很高例如高速電機加上高線數編碼器中斷服務函數里盡量只處理整數變量更新。浮點角度和速度計算放在主控制循環(huán)中進行。9.4 數據打印與上位機聯(lián)動調試時建議把以下數據通過串口或虛擬示波器VOFA、SerialPlot讀出編碼器原始計數值機械角度電角度目標速度和實際速度速度環(huán)輸出和電流環(huán)給定當電角度波形在恒速旋轉時應該是平滑的三角波或鋸齒波如果在某個位置出現跳變大概率是角度回繞或零點偏移問題。10. 總結與下一步STM32F4 上的 FOC 編碼器方案本質上就是用硬件編碼器接口模式簡化了位置增量的獲取然后用一小段數學換算完成機械角度、電角度和速度解算。TIM3 四倍頻可以基于常見 1000 線編碼器達到 4000 脈沖/圈的精度配合極對數映射到電角度已經能滿足多數 DIY 伺服和教學實驗的需求。建議拿到板子后先做三件事第一步用示波器或邏輯分析儀確認編碼器 A/B 波形和方向第二步運行基礎角度解算手動轉軸觀察串口輸出的機械角度和電角度曲線第三步用 M 法測速匹配速度環(huán)先跑通低速再逐步提速。最容易踩的坑是零點偏移和方向不一致這些問題在開環(huán)測試階段就能暴露出來不要直接上閉環(huán)。后續(xù)可以繼續(xù)擴展的方向包括M/T 法測速提升低速性能、編碼器 Z 相索引歸零、磁編碼器 SPI 接入對比、以及把編碼器反饋接入無感 FOC 觀測器的啟動過渡邏輯。每一步都在這個基礎上加一個小模塊不會影響整體架構。建議收藏備用調編碼器時可以直接對照。