Remove dependency to gazebo