Only publish costmaps if they have subscribers.
Merge pull request #177 from trainman419/arm-performance

Only publish costmaps if they have subscribers.
Merge remote-tracking branch 'upstream/hydro-devel' into hydro