1. 项目概述
永磁同步电机（PMSM）的无传感器FOC控制一直是电机驱动领域的热点技术。这次我们要探讨的是基于STM32F405微控制器实现的高频方波注入（HFI）方案，这种方案特别适合低速和零速工况下的转子位置检测。
在实际工业应用中，传统的位置传感器不仅增加系统成本，还降低了可靠性。我在多个伺服驱动项目中验证过，采用HFI方案后，系统BOM成本可降低15-20%，同时避免了编码器连接线带来的故障风险。STM32F405凭借其Cortex-M4内核和硬件FPU，完全能够胜任这种需要复杂数学运算的实时控制任务。
2. 硬件设计关键点
2.1 主控选型考量
选择STM32F405RG主要基于三个关键因素：
- 168MHz主频配合硬件FPU，能实时完成Clarke/Park变换和SVPWM生成
- 内置3个12位ADC模块，支持同步采样
- 丰富的定时器资源（特别是TIM1/TIM8高级定时器）
注意：实际使用中发现，当PWM频率超过15kHz时，建议开启I-Cache，否则会出现计算延迟。
2.2 功率驱动电路设计
逆变桥采用三菱的IPM模块（如PS21865），其内置死区保护和故障检测功能。关键参数配置：
- 母线电压：48VDC
- 最大相电流：20A（峰值）
- PWM载波频率：10kHz
- 死区时间：1μs（通过TIM1_BDTR寄存器配置）
2.3 电流采样方案
采用双电阻采样+运放调理方案：
- 在下桥臂采样电阻两端接入INA240电流检测放大器
- 配置ADC为三重交替采样模式，触发信号来自TIM1的CC4事件
- 采样时刻设置在PWM周期中点（计数器的ARR/2处）
3. HFI算法实现细节
3.1 高频信号注入原理
在d轴注入2kHz方波电压信号（幅值约15%Vbus），通过q轴电流响应来提取转子位置信息。数学表达式：
Vdh = Vh·sign(sin(ωht))
Vqh = 0
响应电流包含位置信息：
iqh ≈ (Ld-Lq)Vh/(ωhLdLq) · sin(2θr)
3.2 位置观测器设计
采用锁相环（PLL）结构的位置观测器实现框图：
- 带通滤波器（中心频率2kHz）提取q轴高频电流
- 同步解调器与注入信号相乘
- 低通滤波器得到位置误差信号
- PI调节器输出转速估计值
- 积分环节得到转子位置
关键参数经验值：
- BPF带宽：±200Hz
- LPF截止频率：100Hz
- PI参数：Kp=50, Ki=500
3.3 代码实现技巧
在STM32CubeIDE中，将算法分为三个任务：
-
高速任务（10kHz）：
- ADC采样完成中断中执行电流读取和Park变换
- 计算并更新PWM占空比
-
中速任务（1kHz）：
- 执行位置观测器算法
- 更新速度环PI调节器
-
低速任务（100Hz）：
- 监控系统状态
- 处理通信指令
实测技巧：将数学运算函数放在RAM中执行（使用__attribute__((section(".ramfunc")))），可减少约20%的计算时间。
4. 调试经验与问题排查
4.1 典型问题分析表
| 现象 | 可能原因 | 解决方案 |
|---|---|---|
| 电机抖动 | 位置观测器带宽过高 | 降低PI增益，增加LPF截止频率 |
| 零速失步 | 注入信号幅值不足 | 逐步增大Vh至15-20%Vbus |
| 高速切换失败 | 观测器收敛时间不足 | 增加速度环切换阈值（>5%额定转速） |
4.2 关键调试步骤
-
静态测试：
- 断开电机，注入固定频率信号
- 用示波器观察电流响应波形
- 调整BPF参数使信号幅值最大
-
开环测试：
- 强制给定θ=0，缓慢增加Vq
- 确认电机转向与理论一致
- 检查解调信号极性
-
闭环切换：
- 先在5%额定转速下稳定运行
- 逐步降低速度指令至零
- 观察位置误差是否收敛
5. 性能优化方向
5.1 参数自整定方案
开发自动调参流程：
- 扫描不同频率下的电流响应幅值
- 自动选择最佳注入频率（通常在1-3kHz）
- 根据响应幅值动态调整Vh
5.2 混合观测器设计
在高速区切换至反电动势法：
- 设置合理的切换阈值（约10%额定转速）
- 加入过渡区平滑算法
- 我在实际项目中采用加权平均过渡，过渡时间控制在100ms内
5.3 死区补偿改进
针对HFI特有的问题：
- 检测电流过零点的PWM模式切换
- 根据电流极性动态调整补偿量
- 补偿公式：
Vcomp = (Tdead/Tpwm)·Vbus·sign(I)
这个方案经过72小时连续老化测试，位置误差能稳定在±5电角度以内，完全满足大多数工业应用需求。对于需要更高精度的场合，可以考虑结合初始位置检测算法，在启动前先进行转子预定位。