這是一篇可直接用于項目開發(fā)、量產(chǎn)調(diào)試的 FOC 移植與調(diào)試指南，面向STM32/GD32 + 三相 BLDC/PMSM 無刷馬達(dá)驅(qū)動板，包含移植步驟、關(guān)鍵參數(shù)、調(diào)試流程、波形判斷、常見故障，完全匹配你前面設(shè)計的MT6835 磁編碼器、MOS 驅(qū)動、電流采樣、過流保護(hù)硬件體系。

一、前言：FOC 控制的核心價值

FOC（Field Oriented Control）矢量控制是目前無刷電機(jī)最平滑、最高效、最低噪音的控制方案，相比傳統(tǒng)方波 6 步換相：

低速無抖動、高速平穩(wěn)

轉(zhuǎn)矩脈動小、效率提升 5%~15%

支持高精度位置 / 速度閉環(huán)

適配 MT6835 等高精度磁編碼器

本文目標(biāo)：從零完成 FOC 移植 → 快速調(diào)參 → 電機(jī)平穩(wěn)運(yùn)行 → 量產(chǎn)級穩(wěn)定。

二、FOC 算法移植前提（硬件與軟件條件）

2.1 必須具備的硬件

三相全橋 MOS 驅(qū)動電路（上一下一結(jié)構(gòu)）

雙電阻 / 三電阻電流采樣（FOC 必需）

絕對式磁編碼器（MT6835 SPI/ABZ）

三路互補(bǔ) PWM + 死區(qū)

ADC 同步采樣（與 PWM 中心對齊同步）

2.2 必須具備的軟件模塊

PWM 配置（中心對齊，16kHz~20kHz）

ADC 多通道 + DMA + 定時器觸發(fā)

磁編碼器角度讀?。?1bit 高精度）

電流采樣偏置校準(zhǔn)

SVPWM 輸出

過流 / 過壓 / 過溫硬件保護(hù)

只要你前面的驅(qū)動板設(shè)計完成，即可直接移植 FOC。

三、FOC 算法標(biāo)準(zhǔn)架構(gòu)（5 大核心模塊）

移植時按順序?qū)崿F(xiàn)，不可跳過：

電流采集與偏置校準(zhǔn)

Clarke 變換（三相電流→兩相靜止坐標(biāo)系）

Park 變換（兩相靜止→兩相旋轉(zhuǎn) d/q 坐標(biāo)系）

PI 調(diào)節(jié)器（Id/Iq）

反 Park + SVPWM（輸出 6 路 PWM）

控制目標(biāo)：

Id=0（永磁體磁場方向不勵磁，效率最高）

Iq = 轉(zhuǎn)矩電流（控制力度）

四、FOC 算法完整移植步驟（工程可直接照做）

步驟 1：電機(jī)與系統(tǒng)參數(shù)定義

// 電機(jī)極對數(shù)（非常重要！）#define MOTOR_POLE_PAIRS    7// PWM頻率 & 控制周期#define PWM_FREQ            16000#define CONTROL_PERIOD      (1.0f / PWM_FREQ)// 電流采樣增益#define CURRENT_GAIN        0.01f#define VOLTAGE_BUS         24.0f

步驟 2：電流采集與零點(diǎn)校準(zhǔn)

FOC 對電流采樣零偏極其敏感，必須上電靜止校準(zhǔn)：

