Attempting to configure costmap_2d, but not working