Lab 5 电机转速

IR 模块信号 → D2,中断用下降沿,LCD 的 SDA/SCL → A4/A5,共地。先转一整圈数实际下降沿,再设置每转脉冲数。Week 08 Part01 00:00:00–00:01:10 提到转速测量设计,计时公式也见 Tutorial 2 第 2 页。

第 1–25 行 · 参数、计数器和显示数据

Wire.h 提供 I²C,LiquidCrystal_I2C.h 提供 LCD 命令。D2 是 IR 信号,代码按每转 3 个下降沿算。相距不到 500 μs 的脉冲后来会舍掉。每至少 250 ms 算一次 RPM,至少 500 ms 写一次 LCD,连续逾 1 秒没接受新脉冲就归零。

rawPulses 数全部边沿,acceptedPulses 数筛选后的边沿,lastValidPulseUs 记上次接受的时刻。这三个值由中断更新,用 volatile 告诉编译器每次从存储读取。两个 last...Ms 是调度时间,recentRPM[3] 保存最近三个有效计数窗的结果,两个 RPM 变量供串口对比。

展开原代码第 1–25 行
   1  #include <Wire.h>
   2  #include <LiquidCrystal_I2C.h>
   3  
   4  // Lab 5: Reflective IR sensor on D2, I2C LCD on A4/A5.
   5  const byte IR_PIN = 2;
   6  const byte PULSES_PER_REV = 3; // One pulse per blade as reflected IR changes.
   7  const unsigned long MIN_PULSE_GAP_US = 500UL; // Reject very short noise pulses.
   8  const unsigned long SAMPLE_INTERVAL_MS = 250UL;
   9  const unsigned long LCD_INTERVAL_MS = 500UL;
  10  const unsigned long STOP_TIMEOUT_US = 1000000UL;
  11  
  12  LiquidCrystal_I2C lcd(0x27, 16, 2);
  13  volatile unsigned long rawPulses = 0;
  14  volatile unsigned long acceptedPulses = 0;
  15  volatile unsigned long lastValidPulseUs = 0;
  16  
  17  unsigned long lastSampleMs = 0;
  18  unsigned long lastLcdMs = 0;
  19  float rawRPM = 0.0f;
  20  float optimizedRPM = 0.0f;
  21  float recentRPM[3] = {0.0f, 0.0f, 0.0f};
  22  byte recentCount = 0;
  23  byte recentIndex = 0;
  24  bool filterInitialized = false;
  25  

第 26–42 行 · 每个下降沿先数,再决定接受与否

onIrPulse() 进来先取微秒时间,原始计数加一。若还没有有效边沿,或到上次接受的脉冲已过至少 500 μs,就给有效计数加一,并更新接受时刻。假设边沿发生于 1000、1200、1600 μs。1000 作为第一条接受,1200 与 1000 只差 200 微秒被拒,1600 仍与 1000 比较,差 600 微秒被接受。原始计数 3,有效计数 2。

若真实相邻脉冲也短于 500 μs,则会误丢真实事件。3 脉冲/转时,500 μs 的理想边界对应 60000000/(3×500)=4000060000000/(3\times500)=40000 RPM。后面的 median3 三次交换三个元素,返回排序后的中间数。

展开原代码第 26–42 行
  26  void onIrPulse() {
  27    unsigned long nowUs = micros();
  28    rawPulses++;
  29    if (lastValidPulseUs == 0UL ||
  30        (unsigned long)(nowUs - lastValidPulseUs) >= MIN_PULSE_GAP_US) {
  31      acceptedPulses++;
  32      lastValidPulseUs = nowUs;
  33    }
  34  }
  35  
  36  float median3(float a, float b, float c) {
  37    if (a > b) { float t = a; a = b; b = t; }
  38    if (b > c) { float t = b; b = c; c = t; }
  39    if (a > b) { float t = a; a = b; b = t; }
  40    return b;
  41  }
  42  

第 43–60 行 · 复制一个时间窗的值,然后算转速

每次进入 updateMotorSpeed() 先算实际经过的毫秒数。不满 250 ms 就 return。到时短暂停中断,复制原始计数、有效计数和最后有效时刻,再清零两个共享计数并恢复中断。这样 ISR 不会在读取或清零的中间改动多字节数据。

设一窗 TT ms,数到 NN 个下降沿。每转 3 个下降沿,转数 N/3N/3。时间换成 T/1000T/1000 秒,RPM=(N/3)/(T/1000)×60=60000N/(3T)RPM=(N/3)/(T/1000)\times60=60000N/(3T)。例如 250 ms 原始 18 个、筛后 15 个,原始 60000×18/(250×3)=144060000\times18/(250\times3)=1440 RPM,筛后 60000×15/(250×3)=120060000\times15/(250\times3)=1200 RPM。两条用的是同一个实际窗长。

