annotate Renderer/Engine/matrix_calc.cc @ 1226:636dfdc30176 draft

new API for SceneGraph
author Shinji KONO <kono@ie.u-ryukyu.ac.jp>
date Sun, 31 Jul 2011 10:20:46 +0900
parents ab8ed4d1d211
children 34944900f266 e92f00ed2fc0
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 noMoreMemory()
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
9 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
10 cout << "can't allocate memory\n";
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
11 exit(1);
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
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
14 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
15 transMatrix(float *m0, float *m1, float *v)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
16 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
17 memcpy(m0, m1, sizeof(float)*16);
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 m0[12] = m1[12] + v[0];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
20 m0[13] = m1[13] + v[1];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
21 m0[14] = m1[14] + v[2];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
22 m0[15] = m1[15] + v[3];
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
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
25 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
26 unitMatrix(float *m)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
27 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
28 bzero(m, sizeof(float)*16);
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 m[0] = 1.0f;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
31 m[5] = 1.0f;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
32 m[10] = 1.0f;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
33 m[15] = 1.0f;
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
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
36 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
37 inversMatrix(float *m0, float *m1)
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 float m[16];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
40
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
41 for (int i = 0; i < 4; i++) {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
42 for (int j = 0; j < 4; j++) {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
43 m[i*4+j] = m1[j*4+i];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
44 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
45 }
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 m[12] = -(m1[12]*m[0] + m1[13]*m[1] + m1[14]*m[2]);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
48 m[13] = -(m1[12]*m[4] + m1[13]*m[5] + m1[14]*m[6]);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
49 m[14] = -(m1[12]*m[8] + m1[13]*m[9] + m1[14]*m[10]);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
50 m[3] = m[7] = m[11] = 0.0f;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
51 m[15] = 1.0f;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
52
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
53 memcpy(m0, m, sizeof(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
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
56 /**
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
57 * マトリックス m にベクトル v1 を右から乗算して、v0に与える
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
58 * @param[out] v0 output vector (float[4])
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
59 * @param[in] v1 input vector (float[4])
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
60 * @param[in] m matrix (float[16])
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 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
63 applyMatrix(float *v0, float *m, float *v1)
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 for (int i = 0; i < 4; i++) {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
66 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
67 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
68 }
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 /**
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
71 * ベクトルの正規化
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 * @param[out] v0 output vector
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
74 * @param[in] v1 input vector
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
75 */
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
76 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
77 normalize(float *v0, float *v1)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
78 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
79 float norm, dnorm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
80
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
81 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
82 if (norm > 0) {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
83 dnorm = 1.0/norm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
84 v0[0] = v1[0]*dnorm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
85 v0[1] = v1[1]*dnorm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
86 v0[2] = v1[2]*dnorm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
87 v0[3] = v1[3]*dnorm;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
88 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
89 }
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 /**
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
92 * ベクトルの減算 v0 = v1 - v2
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
93 */
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
94 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
95 subVector(float *v0, float *v1, float *v2)
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 v0[0] = v1[0] - v2[0];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
98 v0[1] = v1[1] - v2[1];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
99 v0[2] = v1[2] - v2[2];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
100 v0[3] = v1[3] - v2[3];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
101 }
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 /**
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
104 * ベクトルの外積 v0 = v1 x v2
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
105 */
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
106 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
107 outerProduct(float *v0, float *v1, float *v2)
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 v0[0] = v1[1] * v2[2] - v1[2] * v2[1];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
110 v0[1] = v1[2] * v2[0] - v1[0] * v2[2];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
111 v0[2] = v1[0] * v2[1] - v1[1] * v2[0];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
112 v0[3] = 0;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
113 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
114
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
115 void
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
116 transposeMatrix(float *m0, float *m1)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
117 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
118 float t[16];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
119
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
120 for (int i = 0; i < 4; i++) {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
121 for (int j = 0; j < 4; j++) {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
122 t[i*4+j] = m1[j*4+i];
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
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
126 memcpy(m0, t, sizeof(float)*16);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
127 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
128
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 * ベクトルの内積 f = v0 * v1
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 float
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
133 innerProduct(float *v0, float *v1)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
134 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
135 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
136 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
137
1094
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
138 /**
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
139 * xyz = xyz1 * xyz2
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
140 */
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
141 void matrix4x4(float *xyz, float *xyz1, float *xyz2) //xyz[16]
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
142 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
143 for(int t=0; t<16; t+=4)
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 for(int i=0; i<4; i++)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
146 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
147 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
148 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
149 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
150 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
151
1047
f87218eed9fc broken texure ( h/w != 2^n ) protection
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 677
diff changeset
152 /**
1094
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
153 * c_xyz を中心に sacle 倍する
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
154 */
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
155 void
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
156 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
157 {
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
158 float xyz2[16] = {
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
159 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
160 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
161 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
162 0, 0, 0, 1
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 };
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
165 float xyz1[16] = {
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
166 xyz[0], xyz[1], xyz[2], xyz[3],
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
167 xyz[4], xyz[5], xyz[6], xyz[7],
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
168 xyz[8], xyz[9], xyz[10], xyz[11],
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
169 xyz[12], xyz[13], xyz[14], xyz[15]};
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 for(int t=0; t<16; t+=4)
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
172 {
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
173 for(int i=0; i<4; i++)
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
174 {
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
175 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
176 }
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
177 }
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
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
180 /**
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
181 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
182 行ったものを matrix に代入する
f87218eed9fc broken texure ( h/w != 2^n ) protection
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 677
diff changeset
183 */
f87218eed9fc broken texure ( h/w != 2^n ) protection
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 677
diff changeset
184 void
1094
f10ec9bbd3f6 separate scale matrix
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1051
diff changeset
185 get_matrix( float *matrix, float *rxyz, float *txyz, float *stack)
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
186 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
187 float radx,rady,radz;
1226
636dfdc30176 new API for SceneGraph
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1165
diff changeset
188 radx = rxyz[0]*3.141562/180;
636dfdc30176 new API for SceneGraph
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1165
diff changeset
189 rady = rxyz[1]*3.141562/180;
636dfdc30176 new API for SceneGraph
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1165
diff changeset
190 radz = rxyz[2]*3.141562/180;
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
191
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
192 float sinx = sin(radx);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
193 float cosx = cos(radx);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
194 float siny = sin(rady);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
195 float cosy = cos(rady);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
196 float sinz = sin(radz);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
197 float cosz = cos(radz);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
198
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
199 float m1[16];
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
200 float *m = stack? m1 : matrix;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
201
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
202 /* View Transform */
1051
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
203 m[0] = cosz*cosy+sinz*sinx*siny;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
204 m[1] = sinz*cosx;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
205 m[2] = -cosz*siny+sinz*sinx*cosy;
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
206 m[3] = 0;
1051
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
207 m[4] = -sinz*cosy+cosz*sinx*siny;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
208 m[5] = cosz*cosx;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
209 m[6] = sinz*siny+cosz*sinx*cosy;
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
210 m[7] = 0;
1051
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
211 m[8] = cosx*siny;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
212 m[9] = -sinx;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1050
diff changeset
213 m[10] = cosx*cosy;
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
214 m[11] = 0;
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
215 m[12] = txyz[0];
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
216 m[13] = txyz[1];
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
217 m[14] = txyz[2];
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
218 m[15] = 1;
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
219
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
220 if(stack)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
221 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
222 matrix4x4(matrix, m, stack);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
223 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
224
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
1165
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
227 void
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
228 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
229 {
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
230 float radx,rady,radz;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
231 radx = rxyz[0]*3.14/180;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
232 rady = rxyz[1]*3.14/180;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
233 radz = rxyz[2]*3.14/180;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
234
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
235 float sinx = sin(radx)*scale[0];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
236 float cosx = cos(radx)*scale[0];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
237 float siny = sin(rady)*scale[1];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
238 float cosy = cos(rady)*scale[1];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
239 float sinz = sin(radz)*scale[2];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
240 float cosz = cos(radz)*scale[2];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
241
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
242 float m1[16];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
243 float *m = stack? m1 : matrix;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
244
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
245 /* View Transform */
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
246 m[0] = cosz*cosy+sinz*sinx*siny;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
247 m[1] = sinz*cosx;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
248 m[2] = -cosz*siny+sinz*sinx*cosy;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
249 m[3] = 0;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
250 m[4] = -sinz*cosy+cosz*sinx*siny;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
251 m[5] = cosz*cosx;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
252 m[6] = sinz*siny+cosz*sinx*cosy;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
253 m[7] = 0;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
254 m[8] = cosx*siny;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
255 m[9] = -sinx;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
256 m[10] = cosx*cosy;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
257 m[11] = 0;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
258 m[12] = txyz[0];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
259 m[13] = txyz[1];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
260 m[14] = txyz[2];
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
261 m[15] = 1;
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
262
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
263 if(stack)
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
264 {
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
265 matrix4x4(matrix, m, stack);
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
266 }
ab8ed4d1d211 get_matrix_scale
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1098
diff changeset
267
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
539
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
270 void rotate_x(float *xyz, float r)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
271 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
272 float rad = r*3.14/180;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
273
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
274 xyz[0] = xyz[0];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
275 xyz[1] = xyz[1]*cos(rad) - xyz[2]*sin(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
276 xyz[2] = xyz[1]*sin(rad) + xyz[2]*cos(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
277 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
278
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
279 void rotate_y(float *xyz, float r)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
280 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
281 float rad = r*3.14/180;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
282
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
283 xyz[0] = xyz[0]*cos(rad) + xyz[2]*sin(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
284 xyz[1] = xyz[1];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
285 xyz[2] = -xyz[0]*sin(rad) + xyz[2]*cos(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
286 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
287
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
288 void rotate_z(float *xyz, float r)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
289 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
290 float rad = r*3.14/180;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
291
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
292 xyz[0] = xyz[0]*cos(rad) - xyz[1]*sin(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
293 xyz[1] = xyz[0]*sin(rad) + xyz[1]*cos(rad);
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
294 xyz[2] = xyz[2];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
295 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
296
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
297 void rotate(float *xyz, float *matrix)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
298 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
299 float abc[4];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
300 abc[0] = xyz[0];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
301 abc[1] = xyz[1];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
302 abc[2] = xyz[2];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
303 abc[3] = xyz[3];
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
304
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
305 for(int i=0; i<4; i++)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
306 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
307 //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
308 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
309 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
310 }
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
311
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
312
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
313 void translate(float *xyz, float x, float y, float z)
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
314 {
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
315 xyz[0] += x;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
316 xyz[1] += y;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
317 xyz[2] += z;
3bc98f6d31ff Reorganization..
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents:
diff changeset
318 }
677
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
319
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
320 /**
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
321 * ベクトルに行列を乗算する
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
322 * @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
323 * @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
324 */
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
325 void
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
326 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
327 {
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
328 float t[4];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
329
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
330 t[0] = v[0];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
331 t[1] = v[1];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
332 t[2] = v[2];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
333 t[3] = v[3];
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
334
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
335 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
336 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
337 }
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
338 }
24054155368c add Load light info for some spe
yutaka@henri.cr.ie.u-ryukyu.ac.jp
parents: 539
diff changeset
339
1048
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
340 void
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
341 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
342 {
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
343 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
344 m[i] *= x;
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
345 m[i+4] *= y;
1050
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1048
diff changeset
346 m[i+8] *= z;
1048
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
347 }
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
348 }
5e62924bd7d9 add ScaleXY (not for allExecute...)
Shinji KONO <kono@ie.u-ryukyu.ac.jp>
parents: 1047
diff changeset
349