Basic sub and pub working with ros