コンセントの周波数を観察するインテリアを作った

#define METER_PIN 14
#define RED_PIN 4
#define GREEN_PIN 13
#define BLUE_PIN 2
#define BUZZER_PIN 12
#define BUTTON_PIN 0
#define READ_PIN 5

#define PWMRANGE 2048
#define MAX_RATE (PWMRANGE*0.9)

#define BASE_MHZ 50000
#define BASE_HZ 50.0

#define MAX_COUNT 15 //15*20ms = 300ms

#define MAX_HZ 50.20
#define MIN_HZ 49.80

#define MAX_BUZZER_COUNT 1000 //1000*20ms = 20s
#define ON_BLUE_COUNT 30 // 30*20ms =0.6s
#define OFF_BLUE_COUNT 200 // 200*20ms =4s

volatile unsigned long lastRisingEdgeCycleCount = 0;

volatile unsigned long cycleCountDifference = 0;

volatile unsigned long upbasecount = 0; //upper limmit of diff count
volatile unsigned long downbasecount = 0; //lower limmit of diff count

void ICACHE_RAM_ATTR handleRisingEdge() {
  unsigned long currentCycleCount = ESP.getCycleCount();
  if (lastRisingEdgeCycleCount != 0) {
    cycleCountDifference = currentCycleCount - lastRisingEdgeCycleCount;
  }
  if (downbasecount > cycleCountDifference && cycleCountDifference < upbasecount){ //check valid diffcount
    cycleCountDifference = UINT32_MAX;
  }
  lastRisingEdgeCycleCount = currentCycleCount;
}

unsigned long basecount = 0;

void setup() {
  Serial.begin(115200);
  pinMode(BUTTON_PIN, INPUT_PULLUP);
  pinMode(RED_PIN, OUTPUT);
  digitalWrite(RED_PIN, HIGH);
  pinMode(GREEN_PIN, OUTPUT);
  digitalWrite(GREEN_PIN, HIGH);
  pinMode(BLUE_PIN, OUTPUT);
  digitalWrite(BLUE_PIN, HIGH);
  pinMode(BUZZER_PIN, OUTPUT);
  digitalWrite(BUZZER_PIN, LOW);
  pinMode(READ_PIN ,INPUT);
  //analogWriteFreq(25000);
  analogWriteRange(PWMRANGE);
  // 割り込みを設定: GPIO 5 の Rising Edge (Low から High) で handleRisingEdge を呼び出す
  attachInterrupt(digitalPinToInterrupt(READ_PIN), handleRisingEdge, RISING);

  basecount = ESP.getCpuFreqMHz() * 1000 * 1000 / BASE_HZ;
  upbasecount = 1.2 * basecount;
  downbasecount = 0.8 * basecount;
  
  delay(20);
}

double herz = 0;
double diffhz = 0;
double diffrate = 0;
int count = 0;
unsigned long sum = 0;
int range = 1; //100:45~55Hz, 10:49.5~50.5, 1:49.95~50.05
int setrange = 1;
bool oldbutton = true;
bool nowbutton = true;

void rangeled(){
  switch(range){
    case 1: //GREEN 44.95~50.05Hz
      digitalWrite(RED_PIN, HIGH);
      digitalWrite(GREEN_PIN, LOW);
      break;
    case 10: //RED 44.5~50.5Hz
      digitalWrite(GREEN_PIN, HIGH);
      digitalWrite(RED_PIN, LOW);
      break;
    case 101:
    case 100: //none 45~55Hz
      digitalWrite(RED_PIN, HIGH);
      digitalWrite(GREEN_PIN, HIGH);
      break;
    default:
      range = 1;
      break;
  }
}

bool alarm = false;
bool buzzer = false;
int buzzer_count = 0;
bool blue = false; //blue led ON(LOW):true, OFF(HIGH):false
bool oldvalid = false;
bool ooldvalid = false;
double oldherz = 0;
double aherz = 0; //averaged Hz

