FOC控制流程图详解：从电流采样到SVPWM的完整实现

1. FOC控制流程图到底在画什么很多人第一次接触FOCField-Oriented Control磁场定向控制脑子里冒出来的是一堆坐标变换公式Clarke、Park、反Park、SVPWM。公式能看懂但一到自己画流程图、写代码就不知道从哪下手。我当初啃STM32F103RCT6驱动无刷电机的时候也是这样论文看了一堆真正打开CubeMX配置定时器和ADC的时候还是懵的。这篇内容就是把我自己从零搭FOC控制框架的过程完整拆一遍重点讲清楚FOC控制流程图里每一个环节为什么这么排、每个模块之间怎么衔接、哪些地方是新手最容易翻车的。不管你是用STM32F103RCT6这种经典款还是换到G4、F4系列流程图的骨架是一样的。适合正在做无感FOC、PMSM驱动、电流环调试的嵌入式工程师也适合刚学完电机学想动手做一版FOC代码的学生。先把结论摆出来FOC的流程图本质上是一个周期性中断里的固定执行序列核心就三件事——采样电流、算出该给什么电压、把电压输出出去。剩下的所有复杂度都藏在这三件事的细节里。下面我按实际代码执行的顺序把整张流程图拆开讲。2. 整体控制框架与执行时序设计2.1 为什么FOC必须挂在中断里跑FOC是一个实时性极强的控制算法。电流环的带宽通常在1kHz到20kHz之间意味着你必须在固定的时间间隔内完成一次完整的采样-计算-输出循环。如果用主循环while(1)去跑任何一个延时或者分支都会让控制周期抖动电流环直接震荡。所以FOC流程图的第一个框永远是定时器触发的ADC中断或者PWM周期中断。我用的方案是TIM1产生中心对齐PWM驱动三相桥同时在计数器归零或峰值时触发ADC注入组采样ADC转换完成后触发中断在中断里跑完整的FOC流程。这里有个关键设计决策ADC采样时刻的选择。热搜词里有人问“foc adc采样应该在什么时刻”这个问题非常关键。中心对齐PWM模式下计数器在周期中间时三相下桥臂全部导通或全部关断取决于你的驱动极性此时母线电流流过采样电阻能采到真实的相电流。如果你在PWM边沿采样开关噪声会把电流信号淹掉。注意采样时刻必须和PWM模式匹配。中心对齐配中间采样边沿对齐配边沿采样混了就会采到开关振铃。2.2 完整流程图的模块划分我把整张FOC控制流程图分成五大块按执行顺序排列电流采样与重构ADC读取两相或三相电流根据基尔霍夫电流定律重构第三相Clarke变换三相静止坐标系到两相静止坐标系α-βPark变换两相静止到两相旋转坐标系d-q需要转子电角度电流环PI调节d轴和q轴分别做PI输出Vd、Vq反Park变换 SVPWMVd、Vq转回α-β再通过SVPWM生成六路PWM占空比如果是无感FOC在Park变换之前还需要一个转子位置观测器滑模观测器、龙伯格观测器或磁链观测器来估算电角度和转速。如果是有感FOC电角度直接来自编码器或霍尔传感器。有感和无感的流程图差异就在这一个模块上其余部分完全一致。所以你在画流程图的时候可以把位置获取单独画成一个子模块方便切换。2.3 电流环和速度环的嵌套关系FOC通常是双环结构外环速度环、内环电流环。速度环的执行频率可以比电流环低比如电流环10kHz速度环1kHz。流程图上表现为每10次电流环中断才执行一次速度环计算。速度环的输出是q轴电流指令Iq_refd轴电流指令Id_ref通常设为0表贴式PMSM或者根据MTPA算法计算内置式PMSM。热搜词里提到的“foc mpta控制”就是在这里体现的——根据转矩需求分配Id和Iq让同样转矩下电流最小。我建议新手先把Id_ref固定为0把电流环调稳了再上MTPA。MTPA涉及电机参数Ld、Lq、磁链参数不准反而会让效率变差。3. 核心环节的细节拆解与实操要点3.1 电流采样ADC配置与采样电阻选型电流采样是整张流程图的入口采不准后面全白搭。常见方案有三种采样方案原理优点缺点单电阻采样母线一个采样电阻成本最低需要特殊PWM移相算法复杂双电阻采样下桥臂两个电阻算法简单成本适中低压区采样窗口不足三电阻采样下桥臂三个电阻全周期可采成本最高我用的是双电阻方案在STM32F103RCT6上配置ADC1的注入组规则组用来采母线电压和温度。注入组的好处是可以被TIM1的TRGO事件硬件触发不占用CPU干预。采样电阻的选型要算一下。假设电机峰值相电流10A采样电阻0.01Ω运放增益10倍那么ADC输入电压是10A × 0.01Ω × 10 1V。STM32的ADC参考电压3.3V12位分辨率1V对应1241个码值。这个裕量是合理的既不会饱和分辨率也够用。实操心得采样电阻一定要用四端子 Kelvin 接法否则焊盘和走线的寄生电阻会直接叠加到采样电阻上小电流时误差巨大。我第一版板子没注意这个5A以下电流读数飘得没法看。ADC采样完成后需要做偏置校准。上电时电机不转此时采到的电流值就是零偏。把三相电流的零偏存下来后续每次采样都减去这个值。这一步不做电流环会有直流分量电机会发热。3.2 Clarke变换与Park变换的实现细节Clarke变换把三相电流Ia、Ib、Ic变成Iα、Iβ。如果三相平衡IaIbIc0那么只需要采两相就能重构第三相。公式是Iα Ia Iβ (Ia 2Ib) / √3在代码里为了速度通常用查表或者定点数运算。STM32F103RCT6没有FPU浮点运算慢我建议用Q15定点格式。比如Ia和Ib的范围是-2048到2047对应-10A到10A那么Iα直接等于IaIβ用乘加实现。Park变换需要转子电角度θ。公式是Id Iα·cosθ Iβ·sinθ Iq -Iα·sinθ Iβ·cosθ这里的θ是电角度不是机械角度。电角度 机械角度 × 极对数。比如电机是7对极机械转一圈电角度转7圈。这个换算在流程图里要标清楚我见过有人直接把编码器机械角度喂给Park变换电机转起来像步进电机一样一顿一顿的。sin和cos的计算如果MCU没有硬件三角函数用查表法最快。做一个256点的正弦表用角度的高8位索引低8位做线性插值。精度够用速度也快。3.3 电流环PI调节器的参数整定电流环是FOC的核心PI参数整不好电机要么响应慢要么震荡啸叫。整定方法有两种理论计算和实验试凑。理论计算需要电机参数相电阻Rs、相电感Ls。PI参数按以下公式初算Kp Ls × 带宽 × 2π Ki Rs × 带宽 × 2π假设Ls 1mHRs 0.5Ω期望带宽1kHz那么Kp 0.001 × 1000 × 6.28 ≈ 6.28Ki 0.5 × 1000 × 6.28 ≈ 3140。这只是初值实际还要根据采样周期和离散化方式调整。实验试凑法更实用先把Ki设为0逐渐增大Kp直到电流出现小幅震荡然后回调到震荡的60%。再逐渐增大Ki直到电流跟踪指令无静差且不震荡。注意d轴和q轴的PI参数通常相同但如果电机凸极效应明显Ld ≠ Lq需要分别整定。表贴式PMSM可以共用一组参数。PI输出需要限幅防止积分饱和。限幅值对应最大输出电压通常是母线电压的1/√3。积分项还要做抗饱和处理当输出达到限幅时停止积分累加。3.4 SVPWM的生成与死区时间设置反Park变换把Vd、Vq转回Vα、Vβ然后SVPWM模块根据Vα、Vβ计算六个开关管的占空比。SVPWM的原理是用八个基本电压矢量合成任意方向的电压矢量比SPWM的母线电压利用率高15%。SVPWM的实现步骤判断Vα、Vβ落在哪个扇区共6个扇区计算相邻两个基本矢量的作用时间T1、T2计算零矢量作用时间T0 Tpwm - T1 - T2根据扇区分配三路PWM的比较值在STM32上用TIM1的互补输出通道配置死区时间。死区时间根据MOS管和驱动芯片的开关速度来定一般200ns到1μs。死区太短会直通炸管太长会畸变电流波形。实操心得死区时间会引入电压误差尤其在低速时明显。可以在SVPWM输出后加一个死区补偿模块根据电流方向修正占空比。我一开始没做补偿电机低速时转矩脉动很大加了补偿后明显改善。4. 无感FOC的位置观测器实现4.1 滑模观测器的基本结构无感FOC最大的难点是不知道转子位置。滑模观测器SMO是最常用的方案之一热搜词里“foc滑模观测器”出现频率很高。它的核心思想是根据电机电压方程构造一个电流观测器用实际电流和观测电流的误差构造滑模面误差收敛后反电动势信息就藏在等效控制量里。PMSM在α-β坐标系下的电压方程Vα Rs·Iα Ls·dIα/dt Eα Vβ Rs·Iβ Ls·dIβ/dt Eβ其中Eα、Eβ是反电动势Eα -ω·ψf·sinθEβ ω·ψf·cosθ。观测器构造为dIα_hat/dt (Vα - Rs·Iα_hat - Zα) / Ls dIβ_hat/dt (Vβ - Rs·Iβ_hat - Zβ) / LsZα、Zβ是滑模控制项通常用饱和函数或sign函数。当观测电流收敛到实际电流Zα、Zβ就等效于反电动势。然后用反正切或者锁相环PLL从Eα、Eβ中提取角度和转速。滑模观测器的参数主要是滑模增益Kslide太小收敛慢太大抖振严重。我一般从反电动势幅值的1.5倍开始试。4.2 转子初始位置检测无感FOC上电时不知道转子在哪如果直接开环强拖可能反转或者失步。热搜词里“foc 转子初始位置检测”就是解决这个问题的。常用方法有两种高频注入法向d轴注入高频电压信号利用凸极效应从响应电流中提取转子位置。适合内置式PMSM表贴式效果差。脉冲注入法依次向六个方向施加短时电压脉冲比较各方向的电流响应幅值最大响应方向就是转子N极方向。简单粗暴但会产生转矩脉动和噪音。我用的是脉冲注入法因为表贴式电机凸极效应弱高频注入效果不好。注入脉冲宽度要控制好太短检测不准太长电机会动。一般取PWM周期的几十倍电流上升到额定值的50%左右即可。注意脉冲注入法在电机带载时可能不准负载转矩会让转子微动。如果应用场景允许最好在空载或轻载时做初始位置检测。4.3 低速到高速的切换策略滑模观测器在低速时反电动势幅值小信噪比低角度估算不准。所以无感FOC通常采用三段式启动预定位强制转子对齐到已知角度开环强拖按设定加速度升速电流环闭环但角度用开环给定闭环切换当转速达到观测器能准确工作的阈值通常额定转速的5%~10%切换到观测器角度切换瞬间要做角度平滑过渡否则会失步。我的做法是在切换点用一阶低通滤波把开环角度和观测角度混合过渡时间约100ms。5. 常见问题与排查技巧实录5.1 电流采样异常排查表现象可能原因排查方法电流读数恒为零ADC触发源配置错误检查TIM1 TRGO是否连接到ADC注入组电流波形畸变采样时刻不对示波器看采样点是否在PWM中间小电流时误差大运放偏置未校准上电时做零偏校准大电流时饱和采样电阻或增益过大重新计算最大电流对应电压电流有直流分量零偏未减去或PI积分饱和检查零偏值和PI限幅5.2 电机启动失败或反转启动失败最常见的原因是初始位置检测错误或者相序接反。排查步骤确认三相线顺序正确U-V-W对应驱动器的U-V-W用示波器看三路PWM确认互补输出和死区正常手动给一个固定角度看电机是否对齐到该角度如果对齐方向反了把两相线对调或者把角度加π我遇到过一次电机启动就反转查了半天发现是编码器A、B相接反了导致电角度方向相反。有感FOC一定要确认编码器方向和电机相序匹配。5.3 电流环震荡与啸叫电流环震荡通常表现为电机发出高频啸叫电流波形有毛刺。原因和解决方法PI参数过大降低Kp和Ki重新整定采样噪声大增加RC滤波或在ADC后做滑动平均控制周期抖动检查中断优先级确保FOC中断不被其他中断打断死区时间过长减小死区或加死区补偿实操心得STM32F103RCT6的ADC采样保持时间要设够。电机驱动电路阻抗低采样保持电容充电快但如果采样时间太短采样值会偏低。我一般设采样时间为55.5个ADC周期对应1μs左右。5.4 无感FOC切换失败从开环切到闭环时失步通常是观测器角度和开环角度差异太大。解决方法降低切换转速阈值让反电动势更大再切检查观测器参数确保在切换点角度估算误差小于10度切换时做角度渐变不要突变切换后先只闭电流环速度环延迟一段时间再投入我调试的时候在切换点用串口把开环角度和观测角度都打出来对比看差异。如果差异超过30度说明观测器还没收敛需要继续升速。6. 从流程图到代码的映射建议6.1 中断服务函数的代码结构FOC中断服务函数应该尽量精简只放必须实时执行的部分。我的结构是void TIM1_UP_IRQHandler(void) { // 1. 读ADC注入组结果 Ia ADC_GetInjectedValue(ADC1, 0) - Ia_offset; Ib ADC_GetInjectedValue(ADC1, 1) - Ib_offset; Ic -Ia - Ib; // 2. Clarke变换 Ialpha Ia; Ibeta (Ia 2*Ib) * ONE_BY_SQRT3; // 3. 获取电角度有感读编码器无感跑观测器 theta Get_Electrical_Angle(); // 4. Park变换 Id Ialpha*cos_tab[theta] Ibeta*sin_tab[theta]; Iq -Ialpha*sin_tab[theta] Ibeta*cos_tab[theta]; // 5. 电流环PI Vd PI_Calc(pi_d, Id_ref - Id); Vq PI_Calc(pi_q, Iq_ref - Iq); // 6. 反Park变换 Valpha Vd*cos_tab[theta] - Vq*sin_tab[theta]; Vbeta Vd*sin_tab[theta] Vq*cos_tab[theta]; // 7. SVPWM SVPWM_Calc(Valpha, Vbeta, Ta, Tb, Tc); TIM1-CCR1 Ta; TIM1-CCR2 Tb; TIM1-CCR3 Tc; // 8. 清中断标志 TIM_ClearITPendingBit(TIM1, TIM_IT_Update); }速度环放在主循环或者另一个低优先级中断里每1ms执行一次更新Iq_ref。6.2 CubeMX配置要点用CubeMX配置FOC外设几个关键点TIM1中心对齐模式PWM频率设16kHz死区时间根据硬件填TRGO输出选Update事件ADC1注入组外部触发选TIM1 TRGO采样时间设55.5周期扫描模式使能NVICTIM1更新中断优先级设为最高ADC中断次之GPIOPWM输出引脚设为复用推挽速度最高注意CubeMX生成的ADC注入组代码默认不开启连续转换需要手动在代码里调用ADC_InjectedStart_IT。我一开始忘了这句中断死活不进查了半天。6.3 定点数与浮点的选择STM32F103RCT6没有FPU浮点运算靠软件模拟一次乘法要几十个周期。FOC中断里如果全用float16kHz中断可能跑不过来。我的建议是电流、电压用Q15定点格式sin/cos查表用Q15PI调节器用Q15或Q31只有初始化和参数计算用float如果换到STM32G4或F4系列有FPU可以直接用float开发效率高很多。但F103RCT6作为经典款定点优化是必修课。7. 调试工具与观测方法7.1 串口波形观测没有示波器的时候可以用串口把关键变量打出来用上位机画波形。我常用的是VOFA或者SerialPlot把Id、Iq、转速、角度按固定格式发送上位机实时显示。注意串口波特率要够高115200在16kHz下只能每几次中断发一次。我一般降频发送每100次中断发一帧不影响实时性。7.2 DAC输出观测STM32F103RCT6有两个DAC通道可以把Id和Iq直接输出到DAC引脚用示波器看模拟波形。这比串口更实时没有传输延迟。配置DAC为定时器触发和FOC中断同步。7.3 关键波形判断标准Id波形应该稳定在0附近波动小于额定电流的5%Iq波形跟随指令上升时间符合带宽设计相电流波形正弦度好无明显的平顶或毛刺角度波形有感FOC中观测角度和编码器角度应重合如果Id有直流偏置检查零偏校准如果Iq震荡检查PI参数如果相电流有平顶检查死区时间和母线电压。8. 个人实操体会与后续扩展我在STM32F103RCT6上跑通FOC前后花了大概两个月大部分时间不是在写代码而是在调参数和排查硬件问题。最大的体会是流程图上的每个框背后都有一堆坑。Clarke变换看起来就两行公式但采样时刻不对变换出来的Iα、Iβ全是噪声。SVPWM理论清楚但死区时间设错管子直接炸。如果让我重新走一遍我会先把电流采样和PWM输出调通用开环电压驱动电机转起来确认硬件没问题再上Clarke、Park和电流环。这样每一步都有验证不会一堆问题搅在一起。后续扩展方向我目前在做的是把滑模观测器换成龙伯格观测器低速性能更好。另外MTPA控制也在试但需要准确测量Ld、Lq我还在用LCR表测电机参数。如果这些调通了再回来写一篇。最后分享一个小技巧调试FOC的时候把母线电压设低一点比如12V而不是24V。这样即使参数错了电流也不会太大炸管概率低。等算法调稳了再升到额定电压。这个习惯帮我省了不少MOS管。