STM32G431 FOC程序深度解析：从状态机到SVPWM的电机控制逻辑

最近在调试一个基于STM32G431的无刷电机FOC驱动项目时，发现网上很多开源代码虽然功能完整，但程序逻辑和代码结构对初学者来说犹如“黑盒”，尤其是中断服务程序、状态机切换和SVPWM生成部分，理解起来非常困难。本文将深入剖析一个典型的开源STM32G431 FOC程序，从工程结构、主循环逻辑到核心算法实现，手把手带你理清代码脉络，让你不仅能跑通Demo，更能理解其背后的设计思想。无论你是刚接触电机控制的在校学生，还是希望将FOC算法应用到实际产品中的工程师，这篇文章都能为你提供清晰的路径。

1. FOC与STM32G431：背景与核心概念

在深入代码之前，我们有必要统一一下认知基础。FOC（Field-Oriented Control，磁场定向控制），又称矢量控制，是现代高性能交流电机驱动的核心技术。它的核心思想是模仿直流电机的控制方式，通过坐标变换（Clark变换、Park变换及其逆变换），将三相交流电机的定子电流分解为相互垂直的转矩电流分量（Iq）和励磁电流分量（Id）。通过独立控制Iq和Id，就能像控制直流电机一样，实现对交流电机转矩和磁场的精准、快速解耦控制，从而获得优异的动态性能和高效率。

无刷电机（Brushless DC Motor, BLDC）和永磁同步电机（PMSM）是FOC技术最主要的应用对象。两者结构相似，但反电动势波形不同（BLDC为梯形波，PMSM为正弦波），因此控制策略略有差异。本文讨论的开源项目通常针对PMSM设计，但其核心框架对BLDC的FOC控制同样具有极高的参考价值。

那么，为什么是STM32G431？STM32G4系列是意法半导体推出的混合信号MCU，它在经典的Cortex-M4内核基础上，集成了丰富的模拟外设和高分辨率定时器，天生为数字电源和电机控制而生。STM32G431更是其中的“性价比明星”，它具备：

• 高分辨率定时器（HRTIM）：这是实现高精度、多通道PWM输出的关键，尤其适合生成FOC所需的SVPWM波形。
• 运算放大器（OPAMP）：可直接用于电流采样信号的调理，简化硬件电路。
• ADC：支持快速同步采样，与HRTIM联动，实现精准的电流环采样时刻控制。
• DAC：可用于输出内部变量（如Iq, Id）进行观测调试。

因此，基于STM32G431搭建FOC驱动平台，可以最大程度地发挥芯片性能，减少外部元件，是学习与实践电机控制的绝佳选择。

2. 开源工程环境准备与整体结构解析

首先，我们需要获取并搭建开发环境。常见的开源STM32G431 FOC工程多基于STM32CubeMX初始化，并使用HAL库或LL库进行开发。

开发环境准备：

• IDE: STM32CubeIDE（推荐，集成了CubeMX和编译调试环境）或 Keil MDK、IAR。
• 固件库: STM32CubeG4 Firmware Package。确保你的CubeIDE或CubeMX已安装G4系列的固件支持包。
• 硬件: 一块STM32G431核心板或自制板，一个三相逆变桥（如DRV8301、IR2136等驱动芯片搭建的电路），一个PMSM电机，以及电流采样电路（通常采用采样电阻+运放）。
• 调试工具: ST-Link或其他兼容的调试器，用于下载程序和实时调试。

典型开源工程目录结构：一个结构清晰的FOC工程通常如下所示：

FOC_Project/ ├── Core/ │ ├── Inc/ // 头文件 │ │ ├── main.h │ │ ├── foc.h // FOC核心算法头文件 │ │ ├── pwm.h // PWM驱动头文件 │ │ ├── adc.h // ADC处理头文件 │ │ └── ... │ └── Src/ // 源文件 │ ├── main.c │ ├── foc.c │ ├── pwm.c │ ├── adc.c │ └── ... ├── Drivers/ │ ├── CMSIS/ // Cortex微控制器软件接口标准 │ └── STM32G4xx_HAL_Driver/ // HAL库 ├── Middlewares/ // 中间件（如有） └── STM32G431CBUx_FLASH.ld // 链接脚本

理解这个结构是分析程序逻辑的第一步。我们的分析将主要集中在Core/Src和Core/Inc下的核心业务文件。

3. 程序主框架与状态机逻辑

