Changeset 639 for GTP/trunk/Lib/Vis/Preprocessing/src/Plane3.cpp

Timestamp:

02/14/06 17:13:42 (18 years ago)

Author:

mattausch

Message:

 

File:

• GTP/trunk/Lib/Vis/Preprocessing/src/Plane3.cpp (modified) (1 diff)

GTP/trunk/Lib/Vis/Preprocessing/src/Plane3.cpp

@@ -31 +31 @@
   return true;
 }
+
+
+Vector3 Plane3::FindIntersection(const Vector3 &a,                                                 
+                                                                 const Vector3 &b,
+                                                                 float *t,
+                                                                 bool *coplanar) const 
+{
+    const Vector3 v = b - a; // line from A to B
+    float dv = DotProd(v, mNormal);
+    
+    if (signum(dv) == 0)
+        {
+                if (coplanar) 
+                        (*coplanar) = true;     
+
+                if (t) 
+                        (*t) = 0;
+
+                return a;
+        }
+        
+        if (coplanar) 
+                (*coplanar) = false;
+
+    float u = - Distance(a) / dv; // TODO: could be done more efficiently
+    
+        if (t) 
+                (*t) = u;
+        
+    return a + u * v;
+}
+
+
+int Plane3::Side(const Vector3 &v, const float threshold) const 
+{
+    return signum(Distance(v), threshold);
+}
+
+
+float Plane3::FindT(const Vector3 &a, const Vector3 &b) const 
+{         
+        const Vector3 v = b - a; // line from A to B
+        const float dv = DotProd(v, mNormal);
+    
+        // does not intersect or coincident
+
+        if (signum(dv) == 0)
+                return 0;
+        
+        return - Distance(a) / dv; // TODO: could be done more efficiently
+}