FOC算法实战：从理论到代码的电机控制之旅-开发者社区

1. FOC算法基础：从物理模型到数学变换

第一次接触FOC（磁场定向控制）时，我被它优雅的数学转换惊艳到了。想象你手里有个无刷电机，三根电线接上去，电机就转起来了——但要让这个电机像伺服电机那样精准控制，就需要FOC这套"翻译官"系统。

FOC的核心思想其实很简单：把复杂的三相交流电控制，转换成类似直流电机的控制方式。就像把中文翻译成英文，再翻译回中文一样，FOC通过两次坐标变换（Clark和Park变换）实现了这个魔法。

Clark变换就像把三个不同方向拉扯的绳子，合并成两个互相垂直的力。具体来说：

三相电流(ia,ib,ic)在空间上互差120°

通过公式转换为两相正交系统(iα,iβ)：

i_alpha = ia i_beta = (ia + 2*ib)/sqrt(3) # 假设ic = -ia - ib

Park变换更妙，它把静止坐标系转换到跟着转子旋转的坐标系：

id = i_alpha*cos(theta) + i_beta*sin(theta) iq = -i_alpha*sin(theta) + i_beta*cos(theta)

这样，原本正弦变化的交流量，就变成了可以轻松用PID控制的直流量。我在STM32上实测时，原本抖动的电机，在启用FOC后立刻变得丝般顺滑。

2. 硬件搭建：从开发板到电机驱动

实际动手时，你需要准备：

开发板（STM32F4系列就够用）
三相逆变桥（DRV8302模块很方便）
电流采样电阻（50mΩ/1%精度）
编码器（AS5048A磁编码器性价比高）

接线时有个坑要注意：电流采样相位必须与PWM输出严格同步。我有次把采样点放在PWM周期中间，结果电流波形全是毛刺。后来改成PWM关闭瞬间采样，波形立刻干净了。

配置定时器时，建议：

// STM32CubeIDE配置示例 htim1.Instance = TIM1; htim1.Init.Prescaler = 0; htim1.Init.CounterMode = TIM_COUNTERMODE_CENTERALIGNED3; htim1.Init.Period = 999; // 对应24kHz PWM频率 htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;

中心对齐模式能减少谐波，实测比边沿对齐模式温升降低15%。

3. SVPWM实现：六步换相的艺术

空间矢量PWM（SVPWM）是FOC的执行层。它将电压指令转换为具体的MOS管开关状态。我把它想象成"电子换向器"，比直流电机的机械换向器聪明多了。

关键步骤：

扇区判断：根据角度θ确定当前所在60°扇区

矢量作用时间计算：

T1 = sqrt(3)*Ts*Ubeta/UDC T2 = (Ts/UDC)*(sqrt(3)*Ualpha - Ubeta) T0 = Ts - T1 - T2 # 零矢量时间

PWM占空比分配：不同扇区有固定切换顺序

我在Arduino Due上实现时，发现用查表法比实时计算快3倍：

const uint8_t svpwm_seq[6][6] = { {1,3,2,6,4,5}, // 扇区1 {3,1,5,4,6,2}, // 扇区2 // ...其他扇区 };

4. 闭环控制：PID调参实战

FOC通常采用三级闭环：

电流环（最内环）：响应最快，带宽>1kHz

// 典型PI参数（单位：标幺值） pid_iq.Kp = 0.05; pid_iq.Ki = 0.0001;

速度环：带宽约100Hz

pid_speed.Kp = 0.8; pid_speed.Ki = 0.05;

位置环：带宽<10Hz

调参时有个诀窍：先用开环强制输出固定电压，观察电机电流波形。正常应该是完美正弦波，如果出现畸变，可能是：

相序接反（调换任意两相）
编码器方向错误（改A/B相极性）
电流采样偏移（加软件校准）

我在云台项目中发现，加入前馈控制后，响应速度提升40%：

// 速度前馈计算 ff_term = 0.2*velocity_cmd + 0.01*acceleration_cmd;

5. 进阶优化：从理论到工业级应用

要让FOC达到工业级性能，还需要处理这些细节：

死区补偿：

// 补偿电压计算公式 V_comp = (dead_time * f_pwm * V_bus) / (2 * π * f_current)

实测补偿后，低速转矩脉动减少60%。

参数自整定：

自动测量相电阻（输出小直流电压测电流）
自动测量电感（用PWM阶跃响应法）
自动识别磁极位置（高频注入法）

过调制处理：当指令电压超过最大输出能力时，采用圆限制算法：

Vmax = Vdc/sqrt(3) if sqrt(vd**2 + vq**2) > Vmax: scale = Vmax / sqrt(vd**2 + vq**2) vd *= scale vq *= scale

6. 常见问题排查指南

遇到电机不转？按这个顺序检查：

电源：用示波器看母线电压是否稳定
PWM输出：确认6路PWM都有输出
电流采样：空载时三相电流应该接近零
编码器：转动电机时角度值应连续变化

有个隐蔽的bug我花了三天才解决：MOS管栅极驱动电阻太大（100Ω），导致开关延迟，使电流采样时刻错位。换成20Ω后问题消失。

7. 实战案例：四轴飞行器电调改造

用STM32G4改造成本不到50元的FOC电调：

去掉传统六步换相逻辑
加入基于磁编码器的位置反馈
实现力矩控制模式

改造后效果：

启动转矩提升3倍
低速稳定性显著改善
功耗降低20%

关键代码片段：

void FOC_Update() { // 1. 读取编码器 theta = AS5048_ReadAngle(); // 2. Clark变换 i_alpha = ia; i_beta = (ia + 2*ib) * ONE_BY_SQRT3; // 3. Park变换 id = i_alpha*cos(theta) + i_beta*sin(theta); iq = -i_alpha*sin(theta) + i_beta*cos(theta); // 4. PID计算 vq = PID_Run(&pid_iq, iq_cmd - iq); vd = PID_Run(&pid_id, 0 - id); // 通常令id=0 // 5. 反Park变换 valpha = vd*cos(theta) - vq*sin(theta); vbeta = vd*sin(theta) + vq*cos(theta); // 6. SVPWM生成 SVPWM_Gen(valpha, vbeta); }

最后分享一个调试技巧：用Excel实时记录电流、角度、PID输出等数据，绘制波形图比单纯看示波器更直观。我通常采样1万组数据，能清晰看到控制环路的效果。