Added parameter to control if full costmap is always sent back by Costmap2DPublisher