Changeset 4585 in orxonox.OLD for orxonox/trunk/src/lib/math

Timestamp:

Jun 10, 2005, 4:05:04 AM (19 years ago)

Author:

patrick

Message:

orxonox/trunk: fixed the axis length bug

Location:

orxonox/trunk/src/lib/math

Files:

• vector.cc (modified) (1 diff)
• vector.h (modified) (1 diff)

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

@@ -675 +675 @@
 }
 
+
+/**
+   \brief returns the distance between the plane and a point
+   \param p: a Point
+   \return the distance between the plane and the point (can be negative)
+ */
+float Plane::distancePoint (const sVec3D& p) const
+{
+  Vector s(p[0], p[1], p[2]);
+  float l = n.len();
+  if( l == 0.0) return 0.0;
+  return (n.dot(s) + k) / n.len();
+}
+
+
 /**
    \brief returns the side a point is located relative to a Plane

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

@@ -225 +225 @@
   Vector intersectLine (const Line& l) const;
   float distancePoint (const Vector& p) const;
+  float distancePoint (const sVec3D& p) const;
   float locatePoint (const Vector& p) const;
 };