Added function to get the transformation matrix joint-end effector