“P0.FOC基础知识”——我猜很多人看到这个标题的第一反应，是“又一个讲矢量控制的科普文”。但真在电机驱动这行待过几年的人，看到FOC这三个字母，脑子里弹出的信息量完全不是一个量级的：坐标变换、电流采样、SVPWM、PID整定、转子观测、启动策略……任何一个环节没搞透，电机在台架上就可能叫得比工地还热闹。这篇东西是我自己从方波驱动转到FOC控制之后，把基础知识重新梳理了一遍的总结，用到过、验证过、也翻过车。不管你是刚入行的嵌入式工程师、做电驱的硬件佬，还是整天和“pmsm无感foc”纠缠的算法新兵，这篇都值得你花点时间，把它当一个能落地的FOC入门地图来看。
1. FOC到底在控制什么？——别急着碰代码，先搞懂“磁场定向”这四个字
1.1 三相电机的终极难题：电磁转矩到底听谁的话
任何电机控制算法的归宿，最终都落在“转矩控制”上。PMSM（永磁同步电机）的转矩公式，说白了可以写成一个极简的表达式：Te = kt × Iq。这里的Iq是交轴电流，是真正产生旋转力矩的分量。但问题是，电机外面接的是三相绕组，通进去的是三相交变电流，ia、ib、ic三个东西在空间上相差120度，时间上也互相错开。你坐在控制板旁边，看到的是一堆零碎又时刻变化的数值，根本说不清“这一瞬间电机到底输出了多少转矩”。
这时候就需要转换视角。物理里有个最朴素的方法——换坐标系。把三相静止坐标系下的交流量，逐步变换到一个和转子同步旋转的坐标系里，那个坐标系只有两个轴：一个叫d轴，方向对着转子磁极；另一个叫q轴，方向和d轴差90度。如果这个变换做成功了，原来三个扑朔迷离的交流分量，就变成了d轴和q轴上的两个直流量。一旦变成了直流量，你的PID控制器就能像控制直流电机一样去控制它，思路瞬间简单了七八成。
1.2 什么叫做“磁场定向”？定向的其实是“位置角”
“磁场定向控制”这个中文译名，常常让人一头雾水。其实它的英文Field Oriented Control，强调的是把定子电流产生的磁场，精确地“定向”在某个参考轴上。关键在于你得知道转子磁极此刻在哪个角度。不管是装编码器、霍尔，还是用无感的观测器算法，你都需要拿到一个电角度θ，这才是整个FOC的“心脏信号”。
为什么θ这么重要？因为d轴、q轴不是物理上存在的坐标轴，它们每时每刻跟着转子转。转子转到哪个角度，你的dq坐标系就得跟着转到哪个角度。如果你拿到的θ滞后了或者超前了，那本来该100%作用在q轴上的电流，就会有一部分漏到d轴上去。表现出来的现象就是：同样的给定电流，转矩变软、效率变低、电机发热，严重点甚至会失步或者抖振。所以你可以把FOC整个系统的鲁棒性，直接理解成对角度估计误差的容忍度问题，这一个认知非常关键，后续调无感算法时你会反复用得上。
1.3 为什么要转换成“直流量”？——降维打击其实是控制界的家常便饭
很多新手不理解：为什么非要把交流变成直流？交流量控制得好好的，搞什么Park变换？原因很简单，交流量在PID控制器面前并不好伺候。经典的PI控制器只在直流输入下才能做到无静差跟踪，因为PI内部的积分器对恒定目标的累积作用才最有效。你如果拿一个正弦信号跟在另一个正弦信号后面跑，相位稍有偏差，跟踪误差就是一个高频波，PI调来调去都跟不上。对应到工程实际中，扭矩波动、噪声、低速抖动都是这种跟踪失效的表现。
而坐标变换后，d轴、q轴的电流指令一般是恒定值（在稳态工况下），PI调节器就有了用武之地。整个FOC的控制链虽然包含交流电压许多环节，但最内层的电流环，本质上是两个独立的PI调节器：一个管d轴，一个管q轴，这就是“直流化控制”的真正意义。这跟你在一个旋转的世界里坐旋转木马是一个道理，你手里的参照系跟着木马一起转，你看到的周围一切就是静止的。
2. 坐标变换那点事：Clarke、Park与SVPWM之间的三角关系
2.1 Clarke变换：先降维，把三相的麻烦压缩到两相
FOC第一座桥，叫Clarke变换，也叫3→2变换。它干的事情很简单：把三相绕组的电流ia、ib、ic，投影到两相静止坐标系α-β上。这个坐标系横轴是α，纵轴是β，空间上互相垂直。
数学上就是下面这一组式子（等幅值变换）：
iα = ia
iβ = (ia + 2ib) / √3
注意，因为在三相对称系统中ia + ib + ic = 0, 所以很多实现里干脆省略掉ic的采集，用上面两式直接算。这里要提醒一句：这个变换本身只是坐标投影，不改变电流的频率——变换后iα和iβ依然是交流量。很多没有深入理解的人会觉得Clarke变换之后就万事大吉了，其实在这个坐标系里你依然看到的是两个相位差90度的正弦波，它们之间随时间变化，控制难度并没有降低。Clarke变换的真正意义，是把三相对称系统中相互耦合的三路电流，简化成两个独立的正交变量，为下一步进入旋转坐标系做准备工作。用一个生活化的比喻，Clarke变换相当于把一条挤了三股线的复杂线缆，先理成两股互不缠绕的线。整理完后路的复杂度下降了，但线还是弯的。
2.2 Park变换：进入旋转坐标系，把交流变成直流
Park变换才是整个FOC最核心的魔法环节。通过转子位置角θ_e，把α-β坐标系中的两个电流，再映射到旋转的d-q坐标系中。变换公式如下：
id = iα × cosθ_e + iβ × sinθ_e
iq = -iα × sinθ_e + iβ × cosθ_e
经过这一套旋转操作，稳态下三相电机里那些表现为正弦的磁动势，在dq坐标系中就化为了两个恒定不变的直流分量。id表示直轴电流，iq表示交轴电流。对表贴式PMSM（SPMSM）来说，电磁转矩Te = Kt × iq，近乎完全解耦。也就是说通过Park变换，你成功把一个复杂的交流同步电机，控制模型简化成了“直流电机”级别，控制难度陡降。
但这里有个极其常见的工程坑，非常值得单独拿出来说：Park变换里的θ_e必须是“电角度”，不是“机械角度”。电机如果是1对极，机械角和电角度相等；如果是4对极，电角度就是机械角度的4倍。很多新手拿着编码器的机械角度直接往Park变换的公式里塞，结果电机原地嘀嘀叫，还傻傻地调了半天PID——这就是“方向对了，坐标系却错了”的典型例子。我在带人的时候经常说，FOC里90%的控制问题，都可以退回坐标变换这一步去找原因。如果你的电机电流波形有诡异的锯齿状且转矩输出极低，请先检查角度换算是否做了极对数乘积。
2.3 逆Park变换与SVPWM的配合：输出端的坐标回程
控制器的最终目的，是给三相逆变器输出实际作用的占空比。所以电流环里两个直流电压指令Vd、Vq，要先通过逆Park变换回到α-β坐标系，再交给SVPWM调制器生成实际的三相占空比。逆Park变换就是Park变换的逆运算，这个环节里出现的信息损失极小，真正决定最终电压质量的，是SVPWM这个硬件向下支撑的调制策略。
SVPWM（空间矢量PWM）不是简简单单把三个正弦波信号换成三相标量的脉宽，它的计算思路是：在α-β平面上，用六个基础非零电压矢量和一个零矢量去合成你想要的任意电压矢量。如果一个控制周期Tpwm内，你想输出的电压矢量是V_ref，SVPWM会计算它在相邻两个基础矢量之间以及零矢量上的作用时间T1、T2、T0，然后把它们排成一个七段式序列。这样做的直接收益是：母线电压利用率比普通SPWM提高了约15.47%，电流谐波更小，输出波形质量更好。所以FOC代码里SVPWM模块的输出看起来像是魔改马鞍波，而不是纯正弦波，心里要记着这就是标准操作，不是什么异常信号。
3. 落地的硬件与采样：FOC不是“写代码”，是“伺候信号”
3.1 硬件平台的底子：逆变器、采样电阻、运放与ADC
刚接触FOC的时候，最容易犯的错误是满脑子都是PID算法，却忘了你要控制的对象是通过强电功率级来驱动的。一个标准的FOC系统，最小硬件组成由这几块构成：
- 三相全桥逆变器（6个MOSFET或IGBT）
- 直流母线的电解电容和去耦电容
- 电流采样电阻（低阻值，毫欧级，下桥臂或母线采样）
- 运放差分放大电路（把微小的采样电压放大到ADC可识别的范围）
- 电流/位置传感器（霍尔、电流互感器、编码器或磁编码器）
- STM32系列MCU或者带FPU的DSP、带浮点运算能力的MCU
我在实际项目中比较喜欢用STM32来跑FOC，因为STM32不仅卖得便宜，生态成熟，有大量的参考例程可借鉴，而且它内部集成的ADC触发定时器、硬件比较器等功能，天然适合和PWM发波逻辑联动。另一个常被忽略的是MCU的数学运算能力：FOC必须在每个PWM周期内快速完成Clarke变换、Park变换、两个PI、逆变换、SVPWM一整套计算，PWM频率如果是10kHz，那你就只有100微秒来做完所有时延极低的计算。一定要选择带FPU（浮点运算单元）的芯片，比如F407系列或者G4系列，否则用软件浮点模拟，控制周期未必跑得满。
3.2 ADC采样时刻的学问：千万别在MOS管开关的瞬间采电流
FOC最容易被坑的地方，首推“FOC ADC采样应该在什么时刻”。很多人把三路ADC中断随便挂在PWM周期的某个点，代码也能开环转起来，但一旦闭环就跑飞。原理在于，电流采样因为采样电阻位于下桥臂或直挂母线上，导通瞬间的di/dt极高，会产生极强的开关噪声和振荡，采样值完全不能反映真实相电流。正确做法是：将ADC的触发源配置在PWM定时器的中心对齐点，也就是当三相逆变器的下桥臂在PWM周期的中间点全部导通时的那个TTL瞬间去触发采样。因为此时母线通过下桥臂的电流通道稳定、噪声小，能采到比较干净的相电流值。
如果你用的是STM32，实现上一般这样配置：PWM用中心对齐模式，更新事件（Update Event）或者某个比较事件触发ADC注入组转换，注入组采样出来的值直接由DMA搬运到内存数组。之后在ADC的采样完成中断里再去触发FOC算法。注意这里强调：不是在所有PWM计数器的周期点都能采到有效电流，如果代码里的采样时刻跟开关频率错位，电流波形会带有明显的“开花”状尖刺。
还有一点：硬件上零漂是不可忽略的。运放有输入偏置、ADC有零点偏移，这些都会在采样回路里引入一个恒定的直流分量。对FOC来说，零点漂移会直接转换成dq轴上的直流偏差量，导致电机静止时电流不为零、或者低速时有明显的转矩脉动。解决办法是在上电初始化的时候进行一次“零漂校准”：电机不转、桥臂封锁（PWM输出关闭），采集几十次到几百次电流值，取平均做零点记录。实际使用中我会在每次系统可靠上电后都做一次校准，这个环节省了，后面调得再好都白费。
3.3 SVPWM代码里容易被忽略的扇区判断与电压限幅
SVPWM的实现方法细分成若干派系：查表法、几何法、等效法。不管哪种，第一步都是判断目标电压矢量落在哪个扇区。这个判断很简单，根据Vα、Vβ的符号和大小关系可以得到六个扇区。但真正容易出问题的地方在于：
- 扇区边界处有计算误差，导致矢量方向突变
- 合成电压矢量的幅值超出了SVPWM的线性调制范围
第一个问题通常靠高精度的浮点运算和边界容差处理可以解决。第二个问题更重要。SVPWM能够线性输出的最大相电压幅值，理论最大为Udc/√3，而一旦你超调到这个范围，输出就会进入过调制区，电流就会失真。因此，电流环PI输出的Vd、Vq经过逆Park变换后，必须做一次电压幅值限幅。因为Vα、Vβ的实际模长是√(Vd²+Vq²)，所以很多工程实现里会直接对上一步输出的Vd、Vq做模长限制，这样既防止了过调制，又保证每次参与限幅的矢量方向不畸变。限幅之后，再进入SVPWM的扇区计算和占空比合成。顺序别搞反，一旦反了，你看到的电流是刮胡子式的振荡，而不是正弦。
3.4 三大闭环的协作：电流环是心脏，速度环是大脑，位置环是旗帜
FOC的主拓扑是串级控制，从内到外依次是：电流环、速度环、位置环。电流环在最内层，带宽最高，它直接生成Vd和Vq电压指令；速度环寄生在电流环外面，它输出iq的给定值；位置环如果应用需要，就在速度环外面输出速度给定。这样设计的原因很实际：越往外的环带宽必须越低，执行周期越长。如果内环速度慢了，外环给了再合理的指令也无法执行，串级稳定性就会崩溃。
实际调参时，经验法则是电流环带宽做到PWM频率的1/10到1/20，速度环带宽再取电流环的1/10到1/5。比如PWM 16kHz，电流环带宽大概1kHz左右，然后速度环带宽100Hz上下比较合适。整定顺序必须从内向外：先把电流环PI调稳，看电流波形是否跟随指令且无超调；再挂速度环；最后才上位置环。任何“直接从位置环开调”的做法，都是给自己挖坑，折腾一小时可能还在原地打转。
4. 转子位置从哪来？给PMSM一个“眼睛”
4.1 有感FOC：编码器与磁编码器的选法
有位置传感器FOC是最稳定的方案。比较常用的是增量式光电编码器和磁编码器两类，前者精度高但抗振动差一点，后者成本低、体积小、抗污染能力强。选编码器时除了看分辨率，还要看它的通信方式和上电初始位置特性。比如增量式编码器没有绝对角位置，上电后需要寻找零点（学过Z信号校准），这会导致启动前有一段“找零”的过程；而绝对值磁编码器（如MA730、MT6816）直接输出当前绝对电角度，上电即用。如果你做的产品有快速启停需求或者接受不了启动前的翻转找零，那绝对式磁编码器就是更合适的选择。
装编码器有一个经常被忽略的点：安装偏心。如果你的码盘或磁钢的旋转中心跟电机转轴中心不重合，编码器输出角度会有正弦式误差，在FOC里这种误差就会表现为dq电流的周期性脉动。我见过一个案例，空载运行时电流波形一切正常，稍微带点负载就出现明显二倍频振动，最后排查软件调了一整天，结果是编码器联轴器拧歪了0.2毫米。所以做FOC前，先拿万用表或示波器把编码器输出角度当成直线来测一测，看它是否平滑、有没有非线性跳变。
有感FOC还必须要校准电角度初始角，俗称“对零”。电机轴转到某个已知参考方向，读编码器角度和反电动势零点的偏差，记录为零点偏移，之后所有Park变换都加这个补偿角。这一步如果误差超过几度，启动时就可能出现瞬态大电流甚至反转。我这里强烈建议：不要在没跑通开环转动的情况下就上来对零，先开环给定一个固定q轴电压让电机缓慢堵转或旋转，通过反电动势波形侧面验证零点是否正确。
4.2 无感FOC：反电动势法和滑模观测器到底怎么选
无感FOC已经是行业里越来越普遍的选择，毕竟省掉编码器不光降成本，还减少了系统失效点。但要清醒地认识到：PMSM在零速、低速是天生无感困难的。零速的时候反电动势为零，你根本没有物理量可以提取转子位置，所以绝大部分无感FOC产品，都不能做到像有感一样的“零速满载启动”。
反电动势法（Back-EMF Observer）设计相对直观，通过电机模型计算反电动势，再从中提取转子角度和转速。可是这个方法在中高速段表现不错，低速段信号太小信噪比太差。滑模观测器（SMC Observer）则是另一种思路：不直接反投影观测值，而是构造一个滑模面，利用不连续控制项强制观测误差收敛到零，然后再通过低通滤波器提取等价值。SMO对参数变化不敏感、鲁棒性较好，所以目前不少开源的“pmsm无感foc”项目里你看到的基本都是滑模观测器变种。
不过滑模观测器有一个固有缺点，自带的抖振。它天然带来高频噪声，电流环调节器到速度估计端都会被“污染”得不平滑。工程做法一般是在滑模输出后面并联一个适当阶数的低通滤波器，并做一个角度补偿——否则滤波会带来角度滞后，这个滞后在高速区会直接导致dq轴坐标系漂移，无论电流环怎么调都不稳定。很多人做无感FOC转起来，但负载一加就“突突突”，八成就是这个角度补偿没做好。
4.3 启动的“世界难题”：初始位置检测与I-f拖动
既然无感方案在零速没有观测能力，怎么让电机从一个静止状态启动到有一定反电动势的中速？业界常用的套路有几种：
- 高频信号注入法：在d轴注入高频电压信号，通过分析q轴高频电流响应来提取转子初始磁极位置。对表贴式电机来说，由于凸极效应弱，这方法效果不明显，更多是用于内置式电机。
- 预定位法：直接给一个固定的d轴电流矢量，把转子强制拉到已知位置。简单粗暴，缺点是有反转风险，不适合需要单方向启动的场合。
- I-f强制拖动：先不管转子位置，直接给定一个固定的d轴电流角度，让它产生一个旋转磁场，把转子“拖”着加速，等速度起来后再平滑切换到闭环控制状态。这是目前无感FOC启动方案中比较工程化也比较省事的做法。
我自己的经验是，无感FOC启动参数（拖动加速度、I-f电流幅值、切换速度阈值）要留出足够的安全裕度。因为拖动阶段本质上还是“盲飞”，如果切换时的电流和角度突变太大，切换瞬间会有一个冲击，严重的话直接过流保护。所以实际项目中我会在切换前加一个“反馈修正”的过渡区，把观测器估计角度和拖动的参考角度做逐步融合加权，让电流过渡更顺滑。
5. 调试FOC必须知道的坑和解决手段
5.1 电流波形异常三类症状与原因速查
电流波形是FOC调试里最直观的晴雨表。我总结了三类高频症状和对应排查方向：
- 电流波形不够正弦，毛刺多、开关噪声大：采样时刻偏移、硬件滤波电容参数不对、地线布局不合理、ADC转换时间不足。
- 电流波形是正玄波但转速不稳、低速发抖：角度零漂未校准、速度环带宽过高、位置估计噪声大、电流内环响应不够快。
- 电流波形有直流偏置：电流采样零点未校准、运放供电异常、电阻老化或焊接温度导致阻值漂移。
排查顺序从简单到复杂：先查电源地和参考地、再查PWM触发ADC时刻、再查坐标变换角度、最后才去调PID参数。这样走下来，你能节省至少一半的调试时间。
5.2 整定电流环和速度环时的经验参数
PID整定网上有大量的“公式法”，实际工程中我更喜欢用现场经验法。电流环可以用“带宽估算法”初定，然后珝一调P增益看阶跃响应；速度环更依赖加载测试，空载和满载的转动惯量差很多，所以整定速度环时一定要带实际负载标定。
具体数值建议：电流环P增益可以从“母线电压 × 采样电阻增益 × 估测相电阻”推导一个初值，通常落在0.05到0.3之间；积分时间常数取1/（2×π×带宽）的1.5到3倍之间。调试电流环时，用示波器观察dq轴给定和反馈的跟踪情况，目标是做到无超调且响应快，相位滞后尽量小。速度环的P值类似地从转动惯量估算，I值再按带宽的1/10来配。调到后面你会发现，工程整定更像是一门“看波”的手艺，完全依赖公式反而是不靠谱的。
5.3 步进电机做FOC这件事：别把概念搬错
热词里看到“步进电机FOC控制原理”，这里顺带说一句。步进电机（两相混合式步进）也可以用FOC控制，做法和PMSM非常接近：两相绕组经过Clarke变换（两相90度的特殊简化版）、Park变换、PI调节、再逆变换输出SVPWM。而且步进电机FOC的最大收益，是它能在低速位置控制中极大地降低振动和噪声，同时保持细腻的微步距特性。
但要理解一点，步进电机多数是隐极结构，d轴和q轴电感差异很小，所以FOC不能像PMSM那样靠磁阻转矩去拓展运行范围。如果直接拿两相步进电机套PMSM的FOC代码，往往会发现转矩不足或者启动失败，原因是要算好两相电流的相位关系，A相为α轴，B相为β轴，并且要根据步距角换算电角度。打算做步进FOC的，建议直接用专用驱动芯片很容易踩坑，还是自己拿MOS和运放搭一套小实验板来跑代码更可控。
5.4 我吃过最贵的一次亏：母线电容与布局问题
最后说一个硬件上很容易被低估的点。FOC的高频开关会产生巨大的di/dt，如果母线的电解电容位置离三相桥太远、走线回路面积过大，逆变器关断瞬间就会产生很高的尖峰电压，轻则ADC采样毛刺加重，重则直接击穿MOS管。我自己曾经在一版主板上为了布线方便，把母线电容放得离功率管远了2厘米，负载稍大就跑出过压击穿，而且现象极其随机，时好时坏，排查了两周才发现是回路寄生电感太大。后来改成三角形功率走线、电容紧贴功率管，问题直接消失。这件事告诉我：FOC虽然看起来是算法的事，但一个不具备功率级硬件设计意识的人，是无法做好FOC产品化的。
6. 给入门者的一套建议与路径
很多人在入门FOC时，第一个念头就是“找一份开源的STM32FOC代码跑起来”。我不是反对抄代码，而是希望你能用正确的顺序消化它：先花一周时间把坐标变换和SVPWM的原理彻底搞明白，然后自己动手写一版前向变换和逆变换，把变量的物理含义对应到示波器波形上；再去做电流环的闭环调试，把电流波形调到干净的正弦；最后才去纠结速度环、位置环和无感算法。
我自己带过的人里，凡是能从原理开始一点一点抠的，最后都能独立调出相对完美的FOC系统；相反，那些一上来就复制一堆工程文件、把每个变量都当成魔法数值去调的人，遇到现场问题就彻底抓瞎。FOC知识体系里，真正的硬实力不在于你背了多少公式，而在于你遇到一个诡异现象时，能快速判断它到底出在坐标变换、采样链路、功率硬件还是参数整定哪一层。这份能力没有捷径，只能靠多上手调试、多撞几次墙来积累。
另外一个小建议：如果你还没有示波器，建议入手一台带宽100MHz以上的，配合电流探头或罗氏线圈，这是FOC调试无可替代的眼睛。仿真软件和估算都只是辅助，最终你的波形反馈才是最直接、最可靠的“师傅”。做FOC这个领域，单单靠想象和看别人的代码是学不到精髓的，下板子、上电、拧负载、看波形，循环往复，这才是唯一正确的入口。
