Arduino code handling robot's encoders