Compute best-fit isometries between estimated map and ground truth