Ask Your Question

Find end effector pose from joint state

asked 2019-07-08 06:23:18 -0600

pazgenie gravatar image

updated 2019-07-08 06:29:52 -0600

Hi, I am trying to get the end effector Cartesian point from a list of joint states. I used a solution I found in a different answer here ( and used the pykdl_utils package ( It worked fine but what I got back from there was a 4*4 matrix, and im not sure how to convert this matrix to position and orientation coordinates that I can use in moveit.


edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

answered 2019-07-08 08:37:45 -0600

The 4x4 matrix you have received is known as a DH-Matrix it contains a 3x3 rotation matrix and a 3 element translation vector in such a way that the combined transformation can be applied using a single matrix multiplication.

If you want to extract just the translation from this you'll want to extract the first three rows from the final column, this will give you a 3D position vector. If the DH-Matrix you've got is a transformation from the base frame to the end effector frame then this position vector will actually point from the end effector to the origin of the base link, so it will be the opposite of what you might expect. To get the location of the end effector in the base_link frame you'll need to subtract it from the zero vector.

Hope this helps.

edit flag offensive delete link more

Your Answer

Please start posting anonymously - your entry will be published after you log in or create a new account.

Add Answer

Question Tools



Asked: 2019-07-08 06:23:18 -0600

Seen: 465 times

Last updated: Jul 08 '19