hard-stop for more accuracy
simplify equation
cache constants for more performance and readability
changed comment
added active-stop for zero-movement
Merge pull request #2 from Clemensius/master

small driving improvements