We are trying to visualize the robot end-effector pose in the camera coordinate frame.
Intrinsic used: head_intrinsic_params.json
Extrinsic used: head_extrinsic_params_aligned.json
URDF used: G1_120s.urdf
Here are two examples of our current result:
Could you please clarify:
Should the EEF pose be aligned with the gripper itself, or should it be aligned with the point currently shown in our visualization?
If the alignment is incorrect, we can also provide our transformation code for your reference.
Do you have any suggestions or modifications we should make?