Public API Reference

csgeom/vector4.h

Go to the documentation of this file.

/*
    Copyright (C) 1998,1999,2000 by Jorrit Tyberghein
    Largely rewritten by Ivan Avramovic <[email protected]>
    Extended (and some methods removed) to 4 component by Marten Svanfeldt
    Templatized by Frank Richter

    This library is free software; you can redistribute it and/or
    modify it under the terms of the GNU Library General Public
    License as published by the Free Software Foundation; either
    version 2 of the License, or (at your option) any later version.

    This library is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
    Library General Public License for more details.

    You should have received a copy of the GNU Library General Public
    License along with this library; if not, write to the Free
    Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/

#ifndef __CS_VECTOR4_H__
#define __CS_VECTOR4_H__

#include "csextern.h"
#include "csgeom/vector3.h"
#include "csutil/csstring.h"

template<typename T>
class csVector4T
{
public:
#if !defined(__STRICT_ANSI__) && !defined(SWIG)
  union
  {
    struct 
    {
#endif
      T x;
      T y;
      T z;
      T w;
#if !defined(__STRICT_ANSI__) && !defined(SWIG)
    };
    T m[4];
  };
#endif
  /* Note: Since T is used in an union above it have to be an aggregate
   * type (C++ Std 8.5.1).
   * This implies that T cannot have custom constructor, base classes,
   * or virtual functions. This applies to all of Ts members recursivly.
   */
  
  csVector4T () {}

  csVector4T (const T& m) : x(m), y(m), z(m), w(m) {}

  csVector4T (const T& ix, const T& iy, const T& iz = T(0), 
    const T& iw = T(1))
        : x(ix), y(iy), z(iz), w(iw) {}

  csVector4T (const csVector4T& v) : x(v.x), y(v.y), z(v.z), w(v.w) {}

  csVector4T (const csVector3 &v) : x(v.x), y(v.y), z(v.z), w(1.0f) {}

  template<typename T2>
  csVector4T& operator= (const csVector4T<T2>& other)
  {
    x = other.x;
    y = other.y;
    z = other.z;
    w = other.w;
    return *this;
  }

  csString Description() const
  { 
    csString str;
    str << x << "," << y << "," << z << "," << w;
    return str;
  }
    
  inline friend csVector4T operator+ (const csVector4T& v1, 
    const csVector4T& v2)
  { return csVector4T(v1.x+v2.x, v1.y+v2.y, v1.z+v2.z, v1.w+v2.w); }

  inline friend csVector4T operator- (const csVector4T& v1, 
    const csVector4T& v2)
  { return csVector4T(v1.x-v2.x, v1.y-v2.y, v1.z-v2.z, v1.w-v2.w); }


  inline friend float operator* (const csVector4T& v1, 
    const csVector4T& v2)
  { return v1.x*v2.x + v1.y*v2.y + v1.z*v2.z + v1.w*v2.w; }

  inline friend csVector4T operator% (const csVector4T& v1, 
    const csVector4T& v2)
  {
    return csVector4T<T> (
      (v1.x*v2.y-v1.y*v2.x) + (v1.x*v2.z-v1.z*v2.x) + (v1.y*v2.z-v1.z*v2.y),
      (v1.z*v2.y-v1.y*v2.z) + (v1.y*v2.w-v1.w*v2.y) + (v1.z*v2.w-v1.w*v2.z),
      (v1.x*v2.z-v1.z*v2.x) + (v1.w*v2.x-v1.x*v2.w) + (v1.z*v2.w-v1.w*v2.z),
      (v1.y*v2.x-v1.x*v2.y) + (v1.w*v2.x-v1.x*v2.w) + (v1.w*v2.y-v1.y*v2.w) );
  }

  void Cross (const csVector4T & v1, const csVector4T & v2)
  {
    x = (v1.x*v2.y-v1.y*v2.x) + (v1.x*v2.z-v1.z*v2.x) + (v1.y*v2.z-v1.z*v2.y);
    y = (v1.z*v2.y-v1.y*v2.z) + (v1.y*v2.w-v1.w*v2.y) + (v1.z*v2.w-v1.w*v2.z);
    z = (v1.x*v2.z-v1.z*v2.x) + (v1.w*v2.x-v1.x*v2.w) + (v1.z*v2.w-v1.w*v2.z);
    w = (v1.y*v2.x-v1.x*v2.y) + (v1.w*v2.x-v1.x*v2.w) + (v1.w*v2.y-v1.y*v2.w);
  }

  inline friend csVector4T operator* (const csVector4T& v, T f)
  { return csVector4T(v.x*f, v.y*f, v.z*f, v.w*f); }

  inline friend csVector4T operator* (float f, const csVector4T& v)
  { return csVector4T(v.x*f, v.y*f, v.z*f, v.w*f); }

  inline friend csVector4T operator* (const csVector4T& v, int f)
  { T _f = f; return v * _f; }

  inline friend csVector4T operator* (int f, const csVector4T& v)
  { T _f = f; return v * _f; }

  inline friend csVector4T operator/ (const csVector4T& v, T f)
  { f = 1.0f/f; return csVector4T(v.x*f, v.y*f, v.z*f, v.w*f); }

  inline friend csVector4T operator/ (const csVector4T& v, int f)
  { T _f = f; return v / _f; }

  inline friend bool operator== (const csVector4T& v1, const csVector4T& v2)
  { return v1.x==v2.x && v1.y==v2.y && v1.z==v2.z && v1.w==v2.w; }

  inline friend bool operator!= (const csVector4T& v1, const csVector4T& v2)
  { return v1.x!=v2.x || v1.y!=v2.y || v1.z!=v2.z || v1.w!=v2.w; }

  inline friend csVector4T operator>> (const csVector4T& v1, const csVector4T& v2)
  { return v2*(v1*v2)/(v2*v2); }

  inline friend csVector4T operator<< (const csVector4T& v1, const csVector4T& v2)
  { return v1*(v1*v2)/(v1*v1); }

  inline friend bool operator< (const csVector4T& v, float f)
  { return ABS(v.x)<f && ABS(v.y)<f && ABS(v.z)<f && ABS(v.w)<f; }

  inline friend bool operator> (float f, const csVector4T& v)
  { return ABS(v.x)<f && ABS(v.y)<f && ABS(v.z)<f && ABS(v.w)<f; }

