now also publishing cost map as occupancy grid for visualization