Changeset 3375 in orxonox.OLD for orxonox/branches/trackManager/src/curve.cc

Timestamp:

Jan 8, 2005, 4:00:29 PM (20 years ago)

Author:

bensch

Message:

orxonox/branches/trackManager: now curve-points can be inserted wherever you want.

File:

• orxonox/branches/trackManager/src/curve.cc (modified) (2 diffs)

orxonox/branches/trackManager/src/curve.cc

@@ -40 +40 @@
     }
   currentNode->position = newNode;
-  currentNode->next = 0; // not sure if this really points to NULL!!
+  currentNode->next = 0;
   currentNode->number = (++nodeCount);
+  this->rebuild();
+  return;
+}
+
+void Curve::addNode(const Vector& newNode, unsigned int insertPosition)
+{
+
+  if (this->nodeCount == 0 || insertPosition > this->nodeCount)
+    return addNode(newNode);
+
+  if (insertPosition == 0)
+    insertPosition = 1;
+
+  PathNode* insNode = new PathNode;
+
+  // relinking
+  PathNode* tmpNode = this->firstNode;
+  if (insertPosition > 1)
+    {
+      while (tmpNode->next->number != insertPosition)
+        tmpNode= tmpNode->next;
+      insNode->next = tmpNode->next;
+      tmpNode->next = insNode;
+    }
+  else
+    {
+      insNode->next = this->firstNode;
+      this->firstNode = insNode;
+    }
+  // renumbering
+  insNode->number = insertPosition;
+  tmpNode = insNode->next;
+  while (tmpNode)
+    {
+      tmpNode->number++;
+      tmpNode = tmpNode->next;
+    }
+
+    // finished
+  insNode->position = newNode;
+  ++nodeCount;
   this->rebuild();
   return;
@@ -60 +101 @@
   return tmpNode->position;
 }
+
+/**
+   \brief Outputs information about the state of this Curve
+*/
+void Curve::debug(void)
+{
+  printf("<<-------------------------------\n");
+  printf("Curve Information:\n");
+  printf("NodeCount: %d\n", this->nodeCount);
+  PathNode* tmpNode = this->firstNode;
+  while (tmpNode)
+    {
+      printf("node #%d: %f, %f, %f\n", tmpNode->number, tmpNode->position.x, tmpNode->position.y, tmpNode->position.z);
+      tmpNode = tmpNode->next;
+    }
+  printf("------------------------------->>\n");
+}
+
 
 ///////////////////////////////////