Mercurial > hg > Members > e085722 > Cerium
comparison Renderer/Engine/task/CreatePolygonFromSceneGraph.cc @ 0:04e28d8d3c6f
first commit
author | Daiki KINJYO <e085722@ie.u-ryukyu.ac.jp> |
---|---|
date | Mon, 08 Nov 2010 01:23:25 +0900 |
parents | |
children |
comparison
equal
deleted
inserted
replaced
-1:000000000000 | 0:04e28d8d3c6f |
---|---|
1 /** | |
2 * SceneGraph が増えてくると動かなくなるかもしれない。 | |
3 * 一応 mainMem とかで動くようになるとは思うけど。 | |
4 * だめだったら、そこら辺が怪しいと思うべき | |
5 */ | |
6 | |
7 #include "CreatePolygonFromSceneGraph.h" | |
8 #include "polygon_pack.h" | |
9 #include "scene_graph_pack.h" | |
10 | |
11 SchedDefineTask(CreatePolygonFromSceneGraph); | |
12 | |
13 #define SG_PACK_LOAD 10 | |
14 #define SG_NODE_LOAD 11 | |
15 #define PP_LOAD 12 | |
16 #define PP_STORE 13 | |
17 | |
18 /** | |
19 * ベクトルに行列を乗算する | |
20 * @param[out] v vector (float[4]) | |
21 * @param[in] m matrix (float[16]) | |
22 */ | |
23 static void | |
24 ApplyMatrix(float *v, float *m) | |
25 { | |
26 float t[4]; | |
27 | |
28 t[0] = v[0]; | |
29 t[1] = v[1]; | |
30 t[2] = v[2]; | |
31 t[3] = v[3]; | |
32 | |
33 for (int i = 0; i < 4; i++) { | |
34 v[i] = t[0]*m[i] + t[1]*m[i+4] + t[2]*m[i+8] + t[3]*m[i+12]; | |
35 } | |
36 } | |
37 | |
38 static void | |
39 ApplyNormalMatrix(float *v, float *m) | |
40 { | |
41 float t[4]; | |
42 | |
43 t[0] = v[0]; | |
44 t[1] = v[1]; | |
45 t[2] = v[2]; | |
46 | |
47 for (int i = 0; i < 3; i++) { | |
48 v[i] = t[0]*m[i] + t[1]*m[i+4] + t[2]*m[i+8]; | |
49 } | |
50 } | |
51 | |
52 | |
53 /** | |
54 * 行列の積 | |
55 * | |
56 * @param[out] m0 output matrix | |
57 * @param[in] m1 input left matrix | |
58 * @param[in] m2 input right matrix | |
59 */ | |
60 /* | |
61 static void | |
62 MulMatrix(float *m0, float *m1, float *m2) //xyz[16] | |
63 { | |
64 for(int t = 0; t < 16; t += 4) { | |
65 for (int i = 0; i < 4; i++) { | |
66 m0[t+i] = | |
67 m1[t+0]*m2[ i ] + m1[t+1]*m2[i+ 4] + | |
68 m1[t+2]*m2[i+8] + m1[t+3]*m2[i+12]; | |
69 } | |
70 } | |
71 } | |
72 */ | |
73 static int | |
74 run(SchedTask *smanager, void *rbuf, void *wbuf) | |
75 { | |
76 | |
77 | |
78 float xyz1[4], xyz2[4], xyz3[4]; | |
79 float normal1[4],normal2[4],normal3[4]; | |
80 | |
81 SceneGraphPtr sg_top = (SceneGraphPtr)smanager->get_param(0); | |
82 SceneGraphPtr sg = sg_top; | |
83 | |
84 PolygonPackPtr pp | |
85 = (PolygonPackPtr)smanager->allocate(sizeof(PolygonPack)); | |
86 PolygonPackPtr send_pp | |
87 = (PolygonPackPtr)smanager->allocate(sizeof(PolygonPack)); | |
88 PolygonPackPtr pp_addr = (PolygonPackPtr)smanager->get_param(1); | |
89 PolygonPackPtr tmp_pp; | |
90 | |
91 pp->init(); | |
92 send_pp->init(); | |
93 | |
94 while (sg) { | |
95 if (sg->flag_drawable) { // sg->isDrawable() とかの方がよくね? | |
96 for (int i = 0; i < sg->size; i += 3) { | |
97 if (pp->info.size >= MAX_SIZE_TRIANGLE) { | |
98 PolygonPackPtr next; | |
99 | |
100 smanager->mainMem_alloc(0, sizeof(PolygonPack)); | |
101 smanager->mainMem_wait(); | |
102 next = (PolygonPackPtr)smanager->mainMem_get(0); | |
103 | |
104 pp->next = next; | |
105 | |
106 tmp_pp = pp; | |
107 pp = send_pp; | |
108 send_pp = tmp_pp; | |
109 | |
110 smanager->dma_wait(PP_STORE); | |
111 smanager->dma_store(send_pp, (memaddr)pp_addr, | |
112 sizeof(PolygonPack), PP_STORE); | |
113 | |
114 pp_addr = next; | |
115 | |
116 smanager->dma_wait(PP_LOAD); | |
117 smanager->dma_load(pp, (memaddr)pp_addr, | |
118 sizeof(PolygonPack), PP_LOAD); | |
119 smanager->dma_wait(PP_LOAD); | |
120 pp->init(); | |
121 } | |
122 | |
123 TrianglePack *triangle = &pp->tri[pp->info.size++]; | |
124 | |
125 xyz1[0] = sg->coord_xyz[(i+0)*3]; | |
126 xyz1[1] = sg->coord_xyz[(i+0)*3+1]; | |
127 xyz1[2] = sg->coord_xyz[(i+0)*3+2]*-1.0f; | |
128 xyz1[3] = 1.0f; | |
129 | |
130 xyz2[0] = sg->coord_xyz[(i+1)*3]; | |
131 xyz2[1] = sg->coord_xyz[(i+1)*3+1]; | |
132 xyz2[2] = sg->coord_xyz[(i+1)*3+2]*-1.0f; | |
133 xyz2[3] = 1.0f; | |
134 | |
135 xyz3[0] = sg->coord_xyz[(i+2)*3]; | |
136 xyz3[1] = sg->coord_xyz[(i+2)*3+1]; | |
137 xyz3[2] = sg->coord_xyz[(i+2)*3+2]*-1.0f; | |
138 xyz3[3] = 1.0f; | |
139 | |
140 // sg->matrix = 回転行列*透視変換行列 | |
141 ApplyMatrix(xyz1, sg->matrix); | |
142 ApplyMatrix(xyz2, sg->matrix); | |
143 ApplyMatrix(xyz3, sg->matrix); | |
144 | |
145 xyz1[0] /= xyz1[2]; | |
146 xyz1[1] /= xyz1[2]; | |
147 xyz2[0] /= xyz2[2]; | |
148 xyz2[1] /= xyz2[2]; | |
149 xyz3[0] /= xyz3[2]; | |
150 xyz3[1] /= xyz3[2]; | |
151 | |
152 triangle->ver1.x = xyz1[0]; | |
153 triangle->ver1.y = xyz1[1]; | |
154 triangle->ver1.z = xyz1[2]; | |
155 triangle->ver1.tex_x = sg->coord_tex[(i+0)*3]; | |
156 triangle->ver1.tex_y = sg->coord_tex[(i+0)*3+1]; | |
157 | |
158 triangle->ver2.x = xyz2[0]; | |
159 triangle->ver2.y = xyz2[1]; | |
160 triangle->ver2.z = xyz2[2]; | |
161 triangle->ver2.tex_x = sg->coord_tex[(i+1)*3]; | |
162 triangle->ver2.tex_y = sg->coord_tex[(i+1)*3+1]; | |
163 | |
164 triangle->ver3.x = xyz3[0]; | |
165 triangle->ver3.y = xyz3[1]; | |
166 triangle->ver3.z = xyz3[2]; | |
167 triangle->ver3.tex_x = sg->coord_tex[(i+2)*3]; | |
168 triangle->ver3.tex_y = sg->coord_tex[(i+2)*3+1]; | |
169 | |
170 normal1[0] = sg->normal[(i+0)*3]; | |
171 normal1[1] = sg->normal[(i+0)*3+1]; | |
172 normal1[2] = sg->normal[(i+0)*3+2]*-1.0f; | |
173 //normal1[3] = 1.0f; | |
174 normal1[3] = 0.0f; | |
175 | |
176 normal2[0] = sg->normal[(i+1)*3]; | |
177 normal2[1] = sg->normal[(i+1)*3+1]; | |
178 normal2[2] = sg->normal[(i+1)*3+2]*-1.0f; | |
179 //normal2[3] = 1.0f; | |
180 normal2[3] = 0.0f; | |
181 | |
182 normal3[0] = sg->normal[(i+2)*3]; | |
183 normal3[1] = sg->normal[(i+2)*3+1]; | |
184 normal3[2] = sg->normal[(i+2)*3+2]*-1.0f; | |
185 //normal3[3] = 1.0f; | |
186 normal3[3] = 0.0f; | |
187 | |
188 ApplyNormalMatrix(normal1,sg->real_matrix); | |
189 ApplyNormalMatrix(normal2,sg->real_matrix); | |
190 ApplyNormalMatrix(normal3,sg->real_matrix); | |
191 | |
192 normal1[0] /= normal1[2]; | |
193 normal1[1] /= normal1[2]; | |
194 | |
195 normal2[0] /= normal2[2]; | |
196 normal2[1] /= normal2[2]; | |
197 | |
198 normal3[0] /= normal3[2]; | |
199 normal3[1] /= normal3[2]; | |
200 | |
201 triangle->normal1.x = normal1[0]; | |
202 triangle->normal1.y = normal1[1]; | |
203 triangle->normal1.z = normal1[2]; | |
204 | |
205 triangle->normal2.x = normal2[0]; | |
206 triangle->normal2.y = normal2[1]; | |
207 triangle->normal2.z = normal2[2]; | |
208 | |
209 triangle->normal3.x = normal3[0]; | |
210 triangle->normal3.y = normal3[1]; | |
211 triangle->normal3.z = normal3[2]; | |
212 | |
213 triangle->tex_info.addr = sg->texture_info.pixels; | |
214 triangle->tex_info.width = sg->texture_info.t_w; | |
215 triangle->tex_info.height = sg->texture_info.t_h; | |
216 triangle->tex_info.scale_max = sg->texture_info.scale_max; | |
217 } | |
218 } | |
219 | |
220 if (sg->children != NULL) { | |
221 sg = sg->children; | |
222 } else if (sg->brother != NULL) { | |
223 sg = sg->brother; | |
224 } else { | |
225 while (sg) { | |
226 if (sg->brother != NULL) { | |
227 sg = sg->brother; | |
228 break; | |
229 } else { | |
230 if (sg->parent == NULL) { | |
231 sg = NULL; | |
232 break; | |
233 } else { | |
234 sg = sg->parent; | |
235 } | |
236 } | |
237 } | |
238 } | |
239 } | |
240 | |
241 smanager->dma_wait(PP_STORE); | |
242 smanager->dma_store(pp, (memaddr)pp_addr, | |
243 sizeof(PolygonPack), PP_STORE); | |
244 smanager->dma_wait(PP_STORE); | |
245 | |
246 free(pp); | |
247 free(send_pp); | |
248 | |
249 return 0; | |
250 | |
251 } |