sample_int_publisher_from_pose_array.py

Go to the documentation of this file.

#!/usr/bin/env python
 
import time
 
from geometry_msgs.msg import PoseArray
from jsk_recognition_msgs.msg import Int32Stamped
import rospy
 
 
def cb(msg):
    out_msg = Int32Stamped()
    out_msg.header = msg.header
    out_msg.data = int(time.time() % len(msg.poses))
    pub.publish(out_msg)
 
 
if __name__ == '__main__':
    rospy.init_node('sample_int_publisher_from_pose_array')
    pub = rospy.Publisher('~output', Int32Stamped, queue_size=1)
    sub = rospy.Subscriber('~input', PoseArray, cb, queue_size=1)
    rospy.spin()