任何可靠的电机驱动程序都必须有一个清晰的状态机来管理电机的运行状态，这是程序安全性的基石。我们来看一个典型的状态机设计。

3.1 电机状态定义

通常在foc.h或一个专门的motor.h中定义状态枚举。

// Core/Inc/motor_ctrl.h typedef enum { MOTOR_STATE_IDLE = 0, // 空闲状态，PWM关闭 MOTOR_STATE_ALIGN, // 初始角度对齐（对于有感或初始位置检测） MOTOR_STATE_OPEN_LOOP, // 开环启动（对于无感FOC） MOTOR_STATE_CLOSED_LOOP, // 闭环运行（FOC正常模式） MOTOR_STATE_FAULT, // 故障状态（过流、过温等） MOTOR_STATE_STOP // 停止状态（准备停止或故障后停止） } MotorState_t;

3.2 主循环与状态切换逻辑

在main.c的主循环中，状态机被持续执行。

// Core/Src/main.c int main(void) { // HAL初始化、时钟配置、外设初始化... System_Init(); // 系统初始化 Motor_Init(); // 电机控制相关外设初始化（PWM, ADC, GPIO等） FOC_Init(); // FOC算法变量初始化 MotorState_t motor_state = MOTOR_STATE_IDLE; uint32_t loop_counter = 0; while (1) { // 1. 状态机执行 switch (motor_state) { case MOTOR_STATE_IDLE: // 等待启动命令（如按键按下、串口指令） if (start_command_received) { motor_state = MOTOR_STATE_ALIGN; // 或 MOTOR_STATE_OPEN_LOOP Start_Motor_Procedure(); } break; case MOTOR_STATE_ALIGN: // 执行角度对齐，持续固定时间或达到条件 if (alignment_complete) { motor_state = MOTOR_STATE_OPEN_LOOP; } // 在此状态下，可能强制输出一个固定的电压矢量，将转子拉到已知位置 break; case MOTOR_STATE_OPEN_LOOP: // 开环强拉阶段，逐步提高电角度和电压，让电机转起来 Run_Open_Loop(); // 判断是否达到切入闭环的条件（如速度足够、反电动势可观测） if (speed_estimated > SWITCH_THRESHOLD) { motor_state = MOTOR_STATE_CLOSED_LOOP; } break; case MOTOR_STATE_CLOSED_LOOP: // 正常的FOC闭环运行状态 // 此状态下，速度环、电流环、观测器（无感）等核心算法被调用 Run_FOC_Closed_Loop(); // 检查停止命令或故障 if (stop_command_received) { motor_state = MOTOR_STATE_STOP; } if (check_fault_condition()) { motor_state = MOTOR_STATE_FAULT; } break; case MOTOR_STATE_FAULT: // 立即关闭PWM输出，锁定状态 PWM_DisableOutput(); // 执行故障处理（如点亮LED，上报错误码） Handle_Fault(); // 等待故障复位 if (fault_cleared) { motor_state = MOTOR_STATE_IDLE; } break; case MOTOR_STATE_STOP: // 平滑停止或快速停止 Stop_Motor_Procedure(); if (motor_is_stopped) { motor_state = MOTOR_STATE_IDLE; } break; } // 2. 非实时任务处理（每N个循环执行一次） loop_counter++; if (loop_counter >= 1000) { loop_counter = 0; // 例如：更新上位机数据、检查通讯、非关键的LED闪烁 Process_Non_RealTime_Tasks(); } // 3. 后台任务（如空闲时运行） // HAL_Delay(1); // 注意：在实时控制中慎用阻塞延时，通常用非阻塞方式 } }

这个状态机清晰地划分了电机从启动到运行再到停止的完整生命周期，确保了控制的稳定和安全。逻辑的核心在于：状态切换的条件必须明确、可靠，且从任何状态都能安全地跳转到故障或停止状态。

4. 中断服务程序：实时控制的引擎

FOC是一个高实时性的任务，其核心计算（电流采样、坐标变换、PI调节、SVPWM生成）必须严格定时执行，通常放在高优先级的中断服务程序中。

4.1 PWM定时器中断与ADC触发

最关键的定时器是用于生成SVPWM的定时器（如HRTIM或高级定时器TIM1）。我们配置它在每个PWM周期中点或下溢时产生中断，并在此中断中触发ADC采样。

