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.

How do I get the displacement vector from one object to another?

quaternion

asked 2017-08-01 12:23:40 -0500

ysl208
23 ●6 ●7 ●13

I have two objects A and B, each in the form of geometry_msgs/PoseStamped. I would like to calculate the displacement (translation & rotation) vector that I can apply to any (similar) object A' and arrive to a (similar) object B' (respectively).

I guess the vector should also be of the form PoseStamped.
For translation, can I simply take B.PoseStamped.position.x - A.PoseStamped.position.x (similar for y,z)?
For the quaternion, I am not sure if I can simply do division (since adding angles in quaternions is done by multiplication?) i.e. B.PoseStamped.quaternion.x/A.PoseStamped.quaternion.x ?

I would like to avoid having to transform the quaternion to euler and back.

edit retag flag offensive close merge delete

add a comment

1 Answer

Sort by » oldest newest most voted

answered 2017-08-09 22:53:33 -0500

Ed Venator

1185 ●8 ●19 ●23

Unfortunately, you cannot do mathematical operations on the geometry_msgs message types. They are plain old ROS messages with no overloaded operators. For what you want to do, you'll need to convert the messages to tf::Pose types. Once you do that, follow the instructions in this answer to calculate displacement.

edit flag offensive delete link

Comments

They are plain old ROS messages [..]

+1 for this :)

That would be a PORM.

gvdhoorn ( 2017-08-10 03:24:18 -0500 )edit

add a comment

Question Tools

1 follower

Stats

Asked: 2017-08-01 12:23:40 -0500

Seen: 413 times

Last updated: Aug 09 '17

How do I get the displacement vector from one object to another? edit

1 Answer

Comments

Question Tools

Stats

Related questions

How do I get the displacement vector from one object to another?