FOC算法从推导到实现：Clark/Park变换、SVPWM与电流环工程化

简介：这份PDF笔记面向正在学习或准备实现FOC（磁场定向控制）的嵌入式与电机控制学习者，系统梳理了从理论推导到算法落地的关键环节。内容围绕FOC核心思想与超前角控制展开，依次讲解Clark变换的等幅值与恒功率系数推导、Park变换及逆变换的数学过程与程序实现，并深入SVPWM的扇区判断、矢量作用时间计算、过调制处理与切换点确定，还涉及马鞍波成因与零序分量注入SPWM。此外还整理了PID离散化、位置式与增量式算法区别、参数整定及积分抗饱和方法，以及磁链圆限制中MAX_MODULE与START_INDEX的确定思路。资源包为1个PDF文件，约7.34MB，结构按知识点分节编排，便于对照公式与代码逐章学习。目前已有1926人学习，适合希望把数学推导与Simulink、代码实现打通的读者查漏补缺。

1. 从一份手写推导笔记说起：FOC 到底在算什么

第一次把电机转起来的人，多半会经历一个反直觉的时刻：明明三相电流都在按正弦规律变化，电机却抖得像筛糠。问题往往不在硬件，而在坐标变换那几步——角度差一点、系数错一点，磁场就不是超前转子 90 度，转矩自然出不来。这份笔记的价值就在这里：它不急着贴代码，而是先把 Clark、Park、SVPWM 的数学推导一条条写清楚，再落到程序实现，最后补上 PID 离散化、积分抗饱和和磁链圆限制这些工程上绕不开的细节。适合谁？适合已经能让电机转、但说不清每一行代码为什么这么写的人，也适合想从零搭一套 FOC 算法框架、拿数学推导当对照表的开发者。整份材料围绕数学、FOC、Simulink 仿真与算法实现展开，读下去你会发现，很多调试时的玄学现象，其实在推导阶段就埋下了伏笔。

2. 坐标变换链路：Clark、Park 与反 Park 的推导和落地

2.1 为什么先降维再线性化

FOC 的核心思想只有一句话：生成一个超前转子 90 度的磁场。转子位置由电角度指示，但电角度怎么定义并不唯一，可以是 α 轴与 d 轴的夹角，也可以是 β 轴与 q 轴的夹角，甚至可以是角平分线。定义方式只影响 Park 变换里投影用的三角函数形式，不影响最终要生成的磁场方向。这一点在笔记里被反复强调，因为很多人卡在“角度到底从哪算起”上，其实只要保证变换和反变换用的是同一套定义，闭环就能成立。

三相电流彼此相差 120 度，直接控制三个量既难辨明也难解耦。Clark 变换利用基尔霍夫电流定律 Ia + Ib + Ic = 0，把三维压成两维 αβ 平面；但 αβ 里的量仍然随转子旋转而正弦变化，还是非线性。Park 变换把旋转的 dq 轴当作参考系，对转子而言这个坐标系是静止的，于是 id、iq 变成直流量，PI 控制器才有用武之地。整条链路是：采样三相电流 → Clark → Park → PI 调节 id/iq → 反 Park → SVPWM → 驱动逆变器。少一环，磁场方向就偏。

2.2 Clark 变换：等幅值还是恒功率

笔记里把两种系数都推了一遍。设变换形式为：

Iα = k(Ia - Ib/2 - Ic/2) Iβ = k(√3/2)(Ib - Ic)

等幅值变换要求变换前后幅值相等，代入 Ia=1、Ib=Ic=-0.5 可解出 k=2/3；恒功率变换要求变换前后功率相等，代入功率表达式可解出 k=√(2/3)。实际 FOC 设计一般选等幅值变换，原因很实在：如果选恒功率变换，SVPWM 里得到的矢量幅值会是相电压峰值的 1.5 倍，直接冲出空间矢量圆的边界，产生过调制。等幅值变换下矢量幅值正好落在圆内，调制比算起来也直观。

程序实现时利用 Ia + Ib + Ic = 0 消掉 Ic，只采 A、B 两相电流，省一路采样电路：

