#include 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; }