Only publish costmaps if they have subscribers.

This shaves off a few cycles and improves performance.