Merge pull request #68 from ipa-nhg/groovy_dev_cob4

Groovy dev cob4
Merge branch 'groovy_dev' of github.com:ipa320/schunk_modular_robotics into groovy_dev