a little motion control work
Merge branch 'master' of https://github.com/RoboJackets/robocup-software