Update contact manager for Gazebo 2.0