STM32直流电机控制：低功耗PID算法与驱动设计

1. 项目背景与核心需求在工业自动化和消费电子领域直流电机控制一直是个经典课题。最近接手的一个智能家居窗帘项目要求电机在保持低功耗的同时实现精确的位置控制和速度调节。经过多轮方案对比最终选择了STMicroelectronics的STM32L432KC作为主控芯片搭配东芝的TB6593FNG驱动IC的方案组合。这个组合有几个显著优势STM32L432KC是ARM Cortex-M4内核的低功耗MCU运行频率高达80MHz内置浮点运算单元特别适合需要复杂控制算法的场景而TB6593FNG是一款双H桥驱动器最大输出电流达3A峰值5A支持PWM频率高达100kHz内置电流检测和多种保护功能。两者结合既能满足高性能控制需求又能保持系统整体低功耗。2. 硬件架构设计与关键元件选型2.1 主控芯片STM32L432KC特性解析选择这款MCU主要基于三个考量点功耗表现运行模式下仅100μA/MHz停机模式下1.4μA特别适合电池供电场景计算性能Cortex-M4内核配合硬件FPU能够实时执行PID等控制算法外设资源内置12位ADC5Msps、比较器、运放等模拟外设减少外围电路实际使用中发现其定时器资源特别丰富16位TIM2/TIM3用于生成电机PWM信号32位TIM1用于高精度位置计时LP TIM低功耗模式下维持基本计时2.2 TB6593FNG驱动电路设计要点这款驱动芯片的典型应用电路如下VM --[10μF]-- GND | --[0.1μF]-- GND VCC --[1μF]-- GND OUT1 --[电机]-- OUT2关键设计注意事项电源滤波必须使用低ESR的MLCC电容位置尽量靠近芯片引脚散热处理当持续电流1A时需要添加散热片或采用铜箔散热电流检测利用内置的CS引脚通过外部电阻实现电流反馈实测中发现PWM频率选择对性能影响显著20kHz以下电机有明显啸叫50-80kHz综合性能最佳100kHz以上驱动芯片发热明显增加3. 控制算法实现与参数整定3.1 基础PWM调速实现使用STM32的TIM2生成PWM的基本配置// PWM频率80MHz/(7991)/(491)20kHz TIM_HandleTypeDef htim2; htim2.Instance TIM2; htim2.Init.Prescaler 49; htim2.Init.CounterMode TIM_COUNTERMODE_UP; htim2.Init.Period 799; htim2.Init.ClockDivision TIM_CLOCKDIVISION_DIV1; HAL_TIM_PWM_Init(htim2); TIM_OC_InitTypeDef sConfigOC; sConfigOC.OCMode TIM_OCMODE_PWM1; sConfigOC.Pulse 400; // 初始占空比50% sConfigOC.OCPolarity TIM_OCPOLARITY_HIGH; sConfigOC.OCFastMode TIM_OCFAST_DISABLE; HAL_TIM_PWM_ConfigChannel(htim2, sConfigOC, TIM_CHANNEL_1);3.2 位置式PID算法实现针对窗帘电机的特点采用了改进的PID算法typedef struct { float Kp, Ki, Kd; float integral_max; float last_error; } PID_Controller; float PID_Update(PID_Controller* pid, float error, float dt) { float proportional pid-Kp * error; pid-integral pid-Ki * error * dt; // 积分抗饱和 if(pid-integral pid-integral_max) pid-integral pid-integral_max; else if(pid-integral -pid-integral_max) pid-integral -pid-integral_max; float derivative pid-Kd * (error - pid-last_error) / dt; pid-last_error error; return proportional pid-integral derivative; }参数整定经验先调Kp至系统开始振荡然后取该值的50%Ki从Kp/10开始逐步增加至消除静差Kd最后加入用于抑制超调4. 系统集成与性能优化4.1 电流检测与过载保护实现利用TB6593FNG的CS引脚实现电流检测CS --[Rcs]-- GND | --[100nF]-- GNDADC采样代码要点// 配置ADC采样CS引脚电压 hadc1.Init.Resolution ADC_RESOLUTION_12B; hadc1.Init.ScanConvMode DISABLE; hadc1.Init.ContinuousConvMode ENABLE; hadc1.Init.DiscontinuousConvMode DISABLE; hadc1.Init.ExternalTrigConv ADC_SOFTWARE_START; // 电流计算公式I Vcs / (Rcs * 放大倍数) // 其中VcsADC值*3.3V/4096过载保护策略瞬时电流3A立即关闭PWM输出持续电流2A超过1s触发软关断累计过载次数10次锁定系统需复位4.2 低功耗模式设计系统有三种工作模式运行模式全速执行控制算法待机模式仅响应外部中断停机模式保持最低功耗模式切换逻辑void Enter_LowPower_Mode(void) { // 关闭不必要的外设 __HAL_RCC_GPIOA_CLK_DISABLE(); __HAL_RCC_TIM2_CLK_DISABLE(); // 配置唤醒源 HAL_PWR_EnableWakeUpPin(PWR_WAKEUP_PIN1); // 进入停机模式 HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI); // 唤醒后重新初始化 SystemClock_Config(); MX_GPIO_Init(); MX_TIM2_Init(); }实测功耗数据运行模式8.5mA 48MHz待机模式120μA停机模式1.8μA5. 实测性能与问题排查5.1 关键性能指标测试使用专业仪器测得速度控制精度±1% (空载)±3% (额定负载)位置重复精度±0.5°启动响应时间50ms (0-300rpm)效率曲线峰值效率89% 200rpm轻载效率75% 50rpm5.2 常见问题与解决方案问题1电机启动时抖动原因启动时PID参数过激进解决添加启动渐变算法void Smooth_Start(float target) { float current 0; while(current target) { current target * 0.05f; // 每次增加5% Set_Speed(current); HAL_Delay(20); } }问题2高速运行时失步原因PWM占空比接近100%时驱动芯片保护解决限制最大占空比为95%并优化散热设计问题3位置控制时有稳态误差原因机械传动存在回差解决采用双向逼近策略总是从同一方向接近目标位置6. 进阶优化方向6.1 自适应PID参数调整根据负载情况动态调整PID参数void Adaptive_PID_Tuning(PID_Controller* pid, float error, float dt) { static float error_integral 0; error_integral fabs(error) * dt; // 根据累计误差调整参数 if(error_integral threshold_high) { pid-Kp * 1.1f; pid-Ki * 0.9f; } else if(error_integral threshold_low) { pid-Kp * 0.95f; pid-Ki * 1.05f; } // 定期重置积分 if(error_integral reset_threshold) { error_integral 0; } }6.2 基于模型的预测控制建立电机传递函数模型G(s) K / (τs 1)其中K 0.8 (实测增益)τ 0.02 (时间常数)实现预测控制算法float Model_Predictive_Control(float target, float current) { static float last_output 0; float error target - current; // 一阶预测 float prediction current (last_output * K - current) * (1 - exp(-dt/τ)); // 计算控制量 float output (target - prediction) / K; last_output output; return output; }6.3 机械谐振抑制通过FFT分析发现机械系统在120Hz处存在谐振峰采用陷波滤波器进行抑制// 二阶IIR陷波滤波器 typedef struct { float b0, b1, b2; float a1, a2; float x1, x2; float y1, y2; } NotchFilter; float Notch_Filter_Update(NotchFilter* f, float input) { float output f-b0 * input f-b1 * f-x1 f-b2 * f-x2 - f-a1 * f-y1 - f-a2 * f-y2; f-x2 f-x1; f-x1 input; f-y2 f-y1; f-y1 output; return output; }滤波器参数计算void Notch_Filter_Init(NotchFilter* f, float freq, float bw, float fs) { float omega 2 * M_PI * freq / fs; float alpha sin(omega) * sinh(log(2)/2 * bw * omega / sin(omega)); f-b0 1; f-b1 -2 * cos(omega); f-b2 1; f-a0 1 alpha; f-a1 -2 * cos(omega); f-a2 1 - alpha; // 归一化 f-b0 / f-a0; f-b1 / f-a0; f-b2 / f-a0; f-a1 / f-a0; f-a2 / f-a0; }