Fix 6DoF graph angular check (#1511)

* Fix 6DoF graph angular check * Updated getAngle to use better version
2026-09-09 21:10:19 +08:00 · 2025-05-24 13:25:26 -07:00
parent a02621ef30
commit 478e909742
10 changed files with 36 additions and 36 deletions
@@ -1255,9 +1255,8 @@ int main(int argc, char * argv[])
 												t.r11(), t.r12(), t.r13(), t.x()*bestScale,
 												t.r21(), t.r22(), t.r23(), t.y()*bestScale,
 												t.r31(), t.r32(), t.r33(), t.z()*bestScale);
-										Transform diff = gtLink.inverse()*scaledLink;
-										sumDist += diff.getNorm();
-										sumAngle += diff.getAngle();
+										sumDist += gtLink.getDistance(scaledLink);
+										sumAngle += gtLink.getAngle(scaledLink);
 										++count;
 									}
 								}