fixes for cob3-3
Merge branch 'groovy_dev' of github.com:ipa-cob3-3/cob_robots into groovy_dev
Merge pull request #90 from ipa-cob3-3/groovy_dev

Groovy dev