goal detection is working awesome!! completed finally!!!
Merge branch 'master' of github.com:pkok/Robolab