前言无论是能后空翻的机械狗如宇树科技、极度丝滑的大疆云台还是特斯拉的驱动电机它们底层的核心技术全都是同一个词——FOCField Oriented Control磁场定向控制。在电赛和毕设中如果你还在用传统的六步换向法电调驱动无刷电机低速时的抖动和巨大的噪音会让你显得非常“业余”。很多同学试图去学 FOC但翻开教材满屏的复平面、克拉克变换、帕克变换直接把人看懵用网上的开源库一旦电机抽搐面对几万行代码根本无从 Debug。今天我们将打破数学玄学剥开 FOC 的外衣你会发现所谓的空间矢量变换在 C 语言中只不过是几行极其简单的加减乘除。本文手把手教你理解 FOC 闭环本质并排掉**相电流采样ADC**这个让无数硬件狗炸管的史诗级大坑TOC一、 FOC 的底层哲学把交流电变成直流电无刷电机有三根线A、B、C里面跑的是三个相位相差 120° 的正弦交流电。要控制三个随时间不断变化的交流电对单片机里的 PID 控制器来说简直是地狱难度PID 最怕目标值疯狂变化。FOC 的核心哲学只有一个降维打击既然三相交流电太难控我们就通过数学变换把它们强行转换成两个静止的直流电Id直轴电流产生无用的磁场让电机发热的力我们的目标是用 PID 把它死死控制在 0。Iq交轴电流产生推动电机旋转的力矩有用的力你给的 Iq 越大电机的扭矩就越大。我们要用 PID 精准控制这个 Iq结论FOC 就是一个把复杂的三相交流电变成 Id 和 Iq 两个简单的直流变量然后用两个普通的 PID 去控制它们的过程。二、 撕开数学伪装Clarke 与 Park 变换的 C 语言真面目教科书上的矩阵公式看起来吓人但写成 C 语言代码简单得让人心疼。1. Clarke 变换三相变两相物理定律告诉我们电机三根线流进流出的电流总和永远为 0基尔霍夫定律IaIbIc0IaIbIc0。所以我们其实只需要用 ADC 测两根线比如 A 和 B的电流就能算出第三根。Clarke 变换就是把互成 120° 的 3 个电流Ia,Ib,IcIa,Ib,Ic变成互成 90° 直角的 2 个电流Iα,IβIα,Iβ。C 语言极简代码直接抄codeC// 假设已经通过 ADC 测到了 A相 和 B相 的真实电流 Ia, Ib float I_alpha, I_beta; void Clarke_Transform(float Ia, float Ib) { I_alpha Ia; // sqrt(3)/3 ≈ 0.577350269f // 公式推导极其复杂但代码只有这一句 I_beta 0.577350269f * (Ia 2.0f * Ib); }2. Park 变换旋转变静止核心魔法上面算出来的IαIα和IβIβ依然是交流电因为电机的转子在疯狂旋转。Park 变换就是让我们的观察视角跟着电机的转子一起转这样在我们的眼里相对速度为 0交流电就变成了完美的直流电IdId和IqIq。这需要知道当前电机转子的绝对角度θθ通过磁编码器如 AS5600 瞬间读出。C 语言结合 CMSIS-DSP 加速代码codeC#include arm_math.h float Id, Iq; void Park_Transform(float I_alpha, float I_beta, float theta) { float sin_theta, cos_theta; // 利用 STM32 底层 DSP 硬件加速极速求出 sin 和 cos arm_sin_cos_f32(theta * 57.29578f, sin_theta, cos_theta); // 旋转坐标系矩阵乘法 Id I_alpha * cos_theta I_beta * sin_theta; Iq -I_alpha * sin_theta I_beta * cos_theta; }看到这里你明白了吗困扰无数人的两大数据变换在单片机里总共只需要3 行数学运算代码利用算出来的 Id 和 Iq你就可以开心地送进你最熟悉的 PID 控制器里了三、 FOC 的输出引擎为什么不用 SPWM 而用 SVPWMPID 计算完了我们得到了期望的电压输出。怎么把电压作用到电机的三根线上很多人以为是输出三个正弦波SPWM。错工业界绝不用 SPWM而是用 SVPWM空间矢量脉宽调制为什么要用 SVPWM马鞍波如果用纯正弦波SPWM你最多只能利用电源电压的 86.6%。SVPWM 巧妙地在正弦波中注入了三次谐波。你用示波器去测电机的相电压会看到一个奇丑无比的**“马鞍形”波形**像麦当劳的 M 标志。但是两个马鞍波相减线电压正好是一个极其完美、幅度更大的纯正弦波收益电源电压利用率直接飙升到100%在同样的电池下你的电机能输出更大的极限扭矩(SVPWM 的代码涉及扇区判断和 T1, T2 作用时间计算大约 50 行代码篇幅原因此处不展大家可以套用开源的标准实现。)四、 史诗级硬件灾难相电流采样ADC的生死时速FOC 所有的数学计算都建立在你准确测到了电机的相电流Ia,IbIa,Ib的前提下。这是整个 FOC 乃至电赛中最容易让单片机死机、让 MOS 管炸裂的天坑 避坑 1采样方式的选择In-line串联采样在电机的线上串联极小的采样电阻。非常准但需要极其昂贵的双向高共模运算放大器如 INA240。Low-side下桥臂采样在三个下桥臂的 MOS 管下面串联采样电阻。成本极低几毛钱的普通运放即可但对单片机的 ADC 触发时序要求严苛到变态 避坑 2下桥臂采样的“幽灵时序”因为采样电阻串联在下方只有当电机的 下桥臂 MOS 管导通时才有电流流过电阻如果你用 while(1) 随意触发 ADC你大概率采到的是 0或者是 MOS 管开关瞬间高达上百安培的巨大尖峰噪声。这时候你的 Clarke 变换全乱了PID 输出核弹级指令电机瞬间冒烟 终极解决架构定时器中央对齐 CCR4 触发 ADC与上一篇《定时器外挂指南》梦幻联动必须利用硬件级自动化对齐配置 TIM1 产生 SVPWM 时必须设置为中心对齐模式Center-aligned Mode。在这种模式下下桥臂的导通时间总是分布在计数器达到最大值或者 0的中间激活 TIM1 的第 4 通道CCR4将其比较值设置在计数器即将达到最高点的前 1 微秒用 TIM1 的 CCR4 比较事件TRGO去直接硬件触发 STM32 的 ADC威力CPU 根本不需要操心硬件会在每一个 PWM 周期的绝对正中心此时 MOS 管稳定导通且完美避开了开关瞬间的电流毛刺精准截取真实的相电流。采出来的电流波形平滑得像丝绸你的 FOC 闭环系统将坚如磐石五、 FOC 极简工作流全景图别被代码文件绕晕了FOC 的主循环其实是在定时器溢出中断通常为 10kHz~20kHz中执行的流程极其清晰codeCvoid FOC_High_Frequency_Loop(void) { // 1. 读角度 float theta AS5600_Get_Angle(); // 2. 读真实电流 (ADC 硬件触发已经采好了) float Ia Get_ADC_Current_A(); float Ib Get_ADC_Current_B(); // 3. 变换为直流 Clarke_Transform(Ia, Ib); Park_Transform(I_alpha, I_beta, theta); // 得到当前真实的 Id, Iq // 4. PID 闭环计算 (我们的目标是 Id0, Iq目标扭矩) float Vd PID_Calc(PID_Id, 0.0f, Id); float Vq PID_Calc(PID_Iq, Target_Torque, Iq); // 5. 逆向变换回去(怎么来的怎么回去) Inv_Park_Transform(Vd, Vq, theta); // 得到 V_alpha, V_beta // 6. 送给空间矢量调制器硬件生成 6 路 PWM 去驱动 MOS 管 SVPWM_Generate(V_alpha, V_beta); }这就是 FOC 的全部没有任何黑魔法只有优美的数学与严密的硬件时序控制结语在嵌入式开发的鄙视链中纯手写底层 FOC 无疑处于最高端的塔尖。它要求你同时具备模拟电路知识运放采样、数字电路知识ADC与定时器联动、自动控制原理PID、以及空间数学变换能力。不要再去死记硬背那些枯燥的数学矩阵理解 FOC 降维打击的哲学不要去畏惧下桥臂采样的复杂拥抱 STM32 底层硬件联动的美感。当你亲手写出的第一行 FOC 代码让那个满是磁铁和线圈的无刷电机以 0.1 转/分的极慢速度丝滑旋转并在你用手捏住它时反馈给你如同拥有生命一般的肌肉弹力时……你就会明白硬核科技的浪漫莫过于此。预祝各位挑战极限的开发者ADC 采点精准无误PID 闭环稳如泰山斩断玄学手搓 FOC 震撼全场
