Changeset 3376 in orxonox.OLD for orxonox/branches/trackManager/src/track_manager.cc

Timestamp:

Jan 8, 2005, 6:32:39 PM (19 years ago)

Author:

bensch

Message:

orxonox/branches/trackManager: c2-continuity-patch (mathematically correct, but does not look to good.)

File:

• orxonox/branches/trackManager/src/track_manager.cc (modified) (5 diffs)

orxonox/branches/trackManager/src/track_manager.cc

@@ -152 +152 @@
 {
   this->currentTrackElem->childCount = childCount;
+  this->currentTrackElem->mainJoin = true;
   this->currentTrackElem->children = new TrackElement*[childCount];
   for (int i=0; i<childCount; i++)
@@ -159 +160 @@
       this->currentTrackElem->children[i]->startingTime = this->currentTrackElem->endTime;
       this->addPoint(this->currentTrackElem->curve->getNode(this->currentTrackElem->curve->getNodeCount()), this->currentTrackElem->children[i]);
-      this->addPoint((this->currentTrackElem->children[i]->curve->getNode(0) *2) - this->currentTrackElem->curve->getNode(this->currentTrackElem->curve->getNodeCount()-1),  this->currentTrackElem->children[i]);
     }
 }
@@ -380 +380 @@
   TrackElement* firstJoint = this->currentTrackElem;
   Vector tmpEndPoint = firstJoint->curve->getNode(firstJoint->curve->getNodeCount());
-  Vector tmpTangentPoint = firstJoint->curve->getNode(firstJoint->curve->getNodeCount()-1); 
+  Vector tmpTangentPoint = firstJoint->curve->getNode(firstJoint->curve->getNodeCount()-1);
+  Vector tmpc2Point = firstJoint->curve->getNode(firstJoint->curve->getNodeCount()-2);
   firstJoint->isJoined = true;
-  firstJoint->mainJoin = true;
+  //  firstJoint->mainJoin = true;
   if(!firstJoint->isHotPoint)
     this->setSavePoint();
@@ -401 +402 @@
       else
         {
+          this->addPoint(tmpc2Point, tmpJoinElem);
           this->addPoint(tmpTangentPoint, tmpJoinElem);
           this->addPoint(tmpEndPoint, tmpJoinElem);
@@ -421 +423 @@
   this->workOn(tmpCurrentWorkingID);
 }
+
+/**
+   \brief finalizes the TrackSystem. after this it will not be editable anymore
+*/
+void TrackManager::finalize(void)
+{
+  for (int i = 1; i<= trackElemCount ;i++)
+    {
+      TrackElement* tmpElem = findTrackElementByID(i);
+      if (tmpElem->childCount>0 && tmpElem->mainJoin)
+        {
+          for (int j = 0; j < tmpElem->childCount; j++)
+            {
+              
+              // c1-continuity
+              tmpElem->children[j]->curve->addNode(tmpElem->children[j]->curve->getNode(0) +
+                                                   ((tmpElem->children[j]->curve->getNode(0) - 
+                                                    tmpElem->curve->getNode(tmpElem->curve->getNodeCount()-1))
+                                                    ),2);
+              tmpElem->children[j]->nodeCount++;
+              // c2-continuity
+              tmpElem->children[j]->curve->addNode((tmpElem->curve->getNode(tmpElem->curve->getNodeCount())-
+                                                    tmpElem->curve->getNode(tmpElem->curve->getNodeCount()-1)) * 4 +
+                                                   tmpElem->curve->getNode(tmpElem->curve->getNodeCount()-2), 3);
+              tmpElem->children[j]->nodeCount++;                                                    
+              printf("accelerations: %d-in: count: %d, %f, %f, %f\n                  %d-out: count: %d %f, %f, %f\n",
+                     tmpElem->ID, tmpElem->nodeCount,
+                     tmpElem->curve->calcAcc(0.999).x, tmpElem->curve->calcAcc(0.999).y, tmpElem->curve->calcAcc(0.999).z,
+                     tmpElem->children[j]->ID, tmpElem->children[j]->nodeCount,
+                     tmpElem->children[j]->curve->calcAcc(0).x, tmpElem->children[j]->curve->calcAcc(0).y, tmpElem->children[j]->curve->calcAcc(0).z);
+            }
+        }
+    }
+}
+
 
 // RUNTIME //