Cleaning code.
Adding odometery test.
Merge branch 'master' of https://github.com/astralien3000/robot2014