FOC从Clark/Park变换到SVPWM工程实现与避坑

简介：这份PDF笔记面向正在学习或调试FOC的电机控制初学者与工程实践者，围绕磁场定向控制的核心链路整理理论推导与算法实现，帮助读者把抽象概念落到可计算、可仿真的步骤上。内容从FOC本质与超前角控制切入，依次梳理Clark变换、Park变换及逆变换的数学推导和程序实现，并展开SVPWM的扇区判断、矢量作用时间、过调制处理与切换点确定；同时涵盖PID离散化、位置式与增量式区别、参数整定、积分抗饱和，以及磁链圆限制中MAX_MODULE与START_INDEX的取值思路。资源包仅含1个PDF文件，约7.34MB，适合作为随查随用的专题笔记。已有1920人学习，可帮助读者串联数学推导、Simulink仿真与代码实现，形成较完整的FOC知识框架。笔记按知识点分节组织，推导步骤与程序实现相互对照，尤其适合复现算法、核对SVPWM细节或排查PID积分饱和等问题时查阅。

1. FOC的本质：所有变换最终追的是一个超前90度的磁场

翻开一份 FOC 学习笔记，Clark 变换、Park 变换、SVPWM、PID、磁链圆限制依次排开，公式密度大得吓人，很容易让人以为这套东西的门槛全在数学推导上。实际情况恰恰相反，这些推导只是负责搬运：从三相搬到两相、从静止搬到旋转、再从直流搬回三相，来回折腾的只有一句话——让定子磁场始终超前转子 d 轴 90 度电角度，因为在这个角度上转矩取到最大值。更反直觉的是电角度本身并不神圣，它可以定义成 α 轴与 d 轴的夹角，也可以定义成别的参考线与 d 轴的夹角，它存在的唯一意义是告诉算法“转子此刻朝哪”，好把这个 90 度的目标磁场分解到固定的三相坐标轴上，最后变成六路 PWM 的占空比。想通这一点，后面所有算法都只是在换坐标系解同一道几何题，数学只是工具，几何才是骨架。

2. Clark变换：等幅值系数为什么定在 2/3，恒功率又为什么被放弃

2.1 从三相到两相：KCL 白送了一个维度

三相绕组星形连接、中性点不引出时，任一时刻流入节点的电流等于流出的电流，也就是ia + ib + ic = 0。这条约束直接把三相电流从三个自由度压成两个，第三个永远是前两个的负数。所以 Clark 变换严格来说不是“变换”，而是换基：三个在空间上互差 120 度、彼此线性相关的轴，换成一组正交的 α、β 轴，信息量一点没多也一点没少，只是从“难以辨明和控制的三相波形”变成“平面上一个可以画出来的矢量”。

物理图景很清楚：三相绕组通电后在空间合成一个旋转的磁动势矢量，这个矢量的模长和方向才是真正驱动转子东西，三相电流只是它在三根固定轴上的投影。既然只关心矢量本身，就没必要抱着三根轴不放。把 a 相轴与 α 轴重合，b、c 相轴分别落在 120 度和 240 度方向上，把三相电流往 α、β 上投影，立刻得到：

Iα = k·(Ia − Ib·cos60° − Ic·cos60°) = k·(Ia − Ib/2 − Ic/2) Iβ = k·(Ib·sin60° − Ic·sin60°) = k·(√3/2)·(Ib − Ic)

这里的 k 就是变换系数，它取什么值决定了变换前后“幅值”怎么对应，也是后面一切标度问题的源头。

2.2 等幅值 2/3 与恒功率 √(2/3) 的取舍

系数不是拍脑袋定的，而是先声明想保住什么量，再反解出来。取一组三相平衡电流Ia = Im, Ib = Ic = −Im/2代入上式，β 分量恰好为零，α 分量为1.5k·Im。

如果要求变换后 α 轴幅值与原相电流峰值相等（等幅值），令1.5k·Im = Im，解出k = 2/3。如果要求变换前后功率不变（恒功率），变换前三相在阻抗 R 上的功率为1.5·Im²·R，变换后两相功率为(1.5k·Im)²·R，两者相等解出k = √(2/3) ≈ 0.8165。两种系数都自洽，区别只在“保幅值”还是“保功率”。

