Updated runStepper and use Endstops