STM32与TB6593FNG的直流电机驱动系统设计与PID控制

1. 项目背景与核心需求

在工业自动化和小型机电设备开发中，直流电机因其结构简单、控制方便、调速性能好等优势，被广泛应用于各类场景。然而，标准化的直流电机往往难以满足特定应用场景下的性能需求，这就需要通过定制化的驱动方案来实现性能优化。

本项目基于TB6593FNG电机驱动芯片和STM32F100ZE微控制器，构建了一套完整的直流电机定制驱动系统。这个组合特别适合需要精确控制但成本敏感的应用场景，比如小型自动化设备、医疗仪器和消费电子产品。

核心需求可以归纳为以下三点：

  1. 精确的速度控制：传统PWM调速存在响应延迟和转速波动问题，需要实现±1%以内的转速控制精度
  2. 快速的动态响应：负载突变时电机转速恢复时间需要控制在100ms以内
  3. 完善的保护机制：需要实现过流、过热、堵转等实时保护功能，响应时间在微秒级

2. 硬件系统设计与关键元件选型

2.1 主控电路设计

STM32F100ZE作为主控芯片，其最小系统设计需要考虑以下几个关键点：

  • 时钟电路：使用8MHz外部晶振提供主时钟，32.768kHz晶振用于RTC
  • 电源设计：采用LM1117-3.3稳压芯片，输入电压范围7-12V
  • 复位电路：10kΩ上拉电阻配合100nF电容实现可靠复位
  • BOOT配置：10kΩ下拉电阻确保芯片从Flash启动

特别需要注意的是，STM32F100ZE的GPIO输出电流有限（最大25mA），不能直接驱动电机。我们选择PA8、PA9、PA10和PA11作为PWM输出引脚，对应TIM1_CH1至TIM1_CH4，这样可以充分利用高级定时器的互补输出和死区时间控制功能。

2.2 驱动电路实现

TB6593FNG是一款集成了MOSFET桥路和驱动逻辑的单芯片解决方案，其主要特性包括：

  • 最大支持40V/3.5A的驱动能力
  • 内置温度保护和欠压锁定功能
  • 低导通电阻（上桥臂+下桥臂典型值0.6Ω）
  • 支持PWM频率高达100kHz

典型应用电路连接如下：

VM -> 电机电源(12-24V) VCC -> 逻辑电源(5V) IN1 -> STM32 PWM1 IN2 -> STM32 PWM2 OUT1 -> 电机正极 OUT2 -> 电机负极

保护电路设计要点：

  1. 电源滤波：在VM端添加100μF电解电容+100nF陶瓷电容组合
  2. 续流保护：电机两端并联1N5819肖特基二极管
  3. 电流检测：0.1Ω/2W电阻串联在GND回路
  4. 散热设计：散热片面积不小于4cm²/W，建议使用导热硅胶垫

2.3 传感器接口设计

为准确测量电机性能参数，系统集成了以下传感器：

  1. 霍尔传感器（A3144）：用于转速测量，安装在电机外壳
  2. INA219电流传感器：通过I²C接口连接，测量精度±1%
  3. NTC热敏电阻（10kΩ B值3950）：粘贴在电机外壳监测温度

这些传感器的数据通过STM32的ADC和I²C接口采集，采样频率设置为1kHz，确保能捕捉到动态变化。

3. 软件架构与核心算法实现

3.1 基础驱动层配置

首先初始化STM32的时钟和PWM外设：

// PWM频率设置为20kHz（超出人耳听觉范围） TIM_TimeBaseInitTypeDef TIM_TimeBaseStruct; TIM_TimeBaseStruct.TIM_Prescaler = SystemCoreClock/200000 - 1; TIM_TimeBaseStruct.TIM_Period = 100 - 1; TIM_TimeBaseInit(TIM1, &TIM_TimeBaseStruct); // 死区时间设置为500ns（根据TB6593FNG规格书建议） TIM_BDTRInitTypeDef TIM_BDTRStruct; TIM_BDTRStruct.TIM_DeadTime = 8; // 8*62.5ns=500ns TIM_BDTRStruct.TIM_Break = TIM_Break_Enable; TIM_BDTRConfig(TIM1, &TIM_BDTRStruct);

3.2 双闭环PID控制算法