FOC 工程里几乎清一色用等幅值 2/3，原因不在数学美感，而在整条链路的标度一致性。电流环的给定来自速度环输出，采样来自 ADC 换算出的安培数，SVPWM 里画的圆是按Udc/√3划的，三者都默认“αβ 分量的模等于相量峰值”。一旦换成恒功率系数，αβ 幅值整体被抬高约 1.22 倍，同一个电压指令送进 SVPWM 就会顶到圆外，凭空制造出过调制；更麻烦的是 ADC 采样值、电流环给定、电压矢量三处标度各不相同，调试时得在脑子里做三次换算，血泪经验告诉我们这种隐式换算迟早会翻车。

2.3 程序实现：为什么采样电路只接两相就够

系数定下来之后，代码可以写得非常省。把Ic = −Ia − Ib代进 β 分量，Ib − Ic = Ia + 2Ib，于是 β 分量完全不需要 c 相电流；α 分量在等幅值系数下更是直接化简成Ia：

typedef struct { float ia, ib, ic; } abc_t; typedef struct { float i_alpha, i_beta; } alphaBeta_t; alphaBeta_t Clark(abc_t input) { alphaBeta_t output; /* 等幅值 k=2/3，且 ia+ib+ic=0： k*(ia - ib/2 - ic/2) = (2/3)*(ia - (ib+ic)/2) = (2/3)*(1.5*ia) = ia */ output.i_alpha = input.ia; /* (ib - ic)/√3，再用 ic = -ia-ib 换成 (ia + 2*ib)/√3 1/√3 = 0.577350269 */ output.i_beta = (input.ia + 2.0f * input.ib) * 0.577350269f; return output; }

这段代码的信息量比看上去大：i_alpha没有做任何乘法，是因为三相和为零这条约束已经把系数 2/3 吸收掉了；i_beta里那个 0.577350269 是 1/√3 的十进制展开，写成乘法比除法快，也不会引入除零风险。两个参数input.ia、input.ib就是全部输入，c 相根本不用采。

这正是 FOC 硬件上常见的做法：电流采样只放两路，第三路由软件算出来，省一路运放、一路 ADC 通道和一块布板面积。反变换同样简单，把 αβ 重新投影回三根相差 120 度的轴即可：

abc_t Rev_Clark(alphaBeta_t input) { abc_t output; output.ia = input.i_alpha; output.ib = -0.5f * input.i_alpha + 0.8660254f * input.i_beta; /* √3/2 */ output.ic = -0.5f * input.i_alpha - 0.8660254f * input.i_beta; return output; }

0.8660254就是 √3/2。注意反变换这里用的是等幅值系数下的逆矩阵，前提仍然是三相和为零；如果哪天做的是带中线的三相四桥臂拓扑，这条约束失效，Clark 就得老老实实保留三个输入，不能再用两相采样省成本。

3. Park变换：把正弦量“焊死”成直流量，PI 才有活路

3.1 旋转坐标系到底解决了什么问题

Clark 之后拿到的是 αβ 两相，但稳态运行时这两个分量仍然是随时间做正弦变化的交流量。问题就出在这儿：PI 控制器对阶跃给定能做到零稳态误差，对正弦给定却永远追不上，输出会有幅值衰减和相位滞后，而且给定频率一变，滞后角跟着变，整个环路的设计前提就塌了。这不是参数没调好，是 PI 这种只有极点没有谐振环节的结构，天生无法无静差跟踪正弦信号。

Park 变换的思路是换一个观察者：让坐标系自身以电角速度跟着转子一起转，站在这个旋转坐标系上看，原本正弦变化的定子电流就变成了两个不动的常数——励磁分量 id 和转矩分量 iq。对常数做 PI，零稳态误差立刻就回来了。所以 Park 不是数学游戏，它的存在理由就是“让 PI 能用”。

推导也不复杂：旋转坐标系相对静止坐标系转过 θ 角，同一根矢量在两个坐标系下的坐标满足一个二维旋转关系，把 αβ 往 dq 上投影：

