从零搭建FOC电机控制：STM32 HAL库实战指南
1. 硬件准备与开发环境搭建
工欲善其事，必先利其器。在开始FOC电机控制项目前，我们需要准备一套完整的硬件开发环境和软件工具链。不同于传统理论推导，这里我们直接从实际工程角度出发，选择最具性价比的开发方案。
核心硬件组件清单：
- STM32F4系列开发板（推荐Nucleo-F446RE）
- DRV8301电机驱动板（或类似三相栅极驱动器）
- 无刷电机（BLDC/PMSM，建议先使用低KV值电机）
- 电流采样电阻（通常为5mΩ-10mΩ）
- 12V-24V直流电源
- 增量式编码器（1000线以上为佳）
开发环境配置步骤：
- 安装STM32CubeIDE（版本≥1.10）
- 下载STM32 HAL库最新版本
- 安装电机调试上位机（如MotorControl Workbench）
- 准备示波器（至少双通道，推荐带FFT功能）
注意：DRV8301驱动板需要正确配置死区时间，通常设置为500ns-1μs，具体值需参考MOSFET规格书。
2. CubeMX基础配置
启动STM32CubeMX后，按以下步骤进行关键外设配置：
2.1 PWM定时器设置
选择TIM1或TIM8高级定时器，配置为中央对齐模式1，PWM频率建议16kHz-20kHz：
// PWM初始化代码片段 htim1.Instance = TIM1; htim1.Init.Prescaler = 0; htim1.Init.CounterMode = TIM_COUNTERMODE_CENTERALIGNED1; htim1.Init.Period = SystemCoreClock / 16000 - 1; // 16kHz PWM htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; htim1.Init.RepetitionCounter = 0;2.2 ADC采样配置
配置3路ADC用于相电流采样，采用定时器触发采样：
// ADC配置关键参数 hadc1.Init.ClockPrescaler = ADC_CLOCK_SYNC_PCLK_DIV4; hadc1.Init.Resolution = ADC_RESOLUTION_12B; hadc1.Init.ScanConvMode = ENABLE; hadc1.Init.ContinuousConvMode = DISABLE; hadc1.Init.DiscontinuousConvMode = DISABLE; hadc1.Init.ExternalTrigConv = ADC_EXTERNALTRIGCONV_T1_TRGO;2.3 编码器接口配置
对于增量式编码器，配置TIM2/TIM3为编码器模式：
// 编码器接口配置 sConfig.EncoderMode = TIM_ENCODERMODE_TI12; sConfig.IC1Polarity = TIM_ICPOLARITY_RISING; sConfig.IC1Selection = TIM_ICSELECTION_DIRECTTI; sConfig.IC1Prescaler = TIM_ICPSC_DIV1; sConfig.IC1Filter = 6; // 适当滤波3. FOC算法实现
3.1 Clarke/Park变换实现
在STM32中高效实现坐标变换，采用定点数运算提升性能：
// Clarke变换实现 void Clarke_Transform(int32_t Ia, int32_t Ib, int32_t Ic, int32_t *Ialpha, int32_t *Ibeta) { *Ialpha = Ia; // 假设中性点电流为0，Ic = -Ia - Ib *Ibeta = (Ia + 2*Ib) * 11585 >> 15; // 1/sqrt(3) ≈ 11585/32768 } // Park变换实现 void Park_Transform(int32_t Ialpha, int32_t Ibeta, int32_t sin, int32_t cos, int32_t *Id, int32_t *Iq) { *Id = (Ialpha * cos + Ibeta * sin) >> 15; *Iq = (-Ialpha * sin + Ibeta * cos) >> 15; }3.2 PID调节器设计
实现抗积分饱和的PID控制器：
typedef struct { int32_t Kp; int32_t Ki; int32_t Kd; int32_t integral; int32_t prev_error; int32_t out_max; int32_t out_min; } PID_HandleTypeDef; int32_t PID_Update(PID_HandleTypeDef *hpid, int32_t error) { // 比例项 int32_t P = hpid->Kp * error; // 积分项（带抗饱和） hpid->integral += hpid->Ki * error; if(hpid->integral > hpid->out_max) hpid->integral = hpid->out_max; if(hpid->integral < hpid->out_min) hpid->integral = hpid->out_min; // 微分项 int32_t D = hpid->Kd * (error - hpid->prev_error); hpid->prev_error = error; // 输出限幅 int32_t output = P + hpid->integral + D; if(output > hpid->out_max) output = hpid->out_max; if(output < hpid->out_min) output = hpid->out_min; return output; }4. SVPWM生成与调试
4.1 扇区判断算法
优化后的扇区判断方法，减少计算量：
uint8_t SVM_Sector_Detect(int32_t Valpha, int32_t Vbeta) { int32_t Vref1 = Vbeta; int32_t Vref2 = (Valpha * 8867 >> 15) - (Vbeta >> 1); // sqrt(3)/2 ≈ 8867/32768 int32_t Vref3 = (-Valpha * 8867 >> 15) - (Vbeta >> 1); uint8_t N = 0; if(Vref1 > 0) N |= 0x04; if(Vref2 > 0) N |= 0x02; if(Vref3 > 0) N |= 0x01; const uint8_t sector_table[8] = {0,5,3,4,1,6,2,0}; return sector_table[N]; }4.2 七段式SVPWM实现
void SVM_Generate(uint8_t sector, int32_t T1, int32_t T2, int32_t *Tcmp) { int32_t Ta, Tb, Tc; int32_t T0 = (PWM_PERIOD - T1 - T2) >> 1; switch(sector) { case 1: Ta = T1 + T2 + T0; Tb = T2 + T0; Tc = T0; break; case 2: Ta = T1 + T0; Tb = T1 + T2 + T0; Tc = T0; break; // 其他扇区类似实现... } Tcmp[0] = Ta; Tcmp[1] = Tb; Tcmp[2] = Tc; }5. 系统调试与优化
5.1 电流采样校准
采用三点校准法提高采样精度：
| 校准点 | 操作步骤 | 预期结果 |
|---|---|---|
| 零点 | 电机断电，记录ADC值 | 应接近Vref/2 |
| 正满量程 | 给定最大正向电流 | ADC值接近3.3V |
| 负满量程 | 给定最大反向电流 | ADC值接近0V |
校准后计算增益和偏移：
// 校准参数计算 current_gain = (pos_adc - neg_adc) / (2 * max_current); current_offset = (pos_adc + neg_adc) / 2;5.2 PID参数整定
采用阶跃响应法进行参数整定：
- 先调P：逐步增大Kp直到系统出现轻微振荡
- 再调I：增加Ki消除稳态误差
- 最后调D：适量加入Kd抑制超调
典型电机PID初始参数范围：
| 控制环 | Kp | Ki | Kd |
|---|---|---|---|
| 电流环 | 0.5-2.0 | 100-500 | 0-0.1 |
| 速度环 | 0.1-0.5 | 10-50 | 0.5-2.0 |
| 位置环 | 5-20 | 0.1-1.0 | 10-50 |
5.3 常见问题排查
电机抖动问题：
- 检查编码器接线是否接触良好
- 验证SVPWM死区时间设置
- 降低速度环PID参数
过流保护触发：
- 检查电流采样电路相位是否正确
- 验证MOSFET驱动信号完整性
- 调整电机启动加速度
低速控制不稳：
- 启用高频注入(HFI)算法
- 提高编码器分辨率
- 优化观测器参数
6. 完整工程架构
项目应采用模块化设计，推荐以下文件结构：
foc_controller/ ├── Core/ │ ├── Src/ │ │ ├── foc_core.c # FOC算法核心 │ │ ├── svpwm.c # SVPWM生成 │ │ ├── pid_controller.c # PID实现 │ │ └── motor_control.c # 主控制逻辑 ├── Drivers/ │ └── DRV8301/ # 驱动板专用代码 └── Inc/ # 对应头文件关键数据结构设计：
typedef struct { int32_t Ialpha, Ibeta; // Clarke变换结果 int32_t Id, Iq; // Park变换结果 int32_t Vd, Vq; // PID输出 int32_t rotor_angle; // 电角度(0-32767对应0-360°) int32_t speed_rpm; // 转速(RPM) PID_HandleTypeDef pid_id; // d轴PID PID_HandleTypeDef pid_iq; // q轴PID } FOC_HandleTypeDef;主控制循环实现：
void FOC_Control_Loop(FOC_HandleTypeDef *hfoc) { // 1. 读取电流和位置 Current_Read(&Ia, &Ib); Encoder_Update(&angle); // 2. 执行坐标变换 Clarke_Transform(Ia, Ib, -Ia-Ib, &hfoc->Ialpha, &hfoc->Ibeta); Park_Transform(hfoc->Ialpha, hfoc->Ibeta, sin(hfoc->rotor_angle), cos(hfoc->rotor_angle), &hfoc->Id, &hfoc->Iq); // 3. PID调节 hfoc->Vd = PID_Update(&hfoc->pid_id, hfoc->Id_ref - hfoc->Id); hfoc->Vq = PID_Update(&hfoc->pid_iq, hfoc->Iq_ref - hfoc->Iq); // 4. 反Park变换 Inverse_Park(hfoc->Vd, hfoc->Vq, sin(hfoc->rotor_angle), cos(hfoc->rotor_angle), &Valpha, &Vbeta); // 5. 生成SVPWM sector = SVM_Sector_Detect(Valpha, Vbeta); SVM_Generate(sector, T1, T2, Tcmp); // 6. 更新PWM寄存器 PWM_Update(Tcmp[0], Tcmp[1], Tcmp[2]); }在项目实际调试中，建议先用示波器观察相电流波形，确保其正弦度良好。然后逐步提高转速设定值，同时监测电机运行状态。当遇到异常情况时，应立即切断电源，检查硬件连接和软件参数。
