Enkoder KY-040






/* Enkoder 19.02.2016
 */


#include <Encoder.h>

Encoder myEnc(5, 6);
int pinBuczek = 3;
long licznik = 0;

void setup() {
  Serial.begin(9600);
  pinMode(pinBuczek,OUTPUT);
  digitalWrite(pinBuczek,LOW);
}

long oldPosition  = -999;

void loop() {
  long newPosition = myEnc.read();
  if (newPosition != oldPosition) {
    oldPosition = newPosition;
    if(licznik==4){
      digitalWrite(pinBuczek,HIGH);
      delay(20);
      licznik=0;
      Serial.print(newPosition/4);
    }
    licznik++; 
  }
  digitalWrite(pinBuczek,LOW);
}


Komentarze