FOC算法实战指南：从磁场定向控制到SVPWM调机

你有没有遇到过这样的情况：同一块电机驱动板，别人跑起来顺滑、安静、加速跟脚，你跑起来要么嗡嗡响，要么低速一抖一抖，稍微一堵就过流报警。如果这种场面你很熟，那大概率是和FOC 算法还没磨合好。FOC（Field Oriented Control，磁场定向控制）这个名字听起来很吓人，但说白了，它就是把三相电机的电流控制这件事，从“交流世界”搬到“直流世界”去做。这篇内容不是教科书讲解，而是我这么多年调电机的一点总结：FOC 到底在干什么、各个环节之间怎么咬合、从裸板到电机顺利转起来要经历什么，以及在现场最容易踩的那些坑。

这套算法适合谁？如果你在做无刷电机驱动、无人机电调、机器人关节、云台、水泵或者电动工具的驱动板，又或者是刚接触矢量控制的嵌入式工程师，这篇文章应该能帮你少走不少弯路。我会尽量把公式讲成人话，把调试顺序讲成步骤，把常见故障讲成“你自己也能查出原因”的排查清单。

1. FOC到底在干什么：坐标系变换这道坎

1.1 为什么非要把三相交流量变成直流量

三相永磁同步电机（PMSM）或者无刷直流电机（BLDC），本质上都是靠定子旋转磁场拉着转子转。传统方波控制是六个扇区轮流通电，简单粗暴，但换相点把握不好就会抖动、有噪音，而且低速转矩脉动大。FOC 的思路完全不一样：它不去关心每一相电流的瞬时正弦波形，而是把三相电流合成一个方向和大小的“电流矢量”，然后把这个矢量放在一个跟随转子旋转的坐标系里，你会发现它变成了缓慢变化的直流量。

为什么这么做？因为 PID 控制器的强项是控制恒定目标，让它跟踪一个正弦波当然也能做，但跟踪直流量要容易得多，稳态误差也小得多。这就是 FOC 的核心逻辑：用两次坐标变换，把交流问题变成直流问题，再把直流目标通过逆变换还原成三相电压输出。

整个过程容易让人懵的地方也在这里：正变换把三相电流变成旋转坐标系下的 Id、Iq，逆变换又把旋转坐标系下的电压变成三相电压。正着转一圈，反着转一圈，如果中间任何一个角度不对，电流环就会疯掉。理解了这一点，后面的公式就好背了。

1.2 从abc到dq，公式其实就四行

先聊 Clarke 变换：把三相静止坐标系的 Ia、Ib、Ic，变成两相静止坐标系的 Iα、Iβ。因为电机三相电流星形连接时 Ia + Ib + Ic = 0，所以通常只用两个采样电流就能算出第三相：

Ialpha = Ia; Ibeta = (Ia + 2.0f * Ib) * INV_SQRT3;

这里 INV_SQRT3 是 1/√3，系数来自等幅值变换的约定。要注意等幅值和等功率变换的系数不同，网上代码经常打架，其实就是这个系数差了 √(2/3) 和 √3 的区别。

再聊 Park 变换：把 Iα、Iβ 旋转到随转子磁场同步旋转的 dq 坐标系。θ 是转子电角度，也就是转子磁极方向和静止 A 相轴线的夹角。公式同样很干净：

Iq = Ibeta * cosf(theta) - Ialpha * sinf(theta); Id = Ialpha * cosf(theta) + Ibeta * sinf(theta);

从公式看，Id 是分解到磁极方向的电流，Iq 是分解到垂直磁极方向的电流。Id 负责励磁（改变磁场大小），Iq 负责出力（产生转矩）。工程上最常见的是 Id = 0 控制，也就是不让定子电流去削弱或增强转子磁场，所有电流都用来做功。这种控制简单高效，凸极率不高的表贴式电机非常适用。在逆变换时，反 Park 和逆 Clarke 就是把电压指令从 dq 系变回 abc 系，公式方向和正变换相反：