Id = Iα·cosθ + Iβ·sinθ Iq = −Iα·sinθ + Iβ·cosθ

θ 就是电角度。注意它的单位必须和后面查表函数约定的一致，是弧度还是 0~2π 的标幺、是电角度还是机械角度，这几个问题不统一，现象往往是电机能转但一转快就失步。极对数别忘了乘，机械角度乘极对数才是电角度。

3.2 三角函数查表与 Q15 定点

电流环中断通常跑在 10~20 kHz，每次 Park 和逆 Park 各要一对 sin/cos。如果直接调sinf()，在很多低成本 MCU 上单次就是几十个周期，四次调用足够把中断时间吃满，PWM 周期一抖动，整个环路都跟着遭殃。所以实际工程里一律查表：把 0~2π 均分成若干份，预存一份正弦表，运行时按角度索引取最近点，必要时再做线性插值。

表里的值一般存成 Q15 定点整数，范围 −32768~32767，对应 −1~1。取值回来必须乘一个换算系数才能当浮点用：

#define DIV_Q15 (1.0f / 32768.0f) dq_t Park(alphaBeta_t input, int16_t theta) { dq_t output; Trig_Components sc = Trig_Functions(theta); /* 查表返回 Q15 的 sin/cos */ float cos_da = sc.hCos * DIV_Q15; /* 32768 -> 1.0 */ float sin_da = sc.hSin * DIV_Q15; output.id = input.i_alpha * cos_da + input.i_beta * sin_da; output.iq = -input.i_alpha * sin_da + input.i_beta * cos_da; return output; }

参数说明：input是 Clark 输出或逆 Park 输入；theta是电角度索引，不是弧度，具体量化方式由Trig_Functions决定，这一点必须和编码器/观测器输出的角度对齐。sc.hCos、sc.hSin是 Q15 整数，漏乘DIV_Q15会让 id、iq 整体放大三万两千多倍，PI 输出瞬间饱和，现象是上电就满占空比，很容易被误判成硬件炸管。

3.3 逆变换：PI 输出怎么回到 αβ

电流环 PI 算出来的是 dq 轴上的电压指令 vd、vq，要送进 SVPWM 还得变回 αβ。这里有个漂亮的数学性质：Park 变换的矩阵是正交旋转矩阵，正交矩阵的逆等于转置，所以逆变换不用求逆，只要把符号换个位置：

alphaBeta_t Rev_Park(dq_t input, int16_t theta) { alphaBeta_t output; Trig_Components sc = Trig_Functions(theta); float cos_da = sc.hCos * DIV_Q15; float sin_da = sc.hSin * DIV_Q15; output.i_alpha = input.id * cos_da - input.iq * sin_da; output.i_beta = input.id * sin_da + input.iq * cos_da; return output; }

对比正变换可以看到，唯一的差别是iq两项的符号翻了。这个对称性不是巧合，正是因为旋转矩阵的行列式为 1、转置即逆。工程含义是：正变换和逆变换可以用同一张 sin/cos 表、同一段查表代码，只在乘加时改两个符号，代码体积和中断耗时都能省一半。

顺带说一句，这两次变换串起来必须严格互逆。如果正变换里 θ 用的是索引，逆变换里却传了弧度，或者一边用了等幅值系数另一边忘了，闭环就会出现一个固定角度的旋转偏差——看起来电机也能转，只是电流利用率偏低、发热偏大，这种“不炸但也不对”的问题最费时间。

4. SVPWM：扇区判断与两种作用时间算法凭什么等价

4.1 六个基本矢量与伏秒平衡

三相逆变桥每相上下管互补，三个开关量一共 8 种组合。其中 000 和 111 两种状态三相接到同一个电位，输出矢量为零，叫零矢量；剩下 6 种状态各对应一个幅值为2Udc/3、方向互差 60 度的非零矢量。这 6 个矢量把平面切成 6 个 60 度的扇区，任何一个参考电压矢量都落在某个扇区里，由该扇区相邻的两个非零矢量加零矢量按伏秒平衡合成：

