Fixed the calculate distance bug

Math.cos takes radians, i was giving it degrees!!!
Merge branch 'master' of https://github.com/SirLimbo/Robocup-V2