|
83
|
1 #include <stdio.h>
|
|
|
2 #include <spu_intrinsics.h>
|
|
|
3 #include "CreatePolygonPack.h"
|
|
|
4 #include "polygon_pack.h"
|
|
|
5 #include "scene_graph_pack.h"
|
|
|
6 #include "sys.h"
|
|
|
7
|
|
88
|
8
|
|
|
9 void
|
|
|
10 CreatePolygonPack::read(void)
|
|
|
11 {
|
|
102
|
12 printf("CreatePolgonPack\n");
|
|
88
|
13
|
|
102
|
14 SchedTask::read();
|
|
88
|
15 }
|
|
|
16
|
|
83
|
17 //create_pp(SceneGraphPack *sgp, PolygonPack *pp)
|
|
|
18 //create_pp(void *read, void *write)
|
|
|
19 //CreatePolygonPack::run(SceneGraphPack *sgp, PolygonPack *pp)
|
|
85
|
20 inline float
|
|
|
21 CreatePolygonPack::sum_across_float4(vector float v)
|
|
|
22 {
|
|
102
|
23 vector float c12, c2, c3, c4, c34;
|
|
|
24 vector float result;
|
|
85
|
25
|
|
102
|
26 c2 = spu_rlqwbyte(v, 4);
|
|
|
27 c3 = spu_rlqwbyte(v, 8);
|
|
|
28 c4 = spu_rlqwbyte(v, 12);
|
|
|
29 c12 = spu_add(v, c2);
|
|
|
30 c34 = spu_add(c3, c4);
|
|
85
|
31
|
|
102
|
32 result = spu_add(c12, c34);
|
|
|
33 return (spu_extract(result, 0));
|
|
85
|
34 }
|
|
|
35
|
|
83
|
36 int
|
|
|
37 CreatePolygonPack::run(void *rbuf, void *wbuf)
|
|
|
38 {
|
|
102
|
39 SceneGraphPack *sgp = (SceneGraphPack*)rbuf;
|
|
|
40 PolygonPack *pp = (PolygonPack*)wbuf;
|
|
83
|
41
|
|
102
|
42 float xyz1[4],xyz2[4],xyz3[4];
|
|
83
|
43
|
|
102
|
44 for (int i = 0; i < sgp->info.size; i++) {
|
|
|
45 SceneGraphNodePtr node = &sgp->node[i];
|
|
83
|
46
|
|
102
|
47 int n,nt,pt;
|
|
|
48 for(n=0,nt=0,pt=0; n<node->size*3; n+=9,nt+=6,pt++) {
|
|
|
49 xyz1[0] = node->vertex[n];
|
|
|
50 xyz1[1] = node->vertex[n+1];
|
|
|
51 xyz1[2] = node->vertex[n+2]*-1;
|
|
|
52 xyz1[3] = 1;
|
|
|
53 xyz2[0] = node->vertex[n+3];
|
|
|
54 xyz2[1] = node->vertex[n+3+1];
|
|
|
55 xyz2[2] = node->vertex[n+3+2]*-1;
|
|
|
56 xyz2[3] = 1;
|
|
|
57 xyz3[0] = node->vertex[n+6];
|
|
|
58 xyz3[1] = node->vertex[n+6+1];
|
|
|
59 xyz3[2] = node->vertex[n+6+2]*-1;
|
|
|
60 xyz3[3] = 1;
|
|
83
|
61
|
|
102
|
62 rotate(xyz1, node->translation);
|
|
|
63 rotate(xyz2, node->translation);
|
|
|
64 rotate(xyz3, node->translation);
|
|
83
|
65
|
|
102
|
66 pp->tri[pt].ver1.x = xyz1[0];
|
|
|
67 pp->tri[pt].ver1.y = xyz1[1];
|
|
|
68 pp->tri[pt].ver1.z = xyz1[2];
|
|
|
69 pp->tri[pt].ver1.tex_x = node->texture[nt];
|
|
|
70 pp->tri[pt].ver1.tex_y = node->texture[nt+1];
|
|
83
|
71
|
|
102
|
72 pp->tri[pt].ver2.x = xyz2[0];
|
|
|
73 pp->tri[pt].ver2.y = xyz2[1];
|
|
|
74 pp->tri[pt].ver2.z = xyz2[2];
|
|
|
75 pp->tri[pt].ver2.tex_x = node->texture[nt+2];
|
|
|
76 pp->tri[pt].ver2.tex_y = node->texture[nt+2+1];
|
|
83
|
77
|
|
102
|
78 pp->tri[pt].ver3.x = xyz3[0];
|
|
|
79 pp->tri[pt].ver3.y = xyz3[1];
|
|
|
80 pp->tri[pt].ver3.z = xyz3[2];
|
|
|
81 pp->tri[pt].ver3.tex_x = node->texture[nt+4];
|
|
|
82 pp->tri[pt].ver3.tex_y = node->texture[nt+4+1];
|
|
83
|
83
|
|
102
|
84 pp->tri[pt].tex_width = node->tex_width;
|
|
|
85 pp->tri[pt].tex_height = node->tex_height;
|
|
|
86 }
|
|
|
87 pp->info.size = pt;
|
|
|
88 pp->ssl = sgp->ssl;
|
|
|
89 }
|
|
83
|
90
|
|
102
|
91 return sizeof(PolygonPack);
|
|
83
|
92 }
|
|
|
93
|
|
|
94 void
|
|
|
95 CreatePolygonPack::rotate(float *xyz, float *matrix)
|
|
|
96 {
|
|
87
|
97 #if 1
|
|
102
|
98 float abc[4];
|
|
83
|
99
|
|
102
|
100 abc[0] = xyz[0];
|
|
|
101 abc[1] = xyz[1];
|
|
|
102 abc[2] = xyz[2];
|
|
|
103 abc[3] = xyz[3];
|
|
83
|
104
|
|
102
|
105 // SIMD 使えるよね
|
|
|
106 for (int i=0; i<4; i++)
|
|
|
107 {
|
|
|
108 xyz[i] = abc[0]*matrix[i] + abc[1]*matrix[i+4] + abc[2]*matrix[i+8] + abc[3]*matrix[i+12];
|
|
|
109 }
|
|
83
|
110 #else
|
|
102
|
111 vector float *abc = (vector float *)xyz;
|
|
|
112 float tmp[4];
|
|
83
|
113
|
|
102
|
114 vector float matrixT0 = (vector float){matrix[0], matrix[4], matrix[8], matrix[12]};
|
|
|
115 vector float matrixT1 = (vector float){matrix[1], matrix[5], matrix[9], matrix[13]};
|
|
|
116 vector float matrixT2 = (vector float){matrix[2], matrix[6], matrix[10], matrix[14]};
|
|
|
117 vector float matrixT3 = (vector float){matrix[3], matrix[7], matrix[11], matrix[15]};
|
|
83
|
118
|
|
85
|
119 #if 1
|
|
102
|
120 vector float *v_tmp = (vector float *)tmp;
|
|
85
|
121
|
|
102
|
122 *v_tmp = spu_mul(*abc, matrixT0);
|
|
|
123 xyz[0] = tmp[0] + tmp[1] + tmp[2] + tmp[3];
|
|
|
124 *v_tmp = spu_mul(*abc, matrixT1);
|
|
|
125 xyz[1] = tmp[0] + tmp[1] + tmp[2] + tmp[3];
|
|
|
126 *v_tmp = spu_mul(*abc, matrixT2);
|
|
|
127 xyz[2] = tmp[0] + tmp[1] + tmp[2] + tmp[3];
|
|
|
128 *v_tmp = spu_mul(*abc, matrixT3);
|
|
|
129 xyz[3] = tmp[0] + tmp[1] + tmp[2] + tmp[3];
|
|
85
|
130 #else
|
|
102
|
131 vector float v_tmp;
|
|
85
|
132
|
|
102
|
133 v_tmp = spu_mul(*abc, matrixT0);
|
|
|
134 xyz[0] = sum_across_float4(v_tmp);
|
|
|
135 v_tmp = spu_mul(*abc, matrixT1);
|
|
|
136 xyz[1] = sum_across_float4(v_tmp);
|
|
|
137 v_tmp = spu_mul(*abc, matrixT2);
|
|
|
138 xyz[2] = sum_across_float4(v_tmp);
|
|
|
139 v_tmp = spu_mul(*abc, matrixT3);
|
|
|
140 xyz[3] = sum_across_float4(v_tmp);
|
|
85
|
141 #endif
|
|
83
|
142 #endif
|
|
|
143
|
|
|
144 }
|
|
|
145
|
|
|
146 SchedTask*
|
|
|
147 createTask_createPolygonPack(TaskListPtr _taskList, TaskPtr _task,
|
|
|
148 void *rbuff, void *wbuff, DmaManager *dma)
|
|
|
149 {
|
|
102
|
150 //rbuff = memalign(16, sizeof(SceneGraphPack));
|
|
|
151 //wbuff = memalign(16, sizeof(PolygonPack));
|
|
|
152
|
|
|
153 return new CreatePolygonPack(_taskList, _task, rbuff, wbuff, dma);
|
|
83
|
154 }
|