Uref·Ts = Ux·Tx + Uy·Ty + U0·T0，且 Tx + Ty + T0 = Ts

这就是 SVPWM 的全部理论基础，剩下的都是怎么把 Tx、Ty、T0 算出来、怎么排顺序。

4.2 扇区判断：三个不等式编码成 N

最直白的判法是算atan2(Uβ, Uα)再除以 60 度取整，但中断里开方、除法、反三角函数三件套齐全，代价太高。实际做法是构造三个判据：

Uref1 = Uβ Uref2 = (√3/2)·Uα − (1/2)·Uβ Uref3 = −(√3/2)·Uα − (1/2)·Uβ

这三个式子其实是三条相差 60 度的分界线：Uref1 > 0判断矢量在 α 轴哪一侧，另外两条是这条线旋转 ±120 度得到的。三个布尔量分别记作 A、B、C，编码成N = A + 2B + 4C，N 取 1~6 且不重复，正好一一对应六个扇区。

/* 输入 αβ 下的参考电压，返回扇区号 1..6 */ uint8_t SVPSector(float u_alpha, float u_beta) { float u1 = u_beta; float u2 = (0.8660254f * u_alpha) - (0.5f * u_beta); /* √3/2, 1/2 */ float u3 = -(0.8660254f * u_alpha) - (0.5f * u_beta); uint8_t a = (u1 > 0.0f) ? 1 : 0; uint8_t b = (u2 > 0.0f) ? 1 : 0; uint8_t c = (u3 > 0.0f) ? 1 : 0; uint8_t n = a + (b << 1) + (c << 2); /* N 到扇区的映射固定，用查表比 if-else 链快且不易错 */ static const uint8_t sector_map[8] = {0, 2, 6, 1, 4, 3, 5, 0}; return sector_map[n]; }

参数u_alpha、u_beta是逆 Park 输出的电压指令，单位与 Udc 保持一致。这张sector_map表是整段代码里最容易抄错的地方，N=0 和 N=7 是理论上的退化情况（三个判据同时为零），填 0 表示非法，正常运行时不该出现。

4.3 两种作用时间算法：正弦定理与分量相等

扇区 I 里，参考矢量夹在基本矢量 U4（0 度）和 U6（60 度）之间。方法一走几何路线：把 Uref、U4·T4/Ts、U6·T6/Ts 三个矢量摆成一个三角形，用正弦定理直接解出两个时间，物理意义一目了然。方法二走代数路线：把合成矢量在 α、β 两个轴上的分量分别写出来，令其等于参考矢量的分量，得到一个二元一次方程组，解出来即可。两条路算出的结果完全一样：

T6 = k·Uβ T4 = k·( (√3/2)·Uα − (1/2)·Uβ ) T0 = T7 = (Ts − T4 − T6) / 2 其中 k = √3·Ts / Udc

为什么值得记两种？因为正弦定理那套适合推导和理解，画个三角就明白“为什么时间正比于电压”；而分量相等那套适合写代码，全是乘加，六个扇区可以共用同一个骨架，只是每项前面的符号不同。把六个扇区的结果整理出来会发现，T1、T2永远可以写成k·Uref1、k·Uref2这样的形式，Uref1~3就是扇区判断里那三个判据，只是取了不同的组合。

/* 扇区 I 的作用时间，k = √3·Ts/Udc */ void SVPWM_Times_Sector1(float u_alpha, float u_beta, float Ts, float Udc, float *t4, float *t6, float *t0) { const float k = 1.7320508f * Ts / Udc; *t6 = k * u_beta; *t4 = k * (0.8660254f * u_alpha - 0.5f * u_beta); *t0 = Ts - *t4 - *t6; if (*t0 < 0.0f) { /* 过调制：等比例压缩，别让负时间进比较寄存器 */ float scale = Ts / (*t4 + *t6); *t4 *= scale; *t6 *= scale; *t0 = 0.0f; } }

