1. 永磁同步电机无感FOC驱动框架概述
永磁同步电机（PMSM）的无传感器FOC（磁场定向控制）驱动技术，一直是电机控制领域的热点和难点。传统FOC依赖编码器获取转子位置，但在恶劣环境或成本敏感应用中，无感方案成为刚需。本项目实现了一套完整的无感FOC驱动框架，核心创新在于高频注入（HFI）启动与滑模观测器（SMO）的平滑切换技术。
这套方案最突出的特点是：
- 全速域覆盖：从零速到额定转速全程无感运行
- 平滑过渡：高频注入与反电动势观测器之间实现无扰动切换
- 轻量级实现：全部代码手写，无库依赖，可在资源受限的MCU上运行
提示：无感FOC的核心挑战在于低速时反电动势信号微弱难以检测，而高频注入法正好弥补了这一缺陷，但需要解决与中高速观测器的衔接问题。
2. 系统架构与工作原理
2.1 整体架构设计
系统采用三层模块化设计：
code复制高频注入模块 → 模式仲裁器 → 反电动势观测器
这种架构实现了估算源的自动切换，上层FOC控制器只需使用统一的接口信号（θ̂, ω̂, Q），无需关心底层采用何种估算方法。
2.2 高频注入模块详解
高频注入法利用了PMSM的磁饱和凸极效应（Ld≠Lq）。具体实现时：
-
信号注入：在d轴注入500Hz-1kHz的方波电压
- 方波注入相比正弦波节省了模拟滤波器
- 注入频率需避开机械谐振频率
-
响应解调：
c复制// 伪代码示例：正交锁相环解调 void QPLL_Update(float i_h, float dt) { float err = i_h * sin(2*PI*f_h*t); theta_hat += (Kp*err + Ki*err_integral) * dt; omega_hat = Kf*err; // 速度前馈 } -
退出条件：
- 连续N个周期速度超过阈值（如5%额定转速）
- Q-PLL相位误差小于设定值（如1°）
2.3 滑模观测器设计
中高速区采用滑模观测器，其核心方程为：
code复制s = α·(i_α - î_α) + β·sign(i_β - î_β)
关键实现要点：
- 滑模增益α、β根据电机参数离线优化
- 采用二阶IIR滤波器抑制高频抖振
- 截止频率随转速自适应调整
2.4 模式切换策略
模式仲裁器采用状态机实现平滑过渡：
-
状态转移逻辑：
- STANDBY → HFI_RUN：电机使能立即进入
- HFI_RUN → SWITCHING：Q值达标且速度超阈值
- SWITCHING → SMO_RUN：2ms内θ̂方差达标
-
过渡算法：
c复制// 交叉淡入淡出示例 for(int i=0; i<100; i++) { theta_hat = (1.0-i/100.0)*theta_hfi + (i/100.0)*theta_smo; delay(20us); }
3. 软件实现细节
3.1 实时控制环路设计
系统采用双环中断结构：
-
1kHz快速环（TIM1中断）：
- 电流采样与坐标变换
- FOC电流环计算
- 位置估算算法更新
- SVPWM生成
-
10kHz慢环（SysTick）：
- 速度环PI计算
- 故障检测与保护
- 温度监测等非实时任务
3.2 关键性能优化技巧
-
定点数优化：
c复制// 使用Q15格式的PI控制器示例 int16_t PI_Update(int16_t err) { static int32_t integral = 0; integral += Ki * err; integral = (integral > MAX_INTEGRAL) ? MAX_INTEGRAL : integral; return (Kp * err + (integral >> 15)); } -
内存管理：
- 高频注入缓冲区使用环形队列
- 滑模观测器状态变量分配到快速RAM区
- 所有全局变量标记为static限定作用域
-
计算加速：
- 使用硬件乘法器加速Park变换
- 查表法实现三角函数近似
- 汇编优化关键循环
4. 移植与调试指南
4.1 硬件抽象层设计
移植只需实现两个核心接口：
c复制// PWM输出接口
#define PWM_SET_DUTY(u, v, w) \
TIM1->CCR1 = (u); \
TIM1->CCR2 = (v); \
TIM1->CCR3 = (w)
// ADC采样接口
#define ADC_GET_IABC(iu, iv, iw) \
*(iu) = ADC1->DR; \
*(iv) = ADC2->DR; \
*(iw) = ADC3->DR
4.2 参数自整定方法
配套Python脚本通过串口自动化调试：
- 注入幅值扫描：寻找信噪比最佳点
- PLL带宽测试：阶跃响应分析
- 滑模增益优化：抗扰动测试
典型调试流程：
python复制# 自动化调试脚本示例
def auto_tune():
for amp in range(100,500,50):
send_command(f"hfi_amp {amp}")
resp = measure_noise()
if resp.snr > 20:
break
for bw in [50,100,150]:
send_command(f"pll_bw {bw}")
if step_response().settling_time < 0.1:
break
4.3 常见问题排查
-
启动失败：
- 检查注入信号是否正常（示波器观测PWM）
- 验证电流采样极性是否正确
- 调整初始位置猜测值
-
切换抖动：
- 检查过渡时间是否足够（建议2-5ms）
- 验证两个观测器的θ̂在切换点是否对齐
- 调整Q值阈值
-
高速失步：
- 检查滑模增益是否匹配当前转速
- 验证反电动势估算是否饱和
- 提高PWM频率或降低速度环带宽
5. 实测性能与优化建议
5.1 关键指标实测结果
在STM32G474平台测试表明：
- 启动时间：< 200ms（从静止到5%额定转速）
- 切换冲击：扭矩波动<3%，角度跳变<2°
- CPU占用率：1kHz环55%，10kHz环15%
- 内存占用：Flash 42KB，RAM 3.2KB
5.2 进一步优化方向
-
注入方式改进：
- 尝试脉冲振动注入替代连续波
- 研究旋转高频注入方案
-
观测器融合：
- 引入卡尔曼滤波融合多源信息
- 试验模型参考自适应方法
-
功能扩展：
- 添加参数在线辨识
- 实现故障诊断功能
这套框架在实际项目中已成功应用于电动工具、无人机电调等场景，经过-40℃~85℃环境验证，表现稳定可靠。开源代码保留了充分的扩展接口，便于二次开发。