从六步换向到无感FOC：三相无刷电机控制进阶指南

先说个真实的经历。我之前用STM32做无刷电机驱动最开始走的是很多入门玩家都会走的路装上霍尔传感器写六步换向程序NPN三极管或者MOS管驱动电机“嗡”一声转起来感觉特别有成就感。但等我把它装到带负载的场景里问题就全出来了——中高速段噪声大转矩忽大忽小相线上用示波器看全是尖峰电机发烫严重。后来被一个做伺服驱动的前辈点了一句“你这是在用方波驱动一个正弦反电动势的电机为什么不试试FOC”这句话让我从一个“会转就行”的玩家正式踏进了磁场定向控制的大门。这篇文章我想写给那些已经能跑通六步换向、但想进一步搞懂FOC无传感器控制的朋友。核心关键词很明确三相无刷电机、六步换向、FOC、无传感器实现再带上PID控制、电流采样、STM32F103RCT6这些绕不开的细节。我不会从“什么是无刷电机”开始讲而是直接对比两种控制方式的本质差异再把无感FOC的硬件准备、坐标变换、滑模观测器和调参流程串成一条完整的路线。如果你手里正好有个电机项目或者想搞懂网上那些FOC代码到底在算什么这篇文章应该能帮上忙。1. 六步换向的局限相电流突变的本质与真正痛点1.1 六步换向的导通逻辑先回顾一下六步换向也叫方波驱动、120°导通型驱动的基本逻辑。三相全桥一共6个开关管六步换向每次只导通上下桥臂中的两个管子一个桥臂上管导通另一个桥臂下管导通第三个桥臂悬空。每60°电角度切换一次导通状态换6次就是一个完整的电气周期。霍尔传感器通常提供60°或120°的相位信号MCU根据这三个霍尔信号的高低电平组合就知道当前应该往哪两相通电。比如常用的六步导通顺序是AB→AC→BC→BA→CA→CB这里的AB表示A相上管和B相下管导通对应不同的霍尔编码。每一步持续60°电角度电流在定子绕组中形成的合成磁场方向也按60°步进跳跃。这种控制方式的优点是逻辑简单对MCU算力要求低一个定时器加几个GPIO口就能搞所以大量用在电动工具、风机、水泵这些对噪声和转矩平顺性要求不高的场合。但是“简单”不等于“好用”。只要你在示波器上挂过相电流波形就会知道每次换向瞬间相电流都会出现一个明显的尖峰同时伴随扭矩的瞬间跌落。这个现象才是六步换向最核心的软肋。1.2 相电流突变六步换向最大的软肋为什么相电流会突变关键在电感电流不能突变。假设当前状态是AB-导通A相电流从母线流向电机B相电流从电机流回母线C相悬空。下一个瞬间换到AC-导通B相要由“参与导通”变成“悬空”但B相绕组里的电流不可能瞬间变成0它就只好通过MOS管的反并联二极管继续续流把多余的能量回馈到直流母线或者另一相回路里。这一续流过程会带来两个直接后果一是相电流波形出现尖峰和畸变产生电磁噪声和机械噪声二是换向瞬间的电磁转矩会有明显的脉动表现出来就是电机运转不平顺尤其是在低速带载的时候更明显。电感越小、电机转速越高、母线电压越高这个问题越严重。我实测过一台小型航模电机在高速端挂上负载后换向电流尖峰能到正常工作电流的3倍左右发热量非常可观。还有一点容易被忽略六步换向的合成磁场方向是跳跃式变化的而转子永磁体的磁场方向是连续旋转的两者之间不可能始终保持90°的最优夹角。这就意味着在整个电气周期中很大一部分时间里电机并没有工作在最大转矩输出状态效率自然打折。1.3 什么时候该从六步换向转向FOC很多项目其实没必要上FOC。如果你做的是电钻、打草机、小风扇六步换向足够成本还低。但如果你要做的是机器人关节、压缩机、无人机、电动滑板车或者任何对噪声、震动、低速性能、动态响应速度有要求的场景六步换向就有心无力了。FOC也并不是高不可攀它的思路本质上是“把交流电机当成直流电机来控制”。通过坐标变换把定子三相电流分解成一个与转子磁场垂直的转矩分量和一个与转子磁场平行的励磁分量然后分别对这两个分量做PID控制最终得到的是连续正弦变化的相电流而不是方波。这样转矩脉动小、噪声低、动态响应快而且高速区的效率明显更高。至于“无传感器实现”主要是为了去掉霍尔传感器。霍尔传感器虽然便宜但它在高温、密闭、强振动的场合可靠性会下降而且安装位置一旦有偏差换相时序就会跟着偏移直接影响性能。所以压缩机这类密封系统、或者电机本身在很恶劣环境里的项目无感控制几乎是刚需。我的建议是如果你正在六步换向和FOC之间犹豫优先把FOC学起来因为现在FOC方案的硬件成本并不比六步换向高多少收益却大得多。2. 从方波到正弦FOC的坐标变换和电角度理解2.1 先从直流电机说起FOC的核心思想一句话就能说清楚把三相交流电机的控制问题变换成类似直流电机的控制问题。直流电机为什么好控制因为当电枢电流方向和磁场方向垂直时电磁转矩和电枢电流成正比你只需要控制电流大小转矩就跟着变。而且直流电机的磁场方向和电枢电流方向在结构上是天然确定的不需要实时跟踪。三相永磁同步电机PMSM就不一样了。定子绕组产生的是旋转磁场转子是永磁体也在旋转如果你想让转矩始终最大就得保证定子电流产生的磁场始终和转子磁场保持合适的角度。这时候直接控制三相电流的瞬时值是很麻烦的因为三个相电流全都是随时间正弦变化的交流量而且频率还随转速变。怎么把交流量变成直流量靠坐标变换。这就是FOC算法里最核心的两步Clark变换和Park变换。2.2 Clark变换和Park变换Clark变换把三相静止坐标系a、b、c轴下的电流变换到两相静止坐标系α、β轴下。公式也不复杂iα 2/3 × (ia - 1/2 × ib - 1/2 × ic) iβ 2/3 × (√3/2 × ib - √3/2 × ic)这里的2/3是等幅值变换系数也有人用等功率变换的√(2/3)两种约定都有人用但后续SVPWM和观测器公式里系数要对得上才行。经过Clark变换后三相耦合的交流电流变成了αβ轴上的两个正交交流量。然后再做Park变换把αβ轴旋转到以转子磁场方向为基准的dq坐标系id iα × cosθ iβ × sinθ iq -iα × sinθ iβ × cosθ这个θ就是转子电角度。变换做完之后id是励磁电流分量iq是转矩电流分量。对于表贴式永磁同步电机让id0只用PID控制iq一个量就能线性地控制转矩。这个“旋转坐标系下看静止量”的思路本质上就是坐在旋转的转子上看定子电流看到的就是一个直流。所以FOC的灵魂不是那个SVPWM而是“坐标变换两个电流PI控制器”。你真正要控制好的不是三相电流本身而是dq坐标系下的两个直流分量。2.3 电角度和转子角度这两个角度到底差在哪初学者最搞不定的就是这个角度问题。电角度和机械角度不是一回事之间差一个极对数pθe p × θm如果你用了一个4对极的电机转子每转一圈电角度会跑4圈。也就是说电气周期和机械周期性不同步。FOC里所有坐标变换用到的都是电角度如果你把这个参数搞错了哪怕霍尔信号、编码器位置都对电流环也是完全乱的。另一个更难理解的点是电角度的零点在哪坐标变换里的θ必须和转子磁极位置有一个明确的对应关系。如果你装了编码器通常需要在电机通电后做一次转子预定位让转子转到某个已知位置然后把编码器位置清零这样电角度的起点才确定。如果没有做过零位对齐后面算出来的id、iq也都是错的电流环根本收敛不了。很多无感FOC启动失败其实就失败在初始电角度没对准。关于角度还有个常见误解有人觉得无感控制里反正切求出来的角度可以直接用不需要补偿。实际上任何观测器出来的角度都有相位延迟尤其在电机高速运转时角度滞后会导致电流环解耦不彻底、转矩下降甚至失步。这部分到后面讲滑模观测器的时候再展开。3. 无感FOC的硬件准备电流采样、定时器与CubeMX配置思路3.1 电流采样方案的取舍FOC控制再漂亮没有准确的相电流数据就是空中楼阁。电流采样方案大致分三种三电阻采样、双电阻采样、单电阻采样。最推荐入门用的是三电阻采样在逆变器下桥臂的三个MOS管源极分别接一个采样电阻通过三个运放放大采样电压送给ADC。三电阻方案可以直接得到两相电流第三相用基尔霍夫电流定律算出来就行。它的优点是电流重建简单、精度高缺点是成本略高、需要三个运放通道而且当某一相的PWM占空比接近0或100%时下桥臂导通时间太短采样窗口不足电流重建会失真。双电阻方案省掉一个采样电阻但需要依赖重构算法在占空比合适的时刻采样第三相低调制区误差会比较明显。单电阻方案最省成本只在母线正端或负端接一个采样电阻但三相电流要从不同PWM开关状态下的母线电流里重构出来算法最复杂对时序的要求也最高。我的建议是如果是自学习阶段直接上三电阻方案调试难度最低。下表是三种方案的核心差异方案采样电阻数量相电流重建难度典型限制适合场景三电阻3低高/低占空比采样窗口不足学习、中高端驱动双电阻2中重构误差与占空比强相关成本敏感产品单电阻1高开关状态组合限制多极小体积驱动3.2 采样窗口和ADC触发时机电流采样的时机比采样电路本身更容易翻车。六个MOS管在换流瞬间会有死区死区时间里上下桥臂都处于关断状态电流只通过二极管续流此时采样电阻上的电压不能真实代表绕组电流。另外MOS管开通和关断瞬间还有振铃采样点如果正好落在这个区域得到的电流值会有很大的毛刺。正确做法是在PWM周期中间采样。如果PWM用的是中心对齐模式三角波计数计数器的上溢或下溢时刻正好对应PWM周期的中心点此时三相下桥臂通常都在导通电流续流回路稳定是ADC触发采样的最佳时机。实际做法是用高级定时器的TRGO事件去触发ADC注入组转换同时把ADC采样时间设置得足够长尽量避开开关振铃。还有一个容易踩的坑三电阻采样里如果某个下桥臂的占空比过低它的导通时间小于ADC采样保持时间那一路的值就是不准的。软件上要有最小采样占空比保护或者采用重构算法从另外两相推算。很多人在FOC电流环刚启动的时候看到电流波动巨大查来查去才发现是高占空比/低占空比下采样窗口不足。3.3 基于STM32F103RCT6的硬件资源分配STM32F103RCT6这块芯片算是无感FOC入门最常见的型号之一72MHz主频带高级定时器TIM1适合做电机控制。需要注意它没有硬件浮点单元做FOC运算时如果是C语言里直接写floatDSP库优化不够好的话20kHz电流环会吃紧但优化得好也能跑很多开源项目就是在这个芯片上跑出来的。硬件资源分配建议TIM1作为PWM主定时器输出中心对齐模式的6路PWM别忘开互补输出和死区插入初始极性也要根据前驱电路设对。ADC用ADC1的注入组由TIM1的TRGO事件触发同时在PWM中心的时刻启动采样转换。电流环中断用TIM1的上溢/下溢事件触发中断频率等于PWM频率比如20kHz。如果你要用编码器做有感调试TIM2-TIM4留一个做编码器模式输入但后续切无感时这个定时器可以空出来。在CubeMX里的配置思路是先建立PWM定时器和ADC再把两者的触发关系连起来。很多人会忽略的是PWM死区寄存器尤其是驱动板用的光耦隔离方案或非隔离方案死区设置不合适时上下管直通烧管子是分分钟的事。我习惯把死区先设成2μs左右验证驱动板安全再根据实际MOS管关断延迟逐步调小。4. 无传感器转子位置观测滑模观测器实现与启动策略4.1 主流的无感位置观测方案对比去掉霍尔和编码器之后转子位置要靠算法“猜”。常用的办法有反电动势过零检测、滑模观测器、磁链观测器、高频注入法每一种都有自己的适用区间。方案基本原理优点缺点适用速度段反电动势过零检测检测悬空相的反电动势过零点实现简单、成本低零速和低速无信号中高速滑模观测器SMO基于电机电压方程利用滑模等效控制提取反电动势鲁棒性强、对参数不敏感存在抖振需滤波和角度补偿中高速磁链观测器观测定子磁链估计反电动势相对平滑对电机参数精确度要求高中高速高频注入法注入高频电压信号利用转子凸极性探测位置支持零低速只适用于凸极率高的电机算法复杂零速/低速对入门和大多数中小功率表贴式永磁同步电机来说滑模观测器是最常用的选择网上很多开源项目、ST和TI的参考设计里也是这个路线。它不依赖复杂的电机参数控制律简单配合低通滤波器就能得到可用的转子角度。4.2 滑模观测器的原理和角度补偿滑模观测器的出发点是电机在αβ坐标系下的定子电压方程。以表贴式永磁同步电机为例αβ轴下可以写成diα/dt (-Rs × iα - eα uα) / Ls diβ/dt (-Rs × iβ - eβ uβ) / Ls其中eα、eβ是反电动势分量。反电动势里包含了转子角度和转速的信息所以只要能把eα、eβ估计出来就能算角度。滑模观测器的思路是构造一个电流观测器让观测电流和实际电流的误差作为滑模面s。当系统进入滑模运动状态时s0此时滑模控制律的等效输入中包含了反电动势信息。实际工程里通常的做法是采样得到实际电流iα、iβ用当前角度估计值算出观测电流îα、îβ电流误差经过一个开关函数或者饱和函数得到滑模控制律把滑模控制律经过低通滤波器就得到估计的反电动势êα、êβ反正切运算得到电角度 θ̂e atan2(-êα, êβ)。上面这个角度里面有一个必须处理的滞后问题。低通滤波器会给反电动势带来相位延迟延迟量和滤波器的截止频率、当前电机电频率都有关系。如果不补偿高速时角度误差可能超过十几度甚至几十度直接表现为电流环解耦不彻底、输出转矩下降、电机噪音大。补偿的方法通常是反电动势的频率近似等于电频率所以可以根据低通滤波器的相位特性做一个查表或者公式补偿。比如一阶低通滤波器的滞后角是atan(fe/fcutoff)把计算出的这个角度加到估计角上。我实际调试的时候会用编码器先同时采集真实角度和观测器角度直接看二者差值的趋势再把补偿曲线调准这种方式最直观。4.3 转子初始位置检测和开环启动策略无感FOC绕不开的问题就是零速时反电动势为零任何反电动势类观测器都不工作怎么启动行业里最稳妥的工程方案是预定位开环强拖切换闭环。先给一个固定的电压矢量让转子转到一个已知位置完成“初始位置对齐”。这里对表贴式电机不需要太精确能大致对齐就行。然后开环按给定的角度斜率强拖电机同步角度按固定速度增长电流幅值也给定等转子转速超过某个阈值、反电动势足够大之后再把控制从开环切换成闭环观测器模式。切换那一下是最容易过流的。如果开环角度和观测器角度之间存在相位差切换瞬间电流环会看到一个巨大的误差输出突然饱和轻则电流冲击重则过流保护甚至烧管子。我的做法是在切换之前的几个电周期里不断比较开环给的角度和观测器算出来的角度等到两者误差小到设定范围之后再把控制权交给闭环。同时切换时的给定电流不要突变成0要让目标值平滑过渡比如做一个斜坡函数。如果项目对启动要求比较高比如要零速满载启动、甚至带负载直接启动就要考虑高频注入法或者先用启动标定做初始位置检测。高频注入利用的是转子磁路凸极性注入高频信号之后根据电流响应解调位置能实现真正的零低速闭环启动但算法复杂度高不少。我个人的路线是先把预定位强拖方案吃透再根据项目需求决定要不要上高频注入。5. 调试全流程与参数整定从能转到好用5.1 先解决“能不能转”开环强拖与初始位置对齐很多人的无感FOC代码是从网上或者Github下载的刷进去之后发现电机要么不转要么震动几下就报过流。这时候不要急着调PID应该先用最基础的方式验证硬件和软件闭环是否正常。第一步断开电机只给PWM输出检查六路波形和死区是否正常。第二步接一个很小的电流限制把母线电压调低比如串一个限流电阻或者用隔离电源限制到12V这样就算逻辑有错也不至于烧板子。第三步用预定位方式给固定电压矢量看转子是否能转到对应位置如果转子纹丝不动或者方向不对说明SVPWM极性和相序配置有问题这个查清楚之前不要往下调。想快速确认SVPWM和采样链路是否正常还有一种很实用的方式先用编码器把角度作为真实电角度输入让电流环闭合运行如果带编码器能平稳转起来就证明Clark变换、Park变换、SVPWM和死区全部正确问题只出在无感观测器上。这比直接盲调无感要快得多。5.2 电流环的级联PID设计与参数整定顺序FOC的电流环本质是两个PI控制器一个控制id一个控制iq。id的给定值通常是0表贴式电机iq的给定值来自速度环PID的输出。两个电流环都运行在电流环中断里我这里用20kHz。参数整定顺序要严格遵守先内环后外环先把电流环调好再调速度环。电流环PI里P的作用是快速响应I的作用是消除稳态误差。调试时可以先设I很小或者为0只加大P观察iq跟随给定值的动态响应当出现明显的比例增益足够快但还有静态误差时再加I。I加得太大容易振荡表现为电流高频啸叫、震荡波形明显。电流环调好后速度环就简单很多。速度环的输出作为iq的给定一般用PI就可以P决定了速度响应快慢I消除稳态转速误差。注意速度环的响应带宽必须远远低于电流环带宽否则整个级联系统容易不稳定。经验上电流环带宽做到速度环的5到10倍以上比较安全。如果你在调速度环的时候发现电流环输出一直饱和、速度超调很大多半是速度环P太激进先降下来再试。5.3 位置观测器与速度环的配合以及我踩过的几个典型坑无感控制跑到后面你会发现最难的不是算法本身而是各种边界条件和干扰。下面列几个我实际操作中踩过、也最常见到的坑第一个坑是角度滞后引起的高速带载失步。电机高速转起来之后低通滤波器的相位滞后会让观测器角度严重落后于真实角度此时电流环解耦不彻底输出转矩下降再硬加大负载就直接失步。解决办法必须做角度补偿并且用编码器实测验证补偿量是否正确。不要想当然地给一个固定值补偿量和电频率相关最好做动态补偿。第二个坑是电流采样毛刺导致观测器抖动。很多人把采样触发放到PWM末端结果采到的电流叠加了开关振铃观测器输入噪声很大反电动势估计出来全是锯齿。解决办法是把采样点挪到PWM中心同时调长ADC采样时间必要时做软件滤波比如中值滤波或者多重采样取平均。第三个坑是零速启动时先反转一下。预定位阶段给固定电压矢量转子会转到最近的零位但这个零位和你想对齐的那个方向可能差180°看起来就像电机反转了一小段。如果机构不允许反转就要改用短脉冲法测初始位置或者用高频注入。对于大多数风机、轮毂电机反转很小一段通常可以接受。第四个坑是极对数写错了。这个听着低级但真的很常见。把极对数填错之后坐标变换的角度频率和实际电气频率对不上电机肯定转不好。判断方法很简单用示波器测一下电机线电压的电气频率再结合转速换算一下极对数直接就能确认。最后一个坑是母线电压前馈没做好。SVPWM能输出的最大电压受限于母线电压如果母线电压波动峰值占空比会突然进入过调制区电流环输出饱和失真。很多参考实现里没有母线电压前馈导致电池供电的设备在电压跌落时失控。加一个简单的母线电压补偿项把SVPWM最大调制比限制到0.9左右能显著提高稳定性。最后说点个人体会无感FOC这个方向上手难度确实比六步换向高一个台阶坐标变换、电流采样、观测器、启动策略、PID调参任何一个环节出问题电机都转不顺。但换个角度看它的收益也非常直接噪声小、转矩平顺、效率高、还能去掉霍尔传感器这是六步换向给不了的。以我自己的经验最稳妥的学习路径是先用带霍尔或者编码器的方式把FOC的电流环跑通理解Clark变换、Park变换和SVPWM再去掉位置传感器换观测器。不建议一上来就直接盲调无感不然你很难判断问题到底出在采样、坐标变换还是观测器上。调试的时候尽量全程挂示波器看相电流和观测器角度在开发板上留几个DAC输出口把内部变量引出来会比在串口里看一堆数字高效得多。后面可以扩展的方向也不少弱磁控制让电机跑得更快、MTPA让低速大扭矩更高效、参数在线辨识应对不同电机还有模型预测控制这类更前卫的电流环方案。先把六步换向到无感FOC这一条线走通后面这些都是自然而然的事。