utility functions

EnvyKong · May 30, 2017 · 2c8eb44 · 2c8eb44
1 parent 0a8bfc2
commit 2c8eb44
Show file tree

Hide file tree

Showing 2 changed files with 35 additions and 1 deletion.
diff --git a/core/Util.cs b/core/Util.cs
@@ -179,6 +179,24 @@ public static void WriteDebugMesh(IMesh mesh, string sPath)
             StandardMeshWriter.WriteFile(sPath, new List<WriteMesh>() { new WriteMesh(mesh) }, options);
         }
 
+        public static void WriteDebugMeshAndMarkers(IMesh mesh, List<Vector3d> Markers, string sPath)
+        {
+            WriteOptions options = WriteOptions.Defaults;
+            options.bWriteGroups = true;
+            List<WriteMesh> meshes = new List<WriteMesh>() { new WriteMesh(mesh) };
+            double size = BoundsUtil.Bounds(mesh).Diagonal.Length * 0.01f;
+            foreach ( Vector3d v in Markers ) {
+                TrivialBox3Generator boxgen = new TrivialBox3Generator();
+                boxgen.Box = new Box3d(v, size * Vector3d.One);
+                boxgen.Generate();
+                DMesh3 m = new DMesh3();
+                boxgen.MakeMesh(m);
+                meshes.Add(new WriteMesh(m));
+            }
+
+            StandardMeshWriter.WriteFile(sPath, meshes, options);
+        }
+
 
     }
 

diff --git a/queries/MeshQueries.cs b/queries/MeshQueries.cs
@@ -204,6 +204,23 @@ public static double TriDistanceSqr(DMesh3 mesh, int ti, Vector3d point)
 
 
 
+        // brute force search for nearest triangle to point
+        public static int FindNearestVertex_LinearSearch(DMesh3 mesh, Vector3d p)
+        {
+            int vNearest = DMesh3.InvalidID;
+            double fNearestSqr = double.MaxValue;
+            foreach ( int vid in mesh.VertexIndices() ) {
+                double distSqr = mesh.GetVertex(vid).DistanceSquared(p);
+                if (distSqr < fNearestSqr) {
+                    fNearestSqr = distSqr;
+                    vNearest = vid;
+                }
+            }
+            return vNearest;
+        }
+
+
+
         // brute force search for nearest triangle to point
         public static int FindNearestTriangle_LinearSearch(DMesh3 mesh, Vector3d p)
         {
@@ -219,7 +236,6 @@ public static int FindNearestTriangle_LinearSearch(DMesh3 mesh, Vector3d p)
             return tNearest;
         }
 
-
         public static int FindHitTriangle_LinearSearch(DMesh3 mesh, Ray3d ray)
         {
             int tNearestID = DMesh3.InvalidID;