Merge pull request #9 from merenkoff/master

Changes to step size and distance controller