STM32与TB6593FNG实现直流电机PID闭环控制方案

1. 项目背景与核心组件选型在嵌入式电机控制领域如何实现直流电机的高效驱动一直是工程师们关注的焦点。这次我们选用东芝半导体(Toshiba Semiconductor)的TB6593FNG全桥驱动器与ST意法半导体的STM32F446RE微控制器组合搭建了一套可定制化直流电机控制系统。这套方案特别适合需要精确控制转速、转向和动态响应的应用场景比如小型机器人关节驱动、医疗设备精密运动控制等。TB6593FNG作为核心驱动芯片具有几个突出优势首先是低导通电阻特性5V供电时仅0.35Ω这直接降低了功率损耗其次是宽电压工作范围2.5V-13V适配多种规格电机最后是内置多重保护机制包括热关断和欠压锁定功能。而STM32F446RE则提供了强大的运算能力180MHz主频的Cortex-M4内核和丰富的外设接口其高级定时器特别适合生成高精度PWM信号。实际选型时需要注意TB6593FNG的最大持续输出电流为1A瞬时峰值电流可达2A。如果驱动更大功率电机建议选用TB67H450FNG等电流规格更高的驱动芯片。2. 硬件系统搭建与电路设计2.1 主控板与驱动板连接方案STM32F446RE开发板与TB6593FNG驱动板的典型连接方式如下PWM信号线连接至STM32的TIM1_CH1PA8引脚方向控制IN1/IN2分别连接至PB6和PB7待机控制SLP连接至PC9电源部分建议为驱动板单独供电VM接7.4V锂电池与MCU共地特别要注意的是PWM频率选择。通过实测发现对于小型直流有刷电机10kHz-20kHz的PWM频率既能保证控制响应速度又能避免可闻噪声。在STM32CubeMX中配置TIM1时假设系统时钟为180MHz预分频值设为90-1自动重装载值设为1000-1即可得到20kHz的PWM信号。2.2 关键外围电路设计电机驱动部分需要重点设计以下电路电源滤波电路在VM电源输入端并联100μF电解电容和0.1μF陶瓷电容可有效抑制电机启停时的电压波动反电动势吸收电路在电机两端并联1N5819肖特基二极管组成续流回路电流检测电路通过在GND回路串联0.1Ω采样电阻INA199电流检测放大器实现过流保护// STM32CubeMX生成的PWM初始化代码片段 static void MX_TIM1_Init(void) { TIM_MasterConfigTypeDef sMasterConfig {0}; TIM_OC_InitTypeDef sConfigOC {0}; htim1.Instance TIM1; htim1.Init.Prescaler 90-1; htim1.Init.CounterMode TIM_COUNTERMODE_UP; htim1.Init.Period 1000-1; htim1.Init.ClockDivision TIM_CLOCKDIVISION_DIV1; HAL_TIM_PWM_Init(htim1); sMasterConfig.MasterOutputTrigger TIM_TRGO_RESET; sMasterConfig.MasterSlaveMode TIM_MASTERSLAVEMODE_DISABLE; HAL_TIMEx_MasterConfigSynchronize(htim1, sMasterConfig); sConfigOC.OCMode TIM_OCMODE_PWM1; sConfigOC.Pulse 0; sConfigOC.OCPolarity TIM_OCPOLARITY_HIGH; sConfigOC.OCFastMode TIM_OCFAST_DISABLE; HAL_TIM_PWM_ConfigChannel(htim1, sConfigOC, TIM_CHANNEL_1); }3. 电机控制算法实现3.1 基础驱动函数封装我们首先封装TB6593FNG的底层驱动函数这些函数将通过STM32的GPIO和PWM外设控制电机typedef struct { GPIO_TypeDef* IN1_Port; uint16_t IN1_Pin; GPIO_TypeDef* IN2_Port; uint16_t IN2_Pin; GPIO_TypeDef* SLP_Port; uint16_t SLP_Pin; TIM_HandleTypeDef* PWM_Timer; uint32_t PWM_Channel; } Motor_Driver; void Motor_Init(Motor_Driver* hmd) { // 初始化GPIO和PWM定时器 HAL_GPIO_WritePin(hmd-SLP_Port, hmd-SLP_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(hmd-IN1_Port, hmd-IN1_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(hmd-IN2_Port, hmd-IN2_Pin, GPIO_PIN_RESET); HAL_TIM_PWM_Start(hmd-PWM_Timer, hmd-PWM_Channel); } void Motor_SetSpeed(Motor_Driver* hmd, int16_t speed) { speed constrain(speed, -1000, 1000); // 限制在-1000到1000范围内 if(speed 0) { HAL_GPIO_WritePin(hmd-IN1_Port, hmd-IN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(hmd-IN2_Port, hmd-IN2_Pin, GPIO_PIN_RESET); __HAL_TIM_SET_COMPARE(hmd-PWM_Timer, hmd-PWM_Channel, abs(speed)); } else if(speed 0) { HAL_GPIO_WritePin(hmd-IN1_Port, hmd-IN1_Pin, GPIO_PIN_RESET); HAL_GPIO_WritePin(hmd-IN2_Port, hmd-IN2_Pin, GPIO_PIN_SET); __HAL_TIM_SET_COMPARE(hmd-PWM_Timer, hmd-PWM_Channel, abs(speed)); } else { Motor_Brake(hmd); } } void Motor_Brake(Motor_Driver* hmd) { HAL_GPIO_WritePin(hmd-IN1_Port, hmd-IN1_Pin, GPIO_PIN_SET); HAL_GPIO_WritePin(hmd-IN2_Port, hmd-IN2_Pin, GPIO_PIN_SET); __HAL_TIM_SET_COMPARE(hmd-PWM_Timer, hmd-PWM_Channel, 0); }3.2 速度闭环PID控制实现为实现精确转速控制我们在STM32上实现了数字PID算法。通过霍尔编码器或光电编码器获取电机实际转速与目标转速比较后经PID计算输出PWM占空比typedef struct { float Kp; float Ki; float Kd; float integral; float prev_error; uint32_t last_time; } PID_Controller; float PID_Update(PID_Controller* pid, float setpoint, float measurement) { uint32_t now HAL_GetTick(); float dt (now - pid-last_time) / 1000.0f; pid-last_time now; float error setpoint - measurement; pid-integral error * dt; pid-integral constrain(pid-integral, -100.0f, 100.0f); // 抗积分饱和 float derivative (error - pid-prev_error) / dt; pid-prev_error error; return pid-Kp * error pid-Ki * pid-integral pid-Kd * derivative; } // 在main.c中的应用示例 PID_Controller speed_pid {.Kp0.5, .Ki0.1, .Kd0.01}; Motor_Driver motor; void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if(htim htim2) { // 假设TIM2用于定时采样 float current_rpm Encoder_GetSpeed(); // 获取当前转速 float control PID_Update(speed_pid, target_rpm, current_rpm); Motor_SetSpeed(motor, (int16_t)control); } }4. 性能优化与实测数据4.1 PWM死区时间配置为防止H桥上下管直通必须配置适当的死区时间。通过STM32的高级定时器TIM1/TIM8可以方便地实现void MX_TIM1_Init(void) { // ...其他初始化代码 TIM_BreakDeadTimeConfigTypeDef sBreakDeadTimeConfig {0}; sBreakDeadTimeConfig.OffStateRunMode TIM_OSSR_DISABLE; sBreakDeadTimeConfig.OffStateIDLEMode TIM_OSSI_DISABLE; sBreakDeadTimeConfig.LockLevel TIM_LOCKLEVEL_OFF; sBreakDeadTimeConfig.DeadTime 54; // 约300ns 180MHz sBreakDeadTimeConfig.BreakState TIM_BREAK_DISABLE; sBreakDeadTimeConfig.BreakPolarity TIM_BREAKPOLARITY_HIGH; sBreakDeadTimeConfig.AutomaticOutput TIM_AUTOMATICOUTPUT_DISABLE; HAL_TIMEx_ConfigBreakDeadTime(htim1, sBreakDeadTimeConfig); }4.2 实测性能对比我们测试了一款6V/430RPM的直流减速电机对比开环和闭环控制的性能差异测试项目开环控制PID闭环控制空载稳态误差±15RPM±2RPM加载后转速跌落23%5%阶跃响应时间(ms)12050功耗(额定负载)2.1W1.8W实测数据显示闭环控制显著提升了系统性能。特别是在突加负载时开环控制的转速会从430RPM跌至330RPM左右而PID控制能快速补偿最终稳态误差不超过20RPM。5. 常见问题与调试技巧5.1 电机启动异常排查若遇到电机无法启动的情况建议按以下步骤排查检查VM电源电压是否在2.5V-13V范围内用示波器确认PWM信号是否正常输出测量IN1/IN2引脚电平是否符合预期检查SLP引脚是否为高电平断开电机测量OUT1-OUT2间电压正常时应为VM*Duty%调试时的一个实用技巧先在代码中固定设置一个较小的占空比如30%然后通过短路IN1/IN2到地或VCC来手动控制方向这样可以隔离软件问题。5.2 PID参数整定经验对于小型直流电机PID参数整定可以参考以下经验先设Ki0Kd0逐渐增大Kp直到系统出现等幅振荡取振荡时Kp值的60%作为最终比例系数逐渐增加Ki观察消除静差的效果最后加入微分项抑制超调典型参数范围Kp0.3-1.5Ki0.05-0.3Kd0.01-0.1在实际项目中我发现加入转速变化率限制能显著改善控制品质。即在每次更新PWM占空比时限制其变化幅度不超过前一次的±5%。这可以有效避免因编码器读数突变导致的控制量剧烈波动。