Arduino Encoder-controlled motor rotation