Init

exchange/exchangesource/Collision/visitor/A3DVector.h

@@ -0,0 +1,121 @@
+#ifndef A3DVECTOR_H
+#define A3DVECTOR_H
+
+#include <math.h>
+#include <A3DSDK.h>
+#include <A3DSDKTypes.h>
+#include <A3DSDKErrorCodes.h>
+#include <A3DSDKBase.h>
+#include <A3DSDKRootEntities.h>
+#include <A3DSDKGeometry.h>
+
+class A3DVector3d
+{
+public:
+	double x; 
+	double y;
+	double z;
+
+	A3DVector3d() {}
+	A3DVector3d(double dX, double dY, double dZ) : x(dX), y(dY), z(dZ) {}
+	A3DVector3d(const A3DVector3dData& sV) : x(sV.m_dX), y(sV.m_dY), z(sV.m_dZ) {} 
+	inline void set(double dX, double dY, double dZ)
+	{	 x = dX; y = dY; z = dZ; }
+	
+	A3DVector3d(const A3DVector3d& toCopy) : x(toCopy.x), y(toCopy.y), z(toCopy.z) {}
+	
+	inline double Length() const { return sqrt(x*x + y*y + z*z); }
+
+	inline double LenghtSquared() const{ return x*x + y*y + z*z; }	
+
+	inline A3DStatus normalize()
+	{
+		double d = this->Length();
+		if(d == 0)
+			return A3D_ERROR;
+		x/=d;
+		y/=d;
+		z/=d;
+		return A3D_SUCCESS;
+	}
+
+	inline double Distance(const A3DVector3d& sOther) const 
+	{
+		return sqrt(this->SquareDistance(sOther));
+	}
+
+	inline double SquareDistance(const A3DVector3d& sOther) const
+	{
+		double d=0,dd;
+		dd = x; dd -= sOther.x; dd *= dd; d += dd;
+		dd = y; dd -= sOther.y; dd *= dd; d += dd;
+		dd = z; dd -= sOther.z; dd *= dd; d += dd;
+		return d;
+	}
+
+	inline double Dot(const A3DVector3d& sOther) const
+	{
+		return x*sOther.x + y*sOther.y + z*sOther.z;
+	}
+
+	inline A3DVector3d Cross(const A3DVector3d& sOther)
+	{
+		return A3DVector3d(y*sOther.z - z*sOther.y, z*sOther.x - x*sOther.z, x*sOther.y - y*sOther.x);
+	}
+
+
+	// in-place vector algebra
+	inline A3DVector3d& operator += ( const A3DVector3d& sOther )
+	{
+		x+=sOther.x;
+		y+=sOther.y;
+		z+=sOther.z;
+		return *this;
+	}
+
+	inline A3DVector3d& operator -= ( const A3DVector3d& sOther )
+	{
+		x-=sOther.x;
+		y-=sOther.y;
+		z-=sOther.z;
+		return *this;
+	}
+
+	inline A3DVector3d operator + ( const A3DVector3d& sOther ) const
+	{
+		return A3DVector3d(x+sOther.x, y+sOther.y, z+sOther.z);
+	}
+
+	inline A3DVector3d operator - ( const A3DVector3d& sOther ) const
+	{
+	   return A3DVector3d(x-sOther.x, y-sOther.y, z-sOther.z);
+	}
+
+	inline A3DVector3d& operator *= ( double dValue )
+	{	
+		x*=dValue;
+		y*=dValue;
+		z*=dValue;
+		return *this;
+	}
+
+	inline A3DVector3d& operator /= ( double dValue )
+	{
+		x/=dValue;
+		y/=dValue;
+		z/=dValue;
+		return *this;
+	}
+
+	inline A3DVector3d operator * ( double dValue ) const
+	{
+		return	A3DVector3d(x*dValue, y*dValue, z*dValue);
+	}
+
+	inline A3DVector3d operator / ( double dValue ) const
+	{
+		 return A3DVector3d(x/dValue, y/dValue, z/dValue);
+	}
+};
+
+#endif