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

Timestamp:

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

Author:

patrick

Message:

orxonox/trunk: fixed the axis length bug

File:

• orxonox/trunk/src/lib/math/vector.cc (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