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

手把手教你用STM32的定时器捕获功能，读取编码电机转速（附TB6612驱动代码）

news 2026/6/14 7:30:00

STM32定时器捕获功能实战：精准读取编码电机转速与TB6612驱动方案

在工业自动化、机器人控制以及智能家居设备中，电机转速的精确测量是实现闭环控制的基础。传统方法依赖外部中断或软件延时，不仅占用CPU资源，还难以应对高速脉冲信号。本文将深入探讨如何利用STM32内置定时器的输入捕获与编码器接口模式，构建一个高效可靠的电机测速系统，并结合TB6612FNG驱动模块实现完整的运动控制方案。

1. 硬件架构设计与核心组件选型

一套完整的电机控制系统通常包含三个关键部分：微控制器、电机驱动模块和反馈传感器。我们选用STM32F4系列作为主控芯片，其丰富的高级定时器资源特别适合处理编码器信号；TB6612FNG作为驱动核心，提供高达1.2A的持续输出电流；而增量式编码电机则负责实时反馈转速信息。

TB6612FNG驱动模块的独特优势：

双H桥设计，可同时驱动两个直流电机或一个步进电机
MOSFET功率管架构，效率可达97%（远高于传统L298N）
内置热关断和低压保护电路
支持PWM频率高达100kHz
待机电流仅0.1μA（通过STBY引脚控制）

注意：VM（电机电源）与VCC（逻辑电源）必须分开供电，避免电机启动时的电压波动影响MCU稳定性。典型配置为VM=12V，VCC=3.3V。

编码器接线时需特别注意：

// 推荐接线方式 电机线+ -> TB6612 AO1 电机线- -> TB6612 AO2 编码器A -> STM32 TIMx_CH1 编码器B -> STM32 TIMx_CH2 编码器VCC -> 3.3V 编码器GND -> 共地

2. STM32定时器工作模式深度解析

STM32的通用定时器（如TIM2-TIM5）和高级定时器（TIM1,TIM8）都支持编码器接口模式，其本质是通过硬件自动处理正交编码信号，大幅减轻CPU负担。当配置为编码器模式时，定时器会根据A/B相脉冲的边沿和相位关系自动增减计数器。

关键配置参数对比：

参数项	输入捕获模式	编码器模式
信号处理方式	软件中断	硬件自动计数
最高频率	约100kHz	可达定时器时钟频率1/4
方向检测	需软件判断	硬件自动识别
CPU占用率	高	极低
适用场景	低频单通道信号	高频正交编码信号

配置编码器模式的典型代码：

void TIM_Encoder_Config(void) { TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure; TIM_ICInitTypeDef TIM_ICInitStructure; // 时基单元配置 TIM_TimeBaseStructInit(&TIM_TimeBaseStructure); TIM_TimeBaseStructure.TIM_Prescaler = 0; TIM_TimeBaseStructure.TIM_Period = 65535; // 16位最大值 TIM_TimeBaseStructure.TIM_ClockDivision = 0; TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); // 编码器接口配置 TIM_EncoderInterfaceConfig(TIM3, TIM_EncoderMode_TI12, TIM_ICPolarity_Rising, TIM_ICPolarity_Rising); // 输入捕获配置 TIM_ICStructInit(&TIM_ICInitStructure); TIM_ICInitStructure.TIM_ICFilter = 6; // 适当滤波 TIM_ICInit(TIM3, &TIM_ICInitStructure); TIM_Cmd(TIM3, ENABLE); }

3. 转速计算算法与误差处理

获得脉冲计数后，转速计算需要考虑三个关键因素：编码器分辨率、采样周期和测量方向。典型250线编码器每转会产生1000个脉冲（四倍频后），而采样周期则取决于控制系统响应速度需求。

转速计算步骤：

在固定周期T（如10ms）读取计数器值CNT
计算脉冲差值：ΔP = CNT - CNT_prev
考虑计数器溢出：若|ΔP| > MAX/2，进行溢出修正
实际转速RPM = (ΔP × 60) / (PPR × T)
- PPR: 每转脉冲数（250线编码器PPR=1000）
- T: 采样周期（秒）

为提高测量精度，可采用以下优化策略：

滑动平均滤波：维护一个长度为N的队列，计算移动平均值
动态采样调整：转速高时缩短采样周期，转速低时延长
异常值剔除：当ΔP超过合理范围时视为干扰信号

提示：在电机启动/停止阶段，建议采用软件去抖算法避免误判。可通过连续检测多个周期的一致性来确认有效信号。

4. 闭环控制实现与TB6612驱动优化

将转速测量与PWM控制结合，即可构建完整的闭环系统。TB6612的PWM输入频率建议设置在5-20kHz之间，既能避免可闻噪声，又能保证响应速度。典型的PID控制流程如下：

读取当前转速（编码器反馈）
计算误差：e = 目标转速 - 实际转速

更新PID各项：

pTerm = Kp * e; iTerm += Ki * e; dTerm = Kd * (e - lastError); output = pTerm + iTerm + dTerm;

限制输出范围并写入PWM寄存器
更新TB6612方向控制引脚（AIN1/AIN2）

PID参数整定技巧：

先设Ki=Kd=0，增大Kp直到系统出现轻微振荡
然后加入Ki消除静差，但不宜过大以免积分饱和
最后加入Kd抑制超调，改善动态响应
实际项目中建议加入抗积分饱和和输出限幅机制

TB6612驱动优化配置示例：

// PWM初始化（以TIM1 CH1为例） void PWM_Init(void) { GPIO_InitTypeDef GPIO_InitStructure; TIM_OCInitTypeDef TIM_OCInitStructure; // 使能时钟 RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE); RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA, ENABLE); // 配置PA8为TIM1_CH1 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_8; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz; GPIO_InitStructure.GPIO_OType = GPIO_OType_PP; GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP; GPIO_Init(GPIOA, &GPIO_InitStructure); GPIO_PinAFConfig(GPIOA, GPIO_PinSource8, GPIO_AF_TIM1); // PWM配置 TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; TIM_OCInitStructure.TIM_Pulse = 0; // 初始占空比0 TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; TIM_OC1Init(TIM1, &TIM_OCInitStructure); TIM_CtrlPWMOutputs(TIM1, ENABLE); TIM_Cmd(TIM1, ENABLE); }

5. 系统集成与调试技巧

在实际组装系统时，布线质量直接影响信号稳定性。建议采用以下实践方案：

硬件布局要点：

电机电源与逻辑电源完全隔离
编码器信号线使用双绞线或屏蔽线
在TIM输入引脚添加100pF滤波电容
TB6612的VM端并联大容量电解电容（如220μF）
所有GND最终单点共地

调试阶段常见问题及解决方法：

现象	可能原因	解决方案
转速测量值跳变	信号干扰	增加硬件滤波，缩短走线距离
方向判断错误	A/B相序接反	交换编码器A/B相接线
高速时计数丢失	定时器溢出处理不当	启用定时器溢出中断
电机响应迟缓	PID参数不合适	重新整定，特别是减小积分项
TB6612发热严重	PWM频率过低	提高频率至10kHz以上