Ts是 PWM 周期，Udc是母线电压，t4、t6输出非零矢量作用时间，t0是零矢量总时间（两个零矢量平分）。那段if是关键防线：一旦参考矢量超出线性区，T4 + T6会大于Ts，T0变负，如果直接把负值写进比较寄存器，PWM 相位会乱跳，严重时上下桥臂直通。

4.4 七段式开关顺序与切换点

时间算出来只是第一步，怎么把它们排进一个 PWM 周期决定了开关损耗和谐波含量。原则只有一条：每次切换只改变一相开关状态。扇区 I 的顺序是0 → 4 → 6 → 7 → 7 → 6 → 4 → 0，中间两个 7 拼在一起，整个周期关于中点对称。这样一周期内每相只翻转一次，开关损耗最小；波形对称则偶次谐波互相抵消。

切换点就是把时间累加后除以 2，因为对称所以只算半个周期的三个比较值：

/* 扇区 I 的三相比较点：A 相最先翻转，C 相最后 */ void SVPWM_Compare_Sector1(float t4, float t6, float Ts, float *ta, float *tb, float *tc) { float tcm1 = (Ts - t4 - t6) * 0.25f; /* 零矢量四等分，取第一段 */ *ta = tcm1; *tb = tcm1 + t4 * 0.5f; *tc = tcm1 + (t4 + t6) * 0.5f; }

这三个值直接写进定时器比较寄存器。注意(Ts − t4 − t6) * 0.25里的 0.25，是因为零矢量被切成四段、每段占四分之一，A 相在第一个四分之一处翻转。这个系数写成 0.5 是另一个常见错误，现象是输出电压整体偏低、调制比怎么给都上不去。

5. SVPWM避坑：从扇区错位到马鞍波的五个翻车现场

5.1 扇区判断与作用时间：命名和符号最容易出事

坑一：T1/T2和Uref1/Uref2混用。现象是电机能转，但低速抖动明显、相电流波形上有周期性畸变，某个扇区附近尤其严重。原因在于笔记里同一组符号名既用来表示电压判据又用来表示作用时间，抄代码时张冠李戴，把k·Uref1当成了Uref1本身。解决办法很土但有效：变量名一律加后缀区分，时间用t_first、t_second，判据用u_ref1、u_ref2，同理电压矢量用大写U4、U6，时间用小写t4、t6，改完这一处，那类错误基本绝迹。

坑二：扇区映射表错位。现象是正转勉强正常、反转啸叫，或者每转一圈有一小段明显没劲。原因是sector_map抄错一位，N 和扇区号对不上。验证办法不需要硬件：写个测试程序让Uref沿单位圆走一圈，θ 每 5 度取一个点，打印 N 和扇区号，看是否按 3-1-5-4-6-2 的顺序循环；再打印t4、t6，它们必须随 θ 连续变化，出现跳变就说明映射错了。

坑三：过调制时未做负时间处理。现象是占空比偶尔超过一个周期，示波器上能看到 PWM 相位突变，严重时上下管直通。原因是|Uref|超过Udc/√3后T4 + T6 > Ts，T0为负。除了在SVPWM_Times里做等比例压缩，更稳妥的做法是在上游加磁链圆限制，让超出圆外的指令根本进不到这一步。

5.2 马鞍波与零序注入：不是算法坏了

坑四：把马鞍波当成故障。现象是用示波器量相电压（对母线中点），看到的是顶部凹陷的马鞍形，不是正弦，于是一路怀疑 SVPWM 写错了。原因很干脆：SVPWM 在数学上等价于注入了零序分量的 SPWM，零序分量以三次谐波为主，它让相电压波形被“削”成马鞍形，但线电压依然是标准正弦，磁链依然是圆。要验证很简单，量两相之间的线电压，或者量相电压之差，正弦就是对的。反过来说，如果你确实需要看相电压，那就得接受马鞍波。

零序注入的实现比 SVPWM 直白得多，取三相指令的最大值和最小值，注入它们的负平均值即可：

