STM32_FOC_零电角度标定：从开环注入到编码器读数捕获

1. 什么是零电角度标定

零电角度标定是FOC（磁场定向控制）系统中一个关键步骤。简单来说，就是找到电机转子位置与定子绕组之间的对应关系。想象一下，你手里拿着一块磁铁靠近另一个磁铁，当两个磁铁的N极和S极完全对齐时，这个位置就是零电角度位置。

在实际电机控制中，我们需要把这个理论上的零电角度位置转化为编码器的具体读数。为什么要这么做呢？因为编码器是实时反馈转子位置的传感器，只有知道零电角度对应的编码器值，后续的FOC控制才能准确工作。

这个方法特别适合已经搭建好STM32硬件平台，使用编码器作为位置反馈的开发者。你可能已经完成了电机驱动电路、编码器接口等硬件设计，现在需要的就是这个关键的软件标定步骤。

2. 开环电流注入法原理

2.1 基本思路

开环电流注入法的核心思想很简单：我们强制让电机产生一个固定方向的磁场，然后读取此时编码器的值。具体来说：

1. 设定id=某个固定值（比如1），iq=0
2. 假设电角度θ=0
3. 通过Park逆变换得到iα和iβ
4. 生成SVPWM波形驱动电机
5. 读取编码器值作为零电角度偏移量

这相当于人为制造了一个"基准点"。因为iq=0，电机不会转动，但会有电流流过绕组产生固定磁场。这个磁场会吸引转子到一个固定位置，这个位置就是零电角度位置。

2.2 为什么选择开环方式

你可能会问：为什么不用闭环控制？主要有几个原因：

1. 闭环控制需要已经校准好的参数，而我们现在连零电角度都不知道
2. 开环方式实现简单，不需要复杂的控制算法
3. 标定过程通常只需要很短时间，开环方式完全够用

不过要注意，这种方法会让电机发热，所以标定完成后要尽快断电。我在实际项目中就遇到过因为标定时间过长导致电机烫手的情况。

3. STM32硬件配置要点

3.1 PWM定时器配置

在STM32CubeMX中配置PWM时，有几个关键点需要注意：

1. 使用高级定时器TIM1或TIM8
2. 选择中心对齐模式（Center Aligned mode）
3. 配置正确的预分频和自动重载值(ARR)
4. 设置合适的PWM模式

以TIM1为例，假设主频是168MHz，通常我会这样配置：

c复制htim1.Instance = TIM1;
htim1.Init.Prescaler = 1;  // 2分频
htim1.Init.CounterMode = TIM_COUNTERMODE_CENTERALIGNED1;
htim1.Init.Period = 500;   // ARR值
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
htim1.Init.RepetitionCounter = 0;
htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_ENABLE;

3.2 编码器接口配置

编码器接口通常使用通用定时器（如TIM2/TIM3）的编码器模式。配置时要注意：

1. 选择正确的编码器模式（通常是TI1和TI2都计数）
2. 设置合适的分辨率
3. 确保GPIO引脚配置正确

c复制htim2.Instance = TIM2;
htim2.Init.Prescaler = 0;
htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
htim2.Init.Period = 0xFFFF;
htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
sConfig.EncoderMode = TIM_ENCODERMODE_TI12;
sConfig.IC1Polarity = TIM_ICPOLARITY_RISING;
sConfig.IC1Selection = TIM_ICSELECTION_DIRECTTI;
sConfig.IC1Prescaler = TIM_ICPSC_DIV1;
sConfig.IC1Filter = 0;

4. 软件实现详解

4.1 开环控制代码实现

让我们看看具体的代码实现。首先是Park逆变换部分：

c复制void Get_EncoderOffset_Of_Zero_Electric_Angle_Method_1(void){
    float TempVar1 = 0.0f;
    float TempVar2 = 0.0f;
    
    id = 1;  // 设定id值
    theta = 0.0f;  // 假设电角度为0
    
    // 计算sin/cos值
    sin_theta = arm_sin_f32(theta);
    cos_theta = arm_cos_f32(theta);
    
    // Park逆变换
    V_Alpha = (id*cos_theta - iq*sin_theta);
    V_Beta = (id*sin_theta + iq*cos_theta);
    
    // 后续SVPWM生成代码...
}

这段代码的关键点：

1. 设定id=1，iq=0（全局变量默认已设为0）
2. 假设电角度θ=0
3. 使用ARM数学库计算sin/cos值
4. 进行Park逆变换得到Vα和Vβ

4.2 SVPWM生成逻辑

接下来是SVPWM的生成逻辑，这是整个标定过程的核心：