Valpha = Vd * cosf(theta) - Vq * sinf(theta); Vbeta = Vd * sinf(theta) + Vq * cosf(theta); Va = Valpha; Vb = -0.5f * Valpha + INV_SQRT3 * Vbeta; Vc = -0.5f * Valpha - INV_SQRT3 * Vbeta;

很多人在这一步踩坑，在于 Park 和反 Park 的正负号约定。我的建议是：不要同时记好几套符号体系，认准一套，每次都用同一套，即使坐标轴方向定义和别人不同，只要正反变换自洽，就能转起来。

2. 拆开看核心环节：采样、PI、SVPWM

2.1 电流采样：看不见电流，FOC就是瞎转

FOC 的一切判断都建立在准确电流值上，电流采样是第一个容易出问题的地方。常见方案有三电阻采样、双电阻采样和单电阻采样。三电阻采样用得最普遍：三个下桥臂分别串联采样电阻，在 PWM 周期内某一时刻同时采集三相电流，重构出两相即可。双电阻采样是采两相而第三相用关系式计算，能省一路运放，但在某些扇区两相有效脉冲太窄时采样精度会变差，需要用移相或者中心对齐补丁来处理。单电阻采样则是完全依赖直流母线上一个电阻，利用不同开关状态下电流通路不同，把一个 PWM 周期分成多段，在多个时刻采样再拼凑三相电流，这种方法成本最低但对 ADC 时序要求极高，一般新手不推荐一上来就用。

采样时机是我重点想强调的。PWM 输出用中心对齐模式时，载波顶部和底部都能看到三相下桥同时导通，这时电机三相电流都通过下桥臂回流，是采样的黄金窗口。我一般在 PWM 计数器的周期中断里触发 ADC，然后等 ADC 转换完成后进入控制中断，这样能保证采到的电流是 PWM 周期中点附近的电流，避开开关噪声。很多朋友采样毛刺大，其实不是运放不好，而是采样时刻正好落在了上下桥切换瞬间，这时候母线电压被短路，采样当然一塌糊涂。

还有一件事必须做：电流零点校准。运放和 ADC 不可能绝对零偏，零点漂移会让 dq 电流存在固定偏置，表现就是电机静止时 Id、Iq 不为零，带负载时电流畸变明显。我习惯在电机启动前，三个下桥全部打开，把母线电流为零时的 ADC 采样值取平均保存为 offset，每次电流计算前减去这个值。校准这一步看似简单，但对整个控制精度的提升立竿见影。

2.2 三个环怎么套在一起

FOC 的骨架是三闭环：从内到外分别是电流环、速度环、位置环（如果需要的话）。电流环是根本，必须在最里面，因为电流响应直接影响转矩响应。电流环一般使用 PI 控制，执行频率在 10kHz 到 20kHz 之间，也就是控制周期 50 到 100 微秒。速度环放在外面，执行频率可以低一些，比如 1kHz 或者 2kHz。位置环大多数时候在外围，用简单的 P 或 PID 就能满足要求。

三个环的执行顺序是：外层环输出作为内层环的目标，内层环计算完成后产生 PWM 占空比。举个例子，位置环输出一个目标转速，速度环根据目标转速和实际转速的误差输出目标 Iq，电流环再根据目标 Iq 和实际 Iq 的误差输出 Vq，最后经过逆变换和 SVPWM 生成六个桥臂的占空比。这里有一个优化细节：Id 的目标很多情况下就是 0，速度环只调整 Iq，但弱磁控制时 Id 目标会变成负值，需要额外处理，这篇先不展开。

