STM32 FOC开源算法解析与电机控制实践

1. STM32 FOC开源算法解析

深夜调试电机时偶然发现的STM32F0开发板，勾起了我对ST官方FOC开源代码的回忆。这套代码堪称FOC领域的"活化石"，虽然发布于多年前，但其中蕴含的设计思想至今仍值得玩味。与现在主流的CubeMX库不同，这套开源方案将FOC的底层实现完全暴露，特别适合想深入理解电机控制本质的开发者。

1.1 硬件平台特性

STM32F0系列作为ST的入门级MCU，其Cortex-M0内核主频仅48MHz，却成功实现了无感FOC控制。这套代码的精妙之处在于：

• 充分利用了STM32F0的1.25MSPS ADC采样率
• 精准利用了TIM1高级定时器的互补PWM输出
• 通过DMA实现了ADC采样与PWM的硬件级同步

在资源受限的平台上实现FOC，需要对每个时钟周期都精打细算。例如在ADC采样时，代码中采用了循环展开和寄存器级操作来减少指令周期。

1.2 代码架构分析

这套开源FOC代码采用模块化设计，主要包含以下几个核心组件：

1. 电流采样模块：支持单电阻和三电阻两种方案
2. 坐标变换模块：实现Clarke/Park变换及逆变换
3. 观测器模块：滑模观测器与反电动势估算的结合
4. PID调节模块：带抗饱和处理的PI控制器
5. SVPWM模块：包含死区补偿算法

每个模块都保持高内聚低耦合，通过清晰的接口定义进行交互。这种架构使得代码既便于学习理解，又方便进行功能扩展。

2. 电流采样方案实现细节

2.1 单电阻采样技术

单电阻方案通过在PWM周期不同时段采样相电流，再根据基尔霍夫电流定律重构三相电流。其核心挑战在于采样时机的精确控制。

c复制void ADC_Handler(void) {
    if(ADC_GetFlagStatus(ADC_FLAG_EOC)) {
        switch(sampling_phase) {
            case 0:  // 上管导通时段采样
                currA = ADC_GetValue() * voltage_scale;
                break;
            case 1:  // 下管导通时段采样
                currB = (ADC_GetValue() - currA) * voltage_scale;
                break;
            // 其他4个采样相位...
        }
        sampling_phase = (sampling_phase + 1) % 6;
    }
}

关键点说明：

1. voltage_scale需要根据具体硬件校准，包含：
   • 采样电阻阻值
   • 运放增益
   • ADC参考电压
2. 采样时机必须与PWM中心对齐模式严格同步
3. 电流重构算法需要考虑MOS管导通压降的影响

实际调试中发现，当PWM频率超过15kHz时，单电阻方案的电流波形会出现明显畸变。这是因为高PWM频率下可用的采样时间窗口过窄，导致ADC采样值不够准确。

2.2 三电阻采样方案

三电阻方案虽然硬件成本略高，但实现更简单可靠：

c复制void TIM1_UP_IRQHandler(void) {
    ADC_StartConversion();
    while(!ADC_GetFlagStatus(ADC_FLAG_EOC)); 
    currA_raw = ADC_GetValue(ADC_Channel_1);
    currB_raw = ADC_GetValue(ADC_Channel_2);
    currC_raw = ADC_GetValue(ADC_Channel_3);
    Clarke_Transform(currA_raw, currB_raw, currC_raw, &Ialpha, &Ibeta);
}

三电阻方案的优势：

• 可同时采样三相电流，无需复杂的时序控制
• 电流波形质量更好，特别适合高频PWM应用
• 对电机参数变化不敏感

但需要注意：

1. 三个采样通道的ADC特性应尽量一致
2. 采样电阻的温漂会影响测量精度
3. PCB布局需保证三相采样回路对称

3. 无感观测器实现原理

3.1 滑模观测器设计

这套代码采用了混合观测器设计，结合了滑模观测器和反电动势估算：

c复制void Observer_Update(float Ialpha, float Ibeta, float speed_est) {
    // 反电动势估算
    float Ealpha = -Lq * Ibeta * speed_est;
    float Ebeta = Ld * Ialpha * speed_est;
    
    // 滑模观测器
    float Zalpha = Kslide * sign(Ialpha_est - Ialpha);
    float Zbeta = Kslide * sign(Ibeta_est - Ibeta);
    
    // 角度估算
    theta_est = atan2f(Ebeta - Zbeta, Ealpha - Zalpha);
}

参数调试经验：

1. Kslide决定系统收敛速度，但过大会引起抖动
2. Ld和Lq参数误差会导致角度估算偏差
3. 低速时反电动势信号微弱，需要特殊处理

3.2 角度估算优化

为提高低速性能，代码中实现了以下优化：

• 采用移动平均滤波平滑角度输出
• 在启动阶段注入高频信号辅助观测
• 对atan2f结果进行象限校正

实测表明，这套观测器在100rpm以上能稳定工作，但在超低速时仍需改进。一种可行的方案是引入高频注入法作为补充。

4. FOC核心控制环路

4.1 控制时序设计

主控制循环采用10kHz频率运行：

c复制void FOC_Loop(void) {
    static uint32_t last_tick = 0;
    if(HAL_GetTick() - last_tick >= 100) {  // 10kHz控制频率
        Get_Phase_Currents();
        Clarke_Park_Transform();
        PI_Regulator_Update();
        Inverse_Park_Transform();
        SVM_Generate();
        last_tick = HAL_GetTick();
    }
}

实际应用中发现了几个时序问题：

1. HAL_GetTick()基于1ms定时器，精度不足
2. 各功能模块执行时间需要严格测量
3. 中断优先级配置不当会导致时序错乱

改进方案：

• 改用硬件定时器触发控制循环
• 使用DMA传输减轻CPU负担
• 优化代码执行路径

4.2 SVPWM与死区补偿

空间矢量PWM生成算法中包含了实用的死区补偿：

c复制void DeadTime_Compensation(float *Ualpha, float *Ubeta) {
    float deadtime_voltage = DEADTIME_US * BUS_VOLTAGE / PWM_PERIOD;
    if(*Ualpha > 0) *Ualpha -= deadtime_voltage;
    else *Ualpha += deadtime_voltage;
    // Beta轴同理...
}

死区补偿的关键：

1. DEADTIME_US需根据实际MOS管特性调整
2. 补偿电压与母线电压成正比
3. 补偿方向取决于电流方向

实测数据显示，合理的死区补偿可以提高电压利用率约5-8%，同时降低波形畸变。

5. 实际调试经验分享

5.1 参数整定方法

电机参数对控制性能影响巨大，推荐以下调试步骤：

1. 先调电阻Rs：通过直流注入法测量
2. 再调电感Ld/Lq：使用交流注入法
3. 最后调反电动势常数Ke：通过空载反电动势测量

调试技巧：

• 先开环运行验证基本参数
• 逐步提高速度环带宽
• 观察电流波形是否正弦

5.2 常见问题排查

1. 电机抖动问题：

   • 检查观测器参数是否合适
   • 确认电流采样是否准确
   • 调整速度环PID参数

2. 启动失败问题：

   • 检查初始角度检测逻辑
   • 验证启动电流限制是否生效
   • 调整开环启动参数

3. 高速失步问题：

   • 检查母线电压是否足够
   • 确认弱磁控制逻辑
   • 优化观测器带宽

这套开源FOC代码虽然年代较久，但其设计思想至今仍有参考价值。通过研究这些底层实现，可以深入理解FOC控制的本质，而不是仅仅停留在库函数调用的层面。对于想要真正掌握电机控制技术的开发者来说，这无疑是一份珍贵的学习资料。