// Core/Src/stm32g4xx_it.c (或对应的定时器中断回调函数) // 假设使用HRTIM的Master Timer Period事件 void HRTIM1_Master_IRQHandler(void) { if (__HAL_HRTIM_GET_FLAG(&hhrtim1, HRTIM_FLAG_MPER)) { __HAL_HRTIM_CLEAR_FLAG(&hhrtim1, HRTIM_FLAG_MPER); // 1. 触发ADC同步采样两相电流（第三相可通过计算得出） HAL_ADC_Start(&hadc1); // 采样Ia HAL_ADC_Start(&hadc2); // 采样Ib // 通常使用双ADC同步触发模式，这里简化表示 // 2. 置位一个标志，通知主循环或另一个优先级稍低的中断进行处理 g_foc_calc_flag = 1; } }

为什么在PWM周期中点采样？因为此时三相桥臂的开关状态稳定，电流纹波较小，采样值最能代表该周期的平均电流，准确性最高。

4.2 ADC采样完成中断与FOC计算链

ADC采样完成后，进入ADC转换完成中断（或DMA传输完成中断），在这里执行最核心的FOC计算。

// ADC转换完成中断回调函数（或在DMA完成中断中调用） void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef* hadc) { // 确保两路ADC都采样完成（实际中可能有更严谨的同步机制） static uint8_t adc_sample_count = 0; adc_sample_count++; if (adc_sample_count >= 2) { // 两相电流采样完成 adc_sample_count = 0; // 1. 读取ADC值并转换为实际电流值（安培） g_Ia = (ADC1_VALUE - ADC_OFFSET) * CURRENT_SENSE_GAIN; g_Ib = (ADC2_VALUE - ADC_OFFSET) * CURRENT_SENSE_GAIN; g_Ic = -g_Ia - g_Ib; // 克拉克变换约束，三相电流和为0 // 2. 执行FOC计算（这是一个函数，内部包含完整链） FOC_Current_Loop_Handler(g_Ia, g_Ib, g_electrical_angle, g_Vd_ref, g_Vq_ref); // 3. 更新PWM占空比 PWM_UpdateDutyCycle(g_PWM_duty_a, g_PWM_duty_b, g_PWM_duty_c); } }

这个中断服务程序的执行时间直接决定了电流环的带宽，因此里面的代码必须高度优化，避免浮点除法和复杂的函数调用（在G431的硬件浮点单元支持下，单精度浮点计算已很快，但仍需注意）。

5. FOC核心算法链详解

现在，我们进入最核心的部分——FOC_Current_Loop_Handler函数内部的逻辑。这是将电流采样值转化为PWM占空比的完整数学过程。

5.1 克拉克变换（Clark Transform）

将测得的三相静止坐标系电流Ia, Ib, Ic变换到两相静止坐标系Iα, Iβ。

// Core/Src/foc.c void Clark_Transform(float Ia, float Ib, float Ic, float *Ialpha, float *Ibeta) { // 对于三相对称系统，Ic = -Ia - Ib，所以有时只采样两相 *Ialpha = Ia; // 或 Ia *Ibeta = (ONE_BY_SQRT3 * Ia + TWO_BY_SQRT3 * Ib); // 常数：1/√3 和 2/√3 // 更常见的公式：Ialpha = Ia, Ibeta = (Ia + 2*Ib)/√3 // 具体系数取决于变换的等幅值或等功率定义，开源工程需确认其采用的定义。 }

5.2 帕克变换（Park Transform）

将两相静止坐标系Iα, Iβ变换到随转子磁场旋转的两相旋转坐标系Id, Iq。这需要当前的电角度θ。

void Park_Transform(float Ialpha, float Ibeta, float angle, float *Id, float *Iq) { float cos_theta = arm_cos_f32(angle); float sin_theta = arm_sin_f32(angle); *Id = Ialpha * cos_theta + Ibeta * sin_theta; *Iq = -Ialpha * sin_theta + Ibeta * cos_theta; }

Id和Iq的物理意义：Iq直接产生转矩，Id用于控制磁场（对于表贴式PMSM，通常控制Id=0以获取最大转矩电流比）。

5.3 PI控制器调节

分别对Id和Iq进行PI调节，输出旋转坐标系下的电压指令Vd, Vq。