/* 零序注入 SPWM，输出波形与 SVPWM 等价，谐波表现略有差异 */ void SPWM_ZeroSequence(float ua, float ub, float uc, float *ua_out, float *ub_out, float *uc_out) { float umax = fmaxf(ua, fmaxf(ub, uc)); float umin = fminf(ua, fminf(ub, uc)); float u0 = -0.5f * (umax + umin); /* 零序分量，主要成分是三次谐波 */ *ua_out = ua + u0; *ub_out = ub + u0; *uc_out = uc + u0; }

这段代码的好处是不用算扇区、不用算作用时间，三个减法一个除二就完事，在算力紧张的芯片上很划算；代价是调制比上限略低于标准 SVPWM，母线利用率差一点点，而且开关次数不按七段式优化。两种实现放在同一套硬件上都能量出正弦线电压，区别只在效率和波形细节。

5.3 定点与标幺：最隐蔽的一类错

坑五：Q15 数值忘记换算。现象是 id、iq 数值大得离谱，PI 参数怎么调都振荡，或者干脆一上电就满占空比。原因是查表返回的hSin、hCos是 −32768~32767 的整数，直接乘电流得到的结果被放大了三万两千多倍。解决办法是统一在查表出口乘DIV_Q15，并在代码里给这个常量加注释；如果芯片性能够，也可以干脆全用 float，代价是中断耗时上升，需要实测确认还留有余量。

还有个同源问题：角度单位不统一。编码器给的是机械角度，观测器给的是电角度，查表函数要的是 0~2π 标幺或索引，三者混用的时候现象非常“玄学”——低速正常、高速失步，或者正转正常、反转异常。这类问题的排查习惯是：在中断里固定打印一次 θ 的原始值、乘极对数后的值、换算成索引后的值，三个数对一遍，比盯着代码看半天管用。

6. PID与磁链圆限制：控制环最后两道保险的设计取舍

6.1 积分抗饱和：为什么要限两次

位置式 PID 的输出饱和之后，误差仍然存在，积分项会继续累加，这就是积分饱和。后果是超调巨大、退饱和慢，电机从堵转恢复时能明显看到一段“刹不住”的冲过头。抗饱和的常见做法是两层：第一层在积分项累加时就按输出上下限钳位，第二层在输出饱和时把超出部分回灌给积分项（back-calculation）。前者实现简单，后者退饱和更快。

增量式 PID 天然免疫这个问题，因为它输出的是增量，累加发生在执行机构一侧，积分项不会无限膨胀。代价是增量式对积分项的物理意义不直观，切手动/自动时要做无扰切换。选哪种不是对错问题，是场景问题：电流环这种要求快速退饱和的，位置式配反计算更稳；位置环这种不怕慢一点的，增量式代码更短。

6.2 磁链圆限制：MAX_MODULE 与 START_INDEX 的用意

SVPWM 的线性调制边界是|Uref| ≤ Udc/√3，超过这条线就进入过调制，波形开始失真、电流谐波陡增。磁链圆限制就是在指令进入 SVPWM 之前先检查模长，超了按比例缩回圆上。这个“先限制再计算”的顺序很关键，它把非线性环节挡在了调制器之外，调制器内部看到的永远是合法输入，省掉了内部那堆异常分支。

MAX_MODULE一般取Udc/√3再留一点余量，留余量的目的是给母线电压跌落和采样误差兜底。START_INDEX则是查表法的产物：与其每次都开方算模长，不如预先按角度把单位圆离散成若干点，超限时直接按当前角度索引找到圆上对应的起点，START_INDEX就是这个表的起始偏移。用查表换掉一次开方，在中断里是实打实的收益。

真正需要权衡的是“限制得多狠”。限得太保守，母线电压利用率上不去，高速段提前进入弱磁；限得太松，过调制时电流波形变差，噪声和发热都上来。我自己的习惯是先在 Simulink 里把电压圆和电流圆都画出来，跑一遍极限工况看轨迹会不会出界，再把MAX_MODULE定在实测边界内缩 3%~5% 的位置。从那以后，每次改调制比或者换母线电压，我都会强制走一遍“圆限制 + 过调制压缩”的双重检查，宁可少榨一点电压，也不让波形进入不可控区。希望这套排查顺序能帮到你。

本文还有配套的精品资源，点击获取