Debian Codegraph @

external/cubicvr2/math/transform.h

raw
1 //
2 // Transform.h
3 // CubicVR2
4 //
5 // Created by Charles J. Cliffe on 2013-02-22.
6 // Copyright (c) 2013 Charles J. Cliffe. All rights reserved.
7 //
8
9 #ifndef __CubicVR2__Transform__
10 #define __CubicVR2__Transform__
11
12 #include <iostream>
13 #include "cubic_types.h"
14 #include "mat4.h"
15 #include "vec3.h"
16 #include <vector>
17
18 namespace CubicVR {
19
20 class transform {
21 std::vector<mat4> m_stack;
22 std::vector<mat4> m_cache;
23 int c_stack;
24 int valid;
25 mat4 result;
26
27 transform() {
28 c_stack = 0;
29 valid = false;
30 result = mat4::identity();
31 };
32
33 transform(mat4 init_mat) {
34 clearStack(init_mat);
35 };
36
37 void setIdentity() {
38 m_stack[c_stack] = mat4(1.0f, 0.0f, 0.0f, 0.0f, 0.0f, 1.0f, 0.0f, 0.0f, 0.0f, 0.0f, 1.0f, 0.0f, 0.0f, 0.0f, 0.0f, 1.0f);
39 if (valid == c_stack && c_stack) {
40 valid--;
41 }
42 }
43
44 mat4 getIdentity() {
45 return mat4(1.0f, 0.0f, 0.0f, 0.0f, 0.0f, 1.0f, 0.0f, 0.0f, 0.0f, 0.0f, 1.0f, 0.0f, 0.0f, 0.0f, 0.0f, 1.0f);
46 }
47
48 void invalidate() {
49 valid = 0;
50 result = mat4::identity();
51 }
52
53 mat4 getResult() {
54 if (!c_stack) {
55 return m_stack[0];
56 }
57
58 mat4 m = getIdentity();
59
60 if (valid > c_stack-1) valid = c_stack-1;
61
62 for (int i = valid; i < c_stack+1; i++) {
63 m = mat4::multiply(m, m_stack[i], true);
64 m_cache[i] = m;
65 }
66
67 valid = c_stack-1;
68
69 result = m_cache[c_stack];
70
71 return result;
72 }
73
74 void pushMatrix(mat4 m) {
75 c_stack++;
76 m_stack[c_stack] = m;
77 }
78
79 void popMatrix() {
80 if (c_stack == 0) {
81 return;
82 }
83 c_stack--;
84 }
85
86 void clearStack(mat4 init_mat) {
87 m_stack.clear();
88 m_cache.clear();
89 c_stack = 0;
90 valid = 0;
91
92 result = mat4::identity();
93
94 m_stack[0] = init_mat;
95 }
96
97 void translate(__float x, __float y, __float z) {
98 mat4 m = getIdentity();
99
100 m[12] = x;
101 m[13] = y;
102 m[14] = z;
103
104 m_stack[c_stack] = mat4::multiply(m, m_stack[c_stack], true);
105 if (valid == c_stack && c_stack) {
106 valid--;
107 }
108 }
109
110 void scale(__float x, __float y, __float z) {
111 mat4 m = getIdentity();
112
113 m[0] = x;
114 m[5] = y;
115 m[10] = z;
116
117 m_stack[c_stack] = mat4::multiply(m, m_stack[c_stack], true);
118 if (valid == c_stack && c_stack) {
119 valid--;
120 }
121 }
122
123 void rotate(__float ang, __float x, __float y, __float z) {
124 __float sAng, cAng;
125
126 if (x || y || z) {
127 sAng = sin(-ang * ((float)M_PI / 180.0f));
128 cAng = cos(-ang * ((float)M_PI / 180.0f));
129 }
130
131 if (x) {
132 mat4 X_ROT = getIdentity();
133
134 X_ROT[5] = cAng * x;
135 X_ROT[9] = sAng * x;
136 X_ROT[6] = -sAng * x;
137 X_ROT[10] = cAng * x;
138
139 m_stack[c_stack] = mat4::multiply(m_stack[c_stack], X_ROT, true);
140 }
141
142 if (y) {
143 mat4 Y_ROT = getIdentity();
144
145 Y_ROT[0] = cAng * y;
146 Y_ROT[8] = -sAng * y;
147 Y_ROT[2] = sAng * y;
148 Y_ROT[10] = cAng * y;
149
150 m_stack[c_stack] = mat4::multiply(m_stack[c_stack], Y_ROT, true);
151 }
152
153 if (z) {
154 mat4 Z_ROT = getIdentity();
155
156 Z_ROT[0] = cAng * z;
157 Z_ROT[4] = sAng * z;
158 Z_ROT[1] = -sAng * z;
159 Z_ROT[5] = cAng * z;
160
161 m_stack[c_stack] = mat4::multiply(m_stack[c_stack], Z_ROT, true);
162 }
163
164 if (valid == c_stack && c_stack) {
165 valid--;
166 }
167 };
168 };
169 }
170
171 #endif /* defined(__CubicVR2__Transform__) */