typedef struct { float Kp; float Ki; float integral; float output; float limit; // 输出限幅 } PI_Controller_t; void PI_Controller_Update(PI_Controller_t *pi, float setpoint, float feedback) { float error = setpoint - feedback; // 积分项累加（可考虑抗饱和） pi->integral += error * pi->Ki; // 积分限幅 if (pi->integral > pi->limit) pi->integral = pi->limit; if (pi->integral < -pi->limit) pi->integral = -pi->limit; // 比例项 + 积分项 pi->output = error * pi->Kp + pi->integral; // 输出限幅 if (pi->output > pi->limit) pi->output = pi->limit; if (pi->output < -pi->limit) pi->output = -pi->limit; } // 在FOC循环中 PI_Controller_Update(&pi_id, g_Id_ref, g_Id_fb); // g_Id_ref通常为0 PI_Controller_Update(&pi_iq, g_Iq_ref, g_Iq_fb); // g_Iq_ref来自速度环输出 g_Vd = pi_id.output; g_Vq = pi_iq.output;

5.4 逆帕克变换（Inverse Park Transform）

将旋转坐标系下的电压指令Vd, Vq变换回静止坐标系Vα, Vβ。

void Inv_Park_Transform(float Vd, float Vq, float angle, float *Valpha, float *Vbeta) { float cos_theta = arm_cos_f32(angle); float sin_theta = arm_sin_f32(angle); *Valpha = Vd * cos_theta - Vq * sin_theta; *Vbeta = Vd * sin_theta + Vq * cos_theta; }

5.5 SVPWM生成

将Vα, Vβ转换为三相PWM占空比。这是最关键的硬件驱动环节。STM32G431的HRTIM可以硬件实现SVPWM，但理解其软件算法同样重要。

void SVPWM_Generate(float Valpha, float Vbeta, float Udc, float *Ta, float *Tb, float *Tc) { // 1. 扇区判断 int sector = 0; float Vref1 = Vbeta; float Vref2 = (SQRT3 * Valpha - Vbeta) / 2.0f; float Vref3 = (-SQRT3 * Valpha - Vbeta) / 2.0f; if (Vref1 > 0) sector |= 1; if (Vref2 > 0) sector |= 2; if (Vref3 > 0) sector |= 4; // 根据sector值映射到1-6扇区（标准SVPWM扇区表） // 2. 计算基本矢量作用时间 T1, T2 // 涉及 Clarke 逆变换和扇区对应的矢量时间计算，公式略 // float T1 = ... , T2 = ... ; // 3. 计算三相占空比 // 根据扇区，将T1, T2分配给不同的相，并计算Ta, Tb, Tc（归一化到PWM周期） // 最终 Ta, Tb, Tc 是0到1之间的值，代表占空比 }

在STM32G431中，计算出的Ta, Tb, Tc会写入HRTIM的比较寄存器（CMPx），硬件会自动生成中心对齐或边沿对齐的PWM波形。

6. 速度环与位置观测器（无感FOC）

对于完整的FOC驱动，还需要外环（速度环、位置环）和转子位置信息。

6.1 速度环

速度环比电流环慢，可以在主循环或一个低频定时器中断中执行。

// 假设每10ms执行一次速度环 void Speed_Loop_Handler(void) { // 1. 获取速度反馈（有传感器：编码器；无传感器：观测器估算） float speed_feedback = Get_Speed_Feedback(); // 单位可能是 RPM 或 rad/s // 2. PI控制器更新，输出 Iq_ref PI_Controller_Update(&pi_speed, g_speed_ref, speed_feedback); g_Iq_ref = pi_speed.output; // 作为电流环的给定 // 3. 限幅保护 g_Iq_ref = CONSTRAIN(g_Iq_ref, -IQ_MAX, IQ_MAX); }

6.2 无感FOC的位置与速度观测

无传感器FOC的核心难点在于估算转子位置（电角度θ）和速度。最常用的方法是滑模观测器（SMO）或模型参考自适应系统（MRAS）。这里以扩展反电动势（EEMF）观测器为例简述逻辑：

// 在ADC中断中，完成电流环计算后，执行观测器更新 void Observer_Update(float Valpha, float Vbeta, float Ialpha, float Ibeta, float dt) { // 1. 构建电机数学模型（在静止α-β坐标系下） // 计算反电动势 Eα, Eβ 的观测值 // E_alpha_hat = ... (基于电压方程和电流微分) // E_beta_hat = ... // 2. 使用锁相环（PLL）或反正切函数从反电动势中提取角度 // theta_estimated = atan2(-E_alpha_hat, E_beta_hat); // 注意符号 // 或者使用 PLL 来平滑估算并同时得到速度 // 3. 更新全局的电角度和速度估算值 g_electrical_angle = theta_estimated; g_speed_estimated = speed_from_pll; }

逻辑关系：观测器利用采集到的电压Vα, Vβ和电流Iα, Iβ，通过电机数学模型估算出反电动势，进而推算出转子角度和速度。这个估算出的角度g_electrical_angle会被用于下一次循环的 Park 和 Inverse Park 变换，形成闭环。

7. 关键外设配置要点（STM32G431）

理解了算法逻辑，还需要正确的硬件配置来支撑。

7.1 HRTIM配置（生成SVPWM）

• 计数模式：选择中心对齐模式（Up-Down），这样能产生对称的PWM，谐波更小。
• 预分频与周期：根据开关频率设置。例如，若开关频率为20kHz，系统时钟170MHz，则周期寄存器值约为170M / (2 * 20k) - 1 = 4249。
• 输出通道：至少配置3个互补输出通道（对应三相桥臂的上管和下管），并设置死区时间以防止上下管直通。
• 中断：使能周期中断（Master Timer Period Event），用于触发ADC采样。

7.2 ADC配置（电流采样）

• 采样时机：配置为由HRTIM的事件触发（如Master Timer Period事件），确保在PWM周期中点采样。
• 采样通道：配置两路ADC分别采样两相电流（或使用双ADC同步模式）。
• DMA：强烈建议使用DMA传输ADC数据，以减少CPU开销和中断延迟。
• 校准：上电后执行ADC自校准，并测量电流采样电路的零漂（Vref），用于软件补偿。

7.3 GPIO与保护

• 故障输入：将过流比较器的输出或硬件故障信号连接到MCU的带有刹车功能（Break）的定时器引脚或外部中断引脚，实现硬件级保护，一旦故障立即关闭PWM。
• 使能信号：控制驱动芯片的使能引脚，软件可控电机启停。

8. 常见问题与调试排查思路

在实现FOC过程中，你一定会遇到各种问题。下面是一个排查清单：

调试建议：

1. 先开环，后闭环：先让电机在开环V/F控制下平稳旋转，确认硬件（PWM、ADC、电源）基本正常。
2. 先电流环，后速度环：在零速下，给定一个小的阶跃Iq_ref，用示波器看实际电流能否快速跟踪。调好电流环PI参数。
3. 善用DAC：利用STM32G431的DAC，将内部关键变量（如Iq,Id,速度,角度）实时输出，用示波器观察，这是最直观的调试手段。
4. 分步验证：单独测试Clark/Park变换函数，用已知输入验证输出是否正确。

9. 工程优化与最佳实践

当你的FOC程序能基本运行后，可以考虑以下优化来提升性能和可靠性：

• 数学库优化：使用STM32G431的硬件浮点单元（FPU）和ARM的CMSIS-DSP库（如arm_sin_f32,arm_cos_f32,arm_sqrt_f32），速度远超软件浮点及标准库函数。
• 定点数运算：如果对速度要求极致，可以考虑将核心算法改用Q格式定点数运算，但开发复杂度会增加。
• 抗饱和处理：为所有PI控制器加入抗饱和机制（如积分分离、积分钳位），防止深度饱和后系统恢复慢。
• 参数自整定：可以尝试实现简单的继电器反馈或阶跃响应的自动PI参数整定算法。
• 安全监控：除了硬件保护，软件上应周期性检查电流、电压、温度、角度连续性，实现多级保护。
• 通讯与调试接口：预留USART/CAN接口，用于接收指令、发送状态和调试数据。可以借鉴FreeMaster、MicroLab等工具的上位机协议。
• 代码模块化：将FOC算法、硬件驱动、通讯协议分层，便于移植和维护。例如，将与MCU相关的PWM设置、ADC读取放在hal层，将纯数学算法的FOC函数放在core层。

开源STM32G431 FOC项目为我们提供了一个绝佳的学习起点。通过本文对程序逻辑从宏观状态机到微观算法链的逐层剖析，希望你能穿透代码的表象，理解其背后电机控制的本质思想。真正的掌握源于实践，建议你克隆一份开源代码，配合一块开发板，按照本文的指引，从点灯、配置PWM、读取ADC开始，一步步将整个系统搭建并调试起来。过程中遇到的每一个问题，都是对“逻辑”二字更深的理解。当你能够随心所欲地让电机平稳启停、快速响应时，你收获的将不仅仅是一个驱动方案，更是对嵌入式实时系统和控制理论的深刻认知。