Changeset 4929 in orxonox.OLD for orxonox/trunk/src/lib/graphics/spatial_separation/quadtree_node.cc

Timestamp:

Jul 21, 2005, 6:07:23 PM (19 years ago)

Author:

patrick

Message:

orxonox/trunk: implemented a point in triangle function

File:

• orxonox/trunk/src/lib/graphics/spatial_separation/quadtree_node.cc (modified) (1 diff)

orxonox/trunk/src/lib/graphics/spatial_separation/quadtree_node.cc

@@ -389 +389 @@
 
 
+sTriangleExt* QuadtreeNode::getTriangle(const Vector& position)
+{
+
+}
+
+bool QuadtreeNode::pointInTriangle(const Vector&p, const Vector& a, const Vector& b, const Vector& c)
+{
+  if( this->sameSide(p, a, b, c) && this->sameSide(p, b, a, c) && sameSide(p, c, a, b))
+    return true;
+  return false;
+  /*
+  function PointInTriangle(p, a,b,c)
+  if SameSide(p,a, b,c) and SameSide(p,b, a,c)
+  and SameSide(p,c, a,b) then return true
+  else return false
+  */
+}
+
+
+bool QuadtreeNode::sameSide(const Vector& p1, const Vector&p2, const Vector& a, const Vector& b)
+{
+  Vector cp1 = (b - a).cross(p1 - a);
+  Vector cp2 = (b - a).cross(p2 - a);
+
+  if( unlikely(cp1.dot(cp2) >= 0)) return true;
+  return false;
+}
+
+
 /**
  *  draws all the debug quadtree squares