Initial commit

Torque/SDK/lib/dtsSDKPlus/DTSUtil.h

@@ -0,0 +1,140 @@
+//-----------------------------------------------------------------------------
+// Torque Game Engine 
+// Copyright (C) GarageGames.com, Inc.
+//-----------------------------------------------------------------------------
+
+#ifndef DTSUTIL_H_
+#define DTSUTIL_H_
+
+#include "DTSTypes.h"
+#include "DTSShape.h"
+#include "DTSPlusTypes.h"
+#include "appNode.h"
+
+namespace DTS
+{
+#ifndef M_PI
+   const F64 M_PI = 3.14159265358979323846;
+#endif
+   const char PATH_DELIM_CHAR = '\\';
+   const char PATH_DELIM_STR[] = "\\";
+
+   template <class T> inline const T & getmax(const T & t1, const T & t2) {  return t1>t2 ? t1 : t2; }
+
+   // don't like std:vector insert/erase...
+
+   template <class T>
+   inline void delElement(std::vector<T> & vec, S32 idx)
+   {
+      std::vector<T>::iterator itr = (std::vector<T>::iterator)&vec[idx];
+      vec.erase(itr);
+   }
+   template <class T>
+   inline void insElement(std::vector<T> & vec, S32 idx, const T & el) 
+   {
+      std::vector<T>::iterator itr = (std::vector<T>::iterator)&vec[idx];
+      vec.insert(itr,el);
+   }
+
+   // add a method that Torque vectors has but std::vectors don't
+   template <class T>
+   inline void appendVector(std::vector<T> & m1, const std::vector<T> & m2) { m1.insert(m1.end(),m2.begin(),m2.end()); }
+
+   inline bool isZero(F32 f, F32 tol) { return fabs(f)<tol; }
+   inline bool isZero(const Point2D & a, F32 tol) { return isZero(a.x(),tol) && isZero(a.y(),tol); }
+   inline bool isZero(const Point3D & a, F32 tol) { return isZero(a.x(),tol) && isZero(a.y(),tol) && isZero(a.z(),tol); }
+   inline bool isZero(const Quaternion & a, F32 tol) { return isZero(a.x(),tol) && isZero(a.y(),tol) && isZero(a.z(),tol) && isZero(a.w(),tol); }
+   inline bool isEqual(F32 a, F32 b, F32 tol) { return isZero(a-b,tol); }
+   inline bool isEqual(const Point2D & a, const Point2D & b, F32 tol) { return isZero(a-b,tol); }
+   inline bool isEqual(const Point3D & a, const Point3D & b, F32 tol) { return isZero(a-b,tol); }
+   inline bool isEqual(const Quaternion & a, const Quaternion & b, F32 tol) { return isZero(a-b,tol); }
+   extern bool isEqualQ16(const Quaternion & a, const Quaternion &b);
+
+   inline F32 dotProduct(const Point3D & a, const Point3D & b) { return a.x() * b.x() + a.y() * b.y() + a.z() * b.z(); }
+   extern void crossProduct(const Point3D & a, const Point3D & b, Point3D * c);
+
+   template <class T>
+   inline T* constructInPlace(T* p)
+   {
+      return new(p) T;
+   }
+
+   template <class T>
+   inline void destructInPlace(T* p)
+   {
+      p->~T();
+   }
+
+	struct AffineParts
+	{
+      Point3D trans;       // Translation components
+      Quaternion rot;      // Essential rotation
+      Quaternion scaleRot; // Stretch rotation
+      Point3D scale;       // Stretch factors
+      F32 sign;            // Sign of determinant
+	};
+
+   extern void decomp_affine(const Matrix<4,4,F32> &, AffineParts *);
+   extern void zapScale(Matrix<4,4,F32> &);
+
+   extern void getLocalNodeTransform(AppNode * node, AppNode * parent, AffineParts & child0, AffineParts & parent0, const AppTime & time, Quaternion & rot, Point3D & trans, Quaternion & srot, Point3D & scale);
+   extern void getBlendNodeTransform(AppNode * node, AppNode * parent, AffineParts & child0, AffineParts & parent0, const AppTime & time, const AppTime & referenceTime, Quaternion & rot, Point3D & trans, Quaternion & srot, Point3D & scale);
+   extern void getDeltaTransform(AppNode * node, const AppTime & time1, const AppTime & time2, Quaternion & rot, Point3D & trans, Quaternion & srot, Point3D & scale);
+
+   inline void setMembershipArray(std::vector<bool> & m, bool setTo, S32 a, S32 b)
+   {
+      if (m.size()<b)
+         m.resize(b);
+      for (S32 i=a; i<b; i++)
+         m[i]=setTo;
+   }
+
+   inline void setMembershipArray(std::vector<bool> & m, bool setTo, S32 a) 
+   {
+      m[a]=setTo;
+   }
+
+   inline bool allSet(std::vector<bool> & m)
+   {
+      for (S32 i=0; i<m.size(); i++)
+      {
+         if (!m[i]) return false;
+      }
+      return true;
+   }
+
+   inline void overlapSet(std::vector<bool> & m1, const std::vector<bool> & m2)
+   {
+      assert(m1.size()==m2.size());
+      for (S32 i=0; i<m2.size(); i++)
+      {
+         if (m2[i])
+            m1[i]=true;
+      }
+   }
+
+   inline void subtractSet(std::vector<bool> & m1, const std::vector<bool> & m2)
+   {
+      assert(m1.size()==m2.size());
+      for (S32 i=0; i<m2.size(); i++)
+      {
+         if (m2[i])
+            m1[i]=false;
+      }
+   }
+
+   extern S32 getTrailingNumber(const char * fullName);
+   extern char * chopTrailingNumber(const char * fullName, S32 & size);
+   extern void tweakName(const char ** name);
+   extern const char* avar(const char *in_msg, ...);
+   extern bool stringEqual(const char * s1, const char * s2);
+   inline char * strnew(const char * str) { char * ret = new char[strlen(str)+1]; strcpy(ret,str); return ret; }
+   extern char * getFileBase(char * str);
+   extern const char * getFileBase(const char * str);
+   extern char * getFilePath(const char * str, S32 pad=0);
+
+   inline char * strnew(std::string str) { return strnew(str.c_str()); }
+};
+
+#endif // DTSUTIL_H_
+