Fixed rounding issues with Stepper motor drive