stm32 FOC从学习开发（六）SVPWM算法实战：从扇区判断到PWM生成

1. SVPWM算法实战：从理论到代码的跨越

很多朋友在学习了SVPWM的理论知识后，面对实际代码实现时还是会一头雾水。今天我就用最直白的语言，带大家把算法一步步转化成STM32上的可运行代码。记得我第一次实现SVPWM时，在扇区判断那里卡了整整两天，后来才发现是三角函数的使用出了问题。下面这些经验都是用真金白银的调试时间换来的。

SVPWM算法的核心流程可以简化为四步：输入处理、扇区判断、时间计算、PWM生成。我们先看整体框架，用STM32的标准外设库来举例：

c复制void SVPWM_Generate(float Ualpha, float Ubeta) {
    // 1.扇区判断
    uint8_t sector = Get_Sector(Ualpha, Ubeta);
    
    // 2.计算作用时间
    Calc_Time(sector, Ualpha, Ubeta);
    
    // 3.生成PWM比较值
    Set_PWM_Compare(sector);
}

这个骨架看起来简单，但每个函数里都藏着魔鬼细节。比如在输入处理阶段，很多新手会忽略电压矢量的归一化处理。假设我们使用12V电源供电，PWM计数器周期值为1000，那么参考电压应该先除以直流母线电压，再乘以计数周期的一半：

c复制// 电压归一化示例
Ualpha = (Ualpha / Vdc) * (PWM_PERIOD / 2);
Ubeta = (Ubeta / Vdc) * (PWM_PERIOD / 2);

2. 扇区判断的工程实现技巧

2.1 告别三角函数：快速判断法

原始文章提到了用arctan判断扇区的方法，但在实际工程中我们绝对要避免使用三角函数！不仅计算量大，还会引入浮点误差。我在项目中发现的最优解是使用参考电压分量做线性比较：

c复制uint8_t Get_Sector(float Ualpha, float Ubeta) {
    float Uref1 = Ubeta;
    float Uref2 = (SQRT3 * Ualpha - Ubeta) / 2;
    float Uref3 = (-SQRT3 * Ualpha - Ubeta) / 2;
    
    int N = 0;
    if(Uref1 > 0) N += 1;
    if(Uref2 > 0) N += 2;
    if(Uref3 > 0) N += 4;
    
    const uint8_t sector_map[8] = {0,2,6,1,4,3,5,0};
    return sector_map[N];
}

这个方法的精妙之处在于：

1. 完全避免了三角函数运算
2. 通过简单的加减乘除完成判断
3. 最后的映射表处理了所有边界情况

2.2 边界条件处理实战

在实际电机控制中，参考电压矢量可能正好落在扇区边界上。这时如果处理不当会导致PWM输出抖动。我的经验是加入一个死区阈值：

c复制#define DEAD_ZONE 0.001f  // 根据实际精度需求调整

if(fabs(Uref1) < DEAD_ZONE) Uref1 = 0;
if(fabs(Uref2) < DEAD_ZONE) Uref2 = 0; 
if(fabs(Uref3) < DEAD_ZONE) Uref3 = 0;

3. 作用时间计算的优化之道

3.1 七段式VS五段式实现差异

原始文章对比了两种算法，但在工程实现时还有更多考量。这是七段式的典型时间分配：

c复制void Calc_Time(uint8_t sector, float Ualpha, float Ubeta) {
    // 计算XYZ
    float X = SQRT3 * Ubeta;
    float Y = SQRT3/2 * Ubeta + 1.5 * Ualpha;
    float Z = -SQRT3/2 * Ubeta + 1.5 * Ualpha;
    
    // 根据扇区选择有效时间
    switch(sector) {
        case 1: T1 = -Z; T2 = X; break;
        case 2: T1 = Y; T2 = Z; break;
        // 其他扇区类似...
    }
    
    // 零矢量平均分配
    T0 = (PWM_PERIOD - T1 - T2) / 2;
    T7 = T0;
}

而五段式的实现会更简洁，但要注意开关损耗问题：

