From 1ffd23218b3672adfa03f87b220e38838cd6100d Mon Sep 17 00:00:00 2001
From: notgiven688 <notgiven688@users.noreply.github.com>
Date: Thu, 3 Oct 2024 10:17:08 +0200
Subject: [PATCH] Move MinkowskiDifference to a separate class

---
 src/GJKEPA.cs              | 41 ------------------------------------
 src/MinkowskiDifference.cs | 43 ++++++++++++++++++++++++++++++++++++++
 2 files changed, 43 insertions(+), 41 deletions(-)
 create mode 100644 src/MinkowskiDifference.cs

diff --git a/src/GJKEPA.cs b/src/GJKEPA.cs
index bd8ec20..75995b6 100644
--- a/src/GJKEPA.cs
+++ b/src/GJKEPA.cs
@@ -31,47 +31,6 @@ public sealed class GJKEPA
 
         public struct Statistics { public double Accuracy; public int Iterations; }
 
-        public struct MinkowskiDifference
-        {
-            public ISupportMappable SupportA, SupportB;
-            public JMatrix OrientationA, OrientationB;
-            public JVector PositionA, PositionB;
-
-            private void SupportMapTransformedA(in JVector direction, out JVector result)
-            {
-                JVector.TransposedTransform(direction, OrientationA, out JVector tmp);
-                SupportA.SupportMapping(tmp, out result);
-                JVector.Transform(result, OrientationA, out result);
-                JVector.Add(result, PositionA, out result);
-            }
-
-            private void SupportMapTransformedB(in JVector direction, out JVector result)
-            {
-                JVector.TransposedTransform(direction, OrientationB, out JVector tmp);
-                SupportB.SupportMapping(tmp, out result);
-                JVector.Transform(result, OrientationB, out result);
-                JVector.Add(result, PositionB, out result);
-            }
-
-            public void Support(in JVector direction, out JVector vA, out JVector vB, out JVector v)
-            {
-                // Calculates the support function S_{A-B}(d) = S_{A}(d) - S_{B}(-d),
-                // where 'd' represents the direction.
-                SupportMapTransformedA(direction, out vA);
-                SupportMapTransformedB(-direction, out vB);
-                JVector.Subtract(vA, vB, out v);
-            }
-
-            public void SupportMapping(in JVector direction, out JVector result)
-            {
-                this.Support(direction, out _, out _, out result);
-            }
-
-            public void SupportCenter(out JVector center)
-            {
-                JVector.Subtract(PositionA, PositionB, out center);
-            }
-        }
 
         public class GJKEPASolver
         {
diff --git a/src/MinkowskiDifference.cs b/src/MinkowskiDifference.cs
new file mode 100644
index 0000000..d92de7e
--- /dev/null
+++ b/src/MinkowskiDifference.cs
@@ -0,0 +1,43 @@
+namespace GJKEPADemo;
+
+public struct MinkowskiDifference
+{
+    public ISupportMappable SupportA, SupportB;
+    public JMatrix OrientationA, OrientationB;
+    public JVector PositionA, PositionB;
+
+    private void SupportMapTransformedA(in JVector direction, out JVector result)
+    {
+        JVector.TransposedTransform(direction, OrientationA, out JVector tmp);
+        SupportA.SupportMapping(tmp, out result);
+        JVector.Transform(result, OrientationA, out result);
+        JVector.Add(result, PositionA, out result);
+    }
+
+    private void SupportMapTransformedB(in JVector direction, out JVector result)
+    {
+        JVector.TransposedTransform(direction, OrientationB, out JVector tmp);
+        SupportB.SupportMapping(tmp, out result);
+        JVector.Transform(result, OrientationB, out result);
+        JVector.Add(result, PositionB, out result);
+    }
+
+    public void Support(in JVector direction, out JVector vA, out JVector vB, out JVector v)
+    {
+        // Calculates the support function S_{A-B}(d) = S_{A}(d) - S_{B}(-d),
+        // where 'd' represents the direction.
+        SupportMapTransformedA(direction, out vA);
+        SupportMapTransformedB(-direction, out vB);
+        JVector.Subtract(vA, vB, out v);
+    }
+
+    public void SupportMapping(in JVector direction, out JVector result)
+    {
+        this.Support(direction, out _, out _, out result);
+    }
+
+    public void SupportCenter(out JVector center)
+    {
+        JVector.Subtract(PositionA, PositionB, out center);
+    }
+}