Tuned the PID. It could be better, but for now it works a-okay.
Updated odometry to publish the appropriate ros message.
Merge branch 'master' of http://github.com/TheiaRobo/Theia