FOC核心调制SVPWM：从原理到代码实现与调试

开头直接以博主口吻切入先承接上一篇再点出为什么要先做SVPWM。上次我们把工程框架搭起来电机能转但转得很难看那是因为用的还是最原始的六步换相——换相点一拍脑袋定死电流换向生硬低速抖动、高速啸叫全是它的锅。这次我们要干的事就是把FOC里最核心的调制环节SVPWM落地写出一份能直接跑的代码并且想尽办法验证它没写错。先说清楚一件事SVPWM在FOC里的地位不是锦上添花而是没有它就谈不上FOC。FOC就是控制转子磁场定向最终要给电机三相绕组输出特定幅值和相位的正弦电压。但STM32的定时器管脚只能输出0或3.3V的电平最多通过PWM占空比让桥臂输出的平均电压等于一个直流电平。SVPWM就是干这个的把αβ坐标系里一个连续旋转的电压矢量转换成三路互补PWM占空比让逆变器桥臂输出电压的基波尽可能接近我们想要的电机相电压。本篇是这个系列的第二篇动手前建议你先把上一篇的环境搭好代码在HAL库工程上直接加文件就行。这一篇的目标很明确看懂SVPWM计算逻辑 → 写出代码 → 用示波器和串口验证波形正确。1. SVPWM在FOC里的定位为什么这个环节决定了电机能不能转1.1 从同步旋转坐标系到桥臂占空比FOC整个控制链路的末端是这样的电流环输出Uq、Ud经过反Park变换得到Uα、Uβ这两个电压量仍然是在静止αβ坐标系下的连续量。问题是逆变器没法直接输出连续电压它只能输出高电平和低电平靠占空比的平均效果来模拟。SVPWM干的事就是找到一组三路占空比(Da, Db, Dc)让逆变器输出端的三相电压基波正好等于Uα、Uβ对应的那组三相正弦电压。打个比方这就像一个翻译官FOC核心算法说的是我要一个3000转的旋转磁场SVPWM负责把这个需求翻译成三个桥臂各自在什么时间点开、什么时间点关。很多人刚接触FOC时会有一个误区觉得SVPWM只是输出正弦波而已那直接用SPWM不就行了。这就是忽略了SVPWM一个关键优势它让逆变器的直流母线电压利用率提高了15.47%。SPWM调制下逆变器能输出的最大相电压幅值是Vdc/2而SVPWM能输出到Vdc/√3≈0.577Vdc。别小看这15%电机额定转速直接差出15%。同样的母线电压SVPWM能让电机跑得更快同样的转速目标SVPWM能让你在母线电压上省出一大截余量。对于电池供电的便携设备这个优势往往直接决定方案可不可行。1.2 FOC算法链路里SVPWM的前后级关系从整个FOC框架看SVPWM前面是反Park变换后面是定时器比较寄存器。信号流是这样的电流采样 → Clark变换(Iα/Iβ) → Park变换(Id/Iq) → PI调节器(Ud/Uq) → 反Park变换(Uα/Uβ) → SVPWM → 定时器CCR → 逆变器MOSFETSVPWM的输入是Uα/Uβ和母线电压Vdc输出是三路0到1之间的占空比数值。这个占空比不能直接给电机还得换算成定时器的比较寄存器值。这一步换算的精度直接决定了前面所有PI计算出的电压有没有被忠实还原如果这里系数错一个√3电流环的PI参数也会跟着全部失真。这也是为什么SVPWM值得单独花一整篇来讲它是整个FOC链路里第一个从算法数字世界跳到物理PWM世界的环节系数错一点整条链路都白搭。2. 扇区判断与作用时间计算把课本公式变成可运行的代码2.1 八个基本电压矢量与扇区地图先复习一个关键概念。三相全桥逆变器有6个MOSFET分成上三桥和下三桥同一时刻同一桥臂上下管不能同时导通。如果用1表示上管导通、0表示下管导通那么三个桥臂的状态组合一共有8种对应8个基本电压矢量6个非零矢量和2个零矢量。这6个非零矢量在αβ平面上的分布正好把360°分成6个扇区相邻两个非零矢量间隔60°。SVPWM的调制思想很直接你想要的任意电压矢量必然落在某个扇区里那就用这个扇区相邻的两个非零矢量各作用一段时间中间再插入零矢量凑满整个PWM周期平均效果就等于目标矢量。问题就变成两件事当前目标电压矢量落在哪个扇区在这个扇区里的两个相邻非零矢量各要作用多长时间2.2 扇区判断代码一套符号判断走天下扇区判断最经典的做法是利用Uα、Uβ在三个直线方程上的符号。这三个方程本质就是三对相邻非零矢量之间的分界线。判断逻辑用C语言写非常短// 输入Ualpha, Ubeta单位为V // 输出扇区编号1~6 uint8_t svpwm_sector_calc(float u_alpha, float u_beta) { float v1 u_beta; float v2 -0.5f * u_beta 0.8660254f * u_alpha; float v3 -0.5f * u_beta - 0.8660254f * u_alpha; uint8_t sector 0; if (v1 0) sector 1; if (v2 0) sector 2; if (v3 0) sector 4; return sector; }这里0.8660254就是√3/2。这套判断和课本上常见的N A 2B 4C公式本质一样只是把三个判断函数展开写方便在调试器里直接观察v1/v2/v3的值来判断是否在扇区边界附近。从代码逻辑可以看出扇区判断是纯符号运算没有任何三角函数和开方执行时间极短在F103这种主频不算高的MCU上也能轻松跑在20kHz的中断频率里。2.3 基本矢量作用时间计算X/Y/Z法和查表法判断出扇区之后就要计算相邻两个非零矢量的作用时间。经典的做法是定义三个中间变量X、Y、Z// Ts为PWM周期(s)Vdc为母线电压(V) float x 1.7320508f * u_beta * ts / vdc; float y (1.5f * u_alpha 0.8660254f * u_beta) * ts / vdc; float z (-1.5f * u_alpha 0.8660254f * u_beta) * ts / vdc;然后根据扇区编号查表确定T1和T2分别对应哪个中间变量。扇区T1T21ZY2Y-X3-ZX4-XZ5X-Y6-Y-Z这里我第一次写时踩过一个坑X/Y/Z公式里Uα/Uβ的单位和前面扇区判断里必须一致而且Ts和Vdc必须是用实际值参与计算不能一个用标幺一个用物理值。如果电流环用的是标幺值比如把电流归一化到0~1之间那Uα/Uβ进了SVPWM也得用同一个标幺体系否则作用时间会差出一个母线电压的比例。2.4 七段式PWM波形与比较值分配算出T1、T2之后一个PWM周期里两个非零矢量各作用T1、T2时间剩下的时间由零矢量补齐。为了减少开关次数工程上普遍采用七段式分布也就是零矢量-非零矢量1-非零矢量2-零矢量-非零矢量2-非零矢量1-零矢量的对称结构。七段式的好处是每次开关切换只动一个桥臂开关损耗小而且波形对称性好电流纹波也小。与之对应的五段式分布虽然可以减少开关次数但电流纹波更大FOC里一般不用。不同扇区里A/B/C三相各自的比较值从T1/T2/T0怎么组合有一个固定的分配关系。不必死记硬背写代码时直接查表但要注意这个分配表一旦抄错输出波形会乱得毫无规律而且很难从现象上判断是哪里错了。我建议写完代码后在扇区判断那里加个断点手动给定几组Uα/Uβ算出占空比手算核对一遍。3. min-max等效实现工程里我更推荐的SVPWM写法3.1 为什么扇区法适合理解原理但min-max更适合进工程上一种扇区法思路清晰完全对应SVPWM的几何原理非常适合学习。但在实际工程代码里我更多用另一种等效实现min-max法也叫零序注入法。它的核心思想是SVPWM从数学上等价于在SPWM的三相正弦调制波上叠加一个共模电压分量零序分量把三相波形整体抬高或压低使得调制波的峰峰值不超过三角载波的峰峰值。正是因为这个零序分量调制波的利用率才能比纯SPWM高15.47%。这种实现的好处很直接不需要算扇区不需要查表也不存在T1算出来是负值这种边界问题。代码量少、逻辑简单、不容易抄错。3.2 min-max法完整代码// 输入Ualpha, Ubeta(V)Vdc母线电压(V) // 输出Ta,Tb,Tc范围0~1的占空比 void svpwm_calc_minmax(float u_alpha, float u_beta, float vdc, float *ta, float *tb, float *tc) { // 三相标准正弦参考电压对Vdc归一化 float t1 u_alpha / vdc; float t2 (-0.5f * u_alpha 0.8660254f * u_beta) / vdc; float t3 (-0.5f * u_alpha - 0.8660254f * u_beta) / vdc; // 找最大值和最小值 float tmax t1; float tmin t1; if (t2 tmax) tmax t2; if (t3 tmax) tmax t3; if (t2 tmin) tmin t2; if (t3 tmin) tmin t3; // 零序分量把调制波整体搬到0~1之间 float offset 0.5f - 0.5f * (tmax tmin); *ta t1 offset; *tb t2 offset; *tc t3 offset; }这个函数输出的是0~1之间的占空比接下来直接乘以定时器的ARR值就是CCR比较值。代码本身没有任何分支没有查表执行路径是固定的非常适合放在中断里跑。我在实际项目里测过这个函数在72MHz的F103上纯计算耗时不超过2微秒20kHz中断频率下占用的CPU时间可以忽略不计。而扇区法的X/Y/Z计算加查表耗时也差不多两者性能上没有本质差别主要区别还是可读性和易维护性。3.3 为什么min-max法自动实现了过调制区限幅一个很多人没注意到的细节min-max法代码里没有显式的限幅判断但输出占空比天然落在0~1之间。原因在于零序分量offset会把三相调制波整体拉回安全范围即使输入电压矢量幅值超过线性区上限输出占空比也只是被削顶不会出现扇区法里T1T2Ts需要额外等比例缩放的问题。当然这不意味着过调制问题消失了。输入电压矢量超过线性区上限之后实际输出电压会低于指令值电流环如果继续加大Ud/Uq就会产生静态误差严重时电流环发散。这个需要通过弱磁控制或者限制Ud/Uq幅值来处理属于后面篇章的内容。4. 接进STM32定时器配置、互补输出与死区4.1 定时器选型与中心对齐模式SVPWM最终要通过三路互补PWM输出到六个MOSFET。STM32F103里能输出6路互补PWM的只有高级定时器TIM1和TIM8。我用的TIM1配置为中央对齐模式1也就是计数器先向上计数到ARR再向下计数到0。中央对齐模式天然适合FOC因为PWM波形的中心时刻正好对应电流采样的最佳窗口这时候mos管开关引起的电流尖峰已经衰减完毕ADC采样到的电流最干净。PWM频率的计算公式是f_pwm 72MHz / (2 * (ARR 1))如果目标PWM频率是20kHz那么ARR 72e6 / (2 * 20000) - 1 1799。这个值算好直接填进CubeMX的Period就行。4.2 死区时间设置互补PWM必须设置死区时间防止同一桥臂上下管同时导通导致直通短路。死区时间的大小取决于MOSFET的关断延迟和栅极驱动电路。我用的是常见IR2101驱动芯片加IRLR7843 MOSFET组合死区设置1μs左右比较合适。TIM1的死区寄存器是BDTR的DTG位段在CubeMX里Dead Time直接填1.0μs即可。注意如果用的是HAL库的TIM_HandleTypeDef需要在初始化时配置sConfigOC.OCMode TIM_OCMODE_PWM1; sConfigOC.Pulse 0; sConfigOC.OCPolarity TIM_OCPOLARITY_HIGH; sConfigOC.OCNPolarity TIM_OCNPOLARITY_HIGH; sConfigOC.OCFastMode TIM_OCFAST_DISABLE; sConfigOC.OCIdleState TIM_OCIDLESTATE_RESET; sConfigOC.OCNIdleState TIM_OCNIDLESTATE_RESET;死区配置完成后有一个常见坑高级定时器默认主输出关闭必须使能MOE位否则PWM不会输出。CubeMX生成的代码一般会自动处理但如果手动写寄存器初始化漏掉MOE就会看到PWM完全没有输出查半天查不出来。4.3 把占空比写到比较寄存器SVPWM函数输出0~1的浮点占空比后映射到定时器比较寄存器volatile uint16_t arr __HAL_TIM_GET_AUTORELOAD(htim1); TIM1-CCR1 (uint16_t)(ta * (arr 1)); TIM1-CCR2 (uint16_t)(tb * (arr 1)); TIM1-CCR3 (uint16_t)(tc * (arr 1));注意这里乘以的是arr1而不是arr。中央对齐模式里计数器计数范围是0到ARR共ARR1个计数值占空比100%对应ARR1。如果乘以ARR最大占空比只有ARR/(ARR1)虽然误差很小但没必要留这个隐患。4.4 电流采样触发的对齐SVPWM接进定时器之后还要考虑电流采样时机。中央对齐模式下计数器在顶点和底点时PWM输出都处于确定的开关状态适合采样。标准做法是把ADC触发配置在计数器上溢时也就是顶点采样此时所有下桥臂导通相电流通过下桥臂MOSFET的导通电阻或者采样电阻流回母线采样电阻上的电压能反映真实的相电流。这个时机如果在启动之后发现电流波形有周期性毛刺多半是采样时刻离开关切换太近毛刺还没消退就触发了ADC。解决方法是稍微把采样点偏移到PWM中心附近或者加一级RC滤波截止频率取PWM频率的1/10左右比较合适。5. 写完了怎么验证我常用的几种验证方法5.1 开环VF验证法电机能均匀转动是基本盘写完SVPWM代码先别上闭环直接开环给一组旋转的Uα/Uβ。设电角度θ匀速递增然后用u_alpha voltage * cos(electrical_angle); u_beta voltage * sin(electrical_angle);喂进SVPWM函数电机应该能均匀转动。把电压幅值设成额定电压的1/3到1/2频率从极低开始慢慢往上加。如果电机能平稳转动、没有明显顿挫和啸叫说明SVPWM的基本方向是对的。这一步是最粗粒度的验证也是最容易暴露问题的一步。如果电机完全不动优先查三路PWM输出是否正常、MOSFET驱动是否在工作如果电机转动但一顿一顿的优先怀疑输出到电机的三相相序和SVPWM计算时使用的扇区方向不一致。5.2 串口导出数据把占空比和扇区拉出来看开环能转之后把SVPWM计算过程中的关键变量通过串口导出Uα、Uβ、三路占空比、扇区编号。采样数据存成文本拿到电脑上用Python或者Matlab画出来。理想情况下三路占空比应该呈现为相位差120°的马鞍形波形而扇区编号按0→1→2→3→4→5循环变化。如果你看到三路占空比是纯正弦波形说明SVPWM写成了SPWM零序分量没有注入波形看着没问题但电压利用率少15%。这一个验证步骤能提前发现大量低级错误强烈建议开着开环跑的时候用调试器的Live Watch窗口实时观察几个关键变量比事后看数据更直观。我用的是J-Link的RTT直接print到J-Link的终端窗口省一个串口。5.3 示波器看相电压波形马鞍形就是活招牌SVPWM代码正确性最直接的物理证据是电机相电压对母线中点的波形呈现马鞍形。用示波器探头接电机某一相和母线中点地开环VF下看到的应该是近似马鞍形的波形——上下对称、顶部被削平而不是纯正弦。如果不是马鞍形而是正弦大概率是代码里offset计算错了或者零序分量根本没加进去。如果波形顶部的削平不在正中间位置而是偏向一侧说明offset计算里有一个0.5的常数不对。5.4 电流波形验证最接近真实工况验证的最后一关是看电流波形。没有电流探头的话在直流母线侧串一个小阻值采样电阻用差分探头看采样电阻上的波形。SVPWM正确时母线电流应该是一个基频等于电机电频率的脉动波形包络呈正弦状且频率与开环给定的电角速度一致。如果母线电流包络不是正弦而是乱七八糟的高频分量说明PWM占空比更新时机和电机转速不匹配或者SVPWM输出电压里混入了大量谐波。这通常和PWM频率偏低、死区时间过大有关。5.5 验证清单快速对照验证手段理想结果常见故障表现开环VF转动均匀转动无顿挫电机不动/抖动/异响串口导出占空比相位差120°马鞍形纯正弦/波形不对称示波器看相电压对称马鞍形顶部偏置/正弦波母线电流包络正弦包络高频杂波/包络畸形扇区编号0~5循环跳变/不连续6. 负时间、限幅、离散误差实际调试中躲不开的坑6.1 扇区法T1/T2算成负值是怎么回事扇区法查表实现里如果T1或T2算出来是负值很多人第一反应是公式抄错了。其实不一定。当目标电压矢量非常接近扇区边界时浮点计算误差和输入信号的微小抖动都可能让T1/T2短暂穿越零值。另外当电压矢量幅值超过线性区上限时T1T2Ts如果不做限幅作用时间就会出现异常。工程上处理的方法是加限幅逻辑if (t1 0) t1 0; if (t2 0) t2 0; float total t1 t2; if (total ts) { float scale ts / total; t1 * scale; t2 * scale; }这个等比例缩放实际上就是过调制处理让电压矢量从六边形边界平滑落到内切圆内不至于直接跳变。6.2 载波比降低之后的离散化误差还有一个新手容易忽略的问题SVPWM计算在每个PWM周期开始时更新一次但定时器比较值是这一整个周期内都有效的。这意味着输出电压相对于指令值有一个固定延迟大约等于0.5到1个PWM周期。电机转速低时这个延迟相对于电周期来说很小可以忽略。但转速高了之后比如4对极电机跑到3000rpm对应电频率200HzPWM频率20kHz时一个载波周期对应的角度变化是200/20000*3603.6度。一个周期的延迟就相当于电压矢量滞后了3.6度累计误差就会让电流出现明显的波形畸变。解决办法是在电机高速时对电压矢量做角度补偿也就是在反Park变换之后输出相位前移一个角度补偿量约等于半个PWM周期对应的电角度。这个补偿在FOC控制里通常叫电压角度补偿或者延迟补偿很多电机库实现里会有一个单独的补偿系数。6.3 死区效应低速时波形畸变的主要来源死区时间虽然只有1微秒但在低速工况下死区效应会让相电压波形发生畸变电流出现交叉失真。原因是死区期间相电流会通过续流二极管续流而这个续流路径受到电流方向的影响导致实际输出电压和指令值不一致。这个问题在低速重载时最明显表现为电流过零点附近出现畸变。缓解手段包括死区补偿根据电流方向修正占空比以及提高PWM频率降低死区占空比的比例。死区补偿算法本身不复杂但需要准确的电流方向判断电流过零时判断不准反而会引入更大的误差属于工程上离成功最后一步才处理的细节。6.4 相序接反的排查经验最后分享一个踩过很多次的坑SVPWM代码和电机驱动板都正常但电机要么锁死要么倒转。排查到最后发现是电机三相线接反了。判断方法很简单开环VF给定一个固定的电压矢量比如Uα3V、Uβ0V这时候电机会锁在一个固定位置。用手轻轻转动电机轴如果能感觉到清晰的定位力矩说明电机三相连接和代码的判断方向基本一致。如果定位力矩弱、方向不对就把电机任意两相调换一下再试直到手感正确。我自己的习惯是在驱动板上给电机三根线套上不同颜色的热缩管A/B/C相严格对应并且和电流采样通道、SVPWM输出的相位关系画成一张图贴在驱动板盒子上。为了调试方便做过一次相序搞混的事情之后再也不敢偷懒了。这一篇把SVPWM从原理到代码再到验证讲完了。你手头如果已经把代码跑起来我建议你先用5.5的验证清单逐项过一遍确认输出波形正确之后再进入下一节的电流采样环节。别急着往下冲SVPWM作为整个FOC链路里唯一和物理桥臂直接打交道的环节它的任何一个系数错误都会在后面电流环调试时表现出极其诡异的现象到时候回头排查的成本远高于现在多花半小时验证波形。