c复制// 五段式只需计算主要矢量时间
T0 = PWM_PERIOD - T1 - T2;

3.2 过调制处理的工程技巧

当T1+T2超过PWM周期时，必须做过调制处理。但直接等比例压缩会影响线性度。我的解决方案是：

c复制if((T1 + T2) > PWM_PERIOD) {
    float sat_ratio = PWM_PERIOD / (T1 + T2);
    T1 *= sat_ratio;
    T2 *= sat_ratio;
    // 记录过调制标志，用于后续补偿
    over_modulation_flag = 1;
}

4. PWM生成的硬件级优化

4.1 定时器配置关键点

STM32的定时器配置直接影响波形质量。以下是TIM1的初始化要点：

c复制TIM_TimeBaseInitTypeDef TIM_BaseStruct;
TIM_BaseStruct.TIM_Prescaler = 0;
TIM_BaseStruct.TIM_CounterMode = TIM_CounterMode_CenterAligned3;
TIM_BaseStruct.TIM_Period = PWM_PERIOD;
TIM_BaseStruct.TIM_ClockDivision = 0;
TIM_TimeBaseInit(TIM1, &TIM_BaseStruct);

特别注意：

• 必须使用中央对齐模式
• 死区时间根据MOSFET规格设置
• 预分频器设为0以获得最高分辨率

4.2 比较值更新策略

不同扇区的PWM比较值生成是个重点难点。以扇区1为例：

c复制void Set_PWM_Compare(uint8_t sector) {
    switch(sector) {
        case 1:
            TIM1->CCR1 = (PWM_PERIOD - T1 - T2)/2;
            TIM1->CCR2 = TIM1->CCR1 + T1;
            TIM1->CCR3 = TIM1->CCR2 + T2;
            break;
        // 其他扇区类似...
    }
}

这里有个坑我踩过：STM32的CCRx寄存器是影子寄存器，直接连续写入可能导致时序错乱。安全的做法是：

c复制TIM1->CCR1 = val1;
TIM1->EGR = TIM_EGR_UG;  // 产生更新事件
TIM1->CCR2 = val2;
TIM1->EGR = TIM_EGR_UG;

5. 调试实战：示波器上的秘密

5.1 波形诊断技巧

健康的SVPWM波形应该具备：

1. 对称的马鞍形相电压
2. 线电压呈现完美的正弦波
3. 死区时间清晰可见

常见问题排查：

• 出现毛刺：检查死区时间配置
• 波形不对称：确认定时器是中央对齐模式
• 幅度不足：检查电压归一化计算

5.2 代码效率优化

在电机控制中，SVPWM算法需要每50-100us执行一次。经过实测，这些优化能提升30%性能：

1. 将SQRT3定义为宏：

c复制#define SQRT3 1.73205080757f

2. 使用查表法替代实时计算：

c复制const float SectorTimeCoef[6][3] = {
    {/* 扇区1系数 */ -1, 2, 1},
    {/* 扇区2系数 */ 1, 1, -2},
    // ...
};

3. 启用STM32的FPU加速浮点运算

6. 从MATLAB到C的迁移要点

很多朋友先用MATLAB验证算法，但移植到C时会出现问题。主要注意：

1. MATLAB的atan2函数和C库的行为差异
2. 矩阵运算要展开为基本运算
3. 仿真时的连续时间要离散化为PWM周期

这是我用的验证方法：

c复制// 在STM32中重建MATLAB测试案例
void Test_Sector_Judgment() {
    for(int i=0; i<6; i++) {
        float angle = i * 60 + 30;  // 测试每个扇区中心点
        float Ualpha = cos(angle * PI / 180);
        float Ubeta = sin(angle * PI / 180);
        assert(Get_Sector(Ualpha, Ubeta) == i+1);
    }
}

最后给个忠告：一定要在安全环境下测试，先用低压电源，确认所有波形正常后再上高压。我曾经因为一个符号错误烧毁了价值2000元的IPM模块，这个教训希望大家引以为戒。