#include <SoftwareSerial.h>
SoftwareSerial mySerial(0, 1);

const int motor_pin_1 = 8;
const int motor_pin_2 = 7;
const int enc_A = 2;
const int enc_B = 3;
int prev_A_value = LOW;
int pos = 0;
int new_A_value = LOW;

void setup() {
  pinMode(motor_pin_1, OUTPUT);
  pinMode(motor_pin_2, OUTPUT);
  pinMode(enc_A, INPUT);
  pinMode(enc_B, INPUT);

  mySerial.begin(9600);
  mySerial.println("Starting up");
}

void loop() {
  new_A_value = digitalRead(enc_A);
  if ((prev_A_value == LOW) && (new_A_value == HIGH)) {
    if (digitalRead(enc_B) == LOW) {
      pos--;
    } else {
      pos++;
    }
    mySerial.println(pos);

  } 
  prev_A_value = new_A_value;
}

