ESP math with stepper is working correctly