1. MG310P20电机霍尔编码器测速测距原理剖析
霍尔编码器作为电机运动控制中的关键传感器，其工作原理直接决定了测速测距的精度。MG310P20电机采用的是13线霍尔编码器，这意味着编码器转子每旋转一圈，会在每个相位上产生13个方波脉冲。这种设计在工业级电机中非常常见，主要因为13这个质数特性可以有效避免谐波干扰。
编码器转子与电机原始轴直接相连，而实际输出轴（连接轮子的部分）则通过减速齿轮组相连。在MG310P20电机中，减速比为20:1，这意味着电机原始轴需要旋转20圈，输出轴才旋转1圈。这种设计虽然降低了转速，但大幅提高了扭矩输出。
关键提示：实际计算时必须考虑减速比的影响，否则会导致速度计算结果出现20倍的误差。
2. STM32硬件接口配置详解
2.1 定时器编码器模式配置
STM32的定时器外设支持专门的编码器接口模式，可以自动处理正交编码信号。在项目中我们使用TIM8和TIM3两个定时器分别对接两个电机编码器：
c复制TIM_EncoderInterfaceConfig(TIM8, TIM_EncoderMode_TI12,
TIM_ICPolarity_Rising, TIM_ICPolarity_Rising);
这里选择TI12模式（四倍频模式）是关键，它能将13线的物理分辨率提升到等效52线。配合20:1的减速比，最终每个轮子转一圈会产生1040个脉冲（13×4×20）。这种设计使得48mm直径的轮子理论测距分辨率达到0.145mm，完全满足一般移动机器人的精度需求。
2.2 GPIO引脚复用配置
编码器信号线需要正确映射到定时器的输入通道：
c复制GPIO_PinAFConfig(GPIOC, GPIO_PinSource6, GPIO_AF_TIM8); // PC6 -> TIM8_CH1
GPIO_PinAFConfig(GPIOC, GPIO_PinSource7, GPIO_AF_TIM8); // PC7 -> TIM8_CH2
特别注意STM32F4系列不同定时器所在的APB总线不同：
- TIM8在APB2总线（最高84MHz）
- TIM3在APB1总线（最高42MHz）
3. 速度与距离计算算法实现
3.1 脉冲计数处理
由于16位定时器的计数范围有限（0-65535），需要处理溢出情况：
c复制if (Diff > 32767) Diff -= 65536;
else if (Diff < -32767) Diff += 65536;
这段代码实现了带符号的溢出处理，确保无论正转反转都能正确累计脉冲数。实际测试表明，在电机转速不超过3000RPM的情况下，这种处理方式完全可靠。
3.2 速度计算公式推导
速度计算的核心公式：
code复制v = (Num / N) / P * C / T
其中：
- Num：T时间内捕获的脉冲数
- N：编码器线数（13线）
- P：减速比（20:1）
- C：轮子周长（π×0.048m）
- T：采样周期（秒）
在代码中体现为：
c复制float delta_distance = ((float)delta_pulses / PULSES_PER_ROUND) * WHEEL_PERIMETER_M;
speed = delta_distance / dt_s;
4. 工程实践中的关键问题
4.1 采样周期选择
速度计算的精度直接受采样周期dt_s影响：
- 周期过短：脉冲数太少，量化误差明显
- 周期过长：动态响应变差
实测建议：
- 低速运动（<0.5m/s）：100-200ms采样周期
- 高速运动（>0.5m/s）：50-100ms采样周期
4.2 信号滤波配置
编码器信号容易受到干扰，TIM_ICInitStructure中的滤波器配置很关键：
c复制TIM_ICInitStructure.TIM_ICFilter = 0x0F; // 最大滤波值
这个值对应约680ns的滤波窗口，能有效消除常见毛刺干扰。但在极高转速下（>5000RPM），需要适当降低滤波值以避免丢失脉冲。
5. 性能优化技巧
5.1 浮点运算优化
原始代码中多次出现浮点除法运算，这在没有FPU的单片机上代价很高。可以预先计算并存储以下常量：
c复制const float PULSE_TO_METER = WHEEL_PERIMETER_M / PULSES_PER_ROUND;
这样速度计算简化为：
c复制speed = delta_pulses * PULSE_TO_METER / dt_s;
5.2 方向判断优化
通过比较两个通道信号的相位差，可以判断旋转方向。STM32的编码器模式已经硬件支持方向检测，我们可以直接读取TIMx->CR1中的DIR位。
6. 实际应用案例
在一个自动导引车(AGV)项目中，这套方案实现了：
- 测距精度：±2cm/10m
- 测速精度：±0.05m/s（在1m/s速度下）
- 最大响应频率：10kHz（对应约4.6m/s的最大测量速度）
关键配置参数：
c复制#define WHEEL_DIAMETER_M 0.048f // 实测轮径48.2mm
#define ENCODER_RESOLUTION 13.0f // 确认编码器规格书
#define GEAR_RATIO 20.0f // 电机铭牌标注
7. 常见问题排查指南
7.1 脉冲计数异常
现象：计数忽大忽小或方向错误
排查步骤：
- 检查编码器A/B相接线是否反接
- 确认GPIO上拉电阻使能
- 用示波器观察信号质量
7.2 速度计算为0
可能原因：
- 采样周期dt_s传入值为0
- 脉冲数没有变化（检查编码器供电）
- 定时器未正确启动（检查TIMx_CR1寄存器）
7.3 测量值漂移
处理方法：
- 校准轮径实际值（用实测法修正WHEEL_DIAMETER_M）
- 检查减速比参数是否正确
- 添加软件滤波（如滑动平均）
我在实际项目中发现，机械安装的同心度对测量精度影响很大。曾经遇到因为联轴器偏心导致周期性速度波动的情况，最终通过改用柔性联轴器解决了问题。另外建议每隔3个月重新校准一次轮径，特别是经常负重运行的设备。