电流环 PI 参数怎么给初值？我自己的经验是从电机的相电阻 Rs 和相电感 Ls 出发。如果电机时间常数 τ = Ls / Rs 已知，可以把 PI 的零点放在电机极点附近，也就是 Ki / Kp ≈ Rs / Ls，然后根据期望的带宽 ωc 来定 Kp ≈ ωc × Ls。我调表贴式电机时，常用带宽 1000 到 2000 rad/s 作为起点，再配合示波器看阶跃响应，超调大就降 Kp，静差大就补 Ki。理想很丰满，但实际中电感会随电流饱和变化，所以参数还是要现场微调。

2.3 SVPWM：输出正弦电压的关键

逆变器只有六个开关管，每相输出要么接到母线正端要么接到负端，看起来只能生成方波，怎么给电机提供正弦电压？答案是靠 PWM 的平均效果，也就是在一个开关周期内让每相平均输出电压等于目标正弦值。SVPWM 更进一步：它不单独看待三相电压，而是把三相目标电压合成为一个电压矢量，然后用八个基本开关状态里的两个相邻矢量去合成它，这就是伏秒平衡的思想。

SVPWM 的工程实现流程是：先判断目标电压矢量落在哪个扇区，然后计算两个相邻基本矢量在一个 PWM 周期内分别作用的时间 T1、T2，零矢量填满剩余时间。常见七段式 SVPWM 把零矢量对称地放在开头、中间和结尾，好处是电流纹波小，但开关次数多一些；五段式或者称不连续 PWM，把零矢量集中放在一端，可以减少开关损耗，适合对效率更敏感的场合。我做机器人关节电机时一般用七段式，因为关节电机对噪声和纹波敏感，切换损耗不是主要矛盾。

写代码时不用真的去算扇区反正切，可以直接根据 Vα、Vβ 的大小关系判断扇区，再用统一的中间变量计算 T1、T2，最后做饱和限幅。有一个常见错误很值得和你们提一句：当 T1 + T2 大于 PWM 周期时，一定要等比缩放，否则电压矢量会超出线性调制范围，波形发生畸变，电机电流剧烈波动。

3. 实操记录：从一块裸板到电机转起来

3.1 先把电机参数摸清楚

拿到一块新电机，不要急着接驱动板上电，先把几个基础参数测出来。极对数是最容易的：用手慢慢转电机，用示波器看任意两相间反电动势一个完整周期的角度，再用机械角度换算。其实很多电机的参数铭牌上已经写了，比如“380KV”之类的多旋翼电机参数。极对数虽然简单，但搞错了后果很严重，角度和频率会全部错位，电机直接飞车或者堵转。

相电阻的测量方法是：用可调电源给两相之间加一个低压直流电，测出电压和电流，根据 R = U / (2I) 算出单相电阻。注意电流别太大，别把绕组烧了，一般给到额定电流的 10% 到 20% 就够。相电感可以用 LCR 表在 1kHz 附近测，或者用伏安积分法：给绕组加一个阶跃电压，记录电流上升曲线，通过时间常数反算电感。不过电机绕组的电感在不同转子位置下有差别，粗略算的平均值也能作为调参起点。

最后一个参数是永磁磁链 ψf。最可靠的方法是把电机拖到一个固定转速，测量两相线电压的峰值 Upp，然后反电动势常数和磁链之间有一个换算关系。我一般不单独测磁链，而是直接通过反电动势常数来推：ψf ≈ Ke / (极对数 × ω) 这种换算，调无感的时候更常用。这些参数不用特别精确，能进对数量级就行，因为 PI 参数最后还要现场整定。

3.2 开环拖起来再说

新板子千万别一上来就合电流环。我的习惯是先用开环 V/F 控制把电机拖起来，验证功率管、驱动、采样和电机本身都正常。

具体做法是：给定一个固定的角度增量，让电压矢量的角度以恒定速度旋转，同时给一个恒定的电压幅值，比如初始给额定电压的 10%。如果电压太弱电机可能不转，太大会过流。这种开环方式其实相当于在拖着一个失步的同步电机，能不能转起来看负载。我一般递增频率，在 10Hz 左右开始给 1V 左右电压，观察是否电流平滑、有没有过流报警、电机是否平滑跟转，然后再继续增加频率到 50Hz 左右，确认整个基础链路是通的。开环时一定把电流限制加好，建议初始把限流值设到额定电流的一半，避免烧管。

