Fixes #34. Found a problem with math in positioning stepper.