Changeset 3644 in orxonox.OLD for orxonox/trunk/src/lib/coord

Timestamp:

Mar 23, 2005, 2:32:06 PM (20 years ago)

Author:

patrick

Message:

orxonox/trunk: pnode speed function implemented

Location:

orxonox/trunk/src/lib/coord

Files:

• null_parent.cc (modified) (2 diffs)
• null_parent.h (modified) (1 diff)
• p_node.cc (modified) (4 diffs)
• p_node.h (modified) (4 diffs)

orxonox/trunk/src/lib/coord/null_parent.cc

@@ -77 +77 @@
    worry, normaly...
 */
-void NullParent::update ()
+void NullParent::update (float dt)
 {
 
@@ -92 +92 @@
       if( this->bRelDirChanged || this->bAbsDirChanged)
         pn->parentDirChanged ();
-      pn->update ();
+      pn->update (dt);
       pn = this->children->nextElement ();
     }

orxonox/trunk/src/lib/coord/null_parent.h

@@ -19 +19 @@
 
 
-  virtual void update ();
-
+  virtual void update (float dt);
+  
  private:
   NullParent ();

orxonox/trunk/src/lib/coord/p_node.cc

@@ -115 +115 @@
   this->absDirection = new Quaternion();
   this->relDirection = new Quaternion();
+  this->lastAbsCoordinate = new Vector();
 }
 
@@ -297 +298 @@
 {}
 
+
+/**
+   \brief this calculates the current movement speed of the node
+*/
+float PNode::getSpeed()
+{
+  if(this->time == 0)
+    return 0;
+  Vector* diff = new Vector();
+  *diff = *this->absCoordinate - *this->lastAbsCoordinate;
+  float x = diff->len();
+  return x / this->time;
+}
+
+
 /**
    \brief adds a child and makes this node to a parent
@@ -422 +438 @@
    worry, normaly...
 */
-void PNode::update ()
-{
+void PNode::update (float dt)
+{
+  this->time = dt;
   PRINTF(4)("PNode::update - %s - (%f, %f, %f)\n", this->objectName, this->absCoordinate->x, this->absCoordinate->y, this->absCoordinate->z);
   // printf("%s", this->objectName);
@@ -486 +503 @@
         pn->parentDirChanged ();
 
-      pn->update();
+      pn->update(dt);
       pn = this->children->nextElement();
     }

orxonox/trunk/src/lib/coord/p_node.h

@@ -72 +72 @@
   void shiftDir (Quaternion* shift);
 
+  float getSpeed();
+
   void addChild (PNode* pNode);
   void addChild (PNode* pNode, int parentingMode);
@@ -84 +86 @@
   int getMode();
 
-  virtual void update ();
+  virtual void update (float dt);
   void processTick (float dt);
 
@@ -92 +94 @@
 
   void debug ();
-
- private:
-  void init(PNode* parent);
 
  protected:
@@ -111 +110 @@
   int mode;                //!< the mode of the binding
 
+ private:
+  void init(PNode* parent);
+
+  Vector* lastAbsCoordinate; //!< this is used for speedcalculation, it stores the last coordinate
+  float time;                //!< time since last update
 };