Implementing the ADD-S Metric for 6D Pose Comparison in Python
import numpy as np def compute_add_s(ground_truth_pose, predicted_pose, model_points): """ Calculate the ADD-S metric for 6D pose comparison. Parameters: ground_truth_pose: 4x4 transformation matrix for ground truth pose predicted_pose: 4x4 transformation matrix for predicted pose mod...