Check number of subscribers before publishing marker

This checks whether a node as subscribed to the marker topic and do not publish until someone subscribes.
Related [answers.ros.org](http://answers.ros.org/question/199299/why-do-i-need-to-enter-a-loop-to-display-a-marker/) topic.