MathUtil squaredist (#910)

soedinglab · Dec 2, 2024 · 9c102e1 · 9c102e1
1 parent c2c3ad9
commit 9c102e1
Showing 1 changed file with 7 additions and 0 deletions.
diff --git a/src/commons/MathUtil.h b/src/commons/MathUtil.h
@@ -256,6 +256,13 @@ class MathUtil {
         return sum;
     }
 
+    static float squareDist(const float xx, const float xy, const float xz,
+            const float yx, const float yy, const float yz){
+        float d1 = xx - yx;
+        float d2 = xy - yy;
+        float d3 = xz - yz;
+        return (d1 * d1 + d2 * d2 + d3 * d3);
+    }
 
 };