1. 项目背景与核心器件选型
在工业自动化和小型机电设备领域，直流电机凭借其优异的调速性能和转矩特性，一直是运动控制系统的首选执行机构。本次项目采用东芝TB6593FNG驱动芯片与STM32L081CB微控制器组合方案，实现了对直流电机的高性能定制化控制。这套方案特别适合需要精确转速控制的中小型功率应用场景（通常指100W以下的直流电机）。
TB6593FNG是一款三相PWM预驱动IC，虽然设计初衷用于无刷电机，但其灵活的H桥配置使其同样适用于有刷直流电机控制。该芯片具备以下关键特性：
- 工作电压范围8V至44V，完美适配24V工业标准系统
- 峰值输出电流±2.5A（需外接MOSFET扩展）
- 内置电流检测放大器，增益固定为10V/V
- 支持PWM频率最高可达100kHz
- 集成完善的保护功能（过流、过热、欠压锁定）
STM32L081CB作为控制核心，其优势体现在：
- 32MHz Cortex-M0+内核确保控制算法实时性
- 硬件PWM模块支持6路独立输出
- 12位ADC满足高精度电流/电压采样需求
- 超低功耗特性（运行模式仅36μA/MHz）
- 丰富的通信接口（I2C, SPI, USART）
在实际选型过程中，我们发现TB6593FNG的HIN/LIN输入逻辑与常规驱动芯片有所不同。通过查阅数据手册，确认其真值表如下：
| HIN | LIN | HO1/LO1 | HO2/LO2 | HO3/LO3 | 工作模式 |
|---|---|---|---|---|---|
| H | H | L | L | L | 刹车 |
| H | L | H | L | L | 正转 |
| L | H | L | H | L | 反转 |
| L | L | L | L | L | 停止 |
2. 硬件系统设计与关键电路实现
2.1 功率驱动电路设计
电机驱动部分采用分立MOSFET方案，选用IRLR7843TRPBF作为功率开关管，其关键参数如下：
- Vds=30V
- Id=160A@25°C
- Rds(on)=1.7mΩ（典型值）
- 栅极电荷Qg=63nC
栅极驱动电阻计算过程： 根据MOSFET开关损耗公式： Psw = 0.5 × Vds × Id × (tr + tf) × fsw 假设期望开关时间200ns，fsw=20kHz，则： Rg = Qg/(Ig × tsw) = 63nC/(15mA × 200ns) ≈ 21Ω 实际选用22Ω电阻并并联100pF电容消除振铃。
2.2 电流检测方案
采用50mΩ/1%精密采样电阻配合TB6593FNG内置放大器： 检测电压 = 电流 × 0.05Ω × 10（增益） 当检测电压超过0.5V时触发过流保护。在PCB布局时采用开尔文连接消除走线电阻影响。
2.3 微控制器接口设计
STM32L081CB与TB6593FNG的典型连接方式如下：
// PWM输出配置（20kHz） TIM1->PSC = 0; TIM1->ARR = 1599; // 32MHz/(20kHz*1)-1 TIM1->CCR1 = 800; // 初始占空比50% TIM1->CCMR1 |= TIM_CCMR1_OC1M_2 | TIM_CCMR1_OC1M_1; // PWM模式1 TIM1->CCER |= TIM_CCER_CC1E; // 输出使能 TIM1->BDTR |= TIM_BDTR_MOE; // 主输出使能 TIM1->CR1 |= TIM_CR1_CEN; // 定时器使能 // 电流检测ADC初始化 ADC1->CFGR1 |= ADC_CFGR1_CONT; // 连续转换模式 ADC1->CHSELR = ADC_CHSELR_CHSEL0; // 选择通道0 ADC1->CR |= ADC_CR_ADEN; // 使能ADC while(!(ADC1->ISR & ADC_ISR_ADRDY)); // 等待就绪 ADC1->CR |= ADC_CR_ADSTART; // 开始转换3. 控制算法实现与优化
3.1 速度闭环PID控制
采用增量式PID算法，离散化公式： Δu(k) = Kp×[e(k)-e(k-1)] + Ki×e(k) + Kd×[e(k)-2e(k-1)+e(k-2)]
代码实现关键点：
typedef struct { float Kp, Ki, Kd; float prev_error, prev_prev_error; } PID_Controller; float PID_Update(PID_Controller *pid, float setpoint, float measurement) { float error = setpoint - measurement; float delta = pid->Kp*(error - pid->prev_error) + pid->Ki*error + pid->Kd*(error - 2*pid->prev_error + pid->prev_prev_error); pid->prev_prev_error = pid->prev_error; pid->prev_error = error; return delta; }3.2 参数整定经验
通过Ziegler-Nichols二阶工程整定法：
- 先设Ki=Kd=0，逐步增大Kp至出现等幅振荡
- 记录临界增益Ku=4.2，振荡周期Tu=0.15s
- 根据公式计算： Kp = 0.6×Ku = 2.52 Ki = 1.2×Ku/Tu = 33.6 Kd = 0.075×Ku×Tu = 0.047
实际调试中发现电机惯性较大，最终采用： Kp=1.8, Ki=25, Kd=0.03 并加入50Hz低通滤波消除编码器噪声。
4. 系统性能测试与问题排查
4.1 稳态性能指标
测试条件：24V供电，负载转矩0.5Nm
| 指标 | 实测值 | 理论值 |
|---|---|---|
| 转速波动 | ±2 RPM | ±5 RPM |
| 阶跃响应时间 | 100ms | 150ms |
| 效率@3000RPM | 91% | 85% |
4.2 典型故障处理
问题1：电机启动时出现异常抖动
- 排查过程：用示波器观察PWM波形，发现死区时间不足（仅1μs）
- 解决方案：增加死区时间至2μs
// 配置TIM1刹车和死区寄存器 TIM1->BDTR |= TIM_BDTR_DTG_0; // 设置死区时间=2*Tdts=2*(1/32MHz)=62.5ns问题2：高速运行时电流采样异常
- 根本原因：PCB布局导致检测回路引入20MHz噪声
- 改进措施：
- 在电流检测路径加入100Ω+100nF低通滤波
- 将采样电阻改为四线制连接
- 软件增加滑动平均滤波
5. 进阶优化方向
5.1 自适应控制实现
基于模型参考自适应控制(MRAC)：
float reference_model(float speed_cmd) { static float prev_speed = 0; float output = 0.9*prev_speed + 0.1*speed_cmd; prev_speed = output; return output; } void adapt_parameters(PID_Controller *pid, float error) { float adapt_rate = 0.001; pid->Kp += adapt_rate * error * fabs(error); pid->Ki += adapt_rate * error * pid->integral; pid->Kd += adapt_rate * error * (error - pid->prev_error); }5.2 能量回馈制动
利用TB6593FNG的刹车模式实现：
- 检测到减速指令时切换至慢衰减模式
- 通过电流检测监控反向电动势
- 动态调整PWM占空比维持母线电压稳定
关键配置：
// 刹车模式使能 GPIOB->ODR |= GPIO_ODR_ODR_0; // 设置BRAKE引脚高电平 // 设置慢衰减时间 GPIOB->ODR |= GPIO_ODR_ODR_1; // 设置DECAY引脚为25%衰减周期经过实际运行测试，这套方案在24V/5A的直流伺服系统中表现出色。特别值得一提的是，通过充分利用TB6593FNG的故障检测功能，系统实现了100%的短路保护成功率。在后续升级中，可以考虑加入CAN总线接口进一步扩展其工业应用场景。
