Stepper motor speed control by encoder