STM32G431 FOC程序逻辑全解析：从主循环到中断与状态机设计

最近在调试一个基于STM32G431的无刷电机FOC控制项目时，发现网上很多开源代码虽然功能完整，但程序逻辑和代码结构对初学者来说像一团乱麻，尤其是中断、状态机、SVPWM和PID环之间的耦合关系，常常让人理不清头绪。本文将深入剖析一个典型的开源STM32G431 FOC程序，从工程结构、主循环逻辑、中断服务到核心算法实现，一步步拆解其运行机制。无论你是刚开始接触电机控制的学生，还是希望优化现有代码的工程师，都能通过本文获得一套清晰的代码阅读与调试方法。

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

无刷直流电机（BLDC）和永磁同步电机（PMSM）的高性能控制离不开磁场定向控制（Field-Oriented Control, FOC）。FOC的核心思想是将电机的三相电流通过克拉克（Clark）和帕克（Park）变换，从静止的三相坐标系转换到旋转的两相直交坐标系（d-q轴）上。在这个坐标系下，励磁电流分量（Id）和转矩电流分量（Iq）被解耦，可以像控制直流电机一样分别进行控制，从而获得更快的动态响应、更高的效率以及更平稳的低速转矩。

STM32G431是意法半导体推出的一款基于Arm® Cortex®-M4内核的微控制器，其高主频（170MHz）、丰富的定时器资源（特别是高级控制定时器如TIM1）以及高精度ADC，使其成为实现FOC算法的理想平台。开源社区中有许多基于HAL库或LL库的FOC工程，它们通常包含了完整的双闭环（电流环、速度环）控制、SVPWM生成、位置与速度估算（无感或有感）等功能。

理解这类开源工程，关键在于把握其“逻辑”——即软件如何通过中断、状态机和数据流来协调硬件资源，实时地完成电流采样、坐标变换、PID计算和PWM更新这一系列任务。本文将围绕一个典型的工程，讲解其程序骨架和核心逻辑流。

2. 工程环境准备与代码结构概览

在开始分析代码逻辑之前，我们需要搭建一个可以阅读、编译甚至调试的环境。

2.1 软硬件环境说明

• 开发板/主控：STM32G431CBU6（或其他G4系列芯片，注意引脚兼容性）。
• 电机驱动板：常用的三相全桥驱动电路（如DRV8301、IR2136等栅极驱动器方案）。
• 开发环境：
  • IDE: STM32CubeIDE（推荐，便于管理HAL库和生成初始化代码）。
  • 编译工具链: ARM GCC (已集成在CubeIDE中)。
  • 调试器: ST-LINK/V2。
• 关键软件库：
  • STM32CubeG4 HAL库: 提供硬件抽象层驱动。
  • FOC算法库: 开源工程中通常自己实现或封装了数学库，包含clarke_transform,park_transform,svpwm等函数。
• 工程来源：本文分析的逻辑基于GitHub、Gitee等平台上常见的“STM32G431-FOC-无刷电机”开源项目。你可以搜索相关关键词找到并下载工程。

版本兼容性提示：不同版本的HAL库或CubeMX生成的代码在函数名或配置上可能有细微差别。如果遇到编译错误，请根据错误信息调整头文件引用或函数调用，核心逻辑通常不变。

2.2 典型开源FOC工程目录结构

下载并打开工程后，你会看到类似如下的目录结构。理解这个结构是读懂逻辑的第一步。

Your_FOC_Project/ ├── Core/ │ ├── Inc/ │ │ ├── main.h │ │ ├── foc_algorithm.h // FOC算法头文件 │ │ ├── pid_regulator.h // PID控制器头文件 │ │ ├── motor_control.h // 电机状态与控制头文件 │ │ └── ... │ ├── Src/ │ │ ├── main.c // 主函数与主循环 │ │ ├── foc_algorithm.c // FOC算法实现 │ │ ├── pid_regulator.c // PID控制器实现 │ │ ├── motor_control.c // 电机控制状态机 │ │ └── ... ├── Drivers/ │ ├── STM32G4xx_HAL_Driver/ // HAL库文件 │ └── CMSIS/ // Cortex微控制器软件接口标准 ├── STM32G431CBUX_FLASH.ld // 链接脚本 └── README.md // 工程说明

核心文件说明：

