STM32与TB6612电机驱动实战：从PWM控制到编码器测速全解析
在机器人开发领域，精确的电机控制是移动平台实现自主导航的基础。无论是参加RoboMaster竞赛的工程机器人，还是高校实验室的SLAM研究平台，稳定可靠的电机驱动方案都直接影响着机器人的运动性能和定位精度。本文将深入探讨基于STM32微控制器和TB6612驱动芯片的完整电机控制解决方案，涵盖硬件接口设计、PWM信号生成、编码器数据采集以及抗干扰布局等关键技术要点。
1. 硬件架构设计与核心元件选型
1.1 系统整体架构
典型的机器人运动控制系统包含三个核心层级：控制层采用STM32等微控制器作为运算核心，负责运动算法执行和信号处理；驱动层选用TB6612等专业电机驱动芯片，实现功率放大和方向控制；执行层则由直流电机配合光电编码器组成，形成闭环控制的基础。这种分层设计既保证了控制精度，又确保了系统可靠性。
TB6612相较于传统的L298N驱动芯片具有明显优势：
- 效率提升：采用MOSFET功率管，导通电阻仅0.3Ω（H桥上下合计）
- 集成度高：单芯片集成双H桥，支持两路直流电机控制
- 保护完善：内置过热关断和低压检测功能
- 控制简化：逻辑电平兼容3.3V/5V系统，无需额外电平转换
1.2 关键参数匹配原则
在设计电机驱动接口时，需要重点考虑以下参数的匹配关系：
| 参数类别 | TB6612规格 | STM32F103配置建议 | 注意事项 |
|---|---|---|---|
| 工作电压 | 2.5-13.8V | 3.3V逻辑电平 | VM电源需单独供电 |
| 峰值电流 | 3.2A(单路) | GPIO驱动能力8mA | 需外接续流二极管 |
| PWM频率 | 支持100kHz | 定时器最高72MHz | 建议1-20kHz范围 |
| 响应时间 | 1μs(典型值) | 定时器分辨率14ns | 高频率需考虑软件开销 |
| 待机功耗 | 0μA(standby模式) | 支持睡眠模式 | 需正确配置STBY引脚 |
2. PWM控制信号生成与电机驱动
2.1 STM32定时器配置
STM32的通用定时器(TIM2-TIM5)非常适合生成电机控制PWM信号。以下是一个典型的PWM初始化代码示例：
// TIM3初始化 生成10kHz PWM void PWM_Init(void) { GPIO_InitTypeDef GPIO_InitStruct; TIM_TimeBaseInitTypeDef TIM_TimeBaseStruct; TIM_OCInitTypeDef TIM_OCInitStruct; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); // 配置PA6为复用推挽输出(TIM3_CH1) GPIO_InitStruct.GPIO_Pin = GPIO_Pin_6; GPIO_InitStruct.GPIO_Mode = GPIO_Mode_AF_PP; GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOA, &GPIO_InitStruct); // 时基配置：72MHz/(720*100) = 10kHz TIM_TimeBaseStruct.TIM_Period = 100 - 1; // 自动重装载值 TIM_TimeBaseStruct.TIM_Prescaler = 720 - 1; // 预分频系数 TIM_TimeBaseStruct.TIM_ClockDivision = 0; TIM_TimeBaseStruct.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStruct); // PWM模式配置 TIM_OCInitStruct.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitStruct.TIM_OutputState = TIM_OutputState_Enable; TIM_OCInitStruct.TIM_Pulse = 0; // 初始占空比0% TIM_OCInitStruct.TIM_OCPolarity = TIM_OCPolarity_High; TIM_OC1Init(TIM3, &TIM_OCInitStruct); TIM_Cmd(TIM3, ENABLE); TIM_CtrlPWMOutputs(TIM3, ENABLE); }提示：高级定时器(TIM1/TIM8)支持互补输出和死区控制，适合需要安全保护的工业应用场景
2.2 TB6612接口电路设计
TB6612的典型应用电路需要正确处理以下信号连接：
- 逻辑控制接口：
- PWMA/PWMB：连接STM32的PWM输出引脚
- AIN1/AIN2/BIN1/BIN2：控制电机转向的GPIO
- STBY：硬件使能信号(高电平有效)
- 功率接口：
- VM：电机供电电源(建议10-12V)
- VCC：逻辑电源(3.3V/5V)
- AO1/AO2/BO1/BO2：电机输出端
- 保护电路：
- 电机两端并联100nF电容滤除高频噪声
- 电源输入端添加470μF电解电容储能
电机转向控制真值表：
| AIN1 | AIN2 | PWM | 电机状态 |
|---|---|---|---|
| 0 | 0 | X | 停止 |
| 1 | 0 | 有效 | 正转 |
| 0 | 1 | 有效 | 反转 |
| 1 | 1 | X | 刹车 |
3. 编码器接口与速度测量
3.1 正交编码器工作原理
光电编码器通过AB两相输出正交脉冲信号，其相位关系可判断转向，脉冲数量反映转动角度。STM32的定时器编码器接口模式能自动处理这种信号，硬件实现4倍频计数。
编码器信号特征：
- 典型分辨率：500线/转(实际2000脉冲/转，4倍频后)
- 信号类型：推挽或开漏输出
- 最大响应频率：通常100kHz以上
- 相位差：90°±45°(正交关系)
3.2 STM32编码器模式配置
使用TIM2/TIM3/TIM4的编码器接口模式，示例配置如下：
void Encoder_Init(void) { GPIO_InitTypeDef GPIO_InitStruct; TIM_TimeBaseInitTypeDef TIM_TimeBaseStruct; TIM_ICInitTypeDef TIM_ICInitStruct; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); // 配置PA0/PA1为浮空输入(编码器AB相) GPIO_InitStruct.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1; GPIO_InitStruct.GPIO_Mode = GPIO_Mode_IN_FLOATING; GPIO_Init(GPIOA, &GPIO_InitStruct); // 时基结构体初始化(实际值不影响编码器模式) TIM_TimeBaseStruct.TIM_Period = 65535; TIM_TimeBaseStruct.TIM_Prescaler = 0; TIM_TimeBaseStruct.TIM_ClockDivision = 0; TIM_TimeBaseStruct.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStruct); // 编码器接口配置 TIM_EncoderInterfaceConfig(TIM2, TIM_EncoderMode_TI12, TIM_ICPolarity_Rising, TIM_ICPolarity_Rising); TIM_ICStructInit(&TIM_ICInitStruct); TIM_ICInitStruct.TIM_ICFilter = 6; // 适当滤波 TIM_ICInit(TIM2, &TIM_ICInitStruct); TIM_SetCounter(TIM2, 32768); // 初始值设为中值(支持双向计数) TIM_Cmd(TIM2, ENABLE); }3.3 速度计算算法
通过定时采样编码器计数值可计算实时转速，常用方法包括：
- M法测速：固定时间间隔内的脉冲计数
int32_t Get_Speed(uint32_t interval_ms) { static int32_t last_count = 0; int32_t current_count = TIM_GetCounter(TIM2); int32_t delta = current_count - last_count; last_count = current_count; // 转换为转速(RPM): (delta/2000)*1000/(interval_ms/60000) return delta * 30 / interval_ms; } - T法测速：测量相邻脉冲的时间间隔
- M/T混合法：结合两者优点，提高全量程精度
注意：在中断服务函数中读取计数值时，应使用TIM_GetCounter()的原子操作，避免16位寄存器读取时的数据撕裂问题
4. PCB布局与抗干扰设计
4.1 电源分配策略
合理的电源布局对系统稳定性至关重要，建议采用星型拓扑：
- 主电源路径： 锂电池 → 保险丝 → 开关 → 100μF电解电容 → TB6612的VM引脚
- 控制电源路径： 锂电池 → 5V稳压 → 3.3V LDO → 10μF+0.1μF去耦电容 → MCU
- 地平面处理： 数字地与功率地单点连接，电机回流路径尽量短
4.2 关键信号布线规则
| 信号类型 | 线宽要求 | 间距要求 | 布线层优先 | 特殊处理 |
|---|---|---|---|---|
| 电机功率线 | ≥1mm | ≥0.5mm | 顶层 | 避免直角转弯 |
| PWM控制线 | 0.3mm | 0.2mm | 底层 | 远离高频噪声源 |
| 编码器信号线 | 0.2mm | 0.2mm | 内层 | 差分走线，加终端匹配电阻 |
| 模拟小信号 | 0.2mm | 0.3mm | 内层 | 包地处理 |
4.3 噪声抑制措施
- 传导干扰抑制：
- 电机两端并联0.1μF陶瓷电容和二极管续流
- 电源输入端加入共模扼流圈
- 辐射干扰抑制：
- 关键信号线使用屏蔽双绞线
- 敏感电路区域敷设铜箔屏蔽
- 软件滤波：
- 编码器信号数字滤波(定时器ICF[3:0]位)
- PWM占空比渐变算法避免突变
在实际项目中，我曾遇到编码器计数异常的问题，最终发现是电机电源线与编码器信号线平行走线导致耦合干扰。将两者垂直布线并增加屏蔽层后，问题得到彻底解决。这个案例印证了合理布局对系统稳定性的关键作用。
