Changeset 3355 in orxonox.OLD for orxonox/branches/parenting/src/curve.cc

Timestamp:

Jan 6, 2005, 1:52:47 PM (19 years ago)

Author:

bensch

Message:

orxonox/branches/parenting: :Curve: bezierCurve now can have 0,1,2,3 points. instead of only more than 3

File:

• orxonox/branches/parenting/src/curve.cc (modified) (1 diff)

orxonox/branches/parenting/src/curve.cc

@@ -164 +164 @@
    \param t The position on the Curve (0<=t<=1)
    \return the Position on the Path
-   \todo implement nodeCount 0,1,2,3
 */
 Vector BezierCurve::calcPos(float t) 
 {
-  if (nodeCount < 4)
-    {
-      //    if (verbose >= 1)
-      //      printf ("Please define at least 4 nodes, until now you have only defined %i.\n", nodeCount);
-      return Vector(0,0,0);
-    }
-  PathNode* tmpNode = firstNode;
   Vector ret = Vector(0.0,0.0,0.0);
-  double factor = pow(1.0-t,nodeCount-1);
-  while(tmpNode)
-    {
-      ret.x += tmpNode->factor * factor * tmpNode->position.x;
-      ret.y += tmpNode->factor * factor * tmpNode->position.y;
-      ret.z += tmpNode->factor * factor * tmpNode->position.z;
-      factor *= t/(1.0-t); // same as pow but much faster.
-
-      tmpNode = tmpNode->next;
-    }
+  if (this->nodeCount >= 3)
+    {
+      PathNode* tmpNode = this->firstNode;
+      double factor = pow(1.0-t,nodeCount-1);
+      while(tmpNode)
+        {
+          ret.x += tmpNode->factor * factor * tmpNode->position.x;
+          ret.y += tmpNode->factor * factor * tmpNode->position.y;
+          ret.z += tmpNode->factor * factor * tmpNode->position.z;
+          factor *= t/(1.0-t); // same as pow but much faster.
+          
+          tmpNode = tmpNode->next;
+        }
+    }
+  else if (nodeCount == 2)
+    {
+      ret = this->firstNode->position *(1.0-t);
+      ret = ret + this->firstNode->next->position * t;
+    }
+  else if (nodeCount == 1)
+    ret = this->firstNode->position;
   return ret;
 }