PMSM无位置传感器控制的高频方波注入新方案

1. 项目背景与核心价值

高频方波注入法在永磁同步电机(PMSM)无位置传感器控制领域已经发展了十余年，但传统方案始终面临两个技术痛点：一是依赖数字滤波器带来的相位滞后问题，二是转子初始位置检测精度不足的隐患。我们团队在工业伺服项目实践中发现，这两个问题直接影响了电机启动性能和低速控制精度。

去年在为某精密数控机床配套伺服驱动时，就遇到过因初始位置检测偏差导致机床主轴启动抖动的问题。经过三个月技术攻关，我们开发出这套取消数字滤波器的新型高频注入方案，配合创新的初始位置检测算法，将位置检测误差控制在±0.5°以内。下面分享这套方案的Simulink仿真实现细节。

2. 系统架构设计解析

2.1 整体控制框架

系统采用典型的双闭环结构，但创新点在于信号处理环节：

code复制速度环PI → 电流环PI → 高频方波注入 → 响应提取 → 位置观测

与传统方案最大的区别在于去掉了数字滤波器模块，改为在Park逆变换环节直接处理高频信号。这种设计带来两个优势：

1. 避免了滤波器引起的相位滞后（实测可减少15°相位延迟）
2. 系统带宽提升约30%，更适合高动态响应场景

2.2 高频信号注入策略

采用2kHz方波电压注入，幅值取额定电压的15%。这个参数选择基于以下考量：

• 频率高于电机基频10倍以上，确保信号可分离
• 幅值足够产生可检测响应又不影响主功率输出
• 方波比正弦波更易实现且谐波丰富

关键实现代码：

matlab复制% 高频方波生成
hfi_signal = 0.15*Udc * square(2*pi*2000*t);
Vh = [hfi_signal; -hfi_signal; 0]; % 三相静止坐标系

3. 初始位置检测创新方案

3.1 脉冲矢量注入法

传统高频注入法在零速时无法区分N/S极，我们改进的脉冲序列包含6个空间矢量：

1. 注入幅值递增的6个基本电压矢量
2. 采集各矢量下的电流响应微分
3. 通过最小二乘法拟合电感椭圆

这种方法相比单矢量注入的优势：

• 信噪比提升40%以上
• 对电机参数变化不敏感
• 可同时辨识极性和位置

3.2 位置解算算法

建立电感椭圆方程：

code复制L(θ) = L0 + ΔL·cos(2θ-2θr)

通过奇异值分解(SVD)求解超定方程组，算法流程：

1. 构造包含所有矢量响应的Hankel矩阵
2. SVD分解获取椭圆参数
3. 计算长轴方向即为初始位置

实测在1ms内可完成解算，精度满足±0.5°要求。

4. 无滤波器信号处理技术

4.1 同步解调新方法

传统方案需要带通滤波器提取响应，我们改为：

1. 在Park变换中保留高频分量
2. 采用正交锁相环(QPLL)直接解调
3. 利用方波谐波特性进行相关运算

关键参数设置：

• QPLL带宽设为注入频率的1/10
• 相关运算窗口取1/4方波周期
• 采用滑动平均代替滤波

4.2 延时补偿设计

虽然取消滤波器减少了延时，但仍需补偿：

1. 计算控制周期带来的固定延时
2. 采用Smith预估器进行相位补偿
3. 动态调整观测器增益

补偿后的相位误差从15°降至3°以内。

5. Simulink仿真实现

5.1 主要模块配置

1. PMSM模型参数：

   • 额定功率：1.5kW
   • 极对数：4
   • Ld/Lq：5mH/8mH

2. 逆变器设置：

   • 开关频率：10kHz
   • 死区时间：2μs

3. 采样周期：

   • 控制周期：100μs
   • 观测周期：50μs

5.2 关键子系统实现

位置观测器采用Level-2 M代码实现：

matlab复制function [theta_est, omega_est] = observer(hfi_response, t)
    persistent last_theta;
    % 谐波幅值提取
    h1 = mean(hfi_response.*cos(2*pi*2000*t)); 
    h2 = mean(hfi_response.*sin(2*pi*2000*t));
    
    % 位置误差计算
    err = atan2(h2,h1)/2;
    
    % 自适应观测器
    k1 = 0.1; k2 = 0.01;
    omega_est = last_theta + k1*err;
    theta_est = omega_est + k2*err;
    
    last_theta = theta_est;
end

6. 实测问题与解决方案

6.1 高频噪声干扰

现象：电流采样出现毛刺
解决措施：

1. 增加硬件RC滤波（截止频率5kHz）
2. 软件采用中值滤波
3. 优化PCB布局减少耦合

6.2 低速抖动问题

现象：转速<50rpm时转矩波动
优化方案：

1. 引入转速前馈补偿
2. 调整观测器带宽
3. 增加死区补偿

6.3 参数敏感性测试

在不同电机参数下测试：

1. 电感变化±30%：位置误差<1°
2. 电阻变化±50%：基本无影响
3. 惯量变化：需调整观测器增益

7. 性能对比数据

与传统方案对比结果：

这套方案已在数控机床主轴驱动中量产应用，实测启动成功率达到99.9%以上。对于需要快速启停且要求低速平稳的场合，如机器人关节驱动、半导体设备等场景特别适用。