Changeset 3078 for GTP/trunk/App/Demos/Vis/FriendlyCulling/src/MotionPath.cpp

Timestamp:

10/29/08 10:19:11 (16 years ago)

Author:

mattausch

Message:

 

File:

• GTP/trunk/App/Demos/Vis/FriendlyCulling/src/MotionPath.cpp (modified) (5 diffs)

GTP/trunk/App/Demos/Vis/FriendlyCulling/src/MotionPath.cpp

@@ -1 +1 @@
 #include "MotionPath.h"
+#include "Matrix4x4.h"
 
 
@@ -7 +8 @@
 
 MotionPath::MotionPath(const VertexArray &vertices):
-mVertices(vertices), mCurrentVertexIdx(0)
+mVertices(vertices), mCurrentVertexIdx(0), mT(.0f)
 {
 }
@@ -14 +15 @@
 void MotionPath::Move(float velocity)
 {
+        mT += velocity;
+
+        if (mT >= 1.0f)
+        {
+                mCurrentVertexIdx = (mCurrentVertexIdx + 1) % (int)mVertices.size();
+                mT -= 1.0f;
+        }
 }
 
@@ -19 +27 @@
 Vector3 MotionPath::GetCurrentPosition() const
 {
-        return mT * mVertices[mCurrentVertexIdx] + (1.0f - mT) * mVertices[(mCurrentVertexIdx + 1) % mVertices.size()];
+        return (1.0f - mT) * mVertices[mCurrentVertexIdx] + mT * mVertices[(mCurrentVertexIdx + 1) % mVertices.size()];
 }
 
@@ -32 +40 @@
 {
         mCurrentVertexIdx = 0;
+        mT = 0;
+}
+
+
+Matrix4x4 MotionPath::GetOrientation()
+{
+        Vector3 dir = mVertices[(mCurrentVertexIdx + 1) % mVertices.size()] - mVertices[mCurrentVertexIdx];
+        Vector3 ndir = -Normalize(dir);
+
+        float pitch = -atan2(ndir.x, ndir.y);
+        float yaw = atan2(ndir.z, sqrt((ndir.x * ndir.x) + (ndir.y * ndir.y)));
+
+        
+        Matrix4x4 roty = RotationYMatrix(pitch);
+        Matrix4x4 rotx = RotationXMatrix(yaw);
+
+        return roty * rotx;
 }