深入STM32无感FOC的ADC中断服务程序：如何让10kHz控制环稳定运行

深入STM32无感FOC的ADC中断服务程序：如何让10kHz控制环稳定运行

在电机控制领域，无感FOC（Field Oriented Control）算法因其优异的性能表现而备受青睐。当控制频率提升到10kHz时，系统对实时性的要求变得极为苛刻，任何一个环节的延迟都可能导致控制环失稳。本文将聚焦STM32平台下ADC中断服务程序的设计与优化，分享如何构建一个稳定可靠的高频无感FOC系统。

1. 10kHz控制环的时序挑战

10kHz的控制频率意味着每个PWM周期仅有100μs的处理时间窗口。在这个短暂的时间片内，系统需要完成电流采样、坐标变换、PI调节、SVPWM生成等一系列计算任务。更棘手的是，这些操作必须在下一个PWM周期开始前全部完成，否则会导致控制时序紊乱。

典型10kHz控制环的时间分配：

在STM32F1这类72MHz主频的MCU上，这些计算任务已经接近处理能力的极限。我们曾在一个实际项目中测量发现，当SMO算法复杂度增加时，中断服务程序的总执行时间会从60μs骤增到95μs，直接导致控制环崩溃。

2. ADC中断服务程序的核心架构

ADC中断服务程序是无感FOC系统的"心脏"，它需要高效协调多个关键任务。一个经过优化的中断服务程序通常包含以下逻辑流程：

