Attention: Answers.ros.org is deprecated as of August the 11th, 2023. Please visit robotics.stackexchange.com to ask a new question. This site will remain online in read-only mode during the transition and into the foreseeable future. Selected questions and answers have been migrated, and redirects have been put in place to direct users to the corresponding questions on Robotics Stack Exchange. Additional details are available here.

Revision history [back]

Try to add this in the global scope:

waistp = None
shoulderp  = None
elbowp  = None
waistv  = None
shoulderv  = None
elbowv  = None

so you have these variables and can update them every get_arm_pose callback. Instead of using global variables I would move the code inside a class, e.g. class Arm().

ROS Answers is licensed under Creative Commons Attribution 3.0 Content on this site is licensed under a Creative Commons Attribution Share Alike 3.0 license.