Mercurial > hg > Members > kono > Cerium
annotate TaskManager/Test/test_render/sys.cpp @ 212:fe2cc32cd94d
fix
| author | gongo@localhost.localdomain |
|---|---|
| date | Sat, 31 Jan 2009 08:54:22 +0900 |
| parents | dee3b5092a70 |
| children | 7ca6a2ef5be9 |
| rev | line source |
|---|---|
| 160 | 1 #include <stdlib.h> |
| 109 | 2 #include <iostream> |
| 3 #include <math.h> | |
| 4 #include "sys.h" | |
| 5 using namespace std; | |
| 6 | |
| 7 void noMoreMemory() | |
| 8 { | |
| 9 cout << "can't allocate memory\n"; | |
| 10 exit(1); | |
| 11 } | |
| 12 | |
| 212 | 13 /** |
| 14 * ベクトルの正規化 | |
| 15 * | |
| 16 * @param[out] v0 output vector | |
| 17 * @param[in] v1 input vector | |
| 18 */ | |
| 19 void | |
| 20 normalize(float *v0, float *v1) | |
| 21 { | |
| 22 float norm, dnorm; | |
| 23 | |
| 24 norm = sqrt(v1[0]*v1[0] + v1[1]*v1[1] + v1[2]*v1[2]); | |
| 25 if (norm > 0) { | |
| 26 dnorm = 1.0/norm; | |
| 27 v0[0] = v1[0]*dnorm; | |
| 28 v0[1] = v1[1]*dnorm; | |
| 29 v0[2] = v1[2]*dnorm; | |
| 30 v0[3] = v1[3]*dnorm; | |
| 31 } | |
| 32 } | |
| 33 | |
| 34 /** | |
| 35 * ベクトルの減算 v0 = v1 - v2 | |
| 36 */ | |
| 37 void | |
| 38 subVector(float *v0, float *v1, float *v2) | |
| 39 { | |
| 40 v0[0] = v1[0] - v2[0]; | |
| 41 v0[1] = v1[1] - v2[1]; | |
| 42 v0[2] = v1[2] - v2[2]; | |
| 43 v0[3] = v1[3] - v2[3]; | |
| 44 } | |
| 45 | |
| 46 /** | |
| 47 * ベクトルの外積 v0 = v1 x v2 | |
| 48 */ | |
| 49 void | |
| 50 outerProduct(float *v0, float *v1, float *v2) | |
| 51 { | |
| 52 v0[0] = v1[1] * v2[2] - v1[2] * v2[1]; | |
| 53 v0[1] = v1[2] * v2[0] - v1[0] * v2[2]; | |
| 54 v0[2] = v1[0] * v2[1] - v1[1] * v2[0]; | |
| 55 v0[3] = 0; | |
| 56 } | |
| 57 | |
| 58 /** | |
| 59 * ベクトルの内積 f = v0 * v1 | |
| 60 */ | |
| 61 float | |
| 62 innerProduct(float *v0, float *v1) | |
| 63 { | |
| 64 return (v0[0]*v1[0] + v0[1]*v1[1] + v0[2]*v1[2]); | |
| 65 } | |
| 66 | |
| 109 | 67 void matrix4x4(float *xyz, float *xyz1, float *xyz2) //xyz[16] |
| 68 { | |
| 69 for(int t=0; t<16; t+=4) | |
| 70 { | |
| 71 for(int i=0; i<4; i++) | |
| 72 { | |
| 73 xyz[t+i] = xyz1[t]*xyz2[i] + xyz1[t+1]*xyz2[4+i] + xyz1[t+2]*xyz2[8+i] + xyz1[t+3]*xyz2[12+i]; | |
| 74 } | |
| 75 } | |
| 76 } | |
| 77 | |
| 78 void get_matrix( float *matrix, float *rxyz, float *txyz, float *stack) | |
| 79 { | |
| 80 float radx,rady,radz; | |
| 81 radx = rxyz[0]*3.14/180; | |
| 82 rady = rxyz[1]*3.14/180; | |
| 83 radz = rxyz[2]*3.14/180; | |
| 84 | |
| 85 float sinx = sin(radx); | |
| 86 float cosx = cos(radx); | |
| 87 float siny = sin(rady); | |
| 88 float cosy = cos(rady); | |
| 89 float sinz = sin(radz); | |
| 90 float cosz = cos(radz); | |
| 91 | |
| 206 | 92 /* View Transform */ |
| 109 | 93 matrix[0] = cosz*cosy+sinz*sinx*siny; |
|
174
559b48b69b76
getScale()、getTapestry から、span->length に適切なテクスチャの選択に成功
gongo@localhost.localdomain
parents:
160
diff
changeset
|
94 matrix[1] = sinz*cosx; |
| 109 | 95 matrix[2] = -cosz*siny+sinz*sinx*cosy; |
| 96 matrix[3] = 0; | |
| 97 matrix[4] = -sinz*cosy+cosz*sinx*siny; | |
| 98 matrix[5] = cosz*cosx; | |
| 99 matrix[6] = sinz*siny+cosz*sinx*cosy; | |
| 100 matrix[7] = 0; | |
| 101 matrix[8] = cosx*siny; | |
| 102 matrix[9] = -sinx; | |
| 103 matrix[10] = cosx*cosy; | |
| 104 matrix[11] = 0; | |
| 105 matrix[12] = txyz[0]; | |
| 106 matrix[13] = txyz[1]; | |
| 107 matrix[14] = txyz[2]; | |
| 108 matrix[15] = 1; | |
| 109 | |
| 206 | 110 /* Perspective Transform */ |
| 111 #if 0 | |
| 112 float n = 0.0f; | |
| 113 float f = 1000.0f; | |
| 114 float a = 0.995f / (n-f); | |
| 115 float b = 1-((0.995*n)/(n-f)); | |
| 116 | |
| 117 matrix[0] *= a*txyz[2]+b; | |
| 118 matrix[5] *= a*txyz[2]+b; | |
| 119 #endif | |
| 120 | |
| 109 | 121 float m[16]; |
| 122 | |
| 123 for(int i=0; i<16; i++) | |
| 124 { | |
| 125 m[i] = matrix[i]; | |
| 126 } | |
| 127 | |
| 128 if(stack) | |
| 129 { | |
| 176 | 130 matrix4x4(matrix, m, stack); |
| 109 | 131 } |
| 132 | |
| 133 } | |
| 134 | |
| 135 void rotate_x(float *xyz, float r) | |
| 136 { | |
| 137 float rad = r*3.14/180; | |
| 138 | |
| 139 xyz[0] = xyz[0]; | |
| 140 xyz[1] = xyz[1]*cos(rad) - xyz[2]*sin(rad); | |
| 141 xyz[2] = xyz[1]*sin(rad) + xyz[2]*cos(rad); | |
| 142 } | |
| 143 | |
| 144 void rotate_y(float *xyz, float r) | |
| 145 { | |
| 146 float rad = r*3.14/180; | |
| 147 | |
| 148 xyz[0] = xyz[0]*cos(rad) + xyz[2]*sin(rad); | |
| 149 xyz[1] = xyz[1]; | |
| 150 xyz[2] = -xyz[0]*sin(rad) + xyz[2]*cos(rad); | |
| 151 } | |
| 152 | |
| 153 void rotate_z(float *xyz, float r) | |
| 154 { | |
| 155 float rad = r*3.14/180; | |
| 156 | |
| 157 xyz[0] = xyz[0]*cos(rad) - xyz[1]*sin(rad); | |
| 158 xyz[1] = xyz[0]*sin(rad) + xyz[1]*cos(rad); | |
| 159 xyz[2] = xyz[2]; | |
| 160 } | |
| 161 | |
| 162 void rotate(float *xyz, float *matrix) | |
| 163 { | |
| 164 float abc[4]; | |
| 165 abc[0] = xyz[0]; | |
| 166 abc[1] = xyz[1]; | |
| 167 abc[2] = xyz[2]; | |
| 168 abc[3] = xyz[3]; | |
| 169 | |
| 170 for(int i=0; i<4; i++) | |
| 171 { | |
| 172 //xyz[i] = abc[0]*rot[i] + abc[1]*rot[i+4] + abc[2]*rot[i+8] + abc[3]*rot[i+12]; | |
| 173 xyz[i] = abc[0]*matrix[i] + abc[1]*matrix[i+4] + abc[2]*matrix[i+8] + abc[3]*matrix[i+12]; | |
| 174 } | |
| 175 } | |
| 176 | |
| 177 | |
| 178 void translate(float *xyz, float x, float y, float z) | |
| 179 { | |
| 180 xyz[0] += x; | |
| 181 xyz[1] += y; | |
| 182 xyz[2] += z; | |
| 183 } |