Some refactoring...

Some refactoring in StepperClass and Arduino scetch