Good Afternoon
I was coming little further and add some encoder stuff in it.
Please check wether is usable or not.
A
#include <Encoder.h>
byte motorSpeed = 123;
byte motorFwdPin = 5;
byte motorRevPin = 6;
Encoder myEnc(2,3);
void setup() {
pinMode(motorFwdPin, OUTPUT);
pinMode(motorRevPin, OUTPUT);
analogWrite(motorRevPin, 0);
analogWrite(motorFwdPin, motorSpeed);
Serial.begin(9600);
}
long oldPosition = -999;
void loop() {
long currentPosition = myEnc.read();
Serial.println(currentPosition);
analogWrite(motorRevPin,0);
analogWrite(motorFwdPin, motorSpeed);
delay(1000);
analogWrite(motorRevPin,0);
analogWrite(motorFwdPin,0);
delay(5000);
analogWrite(motorRevPin, motorSpeed);
analogWrite(motorFwdPin, 0);
delay(1000);
}