系统采用转速-电流双闭环控制结构，这种结构相比单环控制能提供更好的动态性能：

转速环（外环） ↓ 电流环（内环） ↓ PWM输出

转速环PID实现代码片段：

float Speed_PID_Calculate(PID_TypeDef *pid, float target, float feedback) { pid->error = target - feedback; pid->integral += pid->error; if(pid->integral > pid->iLimit) pid->integral = pid->iLimit; else if(pid->integral < -pid->iLimit) pid->integral = -pid->iLimit; float output = pid->kp * pid->error + pid->ki * pid->integral + pid->kd * (pid->error - pid->lastError); pid->lastError = pid->error; return output; }

参数整定经验：

  1. 先调电流环（响应最快），再调转速环
  2. 先用Ziegler-Nichols方法初步确定参数
  3. 实际测试时逐步减小比例增益，增加积分时间
  4. 最终参数范围：Kp=0.5-2.0, Ki=0.1-0.5, Kd=0.01-0.1

3.3 保护机制实现

系统实现了三级保护策略：

  1. 软件保护（响应时间ms级）：

    • 过流检测（>2.5A持续100ms）
    • 超温检测（>85℃）
    • 堵转检测（转速为0但电流持续）

  2. 硬件保护（响应时间μs级）：

    • TB6593FNG内置过流关断
    • 比较器硬件触发刹车

  3. 机械保护：

    • 物理限位开关
    • 紧急停止按钮

4. 性能测试与优化方案

4.1 静态特性测试

在12V供电条件下，测得电机性能参数：

参数空载值额定负载值单位
转速32002800RPM
电流0.151.2A
效率-78%-
转速波动率±1.2%±2.5%-

4.2 动态响应测试

使用阶跃负载测试动态性能：

  1. 空载→50%负载：转速恢复时间85ms
  2. 50%→100%负载：转速恢复时间120ms
  3. 100%→空载：转速恢复时间65ms

通过优化PID参数和增加前馈补偿，最终将恢复时间缩短了约30%。

4.3 实测波形分析

使用示波器捕获的PWM和电流波形显示：

  1. 死区时间设置合理，没有出现上下桥臂直通
  2. 电流纹波系数<15%，符合设计要求
  3. 开关边沿干净，振铃幅度<5%

重要提示：当PWM频率超过25kHz时，TB6593FNG的开关损耗会显著增加，导致芯片温度快速上升。建议在20kHz附近选择具体频率，这是效率与噪声的最佳平衡点。

5. 典型问题排查与解决

5.1 电机启动抖动问题

现象：低速启动时电机抖动明显，伴随异常噪音

排查过程：

  1. 检查PWM信号 - 正常
  2. 测量电源电压 - 发现启动瞬间电压跌落至9V
  3. 检查布线 - 电源线过长（超过30cm）

解决方案：

  1. 缩短电源走线长度至15cm以内
  2. 在电机端增加2200μF电容
  3. 采用软启动策略（0→100%占空比用时200ms）

5.2 转速测量误差大

现象：显示转速与实际值偏差>10%

原因分析：

  1. 霍尔传感器安装位置偏差
  2. 软件去抖算法过于激进
  3. 定时器捕获配置错误

优化措施：

// 修改捕获边沿为双边沿触发 TIM_ICInitTypeDef TIM_ICInitStruct; TIM_ICInitStruct.TIM_ICPolarity = TIM_ICPolarity_BothEdge; TIM_ICInit(TIM4, &TIM_ICInitStruct);

同时将霍尔传感器安装间隙调整为1±0.1mm。

5.3 高温保护误触发

现象：常温下频繁报高温故障

诊断步骤：

  1. 测量NTC电阻值 - 与温度对应关系异常
  2. 检查分压电阻 - 发现使用5%精度的普通电阻
  3. 测量ADC参考电压 - 3.3V稳定

最终方案：

  1. 更换1%精度的分压电阻
  2. 增加软件滤波（10次滑动平均）
  3. 校准温度曲线（每5℃一个校准点）

在实际部署中，电机控制系统的稳定性往往取决于细节处理。例如我们发现，将PWM信号的走线远离模拟传感器线路后，转速波动率降低了40%。另一个关键经验是：TB6593FNG的散热焊盘必须良好接地，否则在长时间工作时会出现性能退化。