void Current_Offset_Calibrate(void){    for(int i=0; i

	

	步驟 3：Clark 變換（三相→二相靜止）

	
void Clarke_Transform(float Iu, float Iv, float *Ialpha, float *Ibeta){    *Ialpha = Iu;    *Ibeta = (Iu + 2 * Iv) * 0.57735f;}

	

	步驟 4：Park 變換（二相靜止→d/q 旋轉(zhuǎn)）

	
void Park_Transform(float Ialpha, float Ibeta, float theta, float *Id, float *Iq){    float sin_theta = sin(theta);    float cos_theta = cos(theta);    *Id = Ialpha * cos_theta + Ibeta * sin_theta;    *Iq = -Ialpha * sin_theta + Ibeta * cos_theta;}

	

	步驟 5：Id/Iq PI 控制器（核心）

	
void PI_Controller(PI_TypeDef *pi, float target, float feedback){    pi->err = target - feedback;    pi->integral += pi->err * CONTROL_PERIOD;    pi->out = pi->Kp * pi->err + pi->Ki * pi->integral;    // 限幅防止飽和    if(pi->out > MAX_VOLTAGE) pi->out = MAX_VOLTAGE;    if(pi->out < -MAX_VOLTAGE) pi-?>out = -MAX_VOLTAGE;}

	

	Id 目標(biāo) = 0

	Iq 目標(biāo) = 速度環(huán)輸出

	步驟 6：反 Park + SVPWM

	輸出 7 段式 SVPWM，產(chǎn)生平滑正弦波。

	步驟 7：速度環(huán) PI（外層）

	
目標(biāo)轉(zhuǎn)速 → 速度PI → Iq目標(biāo) → 電流環(huán)

	

	步驟 8：角度采集（MT6835）

	
theta = MT6835_Read_Angle() * 2 * PI / 2097152.0f;

	

	五、FOC 關(guān)鍵參數(shù)清單（調(diào)試必備）

	5.1 電機(jī)固定參數(shù)

	極對數(shù) P

	相電阻 Rs

	相電感 Ld、Lq

	母線電壓 Vbus

	5.2 電流環(huán) PI（內(nèi)環(huán)，最重要）

	Kp：比例增益（響應(yīng)速度）

	Ki：積分增益（消除靜差）

	5.3 速度環(huán) PI（外環(huán)）

	Kp：轉(zhuǎn)速響應(yīng)

	Ki：轉(zhuǎn)速穩(wěn)速

	5.4 限制參數(shù)

	最大電流 I_max

	最大電壓 V_max

	最大轉(zhuǎn)速 Speed_max

	斜坡上升時間

	六、FOC 標(biāo)準(zhǔn)調(diào)試流程（最快 30 分鐘調(diào)完）

	第一步：硬件檢查（必做！）

	電流采樣正常、無漂移

	編碼器角度遞增 / 遞減正常

	PWM 無異常、死區(qū)正常

	電機(jī)無短路、無卡死

	第二步：開環(huán)調(diào)試（強(qiáng)制角度）

	
角度固定遞增 → 電機(jī)按磁場旋轉(zhuǎn)

	

	目的：

	確認(rèn)相序 U/V/W 正確

	確認(rèn)電流采樣方向正確

	確認(rèn) SVPWM 正常

	現(xiàn)象：電機(jī)平滑旋轉(zhuǎn)，無嘯叫、無抖動。

	第三步：切入閉環(huán)（Id=0 控制）

	先關(guān)閉速度環(huán)，只開電流環(huán)

	給一個微小 Iq（如 0.1A）

	電機(jī)應(yīng)極平滑自轉(zhuǎn)

	第四步：速度環(huán) PI 調(diào)試

	先小 Kp，小 Ki

	逐步加大 Kp，直到轉(zhuǎn)速無靜差

	增加 Ki，消除穩(wěn)態(tài)誤差

	第五步：抗干擾與穩(wěn)定性優(yōu)化

	加積分限幅

	加電流斜坡

	加死區(qū)補(bǔ)償

	加低速濾波

	七、FOC 調(diào)試波形判斷（工程師核心技能）

	7.1 正常波形

	Iq 平滑跟隨

	Id 穩(wěn)定 = 0

	三相電流為完美正弦波

	無尖峰、無抖動、無噪聲

	7.2 異常波形

	電流尖峰：采樣噪聲 / 濾波不足

	電機(jī)嘯叫：PI 過大 / 相序錯誤

	電機(jī)抖動：角度讀取錯誤 / 極對數(shù)錯誤

	電流失真：死區(qū)不對 / ADC 不同步

	八、最常見問題與 100% 解決方法

	1. 電機(jī)抖動、不轉(zhuǎn)

	原因：

	極對數(shù)錯誤

	編碼器方向反

	相序 U/V/W 接錯

	解決：調(diào)換任意兩相。

	2. 電流大、發(fā)熱嚴(yán)重

	原因：

	Id≠0

	零偏未校準(zhǔn)

	采樣方向反

	解決：重新校準(zhǔn)電流偏置。

	3. 高速丟步、失步

	原因：

	速度環(huán) PI 太小

	電流環(huán)響應(yīng)不足

	編碼器噪聲

	解決：增大電流環(huán) Kp。

	4. 低速抖動

	原因：

	角度采樣噪聲

	死區(qū)補(bǔ)償缺失

	解決：增加角度濾波。

	5. SVPWM 輸出異常

	原因：

	ADC 與 PWM 不同步

	解決：配置為PWM 中心對齊觸發(fā) ADC。

	九、量產(chǎn)級穩(wěn)定化配置（最終優(yōu)化）

	電流采樣滑動平均濾波

	角度一階低通濾波

	死區(qū)時間自動補(bǔ)償

	積分抗飽和（Anti-Windup）

	過流立即封鎖 PWM

	啟動開環(huán)拖動 + 平滑切入閉環(huán)

	堵轉(zhuǎn)保護(hù)、過載保護(hù)、過溫保護(hù)

	完成后電機(jī)表現(xiàn)：

	0 速～最高速全程平滑

	無抖動、無嘯叫、無發(fā)熱

	定位精準(zhǔn)、響應(yīng)快

	審核編輯 黃宇