• main.c：程序的入口，包含系统初始化、外设初始化和主循环(while(1))。主循环通常处理非实时任务，如通信接收、状态显示、目标值更新等。
• foc_algorithm.c/.h：FOC数学运算的核心，包含坐标变换、反变换、SVPWM扇区判断与占空比计算。
• pid_regulator.c/.h：实现PID控制器，用于电流环和速度环的调节。
• motor_control.c/.h：定义电机控制的状态（如停止、启动、运行、故障），并实现状态机管理逻辑。
• 中断服务程序：通常直接在stm32g4xx_it.c文件中，或者通过HAL库的回调函数机制实现。这是实时控制的关键。

3. 核心控制逻辑与程序流程拆解

一个完整的FOC程序运行依赖于精心设计的中断时序和主从任务分工。其核心逻辑可以概括为“后台规划，前台执行”。

3.1 主循环 (while(1))：后台任务管理器

主循环在系统初始化后一直运行，负责非实时或实时性要求不高的任务。它的优先级最低。

// 文件路径：Core/Src/main.c (片段) int main(void) { // 1. HAL库、系统时钟、GPIO、ADC、定时器等初始化 HAL_Init(); SystemClock_Config(); MX_GPIO_Init(); MX_ADC1_Init(); MX_TIM1_Init(); // 高级定时器，用于产生PWM和触发ADC MX_USART1_UART_Init(); // 用于调试输出或指令接收 // 2. FOC算法、PID参数、电机控制模块初始化 FOC_Init(); PID_Current_Init(&pid_id, kp_id, ki_id, kd_id); // d轴电流PID PID_Current_Init(&pid_iq, kp_iq, ki_iq, kd_iq); // q轴电流PID PID_Speed_Init(&pid_speed, kp_spd, ki_spd, kd_spd); // 速度环PID Motor_Control_Init(&motor); // 3. 启动关键定时器（如PWM定时器TIM1） HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1); HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_2); HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_3); // 启动ADC注入组或规则组的触发定时器（如TIM1的TRGO事件） HAL_TIM_Base_Start(&htim1); // 4. 主循环开始 while (1) { // 4.1 处理来自上位机（如串口、CAN）的指令 // 例如：设置目标速度、更改控制模式、读取状态等 if (UART_RxFlag) { Parse_UART_Command(); UART_RxFlag = 0; } // 4.2 更新电机控制状态机（非实时部分） Motor_Control_StateMachine(&motor); // 4.3 非关键的系统状态监测与保护（如温度、电压） System_Protection_Check(); // 4.4 调试信息输出（频率较低，如每100ms一次） static uint32_t debug_tick = 0; if (HAL_GetTick() - debug_tick > 100) { debug_tick = HAL_GetTick(); printf("Speed: %d, Id: %.2f, Iq: %.2f\r\n", motor.speed, motor.i_d, motor.i_q); } // 4.5 空闲任务或低功耗模式（可选） // __WFI(); } }

逻辑解读：主循环就像一个“指挥中心”，它不直接参与每秒数万次的电流采样与PWM计算，而是负责接收外部指令、管理电机运行的大状态（启动、停止、故障处理）、进行系统监控和输出调试信息。所有实时性要求高的任务都交给了中断服务程序。

3.2 定时器中断与ADC采样：实时控制的节拍器

FOC的实时性体现在固定的控制频率上，通常是10kHz到20kHz。这个频率由高级定时器（如TIM1）的更新中断来设定。

常见的配置策略（以中心对齐PWM和ADC采样为例）：

1. TIM1配置为中心对齐模式1，产生对称的PWM波形，能有效降低谐波。
2. 使能TIM1的更新中断和触发输出(TRGO)。TRGO信号用于触发ADC采样。
3. ADC配置为注入组或规则组，由TIM1的TRGO事件触发转换。
4. 在ADC转换完成中断中读取三相电流值（或两相+直流母线电压），然后进行FOC计算。
5. 在TIM1的更新中断中，使用计算好的新占空比更新比较寄存器（CCR），从而更新下一个PWM周期的输出。

