STM32 定时器编码器模式:AB 相正交解码与转速计算的工程做法
电机转速测量是最常见的 STM32 外设需求。新手常常用两个 GPIO 外部中断去数编码器脉冲,跑起来却发现高速丢脉冲、低速抖动误计数。更稳的做法是让定时器工作在编码器模式:硬件自动完成正交解码、方向判断和计数,CPU 只需定时读数。
一、编码器模式的原理
增量式编码器输出 A、B 两路相位差 90 度的方波。定时器编码器模式把 TI1、TI2 作为两个输入通道,根据两路信号的边沿组合判断旋转方向:A 超前 B 时向上计数,B 超前 A 时向下计数。计数器 CNT 的值就是累计脉冲数,方向由硬件实时维护,CPU 不用介入。
关键点是倍频。编码器模式有三种计数方式:只在 TI1 边沿计数(1 倍频)、只在 TI2 边沿计数(1 倍频)、在 TI1 和 TI2 的双边沿都计数(4 倍频)。同一根编码器线数,4 倍频的分辨率是 1 倍频的 4 倍。线数为 1000 的编码器,4 倍频下转一圈计数 4000,测速精度直接翻四倍。一般直接选编码器模式 3(双通道双边沿,4 倍频)。
二、配置要点
用 STM32CubeMX 配置很直观:定时器选 Encoder Mode,TI1、TI2 接编码器 A、B。容易踩的坑有三个。
第一是输入滤波。编码器信号走线长、电机干扰大时,毛刺会被当成有效边沿。IC1F、IC2F 滤波器按 fDTS 分频采样,值设为 5~10 能滤掉大多数毛刺。滤波越强,最高可测转速越低,高速场合要折中。
第二是极性。A、B 接反时方向正好反过来,测到的转速符号相反。调通后先手动正转确认 CNT 递增,再反转确认递减,接反了交换两根线或改极性配置。
第三是计数器位宽。16 位定时器转一圈 4000 个脉冲,计数器最多 65535,连续转 16 圈就溢出。转速计算必须处理溢出,不能只看 CNT 的绝对值。
三、转速计算:M 法与溢出处理
最常用的是 M 法:每隔固定采样周期 T(比如 10ms)读一次 CNT,用两次读数的差值算转速。
int32_t last_cnt = 0;
void TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)
{
int32_t cnt = (int32_t)__HAL_TIM_GET_COUNTER(&htim2);
int32_t delta = cnt - last_cnt;
last_cnt = cnt;
speed_rpm = delta * 60 / (4000 * 0.01f);
}
这里的关键是把 CNT 先扩成 int32 再做减法:16 位计数器从 65535 回绕到 0 时,int32 减法得到的是正确的正差值,不需要手动判断溢出。但这只在采样周期内转数不超过 32767 个脉冲时成立,转速极高或采样周期过长时差值会超过 int16 范围,需要缩短采样周期或改用 32 位定时器(TIM2/TIM5)。
低速场合 M 法精度差:10ms 内只来几个脉冲,量化误差很大。这时改用 T 法:测两个脉冲之间的时间间隔算转速,或者用 M/T 法结合——高速用脉冲数、低速用时间间隔,根据当前转速自动切换。
四、两个常见故障
一是静止时计数值来回跳。编码器停在边沿临界点,A 或 B 在高低电平间抖动,硬件每次抖动都计一次。解决办法是加大输入滤波,或在软件上加死区:连续两次读数差值小于阈值时按零处理。
二是反转瞬间转速跳变。电机换向时 CNT 先减后增,M 法在换向那一拍算出的转速符号会跳变。如果上层控制算法对符号跳变敏感,应在采样周期内做滑动平均,而不是直接用单次差值。
五、小结
编码器测速的工程做法可以归纳为四条:定时器开编码器模式 3(4 倍频),硬件解码不丢脉冲;输入滤波按干扰强度取 5~10;M 法定时读 CNT,int32 减法处理 16 位回绕;低速补 T 法,静止加死区。按这四条做,测速精度和稳定性基本不会出问题。
- 点赞
- 收藏
- 关注作者
评论(0)