Updated with stepper driver code
Began to work with stepper driver example
Stepper code should be OK now