// 文件路径：Core/Src/stm32g4xx_it.c (或相应的回调函数) // ADC转换完成中断回调函数（HAL库方式） void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef* hadc) { if (hadc->Instance == ADC1) { // 1. 读取ADC值并转换为实际的电流值（单位：安培） motor.i_a = ADC_To_Ampere(ADC_GetValue(ADC_CHANNEL_A)); motor.i_b = ADC_To_Ampere(ADC_GetValue(ADC_CHANNEL_B)); // i_c 可通过 i_a + i_b + i_c = 0 计算得出，或使用第三路ADC // 2. 执行FOC控制算法（这是最核心的实时任务） FOC_Current_Loop(&motor); // 3. 计算并更新SVPWM占空比 SVPWM_UpdateDutyCycle(&motor); // 4. 将计算好的占空比写入到TIM1的比较寄存器影子寄存器 // 注意：为了波形对称和防止毛刺，通常在中心对齐模式的计数器溢出中断中更新CCR // 此处可能只是计算并暂存，在TIM更新中断中再实际加载。 motor.duty_a = ...; // 计算出的占空比 motor.duty_b = ...; motor.duty_c = ...; } } // TIM1更新中断回调函数 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim->Instance == TIM1) { // 1. 将计算好的新占空比加载到TIM1的CCR寄存器中 __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, motor.duty_a); __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_2, motor.duty_b); __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_3, motor.duty_c); // 2. 速度环计算（频率比电流环低，例如每N个电流环周期执行一次） static uint8_t speed_loop_counter = 0; if (++speed_loop_counter >= SPEED_LOOP_DIVIDER) { speed_loop_counter = 0; FOC_Speed_Loop(&motor); // 这里面会调用速度PID } // 3. 无感算法位置/速度估算（如果使用的是无传感器方案） // Observer_Update(&motor); } }

逻辑解读：这里形成了两个关键的中断链。ADC中断是电流环的起点，它在一个PWM周期中的固定时刻（通常是在PWM中心点）采样电流，并立即进行快速计算，为下一个PWM周期做好准备。TIM更新中断是PWM周期的终点和起点，它负责将计算好的新值加载到硬件中，并执行频率较低的速度环计算。这两个中断的紧密协作，构成了FOC实时控制的“心跳”。

3.3 FOC电流环函数详解

这是整个程序算法最密集的部分，我们深入FOC_Current_Loop函数内部。

// 文件路径：Core/Src/foc_algorithm.c void FOC_Current_Loop(Motor_t *motor) { // 步骤1：克拉克变换 (Clark Transform) - 3相静止到2相静止 Clarke_Transform(motor->i_a, motor->i_b, &motor->i_alpha, &motor->i_beta); // 步骤2：帕克变换 (Park Transform) - 2相静止到2相旋转(dq) Park_Transform(motor->i_alpha, motor->i_beta, motor->theta_electrical, &motor->i_d, &motor->i_q); // 步骤3：电流环PID调节 // d轴电流控制（通常用于弱磁控制，基础FOC中常设Id_ref=0） motor->v_d_ref = PID_Calculate(&pid_id, motor->i_d_ref, motor->i_d); // q轴电流控制（转矩控制） motor->v_q_ref = PID_Calculate(&pid_iq, motor->i_q_ref, motor->i_q); // 步骤4：反帕克变换 (Inverse Park Transform) - 2相旋转到2相静止 Inverse_Park_Transform(motor->v_d_ref, motor->v_q_ref, motor->theta_electrical, &motor->v_alpha_ref, &motor->v_beta_ref); // 步骤5：计算SVPWM所需的占空比（基于v_alpha, v_beta和直流母线电压） // 此函数会判断扇区，并计算三相占空比Ta, Tb, Tc SVPWM_CalcDutyCycle(motor->v_alpha_ref, motor->v_beta_ref, motor->v_bus, &motor->duty_a, &motor->duty_b, &motor->duty_c); // 步骤6：更新电角度，为下一个周期做准备 // 对于有传感器： motor->theta_electrical += (motor->speed * DT * POLE_PAIRS); // 对于无传感器： motor->theta_electrical = Observer_GetAngle(); // 从观测器获取 }

逻辑解读：这个函数清晰地展示了FOC算法的标准流水线。它在一个中断周期内，将采样到的三相电流，经过一系列数学变换，最终转换为驱动三相逆变桥的PWM占空比。其中i_q_ref是速度环PID的输出，这就将速度环和电流环串联了起来。

3.4 电机控制状态机

电机不能一上电就全速运行，需要有序的启动流程（如对齐、开环启动、闭环切换），也需要处理各种故障状态（过流、过压、过热）。这些逻辑由状态机管理。

