source: GTP/trunk/App/Games/Jungle_Rumble/src/Vector.cpp @ 1378

#include "dxstdafx.h"
#include ".\vector.h"

Vector::Vector(void) : D3DXVECTOR4(0, 0, 0, 1)
{
}

Vector::Vector(float _x, float _y, float _z) : D3DXVECTOR4(_x, _y, _z, 1)
{
}

Vector::Vector(NxVec3 vec) :  D3DXVECTOR4(vec.x, vec.y, vec.z,1)
{
}

void Vector::normalize()
{
        float thelen = 1/sqrt (x*x + y*y + z*z);

        if (thelen != 0) 
        {
                x *= thelen;
                y *= thelen;
                z *= thelen;
        }
}

float Vector::length()
{
        return sqrt(x*x + y*y + z*z);
}

NxVec3 Vector::getNxVector()
{
        this->nxVector.x = this->x;
        this->nxVector.y = this->y;
        this->nxVector.z = this->z;
        return this->nxVector;
}

void Vector::setNxVector(NxVec3 &nxv) 
{
        //D3DVector aktualisieren
        this->x = nxv.x;
        this->y = nxv.y;
        this->z = nxv.z;
        this->w = 1;
}

D3DXVECTOR3 Vector::getD3DXVector3()
{
        D3DXVECTOR3 temp(this->x, this->y, this->z);
        return temp;
}

NxQuat Vector::getNxQuatRotation()
{
        NxQuat q;

        float _x, _y, _z,cr, cp, cy, sr, sp, sy, cpcy, spsy;

        _x = this->x/2;
        _y = this->y/2;
        _z = this->z/2;

        cr = cos(_x);
        cp = cos(_y);
        cy = cos(_z);

        sr = sin(_x);
        sp = sin(_y);
        sy = sin(_z);

        cpcy = cp * cy;
        spsy = sp * sy;
        
        q.setx(sr * cpcy - cr * spsy);
        q.sety(cr * sp * cy + sr * cp * sy);
        q.setz(cr * cp * sy - sr * sp * cy);
        q.setw(cr * cpcy + sr * spsy);

        return q;
}

Vector Vector::crossProd(Vector &v2) 
{
        Vector v(y*v2.z-z*v2.y, z*v2.x-x*v2.z, x*v2.y-y*v2.x);
        return v;
}

float Vector::dotProd(Vector &v2)  {
        float ret = x*v2.x + y*v2.y + z*v2.z;
        return ret;
}

// assignment operators
Vector Vector::operator += ( CONST Vector& v)
{
        D3DXVECTOR4 tmpv = (D3DXVECTOR4) (*this)+v;
        Vector retv(tmpv.x, tmpv.y, tmpv.z);
        return retv;
}

Vector Vector::operator -= ( CONST Vector& v)
{
        D3DXVECTOR4 tmpv = (D3DXVECTOR4) (*this)-v;
        Vector retv(tmpv.x, tmpv.y, tmpv.z);
        return retv;
}

Vector Vector::operator *= ( float a)
{
        D3DXVECTOR4 tmpv = (D3DXVECTOR4) (*this)*a;
        Vector retv(tmpv.x, tmpv.y, tmpv.z);
        return retv;
}

Vector Vector::operator /= ( float a)
{
        D3DXVECTOR4 tmpv = (D3DXVECTOR4) (*this)/a;
        Vector retv(tmpv.x, tmpv.y, tmpv.z);
        return retv;
}

// binary operators
Vector Vector::operator + ( CONST Vector& v) const
{
        Vector retv(this->x+v.x, this->y+v.y, this->z+v.z);
        return retv;
}

Vector Vector::operator - ( CONST Vector& v) const
{
        Vector retv(this->x-v.x, this->y-v.y, this->z-v.z);
        return retv;
}

Vector Vector::operator * ( float a) const
{
        Vector retv(this->x*a, this->y*a, this->z*a);
        return retv;
}

Vector Vector::operator / ( float a) const
{
        Vector retv(this->x/a, this->y/a, this->z/a);
        return retv;
}

void Vector::applyD3DXVector(D3DXVECTOR4 *v) {
        this->x = v->x;
        this->y = v->y;
        this->z = v->z;
        this->w = v->w;
}

void Vector::setXYZ(float _x, float _y, float _z)
{
        this->x = _x;
        this->y = _y;
        this->z = _z;
        this->w = 1;
}

void Vector::addXYZ(float _x, float _y, float _z)
{
        this->x += _x;
        this->y += _y;
        this->z += _z;
}