FOC-P2-DRAFT_V2.0 这个版本号听起来像是正式工程交付的命名其实这是我给自己做的无感FOC电机控制器整理的第二阶段草稿。P2 就是 Phase 2整个项目从第一阶段“带编码器先把FOC跑通”推进到第二阶段“去掉位置传感器纯无感控制”DRAFT 说明这套代码还没到冻结发布的程度V2.0 则是在前一版草稿基础上做了大量修正后的迭代。这篇文章想把这一版在设计、调试里真正有价值的东西沉淀下来内容包括转子初始位置检测、I/f强拉启动、反电动势滑模观测器、电流环速度环参数整定、驱动板采样电路设计以及我在实际调试中踩过的坑。如果你正在做 PMSM 无感FOC入门或者正在用 STM32 调FOC算法尤其对 FOC调试难点、无感启动、FOC波形分析这些话题感兴趣这篇应该能帮你少走不少弯路。1. 项目背景与整体设计思路1.1 为什么叫 FOC-P2-DRAFT_V2.0很多自己玩电机控制的人都会有这种感觉FOC 算法本身并不神秘网上资料一大把真正让人崩溃的是把算法放到真实电机上之后的各种非理想因素。我这个项目第一阶段用的是带霍尔传感器的 PMSM先把电流内环、速度外环和坐标变换全部跑通确认算法框架没有问题。到了第二阶段也就是现在这版目标很明确把霍尔传感器去掉改成纯无感转子位置估算同时要求启动过程顺滑、不反转、不抖动。版本号从 V1.x 升到 V2.0核心变化有三个第一增加了完整的启动状态机包括预定位、电流强拉、观测器切换三个步骤第二把反电动势滑模观测器从原来的“能出波形”优化到“能长时间稳定运行”加入锁相环提取角度和速度第三重做了驱动板的电流采样电路和 PCB 布局解决了上一版在低速大电流时波形畸变的问题。DRAFT 后缀是提醒我自己这版的控制参数还是针对手头这台样机调出来的换一台电机之后电感电阻参数变了整套 PI 参数和滤波器参数都需要重新标定。1.2 这套系统的软硬件框架设计硬件主控用的是 STM32F405主频 168MHzADC 是 12 位PWM 由高级定时器 TIM1 输出互补带死区的六路信号。驱动部分用的是 IR2101 栅极驱动器加三相全桥 MOS 管电流采样采用低端三电阻方案采样电阻 20mΩ配合差分运放把信号放大 10 倍后送入 ADC。控制频率分配是这样的电流环 20kHz也就是 PWM 开关频率 20kHz速度环 1kHz位置环或者说轨迹规划放在 1kHz 的定时器中断里。为什么电流环比速度环高这么多因为电流环响应速度直接决定了整个系统的动态性能而且对 PMSM 来说电流环带宽至少要达到速度环带宽的十倍以上速度环控制起来才不会觉得“发飘”。PWM 用中心对齐模式ADC 触发点选在 TIM1 计数溢出时也就是三角载波的顶点这个时刻三相下桥臂处于确定的开关状态电流采样最干净。软件上我用的是裸机状态机没有上 RTOS中断优先级安排成PWM 更新中断最高里面完成电流采样触发、坐标变换、电流环 PI、SVPWM 占空比更新定时器低速中断做速度环和状态机切换串口中断只做日志输出。裸机在这个场景下比 RTOS 更可控尤其是电流环这种强实时任务一点点调度抖动都会直接体现在电流波形上。2. 转子初始位置检测无感FOC最容易翻车的地方2.1 启动瞬间角度误差到底有多致命无感FOC 和带传感器 FOC 最大的区别就是上电那一刻你是不知道转子实际位置的。PMSM 的电磁转矩和定子电流矢量、转子磁场夹角直接相关如果启动瞬间给定的电角度和转子实际电角度误差很大轻则堵转不动重则反转更严重的时候电流环会直接过流保护。给大家一个直观的估算表贴式 PMSM 的输出转矩近似为 T 1.5 * p * ψf * iqiq 是交轴电流。假如你给定的角度和实际转子电角度差 60 度那实际的转矩输出就只有 cos600.5 倍也就是说你有 50% 以上的电流变成了 d 轴电流。d 轴电流不产生有效转矩只发热。误差接近 90 度时转矩趋近于零超过 90 度转矩反向电机就会反转。所以在做无感启动时第一步必须先解决“转子大概在哪”的问题。2.2 我从预定位法入手的原因和实操参数现在的转子初始位置检测主流做法有两种预定位法和高频注入法。我这个项目首先用的是最朴素、也最可靠的预定位法。预定位的原理特别简单给定某个固定方向的电压矢量持续时间足够长让转子在电磁力作用下被“吸”到那个角度上。操作上我是这样做的启动状态机进入预定位阶段把开环角度固定在 0 电角度同时给定一个固定的 q 轴电流指令用电流环闭环去执行这个电流。电流环会让定子电流矢量始终保持在 90 度电角度方向转子被电磁转矩迫使逐渐对齐到 0 度位置。预定位电流的大小需要根据负载情况调。我手头这台电机额定电流 3A空载时预定位电流设到 0.5A 就够了加上负载后我调到 1.2A持续时间给足 300ms。经验是预定位时间宁可长一点也不要为了“启动快”而压缩。如果电流太小齿槽转矩可能把转子卡在非目标位置后面一步 I/f 启动就会看到明显的角度偏差如果电流太大会有明显的“咯噔”一声机械冲击大而且可能把转子推过头产生振荡。预定位结束的标志是电流稳定在指令值且转子振动基本消失我这里就直接用固定延时简单可靠。2.3 高频注入方案为什么没在这版里用高频注入法的原理是向定子绕组注入一个远高于基波频率的高频电压信号通过检测定子电感随转子位置的变化来估算位置。这个方案最大的优点是低速甚至零速下都能检测还能做到零速闭环。但问题也很明显它更适用于内嵌式 PMSM靠凸极效应产生高频响应表贴式电机的凸极率低效果会差一些而且高频注入会增加额外噪声和损耗算法复杂度也高很多。我的电机是表贴式的而且应用场景允许启动时有短暂的自对齐过程不需要零速大转矩输出所以这版直接放弃高频注入。如果你做的是伺服或者机器人关节电机要求零速就能输出大转矩那预定位法就不够用了还是得把高频注入或者脉冲振动法啃下来。这个选择没有绝对好坏完全看应用场景。3. I/f强拉启动与无感切换的完整流程3.1 启动状态机设计预定位完成之后转子在电角度 0 度附近接下来不能直接切到无感闭环因为此时反电动势太小观测器算出来的角度噪声很大根本没法用。我采用的是 I/f 强拉启动策略本质上就是把电机当步进电机拖起来开环给定一个随时间匀速增大的电角度同时给定一个固定的电流幅值让转子在电磁转矩作用下跟着这个旋转磁场走。整个启动状态机分成四步预定位、电流建立、斜坡强拉、观测器切换。电流建立阶段一般给 50ms让电流从 0 平滑上升到强拉电流避免电流突变引起过流斜坡强拉阶段电角度以固定的角加速度增加比如设定从 0 加速到 800rpm加速时间 600ms加速度就是 800rpm 除以 0.6s强拉电流我设置的是 1.5A比预定位电流高一点确保有足够的加速转矩。斜坡强拉阶段最需要注意的是给定的角度更新必须平滑连续每进入一次 1kHz 定时器中断角度增量是一个固定值。我见过有些新手直接在 FOC 里给角度阶跃结果电流环还没来得及建立磁场角度已经跳走了电机就在那里原地抖动。正确的做法是让角度像匀速旋转的圆盘一样每个控制周期只增加一个很小的角度步长这样转子受到的电磁力也是平滑变化的。3.2 切换时刻的平滑处理与判定条件I/f 强拉阶段和真正闭环之间最大的问题在于负载角。开环强拉时定子电流矢量和转子磁极之间是有一定夹角的这个夹角就是负载角它随着负载大小的变化而变化。如果你在某个时刻直接把给定角度替换成观测器估算的角度一个很小的角度跳变都会引起电流振荡。我的处理方法是在切换前做角度补偿。具体操作是这样的强拉阶段让观测器一直在后台运行但不参与控制。等到速度达到设定值附近并且反电动势幅值超过阈值后记录当前开环给定角度 theta_open 和观测器估算角度 theta_smo 的差值 delta_theta。这个 delta_theta 就近似等于当时的负载角。切换的时候不直接跳变到 theta_smo而是用 theta_smo 减去 delta_theta 作为过渡角度也就是说让控制角度先“贴合”观测角度再逐步把负载角补偿量减到零整个过程速度环和电流环始终不断流。切换条件我设了两个第一个是速度阈值比如达到 600rpm 以上这个速度下反电动势已经足够大第二个是反电动势幅值阈值我通过观测器输出的 e_alpha、e_beta 计算幅值超过 0.5V 才允许切换。两个条件同时满足后还要再稳定运行 100ms 再执行切换防止是某个瞬时噪声误触发。这个稳定延时非常关键我在调试中就因为少了它在切换瞬间出现过电流尖峰。3.3 如何判断观测器是否真正收敛还有一个很容易被忽略的点观测器在后台运行时你怎么知道它收敛了光看估算角度是不是稳定还不够因为低速下滤波后的角度变化本来就很慢。我习惯用两个指标一起判断一个是刚才说的反电动势幅值另一个是电流观测误差也就是 SMO 里电流估算值和实际采样值的差。当电流观测误差持续小于某个阈值比如连续 500 个控制周期都小于 50mA我就认为观测器已经稳定收敛。调试的时候可以把这个收敛标志通过串口或者 DAC 输出出来配合示波器观察。我当时的做法是把收敛标志映射到开发板上一个 GPIO然后在示波器上同时看波形和这个引脚的电平非常直观。4. 反电动势滑模观测器与PLL角度提取4.1 简化模型和SMO计算公式如果不考虑凸极效应表贴式 PMSM 在静止两相坐标系下的电压方程可以写成V_alpha Rs * i_alpha Ls * di_alpha/dt e_alphaV_beta Rs * i_beta Ls * di_beta/dt e_beta这里的 e_alpha、e_beta 就是反电动势它们里面包含了转子角度和速度信息。我的 SMO 就是基于这个方程构造电流观测器把反电动势项当作扰动然后用滑模项去“逼”电流估算误差为零这时候滑模项的输出就等效于反电动势。核心代码逻辑可以写成// 电流误差 err_alpha i_alpha_est - i_alpha; err_beta i_beta_est - i_beta; // 滑模律用饱和函数替代纯符号函数抑制抖动 smo_out_alpha -K_SMO * sat(err_alpha, BOUND); smo_out_beta -K_SMO * sat(err_beta, BOUND); // 电流状态更新 i_alpha_est Ts / Ls * (v_alpha - Rs * i_alpha_est smo_out_alpha); i_beta_est Ts / Ls * (v_beta - Rs * i_beta_est smo_out_beta);这里的 K_SMO 是滑模增益太大会导致高频抖动太小则无法收敛。我在实际调试中一般取反电动势幅值估算值的 1.2 到 2 倍同时用饱和函数而不是理想符号函数饱和边界根据电流噪声水平来定。饱和函数的好处是能够显著降低滑模带来的“抖振”因为理想滑动模态在离散系统里本质上是高频切换直接对后续 PLL 和速度计算造成很大的噪声干扰。需要特别提醒的是SMO 对电流采样噪声很敏感。我第一次在硬件上跑的时候电流采样毛刺比较大SMO 输出在低速段基本是糊的后来我把采样时序和硬件滤波调好之后波形立刻干净了很多。这再次说明算法再好前端采样烂也一样白搭。4.2 PLL的作用及带宽设定SMO 输出的是反电动势的两个正交分量理论上可以直接用反正切函数求角度。但反正切对噪声非常敏感尤其是 e_alpha、e_beta 接近零的时候一个微小的扰动就能让角度发生大跳变。我改用锁相环 PLL 来提取角度和速度。PLL 的工作方式是这样的估算角度 theta_hat 和真实角度越接近下面这个误差量就越接近零eps_theta -e_alpha * cos(theta_hat) - e_beta * sin(theta_hat)推导一下如果 e_alpha -E * sin(theta)e_beta E * cos(theta)代入上式可以得到 eps_theta ≈ E * sin(theta - theta_hat)所以这个误差量经过 PI 调节器后输出就是电角速度估算值再积分一次得到估算角度。因为 PLL 本身自带积分和滤波特性估算出来的角度和速度都平滑很多。PLL 的带宽设置是重点。带宽太低角度跟随滞后高速时会产生明显的相位延迟带宽太高PLL 输出的速度噪声大。我一开始 PLL 带宽设得太高导致速度环在高速运行时明显抖动后来把带宽压到大约 200Hz动态响应和噪声之间取得了一个平衡。当然如果你的应用要求高速动态响应特别猛可以适当把带宽放宽但前提是速度环 PI 参数已经调得比较软。4.3 滤波和相位延迟补偿经验SMO 输出里叠加了很多 PWM 开关频率附近的噪声所以通常会加一级低通滤波器。但低通滤波器会引入相位延迟尤其在高转速段反电动势频率升高延迟对应的角度延迟也在增加。如果不做补偿观测器估算的角度就会滞后真实角度导致电流环的 dq 轴解耦不彻底效率下降、发热增加。补偿的思路很简单在已知滤波截止频率 fc 和当前电角速度 omega_e 的情况下计算滤波器带来的相位滞后 arctan(omega_e / (2pifc))然后把 PLL 输出的估算角度加上这个滞后量。实际操作中还可以用陷波器把开关频率附近的噪声滤掉同时对基波相位影响更小我在第二版里就是把一阶低通换成了陷波器加上小幅相位补偿效果更好。这里的经验是滤波一定要分别看低频和高频两种噪声。低频噪声主要来自电流采样偏置和 PWM 非理想因素高频噪声主要来自开关动作。不要把所有问题都丢给一个滤波器分频段处理会清晰很多。5. 电流环与速度环参数整定实践5.1 电流环PI参数的工程估算很多教程喜欢直接给一段调参代码但我觉得最好还是理解公式的来源。以表贴式电机为例电流环的被控对象可以简化成一阶惯性环节传递函数是 1/(LsR_s)。把 PI 控制器的零点设计成和电机极点对消也就是令 Ki/Kp R_s/Ls这时系统闭环传递函数就近似成一个一阶低通特性带宽由 Kp/Ls 决定。我手头这台电机的参数大约是 Ls0.8mH、R_s0.4Ω。如果目标电流环带宽 BW1000rad/s约 160Hz那么 Kp Ls * BW 0.8 * 1000 800Ki R_s * BW 0.4 * 1000 400。这里的数值是在标幺化之前的连续域计算值实际用到代码里还要根据电流采样满量程和 PWM 占空比做归一化。我在工程上的做法是先按这个公式算出初始值然后接上直流母线用电流阶跃测试观察响应再微调 Kp 和 Ki。电流环调好的标准是什么我会给一个 1A 的阶跃指令观察电流波形的上升时间和超调量。上升时间大约是带宽的 0.35 倍也就是说 1000rad/s 带宽对应约 0.35ms 的上升时间实际调试如果明显慢于这个值说明增益偏小。如果电流波形高频振荡或者声音发尖说明增益偏大或采样噪声被放大了。5.2 速度环参数整定顺序速度环的整定必须在电流环已经稳定的前提下进行。我见过最典型的错误就是电流环毛糙、速度环再给很高的增益结果两级一叠加整个系统疯狂震荡。速度环带宽一般取电流环的十分之一到二十分之一我这里速度环控制在 1kHz所以速度环带宽大概在 50 到 100Hz 之间。速度环调试时我习惯用转速阶跃测试。比如把目标转速从 800rpm 突然加到 1200rpm观察实际转速的响应。速度环增益太大转速会出现连续过冲和振荡甚至电流限幅值长时间饱和增益太小转速响应慢带载变速时掉速明显。一个偏向保守的起始值是 Kp 取较小值Ki 可以稍微大一点先把稳态误差消掉再逐步加 Kp 提高动态响应。还有一个技巧速度环的积分项输出要加上限幅而且这个限幅值必须综合考虑电流环 q 轴电流指令的允许范围。不然积分饱和之后转速会有很大的超调等减速的时候又会因为积分器的“记忆效应”而出现反向过冲。这个在小惯量电机上尤其明显。5.3 用电流波形判断问题的调试技巧FOC 调试最重要的工具是示波器但我说的不只是看母线电流或者相电流波形更重要的是看 dq 坐标系下的 i_d 和 i_q 波形。具体做法是把软件里的 id_fbk、iq_fbk 通过 DAC 引脚输出或者以 SPI/DMA 方式用逻辑分析仪抓。因为 id 和 iq 是旋转变换后的值直接反映了控制质量。正常情况下id 应该稳定在零附近iq 跟随负载转矩变化。如果 id 出现明显的低频振荡说明观测器的角度和真实角度之间存在周期性偏差如果 id 在某个固定转速下出现尖峰往往是采样时机或者死区补偿问题如果 id 和 iq 都有叠加的高频毛刺优先怀疑电流采样噪声或者 PWM 死区时间设置过大。还有一个我在调试中反复踩的坑电流采样点必须放在 PWM 中心点也就是计数器为零的时刻。因为这个时候三相下桥臂的导通状态最稳定对角线采样电阻上的电流能真实反映相电流。如果你的采样点落在开关边沿附近采到的电流会叠加一个巨大的尖峰经过 PI 后不仅波形难看还会变成电机转矩上的高频抖动电机噪音非常明显。6. 驱动电路设计与采样布局要点6.1 栅极驱动和自举电容的选择驱动部分我用的是半桥驱动芯片 IR2101上管需要自举供电。自举电容选小了上管导通后期栅极电压跌落MOS 管会从完全导通进入线性区导致发热快速上升选大了也有问题会拖慢自举恢复速度高占空比下可能无法正常工作。自举电容的粗略计算方法是C Q_gate / delta_V。比如我用的 MOS 管栅极电荷 Q_gate20nC允许自举电压跌落 0.5V那么 C40nF。实际我选了 100nF 的 X7R 陶瓷电容同时并联一个 10μF 电解电容在母线附近作为补充。因为我 PWM 频率 20kHz一个开关周期才 50μs自举电容的充电时间足够需要的是在死区时间内快速充电的能力。这里还要求最小死区时间不能太短否则自举电容来不及补充电荷上管驱动电压会越来越低。我死区时间设的是 0.5μs实测没问题。6.2 三电阻采样和ADC采样时机电流采样我用三电阻低端采样方案三个采样电阻分别串联在三个下桥臂 MOS 管的源极和地之间经过差分运放放大后送入 STM32 的 ADC。三电阻方案的好处是在任意 PWM 状态下都能重构三相电流算法相对简单适合 20kHz 的 PWM。关键是要把握好采样窗口。中心对齐 PWM 下我选择在计数器值等于 0 的时刻触发 ADC 注入组采样因为这个时候 PWM 波形处于零矢量状态三个下桥臂的导通组合是确定的采样电阻上的电流能够代表相电流。如果 PWM 调制比某个时间点太低采样窗口可能被压缩软件里要做最小采样窗口检测不满足条件时用上一周期的电流值代替。三电阻方案在低压大电流场景下还要注意采样电阻的功率20mΩ 电阻在大电流时发热明显功率选型不能只看阻值精度。6.3 PCB布局上的几个细节采样电路部分的 PCB 布局直接影响无感FOC 的调试难度。功率地和信号地要单点连接采样电阻的走线必须采用开尔文接法也就是把采样电阻两端直接引到运放输入不要让大电流走线经过信号地路径。驱动信号的走线尽量短而粗栅极电阻靠近 MOS 管放置。母线电容的位置也有讲究。电解电容和陶瓷电容要尽量靠近桥臂的电源端和地端形成一个低阻抗的电流回路。我在调试早期遇到过一个问题电机带载时母线电压有明显振铃后来分析是母线电容放置太远杂散电感太大导致 MOSFET 关断瞬间产生了很高的尖峰电压。把电容挪到桥臂旁边之后这个现象基本消失了。还有一点ADC 输入端的 RC 滤波是必须的但不能过大。RC 太大会把采样点的高频信号过滤得过多反而让采样保持电容充电不充分。我用的参数是 100Ω 电阻串联加 1nF 电容到地截止频率约 1.6MHz既能滤掉开关噪声又不会影响采样精度。在软件上我没有再做滑动平均因为滑动平均放在 20kHz 的电流环里相当于给电流信号加了一级低通滤波会引入延迟降低电流环动态性能。7. 常见问题排查与独家避坑技巧7.1 典型问题排查速查表这里把我在整个无感FOC调试过程中遇到的高频问题整理成一个速查表方便后续调试的时候按图索骥。现象可能原因排查方向与解决方法上电预定位时电机不转预定位电流太小、角度方向不对加大电流确认电角度零点与三相相序对应启动瞬间过流保护预定位时间不足、电流建立过快、角度阶跃延长预定位时间给电流指令加斜坡启动反转或卡顿开关相序错误、预定位角度不对调换两相相序或翻转方向标志低速时电流波形毛糙采样点偏离PWM中心、ADC滤波不当调整ADC触发时机检查RC参数高速时id振荡PLL带宽过高或过低、滤波相位补偿不足降低PLL带宽加入相位补偿速度环超调大积分饱和、Ki太大速度环输出限幅减小Ki电机噪音尖锐电流谐波大、死区时间不匹配检查死区设置检查电流采样波形高速提不起速度反电动势观测器相位落后、母线电压不足补偿相位延迟检查母线电压和调制比7.2 几个实际排查案例第一个案例是启动即反转。我第一次切换相序的时候预定位电机稳定但一进入 I/f 强拉阶段就反转。检查了很久发现问题不在什么高级算法就是最简单的相序错误——我 A 相接了电机引线的 C 相导致旋转磁场方向反了。这种问题一个很笨但很快的排查方法是用手转动电机轴同时通过上位机观察反电动势或者霍尔信号的角度变化方向。带传感器阶段就把方向全部确认好无感阶段就不会再被这种低级问题干扰。第二个案例是电机转起来之后id 存在明显的 2 倍频振荡。我开始以为是观测器角度有问题后来用示波器同时抓三相电流波形发现其中一相的采样波形有明显畸变仔细检查是那个采样电阻的焊盘虚焊导致接触电阻变大。重新补焊之后振荡立刻消失。所以遇到 id 振荡优先检查硬件采样通路这个顺序不能变。第三个案例是高速段掉扭矩。一开始的方案是在 SMO 后面加了一阶低通滤波转速超过 2000rpm 后角度延迟越来越大导致电流矢量方向没有对准 q 轴。最后我把低通滤波改成陷波器同时加入按速度查表的相位补偿角度高速段扭矩明显恢复。这类问题在纯软件层面不好定位必须在示波器上对比实际电流矢量和估算角度的关系。7.3 调试工具和日志技巧无感FOC 调试过程中最痛苦的就是看不到内部变量。我的做法是充分利用 STM32 的 DAC 模块把两个最关键的量映射成模拟电压输出一个通道输出速度估算值一个通道输出角度误差或者 id 值。这样可以直接用示波器实时观察内部状态变化比每次串口打印快得多。另外建议在代码里维护一个环形缓冲区记录触发故障前几十毫秒的 id、iq、估算速度、观测器输出等关键变量。当发生过流或失步时把这段历史通过串口导出就能定位到故障发生的具体阶段和控制量变化过程。这个“黑匣子”功能在调试阶段价值巨大我基本每次改完参数都会开着偶尔在 24 小时连续运行测试后就靠它抓出一次偶发失步。最后再分享一个小技巧测试时不要一上来就调大电流、高转速。先给很小的电流跑低速确认角度估算方向和电流环方向一致再逐步加大电流和速度。方向性错误在这种系统里最隐蔽也最容易烧器件。我见过不止一次有人把 sudo 级别的参数乱调一把结果电流环正反馈瞬间过流烧了驱动。先低速、小电流、验证方向再迭代到目标工况这是无感FOC 调试里最稳的路径。到目前为止这台样机已经能在额定负载下完成从零速到额定转速的平滑启动和运行低速段的电流波形也比 V1.x 干净了很多。我个人在项目里体会最深的是FOC 算法从文档到工程交付中间隔着的不是某一两个公式而是采样时序、滤波器选择、电路布局这些看似不起眼的细节。后续这版代码还可以往两个方向继续完善一是把凸极电机的初始位置检测用高频注入补上覆盖零速带载启动的工况二是把速度环输出加一个二阶低通或者陷波器进一步压低机械振动。这些就留到下一版草稿再折腾了。