Changeset 4956 in orxonox.OLD for orxonox/trunk/src/lib

Timestamp:

Jul 25, 2005, 9:01:08 PM (19 years ago)

Author:

patrick

Message:

orxonox/trunk: added the last functions needed to get the heigt from the terrain. test phase now

Location:

orxonox/trunk/src/lib/graphics/spatial_separation

Files:

• quadtree.cc (modified) (2 diffs)
• quadtree.h (modified) (1 diff)
• quadtree_node.cc (modified) (1 diff)
• quadtree_node.h (modified) (2 diffs)

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

@@ -159 +159 @@
   this function will return the quadtree that contains the position
  */
-QuadtreeNode* Quadtree::getQuadtreeFromPosition(const Vector& position)
+QuadtreeNode* Quadtree::getQuadtreeFromPosition(const Vector& position) const
 {
   /* shift into model space */
@@ -182 +182 @@
   this function will return the quadtree that contains the position
  */
-sTriangleExt* Quadtree::getTriangleFromPosition(const Vector& position)
+sTriangleExt* Quadtree::getTriangleFromPosition(const Vector& position) const
 {
   QuadtreeNode* q = this->getQuadtreeFromPosition(position);

orxonox/trunk/src/lib/graphics/spatial_separation/quadtree.h

@@ -27 +27 @@
     virtual ~Quadtree();
 
-    QuadtreeNode* getQuadtreeFromPosition(const Vector& position);
-    sTriangleExt* getTriangleFromPosition(const Vector& position);
+    QuadtreeNode* getQuadtreeFromPosition(const Vector& position) const;
+    sTriangleExt* getTriangleFromPosition(const Vector& position) const;
 
     void drawTree() const;

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)
+
+float QuadtreeNode::getHeight(const Vector& position) const
+{
+  Vector a, b, c;
+  sTriangleExt* tri;
+
+  for( int i = 0; i < this->numTriangles; ++i)
+    {
+      a = *(sVec3D*)&this->pVertices[this->pTriangles[i]->indexToVertices[0]];
+      b = *(sVec3D*)&this->pVertices[this->pTriangles[i]->indexToVertices[1]];
+      c = *(sVec3D*)&this->pVertices[this->pTriangles[i]->indexToVertices[2]];
+      
+      if( unlikely(this->pointInTriangle(position, a, b, c)))
+        {
+          tri = this->pTriangles[i];
+          break;
+        }
+    }
+  
+  /* calculate height out of the data collected above */
+  
+}
+
+
+/**
+ *  get triangles that includes the position
+ * @param position the position that is going to be checked
+ * @returns the triangle in which the position is included, NULL if there is no such triangle
+
+ There is some random behaviour if there are more than one triangle at the same y
+ coordinate. At the moment the function just takes the first triangle, that included the 
+ vector
+*/
+sTriangleExt* QuadtreeNode::getTriangle(const Vector& position) const
+{
+  Vector a, b, c;
+
+  for( int i = 0; i < this->numTriangles; ++i)
+    {
+      a = *(sVec3D*)&this->pVertices[this->pTriangles[i]->indexToVertices[0]];
+      b = *(sVec3D*)&this->pVertices[this->pTriangles[i]->indexToVertices[1]];
+      c = *(sVec3D*)&this->pVertices[this->pTriangles[i]->indexToVertices[2]];
+
+      if( unlikely(this->pointInTriangle(position, a, b, c)))
+        return this->pTriangles[i];
+    }
+  return NULL;
+}
+
+
+/**
+ *  checks if the point is in the triangle
+ * @param point to be checked
+ * @param rectangle edge a
+ * @param rectangle edge b
+ * @param rectangle edge c
+ * @returns true if the point is inside
+*/
+bool QuadtreeNode::pointInTriangle(const Vector&p, const Vector& a, const Vector& b, const Vector& c) const
 {
   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)
+}
+
+
+/**
+ *  checks if two points are on the same side 
+ * @param point one to be checked
+ * @param point two to be checked
+ * @param begining point of the line
+ * @param end of the line
+*/
+bool QuadtreeNode::sameSide(const Vector& p1, const Vector&p2, const Vector& a, const Vector& b) const
 {
   Vector cp1 = (b - a).cross(p1 - a);

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

@@ -36 +36 @@
 
     void buildHashTable(QuadtreeNode** nodeList, int* index);
+    inline Rectangle* getDimension() { return this->pDimension; }
+
     bool includesPoint(const Vector& v);
-    sTriangleExt* getTriangle(const Vector& position);
-    float getHeight(const Vector& position);
-    inline Rectangle* getDimension() { return this->pDimension; }
+    sTriangleExt* getTriangle(const Vector& position) const;
+    float getHeight(const Vector& position) const;
+
 
     void drawTree() const;
@@ -52 +54 @@
     Rectangle* getDimFromModel();
 
-    bool sameSide(const Vector& p1, const Vector&p2, const Vector& a, const Vector& b);
-    bool pointInTriangle(const Vector&p, const Vector& a, const Vector& b, const Vector& c);
+    bool sameSide(const Vector& p1, const Vector&p2, const Vector& a, const Vector& b) const;
+    bool pointInTriangle(const Vector&p, const Vector& a, const Vector& b, const Vector& c) const;
 
   protected: