| 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__) */ |