alphaBeta_t Clark(abc_t input){ alphaBeta_t output; output.i_alpha = input.ia; // Iα = Ia output.i_beta = (input.ia + 2*input.ib) * 0.577350269; // Iβ = (Ia+2Ib)/√3 return output; }

这里的 0.577350269 就是 1/√3。注意 i_beta 用的是 (Ia + 2Ib)，不是 (Ib - Ic)，因为 Ic 已被 -Ia-Ib 替换。参数上，输入 ia、ib 是 ADC 采到的瞬时相电流，输出 i_alpha、i_beta 是 αβ 平面分量。如果采样通道有偏置，Clark 之后会直接体现为直流分量，后面 PI 会把它当真实误差去调，所以上电前做零漂校准是必要动作。

2.3 Park 与反 Park：三角函数精度决定成败

Park 变换的推导来自投影：把 αβ 分量投影到旋转的 dq 轴上，得到

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

反 Park 是它的逆，因为变换矩阵是正交方阵，逆等于转置：

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

程序里角度 θ 通常以 Q15 定点或查表形式给出，笔记中的实现用 Trig_Functions 取 sin/cos，再乘 DIV_Q15 转成浮点：

dq_t Park(alphaBeta_t input, int16_t theta){ dq_t output; Trig_Components sc = Trig_Functions(theta); float cos_da = (float)(sc.hCos * DIV_Q15); // Q15 转 0~1 float sin_da = (float)(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; }

反 Park 只是把 id、iq 换回 αβ，符号按转置矩阵写。参数上要盯两件事：一是 theta 的范围和单位，是 0~2π 的弧度还是 0~65535 的定点刻度，混用会让角度整体偏移；二是查表分辨率，低分辨率查表在低速时角度量化误差明显，iq 上会出现周期性纹波，表现为转矩脉动。常见做法是查表加线性插值，或者直接用 CORDIC 算，代价是几个周期的开销。

3. SVPWM 实现：扇区判断、作用时间与过调制处理

3.1 平均值等效与六个基本矢量

SVPWM 的理论基础是平均值等效：在一个开关周期内，用相邻两个非零矢量和零矢量组合，使平均值等于给定电压矢量。三相逆变桥有 8 种开关状态，对应 6 个非零基本矢量和 2 个零矢量，6 个非零矢量把平面分成 6 个扇区，每个扇区 60 度。基本矢量的幅值是 2Udc/3，这个系数来自三相桥的等效电路推导，笔记里用 KCL 和电阻分压一步步推出来，不是拍脑袋给的。

扇区判断用三个中间变量：

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

若 Uref1 > 0 则 A=1，Uref2 > 0 则 B=1，Uref3 > 0 则 C=1，令 N = A + 2B + 4C，N 与扇区的对应关系是固定的映射表（N=3 对应扇区 I，N=1 对应 II，N=5 对应 III，N=4 对应 IV，N=6 对应 V，N=2 对应 VI）。这套判断只做符号比较，没有除法，适合在中断里跑。

3.2 作用时间计算：两种方法等价

笔记给了方法一和方法二两套推导。方法一从正弦定理出发，直接写出 T4、T6 与 |Uref|、θ 的关系；方法二把参考矢量投影到 αβ 轴，令两轴分量相等解方程。两者结果一致，只是中间变量不同。以扇区 I 为例，作用时间为：

T6 = (√3·Ts/Udc)·Uβ T4 = (√3·Ts/Udc)·(√3/2·Uα - 1/2·Uβ) T0 = T7 = (Ts - T4 - T6)/2

其中 Ts 是 PWM 周期，Udc 是母线电压。定义调制比 m = √3·|Uref|/Udc，线性调制区要求 m ≤ 1，对应 |Uref| ≤ Udc/√3。对比 SPWM 的调制比上限 1，SVPWM 的母线电压利用率高出约 15.47%，这就是它被广泛采用的原因。程序里通常把 √3·Ts/Udc 预先算成一个常数 k，每个周期只做乘加，避免在中断里做浮点除法。

六个扇区的时间表达式结构相同，只是 Uα、Uβ 的组合和符号不同。实现时常见做法是先用 N 查表得到两个基矢量的编号，再用统一的 k 乘以对应的线性组合，最后做饱和判断。这里有个容易翻车的点：T4 + T6 可能大于 Ts，如果不处理，占空比会算出负值或超过 100%，波形直接畸变。

3.3 过调制与切换点安排

过调制处理的核心是把 T4 + T6 按比例缩回 Ts：

if (T4 + T6 > Ts) { float scale = Ts / (T4 + T6); T4 *= scale; T6 *= scale; T0 = 0; } else { T0 = (Ts - T4 - T6) * 0.5; }

缩放而不是简单截断，是为了保持矢量方向不变，只压缩幅值，这样过调制时转矩方向仍然正确，只是幅值受限。切换点安排遵循两个原则：每次只改变一相开关状态，零矢量时间平均分配，使 PWM 对称以降低谐波。扇区 I 的典型顺序是 0→4→6→7→7→6→4→0，对应三相占空比的比较值由 T0/2、T0/2+T4、T0/2+T4+T6 依次给出。顺序写错不会立刻炸，但电流谐波会变大，示波器上能看到明显的毛刺。

提示：过调制缩放后如果还要求更高输出，就进入六步方波区，此时已不是线性调制，电流环需要单独处理，别指望 PI 还能稳住。

4. 电流环工程化：PID 离散化、积分抗饱和与磁链圆限制

4.1 位置式与增量式 PID 的取舍

连续 PID 离散化后有两种常见形式。位置式直接算输出：

u(k) = Kp·e(k) + Ki·Σe(j)·T + Kd·(e(k)-e(k-1))/T

增量式算的是输出增量：

Δu(k) = Kp·(e(k)-e(k-1)) + Ki·e(k)·T + Kd·(e(k)-2e(k-1)+e(k-2))/T u(k) = u(k-1) + Δu(k)

位置式输出直接对应占空比，直观但积分项要一直累加，一旦饱和恢复慢；增量式没有累加器，天然带一点抗饱和能力，但输出是增量，需要维护上一拍的值。FOC 电流环里两种都有人用，笔记里把区别讲清楚了：位置式适合输出直接映射执行机构的场景，增量式适合执行机构带积分特性的场景。参数整定上，先调 Kp 让响应快但不振荡，再加 Ki 消静差，Kd 在电流环里一般很小甚至不用，因为电流采样噪声会被微分放大。

4.2 积分抗饱和的三种做法

积分饱和的现象很具体：给定突变或启动瞬间，误差长时间为正，积分项一路累加，输出早就顶到限幅，等误差反向后积分项还要很久才能退回来，表现为超调大、恢复慢。笔记列了几种方法：积分限幅（给积分项设上下界）、积分分离（误差大时暂停积分）、反计算抗饱和（用输出限幅的差值回灌积分项）。工程上最常用的是积分限幅加反计算组合：

float err = target - actual; integral += Ki * err * T; if (integral > I_MAX) integral = I_MAX; if (integral < -I_MAX) integral = -I_MAX; float out = Kp * err + integral; if (out > OUT_MAX) { integral -= (out - OUT_MAX); out = OUT_MAX; } if (out < -OUT_MAX){ integral -= (out + OUT_MAX); out = -OUT_MAX; }

参数上 I_MAX 一般取输出限幅的 0.8 到 1 倍，留一点余量给比例项。反计算那两行是后悔药，输出被限幅时把超出部分从积分里扣掉，误差反向时积分能立刻退出饱和。不做这一步，电机启动时那一下“冲过头再拉回来”的波形几乎必然出现。

4.3 磁链圆限制：MAX_MODULE 与 START_INDEX

磁链圆限制的目的是防止合成矢量超出线性调制区，导致磁饱和和电流畸变。笔记里给了两个关键量：MAX_MODULE 是允许的最大矢量模长，START_INDEX 是开始限制的索引阈值。确定 MAX_MODULE 时，按母线电压和调制比上限反推，留出死区和采样误差的余量；START_INDEX 则用于在矢量接近边界时提前介入，避免等到完全出界才动作。

实现上常见做法是算当前矢量的模长平方，与 MAX_MODULE 的平方比较，超过就按比例缩放 Uα、Uβ：

float mag2 = Ualpha*Ualpha + Ubeta*Ubeta; if (mag2 > MAX_MODULE_SQ) { float scale = MAX_MODULE / sqrtf(mag2); Ualpha *= scale; Ubeta *= scale; }

用平方比较省一次开方，只有真正越界时才做 sqrtf。START_INDEX 的作用是给一个提前量，让限制在矢量接近圆边时平滑生效，而不是硬切。参数调的时候先看电流波形，如果峰值附近有削顶，说明 MAX_MODULE 偏小；如果过调制保护频繁触发，说明偏大或 START_INDEX 太靠后。

5. 避坑与排查：调试台上最容易翻车的几件事

5.1 角度定义不一致导致电机不转或反转

现象：开环给固定角度能转，切闭环就堵转或反转。原因：Park 变换和反 Park 变换用的电角度定义不同，或者编码器零位与算法零位没对齐，导致 dq 轴整体偏移。解决：先用开环拖动确认相序和角度方向，再把编码器读数与算法角度做一次对齐，确保 id 给定为 0 时 iq 能单独产生转矩。对齐这一步不做，后面调什么参数都是白费。

5.2 Clark 系数用错引发过调制

现象：母线电压还没到额定，SVPWM 就频繁进入过调制，电流波形削顶。原因：Clark 用了恒功率系数 √(2/3)，矢量幅值变成相电压峰值的 1.5 倍，直接冲出圆边界。解决：FOC 里统一用等幅值系数 2/3，检查 Clark 输出和 SVPWM 输入的幅值关系，确保 |Uref| 不超过 Udc/√3。

5.3 积分饱和让启动波形冲过头

现象：阶跃给定下电流冲得很高再慢慢回落，恢复时间明显偏长。原因：积分项在输出限幅期间持续累加，误差反向后要很久才能退饱和。解决：加积分限幅和反计算抗饱和，I_MAX 取输出限幅的 0.8 倍左右，启动阶段可以先关积分，等电流建立后再投入。

5.4 查表分辨率不足引起低速转矩脉动

现象：低速时电流有周期性纹波，转速越低越明显。原因：sin/cos 查表点数少，角度量化误差在低速时相对占比大，dq 变换结果带周期性偏差。解决：提高查表分辨率并加线性插值，或改用 CORDIC；同时确认 theta 的更新频率与 PWM 周期同步，别用上一个周期的角度算这一拍的变换。

5.5 死区与采样延迟未补偿

现象：轻载时电流波形过零附近畸变，正负半周不对称。原因：逆变桥死区时间导致实际输出电压与占空比不符，加上 ADC 采样时刻与 PWM 更新不同步。解决：按电流方向做死区补偿，采样点放在 PWM 中点附近避开开关瞬间，必要时对采样做一拍延迟补偿。这类问题不会让电机停转，但会让电流环带宽上不去。

6. 二次开发：把这份笔记变成自己的算法框架

拿到这份材料后，我建议的改造路径是先仿真后上板，别一上来就烧录。第一步，把 Clark、Park、反 Park、SVPWM 的推导在 Simulink 里搭一遍，用理想电压源和电机模型跑开环，观察扇区切换和占空比波形，确认时间计算和切换顺序对得上。第二步，把 PI 和抗饱和加进去，做电流环阶跃响应，看超调和恢复时间，这一步在仿真里调参数比在板子上快得多。第三步，把磁链圆限制接上，人为把给定拉到过调制区，验证缩放逻辑是否平滑。

代码层面，建议把变换和 SVPWM 做成独立模块，输入输出用结构体，角度和母线电压作为参数传入，别用全局变量。这样换平台时只改采样和 PWM 驱动层，算法层不动。下面是一个模块划分的参考：

验证方法上，我习惯先看三样东西：一是 id 给定为 0 时 iq 阶跃响应，看带宽和超调；二是低速下的电流波形，看有没有周期性纹波；三是给定拉到边界时的占空比，看有没有削顶或负值。三样都过了，再上负载。参数整定没有捷径，Kp 从大到小试到临界振荡再回退，Ki 从 0 慢慢加，每次只动一个参数，改完记录波形，别凭感觉连调三个。

血泪经验是：每次改角度定义或变换系数，都把开环拖动重新跑一遍。我有一次只改了 Park 的符号，觉得“应该没问题”，结果闭环跑了半分钟才发热报警，回头查才发现 dq 轴反了，iq 一直在做无用功。从那以后我每次动坐标变换相关代码，都强制走一遍开环确认相序和角度方向，再切闭环。希望帮到你。

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