void HAL_ADCEx_InjectedConvCpltCallback(ADC_HandleTypeDef* hadc) { if(hadc->Instance == ADC1) { // 1. 读取并预处理ADC采样值 int16_t adc_u = HAL_ADCEx_InjectedGetValue(&hadc1, ADC_INJECTED_RANK_1); int16_t adc_v = HAL_ADCEx_InjectedGetValue(&hadc1, ADC_INJECTED_RANK_2); // 2. 执行Clarke变换 Curr_Components I_ab = Clarke(I_abc); // 3. 状态机处理（预定位/开环加速/闭环运行） switch(Motor_State) { case MOTOR_ALIGN: // 预定位处理 case MOTOR_RAMP: // 开环加速处理 case MOTOR_RUN: // 闭环运行处理 } // 4. Park变换与PI控制 Curr_Components I_dq = Park(I_ab, theta_elec); Volt_Components V_dq = PI_Control(I_dq); // 5. SMO观测器更新 SMO_Update(&SMO, I_ab.qI_Component1, I_ab.qI_Component2, V_dq.qV_Component1, V_dq.qV_Component2, dt); // 6. 反Park变换与SVPWM生成 Volt_Components V_ab = Rev_Park(V_dq); SVPWM_3ShuntCalcDutyCycles(V_ab); } }

这个架构看似简单，但在10kHz频率下运行时，每个环节都可能成为性能瓶颈。我们曾遇到一个典型案例：当电机从开环切换到闭环时，系统频繁崩溃。经过示波器抓取发现，问题根源在于SMO观测器的计算耗时超过了PWM周期。

3. 关键优化技术与实践

3.1 精确的ADC采样触发

在中心对齐PWM模式下，最佳的电流采样时刻是在PWM周期的中点。此时相电流已经稳定，能准确反映电机绕组的电流状态。通过TIM1的CH4输出比较功能，可以精确控制ADC的采样时刻：

// TIM1初始化片段（关键配置） sMasterConfig.MasterOutputTrigger = TIM_TRGO_OC4REF; // 使用OC4REF作为触发源 HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig); // 在SVPWM函数中动态设置CH4比较值 __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_4, hTimePhD); // hTimePhD根据SVPWM扇区计算

实际调试中发现：如果ADC采样时刻过早（在死区时间内），会导致采样值失真；过晚则可能错过电流稳定区间。我们最终确定在PWM周期中点前1μs触发ADC，获得了最稳定的采样结果。

3.2 变量访问的原子性保护

在10kHz中断频率下，主循环与中断服务程序之间的变量共享需要特别小心。例如，SMO估算的速度值可能在中断服务程序更新时被主循环读取，导致数据不一致。

解决方案：

• 对关键全局变量使用__IO修饰符
• 在读写前后禁用全局中断
• 对32位变量的访问要特别小心（在Cortex-M3上不是原子操作）

// 安全的速度值读取函数 float Get_Speed_Estimate(void) { float temp; uint32_t primask = __get_PRIMASK(); // 保存中断状态 __disable_irq(); // 禁用中断 temp = SMO.speed_est_rpm; __set_PRIMASK(primask); // 恢复中断状态 return temp; }

3.3 计算精度的权衡

在资源受限的STM32F1上，浮点运算需要消耗大量CPU周期。通过将部分算法转换为Q15格式的定点运算，可以显著提升计算速度：

// Q15格式的Park变换实现 Curr_Components Park(Curr_Components Curr_Input, s16 Theta) { Curr_Components Curr_Output; Trig_Components = Trig_Functions(Theta); // 获取cos/sin值 // Iq = Ialpha*cosθ - Ibeta*sinθ (Q15乘法) int32_t tmp = (int32_t)Curr_Input.qI_Component1 * Vector_Components.hCos; tmp -= (int32_t)Curr_Input.qI_Component2 * Vector_Components.hSin; Curr_Output.qI_Component1 = (int16_t)(tmp >> 15); // Q30转Q15 // Id = Ialpha*sinθ + Ibeta*cosθ tmp = (int32_t)Curr_Input.qI_Component1 * Vector_Components.hSin; tmp += (int32_t)Curr_Input.qI_Component2 * Vector_Components.hCos; Curr_Output.qI_Component2 = (int16_t)(tmp >> 15); return Curr_Output; }

实测数据显示，这种优化可以将Park/反Park变换的执行时间从8μs缩短到3μs。但需要注意：Q15格式的动态范围有限，在电机高速运行时可能出现溢出，需要合理缩放输入值。

4. 调试技巧与性能分析

4.1 中断延迟测量

使用GPIO引脚和逻辑分析仪可以直观测量中断服务程序的执行时间：

1. 在中断入口处拉高GPIO
2. 在中断退出前拉低GPIO
3. 用逻辑分析仪捕获脉冲宽度

void HAL_ADCEx_InjectedConvCpltCallback(ADC_HandleTypeDef* hadc) { GPIOA->BSRR = GPIO_PIN_5; // 置位PA5 // ... 中断服务程序主体 ... GPIOA->BRR = GPIO_PIN_5; // 复位PA5 }

4.2 关键变量监控

通过SWD接口实时监控关键变量，可以帮助发现控制环不稳定的根源：

• SMO估算角度与开环角度的差值
• Q轴电流的实际值与目标值
• PWM占空比的变化趋势
• ADC采样值的原始数据

经验分享：我们曾发现一个间歇性失稳问题，最终通过监控ADC原始值发现是电流采样电路受到了PWM开关噪声的干扰。在ADC输入增加RC滤波后问题得到解决。

4.3 计算负载均衡

当所有计算都集中在ADC中断中导致超时时，可以考虑将部分任务分流：

• 将SMO观测器更新移到主循环，但需确保至少每2-3个PWM周期执行一次
• 使用DMA将ADC结果传输到内存，减少中断服务程序中的数据处理
• 对PI控制器进行简化，如使用整数运算或降低更新频率

5. 稳定性保障措施

5.1 看门狗机制

在高压大电流应用中，必须预防程序跑飞导致的危险情况。建议采用两级看门狗策略：

1. 独立硬件看门狗（IWDG）：超时时间500ms-1s
2. 软件看门狗（由SysTick维护）：检查关键任务是否按时执行

// 软件看门狗示例 volatile uint32_t wdg_counter = 0; void SysTick_Handler(void) { if(wdg_counter++ > 10000) { // 约1秒超时 NVIC_SystemReset(); } } // 在ADC中断中喂狗 void HAL_ADCEx_InjectedConvCpltCallback(ADC_HandleTypeDef* hadc) { wdg_counter = 0; // ... }

5.2 故障安全处理

当检测到异常情况时（如电流过大、估算角度突变），应立即进入安全状态：

1. 关闭PWM输出
2. 记录错误代码
3. 等待外部复位或超时后自动重启

// 电流过载保护 if(abs(adc_u - CURRENT_OFFSET) > OVERCURRENT_THRESHOLD || abs(adc_v - CURRENT_OFFSET) > OVERCURRENT_THRESHOLD) { HAL_TIM_PWM_Stop(&htim1, TIM_CHANNEL_1); HAL_TIMEx_PWMN_Stop(&htim1, TIM_CHANNEL_1); // ... 关闭所有PWM通道 ... Error_Handler(); }

5.3 启动过程优化

无感FOC的启动过程尤为关键，我们推荐采用三段式启动：

1. 预定位阶段：给固定方向的电流，将转子拉到确定位置
2. 开环加速阶段：逐渐增加频率，将电机拖到一定速度
3. 闭环切换：当SMO估算速度足够可靠时切换到闭环控制

// 状态机处理片段 switch(Motor_State) { case MOTOR_ALIGN: // 预定位 theta_elec = 0; if(align_cnt++ > ALIGN_TIME_MS * 10) { Motor_State = MOTOR_RAMP; open_loop_angle = 0; } break; case MOTOR_RAMP: // 开环加速 ramp_speed += (RAMP_END_SPD / (RAMP_TIME_MS/1000.0f)) * dt; open_loop_angle += ramp_speed * 6.0f * dt; // RPM转角度增量 theta_elec = (int16_t)((open_loop_angle / 180.0f) * 32767.0f); if(SMO.speed_est_rpm > SWITCH_THRESHOLD) { Motor_State = MOTOR_RUN; } break; case MOTOR_RUN: // 闭环运行 theta_elec = (int16_t)((SMO.theta_est / PI) * 32767.0f); break; }

在实际调试中，我们发现开环加速时间不宜过短（至少300ms），否则容易导致失步。同时，切换阈值应根据电机特性调整，通常设为额定转速的10-20%。