做电机驱动的人应该都有过这种感受PMSM的FOC控制公式和模块看起来又多又玄但真把原理一条条捋顺之后在Matlab/Simulink里做仿真验证其实是一个非常清晰的流程。这些年我调过好几套永磁同步电机方案从Simulink原型验证到DSP、STM32移植最大的体会是——先把仿真模型搭对后面写代码踩的坑能少一大半。这篇我就结合自己的项目经验把PMSM FOC和SVPWM的实现过程完完整整拆给你看包含可直接抄作业的算法代码和Simulink建模块操作适合正在学电机控制的学生也适合刚接手FOC驱动开发的工程师。FOC本身不复杂复杂的是你在网上搜到的资料各说各话一会儿用等幅值变换一会儿用等功率变换一会儿Id0一会儿MTPA一会儿SVPWM七段式一会儿五段式初学者很容易被绕晕。我尽量用最直白的语言把这些点都串起来你跟着搭一遍模型基本就清楚整条链路是怎么回事了。1. 先搞定FOC的核心逻辑1.1 PMSM控制的难点在哪里永磁同步电机PMSM的定子是三相绕组转子是永磁体。三相绕组通电后产生旋转磁场拉着转子永磁体跟着转。问题在于三相电流是交流量频率随着转速变化而且三个相之间还有电气耦合直接控制三相电压/电流非常别扭就像一个人同时被三个人推着走三个人力道方向随时在变很难配合。再看无刷直流电机BLDC它的反电动势是梯形波用六步换相法就能转控制简单但转矩脉动大。而PMSM的反电动势是正弦波需要用正弦电流驱动才能保证转矩平稳、噪声低。这就引出了FOCField-Oriented Control磁场定向控制。FOC的核心思路一句话就能说清把三相交流量通过坐标变换变成两相旋转坐标系下的直流量然后像控制直流电机一样去控制转矩和磁通。直流量可以用普通PI控制器做到无静差调节这就是FOC比标量控制V/F控制性能好的根本原因。1.2 FOC到底在干什么从交流到直流的三步变身要把电机里那些“扭转、交变”的量变成直流数学上需要做两次坐标变换加一次逆变换整个过程就像一个翻译器Clarke变换把三相静止坐标系a、b、c变成两相静止坐标系α、β。相当于把三个互差120度的力合成到一个平面上用横纵两个分量表示。Park变换把两相静止坐标系α、β变成两相旋转坐标系d、q。这里面需要一个关键变量——转子电角度θ。变换之后d轴电流对应励磁分量q轴电流对应转矩分量。逆Park变换控制器在d、q旋转坐标系里算出Ud、Uq再变换回α、β静止坐标系交给SVPWM去生成三相PWM。对表贴式永磁同步电机SPMSM来说d轴和q轴的电感基本相等Ld≈Lq所以电磁转矩公式简化为Te 1.5 × P × ψf × Iq其中P是极对数ψf是永磁体磁链。转矩只跟Iq成正比这就是为什么FOC控制里通常让Id0把所有电流都用来产生转矩效率最高。1.3 三大变换公式一条条对照着用这些公式在很多书里写法不一我直接给等幅值变换下的常用版本你在Simulink里搭模块时照这个写就行。Clarke变换三相→两相静止Iα Ia Iβ (Ia 2×Ib) / √3这里假设Ia、Ib、Ic三相对称IaIbIc0。如果三相不平衡直接用下式Iα (2/3)×(Ia - 0.5×Ib - 0.5×Ic) Iβ (2/3)×(√3/2×Ib - √3/2×Ic)Park变换两相静止→两相旋转Id Iα×cosθ Iβ×sinθ Iq -Iα×sinθ Iβ×cosθ逆Park变换两相旋转→两相静止Uα Ud×cosθ - Uq×sinθ Uβ Ud×sinθ Uq×cosθθ是转子电角度等于机械角度乘以极对数。在Simulink里PMSM模块的输出端口会直接给出转子角度θe和电角速度we不需要自己再乘极对数但这个换算关系在你的C代码里写功能函数时一定要搞清楚我吃过亏后面会专门说。2. SVPWM算法母线电压利用率提升15%的核心2.1 为什么用SVPWM而不是直接SPWMFOC算出来的是Uα、Uβ两个电压分量怎么变成三相桥臂的PWM开关信号最简单的是SPWM也就是用三相正弦调制波和三角载波比较生成PWM。但SPWM有个明显短板直流母线电压利用率低相电压基波幅值最大只有Udc/2换算成线电压也就0.866×Udc也就是说311V直流母线最多输出约269V的线电压有效值。SVPWM的思路完全不同它把逆变器看成8种开关状态的组合通过一个PWM周期内相邻两个有效矢量加零矢量的时间分配去合成任意方向、一定幅值的电压矢量。好处有两个母线电压利用率高线性调制区域最大相电压基波幅值可以达到Udc/√3比SPWM提升约15.47%。在母线电压固定的前提下电机能跑更高的转速。谐波含量低电流波形更正弦转矩脉动小。这也是为什么FOC工程中基本都用SVPWM而不是SPWM。2.2 SVPWM扇区判断SVPWM第一步是判断当前参考电压矢量落在哪个扇区。三相逆变器的6个有效电压矢量把平面分成6个60°扇区如图想象一下六个方向0°、60°、120°……。工程上不用画图判断直接用Uα、Uβ算三个中间变量A Uβ 0 ? 1 : 0 B (√3×Uα - Uβ) 0 ? 1 : 0 C (-√3×Uα - Uβ) 0 ? 1 : 0 N A 2×B 4×CN和扇区的对应关系为N扇区3Ⅰ0°~60°1Ⅱ60°~120°5Ⅲ120°~180°4Ⅳ180°~240°6Ⅴ240°~300°2Ⅵ300°~360°这组映射表我踩过坑网上有些文章的映射顺序是反的因为坐标定义或条件符号不同。你在自己推导时用一个已知角度去验证一下就行比如Uα0.3UdcUβ0.3Udc这个点在0°~60°之间代入算出来N3对应扇区Ⅰ说明映射表是对的。2.3 矢量作用时间计算判断完扇区后要计算相邻两个有效矢量的作用时间T1、T2以及零矢量作用时间T0 Ts - T1 - T2。先算三个中间量X √3×Uβ / Udc Y (1.5×Uα √3/2×Uβ) / Udc Z (-1.5×Uα √3/2×Uβ) / Udc然后根据扇区查表扇区T1T2Ⅰ-ZXⅡYZⅢX-YⅣZ-XⅤ-Y-ZⅥ-X-Z注意这里的T1、T2是以Ts为基准的标幺值最终实际时间还要乘以Ts。如果发生T1T2Ts说明参考电压已经超出线性调制范围进入过调制区需要做限幅处理按比例缩小T1、T2把总时间压回Ts以内。2.4 七段式SVPWM完整C代码SVPWM生成的PWM波形有七段式和五段式之分。七段式开关次数多、谐波小是工程中最常用的。我写一套可以直接移植到STM32或DSP的浮点C代码逻辑完整包含扇区判断、作用时间计算、过调制限幅和三相PWM比较值输出#include math.h #define SQRT3 1.7320508075688772f typedef struct { float Ta; // A相PWM比较值时间 float Tb; // B相PWM比较值时间 float Tc; // C相PWM比较值时间 } SVPWM_Result; /** * brief SVPWM计算 * param Ualpha: alpha轴电压 * param Ubeta: beta轴电压 * param Udc: 直流母线电压 * param Ts: PWM开关周期 * retval 三相PWM比较值 */ SVPWM_Result svpwm_calc(float Ualpha, float Ubeta, float Udc, float Ts) { SVPWM_Result out; float X, Y, Z; float T1, T2, T0; float Tcmpa, Tcmpb, Tcmpc; int A 0, B 0, C 0, N 0; // 1. 计算中间量X、Y、Z X SQRT3 * Ubeta / Udc; Y (1.5f * Ualpha 0.8660254f * Ubeta) / Udc; Z (-1.5f * Ualpha 0.8660254f * Ubeta) / Udc; // 2. 扇区判断 if (Ubeta 0.0f) A 1; if ((SQRT3 * Ualpha - Ubeta) 0.0f) B 1; if ((-SQRT3 * Ualpha - Ubeta) 0.0f) C 1; N A 2 * B 4 * C; // 3. 根据扇区查表得到T1、T2标幺值 switch (N) { case 3: T1 -Z; T2 X; break; // 扇区Ⅰ case 1: T1 Y; T2 Z; break; // 扇区Ⅱ case 5: T1 X; T2 -Y; break; // 扇区Ⅲ case 4: T1 Z; T2 -X; break; // 扇区Ⅳ case 6: T1 -Y; T2 -Z; break; // 扇区Ⅴ case 2: T1 -X; T2 -Z; break; // 扇区Ⅵ default: T1 0.0f; T2 0.0f; break; } // 4. 过调制限幅 if ((T1 T2) 1.0f) { float scale 1.0f / (T1 T2); T1 * scale; T2 * scale; } // 5. 计算零矢量时间和七段式比较点 T0 1.0f - T1 - T2; Tcmpa T0 / 4.0f; Tcmpb T0 / 4.0f T1 / 2.0f; Tcmpc T0 / 4.0f T1 / 2.0f T2 / 2.0f; // 6. 根据扇区分配三相比较值 switch (N) { case 3: out.Ta Tcmpa; out.Tb Tcmpb; out.Tc Tcmpc; break; // 扇区Ⅰ case 1: out.Ta Tcmpb; out.Tb Tcmpa; out.Tc Tcmpc; break; // 扇区Ⅱ case 5: out.Ta Tcmpc; out.Tb Tcmpa; out.Tc Tcmpb; break; // 扇区Ⅲ case 4: out.Ta Tcmpc; out.Tb Tcmpb; out.Tc Tcmpa; break; // 扇区Ⅳ case 6: out.Ta Tcmpb; out.Tb Tcmpc; out.Tc Tcmpa; break; // 扇区Ⅴ case 2: out.Ta Tcmpa; out.Tb Tcmpc; out.Tc Tcmpb; break; // 扇区Ⅵ default: out.Ta Tcmpa; out.Tb Tcmpa; out.Tc Tcmpa; break; } // 7. 乘以开关周期转成实际时间 out.Ta * Ts; out.Tb * Ts; out.Tc * Ts; return out; }这段代码输出的是PWM翻转比较点时间。如果你的MCU用的是增/减计数模式直接把out.Ta、out.Tb、out.Tc写入比较寄存器配置好PWM极性就能得到完整的七段式SVPWM波形。代码里我没有用查表法优化速度为的是让逻辑更透明方便你对照原理理解。等你在工程里跑通了再改成定点或查表方案也不迟。2.5 七段式PWM的波形特征很多初学者拿到SVPWM代码看到三相调制波不是标准正弦会怀疑是不是算错了。这里明确告诉你SVPWM的调制波不是纯正弦而是叠加了零序分量的马鞍形/类梯形波。这个零序分量正是提升母线电压利用率的关键。你在Simulink里观察三相调制波如果看到马鞍形波形说明SVPWM生效了如果看到纯正弦说明你自己搭的模型可能退化成了SPWM。3. Simulink模型搭建实操3.1 模型总览与库选择我用的环境是Matlab R2021bSimscape Electrical库。不同版本库路径有差异但模块名基本一致。打开Simulink后新建空模型保存为PMSM_FOC_Demo.slx然后按模块逐个搭建。整体模型分三大部分主电路直流电压源 → 三相两电平逆变器 → PMSM → 负载转矩。测量电路三相电流传感器、转子位置/速度输出、母线电压。控制回路速度PI → 电流PId、q → 逆Park → SVPWM → PWM脉冲。我建议把控制回路和主电路分开画中间用Goto/From标签连接不然连线会乱到怀疑人生。真的Simulink模型一乱调试效率直接减半。3.2 主电路与电机参数设置直流电源选DC Voltage Source电压设311V模拟三相整流后的母线电压。逆变器选Universal Bridge双击设置Number of bridge arms3Power electronic deviceIGBT/DiodesPort configurationABC as output terminals把Snubber resistance改成1e5欧姆默认的1e6有时会导致波形高频振荡。这个细节是我对比仿真结果时发现的默认值在某些步长下会引入不必要的数值振荡。PMSM模块用Permanent Magnet Synchronous Machine我这里用的是一组典型的42V低压电机参数做实验台架或者小功率驱动很合适Stator phase resistance Rs0.958 ΩInductances [Ld Lq][5.25e-3, 5.25e-3] HFlux linkage established by magnets0.1827 WbInertia0.0006329 kg·m²Pole pairs4Mechanical inputTorque用转矩输入方便后面加负载电机输出端口会给出三相电流、反电动势、转子角度和转速。这里有个容易搞混的地方PMSM模块内部输出的转子角速度是电角速度还是机械角速度不同版本的模块输出定义不太一样我习惯看一下参数文档或者在输出端加一个Scope先确认量级。电角速度机械角速度×极对数搞反了控制环会直接发散。负载转矩用Step模块给出设置为0在2秒时阶跃到5N·m用来测试突加负载的动态响应。3.3 坐标变换与PI控制器搭建坐标变换我建议写成MATLAB Function块比用一堆Gain和Sum搭清爽得多也方便移植成代码。新建一个MATLAB Function双击编辑function [Id, Iq] park_transform(Ialpha, Ibeta, theta) % Park变换 Id Ialpha * cos(theta) Ibeta * sin(theta); Iq -Ialpha * sin(theta) Ibeta * cos(theta); endClarke变换同理function [Ialpha, Ibeta] clark_transform(Ia, Ib, Ic) % Clarke变换等幅值形式 Ialpha Ia; Ibeta (Ia 2 * Ib) / sqrt(3); end逆Park变换function [Ualpha, Ubeta] inv_park_transform(Ud, Uq, theta) % 逆Park变换 Ualpha Ud * cos(theta) - Uq * sin(theta); Ubeta Ud * sin(theta) Uq * cos(theta); endPI控制器可以用Simulink自带的Discrete PI Controller也可以直接用PID Controller模块。我推荐后者界面清晰还能直接看饱和限幅。控制回路结构速度环输入是速度参考比如1500rpm减去实际转速输出Iq_ref。速度环PI参数先给Kp0.1Ki2后面再细调。Id环Id_ref设为0减去实际Id输出Ud。电流环PI初值Kp10Ki100。Iq环Iq_ref减去实际Iq输出Uq。电流环PI初值同上。PI控制器输出必须加Saturation饱和度限幅。Ud、Uq限幅±150VIq_ref限幅±20AId_ref限幅±10A。不加限幅的PI在启动瞬间可能输出天文数字仿真波形直接爆炸这点务必要做。3.4 SVPWM与PWM脉冲生成在Simulink里可以有两种方式生成PWM一种是直接调用Simscape Electrical库的**PWM Generator (2-level)**模块选Space vector PWM模式输入Ualpha、Ubeta和Udc模块内部帮你算好开关逻辑。这种方式最快但把SVPWM算法封装起来了不利于你理解原理。既然标题说“附SVPWM算法代码”我建议自己在模型里实现一遍。使用MATLAB Function块输入Ualpha、Ubeta输出三相平均占空比Da、Db、Dc然后再用三角载波比较生成PWM。MATLAB Function里写function [Da, Db, Dc] svpwm_duty(Ualpha, Ubeta, Udc) % 输出SVPWM三相平均占空比范围0~1 SQRT3 1.7320508075688772; X SQRT3 * Ubeta / Udc; Y (1.5 * Ualpha 0.8660254 * Ubeta) / Udc; Z (-1.5 * Ualpha 0.8660254 * Ubeta) / Udc; A double(Ubeta 0); B double((SQRT3 * Ualpha - Ubeta) 0); C double((-SQRT3 * Ualpha - Ubeta) 0); N A 2*B 4*C; switch N case 3, T1 -Z; T2 X; case 1, T1 Y; T2 Z; case 5, T1 X; T2 -Y; case 4, T1 Z; T2 -X; case 6, T1 -Y; T2 -Z; case 2, T1 -X; T2 -Z; otherwise, T1 0; T2 0; end if (T1 T2) 1 scale 1 / (T1 T2); T1 T1 * scale; T2 T2 * scale; end T0 1 - T1 - T2; % 三相平均占空比按扇区分配 switch N case 3 Da 1 - T0/2; Db (1 - T1 T2)/2; Dc T0/2; case 1 Da (1 - T2 T1)/2; Db 1 - T0/2; Dc T0/2; case 5 Da T0/2; Db 1 - T0/2; Dc (1 - T1 T2)/2; case 4 Da T0/2; Db (1 - T2 T1)/2; Dc 1 - T0/2; case 6 Da (1 - T1 T2)/2; Db T0/2; Dc 1 - T0/2; case 2 Da 1 - T0/2; Db T0/2; Dc (1 - T2 T1)/2; otherwise Da 0.5; Db 0.5; Dc 0.5; end end然后生成三角载波用Repeating Sequence模块Time values设为[0 Ts/2 Ts]Output values设为[0 1 0]这样就是0到1的三角波。Ts是PWM周期10kHz开关频率对应Ts1e-4秒。把Da、Db、Dc各接一个Relational Operator设置和三角载波比较输出就是三路PWM信号。这里有个细节Universal Bridge每个桥臂需要互补的上下管脉冲。你可以直接把这路PWM接到上管然后用Logic NOT取反接给下管。注意理想情况下没有死区会有直通风险但在Simulink纯仿真里很多教学模型是先忽略死区的因为电源内阻和开关模型会限制短路电流。真要严谨可以在Universal Bridge模块里找到死区设置参数或者在PWM生成后加Transport Delay模拟死区初学者可以先不管。3.5 求解器与仿真参数设置这一步特别影响仿真体验。很多人仿真跑不动或者波形毛刺多多半是求解器设置问题。求解器选固定步长Fixed-step不要用变步长。推荐ode3或ode4。步长1e-6秒即1微秒。10kHz的PWM周期是100微秒步长太大会丢失PWM边沿信息波形失真步长太小仿真速度慢。仿真时长先跑1.5秒足够看启动过程。跑通后再加长。如果模型里PMSM用的是Simscape Electrical的特种功率系统模块求解器步长太大会直接报“步长导致仿真不稳定”之类的错误这个1e-6的经验值我自己用了很久多数场景都稳。4. 仿真结果分析与调参经验4.1 启动过程波形怎么读模型搭好仿真跑起来先看三个波形转速、Iq电流、三相电流。给定速度阶跃1500rpm。正常情况下转速经过一个缓慢的斜坡上升过程到达目标值会有轻微超调然后收敛。Iq在启动瞬间会有一个尖峰加速转矩需求随后稳定在一个较小数值用来克服空载损耗。三相电流是正弦波幅值平稳频率随转速升高而升高。如果你看到转速振荡、发散或者电流畸变严重优先检查转子角度theta的符号和相位是否接反。Park变换的sin/cos正负号是否和PMSM模型的约定一致。PI控制器极性是否反了这点最坑速度环输出Iq_ref但电流环反馈符号不对时系统就是正反馈。4.2 突加负载看动态响应把负载转矩Step从0改到5N·m触发时间设在2秒。仿真后看转速波形应该有一个短暂的下坠然后回到1500rpm。Iq会从空载值跳变到对应5N·m的转矩电流。对于这个参数的电机Iq稳定值大约Iq ≈ Te / (1.5 × P × ψf) 5 / (1.5 × 4 × 0.1827) ≈ 4.56A注意这是理想值实际会有磁阻转矩和损耗的存在略有偏差是正常现象。如果转速下坠后回不到设定值先检查速度环PI。如果回得很慢是Kp太小或Ki太小。如果剧烈振荡是Kp太大或者限幅太紧。4.3 PI参数整定给小白一个可复制的起点电流环PI整定可以按内模控制IMC法做初值。对表贴式PMSM取电流环带宽ωc1500rad/sKp L × ωc 5.25e-3 × 1500 7.875 Ki R × ωc 0.958 × 1500 1437注意Simulink的PID模块中积分增益Ki表示的是对误差积分的直接放大倍数不是传统意义上的1/Ti时间常数。如果你用的是PID模块直接填这个数就行。有些教程给的Ki很小其实是用了积分时间常数的形式单位不同别混。速度环带宽取电流环的1/10到1/5比如ωs100rad/s转动惯量J0.0006329kg·m²速度环初值可以这样估Kp_s J × ωs 0.06329 Ki_s Kp_s × ωs / 10 ≈ 0.63这个初值不一定完美但至少能让系统稳定然后再去看阶跃响应微调。我的经验是先调电流环电流环稳了再调速度环千万别两个环同时调不然出了问题你都分不清是哪一环的锅。4.4 常见波形异常的定位方向波形现象可能原因排查思路转速震荡发散角度方向反、PI极性反、参数过大先断开速度环给定子Iq看电流环是否稳定三相电流严重畸变SVPWM输出过调制、母线电压设置偏低减小Id/Iq参考或提高Udc观察T1T2是否经常饱和Iq有偏置但转速不动电机极对数或角度换算错误检查PMSM模块角度输出用恒流开环确认电机能否转动低频转矩脉动电流采样/变换相位出错编码器零位偏Simulation里直接用模块输出角度重点查角度符号仿真非常慢变步长或步长太小改固定步长1e-6关闭不必要的Scope显示5. 常见问题与排查技巧实录5.1 电机不转或者转向反了最经典的错误就是角度反馈符号反了。你想想Park变换要用转子的实时角度才能把Id/Iq解耦成直流量如果角度方向反了解耦出来的Id和Iq是错的电流环就等效于给电机加了一个反向转矩电机自然转不起来或者往反方向跑。排查方法先不接速度环让Iq_ref固定为一个小值比如2AId_ref0看电机能不能加速。如果加速了说明电流环和变换正负号都没问题如果不动或反转把theta乘以-1再试。这类问题在单片机实验里更常见因为编码器AB相接反了很隐蔽Simulink里用模块内部角度倒是不会错但仿真验证时也要养成检查角度的习惯。5.2 电流波形有毛刺或者有明显畸变先排除过调制。在SVPWM函数里加一个监视输出看T1T2是不是经常大于1。如果经常饱和说明参考电压超出了线性调制范围。这时候要么降低速度环给定要么提高直流母线电压要么在电流环输出端把限幅调小一点。还有一个容易被忽略的点PI输出限幅和SVPWM调制范围要匹配。比如Udc311V线性调制区最大相电压幅值是Udc/√3≈179.6V但你在电流环输出Ud、Uq限幅到150V这没问题如果限幅到180V以上SVPWM一进过调制区电流波形就开始长毛刺了。5.3 仿真报错或者速度极慢Simscape Electrical的模块在变步长下经常出奇慢还容易不收敛。我的惯例是一上来就固定步长1e-6如果还慢把仿真时长缩短到0.3秒先调通逻辑再拉长到1.5秒看完整过程。另外Scope窗口不要全部打开显示波形Scope本身也消耗仿真资源尤其多个Scope同时绘制大量数据点时仿真速度肉眼可见地掉。5.4 从Simulink仿真到嵌入式移植的要点仿真跑通后真正上板子之前有几个关键点定点化STM32F103这类M3内核做浮点运算还行但要上更高开关频率或更低成本MCUSVPWM和PI控制都要转成Q格式定点运算。转之前先在仿真里把每路变量的范围列出来避免移植后溢出。ADC和PWM的同步FOC采电流要在PWM周期的中心点触发ADC因为中心点电流纹波最小。这个时序在Simulink里不用操心但写底层代码时一定要对齐否则电流采样噪声能让你怀疑人生。转子初始位置检测仿真里PMSM模块直接给出绝对角度现实中电机一上电你不知道转子在哪。工程上要么用带绝对位置输出的编码器要么用高频注入或预定位做初始位置检测这是FOC上板的一块硬骨头。标幺化把电流、电压、转速都标幺到0~1或-1~1之间方便在不同母线电压的平台上复用控制算法。这也是我的习惯仿真模型里先用实际值方便理解移植时统一改为标幺值。6. 写在最后一些个人体会我一直觉得做FOC控制最忌讳“只会用模型不懂原理”。Simulink里拖一个PMSM模块、一个PWM Generator就能跑但真到硬件调试阶段任何一点细节问题都会让系统直接崩掉。所以有机会的话把SVPWM、Clarke、Park、逆Park这些模块自己手写一遍哪怕只是用MATLAB Function也能帮你把整个链路吃透。这套流程我反复走过好几次每次换平台、换电机、换母线电压核心都是同一套逻辑坐标变换解耦、电流环像调直流电机一样调转矩、SVPWM保证母线电压利用率。把这三点刻在脑子里PMSM FOC基本就掌握了七八成。如果你是自己搭模型跑的时候卡住了回头检查顺序建议是先看角度再看电流环最后看速度环。角度错了一切免谈电流环稳了速度环只是锦上添花。祝顺利。