Merge pull request #70 from ipa-fxm/groovy_dev_cob4

Groovy dev cob4
fix kinect topics for simulation
fix file to mesh files
merge with groovy_dev