用STM32F4的HAL库搞定电机测速：从编码器接线到RPS计算，一篇就够了
用STM32F4的HAL库实现高精度电机测速：从硬件对接到算法优化
刚拿到STM32开发板和带编码器电机的开发者，往往会在测速环节遇到各种"坑"：接线错误导致信号抖动、定时器配置不当造成计数溢出、单位换算忽略减速比影响…本文将用全流程实战演示，带你从焊接杜邦线开始，一步步实现工业级精度的电机转速测量。
1. 硬件连接：编码器与STM32的电气握手
带AB相输出的增量式编码器，本质上是通过两个方波信号的相位差传递运动信息。以常见的100线编码器为例：
- A相超前B相90°→ 顺时针旋转
- B相超前A相90°→ 逆时针旋转
接线要点（以TIM3为例）：
| 编码器引脚 | STM32F4引脚 | 定时器通道 | 必需配置 |
|---|---|---|---|
| A相 | PC6 | TIM3_CH1 | 上拉输入 |
| B相 | PC7 | TIM3_CH2 | 上拉输入 |
| VCC | 3.3V | - | 限流电阻 |
| GND | GND | - | 共地 |
提示：若电机电源与开发板分离，务必确保两地共接，否则会出现信号毛刺。我曾用示波器抓取到未共地时高达2V的噪声干扰。
硬件避坑指南：
- 杜邦线长度不超过20cm，过长易引入干扰
- 推荐使用双绞线处理A/B相信号线
- 在VCC与GND间并联0.1μF去耦电容
2. CubeMX配置：定时器的精妙设置
在CubeMX中启用编码器接口时，新手常犯三个错误：
- 误选"Encoder Mode"而非"Combined Channels"
- 忽略滤波器设置导致噪声计数
- 未合理设置ARR值造成频繁溢出
正确配置步骤：
- 定时器时钟源选择"内部时钟"
- 通道1/2设置为"Input Capture direct mode"
- 滑动"Combined Channels"选项选择"Encoder Mode"
- 关键参数设置：
htim3.Init.Prescaler = 0; // 不分频 htim3.Init.CounterMode = TIM_COUNTERMODE_UP; htim3.Init.Period = 65535; // 16位计数器最大值 htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
滤波器配置经验值：
- 低速电机（<1000RPM）：IC1F=0x4（4个时钟周期滤波）
- 高速电机（>5000RPM）：IC1F=0x2（2个时钟周期滤波）
3. 速度计算算法：从原始脉冲到工程单位
获得脉冲计数只是第一步，真正的挑战在于单位换算。假设我们有以下参数：
- 编码器分辨率：100 PPR（每转100个脉冲）
- 减速比：30:1
- 采样周期：100ms
转速计算公式：
RPM = (ΔCount / (4 × PPR × GearRatio)) × (60 / ΔT)其中：
- ΔCount：采样周期内的计数差值
- 4倍频：AB相上下沿均计数
- PPR：编码器每转脉冲数
- GearRatio：减速比
- ΔT：采样时间（秒）
代码实现：
// 在定时器中断回调函数中 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { static int32_t last_count = 0; if (htim->Instance == TIM3) { int32_t current_count = __HAL_TIM_GET_COUNTER(htim); int32_t delta = current_count - last_count; // 处理计数器溢出 if(delta > 32767) delta -= 65536; else if(delta < -32767) delta += 65536; float rpm = (delta / (4.0f * 100 * 30)) * (60 / 0.1); last_count = current_count; printf("当前转速: %.2f RPM\r\n", rpm); } }4. 抗干扰与精度提升技巧
动态自适应滤波算法：
#define FILTER_LENGTH 5 float moving_avg_filter(float new_val) { static float buffer[FILTER_LENGTH] = {0}; static uint8_t index = 0; buffer[index] = new_val; index = (index + 1) % FILTER_LENGTH; float sum = 0; for(int i=0; i<FILTER_LENGTH; i++) { sum += buffer[i]; } return sum / FILTER_LENGTH; }速度测量误差来源分析：
| 误差类型 | 典型值 | 解决方案 |
|---|---|---|
| 量化误差 | ±0.5RPM | 提高采样频率 |
| 机械振动噪声 | ±2~5RPM | 增加硬件滤波电路 |
| 电源纹波干扰 | ±1~3RPM | 使用LDO稳压器 |
| 温度漂移 | ±0.1RPM/℃ | 选择低温漂编码器 |
在最近的一个机器人关节控制项目中，通过组合硬件滤波（RC低通）和软件卡尔曼滤波，将测速波动从±5RPM降低到±0.8RPM。关键是在TIMx_CCMR1寄存器中启用输入捕获噪声滤波器：
TIM3->CCMR1 |= TIM_CCMR1_IC1F_0 | TIM_CCMR1_IC1F_1; // 4采样周期滤波