展开原代码第 43–60 行
  43  void updateMotorSpeed() {
  44    unsigned long nowMs = millis();
  45    unsigned long elapsedMs = nowMs - lastSampleMs;
  46    if (elapsedMs < SAMPLE_INTERVAL_MS) return;
  47    lastSampleMs = nowMs;
  48  
  49    unsigned long rawCount, validCount, lastPulse;
  50    noInterrupts();
  51    rawCount = rawPulses;
  52    validCount = acceptedPulses;
  53    lastPulse = lastValidPulseUs;
  54    rawPulses = 0;
  55    acceptedPulses = 0;
  56    interrupts();
  57  
  58    rawRPM = rawCount * 60000.0f / (elapsedMs * PULSES_PER_REV);
  59    float validRPM = validCount * 60000.0f / (elapsedMs * PULSES_PER_REV);
  60  

第 61–89 行 · 三窗中位数、指数平滑和停转归零

把筛过边沿算出的 RPM 放进三格环形数组。第一格时直接用,两格时取均值,满三格时取中位数。例如筛后 1200、2800、1280 RPM,排成 1200、1280、2800,中值 1280。若上一轮优化值 1200,本轮为 0.35×1280+0.65×1200=12280.35\times1280+0.65\times1200=1228 RPM。0.65 保留较多历史,尖峰影响小,真实加速时会慢一些。

随后检查最后有效脉冲。如果从未收到,或者已超过 1 秒,直接设优化值 0,并把历史计数与下标重置。下一次有有效脉冲时从首批数据重新启动滤波。低到连续两脉冲之间超过超时的速度也会被当成停转,因此超时须与希望测到的最低速度配套。

展开原代码第 61–89 行
  61    // Real-time stability: dead-time rejection (ISR), median of last 3
  62    // measurement windows, then exponential moving average (EMA).
  63    recentRPM[recentIndex] = validRPM;
  64    recentIndex = (recentIndex + 1) % 3;
  65    if (recentCount < 3) recentCount++;
  66  
  67    float medianValue;
  68    if (recentCount == 1) {
  69      medianValue = recentRPM[0];
  70    } else if (recentCount == 2) {
  71      medianValue = (recentRPM[0] + recentRPM[1]) / 2.0f;
  72    } else {
  73      medianValue = median3(recentRPM[0], recentRPM[1], recentRPM[2]);
  74    }
  75  
  76    unsigned long nowUs = micros();
  77    if (lastPulse == 0UL ||
  78        (unsigned long)(nowUs - lastPulse) > STOP_TIMEOUT_US) {
  79      optimizedRPM = 0.0f;
  80      filterInitialized = false;
  81      recentCount = 0;
  82      recentIndex = 0;
  83    } else if (!filterInitialized) {
  84      optimizedRPM = medianValue;
  85      filterInitialized = true;
  86    } else {
  87      optimizedRPM = 0.35f * medianValue + 0.65f * optimizedRPM;
  88    }
  89  

第 90–110 行 · 串口画双曲线,LCD 显示整数

每个采样窗先打印 RawRPM:1440.0 这样的原始值,再打印制表符和 OptimizedRPM:1228.0,末尾换行。串口绘图器用两个标签画两条序列。LCD 刷新另用自己的 500 ms 阈值。第一行写 Motor Speed,第二行先写 RPM 标签和空白,再把光标放到列 5 打印数值。浮点加 0.5 再转无符号整数,正数便四舍五入,例如 1227.6 显示 1228。

展开原代码第 90–110 行
  90    // Serial Plotter graphs two separate series.
  91    Serial.print("RawRPM:");
  92    Serial.print(rawRPM, 1);
  93    Serial.print('\t');
  94    Serial.print("OptimizedRPM:");
  95    Serial.println(optimizedRPM, 1);
  96  }
  97  
  98  void updateLcd() {
  99    unsigned long nowMs = millis();
 100    if (nowMs - lastLcdMs < LCD_INTERVAL_MS) return;
 101    lastLcdMs = nowMs;
 102  
 103    lcd.setCursor(0, 0);
 104    lcd.print("Motor Speed:    ");
 105    lcd.setCursor(0, 1);
 106    lcd.print("RPM:            ");
 107    lcd.setCursor(5, 1);
 108    lcd.print((unsigned long)(optimizedRPM + 0.5f));
 109  }
 110  

第 111–128 行 · 接入外部中断,显示与采集同时推进

INPUT_PULLUP 让空闲输入有上拉,串口设置 230400。初始化并打开 LCD 背光、写出初始 0,记录采样和刷新起点。attachInterrupt(digitalPinToInterrupt(IR_PIN), onIrPulse, FALLING) 把 D2 映射为中断号并注册下降沿处理。循环每圈检查是否该算 RPM、是否该刷新 LCD。红外边沿一到,由中断函数累计脉冲,数字不需要等 LCD 更新才采集。

展开原代码第 111–128 行
 111  void setup() {
 112    pinMode(IR_PIN, INPUT_PULLUP);
 113    Serial.begin(230400);
 114    lcd.init();
 115    lcd.backlight();
 116    lcd.setCursor(0, 0);
 117    lcd.print("Motor Speed:    ");
 118    lcd.setCursor(0, 1);
 119    lcd.print("RPM: 0          ");
 120    lastSampleMs = millis();
 121    lastLcdMs = millis();
 122    attachInterrupt(digitalPinToInterrupt(IR_PIN), onIrPulse, FALLING);
 123  }
 124  
 125  void loop() {
 126    updateMotorSpeed();
 127    updateLcd();
 128  }