Changeset 4611 in orxonox.OLD

Timestamp:

Jun 12, 2005, 11:52:45 PM (19 years ago)

Author:

patrick

Message:

orxonox/trunk: definition of the separation plane and partition of the vertex. some vector sVec3D modification

Location:

orxonox/trunk/src/lib

Files:

• collision_detection/obb_tree.cc (modified) (1 diff)
• collision_detection/obb_tree_node.cc (modified) (1 diff)
• math/vector.cc (modified) (1 diff)
• math/vector.h (modified) (1 diff)

orxonox/trunk/src/lib/collision_detection/obb_tree.cc

@@ -98 +98 @@
   int const length = 3;
   sVec3D* vertList = new sVec3D[length];
-  sVec3D data[length]  = {{5.0, 0.0, 0.0},{2.0, 0.0, 0.5},{14.0, 0.0, 0.0}};//, {5.0, 0.0, 1.0}, {12.0, 0.0, 8.0}, {3.0, 5.0, 4.9}};
+  sVec3D data[length]  = {{5.0, 0.0, 0.0},{2.0, 0.0, 5.0},{14.0, 0.0, 0.0}};//, {5.0, 0.0, 1.0}, {12.0, 0.0, 8.0}, {3.0, 5.0, 4.9}};
 
   for(int i = 0; i < length; ++i)

orxonox/trunk/src/lib/collision_detection/obb_tree_node.cc

@@ -279 +279 @@
 
   /* get the closest vertex near the center */
-  float               dist = 0.0f;                         //!< the smallest distance to each vertex
+  float               dist = 999999.0f;                    //!< the smallest distance to each vertex
   float               tmpDist;                             //!< temporary distance
   int                 vertexIndex;
-  Plane               separationPlane(*box->axis[axisIndex], *box->center); //!< the separation plane definition
+  Plane               middlePlane(*box->axis[axisIndex], *box->center); //!< the middle plane
 
   for(int i = 0; i < box->numOfVertices; ++i)
   {
-    tmpDist = fabs(separationPlane.distancePoint(vertices[i]));
-    if( tmpDist > dist)
+    tmpDist = fabs(middlePlane.distancePoint(box->vertices[i]));
+    if( tmpDist < dist)
+    {
       dist = tmpDist;
-  }
-
+      vertexIndex = i;
+    }
+  }
 
   printf("\nthe clostest vertex is nr: %i, with a dist of: %f\n", vertexIndex ,dist);
+
+
+  /* now definin the separation plane through this specified nearest point and partition
+    the points depending on which side they are located
+  */
+  Plane              separationPlane(*box->axis[axisIndex], box->vertices[vertexIndex]);  //!< separation plane
+  tList<sVec3D>      partition1;                           //!< the vertex partition 1
+  tList<sVec3D>      partition2;                           //!< the vertex partition 2
 
 

orxonox/trunk/src/lib/math/vector.cc

@@ -652 +652 @@
 }
 
+
+/**
+    \brief create a plane from anchor point and normal
+    \param norm: normal vector
+    \param p: anchor point
+*/
+Plane::Plane (Vector norm, sVec3D g)
+{
+  Vector p(g[0], g[1], g[2]);
+  n = norm;
+  k = -(n.x*p.x+n.y*p.y+n.z*p.z);
+}
+
+
 /**
    \brief returns the intersection point between the plane and a line

orxonox/trunk/src/lib/math/vector.h

@@ -227 +227 @@
   Plane (Vector a, Vector b, Vector c);
   Plane (Vector norm, Vector p);
+  Plane (Vector norm, sVec3D p);
   Plane (Vector n, float k) : n(n), k(k) {} //!< assignment constructor
   Plane () : n(Vector(1,1,1)), k(0) {}