Arduino直流电机编码器测速实战：从原理到精准控制

1次阅读

共计 2853 个字符，预计需要花费 8 分钟才能阅读完成。

在机器人控制和自动化系统中，直流电机的转速测量是闭环控制的基础。无论是平衡车、机械臂还是传送带系统，都需要实时获取电机转速来实现精准控制。然而实际项目中常遇到信号抖动、低速测量误差大等问题——当电机转速低于 10RPM 时，传统测速方法可能完全失效。本文将用增量式编码器 +Arduino 的组合，实现 0.1RPM 精度的可靠测速方案。

增量式编码器通过光栅盘和光电传感器配合工作。当电机转动时：

光栅盘随电机轴旋转，其上的刻线会周期性遮挡光电传感器
传感器输出两路相位差 90°的方波信号（A 相 / B 相）
通过检测 AB 相的跳变沿和相位关系，既可计数又可判断转向

典型编码器每转产生数百个脉冲（如 500 线编码器每转输出 500 个脉冲）。我们正是通过统计这些脉冲数来计算转速。

以常见的 5V 增量式编码器为例：

编码器 VCC → Arduino 5V
编码器 GND → Arduino GND
编码器 A 相 → D2（外部中断 0）
编码器 B 相 → D3（外部中断 1）

关键细节 ：

必须使用外部中断引脚（UNO 上是 D2/D3）确保不丢失脉冲
信号线建议用双绞线，长度超过 20cm 时要加 120Ω 终端电阻
电机电源与 Arduino 电源建议用 0.1μF 电容隔离

Arduino 代码的核心是高效准确的中断服务程序（ISR）：

volatile long pulseCount = 0;

void setup() {attachInterrupt(digitalPinToInterrupt(2), handleInterrupt, RISING);
}

// 必须加上 ICACHE_RAM_ATTR 修饰符确保中断响应速度
void ICACHE_RAM_ATTR handleInterrupt() {if(digitalRead(3) == HIGH) {pulseCount++;} else {pulseCount--;}
}

避坑指南 ：

ISR 中不能使用 Serial.print 等耗时操作
所有共享变量必须声明为 volatile
中断触发方式建议用 RISING 而非 CHANGE（减少误触发）

直接使用脉冲计数会因信号抖动导致数据波动。我们采用卡尔曼滤波进行平滑处理：

// 卡尔曼滤波参数
float Q_angle = 0.001;
float Q_bias = 0.003;
float R_measure = 0.03;

float kalmanUpdate(float newValue) {
  static float angle = 0, bias = 0;
  static float P[2][2] = {{0,0},{0,0}};

  // 预测阶段
  angle += (newValue - bias);
  P[0][0] += Q_angle;
  P[0][1] -= Q_bias;
  P[1][0] -= Q_bias;
  P[1][1] += Q_bias;

  // 更新阶段
  float y = newValue - angle;
  float S = P[0][0] + R_measure;
  float K[2] = {P[0][0]/S, P[1][0]/S};

  angle += K[0] * y;
  bias += K[1] * y;

  float P00_temp = P[0][0];
  P[0][0] -= K[0] * P00_temp;
  P[0][1] -= K[0] * P[0][1];
  P[1][0] -= K[1] * P00_temp;
  P[1][1] -= K[1] * P[0][1];

  return angle;
}

#define ENCODER_PPR 500  // 编码器每转脉冲数
#define GEAR_RATIO 30    // 减速箱齿数比
#define SAMPLE_MS 100    // 采样周期 (毫秒)

volatile long pulseCount = 0;
unsigned long lastTime = 0;

void setup() {Serial.begin(115200);
  pinMode(2, INPUT_PULLUP);
  pinMode(3, INPUT_PULLUP);
  attachInterrupt(digitalPinToInterrupt(2), handleInterrupt, RISING);

  // 配置 Timer1 用于精确计时
  TCCR1A = 0;
  TCCR1B = (1 << WGM12) | (1 << CS12); // CTC 模式, 256 分频
  OCR1A = 62500; // 100ms @16MHz/256
  TIMSK1 = (1 << OCIE1A);
}

void handleInterrupt() {
  // 消抖处理
  static unsigned long lastInterrupt = 0;
  if(micros() - lastInterrupt < 200) return;
  lastInterrupt = micros();

  if(digitalRead(3) == HIGH) {pulseCount++;} else {pulseCount--;}
}

ISR(TIMER1_COMPA_vect) {
  static float lastRPM = 0;

  // 计算转速 (RPM)
  float rpm = (pulseCount * 60000.0) / (ENCODER_PPR * GEAR_RATIO * SAMPLE_MS);
  rpm = kalmanUpdate(rpm); // 滤波处理

  if(abs(rpm - lastRPM) > 0.5) { // 变化超过 0.5RPM 才输出
    Serial.println(rpm, 1);
    lastRPM = rpm;
  }
  pulseCount = 0; // 重置计数器
}

void loop() {// 主循环保持空转}

电源噪声抑制 ：
在电机电源并联 100μF 电解电容 +0.1μF 陶瓷电容
编码器信号线加磁环
低速优化方案 ：
当转速 <5RPM 时，改用脉冲周期测量法
启用 Arduino 的输入捕获功能（需 ATmega328P 芯片支持）
多电机同步 ：
每个编码器使用独立的外部中断
通过端口寄存器直接读取引脚状态（比 digitalRead 快 10 倍）

获得稳定转速后，可以进一步实现：

PID 闭环控制 ：

// 简易 PID 实现
float computePID(float target, float actual) {
  static float lastError = 0, integral = 0;
  float error = target - actual;
  integral += error;
  float derivative = error - lastError;
  lastError = error;
  return Kp*error + Ki*integral + Kd*derivative;
}