Subscribe to endpoint_state, and save the pose position coordinates for later use

asked 2014-07-01 14:04:44 -0500

grisam
1 ●2 ●3 ●3

updated 2014-07-01 14:33:01 -0500

On the terminal, I'm entering in

$ rostopic echo /robot/limb/left/endpoint_state

to get the position of the endpoints. The output comes out like this:

pose:  
position: x: 0.0881700859423
y: 0.666633918353
z: -0.25671871773  
...

Now, in my program, I want to subscribe to this topic and retrieve just the above coordinates: the pose x, y and z. My subscriber looks like this:

ros::Subscriber sub = n.subscribe("/robot/limb/left/endpoint_state", 1, leftEndpointCallback)

In my callback, I'm trying to get just these specific coordinates as floats or doubles or whatever data type they are, and be able to use them later in my code (i.e. use the x coordinate in an if statement, for example). How would I do this?

edit retag flag offensive close merge delete

add a comment

0

answered 2014-07-15 14:29:09 -0500

Francisco
31 ●1

The first thing to do is determine what is the message used in that topic, e.g:

$ rostopic info /robot/limb/left/endpoint_state
Type: baxter_core_msgs/EndpointState

Therefore, your function leftEndpointCallback should look like this:

void leftEndpointCallback(const baxter_core_msgs::EndpointStateConstPtr& _msg) 
{
  // The pose is within the _msg object
  ROS_INFO_STREAM("pose: " << _msg->pose);
  ROS_INFO_STREAM("pose.position.x: " << _msg->pose.position.x);
  ROS_INFO_STREAM("pose.position.y: " << _msg->pose.position.y);
  ROS_INFO_STREAM("pose.position.z: " << _msg->pose.position.z);
}

How to use these values somewhere else is scope of C/C++ callbacks. If you really need to process this data outside the callback you may consider implementing a Class. It seems that most people hate global variables (count me as well)

edit flag offensive delete link

Comments

Is there a way I could do this and get only ONE specific point? I keep getting a stream of points but I only want the coordinates at one time instance. Also, what do you mean it's within the scope? If I save _msg->pose.position.x as a variable, how would I access that variable outside the callback?

grisam ( 2014-07-23 11:05:52 -0500 )edit

add a comment

0

answered 2018-06-25 20:32:59 -0500

youssef desouky
11 ●1 ●3 ●4

updated 2018-06-26 02:26:38 -0500

jayess
6155 ●26 ●85 ●92

Yout have to add pose.pose.position.x;

void leftEndpointCallback(const baxter_core_msgs::EndpointStateConstPtr& _msg) 
{
  // The pose is within the _msg object
  ROS_INFO_STREAM("pose: " << _msg->pose);
  ROS_INFO_STREAM("pose.position.x: " << _msg->pose.pose.position.x);
  ROS_INFO_STREAM("pose.position.y: " << _msg->pose.pose.position.y);
  ROS_INFO_STREAM("pose.position.z: " << _msg->pose.pose.position.z);
}

edit flag offensive delete link

add a comment

Subscribe to endpoint_state, and save the pose position coordinates for later use

2 Answers

Comments

Question Tools

Stats

Related questions

Subscribe to endpoint_state, and save the pose position coordinates for later use edit

2 Answers

Comments

Question Tools

Stats

Related questions

Subscribe to endpoint_state, and save the pose position coordinates for later use