Merge pull request #41 from ipa-fxm/groovy_dev_cob4

Adapt to the new cob_controller_configuration_gazebo structure
setup tests
bring in groovy update
merge with groovy_dev
Merge pull request #44 from ipa-fxm/hydro_dev

bring in groovy updates