rayzor

annotate src/vmathmat.h @ 0:2a5340a6eee4

find changesets by author, revision, files, or words in the commit message
rayzor first commit
author John Tsiombikas <nuclear@member.fsf.org>
date Sat, 05 Apr 2014 08:46:27 +0300
parents
children a826bf0fb169
rev   line source
nuclear@0 1 #ifndef VMATH_MATRIX_H_
nuclear@0 2 #define VMATH_MATRIX_H_
nuclear@0 3
nuclear@0 4 #include <math.h>
nuclear@0 5
nuclear@0 6 #ifndef M_PI
nuclear@0 7 #define M_PI 3.141592653
nuclear@0 8 #endif
nuclear@0 9
nuclear@0 10 class Vector3;
nuclear@0 11
nuclear@0 12 class Matrix4x4 {
nuclear@0 13 public:
nuclear@0 14 float m[4][4];
nuclear@0 15
nuclear@0 16 Matrix4x4()
nuclear@0 17 {
nuclear@0 18 set_identity();
nuclear@0 19 }
nuclear@0 20
nuclear@0 21 Matrix4x4(float m00, float m01, float m02, float m03,
nuclear@0 22 float m10, float m11, float m12, float m13,
nuclear@0 23 float m20, float m21, float m22, float m23,
nuclear@0 24 float m30, float m31, float m32, float m33)
nuclear@0 25 {
nuclear@0 26 m[0][0] = m00; m[0][1] = m01; m[0][2] = m02; m[0][3] = m03;
nuclear@0 27 m[1][0] = m10; m[1][1] = m11; m[1][2] = m12; m[1][3] = m13;
nuclear@0 28 m[2][0] = m20; m[2][1] = m21; m[2][2] = m22; m[2][3] = m23;
nuclear@0 29 m[3][0] = m30; m[3][1] = m31; m[3][2] = m32; m[3][3] = m33;
nuclear@0 30 }
nuclear@0 31
nuclear@0 32 inline void set_identity();
nuclear@0 33 inline void translate(float x, float y, float z);
nuclear@0 34 inline void rotate(float angle, float x, float y, float z);
nuclear@0 35 inline void scale(float x, float y, float z);
nuclear@0 36 inline void perspective(float vfov, float aspect, float znear, float zfar);
nuclear@0 37 inline void lookat(const Vector3 &pos, const Vector3 &targ, const Vector3 &up);
nuclear@0 38
nuclear@0 39 float *operator [](int idx) { return m[idx]; }
nuclear@0 40 const float *operator [](int idx) const { return m[idx]; }
nuclear@0 41 };
nuclear@0 42
nuclear@0 43 inline Matrix4x4 operator *(const Matrix4x4 &a, const Matrix4x4 &b)
nuclear@0 44 {
nuclear@0 45 Matrix4x4 res;
nuclear@0 46 for(int i=0; i<4; i++) {
nuclear@0 47 for(int j=0; j<4; j++) {
nuclear@0 48 res[i][j] = a[i][0] * b[0][j] + a[i][1] * b[1][j] +
nuclear@0 49 a[i][2] * b[2][j] + a[i][3] * b[3][j];
nuclear@0 50 }
nuclear@0 51 }
nuclear@0 52 return res;
nuclear@0 53 }
nuclear@0 54
nuclear@0 55 inline void Matrix4x4::set_identity()
nuclear@0 56 {
nuclear@0 57 m[0][0] = m[1][1] = m[2][2] = m[3][3] = 1.0;
nuclear@0 58 m[0][1] = m[0][2] = m[0][3] = m[1][2] = m[1][3] = m[2][3] = 0.0;
nuclear@0 59 m[1][0] = m[2][0] = m[3][0] = m[2][1] = m[3][1] = m[3][2] = 0.0;
nuclear@0 60 }
nuclear@0 61
nuclear@0 62 inline void Matrix4x4::translate(float x, float y, float z)
nuclear@0 63 {
nuclear@0 64 Matrix4x4 m(1, 0, 0, x, 0, 1, 0, y, 0, 0, 1, z, 0, 0, 0, 1);
nuclear@0 65 *this = *this * m;
nuclear@0 66 }
nuclear@0 67
nuclear@0 68 inline void Matrix4x4::rotate(float angle, float x, float y, float z)
nuclear@0 69 {
nuclear@0 70 float sina = (float)sin(angle);
nuclear@0 71 float cosa = (float)cos(angle);
nuclear@0 72 float rcosa = 1.0f - cosa;
nuclear@0 73 float nxsq = x * x;
nuclear@0 74 float nysq = y * y;
nuclear@0 75 float nzsq = z * z;
nuclear@0 76
nuclear@0 77 Matrix4x4 m;
nuclear@0 78 m[0][0] = nxsq + (1.0f - nxsq) * cosa;
nuclear@0 79 m[0][1] = x * y * rcosa - z * sina;
nuclear@0 80 m[0][2] = x * z * rcosa + y * sina;
nuclear@0 81
nuclear@0 82 m[1][0] = x * y * rcosa + z * sina;
nuclear@0 83 m[1][1] = nysq + (1.0f - nysq) * cosa;
nuclear@0 84 m[1][2] = y * z * rcosa - x * sina;
nuclear@0 85
nuclear@0 86 m[2][0] = x * z * rcosa - y * sina;
nuclear@0 87 m[2][1] = y * z * rcosa + x * sina;
nuclear@0 88 m[2][2] = nzsq + (1.0f - nzsq) * cosa;
nuclear@0 89
nuclear@0 90 *this = *this * m;
nuclear@0 91 }
nuclear@0 92
nuclear@0 93 inline void Matrix4x4::scale(float x, float y, float z)
nuclear@0 94 {
nuclear@0 95 Matrix4x4 m(x, 0, 0, 0, 0, y, 0, 0, 0, 0, z, 0, 0, 0, 0, 1);
nuclear@0 96 *this = *this * m;
nuclear@0 97 }
nuclear@0 98
nuclear@0 99 inline void Matrix4x4::perspective(float vfov, float aspect, float znear, float zfar)
nuclear@0 100 {
nuclear@0 101 float f = 1.0f / tan(vfov * 0.5f);
nuclear@0 102 float dz = znear - zfar;
nuclear@0 103
nuclear@0 104 Matrix4x4 m;
nuclear@0 105 m[0][0] = f / aspect;
nuclear@0 106 m[1][1] = f;
nuclear@0 107 m[2][2] = (zfar + znear) / dz;
nuclear@0 108 m[3][2] = -1.0f;
nuclear@0 109 m[2][3] = 2.0f * zfar * znear / dz;
nuclear@0 110 m[3][3] = 0.0f;
nuclear@0 111
nuclear@0 112 *this = *this * m;
nuclear@0 113 }
nuclear@0 114
nuclear@0 115
nuclear@0 116 #endif // VMATH_MATRIX_H_