[DI-5, DI-6] Changes to step size and distance controller
Merge pull request #9 from merenkoff/master

Changes to step size and distance controller