void checkEncoder(){
  if(digitalRead(ENC_A) ^ digitalRead(ENC_B)) count++; //A XOR B
  else count--;
}