improve stepper
Merge pull request #4 from YADAMO/pid

improve stepper