VecMath.hpp

/*
 *
 * Copyright (C) 2003 Fabien Chereau
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 *
 * This program 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 General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Suite 500, Boston, MA  02110-1335, USA.
 */

// Template vector and matrix library.
// Use column-major matrices, and in vectors, order vertices like this:
// x, y, z, w (or r, g, b, a), so they can be passed to Renderer.

#ifndef _VECMATH_H_
#define _VECMATH_H_

#include <cmath>
#include <QString>

template<class T> class Vector2;
template<class T> class Vector3;
template<class T> class Vector4;
template<class T> class Matrix4;

typedef Vector2<double> Vec2d;
typedef Vector2<float>  Vec2f;
typedef Vector2<int>    Vec2i;

typedef Vector3<double> Vec3d;

typedef Vector3<float>  Vec3f;

typedef Vector4<double> Vec4d;

typedef Vector4<float>  Vec4f;

typedef Vector4<int>    Vec4i;

typedef Matrix4<double> Mat4d;

typedef Matrix4<float>  Mat4f;


template<class T> class Vector2
{
public:
    inline Vector2();
    inline Vector2(T, T);

    inline Vector2& operator=(const T*);
    inline void set(T, T);

    inline bool operator==(const Vector2<T>&) const;
    inline bool operator!=(const Vector2<T>&) const;

    inline const T& operator[](int x) const;
    inline T& operator[](int);
    inline operator const T*() const;
    inline operator T*();

    inline void operator+=(const Vector2<T>&);
    inline void operator-=(const Vector2<T>&);
    inline void operator*=(T);
    inline void operator/=(T);

    inline Vector2 operator-(const Vector2<T>&) const;
    inline Vector2 operator+(const Vector2<T>&) const;

    inline Vector2 operator-() const;
    inline Vector2 operator+() const;

    inline Vector2 operator*(T) const;
    inline Vector2 operator/(T) const;


    inline T dot(const Vector2<T>&) const;

    inline T length() const;
    inline T lengthSquared() const;
    inline void normalize();

    T v[2];
};


template<class T> class Vector3
{
public:
    inline Vector3();
    //inline Vector3(const Vector3&);
    //template <class T2> inline Vector3(const Vector3<T2>&);
    inline Vector3(T, T, T);
    inline Vector3(T);

    //inline Vector3& operator=(const Vector3&);
    inline Vector3& operator=(const T*);
    //template <class T2> inline Vector3& operator=(const Vector3<T2>&);
    inline void set(T, T, T);

    inline bool operator==(const Vector3<T>&) const;
    inline bool operator!=(const Vector3<T>&) const;

    inline T& operator[](int);
    inline const T& operator[](int) const;
    inline operator const T*() const;
    inline operator T*();
    inline const T* data() const {return v;}
    inline T* data() {return v;}

    inline void operator+=(const Vector3<T>&);
    inline void operator-=(const Vector3<T>&);
    inline void operator*=(T);
    inline void operator/=(T);

    inline Vector3 operator-(const Vector3<T>&) const;
    inline Vector3 operator+(const Vector3<T>&) const;

    inline Vector3 operator-() const;
    inline Vector3 operator+() const;

    inline Vector3 operator*(T) const;
    inline Vector3 operator/(T) const;


    inline T dot(const Vector3<T>&) const;
    inline Vector3 operator^(const Vector3<T>&) const;

    // Return latitude in rad
    inline T latitude() const;
    // Return longitude in rad
    inline T longitude() const;

    // Distance in radian between two
    inline T angle(const Vector3<T>&) const;
    inline T angleNormalized(const Vector3<T>&) const;

    inline T length() const;
    inline T lengthSquared() const;
    inline void normalize();

    inline void transfo4d(const Mat4d&);
    inline void transfo4d(const Mat4f&);
    T v[3];     // The 3 values

    QString toString() const {return QString("[%1, %2, %3]").arg(v[0]).arg(v[1]).arg(v[2]);}
    QString toStringLonLat() const {return QString("[") + QString::number(longitude()*180./M_PI, 'g', 12) + "," + QString::number(latitude()*180./M_PI, 'g', 12)+"]";}
};


template<class T> class Vector4