Fixed disconnect/reconnect problem in Costmap2DPublisher.
In old version, if you disconnected and reconnected you would still get the first-ever full
costmap from the latched topic instead of the latest costmap.  This fixes that.

This also makes it so that the publisher does no work if there are no subscribers.