Set mode changes

Added code to check the time calculated by the stepper motor
Merge remote-tracking branch 'origin/add-set-mode'