annotate Renderer/Engine/matrix_calc.cc @ 1254:34944900f266 draft

minor fix
author Shinji KONO <kono@ie.u-ryukyu.ac.jp>
date Fri, 18 Nov 2011 16:56:11 +0900
parents 636dfdc30176
children 880f989ce52a
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
1 #include <stdlib.h>
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
2 #include <iostream>
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
3 #include <string.h>
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
4 #include <math.h>
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
5 #include "matrix_calc.h"
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
6 using namespace std;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
7
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
8 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
9 transMatrix(float *m0, float *m1, float *v)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
10 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
11 memcpy(m0, m1, sizeof(float)*16);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
12
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
13 m0[12] = m1[12] + v[0];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
14 m0[13] = m1[13] + v[1];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
15 m0[14] = m1[14] + v[2];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
16 m0[15] = m1[15] + v[3];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
17 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
18
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
19 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
20 unitMatrix(float *m)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
21 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
22 bzero(m, sizeof(float)*16);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
23
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
24 m[0] = 1.0f;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
25 m[5] = 1.0f;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
26 m[10] = 1.0f;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
27 m[15] = 1.0f;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
28 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
29
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
30 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
31 inversMatrix(float *m0, float *m1)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
32 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
33 float m[16];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
34
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
35 for (int i = 0; i < 4; i++) {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
36 for (int j = 0; j < 4; j++) {
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
37 m0[i*4+j] = m[i*4+j] = m1[j*4+i];
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
38 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
39 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
40
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
41 m0[12] = -(m1[12]*m[0] + m1[13]*m[1] + m1[14]*m[2]);
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
42 m0[13] = -(m1[12]*m[4] + m1[13]*m[5] + m1[14]*m[6]);
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
43 m0[14] = -(m1[12]*m[8] + m1[13]*m[9] + m1[14]*m[10]);
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
44 m0[3] = m0[7] = m0[11] = 0.0f;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
45 m0[15] = 1.0f;
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
46
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
47 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
48
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
49 /**
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
50 * マトリックス m にベクトル v1 を右から乗算して、v0に与える
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
51 * @param[out] v0 output vector (float[4])
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
52 * @param[in] v1 input vector (float[4])
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
53 * @param[in] m matrix (float[16])
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
54 */
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
55 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
56 applyMatrix(float *v0, float *m, float *v1)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
57 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
58 for (int i = 0; i < 4; i++) {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
59 v0[i] = v1[0]*m[i] + v1[1]*m[i+4] + v1[2]*m[i+8] + v1[3]*m[i+12];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
60 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
61 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
62
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
63
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
64 /**
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
65 * ベクトルの正規化
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
66 *
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
67 * @param[out] v0 output vector
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
68 * @param[in] v1 input vector
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
69 */
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
70 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
71 normalize(float *v0, float *v1)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
72 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
73 float norm, dnorm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
74
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
75 norm = sqrt(v1[0]*v1[0] + v1[1]*v1[1] + v1[2]*v1[2]);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
76 if (norm > 0) {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
77 dnorm = 1.0/norm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
78 v0[0] = v1[0]*dnorm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
79 v0[1] = v1[1]*dnorm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
80 v0[2] = v1[2]*dnorm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
81 v0[3] = v1[3]*dnorm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
82 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
83 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
84
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
85 /**
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
86 * ベクトルの減算 v0 = v1 - v2
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
87 */
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
88 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
89 subVector(float *v0, float *v1, float *v2)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
90 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
91 v0[0] = v1[0] - v2[0];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
92 v0[1] = v1[1] - v2[1];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
93 v0[2] = v1[2] - v2[2];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
94 v0[3] = v1[3] - v2[3];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
95 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
96
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
97 /**
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
98 * ベクトルの外積 v0 = v1 x v2
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
99 */
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
100 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
101 outerProduct(float *v0, float *v1, float *v2)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
102 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
103 v0[0] = v1[1] * v2[2] - v1[2] * v2[1];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
104 v0[1] = v1[2] * v2[0] - v1[0] * v2[2];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
105 v0[2] = v1[0] * v2[1] - v1[1] * v2[0];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
106 v0[3] = 0;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
107 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
108
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
109 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
110 transposeMatrix(float *m0, float *m1)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
111 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
112 float t[16];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
113
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
114 // こういう小細工よりベクタ使った方が良いんだが
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
115 for (int i = 0; i < 4; i++) {
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
116 for (int j = i+1; j < 4; j++) {
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
117 float tmp = t[j*4+i];
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
118 t[i*4+j] = m1[j*4+i];
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
119 m1[j*4+i] = tmp;
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
120 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
121 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
122 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
123
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
124 /**
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
125 * ベクトルの内積 f = v0 * v1
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
126 */
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
127 float
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
128 innerProduct(float *v0, float *v1)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
129 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
130 return (v0[0]*v1[0] + v0[1]*v1[1] + v0[2]*v1[2]);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
131 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
132
1094
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
133 /**
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
134 * xyz = xyz1 * xyz2
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
135 */
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
136 void matrix4x4(float *xyz, float *xyz1, float *xyz2) //xyz[16]
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
137 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
138 for(int t=0; t<16; t+=4)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
139 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
140 for(int i=0; i<4; i++)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
141 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
142 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];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
143 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
144 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
145 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
146
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
147 void matrix4x4R(float &xyz[16], float &xyz1[16], float &xyz2[16])
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
148 {
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
149 for(int t=0; t<16; t+=4)
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
150 {
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
151 for(int i=0; i<4; i++)
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
152 {
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
153 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];
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
154 }
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
155 }
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
156 }
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
157
1047
f87218eed9fc broken texure ( h/w != 2^n ) protection
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 677
diff changeset
158 /**
1094
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
159 * c_xyz を中心に sacle 倍する
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
160 */
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
161 void
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
162 scale_matrix(float *xyz, float *scale, float *c_xyz)
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
163 {
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
164 float xyz2[16] = {
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
165 scale[0], 0, 0, scale[0]*(-c_xyz[0]) + c_xyz[0],
1098
1ef561eb1ef5 scale_matrix fix.
koba <koba@cr.ie.u-ryukyu.ac.jp>
parents: 1094
diff changeset
166 0, scale[1], 0, scale[1]*(-c_xyz[1]) + c_xyz[1],
1094
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
167 0, 0, scale[2], scale[2]*(-c_xyz[2]) + c_xyz[2],
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
168 0, 0, 0, 1
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
169
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
170 };
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
171 float xyz1[16] = {
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
172 xyz[0], xyz[1], xyz[2], xyz[3],
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
173 xyz[4], xyz[5], xyz[6], xyz[7],
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
174 xyz[8], xyz[9], xyz[10], xyz[11],
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
175 xyz[12], xyz[13], xyz[14], xyz[15]};
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
176
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
177 for(int t=0; t<16; t+=4)
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
178 {
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
179 for(int i=0; i<4; i++)
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
180 {
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
181 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];
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
182 }
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
183 }
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
184 }
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
185
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
186 /**
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
187 stack 上の変換行列に、相対的に、rxyz の回転、txyz の平行移動、scale の拡大を
1047
f87218eed9fc broken texure ( h/w != 2^n ) protection
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 677
diff changeset
188 行ったものを matrix に代入する
f87218eed9fc broken texure ( h/w != 2^n ) protection
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 677
diff changeset
189 */
f87218eed9fc broken texure ( h/w != 2^n ) protection
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 677
diff changeset
190 void
1094
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
191 get_matrix( float *matrix, float *rxyz, float *txyz, float *stack)
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
192 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
193 float radx,rady,radz;
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
194 radx = rxyz[0]*M_PI/180;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
195 rady = rxyz[1]*M_PI/180;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
196 radz = rxyz[2]*M_PI/180;
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
197
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
198 float sinx = sin(radx);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
199 float cosx = cos(radx);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
200 float siny = sin(rady);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
201 float cosy = cos(rady);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
202 float sinz = sin(radz);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
203 float cosz = cos(radz);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
204
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
205 float m1[16];
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
206 float *m = stack? m1 : matrix;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
207
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
208 /* View Transform */
1051
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
209 m[0] = cosz*cosy+sinz*sinx*siny;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
210 m[1] = sinz*cosx;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
211 m[2] = -cosz*siny+sinz*sinx*cosy;
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
212 m[3] = 0;
1051
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
213 m[4] = -sinz*cosy+cosz*sinx*siny;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
214 m[5] = cosz*cosx;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
215 m[6] = sinz*siny+cosz*sinx*cosy;
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
216 m[7] = 0;
1051
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
217 m[8] = cosx*siny;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
218 m[9] = -sinx;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
219 m[10] = cosx*cosy;
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
220 m[11] = 0;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
221 m[12] = txyz[0];
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
222 m[13] = txyz[1];
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
223 m[14] = txyz[2];
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
224 m[15] = 1;
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
225
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
226 if(stack)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
227 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
228 matrix4x4(matrix, m, stack);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
229 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
230
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
231 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
232
1165
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
233 void
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
234 get_matrix_scale( float *matrix, float *rxyz, float *txyz, float *scale, float *stack)
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
235 {
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
236 float radx,rady,radz;
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
237 radx = rxyz[0]*M_PI/180;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
238 rady = rxyz[1]*M_PI/180;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
239 radz = rxyz[2]*M_PI/180;
1165
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
240
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
241 float sinx = sin(radx)*scale[0];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
242 float cosx = cos(radx)*scale[0];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
243 float siny = sin(rady)*scale[1];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
244 float cosy = cos(rady)*scale[1];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
245 float sinz = sin(radz)*scale[2];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
246 float cosz = cos(radz)*scale[2];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
247
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
248 float m1[16];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
249 float *m = stack? m1 : matrix;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
250
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
251 /* View Transform */
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
252 m[0] = cosz*cosy+sinz*sinx*siny;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
253 m[1] = sinz*cosx;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
254 m[2] = -cosz*siny+sinz*sinx*cosy;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
255 m[3] = 0;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
256 m[4] = -sinz*cosy+cosz*sinx*siny;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
257 m[5] = cosz*cosx;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
258 m[6] = sinz*siny+cosz*sinx*cosy;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
259 m[7] = 0;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
260 m[8] = cosx*siny;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
261 m[9] = -sinx;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
262 m[10] = cosx*cosy;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
263 m[11] = 0;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
264 m[12] = txyz[0];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
265 m[13] = txyz[1];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
266 m[14] = txyz[2];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
267 m[15] = 1;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
268
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
269 if(stack)
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
270 {
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
271 matrix4x4(matrix, m, stack);
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
272 }
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
273
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
274 }
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
275
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
276 void
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
277 rotate_matrix( float &m[16], float &rxyz[4] )
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
278 {
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
279 float radx,rady,radz;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
280 radx = rxyz[0]*M_PI/180;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
281 rady = rxyz[1]*M_PI/180;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
282 radz = rxyz[2]*M_PI/180;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
283
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
284 float sinx = sin(radx);
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
285 float cosx = cos(radx);
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
286 float siny = sin(rady);
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
287 float cosy = cos(rady);
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
288 float sinz = sin(radz);
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
289 float cosz = cos(radz);
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
290
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
291 /* View Transform */
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
292 m[0] = cosz*cosy+sinz*sinx*siny;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
293 m[1] = sinz*cosx;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
294 m[2] = -cosz*siny+sinz*sinx*cosy;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
295 m[3] = 0;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
296 m[4] = -sinz*cosy+cosz*sinx*siny;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
297 m[5] = cosz*cosx;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
298 m[6] = sinz*siny+cosz*sinx*cosy;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
299 m[7] = 0;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
300 m[8] = cosx*siny;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
301 m[9] = -sinx;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
302 m[10] = cosx*cosy;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
303 m[11] = 0;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
304 m[12] = 0;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
305 m[13] = 0;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
306 m[14] = 0;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
307 m[15] = 1;
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
308 }
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
309
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
310 void rotate_x(float *xyz, float r)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
311 {
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
312 float rad = r*M_PI/180;
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
313
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
314 xyz[0] = xyz[0];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
315 xyz[1] = xyz[1]*cos(rad) - xyz[2]*sin(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
316 xyz[2] = xyz[1]*sin(rad) + xyz[2]*cos(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
317 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
318
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
319 void rotate_y(float *xyz, float r)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
320 {
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
321 float rad = r*M_PI/180;
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
322
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
323 xyz[0] = xyz[0]*cos(rad) + xyz[2]*sin(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
324 xyz[1] = xyz[1];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
325 xyz[2] = -xyz[0]*sin(rad) + xyz[2]*cos(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
326 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
327
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
328 void rotate_z(float *xyz, float r)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
329 {
1254
34944900f266 minor fix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1226
diff changeset
330 float rad = r*M_PI/180;
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
331
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
332 xyz[0] = xyz[0]*cos(rad) - xyz[1]*sin(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
333 xyz[1] = xyz[0]*sin(rad) + xyz[1]*cos(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
334 xyz[2] = xyz[2];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
335 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
336
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
337 void rotate(float *xyz, float *matrix)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
338 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
339 float abc[4];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
340 abc[0] = xyz[0];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
341 abc[1] = xyz[1];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
342 abc[2] = xyz[2];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
343 abc[3] = xyz[3];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
344
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
345 for(int i=0; i<4; i++)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
346 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
347 //xyz[i] = abc[0]*rot[i] + abc[1]*rot[i+4] + abc[2]*rot[i+8] + abc[3]*rot[i+12];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
348 xyz[i] = abc[0]*matrix[i] + abc[1]*matrix[i+4] + abc[2]*matrix[i+8] + abc[3]*matrix[i+12];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
349 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
350 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
351
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
352
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
353 void translate(float *xyz, float x, float y, float z)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
354 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
355 xyz[0] += x;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
356 xyz[1] += y;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
357 xyz[2] += z;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
358 }
677
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
359
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
360 /**
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
361 * ベクトルに行列を乗算する
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
362 * @param[out] v vector (float[4])
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
363 * @param[in] m matrix (float[16])
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
364 */
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
365 void
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
366 ApplyMatrix(float *v, float *m)
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
367 {
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
368 float t[4];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
369
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
370 t[0] = v[0];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
371 t[1] = v[1];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
372 t[2] = v[2];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
373 t[3] = v[3];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
374
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
375 for (int i = 0; i < 4; i++) {
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
376 v[i] = t[0]*m[i] + t[1]*m[i+4] + t[2]*m[i+8] + t[3]*m[i+12];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
377 }
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
378 }
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
379
1048
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
380 void
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
381 ScaleMatrixXYZ(float *m, float x, float y, float z)
1048
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
382 {
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
383 for(int i=0;i<3;i++) {
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
384 m[i] *= x;
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
385 m[i+4] *= y;
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
386 m[i+8] *= z;
1048
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
387 }
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
388 }
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
389