Trying to make a stepper rotate acordint to a distance reading