开环能稳定转了，才说明硬件没有大问题，这是所有后续调试的地基。很多新手跳过这一把，结果后面电流环调半天转不起来，最后发现是驱动芯片配置错了，很耽误时间。

3.3 合上电流环，让电流听话

开环跑通以后，开始切换闭环。首先要做的是确保电角度准确。如果是带编码器的系统，需要把编码器零位和电机 A 相轴线对齐。

对齐方法很多，最简单的是通过一个固定的电压矢量，比如让 Vd = 2V，Vq = 0，此时定子磁场会被强行拉向 A 相轴线，电机转子会转到一个固定位置。在这个位置记录编码器的值，作为电角度零点。注意这个位置只是近似零点，如果要求高精度，可以用多个方向的电压矢量取平均误差。零点对齐错一两个电角度，电流环还能勉强工作，但出力效率会下降；错得多了，电流和力矩关系就会错乱，表现就是运行中电流大但力矩小，电机发热严重。

零点对齐之后，把 dq 轴电流环断开放入闭环：Id_ref = 0，Iq_ref 给一个斜坡爬升，观察实际 Id、Iq 是否跟随。我习惯在直流母线供电测控，看 dq 平面上的李萨如图形，理想状态它是一个很窄的线段，而不是一片混沌的云。如果 Iq 给 1A，实际 Iq 超调到 2A 以上，就说明 PI 带宽太高；如果阶跃响应慢吞吞的，则带宽太保守。反复调整 Kp、Ki，直到电流环阶跃响应又快又稳，大概几个 PWM 周期内稳定住，电流闭环就算过关了。

3.4 速度环和角度对齐

电流环稳定后，速度环就简单多了。速度反馈用编码器测速，或者用测速周期法在低速时提高分辨率。速度环 PI 参数比电流环好调很多：先给一个目标转速，看实际转速的跟踪情况，超调大就减小 P，稳态误差固定就加 I。注意积分限幅一定在饱和范围内，否则负载变大时会出现明显超调，这在机器人关节上会表现为“硬邦邦”的冲击感。

还有一个不能忽略的细节：速度环输出限幅要与电流环最大输出匹配。速度环输出的是 Iq_ref，如果限幅过大，电流环会被瞬间打饱和，导致启动电流冲击；限幅过小，又拉不动重负载。我一般把 Iq_ref 上限设为额定电流的 1.5 倍左右，堵转保护再降一些。编码器线的屏蔽和接地问题也要重视，我遇到过电机快速运行时角度抖动，导致电流波形锯齿明显，最后排查发现是编码器线干扰，加磁环和重新走线后恢复正常。

4. 无感FOC：把编码器扔掉之后

4.1 无感的思路：从电流与电压中估计角度

很多应用场景不给装编码器的空间和预算，比如家用风扇、水泵、部分无人机，那就得做无感 FOC。无感并不是真的没有角度，而是要靠算法从电流和电压中“反推”转子角度。原理上讲，反电动势里含有转子磁场的位置信息，所以只要能在运行时观测出反电动势，就能算出电角度。电机的电压方程里，定子电压减去电阻压降和电感压降后剩下的就是反电动势项，反电动势的相位与转子磁场位置直接相关。

但这里有一个天然的弱点：反电动势的幅值和转速成正比，在零速和极低速时信号太小，几乎被噪声淹没。这就是无感 FOC 低速启动困难的根本原因。所以成熟的无感方案一般分两段：低速时用特殊的开环强制拖动或者高频注入，中高速时切换到反电动势观测器（如滑模观测器 SMO、龙伯格观测器），中间做好切换逻辑。

4.2 滑模观测器怎么看电角度

