compute_joint_0_target.py

Go to the documentation of this file.

#!/usr/bin/env python

import roslib
import rospy

from sensor_msgs.msg import JointState
from std_msgs.msg import Float64


class Merger(object):

    def __init__(self):
        self.subscriber = rospy.Subscriber(
            "/joint_states", JointState, self.callback)
        self.publisher = rospy.Publisher("/lfj0_target", Float64)

    def callback(self, data):
        msg_to_send = Float64()

        msg_to_send.data = data.position[17] + data.position[18]

        self.publisher.publish(msg_to_send)

if __name__ == '__main__':
    rospy.init_node("merger", anonymous=True)
    merger = Merger()
    rospy.spin()