c复制// 确定扇区
TempVar1 = V_Alpha * 0.86602540378444f;  // √3/2
TempVar2 = V_Beta * 0.5f;
SectorJudgmentFactor1 = TempVar1 - TempVar2;
SectorJudgmentFactor2 = - TempVar1 - TempVar2;

SectorNum = 0;
if( V_Beta >= 0) SectorNum = SectorNum + 1;
if( SectorJudgmentFactor1 >= 0 ) SectorNum = SectorNum + 2;
if( SectorJudgmentFactor2 >= 0 ) SectorNum = SectorNum + 4;

// 计算中间变量
MiddleTerm_X = V_Beta;
MiddleTerm_Y = TempVar1 + TempVar2;
MiddleTerm_Z = -TempVar1 + TempVar2;

// 扇区处理逻辑
switch(SectorNum){
    case 1:
        t_first = MiddleTerm_Z;
        t_second = MiddleTerm_Y;
        // 过调制处理
        if(t_first + t_second > 1){
            t_firstaddsecond = t_first + t_second;
            t_first = t_first / t_firstaddsecond;
            t_second = t_second / t_firstaddsecond;
        }
        t_a = (1 - t_first - t_second)*0.5f;
        t_b = t_a + t_first;
        t_c = t_b + t_second;
        t_cm1 = t_b;
        t_cm2 = t_a;
        t_cm3 = t_c;
        break;
    // 其他扇区处理...
}

// 设置PWM比较值
TIM1_CH1_CMP_VAL = (uint16_t)((t_cm1)*500.0f);
TIM1_CH2_CMP_VAL = (uint16_t)((t_cm2)*500.0f);
TIM1_CH3_CMP_VAL = (uint16_t)((t_cm3)*500.0f);
TIM1->CCR1 = TIM1_CH1_CMP_VAL;
TIM1->CCR2 = TIM1_CH2_CMP_VAL;
TIM1->CCR3 = TIM1_CH3_CMP_VAL;

这段代码做了以下几件事：

1. 根据Vα和Vβ确定当前扇区
2. 计算各扇区的作用时间
3. 处理过调制情况
4. 计算最终的PWM占空比并设置比较寄存器

4.3 编码器读数捕获

当电机被固定在一个位置后，我们需要读取编码器的值：

c复制uint16_t Get_EncoderValue(void){
    return TIM2->CNT;  // 假设编码器接在TIM2上
}

void Calibrate_Zero_Angle(void){
    motor_start();  // 使能电机驱动
    Get_EncoderOffset_Of_Zero_Electric_Angle_Method_1();
    HAL_Delay(100);  // 等待稳定
    uint16_t encoder_zero = Get_EncoderValue();
    motor_stop();  // 立即断电
    
    // 保存encoder_zero到Flash或其他存储介质
    Save_Zero_Offset(encoder_zero);
}

这里有几个注意事项：

1. 要给电机足够的时间稳定（但不要太久，避免过热）
2. 读取编码器值后要立即断电
3. 最好将标定值保存到非易失性存储器中

5. 实际应用中的优化建议

5.1 减少电机发热的方法

在实际项目中，我发现电机发热是个常见问题。通过以下方法可以缓解：

1. 降低id值：不一定非要用1，可以尝试0.5或更低
2. 缩短标定时间：100ms通常足够，不要超过500ms
3. 增加散热措施：特别是需要频繁标定的场合

我曾经在一个项目中因为标定时间设置过长（1秒），导致电机温度快速上升，后来调整到200ms就解决了问题。

5.2 提高标定精度的技巧

要提高标定精度，可以考虑：

1. 多次测量取平均：进行3-5次标定，取中间值
2. 检查机械安装：确保编码器与电机轴连接牢固
3. 滤波处理：对编码器读数进行简单滤波

c复制#define CALIBRATION_TIMES 5

uint16_t Do_Calibration(void){
    uint16_t values[CALIBRATION_TIMES];
    
    for(int i=0; i<CALIBRATION_TIMES; i++){
        Calibrate_Zero_Angle();
        values[i] = Get_EncoderValue();
        HAL_Delay(500);  // 让电机冷却
    }
    
    // 简单的排序取中值
    Bubble_Sort(values, CALIBRATION_TIMES);
    return values[CALIBRATION_TIMES/2];
}

5.3 异常情况处理

在实际应用中，可能会遇到各种异常情况：

1. 编码器读数跳变：检查编码器供电和信号线
2. 电机不固定位置：检查电流是否真的注入，PWM是否正常工作
3. 读数不一致：可能是机械阻力过大，尝试手动转动转子后再标定

我遇到过最棘手的问题是编码器读数不稳定，最后发现是电源噪声导致的，增加滤波电容后就解决了。