STM32与TB6593FNG的直流电机驱动系统设计与PID控制
1. 项目背景与核心需求
在工业自动化和小型机电设备开发中，直流电机因其结构简单、控制方便、调速性能好等优势，被广泛应用于各类场景。然而，标准化的直流电机往往难以满足特定应用场景下的性能需求，这就需要通过定制化的驱动方案来实现性能优化。
本项目基于TB6593FNG电机驱动芯片和STM32F100ZE微控制器，构建了一套完整的直流电机定制驱动系统。这个组合特别适合需要精确控制但成本敏感的应用场景，比如小型自动化设备、医疗仪器和消费电子产品。
核心需求可以归纳为以下三点：
- 精确的速度控制：传统PWM调速存在响应延迟和转速波动问题，需要实现±1%以内的转速控制精度
- 快速的动态响应：负载突变时电机转速恢复时间需要控制在100ms以内
- 完善的保护机制：需要实现过流、过热、堵转等实时保护功能，响应时间在微秒级
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 -> 电机负极保护电路设计要点：
- 电源滤波：在VM端添加100μF电解电容+100nF陶瓷电容组合
- 续流保护：电机两端并联1N5819肖特基二极管
- 电流检测：0.1Ω/2W电阻串联在GND回路
- 散热设计：散热片面积不小于4cm²/W，建议使用导热硅胶垫
2.3 传感器接口设计
为准确测量电机性能参数，系统集成了以下传感器：
- 霍尔传感器（A3144）：用于转速测量，安装在电机外壳
- INA219电流传感器：通过I²C接口连接，测量精度±1%
- 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; }参数整定经验：
- 先调电流环（响应最快），再调转速环
- 先用Ziegler-Nichols方法初步确定参数
- 实际测试时逐步减小比例增益，增加积分时间
- 最终参数范围：Kp=0.5-2.0, Ki=0.1-0.5, Kd=0.01-0.1
3.3 保护机制实现
系统实现了三级保护策略：
软件保护（响应时间ms级）：
- 过流检测（>2.5A持续100ms）
- 超温检测（>85℃）
- 堵转检测（转速为0但电流持续）
硬件保护（响应时间μs级）：
- TB6593FNG内置过流关断
- 比较器硬件触发刹车
机械保护：
- 物理限位开关
- 紧急停止按钮
4. 性能测试与优化方案
4.1 静态特性测试
在12V供电条件下，测得电机性能参数：
| 参数 | 空载值 | 额定负载值 | 单位 |
|---|---|---|---|
| 转速 | 3200 | 2800 | RPM |
| 电流 | 0.15 | 1.2 | A |
| 效率 | - | 78% | - |
| 转速波动率 | ±1.2% | ±2.5% | - |
4.2 动态响应测试
使用阶跃负载测试动态性能：
- 空载→50%负载：转速恢复时间85ms
- 50%→100%负载：转速恢复时间120ms
- 100%→空载：转速恢复时间65ms
通过优化PID参数和增加前馈补偿，最终将恢复时间缩短了约30%。
4.3 实测波形分析
使用示波器捕获的PWM和电流波形显示：
- 死区时间设置合理，没有出现上下桥臂直通
- 电流纹波系数<15%，符合设计要求
- 开关边沿干净，振铃幅度<5%
重要提示：当PWM频率超过25kHz时，TB6593FNG的开关损耗会显著增加，导致芯片温度快速上升。建议在20kHz附近选择具体频率，这是效率与噪声的最佳平衡点。
5. 典型问题排查与解决
5.1 电机启动抖动问题
现象：低速启动时电机抖动明显，伴随异常噪音
排查过程：
- 检查PWM信号 - 正常
- 测量电源电压 - 发现启动瞬间电压跌落至9V
- 检查布线 - 电源线过长（超过30cm）
解决方案：
- 缩短电源走线长度至15cm以内
- 在电机端增加2200μF电容
- 采用软启动策略（0→100%占空比用时200ms）
5.2 转速测量误差大
现象：显示转速与实际值偏差>10%
原因分析：
- 霍尔传感器安装位置偏差
- 软件去抖算法过于激进
- 定时器捕获配置错误
优化措施：
// 修改捕获边沿为双边沿触发 TIM_ICInitTypeDef TIM_ICInitStruct; TIM_ICInitStruct.TIM_ICPolarity = TIM_ICPolarity_BothEdge; TIM_ICInit(TIM4, &TIM_ICInitStruct);同时将霍尔传感器安装间隙调整为1±0.1mm。
5.3 高温保护误触发
现象：常温下频繁报高温故障
诊断步骤：
- 测量NTC电阻值 - 与温度对应关系异常
- 检查分压电阻 - 发现使用5%精度的普通电阻
- 测量ADC参考电压 - 3.3V稳定
最终方案：
- 更换1%精度的分压电阻
- 增加软件滤波（10次滑动平均）
- 校准温度曲线（每5℃一个校准点）
在实际部署中，电机控制系统的稳定性往往取决于细节处理。例如我们发现，将PWM信号的走线远离模拟传感器线路后，转速波动率降低了40%。另一个关键经验是：TB6593FNG的散热焊盘必须良好接地，否则在长时间工作时会出现性能退化。