Update contact manager for Gazebo 2.0
Merge pull request #16 from trainman419/gazebo2

Update contact manager for Gazebo 2.0