Updated costmap params to match Daves suggestions