working stage in ROS loop with publisher and subscriber