Arduino Dc Motor Encoder Position Control