572 lines
14 KiB
C++
572 lines
14 KiB
C++
#ifndef MATRIX4_H__
|
|
#define MATRIX4_H__
|
|
|
|
#include <ostream>
|
|
#include <sstream>
|
|
#include <string>
|
|
|
|
#include "define.h"
|
|
#include "../SQCSim-common/vector3.h"
|
|
|
|
#ifndef M_PI
|
|
#define M_PI 3.14159265f
|
|
#endif
|
|
|
|
#define DEGTORAD(x) ((x * M_PI) / 180.f)
|
|
#define RADTODEG(x) ((180.f * x) / M_PI)
|
|
|
|
template <class T>
|
|
class Matrix4
|
|
{
|
|
public:
|
|
typedef T Type;
|
|
|
|
public:
|
|
static const Matrix4<T> ZERO;
|
|
static const Matrix4<T> IDENTITY;
|
|
|
|
public:
|
|
Matrix4();
|
|
Matrix4(const T& v);
|
|
Matrix4(const Matrix4<T>& m);
|
|
Matrix4(const T& m_11, const T& m_12, const T& m_13, const T& m_14,
|
|
const T& m_21, const T& m_22, const T& m_23, const T& m_24,
|
|
const T& m_31, const T& m_32, const T& m_33, const T& m_34,
|
|
const T& m_41, const T& m_42, const T& m_43, const T& m_44);
|
|
|
|
const T& Get11() const;
|
|
const T& Get12() const;
|
|
const T& Get13() const;
|
|
const T& Get14() const;
|
|
const T& Get21() const;
|
|
const T& Get22() const;
|
|
const T& Get23() const;
|
|
const T& Get24() const;
|
|
const T& Get31() const;
|
|
const T& Get32() const;
|
|
const T& Get33() const;
|
|
const T& Get34() const;
|
|
const T& Get41() const;
|
|
const T& Get42() const;
|
|
const T& Get43() const;
|
|
const T& Get44() const;
|
|
|
|
Matrix4<T>& operator=(const Matrix4<T>& m);
|
|
|
|
Matrix4<T> operator+(const Matrix4<T>& m) const;
|
|
const Matrix4<T>& operator+=(const Matrix4<T>& m);
|
|
|
|
Matrix4<T> operator-(const Matrix4<T>& m) const;
|
|
Matrix4<T> operator-() const;
|
|
const Matrix4<T>& operator-=(const Matrix4<T>& m);
|
|
|
|
Matrix4<T> operator*(const Matrix4<T>& m) const;
|
|
Matrix4<T> operator*(const T& v) const;
|
|
const Matrix4<T>& operator*=(const Matrix4<T>& m);
|
|
const Matrix4<T>& operator*=(const T& v);
|
|
|
|
Matrix4<T> operator/(const T& v) const;
|
|
const Matrix4<T>& operator/=(const T& v);
|
|
|
|
bool operator==(const Matrix4<T>& m) const;
|
|
bool operator!=(const Matrix4<T>& m) const;
|
|
|
|
void SetZero();
|
|
void SetIdentity();
|
|
void SetPerspectiveProjection(const T& fov, const T& aspect, const T& nearPlane, const T& farPlane);
|
|
void SetOrthographicProjection(const T& left, const T& right, const T& bottom, const T& top, const T& nearPlane, const T& farPlane);
|
|
|
|
void SetLookAt(const Vector3<T>& eyePosition, const Vector3<T>& lookAtPosition, Vector3<T> upVector = Vector3<T>(T(0), T(1), T(0)));
|
|
|
|
bool IsZero() const;
|
|
bool IsIdentity() const;
|
|
|
|
void ApplyTranslation(const T& x, const T& y, const T& z);
|
|
void ApplyRotation(const T& angle, const T& x, const T& y, const T& z);
|
|
void ApplyScale(const T& x, const T& y, const T& z);
|
|
|
|
Vector3<T> GetTranslation() const;
|
|
|
|
const T* GetInternalValues() const;
|
|
T* GetInternalValues();
|
|
std::string ToString(const std::string& lineBegin = "|", const std::string& lineEnd = "|\n") const;
|
|
|
|
private:
|
|
union {
|
|
// column-major matrix
|
|
struct
|
|
{
|
|
T m_11, m_21, m_31, m_41, m_12, m_22, m_32, m_42, m_13, m_23, m_33, m_43, m_14, m_24, m_34, m_44;
|
|
};
|
|
T m_values[16];
|
|
};
|
|
};
|
|
|
|
typedef Matrix4<int> Matrix4i;
|
|
typedef Matrix4<float> Matrix4f;
|
|
typedef Matrix4<double> Matrix4d;
|
|
|
|
template <class T>
|
|
const Matrix4<T> Matrix4<T>::ZERO = Matrix4<T>(0);
|
|
|
|
template <class T>
|
|
const Matrix4<T> Matrix4<T>::IDENTITY = Matrix4<T>(
|
|
1, 0, 0, 0,
|
|
0, 1, 0, 0,
|
|
0, 0, 1, 0,
|
|
0, 0, 0, 1);
|
|
|
|
template <class T>
|
|
std::ostream& operator<<(std::ostream& out, const Matrix4<T>& m)
|
|
{
|
|
out << m.ToString();
|
|
return out;
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T>::Matrix4()
|
|
{
|
|
// Leave matrix uninitialized
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T>::Matrix4(const T& v)
|
|
{
|
|
for(int i = 0; i < 16; ++i)
|
|
m_values[i] = v;
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T>::Matrix4(const Matrix4<T>& m)
|
|
{
|
|
for(int i = 0; i < 16; ++i)
|
|
m_values[i] = m.m_values[i];
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T>::Matrix4(const T& m_11, const T& m_12, const T& m_13, const T& m_14,
|
|
const T& m_21, const T& m_22, const T& m_23, const T& m_24,
|
|
const T& m_31, const T& m_32, const T& m_33, const T& m_34,
|
|
const T& m_41, const T& m_42, const T& m_43, const T& m_44)
|
|
{
|
|
this->m_11 = m_11;
|
|
this->m_12 = m_12;
|
|
this->m_13 = m_13;
|
|
this->m_14 = m_14;
|
|
this->m_21 = m_21;
|
|
this->m_22 = m_22;
|
|
this->m_23 = m_23;
|
|
this->m_24 = m_24;
|
|
this->m_31 = m_31;
|
|
this->m_32 = m_32;
|
|
this->m_33 = m_33;
|
|
this->m_34 = m_34;
|
|
this->m_41 = m_41;
|
|
this->m_42 = m_42;
|
|
this->m_43 = m_43;
|
|
this->m_44 = m_44;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get11() const
|
|
{
|
|
return m_11;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get12() const
|
|
{
|
|
return m_12;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get13() const
|
|
{
|
|
return m_13;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get14() const
|
|
{
|
|
return m_14;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get21() const
|
|
{
|
|
return m_21;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get22() const
|
|
{
|
|
return m_22;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get23() const
|
|
{
|
|
return m_23;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get24() const
|
|
{
|
|
return m_24;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get31() const
|
|
{
|
|
return m_31;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get32() const
|
|
{
|
|
return m_32;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get33() const
|
|
{
|
|
return m_33;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get34() const
|
|
{
|
|
return m_34;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get41() const
|
|
{
|
|
return m_41;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get42() const
|
|
{
|
|
return m_42;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get43() const
|
|
{
|
|
return m_43;
|
|
}
|
|
|
|
template <class T>
|
|
const T& Matrix4<T>::Get44() const
|
|
{
|
|
return m_44;
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T>& Matrix4<T>::operator=(const Matrix4<T>& m)
|
|
{
|
|
if(this != &m)
|
|
{
|
|
for(int i = 0; i < 16; ++i)
|
|
m_values[i] = m.m_values[i];
|
|
}
|
|
|
|
return *this;
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T> Matrix4<T>::operator+(const Matrix4<T>& m) const
|
|
{
|
|
return Matrix4<T>(
|
|
m_11 + m.m_11, m_12 + m.m_12, m_13 + m.m_13, m_14 + m.m_14,
|
|
m_21 + m.m_21, m_22 + m.m_22, m_23 + m.m_23, m_24 + m.m_24,
|
|
m_31 + m.m_31, m_32 + m.m_32, m_33 + m.m_33, m_34 + m.m_34,
|
|
m_41 + m.m_41, m_42 + m.m_42, m_43 + m.m_43, m_44 + m.m_44);
|
|
}
|
|
|
|
template <class T>
|
|
const Matrix4<T>& Matrix4<T>::operator+=(const Matrix4<T>& m)
|
|
{
|
|
*this = *this + m;
|
|
return *this;
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T> Matrix4<T>::operator-(const Matrix4<T>& m) const
|
|
{
|
|
return Matrix4<T>(
|
|
m_11 - m.m_11, m_12 - m.m_12, m_13 - m.m_13, m_14 - m.m_14,
|
|
m_21 - m.m_21, m_22 - m.m_22, m_23 - m.m_23, m_24 - m.m_24,
|
|
m_31 - m.m_31, m_32 - m.m_32, m_33 - m.m_33, m_34 - m.m_34,
|
|
m_41 - m.m_41, m_42 - m.m_42, m_43 - m.m_43, m_44 - m.m_44);
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T> Matrix4<T>::operator-() const
|
|
{
|
|
return Matrix4<T>(
|
|
-m_11, -m_12, -m_13, -m_14,
|
|
-m_21, -m_22, -m_23, -m_24,
|
|
-m_31, -m_32, -m_33, -m_34,
|
|
-m_41, -m_42, -m_43, -m_44);
|
|
}
|
|
|
|
template <class T>
|
|
const Matrix4<T>& Matrix4<T>::operator-=(const Matrix4<T>& m)
|
|
{
|
|
*this = *this - m;
|
|
return *this;
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T> Matrix4<T>::operator*(const Matrix4<T>& m) const
|
|
{
|
|
return Matrix4<T>(
|
|
m_11 * m.m_11 + m_12 * m.m_21 + m_13 * m.m_31 + m_14 * m.m_41,
|
|
m_11 * m.m_12 + m_12 * m.m_22 + m_13 * m.m_32 + m_14 * m.m_42,
|
|
m_11 * m.m_13 + m_12 * m.m_23 + m_13 * m.m_33 + m_14 * m.m_43,
|
|
m_11 * m.m_14 + m_12 * m.m_24 + m_13 * m.m_34 + m_14 * m.m_44,
|
|
|
|
m_21 * m.m_11 + m_22 * m.m_21 + m_23 * m.m_31 + m_24 * m.m_41,
|
|
m_21 * m.m_12 + m_22 * m.m_22 + m_23 * m.m_32 + m_24 * m.m_42,
|
|
m_21 * m.m_13 + m_22 * m.m_23 + m_23 * m.m_33 + m_24 * m.m_43,
|
|
m_21 * m.m_14 + m_22 * m.m_24 + m_23 * m.m_34 + m_24 * m.m_44,
|
|
|
|
m_31 * m.m_11 + m_32 * m.m_21 + m_33 * m.m_31 + m_34 * m.m_41,
|
|
m_31 * m.m_12 + m_32 * m.m_22 + m_33 * m.m_32 + m_34 * m.m_42,
|
|
m_31 * m.m_13 + m_32 * m.m_23 + m_33 * m.m_33 + m_34 * m.m_43,
|
|
m_31 * m.m_14 + m_32 * m.m_24 + m_33 * m.m_34 + m_34 * m.m_44,
|
|
|
|
m_41 * m.m_11 + m_42 * m.m_21 + m_43 * m.m_31 + m_44 * m.m_41,
|
|
m_41 * m.m_12 + m_42 * m.m_22 + m_43 * m.m_32 + m_44 * m.m_42,
|
|
m_41 * m.m_13 + m_42 * m.m_23 + m_43 * m.m_33 + m_44 * m.m_43,
|
|
m_41 * m.m_14 + m_42 * m.m_24 + m_43 * m.m_34 + m_44 * m.m_44);
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T> Matrix4<T>::operator*(const T& v) const
|
|
{
|
|
return Matrix4<T>(
|
|
m_11 * v, m_12 * v, m_13 * v, m_14 * v,
|
|
m_21 * v, m_22 * v, m_23 * v, m_24 * v,
|
|
m_31 * v, m_32 * v, m_33 * v, m_34 * v,
|
|
m_41 * v, m_42 * v, m_43 * v, m_44 * v);
|
|
}
|
|
|
|
template <class T>
|
|
const Matrix4<T>& Matrix4<T>::operator*=(const Matrix4<T>& m)
|
|
{
|
|
*this = *this * m;
|
|
return *this;
|
|
}
|
|
|
|
template <class T>
|
|
const Matrix4<T>& Matrix4<T>::operator*=(const T& v)
|
|
{
|
|
*this = *this * v;
|
|
return *this;
|
|
}
|
|
|
|
template <class T>
|
|
Matrix4<T> Matrix4<T>::operator/(const T& v) const
|
|
{
|
|
return Matrix4<T>(
|
|
m_11 / v, m_12 / v, m_13 / v, m_14 / v,
|
|
m_21 / v, m_22 / v, m_23 / v, m_24 / v,
|
|
m_31 / v, m_32 / v, m_33 / v, m_34 / v,
|
|
m_41 / v, m_42 / v, m_43 / v, m_44 / v);
|
|
}
|
|
|
|
template <class T>
|
|
const Matrix4<T>& Matrix4<T>::operator/=(const T& v)
|
|
{
|
|
*this = *this / v;
|
|
return *this;
|
|
}
|
|
|
|
template <class T>
|
|
bool Matrix4<T>::operator==(const Matrix4<T>& m) const
|
|
{
|
|
for(int i = 0; i < 16; ++i)
|
|
if(m_values[i] != m.m_values[i])
|
|
return false;
|
|
|
|
return true;
|
|
}
|
|
|
|
template <class T>
|
|
bool Matrix4<T>::operator!=(const Matrix4<T>& m) const
|
|
{
|
|
return !(*this == m);
|
|
}
|
|
|
|
template <class T>
|
|
void Matrix4<T>::SetZero()
|
|
{
|
|
*this = ZERO;
|
|
}
|
|
|
|
template <class T>
|
|
void Matrix4<T>::SetIdentity()
|
|
{
|
|
*this = IDENTITY;
|
|
}
|
|
|
|
template <class T>
|
|
void Matrix4<T>::SetPerspectiveProjection(const T& fov, const T& aspect, const T& nearPlane, const T& farPlane)
|
|
{
|
|
const float h = T(1) / tan(fov * T(M_PI / 360.f));
|
|
T negDepth = nearPlane - farPlane;
|
|
|
|
SetZero();
|
|
|
|
m_11 = h / aspect;
|
|
m_22 = h;
|
|
m_33 = (farPlane + nearPlane) / negDepth;
|
|
m_34 = T(2) * (nearPlane * farPlane) / negDepth;
|
|
m_43 = -T(1);
|
|
}
|
|
|
|
template <class T>
|
|
void Matrix4<T>::SetOrthographicProjection(const T& left, const T& right, const T& bottom, const T& top, const T& nearPlane, const T& farPlane)
|
|
{
|
|
m_11 = T(2) / (right - left);
|
|
m_12 = T(0);
|
|
m_13 = T(0);
|
|
m_14 = -(right + left) / (right - left);
|
|
|
|
m_21 = T(0);
|
|
m_22 = T(2) / (top - bottom);
|
|
m_23 = T(0);
|
|
m_24 = -(top + bottom) / (top - bottom);
|
|
|
|
m_31 = T(0);
|
|
m_32 = T(0);
|
|
m_33 = -T(2) / (farPlane - nearPlane);
|
|
m_34 = -(farPlane + nearPlane) / (farPlane - nearPlane);
|
|
|
|
m_41 = T(0);
|
|
m_42 = T(0);
|
|
m_43 = T(0);
|
|
m_44 = T(1);
|
|
}
|
|
|
|
template <class T>
|
|
void Matrix4<T>::SetLookAt(const Vector3<T>& eyePosition, const Vector3<T>& lookAtPosition, Vector3<T> upVector)
|
|
{
|
|
Vector3f L = lookAtPosition - eyePosition;
|
|
L.Normalize();
|
|
|
|
upVector.Normalize();
|
|
Vector3f S = L.Cross(upVector);
|
|
S.Normalize();
|
|
|
|
Vector3f U = S.Cross(L);
|
|
|
|
Matrix4<T> M;
|
|
M.m_11 = S.x;
|
|
M.m_12 = S.y;
|
|
M.m_13 = S.z;
|
|
M.m_14 = 0;
|
|
|
|
M.m_21 = U.x;
|
|
M.m_22 = U.y;
|
|
M.m_23 = U.z;
|
|
M.m_24 = 0;
|
|
|
|
M.m_31 = -L.x;
|
|
M.m_32 = -L.y;
|
|
M.m_33 = -L.z;
|
|
M.m_34 = 0;
|
|
|
|
M.m_41 = 0;
|
|
M.m_42 = 0;
|
|
M.m_43 = 0;
|
|
M.m_44 = 1.f;
|
|
|
|
SetIdentity();
|
|
*this *= M;
|
|
ApplyTranslation(-eyePosition.x, -eyePosition.y, -eyePosition.z);
|
|
}
|
|
|
|
template <class T>
|
|
void Matrix4<T>::ApplyTranslation(const T& x, const T& y, const T& z)
|
|
{
|
|
Matrix4<T> tmp(
|
|
1, 0, 0, x,
|
|
0, 1, 0, y,
|
|
0, 0, 1, z,
|
|
0, 0, 0, 1);
|
|
|
|
*this *= tmp;
|
|
}
|
|
|
|
template <class T>
|
|
void Matrix4<T>::ApplyRotation(const T& angle, const T& x, const T& y, const T& z)
|
|
{
|
|
// TODO axis (x, y, z) must be normalized...
|
|
|
|
T s = sin(DEGTORAD(angle));
|
|
T c = cos(DEGTORAD(angle));
|
|
T ic = T(1) - c;
|
|
|
|
Matrix4<T> tmp(
|
|
x * x * ic + c, y * x * ic + (z * s), z * x * ic - (y * s), 0,
|
|
x * y * ic - (z * s), y * y * ic + c, z * y * ic + (x * s), 0,
|
|
x * z * ic + (y * s), y * z * ic - (x * s), z * z * ic + c, 0,
|
|
0, 0, 0, 1);
|
|
|
|
*this *= tmp;
|
|
}
|
|
|
|
template <class T>
|
|
void Matrix4<T>::ApplyScale(const T& x, const T& y, const T& z)
|
|
{
|
|
Matrix4<T> tmp(
|
|
x, 0, 0, 0,
|
|
0, y, 0, 0,
|
|
0, 0, z, 0,
|
|
0, 0, 0, 1);
|
|
|
|
*this *= tmp;
|
|
}
|
|
|
|
template <class T>
|
|
Vector3<T> Matrix4<T>::GetTranslation() const
|
|
{
|
|
// NOTE: Works only if the matrix doesn't contains scale information (only rotation and translation)
|
|
// Reference: http://www.gamedev.net/topic/397751-how-to-get-camera-position/
|
|
T x = -(m_11 * m_14 + m_21 * m_24 + m_31 * m_34);
|
|
T y = -(m_12 * m_14 + m_22 * m_24 + m_32 * m_34);
|
|
T z = -(m_13 * m_14 + m_23 * m_24 + m_33 * m_34);
|
|
|
|
return Vector3<T>(x, y, z);
|
|
}
|
|
|
|
template <class T>
|
|
T* Matrix4<T>::GetInternalValues()
|
|
{
|
|
return m_values;
|
|
}
|
|
|
|
template <class T>
|
|
const T* Matrix4<T>::GetInternalValues() const
|
|
{
|
|
return m_values;
|
|
}
|
|
|
|
template <class T>
|
|
std::string Matrix4<T>::ToString(const std::string& lineBegin, const std::string& lineEnd) const
|
|
{
|
|
std::ostringstream ss;
|
|
ss << lineBegin << m_11 << " " << m_12 << " " << m_13 << " " << m_14 << lineEnd;
|
|
ss << lineBegin << m_21 << " " << m_22 << " " << m_23 << " " << m_24 << lineEnd;
|
|
ss << lineBegin << m_31 << " " << m_32 << " " << m_33 << " " << m_34 << lineEnd;
|
|
ss << lineBegin << m_41 << " " << m_42 << " " << m_43 << " " << m_44 << lineEnd;
|
|
|
|
return ss.str();
|
|
}
|
|
|
|
#endif // MATRIX4_H__
|