滑模观测器是工业界用得最广的无感方案之一。它把电流估算值和实际电流的误差通过符号函数反馈进观测器模型，由于滑模面的非连续特性，能强迫观测电流跟随实际电流，这时等效控制量里就包含了反电动势信息。再用低通滤波把高频抖振滤掉，就得到估算的反电动势。得到反电动势后，一般通过锁相环（PLL）或者反正切求出电角度。相比直接反正切，锁相环对噪声更友好，因为它是一个闭环跟踪过程，角度变化速率也存在约束，不容易因为个别噪声点突跳。

SMO 调起来需要注意两点：第一，滑模增益必须足够大才能保证收敛，但太大又会放大抖振，引起电流噪声和啸叫；第二，低通滤波器的截止频率不能太低，否则相位延迟过大会导致估算角度滞后，影响电流环性能，严重的会造成高速失步。我通常的做法是做一个角度补偿：根据当前转速和滤波器相位响应，对估算角度做前馈补偿，让反馈到坐标变换的角度更贴近真实值。无感启动时先开环强拖，转速到一定值（比如额定转速的 5% 到 10%）后再切换闭环，避免零速直接切带来的失步。

4.3 零速和低速时的高频注入

如果要求电机零速就能输出大力矩，比如伺服电动缸、低速高精度的转台，那就要上高频信号注入法。这个方法的物理基础是凸极性：很多内置式永磁电机（IPM）的 d 轴和 q 轴电感不同，转子位置不同，定子绕组对高频激励的阻抗响应就有差别。通过注入一个高频电压信号并解调相应的高频电流，就能得到转子位置信息，而且是真正的零速观测，不依赖反电动势。但高频注入本身会带来额外的损耗和噪音，而且解调算法复杂一些，工程上一般不单独存在，而是和 SMO 配合：零速和低速用高频注入，中高速切到反电动势法。切换点附近要做一个滞环，防止在边界反复跳变。对新手来说，无感不是从零开始就合适，我建议至少先在有感情况下把电流环和速度环调通，再切无感会有更清晰的问题定位能力。

5. 调机现场：那些坑我已经替你踩过了

5.1 常见问题速查表

调试过程中遇到的问题往往就那么几类，我整理了一个速查表，自己在现场也经常翻：

表格里列的是最常见的情况，现场判断时不要只看表面现象。比如电机抖动，表面看是电流环振荡，实际可能是编码器零点漂了，也可能是采样时序不对。如果只调 PI 参数而不去查根因，问题永远反复出现。

5.2 我的调试习惯和三条心得

最后分享几条我自己的调试习惯，写在最后是因为它们往往比具体某个算法更能救你一把。

第一，每次上电前检查三相输出波形。我用示波器直接看电机三相对中点电压的波形，确认 PWM 占空比指令正确、每相互补信号没有直通，才敢让电机转起来。一次直通就可能烧掉好几个 MOS，这个成本比买示波器高多了。

第二，给每个通道留好测试点。在驱动板上把三相采样点、母线电压、编码器 A/B 信号都引出排针，调试时不用飞线到处刮，能省很多时间。我在 PCB 打样时都会要求把关键信号引到一边，方便接逻辑分析仪和示波器。

第三，一切改动都小步走。每改一个参数只记录一项项变化，不要几个参数一起改。很多时候你以为把 PI 调好了，结果其实是另一个 bug 碰巧掩盖了问题。用表格记录每次修改的参数和现象，这个习惯坚持下来，排查问题的速度会快很多。

现在回到最常见的那句话上：电机“转起来”不是结束，是调试的开始。很多项目前期顺利，一上现场就出问题，其实大概率出在抗干扰和异常处理上。加一点母线电压前馈、适当增大输出滤波，甚至更改一下 PWM 中心对齐的方向，都能带来完全不同的手感。做电机控制的乐趣也就在这：单纯的公式和算法只是骨架，真正有意思的是把每一个环节打磨到在真实工程环境下也能稳定工作。