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

Only publish costmaps if they have subscribers.