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

你的电机速度跳来跳去？STM32 HAL库编码器测速的滤波与防溢出实战指南

news 2026/6/2 23:41:29

STM32 HAL库编码器测速：从抖动抑制到零漂消除的工程实践

在机器人关节控制或工业伺服系统中，编码器测速的稳定性直接决定了整个系统的控制品质。当电机转速显示像心电图般上下跳动时，不仅PID调节器会频繁振荡，更可能导致机械臂末端出现毫米级的位置偏差。本文将深入解决三个核心痛点：如何滤除机械振动导致的脉冲毛刺？怎样设计抗溢出计数架构？以及如何实现长期运行无累积误差的绝对位置跟踪？

1. 硬件层噪声抑制：从源头减少脉冲抖动

编码器信号在传输过程中会叠加高频噪声，特别是长距离布线时。某协作机器人项目曾因20cm未屏蔽线缆导致速度波动达±15RPM。

1.1 硬件滤波参数优化

在TIM配置阶段增加输入滤波参数：

TIM_Encoder_InitTypeDef sConfig = {0}; sConfig.IC1Filter = 0xF; // 8个时钟周期滤波 sConfig.IC1Polarity = TIM_INPUTCHANNELPOLARITY_RISING; sConfig.IC1Prescaler = TIM_ICPSC_DIV1; sConfig.IC1Selection = TIM_ICSELECTION_DIRECTTI;

表：不同滤波等级对信号的影响

滤波等级	有效脉冲宽度	最大转速限制
0x0	2ns	50,000RPM
0xF	32ns	3,000RPM

提示：滤波时间过长会导致高速时脉冲丢失，建议通过示波器观察实际信号质量

1.2 四倍频模式下的边沿一致性

启用编码器接口时需特别注意：

htim5.Init.CounterMode = TIM_COUNTERMODE_UP; htim5.Init.Period = 65535; // 16位计数器最大值 if (HAL_TIM_Encoder_Init(&htim5, TIM_ENCODERMODE_TI12) != HAL_OK) { Error_Handler(); }

常见问题排查步骤：

用逻辑分析仪捕获TI1/TI2原始波形
检查AB相脉冲间隔是否大于滤波器设置时间
验证IO口模式是否配置为浮空输入

2. 软件抗干扰设计：动态阈值滤波算法

原始代码中固定的3333阈值在变速场景下会导致速度突变。我们引入自适应窗口滤波：

2.1 速度变化率限制算法

在TIM6中断服务中改进计算逻辑：

#define MAX_DELTA (PULSE_PRE_ROUND * 4 / 10) // 每周期最大允许变化量 int32_t delta = motor1_count - motor1_lastcount; if(abs(delta) > last_delta * 1.5) { delta = last_delta * sign(delta); // 限制变化率 } last_delta = abs(delta);

2.2 运动状态机设计

表：不同状态下的滤波策略

状态	滤波系数	更新频率	适用场景
静止	0.1	10Hz	零速保持
加速/减速	0.5	50Hz	动态跟随
匀速	0.3	30Hz	抑制微小波动

状态切换逻辑实现：

enum {STOP, ACCEL, DECEL, CONSTANT} state; void update_state(int32_t speed) { static int32_t prev_speed = 0; int32_t accel = speed - prev_speed; if(abs(speed) < 5) state = STOP; else if(accel > 50) state = ACCEL; else if(accel < -50) state = DECEL; else state = CONSTANT; prev_speed = speed; }

3. 计数器溢出管理：环形缓冲架构

传统的中断清零方法会导致1个计数周期的死区时间，在高速时产生明显误差。

3.1 无中断溢出检测

利用32位扩展计数器：

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

3.2 位置补偿算法

针对长时间运行的累积误差：

void position_compensation(void) { static uint32_t last_check = 0; if(HAL_GetTick() - last_check > 3600000) { // 每小时校准 __disable_irq(); total_count = (total_count / 10000) * 10000; __HAL_TIM_SET_COUNTER(&htim5, 10000); __enable_irq(); last_check = HAL_GetTick(); } }