How can I get the positions data of every joint ?
Hi everyone,
I am doing arm trajectory planning.
Now I am using motion_planning_rviz_plugin to display the trajectory of the arm. First I wrote program reference to link text and then RVIZ subscribe the topic "joint_path_display".
I can display the trajectory just like the picture !
Now I want to get the position data of every joints which I circled with red colour on the image.
How can I get the position information of every joint?
Thanks in advance