Final update of code post robocup