How can I obtain the position of a point in the TCP coordinate system?

If the coordinates of a point in the base coordinate system are known, how can we obtain the coordinates of that point in the TCP coordinate system?Which script can achieve this requirement?If you could help me, I would be extremely grateful.

At present, I use get_actual_tcp_pose() script to obtain the pose of TCP, then transform it to obtain the transformation matrix T of the TCP coordinate system and the base coordinate system. and finally use the transformation matrix T to obtain the coordinates of points in TCP coordinate system. However, this method seems to be incorrect.

If you get the inverse of the pose first it should work. :slight_smile:
image