source: trunk/src/matrix.h @ 661

Last change on this file since 661 was 661, checked in by sam, 11 years ago

Implement float4x4::rotate().

  • Property svn:keywords set to Id
File size: 6.2 KB
Line 
1//
2// Lol Engine
3//
4// Copyright: (c) 2010-2011 Sam Hocevar <sam@hocevar.net>
5//   This program is free software; you can redistribute it and/or
6//   modify it under the terms of the Do What The Fuck You Want To
7//   Public License, Version 2, as published by Sam Hocevar. See
8//   http://sam.zoy.org/projects/COPYING.WTFPL for more details.
9//
10
11//
12// The Matrix classes
13// ------------------
14//
15
16#if !defined __DH_MATRIX_H__
17#define __DH_MATRIX_H__
18
19#include <cmath>
20
21#define VECTOR_OP(elems, op) \
22    template<typename U> \
23    inline Vec##elems<T> operator op(Vec##elems<U> const &val) const \
24    { \
25        Vec##elems<T> ret; \
26        for (int n = 0; n < elems; n++) \
27            ret[n] = (*this)[n] op val[n]; \
28        return ret; \
29    }
30
31#define BOOL_OP(elems, op, ret) \
32    inline bool operator op(Vec##elems<T> const &val) const \
33    { \
34        for (int n = 0; n < elems; n++) \
35            if ((*this)[n] != val[n]) \
36                return ret; \
37        return !ret; \
38    }
39
40#define SCALAR_OP(elems, op) \
41    inline Vec##elems<T> operator op(T const &val) const \
42    { \
43        Vec##elems<T> ret; \
44        for (int n = 0; n < elems; n++) \
45            ret[n] = (*this)[n] op val; \
46        return ret; \
47    }
48
49#define CAST_OP(elems, dest) \
50    inline operator Vec##dest<T>() const \
51    { \
52        Vec##dest<T> ret; \
53        for (int n = 0; n < elems && n < dest; n++) \
54            ret[n] = (*this)[n]; \
55        return ret; \
56    }
57
58#define OPERATORS(elems) \
59    inline T& operator[](int n) { return *(&x + n); } \
60    inline T const& operator[](int n) const { return *(&x + n); } \
61    \
62    VECTOR_OP(elems, -) \
63    VECTOR_OP(elems, +) \
64    VECTOR_OP(elems, *) \
65    VECTOR_OP(elems, /) \
66    \
67    BOOL_OP(elems, ==, false) \
68    BOOL_OP(elems, !=, true) \
69    \
70    SCALAR_OP(elems, -) \
71    SCALAR_OP(elems, +) \
72    SCALAR_OP(elems, *) \
73    SCALAR_OP(elems, /) \
74    \
75    CAST_OP(elems, 2) \
76    CAST_OP(elems, 3) \
77    CAST_OP(elems, 4) \
78    \
79    template<typename U> \
80    inline operator Vec##elems<U>() const \
81    { \
82        Vec##elems<U> ret; \
83        for (int n = 0; n < elems; n++) \
84            ret[n] = static_cast<U>((*this)[n]); \
85        return ret; \
86    } \
87    \
88    inline T sqlen() const \
89    { \
90        T acc = 0; \
91        for (int n = 0; n < elems; n++) \
92            acc += (*this)[n] * (*this)[n]; \
93        return acc; \
94    } \
95    \
96    inline float len() const \
97    { \
98        return sqrtf((float)sqlen()); \
99    }
100
101template <typename T> struct Vec2;
102template <typename T> struct Vec3;
103template <typename T> struct Vec4;
104
105template <typename T> struct Vec2
106{
107    inline Vec2() { }
108    inline Vec2(T val) { x = y = val; }
109    inline Vec2(T _x, T _y) { x = _x; y = _y; }
110
111    OPERATORS(2)
112
113    union { T x; T a; T i; };
114    union { T y; T b; T j; };
115};
116
117typedef Vec2<float> float2;
118typedef Vec2<int> int2;
119
120template <typename T> struct Vec3
121{
122    inline Vec3() { }
123    inline Vec3(T val) { x = y = z = val; }
124    inline Vec3(T _x, T _y, T _z) { x = _x; y = _y; z = _z; }
125
126    OPERATORS(3)
127
128    union { T x; T a; T i; };
129    union { T y; T b; T j; };
130    union { T z; T c; T k; };
131};
132
133typedef Vec3<float> float3;
134typedef Vec3<int> int3;
135
136template <typename T> struct Vec4
137{
138    inline Vec4() { }
139    inline Vec4(T val) { x = y = z = w = val; }
140    inline Vec4(T _x, T _y, T _z, T _w) { x = _x; y = _y; z = _z; w = _w; }
141
142    OPERATORS(4)
143
144    union { T x; T a; T i; };
145    union { T y; T b; T j; };
146    union { T z; T c; T k; };
147    union { T w; T d; T l; };
148};
149
150typedef Vec4<float> float4;
151typedef Vec4<int> int4;
152
153#define SCALAR_GLOBAL(elems, op, U) \
154    template<typename T> \
155    static inline Vec##elems<U> operator op(U const &val, \
156                                            Vec##elems<T> const &that) \
157    { \
158        Vec##elems<U> ret; \
159        for (int n = 0; n < elems; n++) \
160            ret[n] = val op that[n]; \
161        return ret; \
162    }
163
164#define SCALAR_GLOBAL2(elems, op) \
165    SCALAR_GLOBAL(elems, op, int) \
166    SCALAR_GLOBAL(elems, op, float)
167
168#define GLOBALS(elems) \
169    SCALAR_GLOBAL2(elems, -) \
170    SCALAR_GLOBAL2(elems, +) \
171    SCALAR_GLOBAL2(elems, *) \
172    SCALAR_GLOBAL2(elems, /)
173
174GLOBALS(2)
175GLOBALS(3)
176GLOBALS(4)
177
178template <typename T> struct Mat4
179{
180    inline Mat4() { }
181    inline Mat4(T val)
182    {
183        for (int j = 0; j < 4; j++)
184            for (int i = 0; i < 4; i++)
185                v[i][j] = (i == j) ? val : 0;
186    }
187    inline Mat4(Vec4<T> v0, Vec4<T> v1, Vec4<T> v2, Vec4<T> v3)
188    {
189        v[0] = v0; v[1] = v1; v[2] = v2; v[3] = v3;
190    }
191
192    inline Vec4<T>& operator[](int n) { return v[n]; }
193    inline Vec4<T> const& operator[](int n) const { return v[n]; }
194
195    T det() const;
196    Mat4<T> invert() const;
197
198    static Mat4<T> ortho(T left, T right, T bottom, T top, T near, T far);
199    static Mat4<T> frustum(T left, T right, T bottom, T top, T near, T far);
200    static Mat4<T> perspective(T theta, T width, T height, T near, T far);
201    static Mat4<T> translate(T x, T y, T z);
202    static Mat4<T> rotate(T theta, T x, T y, T z);
203
204    inline Mat4<T> operator +(Mat4<T> const val) const
205    {
206        Mat4<T> ret;
207        for (int j = 0; j < 4; j++)
208            for (int i = 0; i < 4; i++)
209                ret[i][j] = v[i][j] + val[i][j];
210        return ret;
211    }
212
213    inline Mat4<T> operator -(Mat4<T> const val) const
214    {
215        Mat4<T> ret;
216        for (int j = 0; j < 4; j++)
217            for (int i = 0; i < 4; i++)
218                ret[i][j] = v[i][j] - val[i][j];
219        return ret;
220    }
221
222    inline Mat4<T> operator *(Mat4<T> const val) const
223    {
224        Mat4<T> ret;
225        for (int j = 0; j < 4; j++)
226            for (int i = 0; i < 4; i++)
227            {
228                T tmp = 0;
229                for (int k = 0; k < 4; k++)
230                    tmp += v[k][j] * val[i][k];
231                ret[i][j] = tmp;
232            }
233        return ret;
234    }
235
236    inline Vec4<T> operator *(Vec4<T> const val) const
237    {
238        Vec4<T> ret;
239        for (int j = 0; j < 4; j++)
240        {
241            T tmp = 0;
242            for (int i = 0; i < 4; i++)
243                tmp += v[i][j] * val[i];
244            ret[j] = tmp;
245        }
246        return ret;
247    }
248
249    Vec4<T> v[4];
250};
251
252typedef Mat4<float> float4x4;
253typedef Mat4<int> int4x4;
254
255#endif // __DH_MATRIX_H__
256
Note: See TracBrowser for help on using the repository browser.