STM32F103C8T6编码器测速避坑指南：从脉冲到速度的完整计算流程（附代码）

STM32F103C8T6编码器测速避坑指南：从脉冲到速度的完整计算流程（附代码）

在嵌入式运动控制领域，编码器测速的精度直接影响闭环系统性能。许多开发者在使用STM32F103C8T6实现编码器测速时，常会遇到脉冲丢失、方向误判、速度波动大等问题。本文将深入解析硬件配置陷阱、软件处理技巧以及工业级精度优化方案。

1. 硬件配置的魔鬼细节

1.1 定时器模式选择误区

STM32F103的TIMx定时器支持三种编码器接口模式：

• TIM_ENCODERMODE_TI1：仅TI1边沿触发
• TIM_ENCODERMODE_TI2：仅TI2边沿触发
• TIM_ENCODERMODE_TI12：双相边沿触发（推荐）

TIM_Encoder_InitTypeDef sConfig = { .EncoderMode = TIM_ENCODERMODE_TI12, // 必须选择此模式 .IC1Polarity = TIM_ICPOLARITY_RISING, .IC2Polarity = TIM_ICPOLARITY_RISING, .IC1Filter = 6, // 抗干扰滤波值 .IC2Filter = 6 // 典型值6-15 };

注意：滤波值过小会导致噪声敏感，过大可能丢失高速脉冲。建议通过示波器观察信号质量后调整。

1.2 GPIO配置关键参数

常见错误是忽略GPIO速度设置，导致高频脉冲无法正常捕获：

GPIO_InitStruct.Pin = GPIO_PIN_0 | GPIO_PIN_1; GPIO_InitStruct.Mode = GPIO_MODE_AF_INPUT; GPIO_InitStruct.Pull = GPIO_PULLUP; // 编码器输出开漏时必备 GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH; HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);

2. 脉冲计数中的边界问题

2.1 定时器溢出处理方案

当编码器高速旋转时，16位定时器（CNT寄存器）容易溢出。推荐采用32位扩展计数法：

volatile int32_t total_count = 0; uint16_t last_cnt = 0; void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if(htim->Instance == TIM2) { int16_t diff = __HAL_TIM_GET_COUNTER(htim) - last_cnt; if(diff > 32767) total_count -= 65536 - diff; else if(diff < -32768) total_count += 65536 + diff; else total_count += diff; last_cnt = __HAL_TIM_GET_COUNTER(htim); } }

2.2 方向判定逻辑优化

传统AB相判向方法在信号抖动时易出错，改进方案：

1. 采用状态机判向：

   typedef enum { DIR_UNKNOWN, DIR_CW, // 顺时针 DIR_CCW // 逆时针 } Encoder_Dir; Encoder_Dir get_direction(uint8_t a_phase, uint8_t b_phase) { static uint8_t last_state = 0; uint8_t current_state = (a_phase << 1) | b_phase; Encoder_Dir dir = DIR_UNKNOWN; switch(last_state) { case 0b00: if(current_state == 0b01) dir = DIR_CW; else if(current_state == 0b10) dir = DIR_CCW; break; case 0b01: if(current_state == 0b11) dir = DIR_CW; else if(current_state == 0b00) dir = DIR_CCW; break; // 补充完整状态转移... } last_state = current_state; return dir; }

2. 增加消抖处理：

   • 采样间隔 > 2倍信号抖动周期
   • 连续3次同方向才确认转向

3. 速度计算的工业级实现

3.1 多采样率自适应算法

固定采样周期在变速场景下精度差，推荐动态调整策略：

float calculate_rpm(int32_t pulse_diff, uint16_t sample_ms) { const float pulse_per_rev = 11.0 * 30 * 4; // 编码器线数×减速比×4倍频 return (pulse_diff * 60000.0) / (pulse_per_rev * sample_ms); }

3.2 卡尔曼滤波应用

针对高频噪声的速度滤波实现：

typedef struct { float q; // 过程噪声协方差 float r; // 观测噪声协方差 float x; // 估计值 float p; // 估计误差协方差 float k; // 卡尔曼增益 } KalmanFilter; float kalman_update(KalmanFilter *kf, float measurement) { // 预测阶段 kf->p = kf->p + kf->q; // 更新阶段 kf->k = kf->p / (kf->p + kf->r); kf->x = kf->x + kf->k * (measurement - kf->x); kf->p = (1 - kf->k) * kf->p; return kf->x; }

4. 实战调试技巧

4.1 示波器诊断方法

当出现测速异常时，按以下顺序排查：

1. 信号质量检查：

   • AB相幅值是否达标（通常>2.8V）
   • 上升/下降时间是否<100ns
   • 是否存在振铃现象

2. 相位关系验证：

   • 正转时A相超前B相90°
   • 反转时B相超前A相90°

4.2 软件调试关键点

在Keil MDK中设置实时监控变量：

1. 添加Watch窗口监测：

   • __HAL_TIM_GET_COUNTER(&htim2)
   • total_count
   • Motor1Speed

2. 使用逻辑分析仪插件捕获GPIO状态：

   # 在Debug Console输入的Py命令 import pywinusb.hid as hid LA.start() LA.addSignal("PA0", "ENCODER_A") LA.addSignal("PA1", "ENCODER_B") LA.setTrigger("ENCODER_A", "Rising")

4.3 机械安装注意事项

• 编码器轴与电机轴同心度偏差<0.1mm
• 使用柔性联轴器补偿径向偏差
• 避免强电磁干扰源靠近信号线

5. 完整代码实现

5.1 硬件抽象层封装

typedef struct { TIM_HandleTypeDef *htim; int32_t total_pulses; float speed_rpm; KalmanFilter filter; } Encoder_HandleTypeDef; void Encoder_Update(Encoder_HandleTypeDef *henc, uint16_t sample_ms) { int16_t cnt = __HAL_TIM_GET_COUNTER(henc->htim); henc->total_pulses += cnt; __HAL_TIM_SET_COUNTER(henc->htim, 0); float raw_rpm = calculate_rpm(cnt, sample_ms); henc->speed_rpm = kalman_update(&henc->filter, raw_rpm); }

5.2 应用层调用示例

Encoder_HandleTypeDef henc1 = { .htim = &htim2, .filter = { .q = 0.01, .r = 0.1, .x = 0, .p = 1 } }; while(1) { if(HAL_GetTick() - last_tick >= 10) { // 10ms采样 Encoder_Update(&henc1, 10); last_tick = HAL_GetTick(); printf("Speed: %.1f RPM\tPulses: %ld\r\n", henc1.speed_rpm, henc1.total_pulses); } }

在电机控制实践中，编码器信号的稳定性往往比绝对精度更重要。建议在完成基础测试后，重点优化信号链路的抗干扰能力，包括使用双绞线传输、增加磁环、优化接地等工程细节。