当前位置：首页 > news >正文

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

news 2026/7/8 10:29:08

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_CH1（PA8引脚）
方向控制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 = {.Kp=0.5, .Ki=0.1, .Kd=0.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); }