简介这份PDF笔记面向正在学习或准备实践FOC磁场定向控制的电机控制初学者与嵌入式开发者系统整理了从理论推导到算法实现的完整脉络。内容围绕FOC核心思想展开涵盖Clark变换与Park变换及其逆变换的数学推导、等幅值与恒功率变换系数的选择依据、SVPWM的扇区判断、矢量作用时间计算、过调制处理与切换点确定并延伸至PID位置式与增量式算法、积分抗饱和方法以及磁链圆限制中MAX_MODULE与START_INDEX的确定。资源为1个PDF文件压缩包约7.34MB结构按知识点分节编排便于按模块查阅与对照推导。目前已有1887人学习适合希望打通FOC数学基础、理解SVPWM实现细节并优化电机控制策略的读者作为自学参考与算法复盘材料。1. 从一份手写推导笔记说起FOC 的数学底子到底该怎么打很多人第一次接触 FOC都是直接抄一份能转的代码烧进去电机嗡一声转起来就以为学会了。结果一换电机参数、一改母线电压转速环就开始震荡电流波形像心电图这时候才发现自己连 Clark 变换的系数是怎么来的都说不清楚。我手里这份笔记就是冲着这个问题去的——它不教你怎么点灯而是把 FOC 几大变换的数学推导、SVPWM 的扇区判断与作用时间计算、PID 离散化与积分抗饱和、磁链圆限制这几块硬骨头一块一块拆开写清楚。适合已经能让电机开环转起来、但一到闭环就翻车的嵌入式工程师也适合正在用 Simulink 搭 FOC 模型、想把每个模块和公式对上号的学生。它解决的不是“能不能转”而是“为什么这么转、参数为什么这么设”。2. Clark 与 Park从三相到两相系数选错全盘皆输2.1 为什么先做 Clark 再做 ParkFOC 的核心思想笔记里一句话点透了生成一个超前转子 90 度的磁场。转子是永磁体它的磁场方向由机械位置决定你没法直接改你能改的是定子绕组产生的磁场。要让定子磁场始终超前转子 90 度就得知道转子现在在哪然后把定子电流分解到与转子对齐的 d 轴和超前 90 度的 q 轴上。q 轴电流管转矩d 轴电流管励磁这就是解耦。但三相电流 Ia、Ib、Ic 是相位差 120 度的交流量直接控制它们等于同时追三个旋转目标根本没法做 PI。Clark 变换先把三轴降成两轴静止坐标系 α-β把 120 度相位差消掉Park 变换再把静止的 α-β 转到跟着转子一起转的 d-q 坐标系。在 d-q 坐标系里稳态下 id 和 iq 都是直流量PI 控制器才能正常工作。所以顺序不能反先 Clark 降维再 Park 线性化。2.2 Clark 变换的数学推导与系数选择笔记里从基尔霍夫电流定律出发Ia Ib Ic 0。三相电流不是独立的知道两相就能推出第三相。把三相投影到 α-β 平面α 轴与 A 相重合β 轴超前 90 度得到Iα k * (Ia - Ib/2 - Ic/2) Iβ k * (√3/2 * Ib - √3/2 * Ic)利用 Ia Ib Ic 0 消去 Ic最终形式是Iα k * (3/2) * Ia Iβ k * (√3/2) * (Ia 2Ib)这里的 k 就是变换系数笔记里重点讨论了两种取法。等幅值变换取 k 2/3使得变换后 α 轴分量幅值等于相电流峰值恒功率变换取 k √(2/3)保证变换前后功率不变。实际 FOC 里一般用等幅值变换原因笔记里写得很直白如果用恒功率变换SVPWM 里得到的矢量幅值会变成相电压峰值的 1.5 倍直接超出空间矢量的圆圈产生过调制。这个坑我在早期项目里踩过当时抄了一份恒功率变换的代码母线电压一高SVPWM 就输出异常查了两天才定位到系数。程序实现上笔记给的是等幅值变换的简化写法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; }注意这里 i_alpha 直接等于 ia是因为等幅值变换下 k 取 2/3 后Iα Ia。i_beta 的系数 0.577350269 就是 1/√3。这样写的好处是采样电路只需要采 A 相和 B 相电流C 相由 Ia Ib Ic 0 算出省一路 ADC 和运放成本和复杂度都降下来。参数上唯一要盯的就是这个 0.577350269别写成 0.5 或者 0.866否则电流环的反馈量直接偏PI 怎么调都稳不住。2.3 Park 变换与逆变换的实现细节Park 变换把 α-β 转到 d-q公式是Id Iα * cosθ Iβ * sinθ Iq -Iα * sinθ Iβ * cosθθ 是转子电角度由编码器或霍尔传感器提供。笔记里的程序实现用了查表加 Q15 定点数dq_t Park(alphaBeta_t input, int16_t theta) { dq_t output; Trig_Components TempSinCos; float cos_da, sin_da; TempSinCos Trig_Functions(theta); // 查表得到 sin/cos cos_da (float)(TempSinCos.hCos * DIV_Q15); // Q15 转浮点 sin_da (float)(TempSinCos.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; }DIV_Q15 是 1/32768因为查表输出是 Q15 格式。这里有个容易翻车的点θ 的精度和范围。如果 θ 是 0 到 65535 对应 0 到 360 度查表索引要右移相应位数如果 θ 是 0 到 4095索引方式又不一样。我见过有人直接把机械角度当电角度用结果极对数没乘电机转起来一顿一顿的。Park 逆变换就是把 d-q 转回 α-β公式是Iα Id * cosθ - Iq * sinθ Iβ Id * sinθ Iq * cosθ程序实现和 Park 对称注意符号别搞反。逆变换的输出直接送给 SVPWM所以这里的 cos/sin 必须和 Park 用的是同一组值否则角度对不上电流环会引入额外相位误差。3. SVPWM扇区判断、作用时间与过调制处理3.1 扇区判断的三种变量法SVPWM 的理论基础是平均值等效原理在一个 PWM 周期内用相邻两个非零矢量和零矢量组合使平均值等于给定电压矢量。第一步是判断参考电压矢量在哪个扇区。笔记里用的是定义三个变量 Uref1、Uref2、Uref3Uref1 Uβ Uref2 (√3/2) * Uα - (1/2) * Uβ Uref3 -(√3/2) * Uα - (1/2) * Uβ然后看这三个变量与 0 的关系Uref1 0 则 A 1否则 A 0Uref2 0 则 B 1Uref3 0 则 C 1。令 N A 2B 4CN 与扇区的对应关系是N3 对应扇区 IN1 对应扇区 IIN5 对应扇区 IIIN4 对应扇区 IVN6 对应扇区 VN2 对应扇区 VI。这个映射表建议直接抄在代码注释里现场调试时对着看比重新推导快得多。3.2 作用时间计算方法一与方法二的差异笔记里给了两种计算非零矢量作用时间的方法。方法一是从正弦定理出发直接解出 T4 和 T6T4 (√3 * Ts / Udc) * Uβ T6 (√3 * Ts / Udc) * (√3/2 * Uα - 1/2 * Uβ)方法二是把电压矢量投影到 α-β 轴令两轴分量相等解出 t1 和 t2。两种方法结果一致但方法二的中间变量更少适合定点数实现。笔记里特别提醒T1 和 T2 的大小写要注意T1 是第一个非零矢量的作用时间T2 是第二个不同扇区对应的矢量编号不同。比如扇区 I 是 0→4→6→7→7→6→4→0T1 对应矢量 4T2 对应矢量 6扇区 II 是 0→2→6→7→7→6→2→0T1 对应矢量 2T2 对应矢量 6。这个顺序搞错PWM 波形就是乱的。零矢量的分配也有讲究。笔记里写的是 T0 T7 (Ts - T1 - T2) / 2即零矢量平均分配这样产生的 PWM 是对称的谐波分量最低。如果为了减少开关次数把零矢量全放在一边波形不对称电机噪音会明显变大。3.3 过调制处理与磁链圆限制当参考电压矢量的幅值超过 SVPWM 线性调制区的最大值时就进入过调制。笔记里给的调制系数 m (√3 * |Uref|) / Udc线性区要求 m ≤ 1对应 |Uref| ≤ Udc/√3。如果 m 超过 1T1 T2 会大于 Ts这时候必须做限幅否则作用时间溢出PWM 占空比计算出错。磁链圆限制就是干这个的。笔记里提到确定 MAX_MODULE 值这个值就是允许的最大电压矢量幅值。程序里一般这样处理float max_module Udc / 1.7320508; // Udc/√3 float module sqrtf(Ualpha * Ualpha Ubeta * Ubeta); if (module max_module) { float scale max_module / module; Ualpha * scale; Ubeta * scale; }START_INDEX 则是扇区判断的起始索引用于查表时定位。这两个参数设错要么电机出力不足要么过调制导致电流波形削顶转矩脉动变大。我一般会在调试时把 module 和 max_module 打到 DAC 上用示波器看有没有削顶比盯着代码猜快得多。4. PID 离散化与积分抗饱和位置式还是增量式4.1 位置式与增量式的区别笔记里把位置式 PID 和增量式 PID 的区别讲得很清楚。位置式输出的是控制量的绝对值u(k) Kp * e(k) Ki * Σe(j) Kd * (e(k) - e(k-1))增量式输出的是控制量的增量Δu(k) Kp * (e(k) - e(k-1)) Ki * e(k) Kd * (e(k) - 2e(k-1) e(k-2))位置式需要累加历史误差积分项容易饱和增量式不需要累加天然抗饱和但输出是增量需要外部累加器。FOC 的电流环一般用位置式因为需要直接输出 Ud 和 Uq速度环可以用增量式避免积分饱和。笔记里给的代码框架是位置式积分项单独累加方便做抗饱和处理。4.2 积分抗饱和的三种方法积分饱和的现象是当误差长期存在时积分项一直累加输出达到限幅值后积分项还在涨等误差反向时积分项需要很长时间才能退回来导致系统响应迟钝。笔记里列了三种抗饱和方法第一种是积分限幅直接限制积分项的累加范围if (integral integral_max) integral integral_max; if (integral integral_min) integral integral_min;第二种是积分分离当误差大于某个阈值时暂时关闭积分作用只用 PD 控制等误差小了再开启积分。第三种是反计算抗饱和当输出饱和时把饱和量与输出量的差值反馈到积分项加速积分退出饱和。实际项目里我一般用第一种加第二种组合简单可靠参数好调。4.3 参数整定的实操顺序笔记里没有展开讲整定步骤但根据我的经验FOC 参数整定要按电流环→速度环→位置环的顺序来。电流环先把 Ki 设 0Kp 从小往大加直到电流阶跃响应出现轻微超调然后加 Ki消除稳态误差。速度环的带宽一般设成电流环的 1/5 到 1/10Kp 和 Ki 按同样方法调。位置环带宽最低Kp 为主Ki 很小甚至为 0。每个环调完后用阶跃给定看响应曲线超调控制在 10% 以内调节时间满足要求即可。别一上来三个环一起调那是玄学不是工程。5. 避坑与排查那些让电机发抖的细节5.1 电角度方向与极对数不匹配现象电机能转但转速越高抖动越明显电流波形畸变。原因电角度方向与编码器计数方向相反或者极对数没乘。解决先手动转电机看电角度是否单调变化确认极对数后在角度计算里乘上 pole_pairs。如果方向反了把 sin/cos 的符号对调或者编码器计数方向取反。5.2 Clark 变换系数用错导致过调制现象母线电压升高后SVPWM 输出异常电机突然失速。原因用了恒功率变换系数矢量幅值超出线性区。解决确认 Clark 变换用的是等幅值系数 2/3检查 SVPWM 里的 max_module 是否按 Udc/√3 设置。如果必须用恒功率变换SVPWM 的限幅值要相应调整。5.3 积分饱和导致启动过冲现象电机启动时电流冲得很高然后慢慢回落速度响应慢。原因位置式 PID 积分项在启动阶段累加过大。解决加积分限幅或者启动时先关闭积分等电流接近给定值再开启。我一般会在启动前 100ms 内把积分项清零效果很明显。5.4 扇区判断边界抖动现象电机在低速时听到咔咔声电流波形有毛刺。原因参考电压矢量在扇区边界附近时N 值频繁跳变导致矢量切换顺序错乱。解决在扇区判断里加滞环或者对 Uα、Uβ 做低通滤波。滞环宽度一般取额定电压的 1% 到 2%。5.5 零矢量分配不对称引入谐波现象电机运行时有高频啸叫示波器看相电压波形不对称。原因零矢量 T0 和 T7 没有平均分配或者切换顺序不是中心对称。解决严格按 0→4→6→7→7→6→4→0 的顺序生成 PWMT0 T7 (Ts - T1 - T2)/2。如果用的是七段式 SVPWM检查比较寄存器的赋值顺序。6. 用 Simulink 验证推导把公式跑成波形笔记里的推导再详细不动手跑一遍还是虚的。我一般会用 Simulink 搭一个最小验证模型把 Clark、Park、SVPWM 每个模块单独拉出来看波形。具体做法是用三个正弦波源模拟 Ia、Ib、Ic频率 50Hz幅值 1相位差 120 度经过 Clark 变换后α 轴应该是幅值 1 的正弦β 轴是幅值 1 的余弦再经过 Park 变换θ 用 50Hz 的锯齿波d 轴和 q 轴应该变成直流量。如果 d 轴有波动说明 θ 和三相波的相位没对齐如果 q 轴幅值不对说明 Clark 系数错了。SVPWM 模块的验证更直接给 Uα 和 Uβ 一个恒定幅值、缓慢旋转的矢量看输出的三相占空比是不是马鞍波。笔记里专门提到了马鞍波的形成原因——零序分量注入。SVPWM 本质上是在 SPWM 里注入了零序分量使得相电压波形变成马鞍形母线电压利用率提高约 15.47%。如果你在 Simulink 里看到的占空比是纯正弦那说明零序注入没做对检查扇区判断和作用时间计算。验证通过后把 Simulink 里的参数直接导出成 C 代码的宏定义比如 Ts、Udc、max_module、积分限幅值这样手写代码和仿真模型就能对上。我习惯在模型里加一个 Assertion 模块检查 T1 T2 是否大于 Ts一旦触发就暂停仿真比在硬件上烧管子便宜得多。从那以后我每次调新电机都强制走一遍 Simulink 验证先看 Clark/Park 波形对不对再看 SVPWM 马鞍波最后才上硬件。这个习惯帮我省了至少三块驱动板。希望帮到你。本文还有配套的精品资源点击获取