void loop() {
  if(cycleCountDifference != 0){
    
    // sum diff
    if(cycleCountDifference != UINT32_MAX){ //check valid data
      sum += cycleCountDifference;
      herz = (ESP.getCpuFreqMHz()) / (cycleCountDifference / (1000.0 * 1000.0));
      count++;

      //if((oldherz < MIN_HZ) && (herz < MIN_HZ) && oldvalid && ooldvalid){ //-0.2Hz
      if((oldherz < MIN_HZ) && oldvalid && ooldvalid){ //-0.2Hz
        Serial.print("W:");
        Serial.println(oldherz);
        alarm = true;
        buzzer = true;
      //}else if((MAX_HZ < oldherz) && (MAX_HZ < herz) && oldvalid && ooldvalid){ //+0.2Hz
      }else if((MAX_HZ < oldherz) && oldvalid && ooldvalid){ //+0.2Hz
        Serial.print("W:");
        Serial.println(oldherz);
        alarm = true;
        buzzer = true;
      }
      oldvalid = true;
      oldherz = herz;
    //invalid data
    }else if(cycleCountDifference == UINT32_MAX){
      oldvalid = false;
    }

    ooldvalid = oldvalid;
    oldherz = herz;
    cycleCountDifference = 0;
  }
  
  
  //average and disp diff
  if (count >= MAX_COUNT) {
    aherz = (ESP.getCpuFreqMHz()) / ((sum / count) / (1000.0 * 1000.0));
    //Serial.print((sum / count));
    //Serial.print(" ");
    Serial.println(aherz, 4);
    diffhz = aherz - BASE_HZ;
    do{
      diffrate = 0.5 + (diffhz / (range / 10.0));
      rangeled();
      if(range == 1){
        range = 10;
      }else if(range == 10){
        range = 100;
      }else{ //out of range
        range = 101;
        if(diffrate < 0.0){
          diffrate = 0.0;
        }else if(1.0 < diffrate){
          diffrate = 1.0;
        }
      }
    }while(((diffrate < 0.0) || (1.0 < diffrate)) && range != 101);
    range = setrange;
    
    float pwmming = MAX_RATE * diffrate;
    analogWrite(METER_PIN, pwmming);
    
    count = 0;
    sum = 0;
  }

  //read button
  oldbutton = nowbutton;
  nowbutton = digitalRead(BUTTON_PIN);
  if(oldbutton && !nowbutton){
    if(alarm || buzzer){
      alarm = false;
      buzzer = false;
      buzzer_count = 0;
      digitalWrite(BUZZER_PIN, LOW);
      digitalWrite(BLUE_PIN, HIGH); //OFF
    }else{
      switch(range){
        case 100:
          range = 10; //RED 44.5~50.5Hz
          setrange = 10;
          break;
        case 10:
          range = 1; //GREEN 44.95~50.05Hz
          setrange = 1;
          break;
        case 1:
          range = 100; //none 45.0~55.0Hz
          setrange = 100;
          break;
        default:
          range = 1;
          break;
      }
    }
    rangeled();
  }

  //buzzer
  if(buzzer){
    digitalWrite(BUZZER_PIN, HIGH);
    buzzer_count ++;
    if(buzzer_count > MAX_BUZZER_COUNT){
      digitalWrite(BUZZER_PIN, LOW);
      buzzer = false;
      buzzer_count = 0;
    }
  }else if(alarm){
    buzzer_count ++;
    if((buzzer_count > ON_BLUE_COUNT) && blue){ //on to off
      digitalWrite(BLUE_PIN, HIGH); //off
      blue = false;
      buzzer_count = 0;
    }else if((buzzer_count > OFF_BLUE_COUNT) && !blue){ //off to on
      digitalWrite(BLUE_PIN, LOW); //on
      blue = true;
      buzzer_count = 0;
    }
  }

  delay(20);
}