Groovy Updates for gazebo simulation

- some raw3-1 updates from ICRA-demo,
- adjustments according to new gazebo format