在STM32的FOC（磁场定向控制）算法中，转子角度的还原是实现电机闭环控制的核心步骤。以下是角度还原的常见方法及注意事项：

1. 角度还原的两种场景

(1) 有传感器方案（如编码器、霍尔传感器）

• 原理：通过硬件传感器直接测量转子位置。
• 实现步骤：
  1. 配置定时器：使用STM32的编码器接口（如TIM1/TIM8）读取编码器脉冲。
  2. 计算机械角度：

     // 假设编码器分辨率为 ENCODER_RESOLUTION，电机极对数为 POLE_PAIRS
     mechanical_angle = (float)encoder_count / ENCODER_RESOLUTION * 360.0f;

  3. 电角度转换：
     电角度 = 机械角度 × 极对数（electrical_angle = mechanical_angle * POLE_PAIRS）

(2) 无传感器方案（如滑模观测器、龙伯格观测器）

• 原理：通过反电动势或电流模型估算转子角度。
• 关键代码（以ST MotorControl库为例）：

  // 通过观测器获取估算的电角度（弧度）
  float estimated_angle = STO_GetEstimatedAngle(&Motor_STO);
  // 转换为机械角度（若需要）
  mechanical_angle = estimated_angle / POLE_PAIRS;

2. 常见问题及解决

• 角度跳变或抖动：

  • 检查传感器信号是否受干扰（如编码器线缆屏蔽不良）。
  • 调整观测器滤波器参数（如STO_LPF_BANDWIDTH）。

• 电角度与机械角度混淆：

  • 确保在Clark/Park变换中使用电角度，机械角度仅用于位置控制。

• 极对数设置错误：

  • 验证POLE_PAIRS宏定义是否与电机实际参数一致。

3. 代码示例（无传感器FOC）

#include "mc_parameters.h"
#include "motor_control.h"

void UpdateAngle() {
    // 估算电角度（弧度）
    float electrical_angle = STO_GetEstimatedAngle(&Motor_STO);

    // 转换为0~360°机械角度
    float mechanical_angle = electrical_angle * (180.0f / PI) / POLE_PAIRS;
    mechanical_angle = fmod(mechanical_angle, 360.0f);

    // 用于位置控制或显示
    printf("当前机械角度: %.2f°\n", mechanical_angle);
}

4. 关键配置检查

• STM32CubeMX：确保编码器接口或ADC采样配置正确。
• MotorControl Workbench：
  • 检查motor_parameters.h中的POLE_PAIRS、ENCODER_RESOLUTION等参数。
  • 调整观测器参数（如STO_C1、STO_C2）以优化动态响应。

通过上述方法，可准确获取或估算电机转子角度。若问题仍存在，建议结合示波器观察电流波形或使用ST的Motor Profiler工具进行实时调试。