develop in rostest, use pubsub and other examples as reference