#ifdef __STRICT_ANSI__
  inline float operator[] (size_t n) const 
  { return (n&2)?((n&1)?w:z):((n&1)?y:x); }
#else
  inline float operator[] (size_t n) const { return m[n]; }
#endif

#ifdef __STRICT_ANSI__
  inline float & operator[] (size_t n) 
  { return (n&2)?((n&1)?w:z):((n&1)?y:x); }
#else
  inline float & operator[] (size_t n) { return m[n]; }
#endif

  inline csVector4T& operator+= (const csVector4T& v)
  {
    x += v.x;
    y += v.y;
    z += v.z;
    w += v.w;

    return *this;
  }

  inline csVector4T& operator-= (const csVector4T& v)
  {
    x -= v.x;
    y -= v.y;
    z -= v.z;
    w -= v.w;

    return *this;
  }

  inline csVector4T& operator*= (T f)
  { x *= f; y *= f; z *= f; w *= f; return *this; }

  inline csVector4T& operator/= (T f)
  { f = 1.0f / f; x *= f; y *= f; z *= f; w *= f; return *this; }

  inline csVector4T operator+ () const { return *this; }

  inline csVector4T operator- () const { return csVector4(-x,-y,-z, -w); }

  inline void Set (T sx, T sy, T sz, T sw)
  { x = sx; y = sy; z = sz; w = sw; }

  inline void Set (csVector4T const& v) { x = v.x; y = v.y; z = v.z; w = v.w; }

  inline void Set (T const* v) { x = v[0]; y = v[1]; z = v[2]; w = v[3]; }

  inline void Set (T v) { x = y = z = w = v; }

  inline void Get (T* v) { v[0] = x; v[1] = y; v[2] = z; v[3] = w; }

  T Norm () const { return sqrtf (x * x + y * y + z * z + w * w); }

  T SquaredNorm () const
  { return x * x + y * y + z * z + w * w; }

  csVector4T Unit () const { return (*this)/(this->Norm()); }

  inline static T Norm (const csVector4T& v) { return v.Norm(); }

  inline static csVector4T Unit (const csVector4T& v) { return v.Unit(); }

  void Normalize ()
  {
    T sqlen = x * x + y * y + z * z + w * w;
    if (sqlen < SMALL_EPSILON) return ;
  
    T invlen = csQisqrt (sqlen);
    *this *= invlen;
  }


  inline bool IsZero (T precision = SMALL_EPSILON) const
  { return (ABS(x) < precision) && (ABS(y) < precision)
            && (ABS(z) < precision) &&  (ABS(w) < precision);
  }
};

class csVector4 : public csVector4T<float>
{
public:
  csVector4 () {}

  csVector4 (const float& m) : csVector4T<float> (m) {}

  csVector4 (float ix, float iy, float iz = 0, float iw = 1)
        : csVector4T<float> (ix, iy, iz, iw) {}

  csVector4 (const csVector4& v) : csVector4T<float> (v) {}

  csVector4 (const csVector4T<float>& v) : csVector4T<float> (v) {}

  csVector4 (const csVector3 &v) : 
    csVector4T<float> (v.x, v.y, v.z, 1.0f) {}

  csVector4& operator= (const csVector4T<float>& other)
  {
    Set (other.x, other.y, other.z, other.w);
    return *this;
  }

  csVector4& operator= (const csVector3& other)
  {
    Set (other.x, other.y, other.z, 1.0f);
    return *this;
  }
};

#endif // __CS_VECTOR3_H__

---