1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
|
#include "math/mat4.h"
#include <array>
#include <cmath>
#include "math/math_vector.h"
Mat4 Mat4::idty() {
return {
1.f, 0.f, 0.f, 0.f,
0.f, 1.f, 0.f, 0.f,
0.f, 0.f, 1.f, 0.f,
0.f, 0.f, 0.f, 1.f,
};
}
Mat4 Mat4::rot_x(float a) {
float c = std::cos(a);
float s = std::sin(a);
return {
1.f, 0.f, 0.f, 0.f,
0.f, c, -s, 0.f,
0.f, s, c, 0.f,
0.f, 0.f, 0.f, 1.f,
};
}
Mat4 Mat4::rot_y(float a) {
float c = std::cos(a);
float s = std::sin(a);
return {
c, 0.f, s, 0.f,
0.f, 1.f, 0.f, 0.f,
-s, 0.f, c, 0.f,
0.f, 0.f, 0.f, 1.f,
};
}
Mat4 Mat4::rot_z(float a) {
float c = std::cos(a);
float s = std::sin(a);
return {
c, -s, 0.f, 0.f,
s, c, 0.f, 0.f,
0.f, 0.f, 1.f, 0.f,
0.f, 0.f, 0.f, 1.f,
};
}
Mat4 Mat4::operator-() {
return {
-values[ 0], -values[ 1], -values[ 2], -values[ 3],
-values[ 4], -values[ 5], -values[ 6], -values[ 7],
-values[ 8], -values[ 9], -values[10], -values[11],
-values[12], -values[13], -values[14], -values[15],
};
}
Mat4 Mat4::operator+(Mat4 m) {
return {
values[ 0] + m.values[ 0], values[ 1] + m.values[ 1], values[ 2] + m.values[ 2], values[ 3] + m.values[ 3],
values[ 4] + m.values[ 4], values[ 5] + m.values[ 5], values[ 6] + m.values[ 6], values[ 7] + m.values[ 7],
values[ 8] + m.values[ 8], values[ 9] + m.values[ 9], values[10] + m.values[10], values[11] + m.values[11],
values[12] + m.values[12], values[13] + m.values[13], values[14] + m.values[14], values[15] + m.values[15],
};
}
Mat4 Mat4::operator-(Mat4 m) {
return *this + (-m);
}
Mat4 Mat4::operator*(Mat4 m) {
Mat4 ret;
for (int i = 0; i < 4; i++) {
for (int j = 0; j < 4; j++) {
ret.values[i * 4 + j] = 0.f;
for (int k = 0; k < 4; k++)
ret.values[i * 4 + j] += values[i * 4 + k] * m.values[k * 4 + j];
}
}
return ret;
}
MathVector4 Mat4::operator*(MathVector4 v) {
return {
values[ 0] * v.x + values[ 1] * v.y + values[ 2] * v.z + values[ 3] * v.w,
values[ 4] * v.x + values[ 5] * v.y + values[ 6] * v.z + values[ 7] * v.w,
values[ 8] * v.x + values[ 9] * v.y + values[10] * v.z + values[11] * v.w,
values[12] * v.x + values[13] * v.y + values[14] * v.z + values[15] * v.w,
};
}
std::array<MathVector4, 4> Mat4::to_vecs() {
return {{
{ values[ 0], values[ 4], values[ 8], values[12] },
{ values[ 1], values[ 5], values[ 9], values[13] },
{ values[ 2], values[ 6], values[10], values[14] },
{ values[ 3], values[ 7], values[11], values[15] },
}};
}
|
