added Contact Plugin like in the Gazebo Tutorial, have to create a joint between suctioncup and box if there is a collision