Publishes OccupancyGrid, minor changes