Changeset 3016 in orxonox.OLD for orxonox/branches/bezierTrack

Timestamp:

Nov 27, 2004, 6:12:42 PM (20 years ago)

Author:

bensch

Message:

orxonox/branches/bezierTrack: now the Track-direction is what it should be, but it looks somehow funny…

File:

• orxonox/branches/bezierTrack/src/vector.cc (modified) (3 diffs)

orxonox/branches/bezierTrack/src/vector.cc

@@ -21 +21 @@
 
 #include "vector.h"
-
+#include <fstream>
 
 using namespace std;
@@ -928 +928 @@
     
     tmpNode = tmpNode->next;
+
     }
   return ret;
@@ -934 +935 @@
 Vector BezierCurve::calcDir (float t)
 {
-  double diff = .00000000001;
-  
-  Vector diffV = ((calcPos(t+diff) - calcPos(t))/diff);
-  diffV.normalize();
-  return diffV;
+  PathNode* tmpNode = firstNode;
+  BezierCurve* tmpCurve = new BezierCurve();
+  Vector ret;
+  Vector tmpVector;
+
+  while (tmpNode->next != 0)
+    {
+      tmpVector = (tmpNode->next->position)- (tmpNode->position);
+      tmpVector.x*=(float)nodeCount;
+      tmpVector.y*=(float)nodeCount;
+      tmpVector.z*=(float)nodeCount;
+
+      tmpCurve->addNode(tmpVector);
+      tmpNode = tmpNode->next;
+    }
+  ret = tmpCurve->calcPos(t);
+  ret.normalize();
+
+  return ret;
 }