Merge pull request #342 from reem-utils/fix_sergi

hot fixes while trying code on robot, prociding to do proper fixing
Fixed most obvious errors
Merge branch 'master' of http://github.com/reem-utils/robocup2014 into fix_sergi