Cleaned up, now compiles, not finished nor being used for now
Merge branch 'master' of https://github.com/reem-utils/robocup2014