// 文件路径：Core/Src/motor_control.c typedef enum { MOTOR_STATE_IDLE = 0, MOTOR_STATE_ALIGN, // 转子预定位 MOTOR_STATE_OPEN_LOOP, // 开环启动（无感） MOTOR_STATE_CLOSED_LOOP, // 闭环运行 MOTOR_STATE_FAULT } MotorState_t; void Motor_Control_StateMachine(Motor_t *motor) { switch (motor->state) { case MOTOR_STATE_IDLE: if (motor->start_cmd == true) { motor->state = MOTOR_STATE_ALIGN; motor->start_cmd = false; Motor_AlignRotor(); // 发送固定矢量，将转子拉到预定位置 motor->align_timer = HAL_GetTick(); } break; case MOTOR_STATE_ALIGN: // 预定位持续一段时间，如200ms if (HAL_GetTick() - motor->align_timer > 200) { motor->state = MOTOR_STATE_OPEN_LOOP; motor->open_loop_angle = 0; motor->open_loop_speed = INIT_SPEED; } break; case MOTOR_STATE_OPEN_LOOP: // 开环递增角度，模拟旋转磁场 motor->open_loop_angle += motor->open_loop_speed * CONTROL_PERIOD; motor->theta_electrical = motor->open_loop_angle; // 强制使用开环角度 // 当速度达到一定值，切换到闭环 if (motor->open_loop_speed > SWITCH_SPEED) { motor->state = MOTOR_STATE_CLOSED_LOOP; // 初始化观测器（无感）或使能编码器中断（有感） } // 缓慢加速 motor->open_loop_speed += OPEN_LOOP_ACCEL; break; case MOTOR_STATE_CLOSED_LOOP: // 正常运行状态，目标速度由外部指令设定 // i_q_ref 由速度环PID计算得出 motor->i_q_ref = PID_Calculate(&pid_speed, motor->speed_ref, motor->speed); // 故障检查 if (Check_OverCurrent() || Check_OverVoltage()) { motor->state = MOTOR_STATE_FAULT; Emergency_Stop(); } break; case MOTOR_STATE_FAULT: // 关闭PWM输出，等待故障复位 HAL_TIM_PWM_Stop(&htim1, TIM_CHANNEL_ALL); // 等待复位指令 if (motor->fault_reset_cmd == true) { Clear_Fault_Flags(); motor->state = MOTOR_STATE_IDLE; motor->fault_reset_cmd = false; } break; default: motor->state = MOTOR_STATE_IDLE; break; } }

逻辑解读：状态机是程序稳健性的保证。它确保了电机在任何时候都处于一个明确的状态，并且只能在定义好的条件下进行状态转移。例如，从IDLE到ALIGN需要启动命令，从OPEN_LOOP到CLOSED_LOOP需要达到一定的切换速度。主循环中周期性调用此状态机函数，而实时中断中的FOC计算则会根据motor->state来决定使用何种角度（开环强制角度或闭环估算角度）和何种控制模式。

4. 关键模块代码实现与配置要点

4.1 SVPWM生成：七段式与五段式

SVPWM（空间矢量脉宽调制）是将电压矢量指令转换为具体PWM占空比的关键。开源工程中常见的是七段式SVPWM，它在一个PWM周期内分7个段来合成目标矢量，谐波特性更好。

// 文件路径：Core/Src/foc_algorithm.c (片段) // 简化的SVPWM扇区判断与时间计算 void SVPWM_CalcDutyCycle(float v_alpha, float v_beta, float v_bus, float *ta, float *tb, float *tc) { float u_alpha = v_alpha / v_bus; float u_beta = v_beta / v_bus; // 1. 扇区判断 uint8_t sector = 0; if (u_beta >= 0) { if (u_alpha >= 0) { sector = (sqrtf(3) * u_alpha > u_beta) ? 1 : 2; } else { sector = (-sqrtf(3) * u_alpha > u_beta) ? 3 : 2; } } else { if (u_alpha >= 0) { sector = (-sqrtf(3) * u_alpha < u_beta) ? 6 : 5; } else { sector = (sqrtf(3) * u_alpha < u_beta) ? 4 : 5; } } // 2. 计算基本矢量作用时间 T1, T2 float t1, t2; float sqrt3 = sqrtf(3.0f); switch (sector) { case 1: t1 = u_beta; t2 = (sqrt3 * u_alpha - u_beta) / 2.0f; break; case 2: t1 = (sqrt3 * u_alpha + u_beta) / 2.0f; t2 = -u_beta; break; // ... 其他扇区计算 } // 3. 过调制处理（确保T1+T2 <= 1） float sum = t1 + t2; if (sum > 1.0f) { t1 = t1 / sum; t2 = t2 / sum; } // 4. 计算七段式各相占空比 float t_a, t_b, t_c; switch (sector) { case 1: t_a = (1 - t1 - t2) / 2; t_b = t_a + t1; t_c = t_b + t2; break; case 2: t_a = (1 - t1 - t2) / 2; t_c = t_a + t1; t_b = t_c + t2; break; // ... 其他扇区占空比分配 } // 5. 将占空比归一化到定时器计数范围 *ta = t_a * PWM_PERIOD_COUNTS; *tb = t_b * PWM_PERIOD_COUNTS; *tc = t_c * PWM_PERIOD_COUNTS; }

