1. 无感FOC低速段的位置估算困局1.1 为什么低速是反电动势观测器的死穴做永磁同步电机无感FOC的兄弟都清楚一个基本事实中高速段靠反电动势观测器龙贝格观测器、滑模观测器、扩展卡尔曼滤波等估算转子位置效果通常都不错但一旦转速掉到额定转速的5%以下甚至进入零速附近这些方法就集体失灵了。根子在于物理层面。反电动势幅值与电角速度成正比公式是 E ωe × ψf其中 ψf 是永磁体磁链。假设一台电机的额定转速对应电角速度 300 rad/s额定反电动势峰值 100V那么当转速降到 1% 额定即 3 rad/s反电动势峰值只剩 1V。而逆变器的死区效应、管压降、电流采样噪声、PWM谐波叠加起来在这个量级上产生的干扰可能就有 0.5V 到 2V。信噪比直接崩掉观测器根本没法从噪声里提取出有效信号。这就是为什么很多做无感FOC的朋友发现电机在中高速跑得好好的一到低速就抖、就失步、就反转。不是算法写得不好是物理信息本身就不够了。1.2 HFI高频注入的基本破局思路既然反电动势在低速段靠不住那就主动注入一个高频信号利用电机的凸极效应saliency来提取转子位置。这就是HFIHigh Frequency Injection高频注入的核心思想。PMSM按照转子结构分为表贴式SPM和内嵌式IPM。SPM的d轴和q轴电感基本相等Ld ≈ Lq凸极率很低IPM的Ld Lq凸极率通常在1.5到3倍之间。HFI主要针对有凸极效应的电机但通过饱和凸极效应即使是SPM也能做出一定效果。高频注入的物理基础是这样的当在定子侧注入一个高频电压信号时由于d轴和q轴电感不同高频电流响应中会包含转子位置信息。具体来说在估计的d-q坐标系下注入信号电流响应中的高频分量幅值或相位会随真实转子位置与估计位置的偏差而变化。通过解调这个偏差信号就能驱动估计位置收敛到真实位置。1.3 为什么选d轴正弦波注入而不是方波或旋转注入HFI的注入方式有很多种常见的有注入方式注入信号优点缺点旋转高频注入在α-β轴注入旋转电压矢量不需要初始位置信息解调复杂转矩脉动大d轴方波注入在估计d轴注入正负交替方波信噪比高带宽大噪声大对采样要求高d轴正弦波注入在估计d轴注入高频正弦电压噪声小解调简单带宽相对较窄q轴注入在估计q轴注入对凸极率要求低与转矩控制耦合d轴正弦波高频注入之所以在工业界被广泛采用核心原因是它在噪声、解调复杂度和鲁棒性之间取得了比较好的平衡。方波注入虽然信噪比高但高频方波会在电机上产生刺耳的电磁噪声很多应用场景比如家电、车内电机对NVH要求严格方波方案直接被pass。旋转注入解调需要用到外差法heterodyne和低通滤波计算量大且对滤波器设计敏感。d轴正弦波注入的解调链路相对简洁用带通滤波同步解调低通滤波就能拿到位置误差信号工程落地更容易。2. d轴正弦波高频注入的数学推导全流程2.1 坐标系约定与基本假设推导之前先把坐标系和假设条件理清楚不然后面公式容易看晕。约定如下真实转子位置角为 θe电角度真实d轴与转子磁链方向对齐估计转子位置角为 θ̂e估计误差 Δθ θe - θ̂e估计d-q坐标系记为 d̂-q̂真实d-q坐标系记为 d-q注入频率为 ωh远高于基波频率 ωe基本假设注入频率远高于基波频率也远高于电流环带宽因此基波和注入分量可以解耦分析忽略定子电阻在高频下的影响ωh × L R忽略交叉饱和和涡流损耗电机三相参数对称这些假设在工程上基本成立。注入频率通常选在500Hz到2kHz之间而基波频率在低速段可能只有几Hz到几十Hz差距在十倍以上解耦分析完全合理。2.2 估计d轴注入高频电压的信号形式在估计d轴注入高频电压v̂dh Vh × sin(ωh × t) v̂qh 0其中 Vh 是注入电压幅值ωh 是注入角频率。这个信号只加在估计d轴上q轴不注入。为什么选正弦波而不是余弦其实无所谓正弦和余弦只是相位差90度解调时参考信号的相位对应调整就行。工程上习惯用sin因为解调时乘以sin(ωh t)后直流分量正好是幅值的一半推导起来干净。2.3 高频电流响应的推导在估计d-q坐标系下高频电压方程可以写成[v̂dh] [R jωh×L̂d jωh×L̂dq] [îdh] [v̂qh] [jωh×L̂dq R jωh×L̂q ] [îqh]忽略电阻R高频下ωh×L R并且考虑真实d-q坐标系与估计d-q坐标系之间存在角度误差Δθ经过坐标变换可以得到估计坐标系下的高频电流响应。这一步推导是整篇文章最核心的部分我尽量写得详细但不啰嗦。首先在真实d-q坐标系下高频阻抗矩阵是对角的Z_dq [jωh×Ld 0 ] [0 jωh×Lq]当从估计坐标系看过去需要做旋转变换。估计坐标系到真实坐标系的变换矩阵是T(Δθ) [cos(Δθ) sin(Δθ)] [-sin(Δθ) cos(Δθ)]其中 Δθ θe - θ̂e。那么估计坐标系下的高频阻抗矩阵为Z_dq̂ T(-Δθ) × Z_dq × T(Δθ)展开计算Z_dq̂ [jωh×(Ld×cos²Δθ Lq×sin²Δθ) jωh×(Ld-Lq)×sinΔθ×cosΔθ] [jωh×(Ld-Lq)×sinΔθ×cosΔθ jωh×(Ld×sin²Δθ Lq×cos²Δθ)]引入平均电感 L (LdLq)/2 和半差电感 ΔL (Lq-Ld)/2则Z_dq̂ jωh × [L ΔL×cos(2Δθ) ΔL×sin(2Δθ) ] [ΔL×sin(2Δθ) L - ΔL×cos(2Δθ)]这个阻抗矩阵就是整个HFI推导的基石。可以看到当 Δθ 0 时矩阵退化为对角矩阵交叉项为零当 Δθ ≠ 0 时交叉项 ΔL×sin(2Δθ) 不为零这就是位置误差信息的来源。2.4 高频电流响应的显式表达在估计d轴注入电压 v̂dh Vh×sin(ωh t)v̂qh 0则高频电流响应为[îdh] 1 [L - ΔL×cos(2Δθ) -ΔL×sin(2Δθ) ] [Vh×sin(ωh t)] [îqh] ───────────── × [-ΔL×sin(2Δθ) L ΔL×cos(2Δθ)] [0 ] jωh×(L²-ΔL²)化简后îdh Vh×sin(ωh t) × (L - ΔL×cos(2Δθ)) / (jωh×(L²-ΔL²)) îqh Vh×sin(ωh t) × (-ΔL×sin(2Δθ)) / (jωh×(L²-ΔL²))注意分母有j说明电流滞后电压90度。把j放到正弦函数里sin(ωh t)/j -cos(ωh t)所以时域表达式为îdh -Vh×cos(ωh t) × (L - ΔL×cos(2Δθ)) / (ωh×(L²-ΔL²)) îqh -Vh×cos(ωh t) × (-ΔL×sin(2Δθ)) / (ωh×(L²-ΔL²))整理一下符号îdh Vh×cos(ωh t) × (ΔL×cos(2Δθ) - L) / (ωh×(L²-ΔL²)) îqh Vh×cos(ωh t) × ΔL×sin(2Δθ) / (ωh×(L²-ΔL²))这就是估计d轴和q轴上的高频电流响应。关键观察îdh 中包含 cos(2Δθ) 项但同时也包含与Δθ无关的L项所以d轴电流主要成分是注入频率的余弦波位置信息被淹没在固定分量里îqh 中只有 ΔL×sin(2Δθ) 项当 Δθ 0 时 îqh 0当 Δθ 很小时 sin(2Δθ) ≈ 2Δθîqh 与位置误差成正比所以q轴高频电流就是我们要解调的目标信号。2.5 同步解调与位置误差信号提取îqh 的表达式是îqh Vh×ΔL×sin(2Δθ) / (ωh×(L²-ΔL²)) × cos(ωh t)这是一个幅值为 K×sin(2Δθ)、频率为 ωh 的高频余弦信号其中 K Vh×ΔL / (ωh×(L²-ΔL²))。解调步骤第一步带通滤波。用中心频率为 ωh 的带通滤波器从q轴电流中提取高频分量滤掉基波和低次谐波。第二步同步解调。将滤波后的信号乘以参考信号 cos(ωh t)îqh × cos(ωh t) K×sin(2Δθ) × cos²(ωh t) K×sin(2Δθ) × (1 cos(2ωh t)) / 2 K×sin(2Δθ)/2 K×sin(2Δθ)×cos(2ωh t)/2第三步低通滤波。用低通滤波器滤掉 2ωh 频率分量得到ε K×sin(2Δθ)/2 ≈ K×Δθ (当Δθ很小时)这个 ε 就是位置误差信号。当 ε 0 时说明估计位置滞后于真实位置当 ε 0 时说明估计位置超前。把 ε 送入锁相环PLL或龙贝格观测器就能驱动估计位置收敛到真实位置。2.6 锁相环参数设计PLL的结构很简单误差信号 ε 经过一个PI控制器得到估计转速再积分得到估计位置。ε → PI控制器 → ω̂e → 积分器 → θ̂ePI参数的设计直接决定收敛速度和稳态精度。传递函数推导假设 ε Kp_pll × Δθ小误差线性化则闭环传递函数为θ̂e(s) Kp_pll×Kp×s Kp_pll×Ki ──── ───────────────────────────── θe(s) s² Kp_pll×Kp×s Kp_pll×Ki这是一个标准二阶系统自然频率 ωn sqrt(Kp_pll×Ki)阻尼比 ζ Kp_pll×Kp / (2×ωn)。工程上通常取 ζ 0.707最佳阻尼ωn 取注入频率的1/10到1/5。比如注入频率1kHzωn取100到200 rad/s。然后反推Ki ωn² / Kp_pll Kp 2×ζ×ωn / Kp_pllKp_pll 是解调增益等于 Vh×ΔL / (2×ωh×(L²-ΔL²))。实际调试时不用精确计算先给一个大概值然后根据收敛效果微调。3. 工程实现中的关键细节与参数选择3.1 注入频率怎么选注入频率的选择是一个多目标权衡问题考虑因素倾向选择原因信噪比更高频率高频下电感阻抗大电流响应更明显电流环带宽更低频率注入频率应远高于电流环带宽避免耦合NVH更低频率或更高频率避开人耳敏感频段2k-5kHz采样精度适中频率太高频率对采样率要求高滤波器设计适中频率需要与基波频率拉开足够距离实际工程中注入频率通常选在500Hz到2kHz。如果电机额定频率是100Hz电流环带宽1kHz那么注入频率选1kHz到1.5kHz比较合适。太低比如300Hz会和基波耦合太高比如5kHz会产生刺耳噪声且对MCU算力要求高。我个人的经验是先看电流环带宽注入频率至少取电流环带宽的2倍以上再看NVH要求如果对噪声敏感可以选在1kHz左右这个频率的电磁噪声相对沉闷不像2kHz以上那么尖锐。3.2 注入电压幅值的确定注入电压幅值 Vh 的选择同样需要权衡太小高频电流响应微弱信噪比不够位置估算抖动大太大产生额外的转矩脉动、铜损和噪声严重时影响电机正常运行一个实用的经验公式Vh ≈ (0.05 ~ 0.15) × Vdc比如母线电压300VVh取15V到45V。但这不是绝对的还要看电机的凸极率和电感值。凸极率高的电机Lq/Ld 2Vh可以取小一些凸极率低的电机Lq/Ld 1.3Vh需要取大一些。更精确的方法是先估算高频电流幅值Ih Vh / (ωh × Ld)希望 Ih 在额定电流的10%到30%之间。如果 Ih 太小信噪比不够如果太大转矩脉动和损耗就上去了。3.3 滤波器的设计要点HFI的解调链路里有两个滤波器带通滤波器和低通滤波器。这两个滤波器的设计直接决定了解调质量和动态响应。带通滤波器中心频率ωh带宽通常取 ωh 的10%到20%阶数二阶足够太高阶会引入过大相移低通滤波器截止频率取 ωn 的2到5倍或者取 ωh 的1/10到1/20阶数一阶或二阶注意相位滞后对PLL稳定性的影响工程上我习惯用二阶巴特沃斯带通 一阶低通。巴特沃斯通带平坦相移可控一阶低通简单相位滞后小。如果MCU算力充裕可以用二阶低通但要注意相位裕度。注意滤波器的截止频率不能设得太低否则动态响应会变慢电机加速时位置估算跟不上也不能设得太高否则高频分量滤不干净位置信号会抖动。3.4 数字实现的离散化处理在MCU上实现时所有连续域公式都要离散化。假设PWM频率为 f_pwm采样周期 Ts 1/f_pwm。注入信号生成// 注入频率 fh采样周期 Ts // 相位累加 theta_h 2 * PI * fh * Ts; if (theta_h 2 * PI) theta_h - 2 * PI; Vh_d Vh * sinf(theta_h); Vh_q 0;同步解调参考信号// 解调参考信号需要与注入信号同相位 ref_cos cosf(theta_h); // 或者用查表法提高速度带通滤波器的差分方程二阶巴特沃斯// 以直接II型为例 w[n] x[n] - a1*w[n-1] - a2*w[n-2]; y[n] b0*w[n] b1*w[n-1] b2*w[n-2];系数 a1, a2, b0, b1, b2 根据中心频率和带宽计算可以用MATLAB的 butter 函数生成。低通滤波器一阶y[n] y[n-1] alpha * (x[n] - y[n-1]); // alpha Ts / (Ts RC)RC 1/(2*PI*fc)实操心得在MCU上做三角函数运算很耗时建议用查表法或者CORDIC算法。如果MCU有FPU用sinf/cosf也可以但要注意执行时间。我通常会在PWM中断里预留足够的时间余量避免中断溢出。4. 调试过程中踩过的坑与排查技巧4.1 位置估算收敛但方向反了这是新手最常遇到的问题PLL能收敛但估计位置和真实位置差180度电角度导致电机反转或者启动失败。原因分析HFI的位置误差信号 ε K×sin(2Δθ)这个函数在 Δθ 0 和 Δθ π 时都等于零。也就是说PLL有两个稳定点真实位置和真实位置加180度。PLL最终收敛到哪个点取决于初始条件和凸极效应的极性。解决方法利用凸极效应的极性信息。在d轴注入正负电压脉冲观察电流响应幅值。由于饱和效应正d轴方向的电感通常略小于负d轴方向通过比较可以判断极性。在启动前做一次初始位置检测用脉冲注入法确定磁极方向。如果电机凸极率很高Lq/Ld 2饱和凸极效应明显通常不会收敛到错误点。凸极率低的电机需要额外做极性判断。4.2 低速运行时位置估算抖动大电机在低速运行时估计位置抖动明显转速波动大甚至能听到周期性的嗡嗡声。排查思路检查注入电压幅值是否足够。如果Vh太小信噪比不够解调出来的误差信号被噪声淹没。检查带通滤波器中心频率是否准确匹配注入频率。如果滤波器中心频率偏移高频分量提取不干净。检查同步解调参考信号的相位。如果参考信号与注入信号有相位差解调效率会下降。检查PLL带宽是否合适。带宽太低动态响应慢带宽太高噪声放大。我遇到过一次抖动的原因是带通滤波器的中心频率设成了注入频率的0.9倍导致高频分量衰减了6dB解调增益不够。把中心频率调准后抖动明显改善。4.3 电机参数变化导致估算精度下降PMSM的Ld和Lq会随电流和温度变化。特别是IPM电机d轴和q轴电感在不同负载电流下变化可能达到20%到30%。电感变化会直接影响解调增益K进而影响PLL的等效带宽和稳态误差。应对策略在线辨识电感。通过注入不同幅值的电压脉冲测量电流响应斜率实时更新Ld和Lq。自适应PLL增益。根据估算的转速和电流幅值动态调整PLL的PI参数。如果对精度要求不高可以取额定工况下的电感值作为固定参数接受一定的精度损失。实操心得我通常会在调试阶段用示波器抓取q轴高频电流和解调后的误差信号观察波形质量。如果误差信号正弦度好、幅值稳定说明参数基本合适如果波形畸变严重或者幅值波动大就需要调整滤波器或注入参数。4.4 常见问题速查表现象可能原因排查方法解决措施位置估算不收敛注入幅值太小增大Vh观察增大Vh至额定电流10%以上收敛但方向反极性判断错误检查初始位置检测增加脉冲极性判断低速抖动大滤波器参数不当观察误差信号波形调整带通/低通截止频率高速时估算失效HFI与基波耦合检查高速段切换逻辑高速切换到反电动势观测器噪声刺耳注入频率在人耳敏感区改变注入频率选1kHz以下或避开2k-5kHz温升过高注入幅值太大测量电机温升降低Vh或减小注入占空比带载能力差PLL带宽太低突加负载观察响应提高PLL带宽或增大Kp4.5 低速到高速的平滑切换HFI在低速段好用但到了中高速段反电动势信号足够强再用HFI就得不偿失了——额外的损耗、噪声、转矩脉动都是代价。所以工程上通常采用混合策略低速用HFI高速用反电动势观测器中间有一个过渡区。切换策略有两种硬切换在某个转速点直接切换。简单但容易产生转矩冲击。加权融合在过渡区对两种方法的估算结果做加权平均权重随转速线性变化。平滑但实现复杂。我一般用加权融合过渡区设在额定转速的5%到15%之间。权重函数用sigmoid或者线性函数都可以关键是保证切换过程中位置估算连续不能跳变。5. 从理论到代码的落地要点5.1 整体软件架构一个完整的HFI无感FOC软件通常包含以下模块PWM中断服务程序电流采样、Clarke/Park变换、电流环PI、SVPWM生成HFI注入模块生成注入电压叠加到d轴电压指令上解调模块带通滤波、同步解调、低通滤波PLL模块PI控制器、积分器模式切换模块低速HFI与高速观测器的切换逻辑保护模块过流、过压、过温保护这些模块都在PWM中断里执行中断频率通常等于PWM频率10kHz到20kHz。计算量不小需要合理分配时间。5.2 关键代码片段注入和解调的核心代码// 注入信号生成 theta_h delta_theta_h; if (theta_h TWO_PI) theta_h - TWO_PI; Vh_d_inject Vh * sinf(theta_h); // 叠加到d轴电压指令 Vd_ref Vd_pi Vh_d_inject; Vq_ref Vq_pi; // 电流采样后提取q轴高频分量 Iq_hp bandpass_filter(Iq_feedback); // 同步解调 Iq_demod Iq_hp * cosf(theta_h); // 低通滤波得到误差信号 epsilon lowpass_filter(Iq_demod); // PLL omega_hat pll_kp * epsilon pll_ki * integral_epsilon; integral_epsilon epsilon * Ts; theta_hat omega_hat * Ts;5.3 计算资源优化在低成本MCU上跑HFI计算资源往往紧张。几个优化技巧三角函数用查表线性插值比调用sinf/cosf快5到10倍滤波器用定点运算避免浮点开销如果MCU没有FPU注入频率和PWM频率保持整数比简化相位计算解调参考信号直接复用注入信号的相位不需要额外计算注意优化计算资源时不能牺牲数值稳定性。定点运算要注意溢出和精度损失滤波器系数的Q格式要选合适。5.4 调试工具与观测方法调试HFI时以下工具和观测方法非常有用示波器抓取q轴电流波形观察高频分量是否清晰DAC输出把解调后的误差信号和估计位置通过DAC输出用示波器观察收敛过程上位机波形通过串口或CAN把关键变量传到上位机用波形软件观察电流探头测量实际相电流验证注入效果我习惯在调试初期把误差信号和估计位置都DAC出来用示波器看。如果误差信号在零附近小幅波动说明PLL收敛了如果误差信号持续偏大说明解调增益不够或者滤波器有问题。6. 实际项目中的经验沉淀6.1 不同电机类型的适配策略HFI不是万能的不同电机类型需要不同的适配策略电机类型凸极率HFI效果适配建议表贴式PMSMLq/Ld ≈ 1.0-1.1差依赖饱和凸极需大注入幅值内嵌式PMSMLq/Ld ≈ 1.5-3.0好标准HFI即可永磁辅助同步磁阻Lq/Ld 3.0很好小注入幅值即可异步电机无凸极不适用需用其他方法对于表贴式PMSM凸极率很低HFI的效果主要靠饱和凸极效应。这时候注入幅值需要加大但加大注入又会带来噪声和损耗。所以表贴式电机的低速无感控制一直是难点工程上有时会妥协接受较低的位置精度或者用其他辅助手段。6.2 温度与老化对HFI的影响电机运行一段时间后温度升高永磁体磁链下降电感也会变化。这些变化会影响HFI的解调增益和PLL参数。实测数据一台IPM电机在冷态25°C和热态100°C下Lq变化约15%Ld变化约10%。解调增益K与ΔL成正比ΔL变化约20%意味着PLL的等效带宽变化约20%。如果PLL参数不调整热态下动态响应会变慢。应对方法在软件里加入温度补偿。如果电机有温度传感器可以根据温度查表调整PLL参数如果没有可以根据运行时间估算温升做粗略补偿。6.3 与其他无感方法的对比方法低速性能零速性能参数敏感性实现复杂度适用场景反电动势观测器差不可用中中中高速HFI好好高高低速和零速隆贝格观测器中差中中中高速滑模观测器中差低中中高速扩展卡尔曼滤波中差高高中高速模型参考自适应中差中中中高速HFI在低速和零速段的优势是其他方法无法替代的但它的参数敏感性和实现复杂度也是最高的。工程上通常将HFI与反电动势观测器结合低速用HFI高速用观测器取长补短。6.4 未来改进方向HFI技术本身还在演进几个值得关注的方向无滤波器解调用自适应观测器代替带通同步解调低通减少相位滞后提高动态响应多频率注入同时注入多个频率利用不同频率的响应差异提高鲁棒性机器学习辅助用神经网络拟合电感变化和位置误差的关系提高参数适应性宽禁带器件适配SiC和GaN器件开关频率高可以支持更高的注入频率提高信噪比这些方向目前还在研究阶段工业界落地的不多但值得关注。我个人在实际项目中的体会是HFI的调试时间通常比反电动势观测器长得多因为涉及的参数多、耦合强。但一旦调好低速性能的提升是质的飞跃。建议新手先从仿真入手用MATLAB/Simulink把整个链路跑通理解每个环节的作用再上实物调试。实物调试时先开环注入观察电流响应确认硬件采样没问题再闭环调PLL。这样一步步来比一上来就闭环调更容易找到问题。
1. 无感FOC低速段的位置估算困局1.1 为什么低速是反电动势观测器的死穴做永磁同步电机无感FOC的兄弟都清楚一个基本事实中高速段靠反电动势观测器龙贝格观测器、滑模观测器、扩展卡尔曼滤波等估算转子位置效果通常都不错但一旦转速掉到额定转速的5%以下甚至进入零速附近这些方法就集体失灵了。根子在于物理层面。反电动势幅值与电角速度成正比公式是 E ωe × ψf其中 ψf 是永磁体磁链。假设一台电机的额定转速对应电角速度 300 rad/s额定反电动势峰值 100V那么当转速降到 1% 额定即 3 rad/s反电动势峰值只剩 1V。而逆变器的死区效应、管压降、电流采样噪声、PWM谐波叠加起来在这个量级上产生的干扰可能就有 0.5V 到 2V。信噪比直接崩掉观测器根本没法从噪声里提取出有效信号。这就是为什么很多做无感FOC的朋友发现电机在中高速跑得好好的一到低速就抖、就失步、就反转。不是算法写得不好是物理信息本身就不够了。1.2 HFI高频注入的基本破局思路既然反电动势在低速段靠不住那就主动注入一个高频信号利用电机的凸极效应saliency来提取转子位置。这就是HFIHigh Frequency Injection高频注入的核心思想。PMSM按照转子结构分为表贴式SPM和内嵌式IPM。SPM的d轴和q轴电感基本相等Ld ≈ Lq凸极率很低IPM的Ld Lq凸极率通常在1.5到3倍之间。HFI主要针对有凸极效应的电机但通过饱和凸极效应即使是SPM也能做出一定效果。高频注入的物理基础是这样的当在定子侧注入一个高频电压信号时由于d轴和q轴电感不同高频电流响应中会包含转子位置信息。具体来说在估计的d-q坐标系下注入信号电流响应中的高频分量幅值或相位会随真实转子位置与估计位置的偏差而变化。通过解调这个偏差信号就能驱动估计位置收敛到真实位置。1.3 为什么选d轴正弦波注入而不是方波或旋转注入HFI的注入方式有很多种常见的有注入方式注入信号优点缺点旋转高频注入在α-β轴注入旋转电压矢量不需要初始位置信息解调复杂转矩脉动大d轴方波注入在估计d轴注入正负交替方波信噪比高带宽大噪声大对采样要求高d轴正弦波注入在估计d轴注入高频正弦电压噪声小解调简单带宽相对较窄q轴注入在估计q轴注入对凸极率要求低与转矩控制耦合d轴正弦波高频注入之所以在工业界被广泛采用核心原因是它在噪声、解调复杂度和鲁棒性之间取得了比较好的平衡。方波注入虽然信噪比高但高频方波会在电机上产生刺耳的电磁噪声很多应用场景比如家电、车内电机对NVH要求严格方波方案直接被pass。旋转注入解调需要用到外差法heterodyne和低通滤波计算量大且对滤波器设计敏感。d轴正弦波注入的解调链路相对简洁用带通滤波同步解调低通滤波就能拿到位置误差信号工程落地更容易。2. d轴正弦波高频注入的数学推导全流程2.1 坐标系约定与基本假设推导之前先把坐标系和假设条件理清楚不然后面公式容易看晕。约定如下真实转子位置角为 θe电角度真实d轴与转子磁链方向对齐估计转子位置角为 θ̂e估计误差 Δθ θe - θ̂e估计d-q坐标系记为 d̂-q̂真实d-q坐标系记为 d-q注入频率为 ωh远高于基波频率 ωe基本假设注入频率远高于基波频率也远高于电流环带宽因此基波和注入分量可以解耦分析忽略定子电阻在高频下的影响ωh × L R忽略交叉饱和和涡流损耗电机三相参数对称这些假设在工程上基本成立。注入频率通常选在500Hz到2kHz之间而基波频率在低速段可能只有几Hz到几十Hz差距在十倍以上解耦分析完全合理。2.2 估计d轴注入高频电压的信号形式在估计d轴注入高频电压v̂dh Vh × sin(ωh × t) v̂qh 0其中 Vh 是注入电压幅值ωh 是注入角频率。这个信号只加在估计d轴上q轴不注入。为什么选正弦波而不是余弦其实无所谓正弦和余弦只是相位差90度解调时参考信号的相位对应调整就行。工程上习惯用sin因为解调时乘以sin(ωh t)后直流分量正好是幅值的一半推导起来干净。2.3 高频电流响应的推导在估计d-q坐标系下高频电压方程可以写成[v̂dh] [R jωh×L̂d jωh×L̂dq] [îdh] [v̂qh] [jωh×L̂dq R jωh×L̂q ] [îqh]忽略电阻R高频下ωh×L R并且考虑真实d-q坐标系与估计d-q坐标系之间存在角度误差Δθ经过坐标变换可以得到估计坐标系下的高频电流响应。这一步推导是整篇文章最核心的部分我尽量写得详细但不啰嗦。首先在真实d-q坐标系下高频阻抗矩阵是对角的Z_dq [jωh×Ld 0 ] [0 jωh×Lq]当从估计坐标系看过去需要做旋转变换。估计坐标系到真实坐标系的变换矩阵是T(Δθ) [cos(Δθ) sin(Δθ)] [-sin(Δθ) cos(Δθ)]其中 Δθ θe - θ̂e。那么估计坐标系下的高频阻抗矩阵为Z_dq̂ T(-Δθ) × Z_dq × T(Δθ)展开计算Z_dq̂ [jωh×(Ld×cos²Δθ Lq×sin²Δθ) jωh×(Ld-Lq)×sinΔθ×cosΔθ] [jωh×(Ld-Lq)×sinΔθ×cosΔθ jωh×(Ld×sin²Δθ Lq×cos²Δθ)]引入平均电感 L (LdLq)/2 和半差电感 ΔL (Lq-Ld)/2则Z_dq̂ jωh × [L ΔL×cos(2Δθ) ΔL×sin(2Δθ) ] [ΔL×sin(2Δθ) L - ΔL×cos(2Δθ)]这个阻抗矩阵就是整个HFI推导的基石。可以看到当 Δθ 0 时矩阵退化为对角矩阵交叉项为零当 Δθ ≠ 0 时交叉项 ΔL×sin(2Δθ) 不为零这就是位置误差信息的来源。2.4 高频电流响应的显式表达在估计d轴注入电压 v̂dh Vh×sin(ωh t)v̂qh 0则高频电流响应为[îdh] 1 [L - ΔL×cos(2Δθ) -ΔL×sin(2Δθ) ] [Vh×sin(ωh t)] [îqh] ───────────── × [-ΔL×sin(2Δθ) L ΔL×cos(2Δθ)] [0 ] jωh×(L²-ΔL²)化简后îdh Vh×sin(ωh t) × (L - ΔL×cos(2Δθ)) / (jωh×(L²-ΔL²)) îqh Vh×sin(ωh t) × (-ΔL×sin(2Δθ)) / (jωh×(L²-ΔL²))注意分母有j说明电流滞后电压90度。把j放到正弦函数里sin(ωh t)/j -cos(ωh t)所以时域表达式为îdh -Vh×cos(ωh t) × (L - ΔL×cos(2Δθ)) / (ωh×(L²-ΔL²)) îqh -Vh×cos(ωh t) × (-ΔL×sin(2Δθ)) / (ωh×(L²-ΔL²))整理一下符号îdh Vh×cos(ωh t) × (ΔL×cos(2Δθ) - L) / (ωh×(L²-ΔL²)) îqh Vh×cos(ωh t) × ΔL×sin(2Δθ) / (ωh×(L²-ΔL²))这就是估计d轴和q轴上的高频电流响应。关键观察îdh 中包含 cos(2Δθ) 项但同时也包含与Δθ无关的L项所以d轴电流主要成分是注入频率的余弦波位置信息被淹没在固定分量里îqh 中只有 ΔL×sin(2Δθ) 项当 Δθ 0 时 îqh 0当 Δθ 很小时 sin(2Δθ) ≈ 2Δθîqh 与位置误差成正比所以q轴高频电流就是我们要解调的目标信号。2.5 同步解调与位置误差信号提取îqh 的表达式是îqh Vh×ΔL×sin(2Δθ) / (ωh×(L²-ΔL²)) × cos(ωh t)这是一个幅值为 K×sin(2Δθ)、频率为 ωh 的高频余弦信号其中 K Vh×ΔL / (ωh×(L²-ΔL²))。解调步骤第一步带通滤波。用中心频率为 ωh 的带通滤波器从q轴电流中提取高频分量滤掉基波和低次谐波。第二步同步解调。将滤波后的信号乘以参考信号 cos(ωh t)îqh × cos(ωh t) K×sin(2Δθ) × cos²(ωh t) K×sin(2Δθ) × (1 cos(2ωh t)) / 2 K×sin(2Δθ)/2 K×sin(2Δθ)×cos(2ωh t)/2第三步低通滤波。用低通滤波器滤掉 2ωh 频率分量得到ε K×sin(2Δθ)/2 ≈ K×Δθ (当Δθ很小时)这个 ε 就是位置误差信号。当 ε 0 时说明估计位置滞后于真实位置当 ε 0 时说明估计位置超前。把 ε 送入锁相环PLL或龙贝格观测器就能驱动估计位置收敛到真实位置。2.6 锁相环参数设计PLL的结构很简单误差信号 ε 经过一个PI控制器得到估计转速再积分得到估计位置。ε → PI控制器 → ω̂e → 积分器 → θ̂ePI参数的设计直接决定收敛速度和稳态精度。传递函数推导假设 ε Kp_pll × Δθ小误差线性化则闭环传递函数为θ̂e(s) Kp_pll×Kp×s Kp_pll×Ki ──── ───────────────────────────── θe(s) s² Kp_pll×Kp×s Kp_pll×Ki这是一个标准二阶系统自然频率 ωn sqrt(Kp_pll×Ki)阻尼比 ζ Kp_pll×Kp / (2×ωn)。工程上通常取 ζ 0.707最佳阻尼ωn 取注入频率的1/10到1/5。比如注入频率1kHzωn取100到200 rad/s。然后反推Ki ωn² / Kp_pll Kp 2×ζ×ωn / Kp_pllKp_pll 是解调增益等于 Vh×ΔL / (2×ωh×(L²-ΔL²))。实际调试时不用精确计算先给一个大概值然后根据收敛效果微调。3. 工程实现中的关键细节与参数选择3.1 注入频率怎么选注入频率的选择是一个多目标权衡问题考虑因素倾向选择原因信噪比更高频率高频下电感阻抗大电流响应更明显电流环带宽更低频率注入频率应远高于电流环带宽避免耦合NVH更低频率或更高频率避开人耳敏感频段2k-5kHz采样精度适中频率太高频率对采样率要求高滤波器设计适中频率需要与基波频率拉开足够距离实际工程中注入频率通常选在500Hz到2kHz。如果电机额定频率是100Hz电流环带宽1kHz那么注入频率选1kHz到1.5kHz比较合适。太低比如300Hz会和基波耦合太高比如5kHz会产生刺耳噪声且对MCU算力要求高。我个人的经验是先看电流环带宽注入频率至少取电流环带宽的2倍以上再看NVH要求如果对噪声敏感可以选在1kHz左右这个频率的电磁噪声相对沉闷不像2kHz以上那么尖锐。3.2 注入电压幅值的确定注入电压幅值 Vh 的选择同样需要权衡太小高频电流响应微弱信噪比不够位置估算抖动大太大产生额外的转矩脉动、铜损和噪声严重时影响电机正常运行一个实用的经验公式Vh ≈ (0.05 ~ 0.15) × Vdc比如母线电压300VVh取15V到45V。但这不是绝对的还要看电机的凸极率和电感值。凸极率高的电机Lq/Ld 2Vh可以取小一些凸极率低的电机Lq/Ld 1.3Vh需要取大一些。更精确的方法是先估算高频电流幅值Ih Vh / (ωh × Ld)希望 Ih 在额定电流的10%到30%之间。如果 Ih 太小信噪比不够如果太大转矩脉动和损耗就上去了。3.3 滤波器的设计要点HFI的解调链路里有两个滤波器带通滤波器和低通滤波器。这两个滤波器的设计直接决定了解调质量和动态响应。带通滤波器中心频率ωh带宽通常取 ωh 的10%到20%阶数二阶足够太高阶会引入过大相移低通滤波器截止频率取 ωn 的2到5倍或者取 ωh 的1/10到1/20阶数一阶或二阶注意相位滞后对PLL稳定性的影响工程上我习惯用二阶巴特沃斯带通 一阶低通。巴特沃斯通带平坦相移可控一阶低通简单相位滞后小。如果MCU算力充裕可以用二阶低通但要注意相位裕度。注意滤波器的截止频率不能设得太低否则动态响应会变慢电机加速时位置估算跟不上也不能设得太高否则高频分量滤不干净位置信号会抖动。3.4 数字实现的离散化处理在MCU上实现时所有连续域公式都要离散化。假设PWM频率为 f_pwm采样周期 Ts 1/f_pwm。注入信号生成// 注入频率 fh采样周期 Ts // 相位累加 theta_h 2 * PI * fh * Ts; if (theta_h 2 * PI) theta_h - 2 * PI; Vh_d Vh * sinf(theta_h); Vh_q 0;同步解调参考信号// 解调参考信号需要与注入信号同相位 ref_cos cosf(theta_h); // 或者用查表法提高速度带通滤波器的差分方程二阶巴特沃斯// 以直接II型为例 w[n] x[n] - a1*w[n-1] - a2*w[n-2]; y[n] b0*w[n] b1*w[n-1] b2*w[n-2];系数 a1, a2, b0, b1, b2 根据中心频率和带宽计算可以用MATLAB的 butter 函数生成。低通滤波器一阶y[n] y[n-1] alpha * (x[n] - y[n-1]); // alpha Ts / (Ts RC)RC 1/(2*PI*fc)实操心得在MCU上做三角函数运算很耗时建议用查表法或者CORDIC算法。如果MCU有FPU用sinf/cosf也可以但要注意执行时间。我通常会在PWM中断里预留足够的时间余量避免中断溢出。4. 调试过程中踩过的坑与排查技巧4.1 位置估算收敛但方向反了这是新手最常遇到的问题PLL能收敛但估计位置和真实位置差180度电角度导致电机反转或者启动失败。原因分析HFI的位置误差信号 ε K×sin(2Δθ)这个函数在 Δθ 0 和 Δθ π 时都等于零。也就是说PLL有两个稳定点真实位置和真实位置加180度。PLL最终收敛到哪个点取决于初始条件和凸极效应的极性。解决方法利用凸极效应的极性信息。在d轴注入正负电压脉冲观察电流响应幅值。由于饱和效应正d轴方向的电感通常略小于负d轴方向通过比较可以判断极性。在启动前做一次初始位置检测用脉冲注入法确定磁极方向。如果电机凸极率很高Lq/Ld 2饱和凸极效应明显通常不会收敛到错误点。凸极率低的电机需要额外做极性判断。4.2 低速运行时位置估算抖动大电机在低速运行时估计位置抖动明显转速波动大甚至能听到周期性的嗡嗡声。排查思路检查注入电压幅值是否足够。如果Vh太小信噪比不够解调出来的误差信号被噪声淹没。检查带通滤波器中心频率是否准确匹配注入频率。如果滤波器中心频率偏移高频分量提取不干净。检查同步解调参考信号的相位。如果参考信号与注入信号有相位差解调效率会下降。检查PLL带宽是否合适。带宽太低动态响应慢带宽太高噪声放大。我遇到过一次抖动的原因是带通滤波器的中心频率设成了注入频率的0.9倍导致高频分量衰减了6dB解调增益不够。把中心频率调准后抖动明显改善。4.3 电机参数变化导致估算精度下降PMSM的Ld和Lq会随电流和温度变化。特别是IPM电机d轴和q轴电感在不同负载电流下变化可能达到20%到30%。电感变化会直接影响解调增益K进而影响PLL的等效带宽和稳态误差。应对策略在线辨识电感。通过注入不同幅值的电压脉冲测量电流响应斜率实时更新Ld和Lq。自适应PLL增益。根据估算的转速和电流幅值动态调整PLL的PI参数。如果对精度要求不高可以取额定工况下的电感值作为固定参数接受一定的精度损失。实操心得我通常会在调试阶段用示波器抓取q轴高频电流和解调后的误差信号观察波形质量。如果误差信号正弦度好、幅值稳定说明参数基本合适如果波形畸变严重或者幅值波动大就需要调整滤波器或注入参数。4.4 常见问题速查表现象可能原因排查方法解决措施位置估算不收敛注入幅值太小增大Vh观察增大Vh至额定电流10%以上收敛但方向反极性判断错误检查初始位置检测增加脉冲极性判断低速抖动大滤波器参数不当观察误差信号波形调整带通/低通截止频率高速时估算失效HFI与基波耦合检查高速段切换逻辑高速切换到反电动势观测器噪声刺耳注入频率在人耳敏感区改变注入频率选1kHz以下或避开2k-5kHz温升过高注入幅值太大测量电机温升降低Vh或减小注入占空比带载能力差PLL带宽太低突加负载观察响应提高PLL带宽或增大Kp4.5 低速到高速的平滑切换HFI在低速段好用但到了中高速段反电动势信号足够强再用HFI就得不偿失了——额外的损耗、噪声、转矩脉动都是代价。所以工程上通常采用混合策略低速用HFI高速用反电动势观测器中间有一个过渡区。切换策略有两种硬切换在某个转速点直接切换。简单但容易产生转矩冲击。加权融合在过渡区对两种方法的估算结果做加权平均权重随转速线性变化。平滑但实现复杂。我一般用加权融合过渡区设在额定转速的5%到15%之间。权重函数用sigmoid或者线性函数都可以关键是保证切换过程中位置估算连续不能跳变。5. 从理论到代码的落地要点5.1 整体软件架构一个完整的HFI无感FOC软件通常包含以下模块PWM中断服务程序电流采样、Clarke/Park变换、电流环PI、SVPWM生成HFI注入模块生成注入电压叠加到d轴电压指令上解调模块带通滤波、同步解调、低通滤波PLL模块PI控制器、积分器模式切换模块低速HFI与高速观测器的切换逻辑保护模块过流、过压、过温保护这些模块都在PWM中断里执行中断频率通常等于PWM频率10kHz到20kHz。计算量不小需要合理分配时间。5.2 关键代码片段注入和解调的核心代码// 注入信号生成 theta_h delta_theta_h; if (theta_h TWO_PI) theta_h - TWO_PI; Vh_d_inject Vh * sinf(theta_h); // 叠加到d轴电压指令 Vd_ref Vd_pi Vh_d_inject; Vq_ref Vq_pi; // 电流采样后提取q轴高频分量 Iq_hp bandpass_filter(Iq_feedback); // 同步解调 Iq_demod Iq_hp * cosf(theta_h); // 低通滤波得到误差信号 epsilon lowpass_filter(Iq_demod); // PLL omega_hat pll_kp * epsilon pll_ki * integral_epsilon; integral_epsilon epsilon * Ts; theta_hat omega_hat * Ts;5.3 计算资源优化在低成本MCU上跑HFI计算资源往往紧张。几个优化技巧三角函数用查表线性插值比调用sinf/cosf快5到10倍滤波器用定点运算避免浮点开销如果MCU没有FPU注入频率和PWM频率保持整数比简化相位计算解调参考信号直接复用注入信号的相位不需要额外计算注意优化计算资源时不能牺牲数值稳定性。定点运算要注意溢出和精度损失滤波器系数的Q格式要选合适。5.4 调试工具与观测方法调试HFI时以下工具和观测方法非常有用示波器抓取q轴电流波形观察高频分量是否清晰DAC输出把解调后的误差信号和估计位置通过DAC输出用示波器观察收敛过程上位机波形通过串口或CAN把关键变量传到上位机用波形软件观察电流探头测量实际相电流验证注入效果我习惯在调试初期把误差信号和估计位置都DAC出来用示波器看。如果误差信号在零附近小幅波动说明PLL收敛了如果误差信号持续偏大说明解调增益不够或者滤波器有问题。6. 实际项目中的经验沉淀6.1 不同电机类型的适配策略HFI不是万能的不同电机类型需要不同的适配策略电机类型凸极率HFI效果适配建议表贴式PMSMLq/Ld ≈ 1.0-1.1差依赖饱和凸极需大注入幅值内嵌式PMSMLq/Ld ≈ 1.5-3.0好标准HFI即可永磁辅助同步磁阻Lq/Ld 3.0很好小注入幅值即可异步电机无凸极不适用需用其他方法对于表贴式PMSM凸极率很低HFI的效果主要靠饱和凸极效应。这时候注入幅值需要加大但加大注入又会带来噪声和损耗。所以表贴式电机的低速无感控制一直是难点工程上有时会妥协接受较低的位置精度或者用其他辅助手段。6.2 温度与老化对HFI的影响电机运行一段时间后温度升高永磁体磁链下降电感也会变化。这些变化会影响HFI的解调增益和PLL参数。实测数据一台IPM电机在冷态25°C和热态100°C下Lq变化约15%Ld变化约10%。解调增益K与ΔL成正比ΔL变化约20%意味着PLL的等效带宽变化约20%。如果PLL参数不调整热态下动态响应会变慢。应对方法在软件里加入温度补偿。如果电机有温度传感器可以根据温度查表调整PLL参数如果没有可以根据运行时间估算温升做粗略补偿。6.3 与其他无感方法的对比方法低速性能零速性能参数敏感性实现复杂度适用场景反电动势观测器差不可用中中中高速HFI好好高高低速和零速隆贝格观测器中差中中中高速滑模观测器中差低中中高速扩展卡尔曼滤波中差高高中高速模型参考自适应中差中中中高速HFI在低速和零速段的优势是其他方法无法替代的但它的参数敏感性和实现复杂度也是最高的。工程上通常将HFI与反电动势观测器结合低速用HFI高速用观测器取长补短。6.4 未来改进方向HFI技术本身还在演进几个值得关注的方向无滤波器解调用自适应观测器代替带通同步解调低通减少相位滞后提高动态响应多频率注入同时注入多个频率利用不同频率的响应差异提高鲁棒性机器学习辅助用神经网络拟合电感变化和位置误差的关系提高参数适应性宽禁带器件适配SiC和GaN器件开关频率高可以支持更高的注入频率提高信噪比这些方向目前还在研究阶段工业界落地的不多但值得关注。我个人在实际项目中的体会是HFI的调试时间通常比反电动势观测器长得多因为涉及的参数多、耦合强。但一旦调好低速性能的提升是质的飞跃。建议新手先从仿真入手用MATLAB/Simulink把整个链路跑通理解每个环节的作用再上实物调试。实物调试时先开环注入观察电流响应确认硬件采样没问题再闭环调PLL。这样一步步来比一上来就闭环调更容易找到问题。
