做电机控制的同行应该都有这种感觉FOC的原理不算难真正难的是把一套方案从原理图变成转得稳、跑得顺的实物。最近我基于STSPIN32G4完整做了一套FOC电机控制器从硬件设计到软件调参都是自己搞的中间踩了不少坑也积累了一些可以少走弯路的经验。这篇就从头到尾讲一遍我的实操过程包括为什么选这颗料、FOC的核心算法怎么落地、硬件上哪些细节容易翻车、软件怎么配合PWM和ADC做电流采样以及我实际调试中遇到的各种问题和排查思路。这套方案适合的产品方向很广从电动工具、风机水泵到机器人关节、云台挂载只要是三相永磁同步电机PMSM又希望控制做得平滑、高效基本都能用上。如果你还没接触过FOC看完至少能知道整套链路是怎么串起来的如果你已经在做电机驱动那后面几节遇到的问题排查笔记应该也能给你一些参考。1. 为什么选STSPIN32G4这颗料做FOC1.1 一颗芯片就把整个模拟前端包进去了先聊选型。做FOC控制最传统的方案是单片机加上独立的栅极驱动器、运放、比较器再搭一堆周边电路。这么干不是说不行但PCB面积、物料清单、电源设计、信号完整性都得自己操心尤其是电流采样那一块运放的零点漂移、共模抑制比、PCB走线的噪声耦合任何一个环节不到位FOC都跑不好。STSPIN32G4的好处在于它把整个模拟前端都集成进去了。内部有一颗M4内核的MCU主频可以跑到170MHz带FPU和CORDIC硬件加速器像三角函数、开方这类FOC里高频使用的运算用硬件来算比纯软件快得多。更重要的是芯片内部直接集成了三相栅极驱动器、用于电流采样的可编程运放、用于过流保护的比较器以及一个可以给MCU供电的降压转换器BUCK。也就是说我从外部只需要给它一个电源、一路PWM输入和三个采样电阻就能把逆变器和控制核心全部搭起来。我用之前的项目对比过同样的功能如果用分立方案做PCB差不多要多出三分之一面积而且电流采样那部分的Layout要求极高稍不小心就会引入噪声。集成方案虽然芯片本身价格贵一些但算上外围器件减少、板材面积缩小、调试周期缩短综合成本反而是更划算的。1.2 集成化和分体方案怎么权衡集成方案也不是没有缺点。最直接的问题是灵活性降低栅极驱动参数、运放增益这些虽然在芯片内部都能配置但不如分立方案那样可以随意换料调整。比如你想用一颗外部的高精度运放做电流采样或者想用更大驱动能力的栅极驱动芯片STSPIN32G4的内部路数就给不了你这个自由度。所以我的建议是如果目标产品是固定功能的电机驱动器比如电动工具、水泵、空气压缩机这类硬件定型后不会再大改的东西集成方案很合适但如果你是做通用型伺服驱动器或者未来可能换不同功率等级的平台那分体方案可能更长远。我做这套方案的目标是把它嵌进一个紧凑的机器人关节模组里对体积和系统复杂度要求高集成方案就成了最优解。1.3 适合跑FOC的硬件加速到底加速在哪很多人不太理解FOC代码里真正吃CPU的是什么。我在这儿多说一句三个PI调节器、坐标变换这些其实算起来很快真正费时间的是三角函数、反正切、平方根这些超越函数。以前在普通M0/M3内核上跑一个电角度计算可能要几十个周期再乘上20kHz的控制频率CPU负载就上去了。STSPIN32G4内部那颗CORDIC外设天生就是干这个的旋转坐标变换、求sin/cos、算atan2一条指令级别的硬件操作就能出结果。实际跑下来我一个20 kHz的中断里把整套FOC算完包括位置反馈、三环位置环、速度环、电流环运算整体负载也就不到30%还有富余的算力去做通信、状态监测和故障保护。2. FOC控制原理把算法拆开揉碎2.1 先说清楚FOC到底在控制什么网上讲FOC原理的文章一抓一大把但很多是直接把数学公式甩出来看过之后依然不知道代码怎么写。我用自己的话捋一遍三相永磁同步电机的定子上有三组线圈分别通三相交流电这三相电流合起来会形成一个旋转的磁场拉着转子永磁体跟着转。问题是三相交流电的参数之间互相耦合你直接去控制每一相电流的大小很难直观地对应到“我想要多大扭矩”。FOC的核心思路是给电流做一个坐标系变换把固定在定子上的三相坐标系先变成两相静止坐标系再变成跟着转子一起旋转的坐标系。在旋转坐标系里电流可以分解成两个解耦的分量——一个负责产生磁场d轴电流一个负责产生扭矩q轴电流。这样控制就变成了类似他励直流电机的控制你想要多少扭矩就控制iq你想要多少励磁就控制id通常在表贴式电机上会让id等于0。2.2 电流是怎么从三相变到两相的这里说下关键的两个数学变换。第一步叫Clarke变换把三相电流Ia、Ib、Ic从相差120度的三相坐标系变成两相静止坐标系下的Iα、Iβ。如果电机三相电流没有中线引出那么Ia Ib Ic 0实际目标上只需要采样两相电流就够了。数学关系很直接Iα IaIβ (Ia 2·Ib) / √3第二步叫Park变换把Iα、Iβ旋转一个角度θθ就是转子当前的电角度得到旋转坐标系下的Id、IqId Iα·cosθ Iβ·sinθIq -Iα·sinθ Iβ·cosθ这个θ怎么来如果有编码器直接读编码器位置换算如果无感就得靠反电动势观测器去估计转子位置。这也就是为什么FOC一定需要实时准确的转子位置位置出错整个坐标变换就错电机就会抖、啸叫、甚至失控。2.3 控制回路和SVPWM输出得到Id和Iq之后就是很经典的双环控制电流内环用两个PI调节器一个控id一个控iq。外环根据应用选做速度控制就是速度环做位置控制就是位置环。PI调完后输出的是旋转坐标系下的Vd、Vq需要经过逆Park变换反变换回两相静止坐标系Vα Vd·cosθ - Vq·sinθVβ Vd·sinθ Vq·cosθ然后就是空间矢量调制SVPWM的活了。Vα、Vβ合成的电压矢量幅值和方向决定了逆变器六个开关管在一个PWM周期里分别以什么样的占空比导通。SVPWM相比普通的SPWM母线电压利用率更高谐波也更小所以现在做FOC基本都是标配。具体实现上就是判断扇区、计算相邻基本电压矢量的作用时间、再分配到三相占空比这些代码量大头在查表和边界处理逻辑本身并不复杂。2.4 转子位置获取方案怎么选位置传感器这块不同的应用差别很大我分别说下。增量式编码器便宜、分辨率高但上电不知道转子在哪需要专用的初始定位流程。做法通常是给d轴一个固定电流矢量把转子拖到一个已知位置也就是强制对齐然后再进入闭环。这个过程在带载启动的场景下可能会拖动负载转动需要注意。绝对值编码器上电就能得到绝对位置控制最简单但成本高一般用在伺服级别产品。霍尔传感器只有6个扇区的信息精度比较粗但可以配合反电动势做插值算法适合对低速平稳性要求不高的风机、泵类应用。无感方案基于观测器这是现在非常主流的方向利用电机反电动势估计转子位置省掉了传感器和线缆。难点在低速和零速静止时没有反电动势必须先开环强拉启动IF控制或者脉冲注入转速上来之后观测器才能可靠工作。我在这套STSPIN32G4方案里做的是无感FOC后面会详细说启动策略和调试经验。3. 硬件设计要点与实操记录3.1 电源架构的规划STSPIN32G4的好处之一是内部集成了BUCK转换器可以直接从高压母线取电降压后给MCU供电。我实际设计时电机母线是24VBUCK输出设为3.3V供MCU和外设逻辑。栅极驱动部分的供电由内部的GVDD引脚输出因为芯片内部已经做好了电荷泵和稳压外部只需要在GVDD脚放一颗几微法的陶瓷电容储能。这里有一个我踩过的坑BUCK的电感走线如果离模拟采样部分太近开关噪声会耦合到采样电阻的走线上导致电流波形毛刺特别大。我在第二版Layout时把BUCK区域放在板子一侧电流采样走线从另一侧走并用地线包围起来波形马上就干净了。这个问题在原理图上是看不出来的只有实际示波器测波形时才会发现。3.2 电流采样方案怎么选FOC需要读取至少两相电流常见的有三种采样拓扑我直接列个表对比单电阻采样、双电阻采样、三电阻采样。成本单电阻最低三电阻最高精度三电阻最高双电阻居中单电阻受限于采样窗口和重构算法精度相对最差实现复杂度单电阻因为要在一个PWM周期内测两次电流并重构三相电流算法最麻烦空间矢量调制在扇区边界时的采样窗口会极短必须做插入补偿。双电阻只需要采两相但要求至少有一相下管的导通时间足够长在低占空比时需要做相移补偿。三电阻每个PWM周期都能稳定采到三相电流直观、鲁棒适合大部分应用。我最终选了三电阻方案原因是这个控制板要适配不同电机有的内阻小有的电感小双电阻在低占空比区间的补偿逻辑会让调试时间变长。三电阻加上芯片内部集成的三个可编程运放外部只需要三颗采样电阻再加几个RC滤波电容硬件成本增加很少但调试要轻松得多。3.3 栅极驱动和自举电路细节栅极驱动部分芯片内置的三相驱动器自带死区时间和防直通逻辑这些寄存器配置一下就行。外部需要重点注意的是每个高端MOS管都需要一路自举供电Bootstrap。自举电容的容量不能太小否则高端驱动在高频开关时会欠压也不能太大否则自举充电时间太长启动瞬间可能会失败。我用的自举电容是100nF加1uF并联典型值在这个量级基本没问题。电容尽量靠近芯片的BOOT引脚和相节点引脚放置走线要短、要粗。还有一个容易忽略的地方上电初期母线电压还没建立起来自举电容是空的此时如果直接开启PWM高边MOS管因为驱动电压不足会进入线性区瞬间过温。我的处理方式是软件里做“预充电”流程在启动PWM之前先用低边MOS管导通一段固定时间给自举电容充电然后再正常发波。3.4 布局布线与采样信号完整性电流采样的Layout真的值得单独说一说。采样电阻两端是高压共模信号上面叠加的是很小幅度的差分信号大电流时可能也就几十到几百毫伏如果采样线走得太长或者穿过开关噪声区域那采样出来的电流波形根本没法看。我的做法是采样电阻用四线制开尔文连接的封装采样走线从电阻两端单独引出走差分形式不做交叉在进入芯片运放引脚之前加一级RC低通滤波截止频率放在几MHz左右滤掉高频开关节点的毛刺。实际量测中发现加这级RC之前电流波形上有明显的振铃加了之后完全没有影响FOC控制带宽波形却很干净。关于RC取值我前面做的实验是从100欧姆电阻加1nF电容开始试的你如果采用不同开关频率需要根据实际的噪声频谱重新算一下。功率回路的走线同样关键逆变桥三个半桥构成的大电流回路面积越小越好。因为回路面积决定了寄生电感寄生电感在di/dt大的时候会产生电压尖峰这个尖峰轻则让波形振铃重则直接击穿MOS管。我在第一版板子上就是因为功率回路面积过大MOS管漏源尖峰到了50多V后来重新规划了走线回路尖峰降到了32V以内。4. 软件实现从点亮LED到电机转起来4.1 工程初始化与时钟配置软件部分我用的是C语言基于原厂的硬件抽象层库来做但是FOC核心算法没有直接套用原厂生成代码而是自己写的因为后面要针对自己的应用改控制逻辑。初始化流程按这个顺序来系统时钟配置内部PLL把系统时钟提到170MHz。GPIO把PWM输出脚复用为定时器通道采样保持脚配为模拟输入。ADC配置为注入组采样模式由定时器触发。定时器PWM定时器设为中心对齐模式PWM频率20kHz死区时间设为几百纳秒视MOS管参数而定。电流采样运放设置放大增益、零漂校准。CORDIC外设在初始化时也要打开后面算sin/cos、atan2都会调用它。4.2 PWM和ADC采样时序配合这是FOC软件里最容易出错、也最难排查的部分之一。电流采样必须在IGBT下管开通的中间时刻进行因为此时采样电阻上的电压最稳定、最能代表相电流的平均值。用中心对齐的PWM模式时定时器计数到中心点也就是高电平的中点此时低边MOS刚好导通到了中点位置。设置为在这个点触发ADC注入组采样是可以的。但有个细节要注意PWM刚刚切换的瞬间电流采样电阻上会有很大的电压尖峰这是二极管反向恢复、寄生电容充放电造成的。如果采样时刻正好落在尖峰上采到的电流就不是真实电流了。解决办法是ADC的采样保持时间适当加长或者把触发点从PWM中心稍微偏移一段死区补偿时间。我最后实测下来把采样点设在PWM中心再往后偏移大概0.5到1微秒读到的电流波形沿平滑谐波也小。4.3 FOC主循环代码实现我贴一下自己写的FOC中断服务函数核心结构这个不是完整工程但看完就能明白整个数据流是怎么串起来的void FOC_ISR(void) { // 1. 读取ADC注入组采样的两相电流 float Ia ADC_GetValue(ADC_INJECTED_CHAN_1); float Ib ADC_GetValue(ADC_INJECTED_CHAN_2); float Ic -(Ia Ib); // 第三相电流由基尔霍夫定律推出 // 2. 零漂校正上电时已经采集过offset Ia Ia - offset_a; Ib Ib - offset_b; // 3. 坐标变换静止三相 - 静止两相 float Ialpha Ia; float Ibeta (Ia 2.0f * Ib) * 0.577350269f; // 4. 读取转子电角度无感方案由观测器提供带编码器方案由编码器换算 float theta Get_Rotor_Angle(); // 5. Park变换静止两相 - 旋转两相 float cos_t arm_cos_f32(theta); float sin_t arm_sin_f32(theta); float Id Ialpha * cos_t Ibeta * sin_t; float Iq -Ialpha * sin_t Ibeta * cos_t; // 6. 电流环PI调节id参考值通常设为0 float Vd PID_Update(pid_id, Id_ref, Id); float Vq PID_Update(pid_iq, Iq_ref, Iq); // 7. 逆Park变换 float Valpha Vd * cos_t - Vq * sin_t; float Vbeta Vd * sin_t Vq * cos_t; // 8. SVPWM调制产生三相占空比 SVPWM_Calc(Valpha, Vbeta); }速度环和位置环在电流环外面放在一个较低频率的任务里执行比如电流环20kHz速度环1kHz。只要电流环闭环稳定外环就是普通的级联PI调试思路和直流伺服一致。4.4 无感启动流程IF开环强拉加滑模观测器这一节是无感FOC的精华。启动的时候电机没有反电动势观测器输出不可信必须先用强制对齐的方式把转子拉到已知角度再用IF电流频率注入的方式开环加速速度上升到一定程度之后再切到闭环观测器模式。我的启动时序是先向q轴施加一个固定电流让转子转到一个已知的电气角度维持100毫秒左右。然后开始加速过程电角度持续累加电流幅值按照斜坡慢慢减下来因为速度越高需要的加速电流就越小。等转速到了额定转速的10%到15%左右就开始尝试切换到滑模观测器闭环。切换的判据是观测器的反电动势估算值连续稳定了若干个周期并且观测器估计角度和当前开环角度的误差小到一定范围直接切换过去。这里有一个切换时机的经验问题。切早了观测器角度还没收敛电机容易顿一下或者直接过流切晚了开环电流已经很小了带不动负载可能转速上不去。我实际调的话是先在一个空载电机上记下切换成功的角度误差和反电动势阈值区间再把电机装到负载上微调。这个参数在不同电机上差异很大不建议直接抄但启动时序结构是通用的。5. 调试过程中踩过的坑与排查技巧5.1 电机啸叫、电流波形杂乱先查采样时序和电流零漂我做第一版硬件的时候上电一跑电机能转但噪音很大电流波形用示波器看像是长了毛刺。一开始我以为是PI参数不对来回调Kp、Ki波形依旧难看。后来静下来查才发现问题不在PI而在ADC采样时刻正好落在了PWM开关边沿采到的电流混入了大量尖峰噪声。排查思路很简单用示波器同时看PWM输出高低边的电压波形和ADC采样触发信号对比触发点是否在低边导通区间的最稳定段。如果不是就把采样触发点往后移。另外一个隐蔽坑是运放零漂没有校准。FOC对零漂极其敏感零点哪怕偏了几个mA在旋转坐标系里就会表现为一个固定偏置的id和iq导致低速扭矩波动。我的处理方法是每次上电在电机静止、PWM不输出的状态下手动采集一组电流采样值作为零点存下来给后续坐标变换用。运行时实时偏置校准也可以但要先保证电机是静止状态否则校准结果会把真实电流当成零漂给减掉。5.2 无感FOC低速段扭矩不足、电机发抖无感方案在低速段扭矩能力偏弱这是原理上限定的。低速时反电动势信号太弱观测器信噪比低位置估计抖动大电流相位就不准扭矩自然出不来。如果你非得在低速大扭矩场景下用无感想靠算法解决到底层物理上还是吃力。我实际测试的经验是在额定转速5%以下无感FOC的扭矩稳定性明显比带传感器差。如果你的应用对低速大扭矩有刚需比如机器人在重负载下原地转那还是老老实实加编码器或者霍尔位置传感器。如果只是风机水泵这类启动时负载扭矩很小、转速慢慢往上升的无感方案没有问题把启动电流斜坡的斜率调缓一些就行。5.3 过流保护误触发一加载就跳闸过流保护这块芯片内部的比较器可以设定阈值一旦电流超限就直接硬件封锁PWM输出这个反应速度比软件快得多。但是我一开始把阈值设得很保守稍微带一点负载就触发保护以为是硬件问题。后来用示波器看采样电阻上的真实过流波形发现是启动瞬间电流激增导致的误触但这个电流的持续时间很短并没有真正到损坏器件的程度。解决办法有两个方向一是把比较器阈值调到电机堵转电流的1.2到1.5倍左右确保正常堵转不误触二是适当调整启动策略让启动电流斜坡更平缓减小启动超调。硬件上也可以加一个短暂的滤波窗口利用比较器的滤波功能滤掉微秒级的电流毛刺只对真正持续的过流信号响应。5.4 常见问题速查表我把调试中遇到的问题整理成一个速查表给后面做同类项目的人参考。电机上电无法启动初始位置对齐失败或强制对位电流太小加大对齐电流确认转子被稳定吸附启动时序太短拉长IF启动阶段时间。低速啸叫或抖动采样时序偏早重置ADC触发时刻零漂未校准测量静止零点偏置并做软件扣除电流环PI过强降低Kp并增加积分限幅。高速运行时转速抖速度环带宽和电流环带宽重叠拉大两级带宽差距编码器安装偏心导致角度噪声用软件滤波或换用绝对值编码器母线电压波动给速度环增加前馈补偿。加载时相电流畸变SVPWM过调制区控制没处理好加入过调制和限幅策略采样电阻在强电流下发热导致阻值漂移换更大功率的电阻死区效应显著增加死区补偿。驱动芯片过热开关频率过高适当降低PWM频率或优化栅极电阻栅极电阻太小导致开关斜率过陡增大栅极电阻减缓dv/dt电路板散热铜皮面积不足优化布局并增加散热过孔。过流保护频繁触发阈值设置过紧按堵转电流的合理倍数调整启动冲击电流过大优化启动斜坡电流采样毛刺导致比较器误动作加入硬件滤波或配置比较器消隐时间。实际做下来我的体会是FOC项目调试的顺序真的很重要。先把硬件电流波形调到漂亮再谈闭环参数先让电流环稳再谈速度环先空载跑顺再接负载。跳过任何一步后面都有可能被奇奇怪怪的叠加问题绕进去。另外就是测试点一定留足每一路电流采样、母线电压、三个栅极驱动信号最好在板子上都有可以直接量测的焊盘或测试针调试阶段这些点比什么都管用。最后再分享一个经验原型阶段做单电阻采样省下来的物料和成本最后大概率会翻倍花在调试时间上。电机控制领域采样数据的质量和可靠程度决定了整个系统难不难调。如果你不是被成本压得特别死优先选三电阻方案到了软件调试阶段你会感谢当初这个决定。至于启动策略的细节切换、观测器系数怎么整定这些内容展开又是一大篇之后有空我准备再单独写一篇把无感观测器的调参过程专门讲讲。 
长河君 · 2026/10/21 1:05:10 · 阅读 1.2k 基于STSPIN32G4的无感FOC电机控制器硬件设计与调试实战
做电机控制的同行应该都有这种感觉FOC的原理不算难真正难的是把一套方案从原理图变成转得稳、跑得顺的实物。最近我基于STSPIN32G4完整做了一套FOC电机控制器从硬件设计到软件调参都是自己搞的中间踩了不少坑也积累了一些可以少走弯路的经验。这篇就从头到尾讲一遍我的实操过程包括为什么选这颗料、FOC的核心算法怎么落地、硬件上哪些细节容易翻车、软件怎么配合PWM和ADC做电流采样以及我实际调试中遇到的各种问题和排查思路。这套方案适合的产品方向很广从电动工具、风机水泵到机器人关节、云台挂载只要是三相永磁同步电机PMSM又希望控制做得平滑、高效基本都能用上。如果你还没接触过FOC看完至少能知道整套链路是怎么串起来的如果你已经在做电机驱动那后面几节遇到的问题排查笔记应该也能给你一些参考。1. 为什么选STSPIN32G4这颗料做FOC1.1 一颗芯片就把整个模拟前端包进去了先聊选型。做FOC控制最传统的方案是单片机加上独立的栅极驱动器、运放、比较器再搭一堆周边电路。这么干不是说不行但PCB面积、物料清单、电源设计、信号完整性都得自己操心尤其是电流采样那一块运放的零点漂移、共模抑制比、PCB走线的噪声耦合任何一个环节不到位FOC都跑不好。STSPIN32G4的好处在于它把整个模拟前端都集成进去了。内部有一颗M4内核的MCU主频可以跑到170MHz带FPU和CORDIC硬件加速器像三角函数、开方这类FOC里高频使用的运算用硬件来算比纯软件快得多。更重要的是芯片内部直接集成了三相栅极驱动器、用于电流采样的可编程运放、用于过流保护的比较器以及一个可以给MCU供电的降压转换器BUCK。也就是说我从外部只需要给它一个电源、一路PWM输入和三个采样电阻就能把逆变器和控制核心全部搭起来。我用之前的项目对比过同样的功能如果用分立方案做PCB差不多要多出三分之一面积而且电流采样那部分的Layout要求极高稍不小心就会引入噪声。集成方案虽然芯片本身价格贵一些但算上外围器件减少、板材面积缩小、调试周期缩短综合成本反而是更划算的。1.2 集成化和分体方案怎么权衡集成方案也不是没有缺点。最直接的问题是灵活性降低栅极驱动参数、运放增益这些虽然在芯片内部都能配置但不如分立方案那样可以随意换料调整。比如你想用一颗外部的高精度运放做电流采样或者想用更大驱动能力的栅极驱动芯片STSPIN32G4的内部路数就给不了你这个自由度。所以我的建议是如果目标产品是固定功能的电机驱动器比如电动工具、水泵、空气压缩机这类硬件定型后不会再大改的东西集成方案很合适但如果你是做通用型伺服驱动器或者未来可能换不同功率等级的平台那分体方案可能更长远。我做这套方案的目标是把它嵌进一个紧凑的机器人关节模组里对体积和系统复杂度要求高集成方案就成了最优解。1.3 适合跑FOC的硬件加速到底加速在哪很多人不太理解FOC代码里真正吃CPU的是什么。我在这儿多说一句三个PI调节器、坐标变换这些其实算起来很快真正费时间的是三角函数、反正切、平方根这些超越函数。以前在普通M0/M3内核上跑一个电角度计算可能要几十个周期再乘上20kHz的控制频率CPU负载就上去了。STSPIN32G4内部那颗CORDIC外设天生就是干这个的旋转坐标变换、求sin/cos、算atan2一条指令级别的硬件操作就能出结果。实际跑下来我一个20 kHz的中断里把整套FOC算完包括位置反馈、三环位置环、速度环、电流环运算整体负载也就不到30%还有富余的算力去做通信、状态监测和故障保护。2. FOC控制原理把算法拆开揉碎2.1 先说清楚FOC到底在控制什么网上讲FOC原理的文章一抓一大把但很多是直接把数学公式甩出来看过之后依然不知道代码怎么写。我用自己的话捋一遍三相永磁同步电机的定子上有三组线圈分别通三相交流电这三相电流合起来会形成一个旋转的磁场拉着转子永磁体跟着转。问题是三相交流电的参数之间互相耦合你直接去控制每一相电流的大小很难直观地对应到“我想要多大扭矩”。FOC的核心思路是给电流做一个坐标系变换把固定在定子上的三相坐标系先变成两相静止坐标系再变成跟着转子一起旋转的坐标系。在旋转坐标系里电流可以分解成两个解耦的分量——一个负责产生磁场d轴电流一个负责产生扭矩q轴电流。这样控制就变成了类似他励直流电机的控制你想要多少扭矩就控制iq你想要多少励磁就控制id通常在表贴式电机上会让id等于0。2.2 电流是怎么从三相变到两相的这里说下关键的两个数学变换。第一步叫Clarke变换把三相电流Ia、Ib、Ic从相差120度的三相坐标系变成两相静止坐标系下的Iα、Iβ。如果电机三相电流没有中线引出那么Ia Ib Ic 0实际目标上只需要采样两相电流就够了。数学关系很直接Iα IaIβ (Ia 2·Ib) / √3第二步叫Park变换把Iα、Iβ旋转一个角度θθ就是转子当前的电角度得到旋转坐标系下的Id、IqId Iα·cosθ Iβ·sinθIq -Iα·sinθ Iβ·cosθ这个θ怎么来如果有编码器直接读编码器位置换算如果无感就得靠反电动势观测器去估计转子位置。这也就是为什么FOC一定需要实时准确的转子位置位置出错整个坐标变换就错电机就会抖、啸叫、甚至失控。2.3 控制回路和SVPWM输出得到Id和Iq之后就是很经典的双环控制电流内环用两个PI调节器一个控id一个控iq。外环根据应用选做速度控制就是速度环做位置控制就是位置环。PI调完后输出的是旋转坐标系下的Vd、Vq需要经过逆Park变换反变换回两相静止坐标系Vα Vd·cosθ - Vq·sinθVβ Vd·sinθ Vq·cosθ然后就是空间矢量调制SVPWM的活了。Vα、Vβ合成的电压矢量幅值和方向决定了逆变器六个开关管在一个PWM周期里分别以什么样的占空比导通。SVPWM相比普通的SPWM母线电压利用率更高谐波也更小所以现在做FOC基本都是标配。具体实现上就是判断扇区、计算相邻基本电压矢量的作用时间、再分配到三相占空比这些代码量大头在查表和边界处理逻辑本身并不复杂。2.4 转子位置获取方案怎么选位置传感器这块不同的应用差别很大我分别说下。增量式编码器便宜、分辨率高但上电不知道转子在哪需要专用的初始定位流程。做法通常是给d轴一个固定电流矢量把转子拖到一个已知位置也就是强制对齐然后再进入闭环。这个过程在带载启动的场景下可能会拖动负载转动需要注意。绝对值编码器上电就能得到绝对位置控制最简单但成本高一般用在伺服级别产品。霍尔传感器只有6个扇区的信息精度比较粗但可以配合反电动势做插值算法适合对低速平稳性要求不高的风机、泵类应用。无感方案基于观测器这是现在非常主流的方向利用电机反电动势估计转子位置省掉了传感器和线缆。难点在低速和零速静止时没有反电动势必须先开环强拉启动IF控制或者脉冲注入转速上来之后观测器才能可靠工作。我在这套STSPIN32G4方案里做的是无感FOC后面会详细说启动策略和调试经验。3. 硬件设计要点与实操记录3.1 电源架构的规划STSPIN32G4的好处之一是内部集成了BUCK转换器可以直接从高压母线取电降压后给MCU供电。我实际设计时电机母线是24VBUCK输出设为3.3V供MCU和外设逻辑。栅极驱动部分的供电由内部的GVDD引脚输出因为芯片内部已经做好了电荷泵和稳压外部只需要在GVDD脚放一颗几微法的陶瓷电容储能。这里有一个我踩过的坑BUCK的电感走线如果离模拟采样部分太近开关噪声会耦合到采样电阻的走线上导致电流波形毛刺特别大。我在第二版Layout时把BUCK区域放在板子一侧电流采样走线从另一侧走并用地线包围起来波形马上就干净了。这个问题在原理图上是看不出来的只有实际示波器测波形时才会发现。3.2 电流采样方案怎么选FOC需要读取至少两相电流常见的有三种采样拓扑我直接列个表对比单电阻采样、双电阻采样、三电阻采样。成本单电阻最低三电阻最高精度三电阻最高双电阻居中单电阻受限于采样窗口和重构算法精度相对最差实现复杂度单电阻因为要在一个PWM周期内测两次电流并重构三相电流算法最麻烦空间矢量调制在扇区边界时的采样窗口会极短必须做插入补偿。双电阻只需要采两相但要求至少有一相下管的导通时间足够长在低占空比时需要做相移补偿。三电阻每个PWM周期都能稳定采到三相电流直观、鲁棒适合大部分应用。我最终选了三电阻方案原因是这个控制板要适配不同电机有的内阻小有的电感小双电阻在低占空比区间的补偿逻辑会让调试时间变长。三电阻加上芯片内部集成的三个可编程运放外部只需要三颗采样电阻再加几个RC滤波电容硬件成本增加很少但调试要轻松得多。3.3 栅极驱动和自举电路细节栅极驱动部分芯片内置的三相驱动器自带死区时间和防直通逻辑这些寄存器配置一下就行。外部需要重点注意的是每个高端MOS管都需要一路自举供电Bootstrap。自举电容的容量不能太小否则高端驱动在高频开关时会欠压也不能太大否则自举充电时间太长启动瞬间可能会失败。我用的自举电容是100nF加1uF并联典型值在这个量级基本没问题。电容尽量靠近芯片的BOOT引脚和相节点引脚放置走线要短、要粗。还有一个容易忽略的地方上电初期母线电压还没建立起来自举电容是空的此时如果直接开启PWM高边MOS管因为驱动电压不足会进入线性区瞬间过温。我的处理方式是软件里做“预充电”流程在启动PWM之前先用低边MOS管导通一段固定时间给自举电容充电然后再正常发波。3.4 布局布线与采样信号完整性电流采样的Layout真的值得单独说一说。采样电阻两端是高压共模信号上面叠加的是很小幅度的差分信号大电流时可能也就几十到几百毫伏如果采样线走得太长或者穿过开关噪声区域那采样出来的电流波形根本没法看。我的做法是采样电阻用四线制开尔文连接的封装采样走线从电阻两端单独引出走差分形式不做交叉在进入芯片运放引脚之前加一级RC低通滤波截止频率放在几MHz左右滤掉高频开关节点的毛刺。实际量测中发现加这级RC之前电流波形上有明显的振铃加了之后完全没有影响FOC控制带宽波形却很干净。关于RC取值我前面做的实验是从100欧姆电阻加1nF电容开始试的你如果采用不同开关频率需要根据实际的噪声频谱重新算一下。功率回路的走线同样关键逆变桥三个半桥构成的大电流回路面积越小越好。因为回路面积决定了寄生电感寄生电感在di/dt大的时候会产生电压尖峰这个尖峰轻则让波形振铃重则直接击穿MOS管。我在第一版板子上就是因为功率回路面积过大MOS管漏源尖峰到了50多V后来重新规划了走线回路尖峰降到了32V以内。4. 软件实现从点亮LED到电机转起来4.1 工程初始化与时钟配置软件部分我用的是C语言基于原厂的硬件抽象层库来做但是FOC核心算法没有直接套用原厂生成代码而是自己写的因为后面要针对自己的应用改控制逻辑。初始化流程按这个顺序来系统时钟配置内部PLL把系统时钟提到170MHz。GPIO把PWM输出脚复用为定时器通道采样保持脚配为模拟输入。ADC配置为注入组采样模式由定时器触发。定时器PWM定时器设为中心对齐模式PWM频率20kHz死区时间设为几百纳秒视MOS管参数而定。电流采样运放设置放大增益、零漂校准。CORDIC外设在初始化时也要打开后面算sin/cos、atan2都会调用它。4.2 PWM和ADC采样时序配合这是FOC软件里最容易出错、也最难排查的部分之一。电流采样必须在IGBT下管开通的中间时刻进行因为此时采样电阻上的电压最稳定、最能代表相电流的平均值。用中心对齐的PWM模式时定时器计数到中心点也就是高电平的中点此时低边MOS刚好导通到了中点位置。设置为在这个点触发ADC注入组采样是可以的。但有个细节要注意PWM刚刚切换的瞬间电流采样电阻上会有很大的电压尖峰这是二极管反向恢复、寄生电容充放电造成的。如果采样时刻正好落在尖峰上采到的电流就不是真实电流了。解决办法是ADC的采样保持时间适当加长或者把触发点从PWM中心稍微偏移一段死区补偿时间。我最后实测下来把采样点设在PWM中心再往后偏移大概0.5到1微秒读到的电流波形沿平滑谐波也小。4.3 FOC主循环代码实现我贴一下自己写的FOC中断服务函数核心结构这个不是完整工程但看完就能明白整个数据流是怎么串起来的void FOC_ISR(void) { // 1. 读取ADC注入组采样的两相电流 float Ia ADC_GetValue(ADC_INJECTED_CHAN_1); float Ib ADC_GetValue(ADC_INJECTED_CHAN_2); float Ic -(Ia Ib); // 第三相电流由基尔霍夫定律推出 // 2. 零漂校正上电时已经采集过offset Ia Ia - offset_a; Ib Ib - offset_b; // 3. 坐标变换静止三相 - 静止两相 float Ialpha Ia; float Ibeta (Ia 2.0f * Ib) * 0.577350269f; // 4. 读取转子电角度无感方案由观测器提供带编码器方案由编码器换算 float theta Get_Rotor_Angle(); // 5. Park变换静止两相 - 旋转两相 float cos_t arm_cos_f32(theta); float sin_t arm_sin_f32(theta); float Id Ialpha * cos_t Ibeta * sin_t; float Iq -Ialpha * sin_t Ibeta * cos_t; // 6. 电流环PI调节id参考值通常设为0 float Vd PID_Update(pid_id, Id_ref, Id); float Vq PID_Update(pid_iq, Iq_ref, Iq); // 7. 逆Park变换 float Valpha Vd * cos_t - Vq * sin_t; float Vbeta Vd * sin_t Vq * cos_t; // 8. SVPWM调制产生三相占空比 SVPWM_Calc(Valpha, Vbeta); }速度环和位置环在电流环外面放在一个较低频率的任务里执行比如电流环20kHz速度环1kHz。只要电流环闭环稳定外环就是普通的级联PI调试思路和直流伺服一致。4.4 无感启动流程IF开环强拉加滑模观测器这一节是无感FOC的精华。启动的时候电机没有反电动势观测器输出不可信必须先用强制对齐的方式把转子拉到已知角度再用IF电流频率注入的方式开环加速速度上升到一定程度之后再切到闭环观测器模式。我的启动时序是先向q轴施加一个固定电流让转子转到一个已知的电气角度维持100毫秒左右。然后开始加速过程电角度持续累加电流幅值按照斜坡慢慢减下来因为速度越高需要的加速电流就越小。等转速到了额定转速的10%到15%左右就开始尝试切换到滑模观测器闭环。切换的判据是观测器的反电动势估算值连续稳定了若干个周期并且观测器估计角度和当前开环角度的误差小到一定范围直接切换过去。这里有一个切换时机的经验问题。切早了观测器角度还没收敛电机容易顿一下或者直接过流切晚了开环电流已经很小了带不动负载可能转速上不去。我实际调的话是先在一个空载电机上记下切换成功的角度误差和反电动势阈值区间再把电机装到负载上微调。这个参数在不同电机上差异很大不建议直接抄但启动时序结构是通用的。5. 调试过程中踩过的坑与排查技巧5.1 电机啸叫、电流波形杂乱先查采样时序和电流零漂我做第一版硬件的时候上电一跑电机能转但噪音很大电流波形用示波器看像是长了毛刺。一开始我以为是PI参数不对来回调Kp、Ki波形依旧难看。后来静下来查才发现问题不在PI而在ADC采样时刻正好落在了PWM开关边沿采到的电流混入了大量尖峰噪声。排查思路很简单用示波器同时看PWM输出高低边的电压波形和ADC采样触发信号对比触发点是否在低边导通区间的最稳定段。如果不是就把采样触发点往后移。另外一个隐蔽坑是运放零漂没有校准。FOC对零漂极其敏感零点哪怕偏了几个mA在旋转坐标系里就会表现为一个固定偏置的id和iq导致低速扭矩波动。我的处理方法是每次上电在电机静止、PWM不输出的状态下手动采集一组电流采样值作为零点存下来给后续坐标变换用。运行时实时偏置校准也可以但要先保证电机是静止状态否则校准结果会把真实电流当成零漂给减掉。5.2 无感FOC低速段扭矩不足、电机发抖无感方案在低速段扭矩能力偏弱这是原理上限定的。低速时反电动势信号太弱观测器信噪比低位置估计抖动大电流相位就不准扭矩自然出不来。如果你非得在低速大扭矩场景下用无感想靠算法解决到底层物理上还是吃力。我实际测试的经验是在额定转速5%以下无感FOC的扭矩稳定性明显比带传感器差。如果你的应用对低速大扭矩有刚需比如机器人在重负载下原地转那还是老老实实加编码器或者霍尔位置传感器。如果只是风机水泵这类启动时负载扭矩很小、转速慢慢往上升的无感方案没有问题把启动电流斜坡的斜率调缓一些就行。5.3 过流保护误触发一加载就跳闸过流保护这块芯片内部的比较器可以设定阈值一旦电流超限就直接硬件封锁PWM输出这个反应速度比软件快得多。但是我一开始把阈值设得很保守稍微带一点负载就触发保护以为是硬件问题。后来用示波器看采样电阻上的真实过流波形发现是启动瞬间电流激增导致的误触但这个电流的持续时间很短并没有真正到损坏器件的程度。解决办法有两个方向一是把比较器阈值调到电机堵转电流的1.2到1.5倍左右确保正常堵转不误触二是适当调整启动策略让启动电流斜坡更平缓减小启动超调。硬件上也可以加一个短暂的滤波窗口利用比较器的滤波功能滤掉微秒级的电流毛刺只对真正持续的过流信号响应。5.4 常见问题速查表我把调试中遇到的问题整理成一个速查表给后面做同类项目的人参考。电机上电无法启动初始位置对齐失败或强制对位电流太小加大对齐电流确认转子被稳定吸附启动时序太短拉长IF启动阶段时间。低速啸叫或抖动采样时序偏早重置ADC触发时刻零漂未校准测量静止零点偏置并做软件扣除电流环PI过强降低Kp并增加积分限幅。高速运行时转速抖速度环带宽和电流环带宽重叠拉大两级带宽差距编码器安装偏心导致角度噪声用软件滤波或换用绝对值编码器母线电压波动给速度环增加前馈补偿。加载时相电流畸变SVPWM过调制区控制没处理好加入过调制和限幅策略采样电阻在强电流下发热导致阻值漂移换更大功率的电阻死区效应显著增加死区补偿。驱动芯片过热开关频率过高适当降低PWM频率或优化栅极电阻栅极电阻太小导致开关斜率过陡增大栅极电阻减缓dv/dt电路板散热铜皮面积不足优化布局并增加散热过孔。过流保护频繁触发阈值设置过紧按堵转电流的合理倍数调整启动冲击电流过大优化启动斜坡电流采样毛刺导致比较器误动作加入硬件滤波或配置比较器消隐时间。实际做下来我的体会是FOC项目调试的顺序真的很重要。先把硬件电流波形调到漂亮再谈闭环参数先让电流环稳再谈速度环先空载跑顺再接负载。跳过任何一步后面都有可能被奇奇怪怪的叠加问题绕进去。另外就是测试点一定留足每一路电流采样、母线电压、三个栅极驱动信号最好在板子上都有可以直接量测的焊盘或测试针调试阶段这些点比什么都管用。最后再分享一个经验原型阶段做单电阻采样省下来的物料和成本最后大概率会翻倍花在调试时间上。电机控制领域采样数据的质量和可靠程度决定了整个系统难不难调。如果你不是被成本压得特别死优先选三电阻方案到了软件调试阶段你会感谢当初这个决定。至于启动策略的细节切换、观测器系数怎么整定这些内容展开又是一大篇之后有空我准备再单独写一篇把无感观测器的调参过程专门讲讲。