直流无刷电机FOC控制算法详解：从坐标变换到SVPWM

直流无刷电机的FOC控制算法这几年几乎成了电机控制工程师的标配技能——不管你做的是云台、滚筒洗衣机、电助力车还是机器人关节一提控制算法就绕不开它。我刚入门时其实没少走弯路先用STM32F103跑通六步换相以为电机能转就算会了直到拿扭矩传感器实测波形才被那锯齿状的转矩纹波教育了一课。那会儿我对FOC的认知也就是高级一点的换相方式真正开始觉得这东西值得深挖是在把相电流波形铺到示波器上之后。六步换相下相电流接近方波换相瞬间还有不小的尖峰而FOC下的相电流是漂亮的正弦波转矩纹波压到能接受的水平噪音也从呜呜变成了几乎听不见的嗡嗡。这篇文章是理论到实践系列的第一篇聚焦理论部分。我默认你已经了解直流无刷电机的基本结构三相定子绕组、永磁转子也做过基本的PWM驱动实验但对FOC还处于听说过、没搞懂的阶段。我会把坐标变换、d-q轴含义、SVPWM、转子位置获取这几块讲透并说明它们在后续代码里分别对应什么位置。把这一篇吃透再进入实践篇写代码你会少走至少一个月的弯路。1. 为什么绕不开FOC从六步换相的痛点说起1.1 六步换相法能转但代价不小六步换相的原理一句话就能说清转子位置每转过60度电角度控制器就切换一次定子通电组合任意时刻只有两相绕组通电第三相悬空。霍尔传感器给出三个位置信号组合出6个状态配上6个功率管逻辑上就是个简单的状态机。用STM32甚至51单片机都能跑这也是很多入门教程用它起步的原因。代价主要在三个方面。第一是转矩纹波。电流矢量方向按60度跳变转矩角定子电流矢量和转子磁链矢量的夹角在45度到135度之间来回摆动瞬时转矩自然跟着抖。低速时抖得特别明显如果你做过云台或者机械臂关节应该体会过那种颗粒感——转起来一顿一顿的画面稍微一放大就没法看。第二是噪声和振动。方波电流富含低频谐波电磁激励的频率恰好落在人耳敏感区加上换相瞬间的电流突变机械振动和啸叫都很难压下去。滚筒洗衣机、空调压缩机这类家电场景对噪声要求很高六步换相基本过不了声学测试。第三是高速性能受限。六步换相每个换相点都依赖霍尔信号位置分辨率只有60度高速时反电动势畸变会进一步拉偏换相角度电流尖峰增大MOS管损耗上升效率跟着跌。所以六步换相不是错而是够用但上限低。现代变频家电、新能源汽车驱动、伺服系统几乎全线走FOC路线。1.2 定向到底在定什么FOC的全称是Field Oriented Control直译就是磁场定向控制。核心思想一句话把三相定子电流合成一个电流矢量并让这个矢量始终与转子磁场保持期望的角度关系。对表贴式永磁同步电机SPMSM而言最优角度就是90度——电流矢量与转子磁链矢量垂直同样大小的电流能产生最大的转矩。这种情况下电磁转矩公式可以简化成只和q轴电流相关的线性式子控制问题就退化成稳定地控制两个直流分量比直接控制三个交流量简单得多。定向的关键动作是把定子电流从静止的三相坐标系变换到随转子一起旋转的坐标系里。这个变换分两步Clarke变换先把三相变成两相静止坐标系Park变换再把两相静止系转到转子旋转坐标系。两步合在一起就是把交流问题变直流问题的核心手段。这套思路一样适用于步进电机和感应电机差别主要在电机模型上骨架是完全相同的。下一节我就展开讲这两步变换的数学细节和实现要点。2. FOC的地基Clarke变换与Park变换2.1 Clarke变换三相电流投影到两相静止坐标系三相绕组在空间上互差120度三相电流ia、ib、ic本质上描述的是同一个合成电流矢量在三个方向上的投影。既然三相平衡时iaibic0真正独立的信息其实只有两个所以第一步就是把三个量压缩成两个正交分量。Clarke变换的公式等幅值变换常系数2/3长这样i_alpha (2/3) * (ia - ib/2 - ic/2) i_beta (2/3) * ((√3/2)*ib - (√3/2)*ic)如果只直接采集了ia、ib第三相用ic -ia - ib补进去化简后工程上最常用的实现是i_alpha ia i_beta (ia 2*ib) / √3这段代码在STM32的FOC例程里非常常见本质就是让三相电流在αβ坐标系里重建出来。注意这个坐标系是静止的α轴通常对齐A相绕组轴线β轴逆时针超前α轴90度。αβ坐标系下的电流仍然交流量电机每转一圈i_alpha和i_beta就按基波频率转一圈。2.2 Park变换把坐标系粘在转子上第二步是把αβ静止坐标系旋转到dq旋转坐标系旋转角度就是转子电角度θe。坐标系一转id和iq就从交流量变成了直流量稳态下几乎恒定这才是FOC能大幅简化控制问题的根本原因。你站在地上看旋转的风扇叶片每片都在转但如果跟着风扇一起转叶片在你眼里就是静止的。Park变换干的就是这件事。Park变换公式id i_alpha * cos(θe) i_beta * sin(θe) iq -i_alpha * sin(θe) i_beta * cos(θe)对应的逆变换后面SVPWM阶段要用v_alpha vd * cos(θe) - vq * sin(θe) v_beta vd * sin(θe) vq * cos(θe)这里有个容易搞混的点θe到底是转子N极的绝对电角度还是某个参考系的相对角度工程上一般约定转子N极方向和A相轴线对齐时为0度然后θe 机械角度 × 极对数。极对数这个概念说的就是电机物理上转一圈电角度转了几个360度。2.3 别小看坐标系变换里的系数问题如果你对着不同厂商的例程对比会发现Clarke变换的系数有时是2/3有时是1有时带√(2/3)。这不是谁写错了而是选了不同的变换基准等幅值变换用2/3等功率变换用√(2/3)还有直接用合成矢量长度归一化的写法。对控制环来说只要前后一致哪种基准都能跑起来但如果你从别人的工程里抄了一段PI参数却没注意他用的变换系数那电流环的增益标定就全错了。我在每个FOC工程初始化阶段都会强制自己把三件事确认清楚并写成注释变换采用等幅值还是等功率基准电流采样数值的标定系数也就是ADC原始值到安培的换算关系角度零点编码器Z相清零时刻对应的转子位置。这三项决定了后续所有PI参数是否有意义。理论阶段大家容易只盯着公式实际工程里翻车十有八九出在这些约定上。等幅值变换下你算出来的PI参数可以直接和电机参数对应等功率变换下转矩公式里的系数会变成1而不是3/2整套参数就会差出一截。3. d轴、q轴不是玄学电机方程与控制环路的对应关系3.1 d/q轴的物理含义与转矩公式d轴就是转子N极方向q轴逆时针超前90度。dq坐标系下定子电流被拆成两个分量id沿N极方向起励磁或者去磁作用iq垂直于N极方向真正产生转矩。永磁同步电机在dq坐标系下的电压方程表贴式电机简化为vd Rs*id Ls*d(id)/dt - ωe*Ls*iq vq Rs*iq Ls*d(iq)/dt ωe*Ls*id ωe*ψf其中Rs是相电阻Ls是相电感ψf是永磁磁链ωe是电角速度。注意vq方程最后多了一项ωe×ψf这就是反电动势项也是高速时母线电压不够用、需要弱磁控制的根源。转速越高反电动势越大留给电流环调节的电压余量越小最后必须靠负的id去削弱磁场才能把转速继续往上推。转矩方程极对数为p为T (3/2) * p * (ψf*iq (Ld-Lq)*id*iq)对表贴式电机Ld≈Lq第二项磁阻转矩约为0转矩直接简化为T (3/2) * p * ψf * iq看到没有转矩和iq成正比——这就是FOC的核心红利。你不需要时刻理解复杂的磁场耦合只要把iq稳定在目标值转矩就是平顺的。id呢理论上表贴式电机让id0就行这样省铜耗。而内置式永磁电机IPM的Ld和Lq差别较大磁阻转矩不可忽略就会出现MTPA单位电流最大转矩控制问题需要根据电机参数在线分配id和iq这是更进阶的话题本篇先不展开。3.2 三环级联位置环、速度环、电流环为什么这样排实际FOC系统通常三层嵌套。最外层是位置环伺服、云台会用到中间是速度环最内层是电流环。信号流向是位置给定 → 位置环输出转速参考 → 速度环输出iq参考 → 电流环输出vd、vq → 逆Park变换 → SVPWM → 逆变器。为什么电流环必须放最内层因为电流就是转矩转矩直接决定机械运动。内环要快才能及时抑制负载扰动和反电动势扰动否则外环一收到扰动要等电流慢慢爬上去整个系统响应就迟钝了。电流环的周期一般就取PWM周期10kHz~20kHz速度环放慢到1kHz~5kHz位置环通常几百赫兹到1kHz。带宽上基本要求内环比外环快5~10倍否则内外环互相干扰整定出来全是振荡。这里有个非常常见的认知误区初学者喜欢一上来就调速度环的KP、KI结果电流环还没稳定速度环参数怎么调都压不住振动。正确顺序是先单独把电流环整定好用堵转或者低速状态测阶跃响应确认id、iq能紧跟给定再整速度环最后才碰位置环。每一步都稳了再往上一级走。3.3 电流环PI参数的大致出发点电流环的PI整定一种常用方法是按电机电气时间常数做零极点对消。设期望电流环带宽为BWrad/s那么初步取值Kp ≈ Ls * BW Ki ≈ Rs * BW举个具体的例子某小功率云台电机Ls0.2mHRs0.5Ω目标带宽2000rad/s约318Hz那么Kp≈0.4Ki≈1000。这只是出发点实际还要根据采样延迟、PWM死区引起的误差去微调。重点在于电流环PI的初值不是拍脑袋试出来的而是能从电机参数推导出来的。这也是为什么我在前面反复强调变换系数、电流标定和角度约定必须精确——任何一个环节错位推导出来的参数就全废了。近几年也有项目把电流环换成预测控制或者ADRC来追求更快的动态响应但那是另一个话题基础还是先把PI吃透再谈其他。4. 给定vd/vq之后SVPWM怎么把它变成开关管动作4.1 逆变器的8种开关状态FOC算完电流环得到的是dq坐标系下的vd、vq经过逆Park变换得到vα、vβ。接下来这两个电压投影值要变成三相半桥的占空比这一步就是SVPWM空间矢量脉宽调制。三相逆变器有6个功率管分成3组半桥。每组半桥只有上管导通或者下管导通两种状态所以整个逆变器有8种开关组合。其中6种是有效矢量对应的电压矢量方向互差60度幅值是(2/3)×Vdc另外两种是全上管导通和全下管导通合成矢量为0叫零矢量。每个有效矢量本质上表示某一时刻把三相绕组接到母线或地的某种组合定子电流矢量的空间方向是固定的。SVPWM要做的事就是在一个PWM周期内用相邻的两个有效矢量和零矢量按时间加权平均出一个期望的电压矢量Vref。你可以把它想象成用两根短杠杆在一段时间内交替用力最终让物体受到的等效推力指向你要的方向。4.2 扇区判断与矢量作用时间计算SVPWM的实现分三步判断Vref落在哪个扇区计算相邻两个矢量的作用时间最后生成三相占空比。判断扇区可以基于vα、vβ的组合条件直接判断也可以用角度θatan2(vβ, vα)每60度划一个扇区。设Vref与扇区起始边的夹角为θrPWM周期为Ts直流母线电压为Vdc相邻两个有效矢量的作用时间分别是T1 (√3 * |Vref| / Vdc) * Ts * sin(60° - θr) T2 (√3 * |Vref| / Vdc) * Ts * sin(θr) T0 Ts - T1 - T2|Vref|不能超过Vdc/√3这是SVPWM的线性调制区上限。超过之后进入过调制区输出会有畸变但能榨取更多母线电压。过调制策略在需要极限功率输出的场景很有用理论一阶段先不展开。工程实现时很少真在代码里调atan2和sin一般是基于vα、vβ的符号和大小关系直接判断扇区再通过查表或者查三角函数表完成时间分配。这样在一个PWM中断里几十个周期内就能跑完整个SVPWM计算对MCU浮点压力小得多。六个扇区对应的矢量组合可以整理成表扇区角度范围相邻有效矢量I0°~60°V1、V2II60°~120°V2、V3III120°~180°V3、V4IV180°~240°V4、V5V240°~300°V5、V6VI300°~360°V6、V14.3 SVPWM相比SPWM的优势在哪如果你用过传统SPWM也就是正弦脉宽调制会知道它的母线电压利用率比较低。线性区内SPWM的相电压峰值不超过Vdc/2而SVPWM的线性调制区可以达到Vdc/√3利用率高出约15%。别小看这15%在同样的母线电压下意味着电机能多跑一点最高转速或者逆变器能承受更高的电压利用率。新能源汽车驱动里母线电压利用率直接关系到续航和功率密度。另外SVPWM生成的三相占空比天然中心对称谐波含量更低对电流波形质量更友好。这也是现代FOC普遍用SVPWM而不是三路独立SPWM加三次谐波注入的原因。本质上SVPWM可以理解为在正弦参考里注入了零序分量让每相占空比不会在某段时间贴近0或100%从而腾出更多调制空间。现在的STM32 FOC例程里SVPWM通常被封装成一个函数输入vα、vβ和母线电压输出三个比较寄存器的值。我强烈建议你至少在仿真环境或者Python里手动推一遍扇区判断和时间分配再去看库函数不然将来遇到兼容性或者精度问题你完全不知道从哪下手。5. 没有转子角度就没有FOC有感与无感的位置获取路径5.1 有感方案霍尔、编码器与初始位置检测FOC的Park变换需要电角度θe所以位置传感器是整套系统的眼睛。常见三种霍尔传感器分辨率只有60度电角度需要插值或配合软件观测器使用增量式编码器分辨率高但上电不知道绝对位置需要Z相信号找零点绝对式编码器上电就能知道绝对位置成本也最高。这里必须单独说一句初始位置检测。增量式编码器上电时不知道转子停在哪电机静止时又没有反电动势可利用所以得先对位。最粗暴的办法是给一个沿固定方向比如A相轴线的电流矢量把转子吸到已知位置再清零编码器。代价是电机会轻微转动一下而且如果负载有阻力位置会带上几度偏差初始转矩就会有波动。更平滑的办法是高频注入法在d轴叠加高频电压信号通过响应电流辨识转子凸极位置很多伺服驱动器能做到电机纹丝不动地完成静止状态位置辨识。这是进阶内容但理论一阶段你需要先建立概念没有绝对位置传感器时位置辨识本身就是一个独立问题不是FOC算法能自动解决的。几种方案粗略对比方案位置精度启动/低速表现成本典型场景霍尔插值中启动好低速有纹波低风机、电动工具增量编码器高启动需预定位中伺服、云台绝对式编码器很高无需预定位高高端机器人关节无感观测器中高静止需高频注入或开环强拉最低家电、无人机5.2 无感方案反电动势观测与滑模观测器无感FOC没有位置传感器位置全靠算法估计。基本思想不复杂转子转动时三相绕组会感应出反电动势反电动势的相位和转子位置直接相关所以观测反电动势就能反推θe。中等以上转速时反电动势幅度足够大用滑模观测器SMO是比较经典的方案。SMO利用电流误差构造滑模面把反电动势观测量逼出来再经过低通滤波和锁相环PLL提取角度和转速。STM32的很多实战demo里都是这个组合电流反馈 SMO PLL。滑模控制的特性是鲁棒性强对参数误差不太敏感所以工程上用得很广代价是抖振和滤波滞后。无感方案真正的难点在低速和零速。电机静止时反电动势为零SMO无从下手只能靠高频注入或者干脆用开环强制换相把电机先拉起来等转速够高再切到闭环。所以无感FOC的启动过程通常有一段开环强拉拉不起来、切换瞬间过冲几乎是所有无感方案都要面对的问题。这也是为什么无感FOC和转子初始位置检测两个话题总被放到一起讨论。5.3 FOC的ADC采样时刻为什么要卡在PWM中心这个问题可能让很多人在示波器前抓狂过。FOC电流环要采三相电流但PWM开关动作会产生大量共模噪声如果采样点落在开关动作瞬间采到的电流值完全不可信。主流做法是中心对齐PWM在PWM周期的中心点采样——此时下桥臂全部导通处于零矢量状态相电流流过采样电阻的路径最明确噪声最小。如果使用三电阻采样还有个细节必须处理当某相占空比太低或太高那一相电流流经采样电阻的时间窗口可能太短重构三相电流会失败。这时候要引入最小采样窗口检查甚至用互补采样策略来补齐缺失的相电流。这个伏笔先埋在这里实践篇代码里会专门处理。我记得最早调FOC时低速下的电流波形一直有毛刺查了三天没头绪最后发现就是ADC采样时刻没对准PWM中心差了大概2微秒波形就脏成那样。所以FOC向来是算法时序的工程公式只是入场券采样时序才是真正决定波形质量的分水岭。6. 理论收尾写代码前你的脑子里应该有一张完整框图6.1 从理论到代码的映射关系把前面几节串起来一套典型的FOC主中断流程是这样的触发ADC采样三相电流同步于PWM中心读转子位置换算电角度θeClarke变换ia、ib、ic → iα、iβPark变换iα、iβ → id、iq电流环PI给定id_ref通常为0和iq_ref来自速度环得到vd、vq逆Park变换vd、vq → vα、vβSVPWMvα、vβ → 三个半桥的占空比更新定时器比较寄存器等待下一周期。你随便翻开任何一套FOC例程主循环或者中断里的代码都逃不出这8步区别只在具体实现定点还是浮点、中断里做还是DMA流水线配合、采样用三电阻还是单电阻。理解了这个8步框架再读任何厂家的代码都不会迷路。之前在群里有人问我FOC核心代码到底在哪我说你把上面8步对应的函数找出来剩下的全是工程包装。6.2 新手最常见的三个理论误区第一个误区把id和iq当成可以随便给的东西。事实是id0是表贴式电机的最优运行条件但不是启动瞬间能天然成立的。电机一上电就同时给id0、iq0驱动等于什么都不做必须先从预定位开始让电流环先建立正常的反馈闭环再逐步加大给定。第二个误区把电角度和机械角度混着用。极对数为4的电机转子转一圈电角度走4圈Park变换里的θe全部要用电角度。这里一旦漏乘极对数整个FOC看着也能转但转矩输出严重缩水甚至方向都乱。调试时如果发现电机能转但劲特别小第一个怀疑点就应该是角度换算。第三个误区忽视电流采样的标定。ADC读到的是数字量要换算成真实安培值。如果变换系数、电流标定系数和电机参数之间存在系统性偏差电流环PI整定会陷入看着有响应、实际输出不对的陷阱。这个坑后面实践篇会给具体标定步骤。6.3 实践篇预告与一点个人体会最后说点个人经历。我亲眼见过两种学FOC的人一种直接抄库电机一转就发帖庆祝另一种先把坐标变换推导完、拿电机参数把PI初值算完再碰代码。前一种遇到问题基本只能换库后一种往往两天就能定位出是角度零点没对齐还是电流标定错了。我自己属于中间派先跑通demo建立信心再回头补理论但补理论这步无论如何不能省。实践篇我计划用STM32F103RCT6加一块常见的小功率云台电机从CubeMX配置定时器PWM和ADC采样开始一步步把上面的8步流程落到工程代码里重点讲电流环参数怎么在线整定、无感启动的开环强拉怎么设计以及三电阻采样在极端占空比下的数据重构。理论一这部分最大的价值不是让你背下公式而是让你在动手前脑子里有一张完整的控制框图知道每个公式、每个模块在系统里的位置和角色。有了这张图后面的路会好走非常多。