高频注入FOC方案在无感PMSM控制中的应用与优化

1. 高频注入FOC方案概述

在无感永磁同步电机(PMSM)控制领域，低速和零速状态下的转子位置检测一直是个棘手问题。传统滑模观测器在200RPM以下基本失效，而高频注入法通过向电机注入特定高频信号并解调响应，实现了全速域范围内的稳定观测。我们基于STM32F4开发的这套方案，成功解决了堵转力矩波动、低速反转等业界常见痛点。

这套系统的核心优势体现在三个维度：

1. 低速稳定性：在0-200RPM区间仍能保持±1°的位置精度
2. 抗堵转能力：堵转时转矩脉动控制在额定值的3%以内
3. 动态响应：从零速到额定转速的加速时间比传统方案缩短40%

关键提示：高频注入方案对电机参数敏感性较高，建议先通过Matlab仿真确定电感参数，实测表明电感误差超过20%时观测精度会急剧下降。

2. 硬件设计关键点

2.1 电流采样电路设计

三相下桥臂电阻采样方案采用0.005Ω/2W的锰铜分流电阻，配合TI的INA240电流检测放大器。这个型号的共模抑制比(CMRR)达到110dB@100kHz，特别适合高频PWM环境。

运放输出端的RC滤波网络采用双0.1μF陶瓷电容并联设计：

• 电容材质：X7R介质，±10%容差
• 电阻取值：100Ω/0805封装
• 截止频率：$$f_c=\frac{1}{2πRC}=15.9kHz$$

实测数据对比：

2.2 功率驱动电路优化

MOSFET选用Infineon的IPD90N04S4，特别增加了：

1. 米勒钳位电路：采用15V稳压管串联100Ω电阻
2. 栅极驱动电阻：上拉4.7Ω，下拉2.2Ω
3. 死区时间：根据PWM频率动态调整，基准值为250ns

实测开关波形对比：

bash复制# 无米勒钳位时的振铃
Vds_ring = 28V (峰峰值)
trise = 32ns

# 添加钳位后
Vds_ring = 5V 
trise = 38ns

3. 软件算法实现

3.1 高频信号注入模块

在PWM载波中断(20kHz)中实现的正交信号注入：

c复制#define HF_FREQ     2500   // 2.5kHz注入频率
#define HF_AMPLITUDE (Vbus*0.12)  // 12%母线电压

void HF_Injection(float theta_e) {
    static float hf_angle = 0;
    hf_angle += _2PI * HF_FREQ * PWM_PERIOD;
    
    // Park逆变换注入
    Vd = Vd_ref; 
    Vq = Vq_ref;
    Valpha = Vd*cosf(theta_e) - Vq*sinf(theta_e) + HF_AMPLITUDE*sinf(hf_angle);
    Vbeta = Vd*sinf(theta_e) + Vq*cosf(theta_e) + HF_AMPLITUDE*cosf(hf_angle);
}

注入参数选择依据：

1. 频率应高于电流环带宽(通常1kHz)但低于PWM频率的1/5
2. 幅值建议在8-15%Vbus之间，过大导致转矩脉动，过小则信噪比不足

3.2 改进型锁相环观测器

位置解调算法采用正交相干检测：

c复制void PLL_Update(float i_alpha, float i_beta) {
    // 带通滤波(2kHz-3kHz)
    i_alpha_hf = BPF_Filter(i_alpha);
    i_beta_hf = BPF_Filter(i_beta);
    
    // 正交解调
    float err = i_beta_hf*cosf(hf_angle) - i_alpha_hf*sinf(hf_angle);
    
    // 自适应增益
    float gain = (fabsf(Est_Speed)<50) ? 2.0*HF_GAIN : HF_GAIN;
    
    // 锁相环更新
    Est_Speed += gain * err * DT;
    Est_Angle += Est_Speed * DT;
}

实测性能对比：

4. 堵转保护机制

4.1 智能降频策略

堵转判断逻辑采用双重条件：

c复制#define STALL_THRESHOLD  (I_rated*1.5)
#define SPEED_THRESHOLD  10  // RPM

if((fabsf(Iq_Ref) > STALL_THRESHOLD) && 
   (fabsf(Est_Speed) < SPEED_THRESHOLD)) {
    Stall_Counter++;
    if(Stall_Counter > 50) {
        // 分级降频
        PWM_Freq = (PWM_Freq > 10kHz) ? PWM_Freq/2 : 10kHz;
        Current_Limit *= 0.7;
    }
}

降频操作必须同步调整：

1. 死区时间：按公式 $$t_{dead} = \frac{100}{f_{PWM}} + 50$$ (ns)
2. 电流采样时机：延后至PWM周期中点
3. 观测器更新时间：保持与PWM周期同步

4.2 热管理策略

在降频同时启动温度补偿：

math复制I_{max} = I_{rated} \times \sqrt{\frac{T_{jmax} - T_{case}}{R_{thJC} \times P_{loss}}}

其中：

• $$T_{jmax}$$=150℃ (MOSFET结温)
• $$R_{thJC}$$=0.5℃/W (热阻)
• $$P_{loss}$$=导通损耗+开关损耗

5. 参数调试要点

5.1 电感不对称补偿

在motor_para.h中设置相位补偿：

c复制#define HF_PHASE_SHIFT  15  // 针对特定电机的补偿角度

调试步骤：

1. 让电机空载运行在50RPM
2. 观察Id电流分量，理想值应接近0
3. 调整HF_PHASE_SHIFT使Id最小化

5.2 观测器带宽调整

速度相关增益调整曲线：

基准值建议：

math复制Kp0 = \frac{R_s}{L_d}, \quad Ki0 = \frac{R_s}{L_q}

6. 实测性能数据

在400W/24V的PMSM上测试结果：

波形实测截图：

7. 工程文件使用说明

源码包目录结构：

code复制├── Core
│   ├── Src
│   │   ├── hfi.c        # 高频注入核心算法
│   │   └── pll_obs.c    # 改进型观测器
├── Drivers
│   ├── pwm_driver.c     # 带降频功能的PWM驱动
├── Matlab
│   ├── HFI_Model.slx    # 含磁饱和特性的仿真模型

关键参数修改位置：

1. 电机参数：motor_para.h中的POLE_PAIRS、RS、LD等
2. 注入参数：hfi_config.h中的HF_FREQ、HF_AMPLITUDE
3. 保护阈值：protection.h中的STALL_THRESHOLD

在移植到其他平台时需要注意：

1. PWM中断优先级必须高于其他电机控制中断
2. ADC采样必须与PWM中心对齐
3. 电流采样到运算的延迟需控制在5μs以内