配置要点：在CubeMX中配置TIM1时，需要设置为“中心对齐模式1”，预分频器和自动重载值(ARR)要根据你的控制频率和系统时钟来计算。PWM频率通常为10-20kHz。ARR的值就是上面代码中的PWM_PERIOD_COUNTS。

4.2 PID控制器实现

PID是闭环控制的核心，需要特别注意积分饱和与抗积分饱和处理。

// 文件路径：Core/Src/pid_regulator.c typedef struct { float kp; float ki; float kd; float integral; float prev_error; float output_limit; // 输出限幅 float integral_limit; // 积分限幅 } PID_Handle_t; float PID_Calculate(PID_Handle_t *pid, float target, float feedback) { float error = target - feedback; // 比例项 float p_out = pid->kp * error; // 积分项（带限幅和抗饱和） pid->integral += pid->ki * error; if (pid->integral > pid->integral_limit) pid->integral = pid->integral_limit; if (pid->integral < -pid->integral_limit) pid->integral = -pid->integral_limit; float i_out = pid->integral; // 微分项（常用不完全微分） float d_out = pid->kd * (error - pid->prev_error); pid->prev_error = error; // 总和并限幅 float output = p_out + i_out + d_out; if (output > pid->output_limit) output = pid->output_limit; if (output < -pid->output_limit) output = -pid->output_limit; return output; }

参数整定顺序：先调电流环（内环），再调速度环（外环）。电流环响应要快，通常只使用PI控制器（Kd=0）。调试时，先将所有增益设为0，逐步增加Kp直到系统开始振荡，然后减小到80%左右，再加入Ki消除静差。

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

在移植或运行开源FOC代码时，你可能会遇到以下问题：

6. 最佳实践与工程化建议

理解了基本逻辑后，要让代码更健壮、更易于维护和移植，还需要注意以下几点：

1. 模块化与解耦：将FOC算法、PID控制、硬件驱动（ADC、TIM）、通信协议等严格分离。使用清晰的接口（函数和结构体）进行交互。这样便于单独测试和替换算法（如将PID换成滑模控制）。

2. 参数可配置化：不要将PID参数、电机参数（极对数、电阻、电感）、控制频率等硬编码在代码中。可以将它们定义为全局变量，并通过头文件或单独的config.h文件进行管理，甚至通过串口或EEPROM在线调整和保存。

3. 安全与保护机制：

   • 软件保护：在关键函数（如PID计算、SVPWM计算）入口添加参数有效性检查（如电压、电流范围）。
   • 硬件保护利用：STM32G4的定时器具有强大的刹车功能。配置GPIO引脚为刹车输入，当发生过流时，硬件能自动关闭PWM输出，响应速度远快于软件中断。
   • 状态监控：在主循环中定期检查母线电压、芯片温度、各相电流，并设置合理的阈值进行保护。

4. 调试信息分级输出：使用条件编译来控制调试信息的详细程度。例如：

   #define DEBUG_LEVEL 1 // 0:关闭， 1:基础信息， 2:详细数据 #if DEBUG_LEVEL > 0 printf("[INFO] Motor started.\r\n"); #endif #if DEBUG_LEVEL > 1 printf("[DATA] Id:%.2f, Iq:%.2f, Theta:%.2f\r\n", i_d, i_q, theta); #endif

5. 性能优化：

   • 启用FPU：务必在工程设置中启用单精度浮点单元(FPU)，能极大提升计算速度。
   • 使用查表法：对于频繁调用的三角函数（如sinf,cosf），可以预先计算一个正弦表，用空间换时间。
   • 减少中断内耗时：在ADC中断中只做最必要的计算（电流环），将速度环、状态机等移至TIM更新中断或主循环。

6. 版本管理与文档：使用Git管理你的代码。在关键函数和复杂逻辑处添加清晰的注释。维护一个README.md，记录工程依赖的库版本、硬件连接图、关键参数配置和已知问题。

通过本文对STM32G431 FOC程序逻辑的层层剖析，你应该已经对从主循环到中断服务，从状态机到算法实现的完整链条有了清晰的认识。下一步，建议你亲手打开一个开源工程，结合本文的讲解，对照代码逐行阅读，并使用调试器和示波器进行验证。从让电机成功转起来，到平稳运行，再到动态响应调整，每一步的实践都会加深你对FOC控制精髓的理解。