别再只用M法了！手把手教你用Arduino和旋转编码器实现M/T法测速（附代码）

别再只用M法了！手把手教你用Arduino和旋转编码器实现M/T法测速（附代码）

在电机控制项目中，精确的速度测量往往是实现闭环控制的第一步。许多初学者会直接采用简单的M法（频率测量法），但在实际测试中很快就会发现——当电机转速降低时，测量结果开始出现明显跳变，甚至完全失效。这种现象背后隐藏着测速方法的选择逻辑：没有一种单一方法能完美覆盖所有转速范围。

这就是为什么工业级伺服系统普遍采用M/T法。它像一位经验丰富的调酒师，懂得何时该用M法的"烈酒"应对高速状态，何时该换T法的"冰块"来冷却低速误差。本文将用最常见的Arduino Uno开发板和增量式旋转编码器，带你从零实现这套混合测速方案。不同于单纯的理论讲解，我们会重点解决三个实际问题：如何用定时器捕获高频脉冲？如何设计速度切换阈值？以及如何避免计数器溢出的"坑"？

1. 硬件准备与电路连接

1.1 元器件选型要点

选择旋转编码器时，线数（每转脉冲数）直接影响测量分辨率。常见的有：

• 低分辨率：100-200 PPR（如EC11编码器）
• 中分辨率：360-600 PPR（如OMRON E6B2系列）
• 高分辨率：1000 PPR以上（工业级编码器）

提示：初学者建议选择200-400PPR的编码器，线数过高会导致低速时脉冲间隔过长，增加T法实现难度。

本次演示采用以下硬件组合：

1.2 接线示意图

编码器与Arduino的连接需要特别注意信号抗干扰：

编码器A相 —— D2（外部中断0） 编码器B相 —— D3（外部中断1） 编码器VCC —— 5V（或外部电源正极） 编码器GND —— 共地

注意：若编码器工作电压高于5V，需使用电平转换模块或分压电路，避免损坏单片机。

2. 软件框架设计

2.1 关键库与定时器配置

Arduino的Encoder库虽然方便，但不适合M/T法实现。我们需要直接操作定时器：

// 配置Timer1为高频脉冲计数器 TCCR1A = 0; // 普通模式 TCCR1B = (1 << CS10); // 无分频，16MHz计数 TIMSK1 = 0; // 禁用中断 // 编码器脉冲计数使用外部中断 attachInterrupt(0, pulseISR, RISING); // D2 attachInterrupt(1, dirISR, CHANGE); // D3

2.2 变量定义与初始化

volatile long encoderCount = 0; volatile unsigned int timerCount = 0; unsigned long lastTime = 0; float rpm = 0.0; const int PPR = 400; // 编码器线数 void pulseISR() { encoderCount++; timerCount = TCNT1; // 捕获当前定时器值 TCNT1 = 0; // 重置定时器 }

3. M/T法核心算法实现

3.1 动态阈值切换策略

速度区间划分是M/T法的精髓。通过实验数据得出以下经验值：

• 高速模式（>500 RPM）：纯M法，采样周期10ms
• 中速模式（50-500 RPM）：M/T混合，采样周期20ms
• 低速模式（<50 RPM）：纯T法，采样周期自适应

实现代码片段：

float calculateRPM() { unsigned long currentTime = micros(); float deltaT = (currentTime - lastTime) / 1e6; // 转为秒 if (rpm > 500) { // 高速M法 return 60.0 * encoderCount / (PPR * deltaT); } else if (rpm > 50) { // 混合M/T法 return 60.0 * 16000000.0 * encoderCount / (PPR * timerCount); } else { // 低速T法 return 60.0 * 16000000.0 / (PPR * timerCount); } }

3.2 抗干扰处理技巧

实际测试中会遇到两个典型问题：

1. 计数器溢出：16位定时器在16MHz下约4ms溢出一次

   • 解决方案：在中断中记录溢出次数

   volatile unsigned int overflowCount = 0; ISR(TIMER1_OVF_vect) { overflowCount++; }

2. 脉冲抖动：机械编码器在换向时会产生毛刺

   • 硬件方案：增加0.1μF电容滤波
   • 软件方案：脉冲间隔小于50μs时视为噪声

4. 数据可视化与优化

4.1 串口绘图技巧

利用Arduino IDE的串口绘图器实时观察波形：

void serialPlot() { Serial.print("RPM:"); Serial.print(rpm); Serial.print(",Mode:"); if(rpm > 500) Serial.println("M"); else if(rpm > 50) Serial.println("M/T"); else Serial.println("T"); }

4.2 参数校准方法

通过以下步骤获得最优参数：

1. 固定电机在已知转速（如用激光测速仪）
2. 调整采样周期直到误差<1%
3. 记录各速度段的切换阈值
4. 重复3次取平均值

实测数据示例：

5. 进阶应用：PID速度闭环

将测速结果反馈给PID控制器：

#include <PID_v1.h> double Setpoint, Input, Output; PID myPID(&Input, &Output, &Setpoint, 2, 5, 1, DIRECT); void setup() { Input = rpm; myPID.SetMode(AUTOMATIC); myPID.SetSampleTime(10); // ms } void loop() { Input = rpm; myPID.Compute(); analogWrite(9, Output); // PWM输出 }

遇到电机启动时的超调问题？尝试以下调整：

• 增加速度微分项权重
• 设置启动阶段特殊PID参数
• 加入加速度前馈控制