STM32F103低成本无感FOC实战：SMO滑模观测器原理与调试全记录

做无感FOC这件事我一开始是撞了墙的。手边没有专用电机控制芯片也没有带浮点的G4/F4开发板只有几片吃灰的STM32F103RCT6最小系统板外加一个拆机云台电机。照着网上的无感方波程序随便改一版转起来倒也能转可一旦要求低速不抖、噪音小、堵转不烧驱动器无感方波那套就完全不是那么回事了。所以我换了一条路基于STM32F103跑FOC矢量控制用SMO滑模观测器来估算转子位置和速度把霍尔和编码器彻底去掉。这条路成本很低资料又多可玩性很强唯一的门槛是得把原理和调试思路吃透。从选型、焊板、写代码到现场调试我把整个过程完整复盘了一遍这篇文章就当作一次踩坑记录给同样手里只有F103、想低成本玩转无感FOC的朋友做个参考。1. 方案选型低成本无感FOC为什么选F103SMO1.1 先看清市面上有几条“无感”路线做无感电机驱动摆在面前的无非是下面几条路。我一开始没想清楚直接抄代码浪费了不少时间把路线梳理清楚比选哪颗芯片更重要。路线成本开发难度适用场景专用单芯片方案InstaSPIN、电机专用SoC高低有自动辨识和算法库量产产品、对开发周期要求极短通用F4/G4系列MCU跑FOC中高中硬件浮点/FPU加持高性能驱动、伺服级应用通用MCU做无感方波最低低代码简单航模、风扇等对噪音/低速要求不高的场合F103低成本MCU跑FOCSMO低高原理要自己啃学习、自制驱动器、中小功率设备我当时选择F103理由非常现实第一芯片手里就有成本几乎为零第二STM32F103自带高级定时器TIM1/TIM8可以输出带死区的互补PWM硬件结构天生适合三相全桥驱动第三资料太多太多哪怕卡住了也容易找到参考。72MHz主频跑FOC完全够用只要不是每次中断里print字符串CPU占用能控制在40%以内。顺便说一句很多人觉得F103没有FPU就跑不动FOC这是个误会。FOC核心计算无非是几个坐标变换、两个PI环和一个SVPWM一个控制周期内的浮点运算大约几十次16kHz中断下F103完全能跑只是要注意开启编译器O2优化、避免在控制中断里用重型库函数。1.2 SMO滑模观测器到底赢在哪里无感FOC里观测器方案有好几种直接反电动势法、滑模观测器SMO、扩展卡尔曼滤波EKF、模型参考自适应MRAS、高频注入法等。选SMO不是因为它是性能最好的而是因为它最适合“低成本参数不确定”的场合。直接反电动势法最简单但它依赖转速和负载条件对电机参数变化太敏感EKF精度高但计算量非常大F103跑EKF会非常吃力高频注入在零速和低速表现好但需要额外调试注入频率和信号处理代码量和硬件要求都不低。SMO的优势在于鲁棒性。它不需要精确的电机模型只要滑模增益足够大系统就能克服参数误差和扰动“强行”让观测收敛。实际使用中哪怕你的电阻电感测量得并不准SMO也能跑起来这对自制驱动器的调试来说太重要了。当然SMO也有自己的短板它是基于反电动势观测的转速越低反电动势越小信噪比就越差所以零速和极低速时SMO基本失效。这里只能靠其他启动策略兜底比如预定位加I/F强拉启动等转速起来后再切入SMO闭环。2. 原理拆解FOC和SMO是怎么配合的2.1 FOC的“三环”与两次坐标变换FOC的核心思路是把三相交流电机的定子电流分解成两个正交分量一个是产生磁场的励磁分量id一个是产生力矩的转矩分量iq。这样电机控制就从“同时管理三相正弦电流”变成了“分别控制两个直流分量”难度一下子降下来了。两个坐标变换绕不开Clark变换把三相电流变换到αβ静止坐标系iα ia iβ (ia 2·ib) / √3Park变换把αβ系电流旋转到与转子同步的dq坐标系id iα·cosθe iβ·sinθe iq −iα·sinθe iβ·cosθe这里有个非常关键的点dq坐标的旋转角度θe必须和转子位置同步。在有感FOC里这个角度直接来自编码器或霍尔在无感FOC里这个角度就是SMO估算出来的。角度估得准不准直接决定FOC能不能正确解耦和输出力矩。电流环算出vd和vq之后还要做一次反Park变换把dq电压变回αβ电压vα vd·cosθe − vq·sinθe vβ vd·sinθe vq·cosθe拿到vα和vβ之后通过SVPWM算法生成六个MOS管的开关时序。至此FOC的整个控制链就打通了采样电流→Clark→Park→电流PI→反Park→SVPWM→驱动电机。外环还有速度环速度环的输出就是iq的给定值。2.2 SMO滑模观测器是怎么“猜”转子位置的SMO的核心思想是构造一个电流观测器让观测电流强制跟随实际电流这个“强制跟随”的修正量里就包含着反电动势的信息而反电动势的方向正好指向转子位置。先看PMSM在αβ坐标系下的电压方程uα Rs·iα Ls·diα/dt eα uβ Rs·iβ Ls·diβ/dt eβ其中eα和eβ是反电动势eα −ψf·ωe·sinθe eβ ψf·ωe·cosθe从这两个公式能看出来只要把eα和eβ估出来转子位置θe就等于atan2(−eα, eβ)。那怎么估eα和eβ呢构造一个电流观测器让它的结构和电机模型一模一样然后把实际电流和观测电流的误差经过一个符号函数“甩”进去dîα/dt (−Rs·îα − êα uα − k·sign(îα − iα)) / Ls dîβ/dt (−Rs·îβ − êβ uβ − k·sign(îβ − iβ)) / Ls当滑模收敛后观测电流î会贴着实际电流i走此时k·sign(î − i)这个高频开关量经过低通滤波平均值就约等于反电动势。这个开关量的平均值常被叫作“等效控制量”。实际工程里的做法是把计算出来的zα k·sign(îα − iα)和zβ k·sign(îβ − iβ)各过一个低通滤波器得到平滑的eα和eβ然后通过atan2取角度θe atan2(−eα, eβ)2.3 关键参数整定滑模增益k、滤波截止频率、角度补偿SMO看起来简单参数调起来才见真功夫。首先是滑模增益k。k太小观测器无法克服参数偏差和噪声电流误差消不掉系统会“滑”不起来k太大系统高频抖振剧烈轻则发热发烫重则烧管炸机。工程上我一般这样粗估k 1.2 × (反电动势峰值 Rs × 最大相电流)反电动势峰值可以用转速和Ke算也可以直接把k当成一个“旋钮”在保证不抖振的前提下慢慢往下调直到速度波形最干净。其次是低通滤波器的截止频率。SMO输出的等效控制量是高频开关信号需要低通滤掉高频分量才能得到平滑的eα、eβ。低通截止频率太低反电动势相位延迟就大太高滤波效果差。我一般把低通截止频率放在电机电频率的5到10倍左右。最后是角度补偿。低通滤波在物理上就是一个相位延迟延迟量大约为Δθ ≈ atan(ωe / ωc)其中ωe是电角速度ωc是低通截止角频率。实际代码里在atan2之后直接加上这个补偿量即可。补偿不准确的话电流环和速度环都很难看典型表现是力矩不足、跑高速容易失步。3. 硬件搭建用最少的钱搭出能跑的驱动板3.1 一张最小系统板能担多少活儿F103最小系统板核心就是芯片、8MHz晶振、复位电路、BOOT配置和3.3V LDO这些在任意一块普通开发板上都能找到。做FOC最好选RCT6以上型号72KB RAM版本的有RCT6和RBT6跑FOC控制逻辑绰绰有余。要注意的是F103的ADC是12位的范围0到4095对应0到3.3V。电流采样信号通常要经过运放放大到1.65V附近再进ADC也就是说零电流时ADC读数大约是2048正负电流方向在ADC上分别对应偏上和偏下。软件里做电流标定时要把这个1.65V中点减掉再乘上放大系数才能得到真实的电流值。一个容易被忽略的点是如果最小系统板上没有外部基准电压ADC的满量程精度取决于3.3V电源的质量。电流波形好不好和3.3V干不干净有很大关系建议给模拟电源加一级LC滤波。3.2 电流采样三电阻采样和中心对齐电流采样方案从左到右分为三电阻、双电阻、单电阻几种。三电阻采样的精度最高每个PWM周期都能直接得到三相电流只是要求PCB上能放三个采样电阻和三个运放通道。双电阻省一个运放但某些扇区需要靠重构才能拿到第三相电流。单电阻方案最省但采样窗口极短、对时序要求苛刻新手不建议碰。驱动板的常见架构是三个低端MOS管下面各接一个10mΩ到50mΩ的采样电阻电阻两端接运放放大后送ADC。在实际项目里我常选INA240这类电流检测运放噪声低、偏置小省去很多调零麻烦。采样时刻必须和PWM中心对齐。当TIM1工作在中心对齐模式时PWM计数器在中间值和0值两个点电流采样应该在下桥臂全部导通、电流流过采样电阻最稳定的时刻进行也就是PWM周期的最低点。用TIM1的TRGO事件去触发ADC注入组正好能自动对齐这是F103跑FOC的标准做法。3.3 保护电路和Layout经验无感FOC最怕的就是过流。如果电流失控而保护电路反应太慢功率管秒秒钟就报销。STM32F103的TIM1有刹车BKIN功能把过流比较器的输出直接接到BKIN引脚一旦电流超过阈值PWM输出立刻硬件关闭根本不经过软件。这个保护路径必须在测试之前就做好。母线电容不能省一般按每安培电流配100uF左右的电解电容再加上0.1uF和1uF高频陶瓷电容电容尽量靠近MOS管桥臂否则关断瞬间的尖峰电压很容易把管子击穿。自举电容要选低漏电的建议100nF到1uF放在自举引脚附近。Layout上特别提醒三件事第一采样电阻到运放输入端要短走线最好用差分走线避免功率地噪声串进去第二栅极驱动IC尽量靠近MOS管第三强电回路和弱电信号回路分开中间用地线隔离。4. 软件实现从CubeMX到电机转起来4.1 CubeMX配置四大块我用STM32CubeMX生成工程配置要点就四个块时钟外部8MHz晶振倍频到72MHz。ADC时钟建议分频到12MHz左右采样时间调到最大量程保证采样精度。TIM1选择中心对齐模式PWM频率定在16kHz。ARR的计算公式是72MHz能整除2×PWM频率16kHz对应ARR2249。使能CH1、CH2、CH3及互补通道死区时间根据MOS管的栅极电荷量来定一般0.5us到1us。我早期用过大死区结果在轻载时扭矩明显下降后来才知道死区太大了也让电流波形畸变得很厉害。ADC1配置成注入组模式触发源选择TIM1_TRGO。注入组可以一次连续采三路电流采样信号并且可以设置注入序列的长度为3分别为U相、V相、W相采样。中心对齐模式下TRGO正好在PWM周期的最低点发出脉冲采样时刻自动对齐。DMAADC注入组数据用DMA搬运到数组里这样中断里可以直接读最新的三相电流值不需要等待转换完成能省出不少CPU时间。4.2 FOC中断主流程代码控制中断挂在哪里有讲究。我习惯用ADC注入转换完成中断也就是每次PWM周期中点采完样之后立即进入FOC控制计算这样角度更新、电流PI、SVPWM刚好在一个周期内完成延迟最低。中断主流程大致如下void ADC1_2_IRQHandler(void) { if (ADC1-SR ADC_SR_JEOC) { // 1. 读取三相电流采样值进行ADC转电流 ia (adc_u - midpoint) * current_scale; ib (adc_v - midpoint) * current_scale; ic (adc_w - midpoint) * current_scale; // 2. Clark变换 i_alpha ia; i_beta (ia 2.0f * ib) / 1.7320508f; // 3. Park变换theta_hat来自SMO观测器 id i_alpha * cos_theta i_beta * sin_theta; iq -i_alpha * sin_theta i_beta * cos_theta; // 4. 电流环PI输出vd和vq vd pi_id(id_ref, id); vq pi_iq(iq_ref, iq); // 5. 反Park变换 v_alpha vd * cos_theta - vq * sin_theta; v_beta vd * sin_theta vq * cos_theta; // 6. SVPWM计算占空比 svpwm_calc(v_alpha, v_beta); // 7. SMO观测器更新角度和速度 smo_update(v_alpha, v_beta, i_alpha, i_beta); } }代码里cos_theta和sin_theta直接在SMO更新后计算内存中保存正弦余弦值避免反复调libm函数。还能利用F103的查表法逼近三角函数每周期减少几十微秒的计算时间。16kHz中断频率下每个周期的执行时间务必控制在50us以内实际优化后能做到20us左右。4.3 无感启动预定位、I/F强拉、切SMO闭环无感FOC最难受的就是启动因为SMO在零速时反电动势为零根本估算不出角度。我用的启动流程是三段式预定位、I/F强拉、闭环切换。预定位上电后给一个固定的电流矢量比如强制θ0q轴电流给额定值持续0.3到1秒。转子会逐渐被拉到这个位置停住。这一步是把电机的初始电角度“归零”如果转子负载很重预定位时间要加长否则转起来之后角度基准就偏了。I/F强拉预定位完成后让θ按一个固定的角速度斜坡增加同时保持iq为恒定值此时定子电流矢量相当于同步旋转转子会被拖着一起转。因为还没有真实角度反馈这个阶段本质上是“电流源角度开环”力矩波动是难免的。加速度要控制在电机能跟上的范围内工程经验是每秒钟增加5%到10%额定电频率等转速超过额定转速的5%以上再进行下一步。闭环切换当转速达到阈值后SMO输出的估算角度会逐渐和真实角度收敛。切换条件是估算速度连续一段时间大于设定阈值且估算角度与I/F给定角度的偏差在正负10度以内。切换时需要把q轴给定平滑过度也就是把I/F的电流源模式平稳切到速度环闭环模式同时限幅防突变。我第一次切换的时候切换瞬间电机会“咔”一声抖一下。后来总结原因是切换前iq和切换后速度环输出的iq不连续导致力矩跳变。解决办法是切换前手动将速度环的输出强制等于当前I/F的iq再释放给速度环调节这样切换时力矩就是连续的。5. 调试实战现场踩过的坑和排查手册5.1 先开环验证不要一上来就无感闭环许多刚接触FOC的朋友上来就把SMO打开结果电机一顿狂震无从下手。更稳妥的做法是先做开环验证分两步走第一步是PWM验证。用示波器看TIM1六路PWM输出确认死区、频率、互补关系都正常。如果芯片输出的波形都对再去看驱动板栅极波形确认MOS管没有直通、没有振铃。第二步是开环电流验证。把SMO完全关掉手动给一个固定的θ和固定的iq/id比如θ固定0度iq给0.1A看看电流采样值是否正常、电流是否真的在这相上流。如果相位不对就调整相序直到开环电流可控。等开环状态下的电流波形干净、采样值稳定再开始做SMO闭环。这条路径能省下大量排查时间。5.2 “土法”辨识电机参数Rs、Ls、KeSMO需要用到定子电阻Rs和电感Ls这两个值测量得准不准直接影响滑模增益和低通的反馈效果。没有LCR电桥和测功机也能土法测量精度足够这个应用。Rs很好测电机静止时用万用表量任意两相线电阻除以2就是单相电阻。要更精确恒定电流下测压降再除以电流也行。Ls测量的办法是L/R阶跃法把直流电源经过一个已知电阻接到两相之间用示波器记录电流上升曲线从10%上升到90%的时间常数τ再根据τL/R算出电感。注意测量时转子不要转动最好把转子固定住。Ke的测量更简单拿示波器探头接任意两相线端手摇或者用一个已知转速的电机拖动测线反电动势峰值结合转速换算到电频率下的Ke。大多无刷电机铭牌上也能查到到一些参数如果没有铭牌直接按三相绕组标称电压的10%作为额定反电动势来估算也够用。5.3 常见问题速查表调试半年多我把踩过的坑整理成了下面这张速查表遇到问题直接对着排查思路会更顺。现象可能原因排查方向上电后PWM输出为0使能信号没拉高或BKIN误触发查TIM1刹车状态、GPIO使能引脚电机不转有嗡嗡声死区过大、PWM占空比计算反了、逆变桥缺相示波器看MOS栅极波形和三相占空比电机原地剧烈振动估算角度和真实角度偏差太大检查相序、Park变换符号、滑模是否收敛电流波形毛刺严重采样时刻没对准中心点、运放噪声检查采样时刻对齐、电源滤波、采样电阻走线低速启动时抖得厉害SMO在低速失效或I/F切换过早延后闭环切换点增大I/F阶段力矩高速运行时突然失去同步低通滤波相位补偿不够、速度环超调增大角度补偿量、优化速度环PI参数突然过流跳闸k值过大导致抖振、电流环饱和减小滑模增益检查母线电容和自举电容其中最容易踩回的坑是Park变换符号反了。一旦符号反了id和iq全反电流环会形成正反馈电机通电瞬间就可能过流。如果你发现电机在低速时越转越猛首先要怀疑的就是这个符号问题。还有一点角度估算出来后要顺手做归一化把角度限制在0到2π范围内否则长时间运行后浮点误差积累角度会漂移导致SMO在运行一段时间后突然崩掉。调试时顺手把估算角度、给定角度、iq、观测器反电动势等变量通过DAC引脚实时输出用示波器看波形远比查看串口日志直观。我在板子上预留了2路DAC调FOC时几乎每天都靠它吃饭。你先尝试开环和SMO分别转起来再逐步逼近你要的性能这个项目才算真正落地。