全速域无感FOC实战：HFI+SMO权重切换的IPM电机控制方案

1. 项目缘起与整体设计思路1.1 为什么要在全速域做无感FOC永磁同步电机PMSM的矢量控制绕不开转子位置这个核心变量。有传感器方案靠编码器或旋转变压器直接读角度精度高、响应快但成本、接线、可靠性都是问题——尤其是压缩机、风机、水泵这类长期运行、环境恶劣的场合传感器反而是整条链路上最脆弱的一环。无感控制Sensorless Control就是要把这个物理传感器拿掉用算法从电机的电压、电流里把转子位置“算”出来。这件事在高速段相对好办反电动势足够大滑模观测器SMO或者龙伯格观测器都能稳定收敛。麻烦的是低速和零速反电动势和转速成正比转速一低反电动势小到淹没在噪声里观测器直接失效。而很多应用偏偏要求低速大扭矩比如电梯的零速抱闸、压缩机的低频启动、电动工具的堵转启动。所以一个能覆盖“零速—低速—中高速”全速域的无感方案才是真正能落地的方案。这个项目标题里的“全速域”三个字分量就在这里。它不是单纯把SMO调好就完事而是要在低速段用高频注入HFI把转子初始位置和低速角度辨识出来在中高速段切换到SMO中间还要用权重切换做平滑过渡避免切换瞬间的转矩冲击。整套东西跑在TI的F283xC2000系列DSP上配合IPM功率模块和FOC算法最终交付一个V1.0版本的工程。1.2 三种观测手段的分工逻辑我把这套方案的核心思路概括成一句话低速靠注入高速靠反电动势中间靠权重过渡。下面拆开说。高频注入法的原理是往定子绕组里注入一个高频电压或电流信号利用PMSM的凸极效应Ld ≠ Lq——转子在不同位置时高频信号对应的电流响应幅值不同从响应里解调出转子位置。它的优点是零速和低速都能工作不依赖反电动势缺点是注入会带来额外损耗和噪声而且对凸极率有要求表贴式电机SPMLd≈Lq效果会差很多。这个项目用的是IPM内置式永磁同步电机凸极率天然满足所以HFI能发挥出应有的效果。滑模观测器则是基于反电动势模型用电流观测误差构造滑模面通过等效控制量反推反电动势再从中提取角度。它的优点是中高速精度高、动态响应快、对参数摄动鲁棒缺点是低速信噪比差抖振问题需要处理。权重切换就是解决两者“交接班”的问题。如果直接硬切换角度会有跳变转矩会抖一下严重时甚至失步。权重切换的思路是在过渡区间内让HFI估计的角度和SMO估计的角度按一个随转速变化的权重系数加权融合转速越低HFI权重越大转速越高SMO权重越大平滑地把控制权交出去。1.3 方案选型的几个关键取舍为什么选F283xC2000而不是STM32热词里“stm32 foc 代码”出现频率很高STM32做FOC确实成熟生态好、资料多。但高频注入对运算实时性要求高——注入频率通常在1~2kHz解调需要做带通滤波、锁相环PLL加上SMO的滑模运算、电流环、速度环整个控制周期要压到几十微秒。F283xC2000系列有专门的CLA协处理器、浮点单元和高速ADC能把控制链路拆开并行跑这是它在这类高性能场合的优势。当然STM32G4/H7也能做只是资源调度上要更抠一些。为什么用IPM而不是SPM前面说了HFI依赖凸极效应。IPM的Lq/Ld比值通常在1.5~3之间注入响应明显SPM的凸极率接近1HFI基本没法用只能靠其他方法比如INFORM、旋转高频注入的变种勉强做效果和鲁棒性都差一截。所以标题里明确写IPM是有意为之。为什么是V1.0这个版本号说明它是一个可运行、可复现的基线版本不是实验室里跑通一次就完事的demo。V1.0意味着参数标定、保护逻辑、状态机都到位了能拿去做台架测试和初步现场验证。后续V1.1、V1.2大概率会优化切换平滑度、加入参数自辨识、提升低速带载能力。2. 核心细节解析与实操要点2.1 高频注入的参数怎么定HFI的参数选择直接决定低速性能我把它拆成四个关键量注入频率、注入幅值、解调滤波带宽、PLL带宽。注入频率一般取PWM频率的1/4到1/2。假设PWM是10kHz注入频率可以选1~2kHz。选太低会和基波、电流环带宽打架选太高则一个PWM周期内采样点不够解调精度下降。我实测下来注入频率取PWM频率的1/5左右比较稳比如10kHz PWM配2kHz注入。注入幅值要兼顾信噪比和额外损耗。太小了解调不出来太大了电机发热、噪声明显。经验值是额定电压的5%~15%具体要看凸极率和电流采样精度。如果电流采样分辨率是12位、量程±20A那注入产生的电流响应至少要大于几个LSB才能可靠解调反推回去就能估出最小注入幅值。解调滤波带宽要能滤掉基波和PWM开关频率只留下注入频率附近的响应。通常用一个带通滤波器中心频率等于注入频率带宽取注入频率的10%~20%。带宽太窄动态响应慢太宽噪声进来。PLL带宽决定角度跟踪的快慢。低速时角度变化慢PLL带宽可以低一些比如20~50Hz抑制噪声但太低会导致负载突变时角度跟不上。这个参数需要在台架上反复调。注意HFI注入会带来可听噪声如果应用对噪声敏感比如室内风机需要评估是否接受或者改用随机注入、方波注入等降噪变种。2.2 滑模观测器的抖振抑制SMO的经典形式是用符号函数sign(s)作为切换项但符号函数在滑模面附近会高频切换产生抖振反映到角度上就是纹波。抑制抖振有几种常用手段边界层法用饱和函数sat(s/φ)代替sign(s)在边界层内线性化抖振明显减小但会引入稳态误差φ越大误差越大。连续函数法用sigmoid、tanh等连续函数替代效果介于sign和sat之间。高阶滑模用超螺旋Super-Twisting算法把切换项放到积分里理论上能消除抖振但实现复杂一些。这个项目里我倾向于用饱和函数加自适应边界层边界层宽度随转速调整——低速时宽一点压抖振高速时窄一点保精度。反电动势估计出来之后用反正切或者PLL提取角度PLL比反正切更抗噪推荐用PLL。2.3 权重切换的过渡区间设计权重切换的核心是设计一个权重函数w(ω)满足ω低于切换下限时w1全HFIω高于切换上限时w0全SMO中间线性或S形过渡。最终角度θ w · θ_HFI (1-w) · θ_SMO这里有个坑两个观测器输出的角度是各自独立的直接加权平均在角度跨越±π边界时会出问题。所以加权前要先把两个角度统一到同一个参考系或者用角度误差的加权而不是角度本身的加权。更稳妥的做法是以SMO角度为基准计算HFI角度与它的偏差对偏差做加权修正再叠加到基准上。这样避免角度跳变。过渡区间的宽度也有讲究。太窄切换太急转矩冲击大太宽两个观测器都不准的区间被拉长整体精度下降。我一般把过渡区间设在额定转速的10%~30%之间具体看两个观测器各自的有效范围。2.4 电流采样与PWM同步FOC的根基是准确的电流采样。F283xC2000的ADC要和PWM同步通常在PWM周期的中点触发采样这时候开关噪声最小。如果是单电阻采样还要考虑最小采样窗口注入高频信号时可能会干扰采样时序需要仔细安排注入和采样的相位关系。实操心得调试初期先用示波器看PWM波形和ADC触发信号确认采样点落在电流纹波的中点。这个基础没打好后面所有算法都是空中楼阁。3. 实操过程与核心环节实现3.1 硬件平台搭建与基础配置硬件这边主控用F283xC2000功率级是IPM模块电流采样用霍尔或分流电阻母线电压采样分压后进ADC。上电顺序、驱动使能、故障保护这些底层逻辑要先跑通再谈算法。基础配置包括系统时钟、PWM模块载波频率、死区、互补输出、ADC触发源、采样窗口、通道映射、GPIO驱动使能、故障输入、中断PWM中断作为控制周期基准。这些配置在TI的SysConfig或者直接寄存器操作里完成建议用SysConfig生成初始化代码减少手写寄存器的出错概率。PWM频率我一般选10kHz或20kHz。10kHz开关损耗小但电流纹波大、控制带宽受限20kHz纹波小、噪声好但开关损耗和DSP负载上升。工业场合10kHz够用对噪声敏感的场合上20kHz。3.2 电流环与速度环的整定电流环是内环带宽通常设到1~2kHz。整定方法是先辨识电机电感电阻用零极点对消法算出PI参数再在台架上微调。电流环带宽不能超过PWM频率的1/10否则采样和延迟会导致振荡。速度环是外环带宽一般是电流环的1/5到1/10比如100~200Hz。速度环的输出是q轴电流指令。整定时先给一个小的阶跃看响应有没有超调、振荡逐步加大增益直到临界再回退到70%左右。注意无感控制下速度环的反馈是估计转速估计转速本身有噪声和延迟所以速度环带宽要比有传感器方案低一些否则会把估计噪声放大成转矩抖动。3.3 高频注入的代码实现HFI的实现分几步注入信号生成、电流响应采样、带通滤波、解调、PLL角度提取。注入信号一般用正弦电压加在d轴或q轴上。代码里用一个查表或者实时计算的正弦值乘以注入幅值叠加到电压指令上。注入频率和PWM周期要同步避免拍频。电流响应采样后先做带通滤波提取注入频率分量再和注入信号做外差解调乘以同频正弦和余弦得到包含位置误差的低频分量经过低通滤波后送PLL。PLL的输出就是估计角度和转速。// 简化的HFI解调伪代码 float inject_sin sinf(2 * PI * f_inj * t); float inject_cos cosf(2 * PI * f_inj * t); float i_alpha_bp bandpass(i_alpha); // 带通滤波 float i_beta_bp bandpass(i_beta); float err i_alpha_bp * inject_cos - i_beta_bp * inject_sin; // 外差解调 float err_lpf lowpass(err); // 低通滤波 pll_update(pll, err_lpf); // PLL更新角度这段代码的关键在滤波器的设计和PLL参数。带通滤波器的Q值、低通滤波器的截止频率、PLL的PI参数都要根据注入频率和转速范围来定。3.4 滑模观测器的代码实现SMO的实现相对直接用电流观测方程算出电流估计值和实际电流比较得到误差误差经过滑模切换函数得到反电动势估计再提取角度。// 简化的SMO伪代码 i_alpha_est (v_alpha - R * i_alpha_est - e_alpha_est) / L * Ts; i_beta_est (v_beta - R * i_beta_est - e_beta_est) / L * Ts; float s_alpha i_alpha_est - i_alpha; float s_beta i_beta_est - i_beta; e_alpha_est sat(s_alpha / phi) * K_slide; e_beta_est sat(s_beta / phi) * K_slide; float theta_smo atan2f(-e_alpha_est, e_beta_est);这里的K_slide是滑模增益要大于反电动势的最大幅值才能保证到达条件。phi是边界层宽度。Ts是控制周期。实际工程里还要加PLL平滑角度直接用atan2噪声大。3.5 权重切换的代码实现权重切换模块接收HFI角度、SMO角度和估计转速输出融合后的角度。float w weight_function(omega_est); // 权重计算 float theta_err angle_diff(theta_hfi, theta_smo); // 角度偏差处理±π float theta_fused theta_smo w * theta_err; // 以SMO为基准加权修正weight_function可以设计成线性、S形或者分段。线性最简单S形过渡更平滑。angle_diff要处理角度环绕避免±π跳变。实操心得切换区间内要密切观察q轴电流和转速波形。如果切换瞬间q轴电流有明显尖峰说明权重过渡太快或者两个观测器角度偏差太大需要放慢过渡或者先校准两个观测器的静态偏差。4. 常见问题与排查技巧实录4.1 低速启动失败或反转这是无感控制最常见的坑。原因通常有几个初始位置辨识不准、HFI注入幅值不够、PLL参数太激进、启动转矩不足。排查顺序先用示波器看HFI解调出来的角度和实际角度如果有编码器做对比是否一致再检查注入幅值是否足够大能不能在电流里看到明显的注入响应然后看PLL的误差信号是否收敛。如果初始位置辨识有偏差启动时可能反转这时候可以先用开环强拖到一定转速再切闭环或者改进初始位置辨识算法。4.2 中高速段角度纹波大SMO在高速段角度纹波大通常是抖振没压住。检查滑模增益是否过大、边界层是否太窄、PLL带宽是否太高。另外反电动势估计里的高频噪声也会传到角度上可以在PLL前加一级低通滤波但要注意相位延迟。还有一种可能是电流采样噪声大。检查ADC采样时刻是否在电流纹波中点采样窗口是否足够霍尔或分流电阻的布线是否远离功率回路。4.3 切换区间转矩抖动切换抖动的原因前面提过角度跳变、权重过渡太快、两个观测器偏差大。解决办法用角度误差加权而不是角度加权放慢过渡区间在切换前先让两个观测器并行运行一段时间校准静态偏差。如果抖动还是压不住可以考虑在切换区间内对q轴电流指令做限幅或者加一个斜坡减小转矩变化率。4.4 常见问题速查表现象可能原因排查方向解决手段低速启动反转初始位置辨识错误对比估计角度与实际角度改进初始辨识或开环强拖启动低速带载能力差HFI注入幅值不足观察注入电流响应幅值加大注入幅值检查凸极率中高速角度纹波大SMO抖振观察反电动势估计波形加宽边界层降低滑模增益切换瞬间转矩冲击角度跳变或过渡太快观察切换时q轴电流用误差加权放慢过渡估计转速噪声大PLL带宽过高观察转速波形降低PLL带宽加低通滤波电流采样异常采样时刻不对示波器看PWM与ADC触发调整采样点到纹波中点4.5 几个容易被忽略的细节死区补偿。IPM模块的死区会导致电压失真低速时尤其明显会影响HFI的解调精度。死区补偿做不做、做多准直接关系到低速性能。我一般会根据电流方向做前馈补偿补偿量通过实验标定。参数温漂。定子电阻随温度变化明显SMO里用的R如果和实际偏差大低速反电动势估计会偏。有条件的话加一个电阻在线辨识或者至少做温度补偿。母线电压波动。HFI注入幅值如果是绝对值母线电压波动时注入幅值相对变化解调增益也跟着变。稳妥的做法是把注入幅值做成母线电压的百分比或者对解调结果做母线电压归一化。中断优先级。F283xC2000有多个中断源PWM中断、ADC中断、通信中断的优先级要安排好。控制中断必须最高优先级通信可以放低避免通信打断控制导致周期抖动。5. 调试工具与验证方法5.1 上位机观测与数据记录调试无感控制光靠示波器不够需要能实时看角度、转速、电流、权重系数这些内部变量。我一般用DSP的DAC或者PWMRC滤波输出关键变量到示波器同时用串口或CAN把数据传到上位机做波形记录。F283xC2000的调试资源比较丰富可以用CCS的Graph功能实时看变量也可以自己写上位机。数据记录的重点是估计角度vs实际角度如果有编码器对比、估计转速vs实际转速、q轴电流、权重系数、HFI解调误差、SMO反电动势估计。这些量放在一起看问题基本能定位。5.2 台架验证的步骤台架验证我一般分四步走开环验证电机开环运行验证PWM、ADC、驱动都正常电流波形对。电流环闭环用实际角度编码器做电流环验证电流环带宽和稳定性。无感低速验证切到HFI从零速启动逐步加载看低速角度估计精度和带载能力。全速域验证从零速加速到额定转速观察切换过程记录全程角度误差和转矩波动。每一步都要记录数据和预期对比。如果某一步不通过不要急着往下走回去查原因。5.3 性能评估指标评估这套无感方案我关注几个指标低速角度误差目标5°电角度、切换区间转矩波动目标5%额定转矩、最高转速下的角度误差、零速带载能力、动态响应时间。这些指标在台架上用编码器做基准对比数据说话。注意台架验证通过不代表现场没问题。现场的温度、电压、负载特性都可能不同V1.0版本建议先在台架上跑够时间再做现场小批量验证。6. 后续优化方向与个人体会这套V1.0版本跑通之后我脑子里已经有一堆可以优化的点。比如HFI的注入策略可以改成方波注入降低噪声和损耗SMO可以升级成超螺旋或者自适应滑模进一步压抖振权重切换可以引入转速变化率的自适应动态时过渡快一点稳态时过渡慢一点参数辨识可以做成在线电阻电感随温度实时更新。还有一个方向是弱磁。全速域如果包含基速以上就要考虑弱磁控制这时候无感观测器的模型要改因为d轴电流不为零凸极效应和反电动势的关系都变了。这是V2.0级别的工作量。我个人在实际操作中的体会是无感控制这东西算法原理看懂了只是入门真正的功夫在调试。同样一套代码参数差一点性能差一大截。而参数又没有万能公式必须结合具体电机、具体工况反复试。所以别指望抄一套代码就能跑要准备好花时间在台架上磨。另外基础的东西——电流采样、PWM同步、死区补偿——永远比花哨的算法重要这些没做好再高级的观测器也救不回来。