Komak57

Line-Triangle attempt

Mar 31st, 2013
131
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C# 9.63 KB | None | 0 0
  1. // line-triangle formula
  2.         public static bool LinePlane2(Vector start, Vector end, Vector[] face, Vector norm)
  3.         {
  4.             //tmp = start.Subtract(end);
  5.             Vector3 lineDirection = -end.Vec3 - -start.Vec3;//end.Subtract(start).Vec3;
  6.  
  7.             //if ((Vector3.Dot(norm.Vec3, face[0].Vec3) - Vector3.Dot(start.Vec3, norm.Vec3)) / Vector3.Dot(lineDirection, norm.Vec3) < 0) // ray collides behind direction
  8.             //return false;
  9.             //lineDirection.Y = -end.Y - -start.Y;
  10.             // Prepare our barycentric variables
  11.             // UV are our pixel coordinates in a 0 to 1 range
  12.             Vector3 u, v, triangleNormal;
  13.  
  14.             //tmp = face[1].Subtract(face[0]);
  15.             u = face[1].Subtract(face[0]).Vec3;
  16.  
  17.             //tmp = face[2].Subtract(face[0]);
  18.             v = face[2].Subtract(face[0]).Vec3;
  19.  
  20.             triangleNormal = Vector3.Cross(u, v);
  21.  
  22.             // Paranoid Check for collapsed triangle
  23.             if (triangleNormal == new Vector3(0.0f, 0.0f, 0.0f))
  24.             {
  25.                 // triangle is degenerate
  26.                 return false;
  27.             }
  28.  
  29.  
  30.             //tmp = face[0].Subtract(end);
  31.             Vector3 triangleToLineDirection = face[0].Subtract(end).Vec3;
  32.  
  33.             // Parameters for ray/plane intersection
  34.             float a, b, r;
  35.  
  36.             a = Vector3.Dot(triangleNormal, triangleToLineDirection);
  37.  
  38.             b = Vector3.Dot(triangleNormal, lineDirection);
  39.  
  40.             if (a < 0.0001f) // parallel check
  41.             {
  42.                 if (a == 0)
  43.                 {
  44.                     // ray lies in triangle plane
  45.                     return false;
  46.                 }
  47.                 else
  48.                 {
  49.                     // ray is disjointed from triangle's plane
  50.                     return false;
  51.                 }
  52.             }
  53.  
  54.             r = a / b;
  55.             if (r < 0.0f)
  56.             {
  57.                 // Line points away from triangle
  58.                 return false;
  59.             }
  60.  
  61.             // This is the intersection point of the line direction to the triangles plane
  62.             //tmp = start;
  63.             //Vector3 intersectionPoint = start.Vec3;
  64.             Vector3 intersectionPoint = Vector3.Add(start.Vec3, lineDirection * r);
  65.  
  66.             // This is crazy vector dot product math that essentially is a set of line to point
  67.             // collision checks
  68.             float uu, uv, vv, wu, wv, D;
  69.             uu = Vector3.Dot(u, u);
  70.             uv = Vector3.Dot(u, v);
  71.             vv = Vector3.Dot(v, v);
  72.  
  73.             // Now we are getting ray from the intersection point to the refrence
  74.             // point on the triangle
  75.             //tmp = face[0];
  76.             Vector3 refrencePointOnTriangle = face[0].Vec3;
  77.             Vector3 w = intersectionPoint - refrencePointOnTriangle;
  78.  
  79.             wu = Vector3.Dot(w, u);
  80.             wv = Vector3.Dot(w, v);
  81.  
  82.             D = uv * uv - uu * vv;
  83.  
  84.             // Testing the "parametric" coordinates
  85.             float s, t;
  86.             s = (uv * wv - vv * wu) / D;
  87.             if (s < 0.0 || s > 1.0)        // I is outside T
  88.             {
  89.                 // Line Intersection is outside of the Triangle
  90.                 return false;
  91.             }
  92.  
  93.             t = (uv * wu - uu * wv) / D;
  94.             if (t < 0.0 || (s + t) > 1.0)
  95.             {
  96.                 // I is outside T
  97.                 return false;
  98.             }
  99.  
  100.             // The line does intersect
  101.             return true;
  102.         }
  103.  
  104. // loop-code
  105.             if (!player.pos.Equals(dest))
  106.             {
  107.                 collisions = new Model();
  108.                 List<Vector> verts = new List<Vector>();
  109.                 List<Vector> norms = new List<Vector>();
  110.                 List<Color> colors = new List<Color>();
  111.  
  112.                 Stopwatch stopwatch = new Stopwatch();
  113.                 stopwatch.Start();
  114.  
  115.                 //ParallelLoopResult result = Parallel.For(0, World._rawdata._Tri.Count(), i =>
  116.                 for (int i = 0; i < World._rawdata._Tri.Count(); i++)
  117.                 {
  118.  
  119.                     //Gl.glTranslated(0, -player.pos.Y, 0);
  120.                     //Gl.glTranslated(player.pos.X, player.pos.Y, player.pos.Z);
  121.  
  122.                     Vector[] face = { World._rawdata._Vert[World._rawdata._Tri[i].Vertex[0]], World._rawdata._Vert[World._rawdata._Tri[i].Vertex[1]], World._rawdata._Vert[World._rawdata._Tri[i].Vertex[2]] };
  123.                     Vector[] norm = { World._rawdata._Norm[World._rawdata._Tri[i].Normal[0]], World._rawdata._Norm[World._rawdata._Tri[i].Normal[1]], World._rawdata._Norm[World._rawdata._Tri[i].Normal[2]] };
  124.  
  125.                     Gl.glLoadIdentity();
  126.                     /*if (RayPlane(player.pos, dest, face, norm[0]) > 0)
  127.                     {
  128.                         verts.Add(face[0]); verts.Add(face[1]); verts.Add(face[2]);
  129.                         norms.Add(norm[0]); norms.Add(norm[1]); norms.Add(norm[2]);
  130.                         colors.Add(new Color(0, 1, 0, 0.5f)); colors.Add(new Color(0, 1, 0, 0.5f)); colors.Add(new Color(0, 1, 0, 0.5f));
  131.                     }*/
  132.                     /*if (XNARayPlane(player.pos, dest, face, norm[0]) > 0)
  133.                     {
  134.                         verts.Add(face[0]); verts.Add(face[1]); verts.Add(face[2]);
  135.                         norms.Add(norm[0]); norms.Add(norm[1]); norms.Add(norm[2]);
  136.                         colors.Add(new Color(0, 0, 1, 0.5f)); colors.Add(new Color(0, 0, 1, 0.5f)); colors.Add(new Color(0, 0, 1, 0.5f));
  137.                     }*/
  138.                     int chk = 0;
  139.                     //LinePlane(player.pos, dest, face, norm[0]) &&
  140.                     if (Collision.LinePlane2(player.pos, dest, face, norm[0]))
  141.                     {
  142.                         verts.Add(face[0]); verts.Add(face[1]); verts.Add(face[2]);
  143.                         norms.Add(norm[0]); norms.Add(norm[1]); norms.Add(norm[2]);
  144.                         colors.Add(new Color(1, 0, 0, 0.5f)); colors.Add(new Color(1, 0, 0, 0.5f)); colors.Add(new Color(1, 0, 0, 0.5f));
  145.                         //dest = player.pos;
  146.                     }
  147.                     /*Vector3 intersection;
  148.                     if (LinePlane2(out intersection, new Vector3(player.pos.X, player.pos.Y, player.pos.Z), new Vector3(dest.X, dest.Y, dest.Z), new Vector3(norm[0].X, norm[0].Y, norm[0].Z), new Vector3(verts[0].X, verts[0].Y, verts[0].Z)))
  149.                     {
  150.                         if (intersection.Length() - player.pos.Length() < dest.Subtract(player.pos).Length())
  151.                         {
  152.  
  153.                             verts.Add(face[0]); verts.Add(face[1]); verts.Add(face[2]);
  154.                             norms.Add(norm[0]); norms.Add(norm[1]); norms.Add(norm[2]);
  155.                             colors.Add(new Color(0, 0, 1, 0.5f)); colors.Add(new Color(0, 0, 1, 0.5f)); colors.Add(new Color(0, 0, 1, 0.5f));
  156.                         }
  157.                         //dest = player.pos;
  158.                     }*/
  159.                     /*Vector size = player.model.getSize();
  160.                     if (XNABoundingBox(new Vector(size.X / 2 - dest.X, size.Y / 2 - dest.Y, size.Z / 2 - dest.Z), size, face, norm[0]) == 0)
  161.                     {
  162.                        
  163.                         verts.Add(face[0]); verts.Add(face[1]); verts.Add(face[2]);
  164.                         norms.Add(norm[0]); norms.Add(norm[1]); norms.Add(norm[2]);
  165.                         colors.Add(new Color(0, 1, 0, 0.5f)); colors.Add(new Color(0, 1, 0, 0.5f)); colors.Add(new Color(0, 1, 0, 0.5f));
  166.                     }*/
  167.                 }//);
  168.                 collisions._rawdata._Vert = verts.ToArray();
  169.                 collisions._rawdata._Norm = norms.ToArray();
  170.                 int a = 0;
  171.                 collisions._vertexArray = new float[(collisions._rawdata._Vert.Count()) * 3 * 3];
  172.                 foreach (Vector v in collisions._rawdata._Vert)
  173.                 {
  174.                     collisions._vertexArray[a + 0] = v.X;
  175.                     collisions._vertexArray[a + 1] = v.Y;
  176.                     collisions._vertexArray[a + 2] = v.Z;
  177.                     a += 3;
  178.                 }
  179.                 a = 0;
  180.                 collisions._vertexNormal = new float[(collisions._rawdata._Norm.Count()) * 3 * 3];
  181.                 foreach (Vector v in collisions._rawdata._Norm)
  182.                 {
  183.                     collisions._vertexNormal[a + 0] = v.X;
  184.                     collisions._vertexNormal[a + 1] = v.Y;
  185.                     collisions._vertexNormal[a + 2] = v.Z;
  186.                     a += 3;
  187.                 }
  188.                 a = 0;
  189.                 collisions._vertexColors = new float[(collisions._rawdata._Vert.Count()) * 4 * 3];
  190.                 foreach (Color c in colors)
  191.                 {
  192.                     collisions._vertexColors[a + 0] = c.Red;
  193.                     collisions._vertexColors[a + 1] = c.Green;
  194.                     collisions._vertexColors[a + 2] = c.Blue;
  195.                     collisions._vertexColors[a + 3] = c.Alpha;
  196.                     a += 4;
  197.                 }
  198.                 //while (!result.IsCompleted)
  199.                 //;
  200.  
  201.                 stopwatch.Stop();
  202.                 //System.Console.WriteLine("[" + DateTime.Now.ToString("HH:mm:ss+ff") + "] <System>: Collision detections took: " + stopwatch.ElapsedMilliseconds + " miliseconds.");
  203.                 /*System.Console.WriteLine("[" + DateTime.Now.ToString("HH:mm:ss+ff") + "] <System>: Will collide with "+raycount+" faces,"+
  204.                     "\nimmediate collisions "+(allow_move? "detected" : "not detected")+","+
  205.                     "\nfound in " + stopwatch.ElapsedMilliseconds + " miliseconds.");*/
  206.                 stopwatch.Reset();
  207.                 player.pos = dest;
  208.             }
Advertisement
Add Comment
Please, Sign In to add comment