Onderwerp: Bepalen of de motor loopt

const int pulsePin  = 8 ;
const int runLow = 2;
const int runHigh = 7;
const int limiet1 = 100 ;
const int limiet2 = 200 ;

int pulseHigh;
int pulseLow;
float pulseTotal;
float frequency;

void setup() {
  Serial.begin(9600);
  pinMode(pulsePin, INPUT);
  pinMode(runLow, OUTPUT);
  pinMode(runHigh, OUTPUT);
  digitalWrite(runLow,HIGH);
  digitalWrite(runHigh,HIGH);
}

void loop() {
  pulseHigh = pulseIn(pulsePin,HIGH);
  pulseLow = pulseIn(pulsePin,LOW);
  pulseHigh = pulseIn(pulsePin,HIGH);
  pulseLow = pulseIn(pulsePin,LOW);
  pulseTotal = pulseHigh + pulseLow;
  if (pulseTotal != 0) {
    frequency = 1000000/pulseTotal;
    } else frequency = 0 ;
  Serial.print("Frequency is ");
  Serial.print(frequency);
  Serial.print(" Hz\n");
  if ( limiet1<frequency ) digitalWrite(runLow,LOW); else digitalWrite(runLow,HIGH) ;
  if ( limiet2<frequency ) digitalWrite(runHigh,LOW); else digitalWrite(runHigh,HIGH) ;
  delay(1000);
}