fixes for cob3-3
Merge branch 'groovy_dev' of github.com:ipa-cob3-3/cob_robots into groovy_dev