joint_state_publisher.py

Go to the documentation of this file.

#!/usr/bin/env python

import rospy
from sensor_msgs.msg import JointState

joint_states = None
def callback(msg):
    global joint_states
    print(msg)
    joint_states = msg

def joint_state_publisher():
    global joint_states
    rospy.init_node('joint_states_latcher', anonymous=True)
    rospy.Subscriber("joint_states_sub", JointState, callback)
    pub = rospy.Publisher('joint_states_pub', JointState)
    while not rospy.is_shutdown():
        if joint_states:
            print(joint_states)
            joint_states.header.stamp = rospy.Time.now()
            pub.publish(joint_states)
        rospy.sleep(0.1)

if __name__ == "__main__":
    joint_state_publisher()