]> git.xonotic.org Git - xonotic/darkplaces.git/blob - dpsoftrast.c
implemented Texture_UpdatePartial
[xonotic/darkplaces.git] / dpsoftrast.c
1
2 #include <stdio.h>
3 #include <string.h>
4 #define _USE_MATH_DEFINES
5 #include <math.h>
6 #include "quakedef.h"
7 #include "dpsoftrast.h"
8
9 #ifndef __cplusplus
10 typedef qboolean bool;
11 #endif
12
13 #if defined(__GNUC__)
14 #define ALIGN(var) var __attribute__((__aligned__(16)))
15 #elif defined(_MSC_VER)
16 #define ALIGN(var) __declspec(align(16)) var
17 #else
18 #define ALIGN(var) var
19 #endif
20
21 #ifdef SSE2_PRESENT
22 #include <emmintrin.h>
23
24 #define MM_MALLOC(size) _mm_malloc(size, 16)
25
26 static void *MM_CALLOC(size_t nmemb, size_t size)
27 {
28         void *ptr = _mm_malloc(nmemb*size, 16);
29         if(ptr != NULL) memset(ptr, 0, nmemb*size);
30         return ptr;
31 }
32
33 #define MM_FREE _mm_free
34 #else
35 #define MM_MALLOC(size) malloc(size)
36 #define MM_CALLOC(nmemb, size) calloc(nmemb, size)
37 #define MM_FREE free
38 #endif
39
40 typedef enum DPSOFTRAST_ARRAY_e
41 {
42         DPSOFTRAST_ARRAY_POSITION,
43         DPSOFTRAST_ARRAY_COLOR,
44         DPSOFTRAST_ARRAY_TEXCOORD0,
45         DPSOFTRAST_ARRAY_TEXCOORD1,
46         DPSOFTRAST_ARRAY_TEXCOORD2,
47         DPSOFTRAST_ARRAY_TEXCOORD3,
48         DPSOFTRAST_ARRAY_TEXCOORD4,
49         DPSOFTRAST_ARRAY_TEXCOORD5,
50         DPSOFTRAST_ARRAY_TEXCOORD6,
51         DPSOFTRAST_ARRAY_TEXCOORD7,
52         DPSOFTRAST_ARRAY_TOTAL
53 }
54 DPSOFTRAST_ARRAY;
55
56 typedef struct DPSOFTRAST_Texture_s
57 {
58         int flags;
59         int width;
60         int height;
61         int depth;
62         int sides;
63         DPSOFTRAST_TEXTURE_FILTER filter;
64         int mipmaps;
65         int size;
66         unsigned char *bytes;
67         int mipmap[DPSOFTRAST_MAXMIPMAPS][5];
68 }
69 DPSOFTRAST_Texture;
70
71 typedef struct DPSOFTRAST_State_User_s
72 {
73         int colormask[4];
74         int blendfunc[2];
75         int blendsubtract;
76         int depthmask;
77         int depthtest;
78         int depthfunc;
79         int scissortest;
80         int cullface;
81         int alphatest;
82         int alphafunc;
83         float alphavalue;
84         int scissor[4];
85         int viewport[4];
86         float depthrange[2];
87         float polygonoffset[2];
88         float color[4];
89 }
90 DPSOFTRAST_State_User;
91
92 #define DPSOFTRAST_MAXSUBSPAN 16
93
94 typedef ALIGN(struct DPSOFTRAST_State_Draw_Span_s
95 {
96         int start; // pixel index
97         int length; // pixel count
98         int startx; // usable range (according to pixelmask)
99         int endx; // usable range (according to pixelmask)
100         unsigned char mip[DPSOFTRAST_MAXTEXTUREUNITS]; // texcoord to screen space density values (for picking mipmap of textures)
101         unsigned char *pixelmask; // true for pixels that passed depth test, false for others
102         // [0][n][] is start interpolant values (projected)
103         // [1][n][] is end interpolant values (projected)
104         // [0][DPSOFTRAST_ARRAY_TOTAL][] is start screencoord4f
105         // [1][DPSOFTRAST_ARRAY_TOTAL][] is end screencoord4f
106         // NOTE: screencoord4f[3] is W (basically 1/Z), useful for depthbuffer
107         ALIGN(float data[2][DPSOFTRAST_ARRAY_TOTAL+1][4]);
108 }
109 DPSOFTRAST_State_Draw_Span);
110
111 #define DPSOFTRAST_DRAW_MAXSPANQUEUE 1024
112
113 typedef struct DPSOFTRAST_State_Draw_s
114 {
115         int numvertices;
116         int maxvertices;
117         float *in_array4f[DPSOFTRAST_ARRAY_TOTAL];
118         float *post_array4f[DPSOFTRAST_ARRAY_TOTAL];
119         float *screencoord4f;
120
121         // spans are queued in this structure for dispatch to the pixel shader,
122         // partly to improve cache locality, partly for batching purposes, spans
123         // are flushed before DrawTriangles returns to caller
124         int numspans;
125         DPSOFTRAST_State_Draw_Span spanqueue[DPSOFTRAST_DRAW_MAXSPANQUEUE];
126 }
127 DPSOFTRAST_State_Draw;
128
129 #define DPSOFTRAST_VALIDATE_FB 1
130 #define DPSOFTRAST_VALIDATE_DEPTHFUNC 2
131 #define DPSOFTRAST_VALIDATE_BLENDFUNC 4
132 #define DPSOFTRAST_VALIDATE_DRAW (DPSOFTRAST_VALIDATE_FB | DPSOFTRAST_VALIDATE_DEPTHFUNC | DPSOFTRAST_VALIDATE_BLENDFUNC)
133
134 typedef enum DPSOFTRAST_BLENDMODE_e
135 {
136         DPSOFTRAST_BLENDMODE_OPAQUE,
137         DPSOFTRAST_BLENDMODE_ALPHA,
138         DPSOFTRAST_BLENDMODE_ADDALPHA,
139         DPSOFTRAST_BLENDMODE_ADD,
140         DPSOFTRAST_BLENDMODE_INVMOD,
141         DPSOFTRAST_BLENDMODE_MUL,
142         DPSOFTRAST_BLENDMODE_MUL2,
143         DPSOFTRAST_BLENDMODE_SUBALPHA,
144         DPSOFTRAST_BLENDMODE_PSEUDOALPHA,
145         DPSOFTRAST_BLENDMODE_TOTAL
146 }
147 DPSOFTRAST_BLENDMODE;
148
149 typedef ALIGN(struct DPSOFTRAST_State_s
150 {
151         // DPSOFTRAST_VALIDATE_ flags
152         int validate;
153
154         int fb_colormask;
155         int fb_width;
156         int fb_height;
157         unsigned int *fb_depthpixels;
158         unsigned int *fb_colorpixels[4];
159
160         const float *pointer_vertex3f;
161         const float *pointer_color4f;
162         const unsigned char *pointer_color4ub;
163         const float *pointer_texcoordf[DPSOFTRAST_MAXTEXCOORDARRAYS];
164         int stride_vertex;
165         int stride_color;
166         int stride_texcoord[DPSOFTRAST_MAXTEXCOORDARRAYS];
167         int components_texcoord[DPSOFTRAST_MAXTEXCOORDARRAYS];
168         DPSOFTRAST_Texture *texbound[DPSOFTRAST_MAXTEXTUREUNITS];
169
170         int shader_mode;
171         int shader_permutation;
172         ALIGN(float uniform4f[DPSOFTRAST_UNIFORM_TOTAL*4]);
173         int uniform1i[DPSOFTRAST_UNIFORM_TOTAL];
174
175         // derived values (DPSOFTRAST_VALIDATE_FB)
176         int fb_clearscissor[4];
177         int fb_viewport[4];
178         int fb_viewportscissor[4];
179         ALIGN(float fb_viewportcenter[4]);
180         ALIGN(float fb_viewportscale[4]);
181
182         // derived values (DPSOFTRAST_VALIDATE_DEPTHFUNC)
183         int fb_depthfunc;
184
185         // derived values (DPSOFTRAST_VALIDATE_BLENDFUNC)
186         int fb_blendmode;
187
188         int texture_max;
189         int texture_end;
190         int texture_firstfree;
191         DPSOFTRAST_Texture *texture;
192
193         int bigendian;
194
195         // error reporting
196         const char *errorstring;
197
198         DPSOFTRAST_State_User user;
199
200         DPSOFTRAST_State_Draw draw;
201 }
202 DPSOFTRAST_State);
203
204 DPSOFTRAST_State dpsoftrast;
205
206 extern int dpsoftrast_test;
207
208 #define DPSOFTRAST_DEPTHSCALE (1024.0f*1048576.0f)
209 #define DPSOFTRAST_DEPTHOFFSET (128.0f)
210 #define DPSOFTRAST_BGRA8_FROM_RGBA32F(r,g,b,a) (((int)(r * 255.0f + 0.5f) << 16) | ((int)(g * 255.0f + 0.5f) << 8) | (int)(b * 255.0f + 0.5f) | ((int)(a * 255.0f + 0.5f) << 24))
211 #define DPSOFTRAST_DEPTH32_FROM_DEPTH32F(d) ((int)(DPSOFTRAST_DEPTHSCALE * (1-d)))
212 #define DPSOFTRAST_DRAW_MAXSPANLENGTH 256
213
214 void DPSOFTRAST_RecalcFB(void)
215 {
216         // calculate framebuffer scissor, viewport, viewport clipped by scissor,
217         // and viewport projection values
218         int x1, x2, x3, x4, x5, x6;
219         int y1, y2, y3, y4, y5, y6;
220         x1 = dpsoftrast.user.scissor[0];
221         x2 = dpsoftrast.user.scissor[0] + dpsoftrast.user.scissor[2];
222         x3 = dpsoftrast.user.viewport[0];
223         x4 = dpsoftrast.user.viewport[0] + dpsoftrast.user.viewport[2];
224         y1 = dpsoftrast.fb_height - dpsoftrast.user.scissor[1] - dpsoftrast.user.scissor[3];
225         y2 = dpsoftrast.fb_height - dpsoftrast.user.scissor[1];
226         y3 = dpsoftrast.fb_height - dpsoftrast.user.viewport[1] - dpsoftrast.user.viewport[3];
227         y4 = dpsoftrast.fb_height - dpsoftrast.user.viewport[1];
228         if (!dpsoftrast.user.scissortest) {x1 = 0;y1 = 0;x2 = dpsoftrast.fb_width;y2 = dpsoftrast.fb_height;}
229         if (x1 < 0) x1 = 0;
230         if (x2 > dpsoftrast.fb_width) x2 = dpsoftrast.fb_width;
231         if (x3 < 0) x1 = 0;
232         if (x4 > dpsoftrast.fb_width) x4 = dpsoftrast.fb_width;
233         if (y1 < 0) y1 = 0;
234         if (y2 > dpsoftrast.fb_height) y2 = dpsoftrast.fb_height;
235         if (y3 < 0) y1 = 0;
236         if (y4 > dpsoftrast.fb_height) y4 = dpsoftrast.fb_height;
237         x5 = x1;if (x5 < x3) x5 = x3;
238         x6 = x2;if (x6 > x4) x4 = x4;
239         y5 = y1;if (y5 < y3) y5 = y3;
240         y6 = y2;if (y6 > y4) y6 = y4;
241         dpsoftrast.fb_clearscissor[0] = x1;
242         dpsoftrast.fb_clearscissor[1] = y1;
243         dpsoftrast.fb_clearscissor[2] = x2 - x1;
244         dpsoftrast.fb_clearscissor[3] = y2 - y1;
245         dpsoftrast.fb_viewport[0] = x3;
246         dpsoftrast.fb_viewport[1] = y3;
247         dpsoftrast.fb_viewport[2] = x4 - x3;
248         dpsoftrast.fb_viewport[3] = y4 - y3;
249         dpsoftrast.fb_viewportscissor[0] = x5;
250         dpsoftrast.fb_viewportscissor[1] = y5;
251         dpsoftrast.fb_viewportscissor[2] = x6 - x5;
252         dpsoftrast.fb_viewportscissor[3] = y6 - y5;
253         dpsoftrast.fb_viewportcenter[1] = dpsoftrast.user.viewport[0] + 0.5f * dpsoftrast.user.viewport[2] - 0.5f;
254         dpsoftrast.fb_viewportcenter[2] = dpsoftrast.fb_height - dpsoftrast.user.viewport[1] - 0.5f * dpsoftrast.user.viewport[3] - 0.5f;
255         dpsoftrast.fb_viewportcenter[3] = 0.5f;
256         dpsoftrast.fb_viewportcenter[0] = 0.0f;
257         dpsoftrast.fb_viewportscale[1] = 0.5f * dpsoftrast.user.viewport[2];
258         dpsoftrast.fb_viewportscale[2] = -0.5f * dpsoftrast.user.viewport[3];
259         dpsoftrast.fb_viewportscale[3] = 0.5f;
260         dpsoftrast.fb_viewportscale[0] = 1.0f;
261 }
262
263 void DPSOFTRAST_RecalcDepthFunc(void)
264 {
265         dpsoftrast.fb_depthfunc = dpsoftrast.user.depthtest ? dpsoftrast.user.depthfunc : GL_ALWAYS;
266 }
267
268 int blendmodetable[][4] = 
269 {
270         {DPSOFTRAST_BLENDMODE_OPAQUE, GL_ONE, GL_ZERO, false},
271         {DPSOFTRAST_BLENDMODE_ALPHA, GL_SRC_ALPHA, GL_ONE_MINUS_SRC_ALPHA, false},
272         {DPSOFTRAST_BLENDMODE_ADDALPHA, GL_SRC_ALPHA, GL_ONE, false},
273         {DPSOFTRAST_BLENDMODE_ADD, GL_ONE, GL_ONE, false},
274         {DPSOFTRAST_BLENDMODE_INVMOD, GL_ZERO, GL_ONE_MINUS_SRC_COLOR, false},
275         {DPSOFTRAST_BLENDMODE_MUL, GL_ZERO, GL_SRC_COLOR, false},
276         {DPSOFTRAST_BLENDMODE_MUL, GL_DST_COLOR, GL_ZERO, false},
277         {DPSOFTRAST_BLENDMODE_MUL2, GL_DST_COLOR, GL_SRC_COLOR, false},
278         {DPSOFTRAST_BLENDMODE_PSEUDOALPHA, GL_ONE, GL_ONE_MINUS_SRC_ALPHA, false},
279         {DPSOFTRAST_BLENDMODE_SUBALPHA, GL_SRC_COLOR, GL_ONE, true}
280 };
281
282 void DPSOFTRAST_RecalcBlendFunc(void)
283 {
284         int i;
285         dpsoftrast.fb_blendmode = DPSOFTRAST_BLENDMODE_OPAQUE;
286         for (i = 0;i < (int)(sizeof(blendmodetable) / sizeof(blendmodetable[0]));i++)
287         {
288                 if (dpsoftrast.user.blendfunc[0] == blendmodetable[i][1] && dpsoftrast.user.blendfunc[1] == blendmodetable[i][2] && dpsoftrast.user.blendsubtract == blendmodetable[i][3])
289                 {
290                         dpsoftrast.fb_blendmode = blendmodetable[i][0];
291                         break;
292                 }
293         }
294 }
295
296 #define DPSOFTRAST_ValidateQuick(f) ((dpsoftrast.validate & (f)) ? (DPSOFTRAST_Validate(f), 0) : 0)
297
298 void DPSOFTRAST_Validate(int mask)
299 {
300         mask &= dpsoftrast.validate;
301         if (!mask)
302                 return;
303         if (mask & DPSOFTRAST_VALIDATE_FB)
304         {
305                 dpsoftrast.validate &= ~DPSOFTRAST_VALIDATE_FB;
306                 DPSOFTRAST_RecalcFB();
307         }
308         if (mask & DPSOFTRAST_VALIDATE_DEPTHFUNC)
309         {
310                 dpsoftrast.validate &= ~DPSOFTRAST_VALIDATE_DEPTHFUNC;
311                 DPSOFTRAST_RecalcDepthFunc();
312         }
313         if (mask & DPSOFTRAST_VALIDATE_BLENDFUNC)
314         {
315                 dpsoftrast.validate &= ~DPSOFTRAST_VALIDATE_BLENDFUNC;
316                 DPSOFTRAST_RecalcBlendFunc();
317         }
318 }
319
320 DPSOFTRAST_Texture *DPSOFTRAST_Texture_GetByIndex(int index)
321 {
322         if (index >= 1 && index < dpsoftrast.texture_end && dpsoftrast.texture[index].bytes)
323                 return &dpsoftrast.texture[index];
324         return NULL;
325 }
326
327 int DPSOFTRAST_Texture_New(int flags, int width, int height, int depth)
328 {
329         int w;
330         int h;
331         int d;
332         int size;
333         int s;
334         int texnum;
335         int mipmaps;
336         int sides = (flags & DPSOFTRAST_TEXTURE_FLAG_CUBEMAP) ? 6 : 1;
337         int texformat = flags & DPSOFTRAST_TEXTURE_FORMAT_COMPAREMASK;
338         DPSOFTRAST_Texture *texture;
339         if (width*height*depth < 1)
340         {
341                 dpsoftrast.errorstring = "DPSOFTRAST_Texture_New: width, height or depth is less than 1";
342                 return 0;
343         }
344         if (width > DPSOFTRAST_TEXTURE_MAXSIZE || height > DPSOFTRAST_TEXTURE_MAXSIZE || depth > DPSOFTRAST_TEXTURE_MAXSIZE)
345         {
346                 dpsoftrast.errorstring = "DPSOFTRAST_Texture_New: texture size is too large";
347                 return 0;
348         }
349         switch(texformat)
350         {
351         case DPSOFTRAST_TEXTURE_FORMAT_BGRA8:
352         case DPSOFTRAST_TEXTURE_FORMAT_RGBA8:
353         case DPSOFTRAST_TEXTURE_FORMAT_ALPHA8:
354                 break;
355         case DPSOFTRAST_TEXTURE_FORMAT_DEPTH:
356                 if (flags & DPSOFTRAST_TEXTURE_FLAG_CUBEMAP)
357                 {
358                         dpsoftrast.errorstring = "DPSOFTRAST_Texture_New: DPSOFTRAST_TEXTURE_FORMAT_DEPTH only permitted on 2D textures";
359                         return 0;
360                 }
361                 if (depth != 1)
362                 {
363                         dpsoftrast.errorstring = "DPSOFTRAST_Texture_New: DPSOFTRAST_TEXTURE_FORMAT_DEPTH only permitted on 2D textures";
364                         return 0;
365                 }
366                 if ((flags & DPSOFTRAST_TEXTURE_FLAG_MIPMAP) && (texformat == DPSOFTRAST_TEXTURE_FORMAT_DEPTH))
367                 {
368                         dpsoftrast.errorstring = "DPSOFTRAST_Texture_New: DPSOFTRAST_TEXTURE_FORMAT_DEPTH does not permit mipmaps";
369                         return 0;
370                 }
371                 break;
372         }
373         if (depth != 1 && (flags & DPSOFTRAST_TEXTURE_FLAG_CUBEMAP))
374         {
375                 dpsoftrast.errorstring = "DPSOFTRAST_Texture_New: DPSOFTRAST_TEXTURE_FLAG_CUBEMAP can not be used on 3D textures";
376                 return 0;
377         }
378         if (depth != 1 && (flags & DPSOFTRAST_TEXTURE_FLAG_MIPMAP))
379         {
380                 dpsoftrast.errorstring = "DPSOFTRAST_Texture_New: DPSOFTRAST_TEXTURE_FLAG_MIPMAP can not be used on 3D textures";
381                 return 0;
382         }
383         if (depth != 1 && (flags & DPSOFTRAST_TEXTURE_FLAG_MIPMAP))
384         {
385                 dpsoftrast.errorstring = "DPSOFTRAST_Texture_New: DPSOFTRAST_TEXTURE_FLAG_MIPMAP can not be used on 3D textures";
386                 return 0;
387         }
388         if ((flags & DPSOFTRAST_TEXTURE_FLAG_CUBEMAP) && (flags & DPSOFTRAST_TEXTURE_FLAG_MIPMAP))
389         {
390                 dpsoftrast.errorstring = "DPSOFTRAST_Texture_New: DPSOFTRAST_TEXTURE_FLAG_MIPMAP can not be used on cubemap textures";
391                 return 0;
392         }
393         if ((width & (width-1)) || (height & (height-1)) || (depth & (depth-1)))
394         {
395                 dpsoftrast.errorstring = "DPSOFTRAST_Texture_New: dimensions are not power of two";
396                 return 0;
397         }
398         // find first empty slot in texture array
399         for (texnum = dpsoftrast.texture_firstfree;texnum < dpsoftrast.texture_end;texnum++)
400                 if (!dpsoftrast.texture[texnum].bytes)
401                         break;
402         dpsoftrast.texture_firstfree = texnum + 1;
403         if (dpsoftrast.texture_max <= texnum)
404         {
405                 // expand texture array as needed
406                 if (dpsoftrast.texture_max < 1024)
407                         dpsoftrast.texture_max = 1024;
408                 else
409                         dpsoftrast.texture_max *= 2;
410                 dpsoftrast.texture = (DPSOFTRAST_Texture *)realloc(dpsoftrast.texture, dpsoftrast.texture_max * sizeof(DPSOFTRAST_Texture));
411         }
412         if (dpsoftrast.texture_end <= texnum)
413                 dpsoftrast.texture_end = texnum + 1;
414         texture = &dpsoftrast.texture[texnum];
415         memset(texture, 0, sizeof(*texture));
416         texture->flags = flags;
417         texture->width = width;
418         texture->height = height;
419         texture->depth = depth;
420         texture->sides = sides;
421         w = width;
422         h = height;
423         d = depth;
424         size = 0;
425         mipmaps = 0;
426         w = width;
427         h = height;
428         d = depth;
429         for (;;)
430         {
431                 s = w * h * d * sides * 4;
432                 texture->mipmap[mipmaps][0] = size;
433                 texture->mipmap[mipmaps][1] = s;
434                 texture->mipmap[mipmaps][2] = w;
435                 texture->mipmap[mipmaps][3] = h;
436                 texture->mipmap[mipmaps][4] = d;
437                 size += s;
438                 mipmaps++;
439                 if (w * h * d == 1 || !(flags & DPSOFTRAST_TEXTURE_FLAG_MIPMAP))
440                         break;
441                 if (w > 1) w >>= 1;
442                 if (h > 1) h >>= 1;
443                 if (d > 1) d >>= 1;
444         }
445         texture->mipmaps = mipmaps;
446         texture->size = size;
447
448         // allocate the pixels now
449         texture->bytes = (unsigned char *)MM_CALLOC(1, size);
450
451         return texnum;
452 }
453 void DPSOFTRAST_Texture_Free(int index)
454 {
455         DPSOFTRAST_Texture *texture;
456         texture = DPSOFTRAST_Texture_GetByIndex(index);if (!texture) return;
457         if (texture->bytes)
458                 MM_FREE(texture->bytes);
459         texture->bytes = NULL;
460         memset(texture, 0, sizeof(*texture));
461         // adjust the free range and used range
462         if (dpsoftrast.texture_firstfree > index)
463                 dpsoftrast.texture_firstfree = index;
464         while (dpsoftrast.texture_end > 0 && dpsoftrast.texture[dpsoftrast.texture_end-1].bytes == NULL)
465                 dpsoftrast.texture_end--;
466 }
467 void DPSOFTRAST_Texture_CalculateMipmaps(int index)
468 {
469         int i, x, y, z, w, layer0, layer1, row0, row1;
470         unsigned char *o, *i0, *i1, *i2, *i3;
471         DPSOFTRAST_Texture *texture;
472         texture = DPSOFTRAST_Texture_GetByIndex(index);if (!texture) return;
473         if (texture->mipmaps <= 1)
474                 return;
475         for (i = 1;i < texture->mipmaps;i++)
476         {
477                 for (z = 0;z < texture->mipmap[i][4];z++)
478                 {
479                         layer0 = z*2;
480                         layer1 = z*2+1;
481                         if (layer1 >= texture->mipmap[i-1][4])
482                                 layer1 = texture->mipmap[i-1][4]-1;
483                         for (y = 0;y < texture->mipmap[i][3];y++)
484                         {
485                                 row0 = y*2;
486                                 row1 = y*2+1;
487                                 if (row1 >= texture->mipmap[i-1][3])
488                                         row1 = texture->mipmap[i-1][3]-1;
489                                 o =  texture->bytes + texture->mipmap[i  ][0] + 4*((texture->mipmap[i  ][3] * z      + y   ) * texture->mipmap[i  ][2]);
490                                 i0 = texture->bytes + texture->mipmap[i-1][0] + 4*((texture->mipmap[i-1][3] * layer0 + row0) * texture->mipmap[i-1][2]);
491                                 i1 = texture->bytes + texture->mipmap[i-1][0] + 4*((texture->mipmap[i-1][3] * layer0 + row1) * texture->mipmap[i-1][2]);
492                                 i2 = texture->bytes + texture->mipmap[i-1][0] + 4*((texture->mipmap[i-1][3] * layer1 + row0) * texture->mipmap[i-1][2]);
493                                 i3 = texture->bytes + texture->mipmap[i-1][0] + 4*((texture->mipmap[i-1][3] * layer1 + row1) * texture->mipmap[i-1][2]);
494                                 w = texture->mipmap[i][2];
495                                 if (layer1 > layer0)
496                                 {
497                                         if (texture->mipmap[i-1][2] > 1)
498                                         {
499                                                 // average 3D texture
500                                                 for (x = 0;x < w;x++, o += 4, i0 += 8, i1 += 8, i2 += 8, i3 += 8)
501                                                 {
502                                                         o[0] = (i0[0] + i0[4] + i1[0] + i1[4] + i2[0] + i2[4] + i3[0] + i3[4] + 4) >> 3;
503                                                         o[1] = (i0[1] + i0[5] + i1[1] + i1[5] + i2[1] + i2[5] + i3[1] + i3[5] + 4) >> 3;
504                                                         o[2] = (i0[2] + i0[6] + i1[2] + i1[6] + i2[2] + i2[6] + i3[2] + i3[6] + 4) >> 3;
505                                                         o[3] = (i0[3] + i0[7] + i1[3] + i1[7] + i2[3] + i2[7] + i3[3] + i3[7] + 4) >> 3;
506                                                 }
507                                         }
508                                         else
509                                         {
510                                                 // average 3D mipmap with parent width == 1
511                                                 for (x = 0;x < w;x++, o += 4, i0 += 8, i1 += 8)
512                                                 {
513                                                         o[0] = (i0[0] + i1[0] + i2[0] + i3[0] + 2) >> 2;
514                                                         o[1] = (i0[1] + i1[1] + i2[1] + i3[1] + 2) >> 2;
515                                                         o[2] = (i0[2] + i1[2] + i2[2] + i3[2] + 2) >> 2;
516                                                         o[3] = (i0[3] + i1[3] + i2[3] + i3[3] + 2) >> 2;
517                                                 }
518                                         }
519                                 }
520                                 else
521                                 {
522                                         if (texture->mipmap[i-1][2] > 1)
523                                         {
524                                                 // average 2D texture (common case)
525                                                 for (x = 0;x < w;x++, o += 4, i0 += 8, i1 += 8)
526                                                 {
527                                                         o[0] = (i0[0] + i0[4] + i1[0] + i1[4] + 2) >> 2;
528                                                         o[1] = (i0[1] + i0[5] + i1[1] + i1[5] + 2) >> 2;
529                                                         o[2] = (i0[2] + i0[6] + i1[2] + i1[6] + 2) >> 2;
530                                                         o[3] = (i0[3] + i0[7] + i1[3] + i1[7] + 2) >> 2;
531                                                 }
532                                         }
533                                         else
534                                         {
535                                                 // 2D texture with parent width == 1
536                                                 o[0] = (i0[0] + i1[0] + 1) >> 1;
537                                                 o[1] = (i0[1] + i1[1] + 1) >> 1;
538                                                 o[2] = (i0[2] + i1[2] + 1) >> 1;
539                                                 o[3] = (i0[3] + i1[3] + 1) >> 1;
540                                         }
541                                 }
542                         }
543                 }
544         }
545 }
546 void DPSOFTRAST_Texture_UpdatePartial(int index, int mip, const unsigned char *pixels, int blockx, int blocky, int blockwidth, int blockheight)
547 {
548         DPSOFTRAST_Texture *texture;
549         unsigned char *dst;
550         texture = DPSOFTRAST_Texture_GetByIndex(index);if (!texture) return;
551     
552         dst = texture->bytes + (blocky * texture->mipmap[0][2] + blockx) * 4;
553         while (blockheight > 0)
554         {
555                 memcpy(dst, pixels, blockwidth * 4);
556                 pixels += blockwidth * 4;
557                 dst += texture->mipmap[0][2] * 4;
558                 blockheight--;
559         }
560         DPSOFTRAST_Texture_CalculateMipmaps(index);
561 }
562 void DPSOFTRAST_Texture_UpdateFull(int index, const unsigned char *pixels)
563 {
564         DPSOFTRAST_Texture *texture;
565         texture = DPSOFTRAST_Texture_GetByIndex(index);if (!texture) return;
566
567         memcpy(texture->bytes, pixels, texture->mipmap[0][1]);
568         DPSOFTRAST_Texture_CalculateMipmaps(index);
569 }
570 int DPSOFTRAST_Texture_GetWidth(int index, int mip)
571 {
572         DPSOFTRAST_Texture *texture;
573         texture = DPSOFTRAST_Texture_GetByIndex(index);if (!texture) return 0;
574         return texture->mipmap[mip][2];
575 }
576 int DPSOFTRAST_Texture_GetHeight(int index, int mip)
577 {
578         DPSOFTRAST_Texture *texture;
579         texture = DPSOFTRAST_Texture_GetByIndex(index);if (!texture) return 0;
580         return texture->mipmap[mip][3];
581 }
582 int DPSOFTRAST_Texture_GetDepth(int index, int mip)
583 {
584         DPSOFTRAST_Texture *texture;
585         texture = DPSOFTRAST_Texture_GetByIndex(index);if (!texture) return 0;
586         return texture->mipmap[mip][4];
587 }
588 unsigned char *DPSOFTRAST_Texture_GetPixelPointer(int index, int mip)
589 {
590         DPSOFTRAST_Texture *texture;
591         texture = DPSOFTRAST_Texture_GetByIndex(index);if (!texture) return 0;
592         return texture->bytes + texture->mipmap[mip][0];
593 }
594 void DPSOFTRAST_Texture_Filter(int index, DPSOFTRAST_TEXTURE_FILTER filter)
595 {
596         DPSOFTRAST_Texture *texture;
597         texture = DPSOFTRAST_Texture_GetByIndex(index);if (!texture) return;
598         if (!(texture->flags & DPSOFTRAST_TEXTURE_FLAG_MIPMAP) && filter > DPSOFTRAST_TEXTURE_FILTER_LINEAR)
599         {
600                 dpsoftrast.errorstring = "DPSOFTRAST_Texture_Filter: requested filter mode requires mipmaps";
601                 return;
602         }
603         texture->filter = filter;
604 }
605
606 void DPSOFTRAST_SetRenderTargets(int width, int height, unsigned int *depthpixels, unsigned int *colorpixels0, unsigned int *colorpixels1, unsigned int *colorpixels2, unsigned int *colorpixels3)
607 {
608         dpsoftrast.fb_width = width;
609         dpsoftrast.fb_height = height;
610         dpsoftrast.fb_depthpixels = depthpixels;
611         dpsoftrast.fb_colorpixels[0] = colorpixels0;
612         dpsoftrast.fb_colorpixels[1] = colorpixels1;
613         dpsoftrast.fb_colorpixels[2] = colorpixels2;
614         dpsoftrast.fb_colorpixels[3] = colorpixels3;
615 }
616 void DPSOFTRAST_Viewport(int x, int y, int width, int height)
617 {
618         dpsoftrast.user.viewport[0] = x;
619         dpsoftrast.user.viewport[1] = y;
620         dpsoftrast.user.viewport[2] = width;
621         dpsoftrast.user.viewport[3] = height;
622         dpsoftrast.validate |= DPSOFTRAST_VALIDATE_FB;
623 }
624 void DPSOFTRAST_ClearColor(float r, float g, float b, float a)
625 {
626         int i, x1, y1, x2, y2, w, h, x, y;
627         unsigned int *p;
628         unsigned int c;
629         DPSOFTRAST_Validate(DPSOFTRAST_VALIDATE_FB);
630         x1 = dpsoftrast.fb_clearscissor[0];
631         y1 = dpsoftrast.fb_clearscissor[1];
632         x2 = dpsoftrast.fb_clearscissor[2];
633         y2 = dpsoftrast.fb_clearscissor[1] + dpsoftrast.fb_clearscissor[3];
634         w = x2 - x1;
635         h = y2 - y1;
636         if (w < 1 || h < 1)
637                 return;
638         // FIXME: honor dpsoftrast.fb_colormask?
639         c = DPSOFTRAST_BGRA8_FROM_RGBA32F(r,g,b,a);
640         for (i = 0;i < 4;i++)
641         {
642                 if (!dpsoftrast.fb_colorpixels[i])
643                         continue;
644                 for (y = y1;y < y2;y++)
645                 {
646                         p = dpsoftrast.fb_colorpixels[i] + y * dpsoftrast.fb_width;
647                         for (x = x1;x < x2;x++)
648                                 p[x] = c;
649                 }
650         }
651 }
652 void DPSOFTRAST_ClearDepth(float d)
653 {
654         int x1, y1, x2, y2, w, h, x, y;
655         unsigned int *p;
656         unsigned int c;
657         DPSOFTRAST_Validate(DPSOFTRAST_VALIDATE_FB);
658         x1 = dpsoftrast.fb_clearscissor[0];
659         y1 = dpsoftrast.fb_clearscissor[1];
660         x2 = dpsoftrast.fb_clearscissor[2];
661         y2 = dpsoftrast.fb_clearscissor[1] + dpsoftrast.fb_clearscissor[3];
662         w = x2 - x1;
663         h = y2 - y1;
664         if (w < 1 || h < 1)
665                 return;
666         c = DPSOFTRAST_DEPTH32_FROM_DEPTH32F(d);
667         for (y = y1;y < y2;y++)
668         {
669                 p = dpsoftrast.fb_depthpixels + y * dpsoftrast.fb_width;
670                 for (x = x1;x < x2;x++)
671                         p[x] = c;
672         }
673 }
674 void DPSOFTRAST_ColorMask(int r, int g, int b, int a)
675 {
676         dpsoftrast.user.colormask[0] = r != 0;
677         dpsoftrast.user.colormask[1] = g != 0;
678         dpsoftrast.user.colormask[2] = b != 0;
679         dpsoftrast.user.colormask[3] = a != 0;
680         dpsoftrast.fb_colormask = ((-dpsoftrast.user.colormask[0]) & 0x00FF0000) | ((-dpsoftrast.user.colormask[1]) & 0x0000FF00) | ((-dpsoftrast.user.colormask[2]) & 0x000000FF) | ((-dpsoftrast.user.colormask[3]) & 0xFF000000);
681 }
682 void DPSOFTRAST_DepthTest(int enable)
683 {
684         dpsoftrast.user.depthtest = enable;
685         dpsoftrast.validate |= DPSOFTRAST_VALIDATE_DEPTHFUNC;
686 }
687 void DPSOFTRAST_ScissorTest(int enable)
688 {
689         dpsoftrast.user.scissortest = enable;
690         dpsoftrast.validate |= DPSOFTRAST_VALIDATE_FB;
691 }
692 void DPSOFTRAST_Scissor(float x, float y, float width, float height)
693 {
694         dpsoftrast.user.scissor[0] = x;
695         dpsoftrast.user.scissor[1] = y;
696         dpsoftrast.user.scissor[2] = width;
697         dpsoftrast.user.scissor[3] = height;
698         dpsoftrast.validate |= DPSOFTRAST_VALIDATE_FB;
699 }
700
701 void DPSOFTRAST_BlendFunc(int smodulate, int dmodulate)
702 {
703         // FIXME: validate
704         dpsoftrast.user.blendfunc[0] = smodulate;
705         dpsoftrast.user.blendfunc[1] = dmodulate;
706         dpsoftrast.validate |= DPSOFTRAST_VALIDATE_BLENDFUNC;
707 }
708 void DPSOFTRAST_BlendSubtract(int enable)
709 {
710         dpsoftrast.user.blendsubtract = enable != 0;
711         dpsoftrast.validate |= DPSOFTRAST_VALIDATE_BLENDFUNC;
712 }
713 void DPSOFTRAST_DepthMask(int enable)
714 {
715         dpsoftrast.user.depthmask = enable;
716 }
717 void DPSOFTRAST_DepthFunc(int comparemode)
718 {
719         // FIXME: validate
720         dpsoftrast.user.depthfunc = comparemode;
721 }
722 void DPSOFTRAST_DepthRange(float range0, float range1)
723 {
724         dpsoftrast.user.depthrange[0] = range0;
725         dpsoftrast.user.depthrange[1] = range1;
726 }
727 void DPSOFTRAST_PolygonOffset(float alongnormal, float intoview)
728 {
729         dpsoftrast.user.polygonoffset[0] = alongnormal;
730         dpsoftrast.user.polygonoffset[1] = intoview;
731 }
732 void DPSOFTRAST_CullFace(int mode)
733 {
734         // FIXME: validate
735         dpsoftrast.user.cullface = mode;
736 }
737 void DPSOFTRAST_AlphaTest(float enable)
738 {
739         dpsoftrast.user.alphatest = enable;
740 }
741 void DPSOFTRAST_AlphaFunc(int alphafunc, float alphavalue)
742 {
743         // FIXME: validate
744         dpsoftrast.user.alphafunc = alphafunc;
745         dpsoftrast.user.alphavalue = alphavalue;
746 }
747 void DPSOFTRAST_Color4f(float r, float g, float b, float a)
748 {
749         dpsoftrast.user.color[0] = r;
750         dpsoftrast.user.color[1] = g;
751         dpsoftrast.user.color[2] = b;
752         dpsoftrast.user.color[3] = a;
753 }
754 void DPSOFTRAST_GetPixelsBGRA(int blockx, int blocky, int blockwidth, int blockheight, unsigned char *outpixels)
755 {
756         int outstride = blockwidth * 4;
757         int instride = dpsoftrast.fb_width * 4;
758         int bx1 = blockx;
759         int by1 = blocky;
760         int bx2 = blockx + blockwidth;
761         int by2 = blocky + blockheight;
762         int bw;
763         int bh;
764         int x;
765         int y;
766         unsigned char *inpixels;
767         unsigned char *b;
768         unsigned char *o;
769         if (bx1 < 0) bx1 = 0;
770         if (by1 < 0) by1 = 0;
771         if (bx2 > dpsoftrast.fb_width) bx2 = dpsoftrast.fb_width;
772         if (by2 > dpsoftrast.fb_height) by2 = dpsoftrast.fb_height;
773         bw = bx2 - bx1;
774         bh = by2 - by1;
775         inpixels = (unsigned char *)dpsoftrast.fb_colorpixels[0];
776         if (dpsoftrast.bigendian)
777         {
778                 for (y = by1;y < by2;y++)
779                 {
780                         b = (unsigned char *)inpixels + (dpsoftrast.fb_height - 1 - y) * instride + 4 * bx1;
781                         o = (unsigned char *)outpixels + (y - by1) * outstride;
782                         for (x = bx1;x < bx2;x++)
783                         {
784                                 o[0] = b[3];
785                                 o[1] = b[2];
786                                 o[2] = b[1];
787                                 o[3] = b[0];
788                                 o += 4;
789                                 b += 4;
790                         }
791                 }
792         }
793         else
794         {
795                 for (y = by1;y < by2;y++)
796                 {
797                         b = (unsigned char *)inpixels + (dpsoftrast.fb_height - 1 - y) * instride + 4 * bx1;
798                         o = (unsigned char *)outpixels + (y - by1) * outstride;
799                         memcpy(o, b, bw*4);
800                 }
801         }
802
803 }
804 void DPSOFTRAST_CopyRectangleToTexture(int index, int mip, int tx, int ty, int sx, int sy, int width, int height)
805 {
806         int tx1 = tx;
807         int ty1 = ty;
808         int tx2 = tx + width;
809         int ty2 = ty + height;
810         int sx1 = sx;
811         int sy1 = sy;
812         int sx2 = sx + width;
813         int sy2 = sy + height;
814         int swidth;
815         int sheight;
816         int twidth;
817         int theight;
818         int sw;
819         int sh;
820         int tw;
821         int th;
822         int y;
823         unsigned int *spixels;
824         unsigned int *tpixels;
825         DPSOFTRAST_Texture *texture;
826         texture = DPSOFTRAST_Texture_GetByIndex(index);if (!texture) return;
827         if (mip < 0 || mip >= texture->mipmaps) return;
828         spixels = dpsoftrast.fb_colorpixels[0];
829         swidth = dpsoftrast.fb_width;
830         sheight = dpsoftrast.fb_height;
831         tpixels = (unsigned int *)(texture->bytes + texture->mipmap[mip][0]);
832         twidth = texture->mipmap[mip][2];
833         theight = texture->mipmap[mip][3];
834         if (tx1 < 0) tx1 = 0;
835         if (ty1 < 0) ty1 = 0;
836         if (tx2 > twidth) tx2 = twidth;
837         if (ty2 > theight) ty2 = theight;
838         if (sx1 < 0) sx1 = 0;
839         if (sy1 < 0) sy1 = 0;
840         if (sx2 > swidth) sx2 = swidth;
841         if (sy2 > sheight) sy2 = sheight;
842         tw = tx2 - tx1;
843         th = ty2 - ty1;
844         sw = sx2 - sx1;
845         sh = sy2 - sy1;
846         if (tw > sw) tw = sw;
847         if (th > sh) th = sh;
848         if (tw < 1 || th < 1)
849                 return;
850         for (y = 0;y < th;y++)
851                 memcpy(tpixels + ((ty1 + y) * twidth + tx1), spixels + ((sy1 + y) * swidth + sx1), tw*4);
852         if (texture->mipmaps > 1)
853                 DPSOFTRAST_Texture_CalculateMipmaps(index);
854 }
855 void DPSOFTRAST_SetTexture(int unitnum, int index)
856 {
857         DPSOFTRAST_Texture *texture;
858         if (unitnum < 0 || unitnum >= DPSOFTRAST_MAXTEXTUREUNITS)
859         {
860                 dpsoftrast.errorstring = "DPSOFTRAST_SetTexture: invalid unit number";
861                 return;
862         }
863         texture = DPSOFTRAST_Texture_GetByIndex(index);
864         if (index && !texture)
865         {
866                 dpsoftrast.errorstring = "DPSOFTRAST_SetTexture: invalid texture handle";
867                 return;
868         }
869         dpsoftrast.texbound[unitnum] = texture;
870 }
871
872 void DPSOFTRAST_SetVertexPointer(const float *vertex3f, size_t stride)
873 {
874         dpsoftrast.pointer_vertex3f = vertex3f;
875         dpsoftrast.stride_vertex = stride;
876 }
877 void DPSOFTRAST_SetColorPointer(const float *color4f, size_t stride)
878 {
879         dpsoftrast.pointer_color4f = color4f;
880         dpsoftrast.pointer_color4ub = NULL;
881         dpsoftrast.stride_color = stride;
882 }
883 void DPSOFTRAST_SetColorPointer4ub(const unsigned char *color4ub, size_t stride)
884 {
885         dpsoftrast.pointer_color4f = NULL;
886         dpsoftrast.pointer_color4ub = color4ub;
887         dpsoftrast.stride_color = stride;
888 }
889 void DPSOFTRAST_SetTexCoordPointer(int unitnum, int numcomponents, size_t stride, const float *texcoordf)
890 {
891         dpsoftrast.pointer_texcoordf[unitnum] = texcoordf;
892         dpsoftrast.components_texcoord[unitnum] = numcomponents;
893         dpsoftrast.stride_texcoord[unitnum] = stride;
894 }
895
896 void DPSOFTRAST_SetShader(unsigned int mode, unsigned int permutation)
897 {
898         dpsoftrast.shader_mode = mode;
899         dpsoftrast.shader_permutation = permutation;
900 }
901 void DPSOFTRAST_Uniform4fARB(DPSOFTRAST_UNIFORM index, float v0, float v1, float v2, float v3)
902 {
903         dpsoftrast.uniform4f[index*4+0] = v0;
904         dpsoftrast.uniform4f[index*4+1] = v1;
905         dpsoftrast.uniform4f[index*4+2] = v2;
906         dpsoftrast.uniform4f[index*4+3] = v3;
907 }
908 void DPSOFTRAST_Uniform4fvARB(DPSOFTRAST_UNIFORM index, const float *v)
909 {
910         dpsoftrast.uniform4f[index*4+0] = v[0];
911         dpsoftrast.uniform4f[index*4+1] = v[1];
912         dpsoftrast.uniform4f[index*4+2] = v[2];
913         dpsoftrast.uniform4f[index*4+3] = v[3];
914 }
915 void DPSOFTRAST_UniformMatrix4fvARB(DPSOFTRAST_UNIFORM uniform, int arraysize, int transpose, const float *v)
916 {
917         int i, index;
918         for (i = 0, index = (int)uniform;i < arraysize;i++, index += 4, v += 16)
919         {
920                 if (transpose)
921                 {
922                         dpsoftrast.uniform4f[index*4+0] = v[0];
923                         dpsoftrast.uniform4f[index*4+1] = v[4];
924                         dpsoftrast.uniform4f[index*4+2] = v[8];
925                         dpsoftrast.uniform4f[index*4+3] = v[12];
926                         dpsoftrast.uniform4f[index*4+4] = v[1];
927                         dpsoftrast.uniform4f[index*4+5] = v[5];
928                         dpsoftrast.uniform4f[index*4+6] = v[9];
929                         dpsoftrast.uniform4f[index*4+7] = v[13];
930                         dpsoftrast.uniform4f[index*4+8] = v[2];
931                         dpsoftrast.uniform4f[index*4+9] = v[6];
932                         dpsoftrast.uniform4f[index*4+10] = v[10];
933                         dpsoftrast.uniform4f[index*4+11] = v[14];
934                         dpsoftrast.uniform4f[index*4+12] = v[3];
935                         dpsoftrast.uniform4f[index*4+13] = v[7];
936                         dpsoftrast.uniform4f[index*4+14] = v[11];
937                         dpsoftrast.uniform4f[index*4+15] = v[15];
938                 }
939                 else
940                 {
941                         dpsoftrast.uniform4f[index*4+0] = v[0];
942                         dpsoftrast.uniform4f[index*4+1] = v[1];
943                         dpsoftrast.uniform4f[index*4+2] = v[2];
944                         dpsoftrast.uniform4f[index*4+3] = v[3];
945                         dpsoftrast.uniform4f[index*4+4] = v[4];
946                         dpsoftrast.uniform4f[index*4+5] = v[5];
947                         dpsoftrast.uniform4f[index*4+6] = v[6];
948                         dpsoftrast.uniform4f[index*4+7] = v[7];
949                         dpsoftrast.uniform4f[index*4+8] = v[8];
950                         dpsoftrast.uniform4f[index*4+9] = v[9];
951                         dpsoftrast.uniform4f[index*4+10] = v[10];
952                         dpsoftrast.uniform4f[index*4+11] = v[11];
953                         dpsoftrast.uniform4f[index*4+12] = v[12];
954                         dpsoftrast.uniform4f[index*4+13] = v[13];
955                         dpsoftrast.uniform4f[index*4+14] = v[14];
956                         dpsoftrast.uniform4f[index*4+15] = v[15];
957                 }
958         }
959 }
960 void DPSOFTRAST_Uniform1iARB(DPSOFTRAST_UNIFORM index, int i0)
961 {
962         dpsoftrast.uniform1i[index] = i0;
963 }
964
965 void DPSOFTRAST_Draw_LoadVertices(int firstvertex, int numvertices, bool needcolors)
966 {
967         int i;
968         int j;
969         int stride;
970         const float *v;
971         float *p;
972         float *data;
973         const unsigned char *b;
974         dpsoftrast.draw.numvertices = numvertices;
975         if (dpsoftrast.draw.maxvertices < dpsoftrast.draw.numvertices)
976         {
977                 if (dpsoftrast.draw.maxvertices < 4096)
978                         dpsoftrast.draw.maxvertices = 4096;
979                 while (dpsoftrast.draw.maxvertices < dpsoftrast.draw.numvertices)
980                         dpsoftrast.draw.maxvertices *= 2;
981                 if (dpsoftrast.draw.in_array4f[0])
982                         MM_FREE(dpsoftrast.draw.in_array4f[0]);
983                 data = (float *)MM_CALLOC(1, dpsoftrast.draw.maxvertices * sizeof(float[4])*(DPSOFTRAST_ARRAY_TOTAL*2 + 1));
984                 for (i = 0;i < DPSOFTRAST_ARRAY_TOTAL;i++, data += dpsoftrast.draw.maxvertices * 4)
985                         dpsoftrast.draw.in_array4f[i] = data;
986                 for (i = 0;i < DPSOFTRAST_ARRAY_TOTAL;i++, data += dpsoftrast.draw.maxvertices * 4)
987                         dpsoftrast.draw.post_array4f[i] = data;
988                 dpsoftrast.draw.screencoord4f = data;
989                 data += dpsoftrast.draw.maxvertices * 4;
990         }
991         stride = dpsoftrast.stride_vertex;
992         v = (const float *)((unsigned char *)dpsoftrast.pointer_vertex3f + firstvertex * stride);
993         p = dpsoftrast.draw.in_array4f[0];
994         for (i = 0;i < numvertices;i++)
995         {
996                 p[0] = v[0];
997                 p[1] = v[1];
998                 p[2] = v[2];
999                 p[3] = 1.0f;
1000                 p += 4;
1001                 v = (const float *)((const unsigned char *)v + stride);
1002         }
1003         if (needcolors)
1004         {
1005                 if (dpsoftrast.pointer_color4f)
1006                 {
1007                         stride = dpsoftrast.stride_color;
1008                         v = (const float *)((const unsigned char *)dpsoftrast.pointer_color4f + firstvertex * stride);
1009                         p = dpsoftrast.draw.in_array4f[1];
1010                         for (i = 0;i < numvertices;i++)
1011                         {
1012                                 p[0] = v[0];
1013                                 p[1] = v[1];
1014                                 p[2] = v[2];
1015                                 p[3] = v[3];
1016                                 p += 4;
1017                                 v = (const float *)((const unsigned char *)v + stride);
1018                         }
1019                 }
1020                 else if (dpsoftrast.pointer_color4ub)
1021                 {
1022                         stride = dpsoftrast.stride_color;
1023                         b = (const unsigned char *)((const unsigned char *)dpsoftrast.pointer_color4ub + firstvertex * stride);
1024                         p = dpsoftrast.draw.in_array4f[1];
1025                         for (i = 0;i < numvertices;i++)
1026                         {
1027                                 p[0] = b[0] * (1.0f / 255.0f);
1028                                 p[1] = b[1] * (1.0f / 255.0f);
1029                                 p[2] = b[2] * (1.0f / 255.0f);
1030                                 p[3] = b[3] * (1.0f / 255.0f);
1031                                 p += 4;
1032                                 b = (const unsigned char *)((const unsigned char *)b + stride);
1033                         }
1034                 }
1035                 else
1036                 {
1037                         v = dpsoftrast.user.color;
1038                         p = dpsoftrast.draw.in_array4f[1];
1039                         for (i = 0;i < numvertices;i++)
1040                         {
1041                                 p[0] = v[0];
1042                                 p[1] = v[1];
1043                                 p[2] = v[2];
1044                                 p[3] = v[3];
1045                                 p += 4;
1046                         }
1047                 }
1048         }
1049         for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL-2;j++)
1050         {
1051                 if (dpsoftrast.pointer_texcoordf[j])
1052                 {
1053                         stride = dpsoftrast.stride_texcoord[j];
1054                         v = (const float *)((const unsigned char *)dpsoftrast.pointer_texcoordf[j] + firstvertex * stride);
1055                         p = dpsoftrast.draw.in_array4f[j+2];
1056                         switch(dpsoftrast.components_texcoord[j])
1057                         {
1058                         case 2:
1059                                 for (i = 0;i < numvertices;i++)
1060                                 {
1061                                         p[0] = v[0];
1062                                         p[1] = v[1];
1063                                         p[2] = 0.0f;
1064                                         p[3] = 1.0f;
1065                                         p += 4;
1066                                         v = (const float *)((const unsigned char *)v + stride);
1067                                 }
1068                                 break;
1069                         case 3:
1070                                 for (i = 0;i < numvertices;i++)
1071                                 {
1072                                         p[0] = v[0];
1073                                         p[1] = v[1];
1074                                         p[2] = v[2];
1075                                         p[3] = 1.0f;
1076                                         p += 4;
1077                                         v = (const float *)((const unsigned char *)v + stride);
1078                                 }
1079                                 break;
1080                         case 4:
1081                                 for (i = 0;i < numvertices;i++)
1082                                 {
1083                                         p[0] = v[0];
1084                                         p[1] = v[1];
1085                                         p[2] = v[2];
1086                                         p[3] = v[3];
1087                                         p += 4;
1088                                         v = (const float *)((const unsigned char *)v + stride);
1089                                 }
1090                                 break;
1091                         }
1092                 }
1093         }
1094 }
1095
1096 void DPSOFTRAST_Array_Transform(float *out4f, const float *in4f, int numitems, const float *inmatrix16f)
1097 {
1098         static const float identitymatrix[4][4] = {{1,0,0,0},{0,1,0,0},{0,0,1,0},{0,0,0,1}};
1099         // TODO: SIMD
1100         float matrix[4][4];
1101         int i;
1102         memcpy(matrix, inmatrix16f, sizeof(float[16]));
1103         if (!memcmp(identitymatrix, matrix, sizeof(float[16])))
1104         {
1105                 // fast case for identity matrix
1106                 memcpy(out4f, in4f, numitems * sizeof(float[4]));
1107                 return;
1108         }
1109         for (i = 0;i < numitems;i++, out4f += 4, in4f += 4)
1110         {
1111                 out4f[0] = in4f[0] * matrix[0][0] + in4f[1] * matrix[1][0] + in4f[2] * matrix[2][0] + in4f[3] * matrix[3][0];
1112                 out4f[1] = in4f[0] * matrix[0][1] + in4f[1] * matrix[1][1] + in4f[2] * matrix[2][1] + in4f[3] * matrix[3][1];
1113                 out4f[2] = in4f[0] * matrix[0][2] + in4f[1] * matrix[1][2] + in4f[2] * matrix[2][2] + in4f[3] * matrix[3][2];
1114                 out4f[3] = in4f[0] * matrix[0][3] + in4f[1] * matrix[1][3] + in4f[2] * matrix[2][3] + in4f[3] * matrix[3][3];
1115         }
1116 }
1117
1118 void DPSOFTRAST_Array_Copy(float *out4f, const float *in4f, int numitems)
1119 {
1120         memcpy(out4f, in4f, numitems * sizeof(float[4]));
1121 }
1122
1123 #ifdef SSE2_PRESENT
1124 static __m128 DPSOFTRAST_Draw_ProjectVertex(__m128 v)
1125 {
1126         __m128 viewportcenter = _mm_load_ps(dpsoftrast.fb_viewportcenter), viewportscale = _mm_load_ps(dpsoftrast.fb_viewportscale);
1127         __m128 w = _mm_shuffle_ps(v, v, _MM_SHUFFLE(3, 3, 3, 3));
1128         v = _mm_move_ss(_mm_shuffle_ps(v, v, _MM_SHUFFLE(2, 1, 0, 3)), _mm_set1_ps(1.0f));
1129         v = _mm_add_ps(viewportcenter, _mm_div_ps(_mm_mul_ps(viewportscale, v), w));
1130         v = _mm_shuffle_ps(v, v, _MM_SHUFFLE(0, 3, 2, 1));
1131         return v;
1132 }
1133 #endif
1134
1135 void DPSOFTRAST_Draw_ProjectVertices(float *out4f, const float *in4f, int numitems)
1136 {
1137 #ifdef SSE2_PRESENT
1138         // NOTE: this is used both as a whole mesh transform function and a
1139         // per-triangle transform function (for clipped triangles), accordingly
1140         // it should not crash on divide by 0 but the result of divide by 0 is
1141         // unimportant...
1142         // TODO: SIMD
1143         int i;
1144         __m128 viewportcenter = _mm_load_ps(dpsoftrast.fb_viewportcenter), viewportscale = _mm_load_ps(dpsoftrast.fb_viewportscale);
1145         for (i = 0;i < numitems;i++)
1146         {
1147                 __m128 v = _mm_load_ps(in4f), w = _mm_shuffle_ps(v, v, _MM_SHUFFLE(3, 3, 3, 3));
1148                 v = _mm_move_ss(_mm_shuffle_ps(v, v, _MM_SHUFFLE(2, 1, 0, 3)), _mm_set1_ps(1.0f));
1149                 v = _mm_add_ps(viewportcenter, _mm_div_ps(_mm_mul_ps(viewportscale, v), w));
1150                 _mm_store_ps(out4f, _mm_shuffle_ps(v, v, _MM_SHUFFLE(0, 3, 2, 1)));
1151                 in4f += 4;
1152                 out4f += 4;
1153         }
1154 #endif
1155 }
1156
1157 void DPSOFTRAST_Draw_DebugEdgePoints(const float *screen0, const float *screen1)
1158 {
1159         int i;
1160         int x;
1161         int y;
1162         int w = dpsoftrast.fb_width;
1163         int bounds[4];
1164         float v0[2], v1[2];
1165         unsigned int *pixels = dpsoftrast.fb_colorpixels[0];
1166         //const float *c4f;
1167         bounds[0] = dpsoftrast.fb_viewportscissor[0];
1168         bounds[1] = dpsoftrast.fb_viewportscissor[1];
1169         bounds[2] = dpsoftrast.fb_viewportscissor[0] + dpsoftrast.fb_viewportscissor[2];
1170         bounds[3] = dpsoftrast.fb_viewportscissor[1] + dpsoftrast.fb_viewportscissor[3];
1171         v0[0] = screen0[0];
1172         v0[1] = screen0[1];
1173         v1[0] = screen1[0];
1174         v1[1] = screen1[1];
1175         for (i = 0;i <= 128;i++)
1176         {
1177                 // check nearclip
1178                 //if (dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+3] != 1.0f)
1179                 //      continue;
1180                 x = (int)(v0[0] + (v1[0] - v0[0]) * (i/128.0f));
1181                 y = (int)(v0[1] + (v1[1] - v0[1]) * (i/128.0f));
1182                 if (x < bounds[0] || y < bounds[1] || x >= bounds[2] || y >= bounds[3])
1183                         continue;
1184                 //c4f = dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_COLOR] + element0*4;
1185                 //pixels[y*w+x] = DPSOFTRAST_BGRA8_FROM_RGBA32F(c4f[0], c4f[1], c4f[2], c4f[3]);
1186                 pixels[y*w+x] = 0xFFFFFFFF;
1187         }
1188 }
1189
1190 void DPSOFTRAST_Draw_Span_Begin(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *zf)
1191 {
1192         int x;
1193         int startx = span->startx;
1194         int endx = span->endx;
1195         float w = span->data[0][DPSOFTRAST_ARRAY_TOTAL][3];
1196         float wslope = span->data[1][DPSOFTRAST_ARRAY_TOTAL][3];
1197         float endz = 1.0f / (w + wslope * startx);
1198         for (x = startx;x < endx;)
1199         {
1200                 int nextsub = x + DPSOFTRAST_MAXSUBSPAN, endsub = nextsub - 1;
1201                 float z = endz, dz;
1202                 if(nextsub >= endx) nextsub = endsub = endx-1;
1203                 endz = 1.0f / (w + wslope * nextsub);
1204                 dz = x < nextsub ? (endz - z) / (nextsub - x) : 0.0f;
1205                 for (; x <= endsub; x++, z += dz)
1206                         zf[x] = z;
1207         }
1208 }
1209
1210 void DPSOFTRAST_Draw_Span_Finish(const DPSOFTRAST_State_Draw_Span * RESTRICT span, const float * RESTRICT in4f)
1211 {
1212         int x;
1213         int startx = span->startx;
1214         int endx = span->endx;
1215         int d[4];
1216         float a, b;
1217         unsigned char * RESTRICT pixelmask = span->pixelmask;
1218         unsigned char * RESTRICT pixel = (unsigned char *)dpsoftrast.fb_colorpixels[0];
1219         if (!pixel)
1220                 return;
1221         pixel += span->start * 4;
1222         // handle alphatest now (this affects depth writes too)
1223         if (dpsoftrast.user.alphatest)
1224                 for (x = startx;x < endx;x++)
1225                         if (in4f[x*4+3] < 0.5f)
1226                                 pixelmask[x] = false;
1227         // FIXME: this does not handle bigendian
1228         switch(dpsoftrast.fb_blendmode)
1229         {
1230         case DPSOFTRAST_BLENDMODE_OPAQUE:
1231                 for (x = startx;x < endx;x++)
1232                 {
1233                         if (!pixelmask[x])
1234                                 continue;
1235                         d[0] = (int)(in4f[x*4+2]*255.0f);if (d[0] > 255) d[0] = 255;
1236                         d[1] = (int)(in4f[x*4+1]*255.0f);if (d[1] > 255) d[1] = 255;
1237                         d[2] = (int)(in4f[x*4+0]*255.0f);if (d[2] > 255) d[2] = 255;
1238                         d[3] = (int)(in4f[x*4+3]*255.0f);if (d[3] > 255) d[3] = 255;
1239                         pixel[x*4+0] = d[0];
1240                         pixel[x*4+1] = d[1];
1241                         pixel[x*4+2] = d[2];
1242                         pixel[x*4+3] = d[3];
1243                 }
1244                 break;
1245         case DPSOFTRAST_BLENDMODE_ALPHA:
1246                 for (x = startx;x < endx;x++)
1247                 {
1248                         if (!pixelmask[x])
1249                                 continue;
1250                         a = in4f[x*4+3] * 255.0f;
1251                         b = 1.0f - in4f[x*4+3];
1252                         d[0] = (int)(in4f[x*4+2]*a+pixel[x*4+0]*b);if (d[0] > 255) d[0] = 255;
1253                         d[1] = (int)(in4f[x*4+1]*a+pixel[x*4+1]*b);if (d[1] > 255) d[1] = 255;
1254                         d[2] = (int)(in4f[x*4+0]*a+pixel[x*4+2]*b);if (d[2] > 255) d[2] = 255;
1255                         d[3] = (int)(in4f[x*4+3]*a+pixel[x*4+3]*b);if (d[3] > 255) d[3] = 255;
1256                         pixel[x*4+0] = d[0];
1257                         pixel[x*4+1] = d[1];
1258                         pixel[x*4+2] = d[2];
1259                         pixel[x*4+3] = d[3];
1260                 }
1261                 break;
1262         case DPSOFTRAST_BLENDMODE_ADDALPHA:
1263                 for (x = startx;x < endx;x++)
1264                 {
1265                         if (!pixelmask[x])
1266                                 continue;
1267                         a = in4f[x*4+3] * 255.0f;
1268                         d[0] = (int)(in4f[x*4+2]*a+pixel[x*4+0]);if (d[0] > 255) d[0] = 255;
1269                         d[1] = (int)(in4f[x*4+1]*a+pixel[x*4+1]);if (d[1] > 255) d[1] = 255;
1270                         d[2] = (int)(in4f[x*4+0]*a+pixel[x*4+2]);if (d[2] > 255) d[2] = 255;
1271                         d[3] = (int)(in4f[x*4+3]*a+pixel[x*4+3]);if (d[3] > 255) d[3] = 255;
1272                         pixel[x*4+0] = d[0];
1273                         pixel[x*4+1] = d[1];
1274                         pixel[x*4+2] = d[2];
1275                         pixel[x*4+3] = d[3];
1276                 }
1277                 break;
1278         case DPSOFTRAST_BLENDMODE_ADD:
1279                 for (x = startx;x < endx;x++)
1280                 {
1281                         if (!pixelmask[x])
1282                                 continue;
1283                         d[0] = (int)(in4f[x*4+2]*255.0f+pixel[x*4+0]);if (d[0] > 255) d[0] = 255;
1284                         d[1] = (int)(in4f[x*4+1]*255.0f+pixel[x*4+1]);if (d[1] > 255) d[1] = 255;
1285                         d[2] = (int)(in4f[x*4+0]*255.0f+pixel[x*4+2]);if (d[2] > 255) d[2] = 255;
1286                         d[3] = (int)(in4f[x*4+3]*255.0f+pixel[x*4+3]);if (d[3] > 255) d[3] = 255;
1287                         pixel[x*4+0] = d[0];
1288                         pixel[x*4+1] = d[1];
1289                         pixel[x*4+2] = d[2];
1290                         pixel[x*4+3] = d[3];
1291                 }
1292                 break;
1293         case DPSOFTRAST_BLENDMODE_INVMOD:
1294                 for (x = startx;x < endx;x++)
1295                 {
1296                         if (!pixelmask[x])
1297                                 continue;
1298                         d[0] = (int)((1.0f-in4f[x*4+2])*pixel[x*4+0]);if (d[0] > 255) d[0] = 255;
1299                         d[1] = (int)((1.0f-in4f[x*4+1])*pixel[x*4+1]);if (d[1] > 255) d[1] = 255;
1300                         d[2] = (int)((1.0f-in4f[x*4+0])*pixel[x*4+2]);if (d[2] > 255) d[2] = 255;
1301                         d[3] = (int)((1.0f-in4f[x*4+3])*pixel[x*4+3]);if (d[3] > 255) d[3] = 255;
1302                         pixel[x*4+0] = d[0];
1303                         pixel[x*4+1] = d[1];
1304                         pixel[x*4+2] = d[2];
1305                         pixel[x*4+3] = d[3];
1306                 }
1307                 break;
1308         case DPSOFTRAST_BLENDMODE_MUL:
1309                 for (x = startx;x < endx;x++)
1310                 {
1311                         if (!pixelmask[x])
1312                                 continue;
1313                         d[0] = (int)(in4f[x*4+2]*pixel[x*4+0]);if (d[0] > 255) d[0] = 255;
1314                         d[1] = (int)(in4f[x*4+1]*pixel[x*4+1]);if (d[1] > 255) d[1] = 255;
1315                         d[2] = (int)(in4f[x*4+0]*pixel[x*4+2]);if (d[2] > 255) d[2] = 255;
1316                         d[3] = (int)(in4f[x*4+3]*pixel[x*4+3]);if (d[3] > 255) d[3] = 255;
1317                         pixel[x*4+0] = d[0];
1318                         pixel[x*4+1] = d[1];
1319                         pixel[x*4+2] = d[2];
1320                         pixel[x*4+3] = d[3];
1321                 }
1322                 break;
1323         case DPSOFTRAST_BLENDMODE_MUL2:
1324                 for (x = startx;x < endx;x++)
1325                 {
1326                         if (!pixelmask[x])
1327                                 continue;
1328                         d[0] = (int)(in4f[x*4+2]*pixel[x*4+0]*2.0f);if (d[0] > 255) d[0] = 255;
1329                         d[1] = (int)(in4f[x*4+1]*pixel[x*4+1]*2.0f);if (d[1] > 255) d[1] = 255;
1330                         d[2] = (int)(in4f[x*4+0]*pixel[x*4+2]*2.0f);if (d[2] > 255) d[2] = 255;
1331                         d[3] = (int)(in4f[x*4+3]*pixel[x*4+3]*2.0f);if (d[3] > 255) d[3] = 255;
1332                         pixel[x*4+0] = d[0];
1333                         pixel[x*4+1] = d[1];
1334                         pixel[x*4+2] = d[2];
1335                         pixel[x*4+3] = d[3];
1336                 }
1337                 break;
1338         case DPSOFTRAST_BLENDMODE_SUBALPHA:
1339                 for (x = startx;x < endx;x++)
1340                 {
1341                         if (!pixelmask[x])
1342                                 continue;
1343                         a = in4f[x*4+3] * -255.0f;
1344                         d[0] = (int)(in4f[x*4+2]*a+pixel[x*4+0]);if (d[0] > 255) d[0] = 255;if (d[0] < 0) d[0] = 0;
1345                         d[1] = (int)(in4f[x*4+1]*a+pixel[x*4+1]);if (d[1] > 255) d[1] = 255;if (d[1] < 0) d[1] = 0;
1346                         d[2] = (int)(in4f[x*4+0]*a+pixel[x*4+2]);if (d[2] > 255) d[2] = 255;if (d[2] < 0) d[2] = 0;
1347                         d[3] = (int)(in4f[x*4+3]*a+pixel[x*4+3]);if (d[3] > 255) d[3] = 255;if (d[3] < 0) d[3] = 0;
1348                         pixel[x*4+0] = d[0];
1349                         pixel[x*4+1] = d[1];
1350                         pixel[x*4+2] = d[2];
1351                         pixel[x*4+3] = d[3];
1352                 }
1353                 break;
1354         case DPSOFTRAST_BLENDMODE_PSEUDOALPHA:
1355                 for (x = startx;x < endx;x++)
1356                 {
1357                         if (!pixelmask[x])
1358                                 continue;
1359                         a = 255.0f;
1360                         b = 1.0f - in4f[x*4+3];
1361                         d[0] = (int)(in4f[x*4+2]*a+pixel[x*4+0]*b);if (d[0] > 255) d[0] = 255;
1362                         d[1] = (int)(in4f[x*4+1]*a+pixel[x*4+1]*b);if (d[1] > 255) d[1] = 255;
1363                         d[2] = (int)(in4f[x*4+0]*a+pixel[x*4+2]*b);if (d[2] > 255) d[2] = 255;
1364                         d[3] = (int)(in4f[x*4+3]*a+pixel[x*4+3]*b);if (d[3] > 255) d[3] = 255;
1365                         pixel[x*4+0] = d[0];
1366                         pixel[x*4+1] = d[1];
1367                         pixel[x*4+2] = d[2];
1368                         pixel[x*4+3] = d[3];
1369                 }
1370                 break;
1371         }
1372 }
1373
1374 void DPSOFTRAST_Draw_Span_FinishBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, const unsigned char* RESTRICT in4ub)
1375 {
1376 #ifdef SSE2_PRESENT
1377         int x;
1378         int startx = span->startx;
1379         int endx = span->endx;
1380         const unsigned int * RESTRICT ini = (const unsigned int *)in4ub;
1381         unsigned char * RESTRICT pixelmask = span->pixelmask;
1382         unsigned char * RESTRICT pixel = (unsigned char *)dpsoftrast.fb_colorpixels[0];
1383         unsigned int * RESTRICT pixeli = (unsigned int *)dpsoftrast.fb_colorpixels[0];
1384         if (!pixel)
1385                 return;
1386         pixel += span->start * 4;
1387         pixeli += span->start;
1388         // handle alphatest now (this affects depth writes too)
1389         if (dpsoftrast.user.alphatest)
1390                 for (x = startx;x < endx;x++)
1391                         if (in4ub[x*4+3] < 0.5f)
1392                                 pixelmask[x] = false;
1393         // FIXME: this does not handle bigendian
1394         switch(dpsoftrast.fb_blendmode)
1395         {
1396         case DPSOFTRAST_BLENDMODE_OPAQUE:
1397                 for (x = startx;x + 4 <= endx;)
1398                 {
1399                         if (*(const unsigned int *)&pixelmask[x] == 0x01010101)
1400                         {
1401                                 _mm_storeu_si128((__m128i *)&pixeli[x], _mm_loadu_si128((const __m128i *)&ini[x]));
1402                                 x += 4;
1403                         }
1404                         else
1405                         {
1406                                 if (pixelmask[x])
1407                                         pixeli[x] = ini[x];
1408                                 x++;
1409                         }
1410                 }
1411                 for (;x < endx;x++)
1412                         if (pixelmask[x])
1413                                 pixeli[x] = ini[x];
1414                 break;
1415         case DPSOFTRAST_BLENDMODE_ALPHA:
1416         #define FINISHBLEND(blend2, blend1) \
1417                 for (x = startx;x + 2 <= endx;x += 2) \
1418                 { \
1419                         __m128i src, dst; \
1420                         switch (*(const unsigned short*)&pixelmask[x]) \
1421                         { \
1422                         case 0x0101: \
1423                                 src = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&ini[x]), _mm_setzero_si128()); \
1424                                 dst = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&pixeli[x]), _mm_setzero_si128()); \
1425                                 blend2; \
1426                                 _mm_storel_epi64((__m128i *)&pixeli[x], _mm_packus_epi16(dst, dst)); \
1427                                 continue; \
1428                         case 0x0100: \
1429                                 src = _mm_unpacklo_epi8(_mm_cvtsi32_si128(ini[x+1]), _mm_setzero_si128()); \
1430                                 dst = _mm_unpacklo_epi8(_mm_cvtsi32_si128(pixeli[x+1]), _mm_setzero_si128()); \
1431                                 blend1; \
1432                                 pixeli[x+1] = _mm_cvtsi128_si32(_mm_packus_epi16(dst, dst));  \
1433                                 continue; \
1434                         case 0x0001: \
1435                                 src = _mm_unpacklo_epi8(_mm_cvtsi32_si128(ini[x]), _mm_setzero_si128()); \
1436                                 dst = _mm_unpacklo_epi8(_mm_cvtsi32_si128(pixeli[x]), _mm_setzero_si128()); \
1437                                 blend1; \
1438                                 pixeli[x] = _mm_cvtsi128_si32(_mm_packus_epi16(dst, dst)); \
1439                                 continue; \
1440                         } \
1441                         break; \
1442                 } \
1443                 for(;x < endx; x++) \
1444                 { \
1445                         __m128i src, dst; \
1446                         if (!pixelmask[x]) \
1447                                 continue; \
1448                         src = _mm_unpacklo_epi8(_mm_cvtsi32_si128(ini[x]), _mm_setzero_si128()); \
1449                         dst = _mm_unpacklo_epi8(_mm_cvtsi32_si128(pixeli[x]), _mm_setzero_si128()); \
1450                         blend1; \
1451                         pixeli[x] = _mm_cvtsi128_si32(_mm_packus_epi16(dst, dst)); \
1452                 }
1453
1454                 FINISHBLEND({
1455                         __m128i blend = _mm_shufflehi_epi16(_mm_shufflelo_epi16(src, _MM_SHUFFLE(3, 3, 3, 3)), _MM_SHUFFLE(3, 3, 3, 3));
1456                         dst = _mm_add_epi16(dst, _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(src, dst), 4), _mm_slli_epi16(blend, 4)));
1457                 }, {
1458                         __m128i blend = _mm_shufflelo_epi16(src, _MM_SHUFFLE(3, 3, 3, 3));
1459                         dst = _mm_add_epi16(dst, _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(src, dst), 4), _mm_slli_epi16(blend, 4)));
1460                 });
1461                 break;
1462         case DPSOFTRAST_BLENDMODE_ADDALPHA:
1463                 FINISHBLEND({
1464                         __m128i blend = _mm_shufflehi_epi16(_mm_shufflelo_epi16(src, _MM_SHUFFLE(3, 3, 3, 3)), _MM_SHUFFLE(3, 3, 3, 3));
1465                         dst = _mm_add_epi16(dst, _mm_srli_epi16(_mm_mullo_epi16(src, blend), 8));
1466                 }, {
1467                         __m128i blend = _mm_shufflelo_epi16(src, _MM_SHUFFLE(3, 3, 3, 3));
1468                         dst = _mm_add_epi16(dst, _mm_srli_epi16(_mm_mullo_epi16(src, blend), 8));
1469                 });
1470                 break;
1471         case DPSOFTRAST_BLENDMODE_ADD:
1472                 FINISHBLEND({ dst = _mm_add_epi16(src, dst); }, { dst = _mm_add_epi16(src, dst); });
1473                 break;
1474         case DPSOFTRAST_BLENDMODE_INVMOD:
1475                 FINISHBLEND({
1476                         dst = _mm_sub_epi16(dst, _mm_srli_epi16(_mm_mullo_epi16(dst, src), 8));
1477                 }, {
1478                         dst = _mm_sub_epi16(dst, _mm_srli_epi16(_mm_mullo_epi16(dst, src), 8));
1479                 });
1480                 break;
1481         case DPSOFTRAST_BLENDMODE_MUL:
1482                 FINISHBLEND({ dst = _mm_srli_epi16(_mm_mullo_epi16(src, dst), 8); }, { dst = _mm_srli_epi16(_mm_mullo_epi16(src, dst), 8); });
1483                 break;
1484         case DPSOFTRAST_BLENDMODE_MUL2:
1485                 FINISHBLEND({ dst = _mm_srli_epi16(_mm_mullo_epi16(src, dst), 7); }, { dst = _mm_srli_epi16(_mm_mullo_epi16(src, dst), 7); });
1486                 break;
1487         case DPSOFTRAST_BLENDMODE_SUBALPHA:
1488                 FINISHBLEND({
1489                         __m128i blend = _mm_shufflehi_epi16(_mm_shufflelo_epi16(src, _MM_SHUFFLE(3, 3, 3, 3)), _MM_SHUFFLE(3, 3, 3, 3));
1490                         dst = _mm_sub_epi16(dst, _mm_srli_epi16(_mm_mullo_epi16(src, blend), 8));
1491                 }, {
1492                         __m128i blend = _mm_shufflelo_epi16(src, _MM_SHUFFLE(3, 3, 3, 3));
1493                         dst = _mm_sub_epi16(dst, _mm_srli_epi16(_mm_mullo_epi16(src, blend), 8));
1494                 });
1495                 break;
1496         case DPSOFTRAST_BLENDMODE_PSEUDOALPHA:
1497                 FINISHBLEND({
1498                         __m128i blend = _mm_shufflehi_epi16(_mm_shufflelo_epi16(src, _MM_SHUFFLE(3, 3, 3, 3)), _MM_SHUFFLE(3, 3, 3, 3));
1499                         dst = _mm_add_epi16(src, _mm_sub_epi16(dst, _mm_srli_epi16(_mm_mullo_epi16(dst, blend), 8)));
1500                 }, {
1501                         __m128i blend = _mm_shufflelo_epi16(src, _MM_SHUFFLE(3, 3, 3, 3));
1502                         dst = _mm_add_epi16(src, _mm_sub_epi16(dst, _mm_srli_epi16(_mm_mullo_epi16(dst, blend), 8)));
1503                 });
1504                 break;
1505         }
1506 #endif
1507 }
1508
1509 void DPSOFTRAST_Draw_Span_Texture2DVarying(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float * RESTRICT out4f, int texunitindex, int arrayindex, const float * RESTRICT zf)
1510 {
1511         int x;
1512         int startx = span->startx;
1513         int endx = span->endx;
1514         int flags;
1515         float c[4];
1516         float data[4];
1517         float slope[4];
1518         float tc[2], endtc[2];
1519         float tcscale[2];
1520         unsigned int tci[2];
1521         unsigned int tci1[2];
1522         unsigned int tcimin[2];
1523         unsigned int tcimax[2];
1524         int tciwrapmask[2];
1525         int tciwidth;
1526         int filter;
1527         int mip;
1528         const unsigned char * RESTRICT pixelbase;
1529         const unsigned char * RESTRICT pixel[4];
1530         DPSOFTRAST_Texture *texture = dpsoftrast.texbound[texunitindex];
1531         // if no texture is bound, just fill it with white
1532         if (!texture)
1533         {
1534                 for (x = startx;x < endx;x++)
1535                 {
1536                         out4f[x*4+0] = 1.0f;
1537                         out4f[x*4+1] = 1.0f;
1538                         out4f[x*4+2] = 1.0f;
1539                         out4f[x*4+3] = 1.0f;
1540                 }
1541                 return;
1542         }
1543         mip = span->mip[texunitindex];
1544         pixelbase = (unsigned char *)texture->bytes + texture->mipmap[mip][0];
1545         // if this mipmap of the texture is 1 pixel, just fill it with that color
1546         if (texture->mipmap[mip][1] == 4)
1547         {
1548                 c[0] = texture->bytes[2] * (1.0f/255.0f);
1549                 c[1] = texture->bytes[1] * (1.0f/255.0f);
1550                 c[2] = texture->bytes[0] * (1.0f/255.0f);
1551                 c[3] = texture->bytes[3] * (1.0f/255.0f);
1552                 for (x = startx;x < endx;x++)
1553                 {
1554                         out4f[x*4+0] = c[0];
1555                         out4f[x*4+1] = c[1];
1556                         out4f[x*4+2] = c[2];
1557                         out4f[x*4+3] = c[3];
1558                 }
1559                 return;
1560         }
1561         filter = texture->filter & DPSOFTRAST_TEXTURE_FILTER_LINEAR;
1562         data[0] = span->data[0][arrayindex][0];
1563         data[1] = span->data[0][arrayindex][1];
1564         data[2] = span->data[0][arrayindex][2];
1565         data[3] = span->data[0][arrayindex][3];
1566         slope[0] = span->data[1][arrayindex][0];
1567         slope[1] = span->data[1][arrayindex][1];
1568         slope[2] = span->data[1][arrayindex][2];
1569         slope[3] = span->data[1][arrayindex][3];
1570         flags = texture->flags;
1571         tcscale[0] = texture->mipmap[mip][2];
1572         tcscale[1] = texture->mipmap[mip][3];
1573         tciwidth = texture->mipmap[mip][2];
1574         tcimin[0] = 0;
1575         tcimin[1] = 0;
1576         tcimax[0] = texture->mipmap[mip][2]-1;
1577         tcimax[1] = texture->mipmap[mip][3]-1;
1578         tciwrapmask[0] = texture->mipmap[mip][2]-1;
1579         tciwrapmask[1] = texture->mipmap[mip][3]-1;
1580         endtc[0] = (data[0] + slope[0]*startx) * zf[startx] * tcscale[0] - 0.5f;
1581         endtc[1] = (data[1] + slope[1]*startx) * zf[startx] * tcscale[1] - 0.5f;
1582         for (x = startx;x < endx;)
1583         {
1584                 unsigned int subtc[2];
1585                 unsigned int substep[2];
1586                 float subscale = 65536.0f/DPSOFTRAST_MAXSUBSPAN;
1587                 int nextsub = x + DPSOFTRAST_MAXSUBSPAN, endsub = nextsub - 1;
1588                 if(nextsub >= endx)
1589                 {
1590                         nextsub = endsub = endx-1;      
1591                         if(x < nextsub) subscale = 65536.0f / (nextsub - x);
1592                 }
1593                 tc[0] = endtc[0];
1594                 tc[1] = endtc[1];
1595                 endtc[0] = (data[0] + slope[0]*nextsub) * zf[nextsub] * tcscale[0] - 0.5f;
1596                 endtc[1] = (data[1] + slope[1]*nextsub) * zf[nextsub] * tcscale[1] - 0.5f;
1597                 substep[0] = (endtc[0] - tc[0]) * subscale;
1598                 substep[1] = (endtc[1] - tc[1]) * subscale;
1599                 subtc[0] = tc[0] * (1<<16);
1600                 subtc[1] = tc[1] * (1<<16);
1601                 if(filter)
1602                 {
1603                         if (flags & DPSOFTRAST_TEXTURE_FLAG_CLAMPTOEDGE)
1604                         {
1605                                 for (; x <= endsub; x++, subtc[0] += substep[0], subtc[1] += substep[1])
1606                                 {
1607                                         unsigned int frac[2] = { subtc[0]&0xFFF, subtc[1]&0xFFF };
1608                                         unsigned int ifrac[2] = { 0x1000 - frac[0], 0x1000 - frac[1] };
1609                                         unsigned int lerp[4] = { ifrac[0]*ifrac[1], frac[0]*ifrac[1], ifrac[0]*frac[1], frac[0]*frac[1] };
1610                                         tci[0] = subtc[0]>>16;
1611                                         tci[1] = subtc[1]>>16;
1612                                         tci1[0] = tci[0] + 1;
1613                                         tci1[1] = tci[1] + 1;
1614                                         tci[0] = tci[0] >= tcimin[0] ? (tci[0] <= tcimax[0] ? tci[0] : tcimax[0]) : tcimin[0];
1615                                         tci[1] = tci[1] >= tcimin[1] ? (tci[1] <= tcimax[1] ? tci[1] : tcimax[1]) : tcimin[1];
1616                                         tci1[0] = tci1[0] >= tcimin[0] ? (tci1[0] <= tcimax[0] ? tci1[0] : tcimax[0]) : tcimin[0];
1617                                         tci1[1] = tci1[1] >= tcimin[1] ? (tci1[1] <= tcimax[1] ? tci1[1] : tcimax[1]) : tcimin[1];
1618                                         pixel[0] = pixelbase + 4 * (tci[1]*tciwidth+tci[0]);
1619                                         pixel[1] = pixelbase + 4 * (tci[1]*tciwidth+tci1[0]);
1620                                         pixel[2] = pixelbase + 4 * (tci1[1]*tciwidth+tci[0]);
1621                                         pixel[3] = pixelbase + 4 * (tci1[1]*tciwidth+tci1[0]);
1622                                         c[0] = (pixel[0][2]*lerp[0]+pixel[1][2]*lerp[1]+pixel[2][2]*lerp[2]+pixel[3][2]*lerp[3]) * (1.0f / 0xFF000000);
1623                                         c[1] = (pixel[0][1]*lerp[0]+pixel[1][1]*lerp[1]+pixel[2][1]*lerp[2]+pixel[3][1]*lerp[3]) * (1.0f / 0xFF000000);
1624                                         c[2] = (pixel[0][0]*lerp[0]+pixel[1][0]*lerp[1]+pixel[2][0]*lerp[2]+pixel[3][0]*lerp[3]) * (1.0f / 0xFF000000);
1625                                         c[3] = (pixel[0][3]*lerp[0]+pixel[1][3]*lerp[1]+pixel[2][3]*lerp[2]+pixel[3][3]*lerp[3]) * (1.0f / 0xFF000000);
1626                                         out4f[x*4+0] = c[0];
1627                                         out4f[x*4+1] = c[1];
1628                                         out4f[x*4+2] = c[2];
1629                                         out4f[x*4+3] = c[3];
1630                                 }
1631                         }
1632                         else
1633                         {
1634                                 for (; x <= endsub; x++, subtc[0] += substep[0], subtc[1] += substep[1])
1635                                 {
1636                                         unsigned int frac[2] = { subtc[0]&0xFFF, subtc[1]&0xFFF };
1637                                         unsigned int ifrac[2] = { 0x1000 - frac[0], 0x1000 - frac[1] };
1638                                         unsigned int lerp[4] = { ifrac[0]*ifrac[1], frac[0]*ifrac[1], ifrac[0]*frac[1], frac[0]*frac[1] };
1639                                         tci[0] = subtc[0]>>16;
1640                                         tci[1] = subtc[1]>>16;
1641                                         tci1[0] = tci[0] + 1;
1642                                         tci1[1] = tci[1] + 1;
1643                                         tci[0] &= tciwrapmask[0];
1644                                         tci[1] &= tciwrapmask[1];
1645                                         tci1[0] &= tciwrapmask[0];
1646                                         tci1[1] &= tciwrapmask[1];
1647                                         pixel[0] = pixelbase + 4 * (tci[1]*tciwidth+tci[0]);
1648                                         pixel[1] = pixelbase + 4 * (tci[1]*tciwidth+tci1[0]);
1649                                         pixel[2] = pixelbase + 4 * (tci1[1]*tciwidth+tci[0]);
1650                                         pixel[3] = pixelbase + 4 * (tci1[1]*tciwidth+tci1[0]);
1651                                         c[0] = (pixel[0][2]*lerp[0]+pixel[1][2]*lerp[1]+pixel[2][2]*lerp[2]+pixel[3][2]*lerp[3]) * (1.0f / 0xFF000000);
1652                                         c[1] = (pixel[0][1]*lerp[0]+pixel[1][1]*lerp[1]+pixel[2][1]*lerp[2]+pixel[3][1]*lerp[3]) * (1.0f / 0xFF000000);
1653                                         c[2] = (pixel[0][0]*lerp[0]+pixel[1][0]*lerp[1]+pixel[2][0]*lerp[2]+pixel[3][0]*lerp[3]) * (1.0f / 0xFF000000);
1654                                         c[3] = (pixel[0][3]*lerp[0]+pixel[1][3]*lerp[1]+pixel[2][3]*lerp[2]+pixel[3][3]*lerp[3]) * (1.0f / 0xFF000000);
1655                                         out4f[x*4+0] = c[0];
1656                                         out4f[x*4+1] = c[1];
1657                                         out4f[x*4+2] = c[2];
1658                                         out4f[x*4+3] = c[3];
1659                                 }
1660                         }
1661                 }
1662                 else if (flags & DPSOFTRAST_TEXTURE_FLAG_CLAMPTOEDGE)
1663                 {
1664                         for (; x <= endsub; x++, subtc[0] += substep[0], subtc[1] += substep[1])
1665                         {
1666                                 tci[0] = subtc[0]>>16;
1667                                 tci[1] = subtc[1]>>16;
1668                                 tci[0] = tci[0] >= tcimin[0] ? (tci[0] <= tcimax[0] ? tci[0] : tcimax[0]) : tcimin[0];
1669                                 tci[1] = tci[1] >= tcimin[1] ? (tci[1] <= tcimax[1] ? tci[1] : tcimax[1]) : tcimin[1];
1670                                 pixel[0] = pixelbase + 4 * (tci[1]*tciwidth+tci[0]);
1671                                 c[0] = pixel[0][2] * (1.0f / 255.0f);
1672                                 c[1] = pixel[0][1] * (1.0f / 255.0f);
1673                                 c[2] = pixel[0][0] * (1.0f / 255.0f);
1674                                 c[3] = pixel[0][3] * (1.0f / 255.0f);
1675                                 out4f[x*4+0] = c[0];
1676                                 out4f[x*4+1] = c[1];
1677                                 out4f[x*4+2] = c[2];
1678                                 out4f[x*4+3] = c[3];
1679                         }
1680                 }
1681                 else
1682                 {
1683                         for (; x <= endsub; x++, subtc[0] += substep[0], subtc[1] += substep[1])
1684                         {
1685                                 tci[0] = subtc[0]>>16;
1686                                 tci[1] = subtc[1]>>16;
1687                                 tci[0] &= tciwrapmask[0];
1688                                 tci[1] &= tciwrapmask[1];
1689                                 pixel[0] = pixelbase + 4 * (tci[1]*tciwidth+tci[0]);
1690                                 c[0] = pixel[0][2] * (1.0f / 255.0f);
1691                                 c[1] = pixel[0][1] * (1.0f / 255.0f);
1692                                 c[2] = pixel[0][0] * (1.0f / 255.0f);
1693                                 c[3] = pixel[0][3] * (1.0f / 255.0f);
1694                                 out4f[x*4+0] = c[0];
1695                                 out4f[x*4+1] = c[1];
1696                                 out4f[x*4+2] = c[2];
1697                                 out4f[x*4+3] = c[3];
1698                         }
1699                 }
1700         }
1701 }
1702
1703 void DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char * RESTRICT out4ub, int texunitindex, int arrayindex, const float * RESTRICT zf)
1704 {
1705 #ifdef SSE2_PRESENT
1706         int x;
1707         int startx = span->startx;
1708         int endx = span->endx;
1709         int flags;
1710         __m128 data, slope, tcscale;
1711         __m128i tcsize, tcmask, tcoffset, tcmax;
1712         __m128 tc, endtc;
1713         __m128i subtc, substep, endsubtc;
1714         int filter;
1715         int mip;
1716         unsigned int *outi = (unsigned int *)out4ub;
1717         const unsigned char * RESTRICT pixelbase;
1718         DPSOFTRAST_Texture *texture = dpsoftrast.texbound[texunitindex];
1719         // if no texture is bound, just fill it with white
1720         if (!texture)
1721         {
1722                 memset(out4ub + startx*4, 255, span->length*4);
1723                 return;
1724         }
1725         mip = span->mip[texunitindex];
1726         pixelbase = (const unsigned char *)texture->bytes + texture->mipmap[mip][0];
1727         // if this mipmap of the texture is 1 pixel, just fill it with that color
1728         if (texture->mipmap[mip][1] == 4)
1729         {
1730                 unsigned int k = *((const unsigned int *)pixelbase);
1731                 for (x = startx;x < endx;x++)
1732                         outi[x] = k;
1733                 return;
1734         }
1735         filter = texture->filter & DPSOFTRAST_TEXTURE_FILTER_LINEAR;
1736         data = _mm_load_ps(span->data[0][arrayindex]);
1737         slope = _mm_load_ps(span->data[1][arrayindex]);
1738         flags = texture->flags;
1739         tcsize = _mm_shuffle_epi32(_mm_loadu_si128((const __m128i *)&texture->mipmap[mip][0]), _MM_SHUFFLE(3, 2, 3, 2));
1740         tcmask = _mm_sub_epi32(tcsize, _mm_set1_epi32(1));
1741         tcscale = _mm_cvtepi32_ps(tcsize);
1742         data = _mm_mul_ps(_mm_shuffle_ps(data, data, _MM_SHUFFLE(1, 0, 1, 0)), tcscale);
1743         slope = _mm_mul_ps(_mm_shuffle_ps(slope, slope, _MM_SHUFFLE(1, 0, 1, 0)), tcscale);
1744         endtc = _mm_sub_ps(_mm_mul_ps(_mm_add_ps(data, _mm_mul_ps(slope, _mm_set1_ps(startx))), _mm_load1_ps(&zf[startx])), _mm_set1_ps(0.5f));
1745         endsubtc = _mm_cvtps_epi32(_mm_mul_ps(endtc, _mm_set1_ps(65536.0f)));
1746         tcoffset = _mm_add_epi32(_mm_slli_epi32(_mm_shuffle_epi32(tcsize, _MM_SHUFFLE(0, 0, 0, 0)), 18), _mm_set1_epi32(4));
1747         tcmax = filter ? _mm_packs_epi32(tcmask, tcmask) : _mm_slli_epi32(tcmask, 16);  
1748         for (x = startx;x < endx;)
1749         {
1750                 int nextsub = x + DPSOFTRAST_MAXSUBSPAN, endsub = nextsub - 1;
1751                 __m128 subscale = _mm_set1_ps(65536.0f/DPSOFTRAST_MAXSUBSPAN);
1752                 if(nextsub >= endx)
1753                 {
1754                         nextsub = endsub = endx-1;
1755                         if(x < nextsub) subscale = _mm_set1_ps(65536.0f / (nextsub - x));
1756                 }       
1757                 tc = endtc;
1758                 subtc = endsubtc;
1759                 endtc = _mm_sub_ps(_mm_mul_ps(_mm_add_ps(data, _mm_mul_ps(slope, _mm_set1_ps(nextsub))), _mm_load1_ps(&zf[nextsub])), _mm_set1_ps(0.5f));
1760                 substep = _mm_cvtps_epi32(_mm_mul_ps(_mm_sub_ps(endtc, tc), subscale));
1761                 endsubtc = _mm_cvtps_epi32(_mm_mul_ps(endtc, _mm_set1_ps(65536.0f)));
1762                 subtc = _mm_unpacklo_epi64(subtc, _mm_add_epi32(subtc, substep));
1763                 substep = _mm_slli_epi32(substep, 1);
1764                 if (filter)
1765                 {
1766                         __m128i tcrange = _mm_srai_epi32(_mm_unpacklo_epi64(subtc, _mm_add_epi32(endsubtc, substep)), 16);
1767                         if (_mm_movemask_epi8(_mm_andnot_si128(_mm_cmplt_epi32(tcrange, _mm_setzero_si128()), _mm_cmplt_epi32(tcrange, tcmask))) == 0xFFFF)
1768                         {
1769                                 for (; x + 1 <= endsub; x += 2, subtc = _mm_add_epi32(subtc, substep))
1770                                 {
1771                                         __m128i tci = _mm_shufflehi_epi16(_mm_shufflelo_epi16(subtc, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(3, 1, 3, 1)), pix1, pix2, pix3, pix4, fracm;
1772                                         tci = _mm_madd_epi16(_mm_add_epi16(tci, _mm_setr_epi32(0, 0x10000, 0, 0x10000)), tcoffset);
1773                                         pix1 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&pixelbase[_mm_cvtsi128_si32(tci)]), _mm_setzero_si128());
1774                                         pix2 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(1, 1, 1, 1)))]), _mm_setzero_si128());
1775                                         pix3 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(2, 2, 2, 2)))]), _mm_setzero_si128());
1776                                         pix4 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(3, 3, 3, 3)))]), _mm_setzero_si128());
1777                                         fracm = _mm_srli_epi16(subtc, 1);
1778                                         pix1 = _mm_add_epi16(pix1,
1779                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 1),
1780                                                                                                                  _mm_shuffle_epi32(_mm_shufflelo_epi16(fracm, _MM_SHUFFLE(2, 2, 2, 2)), _MM_SHUFFLE(1, 0, 1, 0))));
1781                                         pix3 = _mm_add_epi16(pix3,
1782                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix4, pix3), 1),
1783                                                                                                                  _mm_shuffle_epi32(_mm_shufflehi_epi16(fracm, _MM_SHUFFLE(2, 2, 2, 2)), _MM_SHUFFLE(3, 2, 3, 2))));
1784                                         pix2 = _mm_unpacklo_epi64(pix1, pix3);
1785                                         pix4 = _mm_unpackhi_epi64(pix1, pix3);
1786                                         pix2 = _mm_add_epi16(pix2,
1787                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix4, pix2), 1),
1788                                                                                                                  _mm_shufflehi_epi16(_mm_shufflelo_epi16(fracm, _MM_SHUFFLE(0, 0, 0, 0)), _MM_SHUFFLE(0, 0, 0, 0))));
1789                                         _mm_storel_epi64((__m128i *)&outi[x], _mm_packus_epi16(pix2, _mm_shufflelo_epi16(pix2, _MM_SHUFFLE(3, 2, 3, 2))));
1790                                 }
1791                                 if (x <= endsub)
1792                                 {
1793                                         __m128i tci = _mm_shufflelo_epi16(subtc, _MM_SHUFFLE(3, 1, 3, 1)), pix1, pix2, fracm;
1794                                         tci = _mm_madd_epi16(_mm_add_epi16(tci, _mm_setr_epi32(0, 0x10000, 0, 0)), tcoffset);
1795                                         pix1 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&pixelbase[_mm_cvtsi128_si32(tci)]), _mm_setzero_si128());
1796                                         pix2 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(1, 1, 1, 1)))]), _mm_setzero_si128());
1797                                         fracm = _mm_srli_epi16(subtc, 1);
1798                                         pix1 = _mm_add_epi16(pix1,
1799                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 1),
1800                                                                                                                  _mm_shuffle_epi32(_mm_shufflelo_epi16(fracm, _MM_SHUFFLE(2, 2, 2, 2)), _MM_SHUFFLE(1, 0, 1, 0))));
1801                                         pix2 = _mm_shuffle_epi32(pix1, _MM_SHUFFLE(3, 2, 3, 2));
1802                                         pix1 = _mm_add_epi16(pix1,
1803                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 1),
1804                                                                                                                  _mm_shufflelo_epi16(fracm, _MM_SHUFFLE(0, 0, 0, 0))));
1805                                         outi[x] = _mm_cvtsi128_si32(_mm_packus_epi16(pix1, pix1));
1806                                         x++;
1807                                 }
1808                         }
1809                         else if (flags & DPSOFTRAST_TEXTURE_FLAG_CLAMPTOEDGE)
1810                         {
1811                                 for (; x + 1 <= endsub; x += 2, subtc = _mm_add_epi32(subtc, substep))
1812                                 {
1813                                         __m128i tci = _mm_shuffle_epi32(_mm_shufflelo_epi16(subtc, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(1, 0, 1, 0)), pix1, pix2, pix3, pix4, fracm;
1814                                         tci = _mm_min_epi16(_mm_max_epi16(_mm_add_epi16(tci, _mm_setr_epi32(0, 1, 0x10000, 0x10001)), _mm_setzero_si128()), tcmax);
1815                                         tci = _mm_madd_epi16(tci, tcoffset);
1816                                         pix1 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(tci)]),
1817                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(1, 1, 1, 1)))])),
1818                                                                                         _mm_setzero_si128());
1819                                         pix2 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(2, 2, 2, 2)))]),
1820                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(3, 3, 3, 3)))])),
1821                                                                                         _mm_setzero_si128());
1822                                         tci = _mm_shuffle_epi32(_mm_shufflehi_epi16(subtc, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(3, 2, 3, 2));
1823                                         tci = _mm_and_si128(_mm_add_epi16(tci, _mm_setr_epi32(0, 1, 0x10000, 0x10001)), tcmax);
1824                                         tci = _mm_madd_epi16(tci, tcoffset);
1825                                         pix3 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(tci)]),
1826                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(1, 1, 1, 1)))])),
1827                                                                                         _mm_setzero_si128());
1828                                         pix4 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(2, 2, 2, 2)))]),
1829                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(3, 3, 3, 3)))])),
1830                                                                                         _mm_setzero_si128());
1831                                         fracm = _mm_srli_epi16(subtc, 1);
1832                                         pix1 = _mm_add_epi16(pix1,
1833                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 1),
1834                                                                                                                  _mm_shuffle_epi32(_mm_shufflelo_epi16(fracm, _MM_SHUFFLE(2, 2, 2, 2)), _MM_SHUFFLE(1, 0, 1, 0))));
1835                                         pix3 = _mm_add_epi16(pix3,
1836                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix4, pix3), 1),
1837                                                                                                                  _mm_shuffle_epi32(_mm_shufflehi_epi16(fracm, _MM_SHUFFLE(2, 2, 2, 2)), _MM_SHUFFLE(3, 2, 3, 2))));
1838                                         pix2 = _mm_unpacklo_epi64(pix1, pix3);
1839                                         pix4 = _mm_unpackhi_epi64(pix1, pix3);
1840                                         pix2 = _mm_add_epi16(pix2,
1841                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix4, pix2), 1),
1842                                                                                                                  _mm_shufflehi_epi16(_mm_shufflelo_epi16(fracm, _MM_SHUFFLE(0, 0, 0, 0)), _MM_SHUFFLE(0, 0, 0, 0))));
1843                                         _mm_storel_epi64((__m128i *)&outi[x], _mm_packus_epi16(pix2, _mm_shufflelo_epi16(pix2, _MM_SHUFFLE(3, 2, 3, 2))));
1844                                 }
1845                                 if (x <= endsub)
1846                                 {
1847                                         __m128i tci = _mm_shuffle_epi32(_mm_shufflelo_epi16(subtc, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(1, 0, 1, 0)), pix1, pix2, fracm;
1848                                         tci = _mm_min_epi16(_mm_max_epi16(_mm_add_epi16(tci, _mm_setr_epi32(0, 1, 0x10000, 0x10001)), _mm_setzero_si128()), tcmax);
1849                                         tci = _mm_madd_epi16(tci, tcoffset);
1850                                         pix1 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(tci)]), 
1851                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(1, 1, 1, 1)))])), 
1852                                                                                         _mm_setzero_si128());
1853                                         pix2 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(2, 2, 2, 2)))]), 
1854                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(3, 3, 3, 3)))])), 
1855                                                                                         _mm_setzero_si128());
1856                                         fracm = _mm_srli_epi16(subtc, 1);
1857                                         pix1 = _mm_add_epi16(pix1,
1858                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 1),
1859                                                                                                                  _mm_shuffle_epi32(_mm_shufflelo_epi16(fracm, _MM_SHUFFLE(2, 2, 2, 2)), _MM_SHUFFLE(1, 0, 1, 0))));
1860                                         pix2 = _mm_shuffle_epi32(pix1, _MM_SHUFFLE(3, 2, 3, 2));
1861                                         pix1 = _mm_add_epi16(pix1,
1862                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 1),
1863                                                                                                                  _mm_shufflelo_epi16(fracm, _MM_SHUFFLE(0, 0, 0, 0))));
1864                                         outi[x] = _mm_cvtsi128_si32(_mm_packus_epi16(pix1, pix1));
1865                                         x++;
1866                                 }
1867                         }
1868                         else
1869                         {
1870                                 for (; x + 1 <= endsub; x += 2, subtc = _mm_add_epi32(subtc, substep))
1871                                 {
1872                                         __m128i tci = _mm_shuffle_epi32(_mm_shufflelo_epi16(subtc, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(1, 0, 1, 0)), pix1, pix2, pix3, pix4, fracm;
1873                                         tci = _mm_and_si128(_mm_add_epi16(tci, _mm_setr_epi32(0, 1, 0x10000, 0x10001)), tcmax);
1874                                         tci = _mm_madd_epi16(tci, tcoffset);
1875                                         pix1 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(tci)]),
1876                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(1, 1, 1, 1)))])),
1877                                                                                         _mm_setzero_si128());
1878                                         pix2 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(2, 2, 2, 2)))]),
1879                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(3, 3, 3, 3)))])),
1880                                                                                         _mm_setzero_si128());
1881                                         tci = _mm_shuffle_epi32(_mm_shufflehi_epi16(subtc, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(3, 2, 3, 2));
1882                                         tci = _mm_and_si128(_mm_add_epi16(tci, _mm_setr_epi32(0, 1, 0x10000, 0x10001)), tcmax);
1883                                         tci = _mm_madd_epi16(tci, tcoffset);
1884                                         pix3 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(tci)]),
1885                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(1, 1, 1, 1)))])),
1886                                                                                         _mm_setzero_si128());
1887                                         pix4 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(2, 2, 2, 2)))]),
1888                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(3, 3, 3, 3)))])),
1889                                                                                         _mm_setzero_si128());
1890                                         fracm = _mm_srli_epi16(subtc, 1);
1891                                         pix1 = _mm_add_epi16(pix1,
1892                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 1),
1893                                                                                                                  _mm_shuffle_epi32(_mm_shufflelo_epi16(fracm, _MM_SHUFFLE(2, 2, 2, 2)), _MM_SHUFFLE(1, 0, 1, 0))));
1894                                         pix3 = _mm_add_epi16(pix3,
1895                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix4, pix3), 1),
1896                                                                                                                  _mm_shuffle_epi32(_mm_shufflehi_epi16(fracm, _MM_SHUFFLE(2, 2, 2, 2)), _MM_SHUFFLE(3, 2, 3, 2))));
1897                                         pix2 = _mm_unpacklo_epi64(pix1, pix3);
1898                                         pix4 = _mm_unpackhi_epi64(pix1, pix3);
1899                                         pix2 = _mm_add_epi16(pix2,
1900                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix4, pix2), 1),
1901                                                                                                                  _mm_shufflehi_epi16(_mm_shufflelo_epi16(fracm, _MM_SHUFFLE(0, 0, 0, 0)), _MM_SHUFFLE(0, 0, 0, 0))));
1902                                         _mm_storel_epi64((__m128i *)&outi[x], _mm_packus_epi16(pix2, _mm_shufflelo_epi16(pix2, _MM_SHUFFLE(3, 2, 3, 2))));
1903                                 }
1904                                 if (x <= endsub)
1905                                 {
1906                                         __m128i tci = _mm_shuffle_epi32(_mm_shufflelo_epi16(subtc, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(1, 0, 1, 0)), pix1, pix2, fracm;
1907                                         tci = _mm_and_si128(_mm_add_epi16(tci, _mm_setr_epi32(0, 1, 0x10000, 0x10001)), tcmax);
1908                                         tci = _mm_madd_epi16(tci, tcoffset);
1909                                         pix1 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(tci)]),                                                                                        
1910                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(1, 1, 1, 1)))])),
1911                                                                                         _mm_setzero_si128());
1912                                         pix2 = _mm_unpacklo_epi8(_mm_unpacklo_epi32(_mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(2, 2, 2, 2)))]),
1913                                                                                                                                 _mm_cvtsi32_si128(*(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(3, 3, 3, 3)))])),
1914                                                                                         _mm_setzero_si128());
1915                                         fracm = _mm_srli_epi16(subtc, 1);
1916                                         pix1 = _mm_add_epi16(pix1,
1917                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 1),
1918                                                                                                                  _mm_shuffle_epi32(_mm_shufflelo_epi16(fracm, _MM_SHUFFLE(2, 2, 2, 2)), _MM_SHUFFLE(1, 0, 1, 0))));
1919                                         pix2 = _mm_shuffle_epi32(pix1, _MM_SHUFFLE(3, 2, 3, 2));
1920                                         pix1 = _mm_add_epi16(pix1,
1921                                                                                  _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 1),
1922                                                                                                                  _mm_shufflelo_epi16(fracm, _MM_SHUFFLE(0, 0, 0, 0))));
1923                                         outi[x] = _mm_cvtsi128_si32(_mm_packus_epi16(pix1, pix1));
1924                                         x++;
1925                                 }
1926                         }
1927                 }
1928                 else
1929                 {
1930                         if (flags & DPSOFTRAST_TEXTURE_FLAG_CLAMPTOEDGE)
1931                         {
1932                                 for (; x + 1 <= endsub; x += 2, subtc = _mm_add_epi32(subtc, substep))
1933                                 {
1934                                         __m128i tci = _mm_min_epi16(_mm_max_epi16(subtc, _mm_setzero_si128()), tcmax); 
1935                                         tci = _mm_shufflehi_epi16(_mm_shufflelo_epi16(tci, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(3, 1, 3, 1));
1936                                         tci = _mm_madd_epi16(tci, tcoffset);
1937                                         outi[x] = *(const int *)&pixelbase[_mm_cvtsi128_si32(tci)];
1938                                         outi[x+1] = *(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(1, 1, 1, 1)))];
1939                                 }
1940                                 if (x <= endsub)
1941                                 {
1942                                         __m128i tci = _mm_min_epi16(_mm_max_epi16(subtc, _mm_setzero_si128()), tcmax);
1943                                         tci = _mm_shufflelo_epi16(tci, _MM_SHUFFLE(3, 1, 3, 1));
1944                                         tci = _mm_madd_epi16(tci, tcoffset);
1945                                         outi[x] = *(const int *)&pixelbase[_mm_cvtsi128_si32(tci)];
1946                                         x++;
1947                                 }
1948                         }
1949                         else
1950                         {
1951                                 for (; x + 1 <= endsub; x += 2, subtc = _mm_add_epi32(subtc, substep))
1952                                 {
1953                                         __m128i tci = _mm_and_si128(subtc, tcmax); 
1954                                         tci = _mm_shufflehi_epi16(_mm_shufflelo_epi16(tci, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(3, 1, 3, 1));
1955                                         tci = _mm_madd_epi16(tci, tcoffset);
1956                                         outi[x] = *(const int *)&pixelbase[_mm_cvtsi128_si32(tci)];
1957                                         outi[x+1] = *(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tci, _MM_SHUFFLE(1, 1, 1, 1)))];
1958                                 }
1959                                 if (x <= endsub)
1960                                 {
1961                                         __m128i tci = _mm_and_si128(subtc, tcmax); 
1962                                         tci = _mm_shufflelo_epi16(tci, _MM_SHUFFLE(3, 1, 3, 1));
1963                                         tci = _mm_madd_epi16(tci, tcoffset);
1964                                         outi[x] = *(const int *)&pixelbase[_mm_cvtsi128_si32(tci)];
1965                                         x++;
1966                                 }
1967                         }
1968                 }
1969         }
1970 #endif
1971 }
1972
1973 void DPSOFTRAST_Draw_Span_TextureCubeVaryingBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char * RESTRICT out4ub, int texunitindex, int arrayindex, const float * RESTRICT zf)
1974 {
1975         // TODO: IMPLEMENT
1976         memset(out4ub, 255, span->length*4);
1977 }
1978
1979 float DPSOFTRAST_SampleShadowmap(const float *vector)
1980 {
1981         // TODO: IMPLEMENT
1982         return 1.0f;
1983 }
1984
1985 void DPSOFTRAST_Draw_Span_MultiplyVarying(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *in4f, int arrayindex, const float *zf)
1986 {
1987         int x;
1988         int startx = span->startx;
1989         int endx = span->endx;
1990         float c[4];
1991         float data[4];
1992         float slope[4];
1993         float z;
1994         data[0] = span->data[0][arrayindex][0];
1995         data[1] = span->data[0][arrayindex][1];
1996         data[2] = span->data[0][arrayindex][2];
1997         data[3] = span->data[0][arrayindex][3];
1998         slope[0] = span->data[1][arrayindex][0];
1999         slope[1] = span->data[1][arrayindex][1];
2000         slope[2] = span->data[1][arrayindex][2];
2001         slope[3] = span->data[1][arrayindex][3];
2002         for (x = startx;x < endx;x++)
2003         {
2004                 z = zf[x];
2005                 c[0] = (data[0] + slope[0]*x) * z;
2006                 c[1] = (data[1] + slope[1]*x) * z;
2007                 c[2] = (data[2] + slope[2]*x) * z;
2008                 c[3] = (data[3] + slope[3]*x) * z;
2009                 out4f[x*4+0] = in4f[x*4+0] * c[0];
2010                 out4f[x*4+1] = in4f[x*4+1] * c[1];
2011                 out4f[x*4+2] = in4f[x*4+2] * c[2];
2012                 out4f[x*4+3] = in4f[x*4+3] * c[3];
2013         }
2014 }
2015
2016 void DPSOFTRAST_Draw_Span_Varying(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, int arrayindex, const float *zf)
2017 {
2018         int x;
2019         int startx = span->startx;
2020         int endx = span->endx;
2021         float c[4];
2022         float data[4];
2023         float slope[4];
2024         float z;
2025         data[0] = span->data[0][arrayindex][0];
2026         data[1] = span->data[0][arrayindex][1];
2027         data[2] = span->data[0][arrayindex][2];
2028         data[3] = span->data[0][arrayindex][3];
2029         slope[0] = span->data[1][arrayindex][0];
2030         slope[1] = span->data[1][arrayindex][1];
2031         slope[2] = span->data[1][arrayindex][2];
2032         slope[3] = span->data[1][arrayindex][3];
2033         for (x = startx;x < endx;x++)
2034         {
2035                 z = zf[x];
2036                 c[0] = (data[0] + slope[0]*x) * z;
2037                 c[1] = (data[1] + slope[1]*x) * z;
2038                 c[2] = (data[2] + slope[2]*x) * z;
2039                 c[3] = (data[3] + slope[3]*x) * z;
2040                 out4f[x*4+0] = c[0];
2041                 out4f[x*4+1] = c[1];
2042                 out4f[x*4+2] = c[2];
2043                 out4f[x*4+3] = c[3];
2044         }
2045 }
2046
2047 void DPSOFTRAST_Draw_Span_AddBloom(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *ina4f, const float *inb4f, const float *subcolor)
2048 {
2049         int x, startx = span->startx, endx = span->endx;
2050         float c[4], localcolor[4];
2051         localcolor[0] = subcolor[0];
2052         localcolor[1] = subcolor[1];
2053         localcolor[2] = subcolor[2];
2054         localcolor[3] = subcolor[3];
2055         for (x = startx;x < endx;x++)
2056         {
2057                 c[0] = inb4f[x*4+0] - localcolor[0];if (c[0] < 0.0f) c[0] = 0.0f;
2058                 c[1] = inb4f[x*4+1] - localcolor[1];if (c[1] < 0.0f) c[1] = 0.0f;
2059                 c[2] = inb4f[x*4+2] - localcolor[2];if (c[2] < 0.0f) c[2] = 0.0f;
2060                 c[3] = inb4f[x*4+3] - localcolor[3];if (c[3] < 0.0f) c[3] = 0.0f;
2061                 out4f[x*4+0] = ina4f[x*4+0] + c[0];
2062                 out4f[x*4+1] = ina4f[x*4+1] + c[1];
2063                 out4f[x*4+2] = ina4f[x*4+2] + c[2];
2064                 out4f[x*4+3] = ina4f[x*4+3] + c[3];
2065         }
2066 }
2067
2068 void DPSOFTRAST_Draw_Span_MultiplyBuffers(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *ina4f, const float *inb4f)
2069 {
2070         int x, startx = span->startx, endx = span->endx;
2071         for (x = startx;x < endx;x++)
2072         {
2073                 out4f[x*4+0] = ina4f[x*4+0] * inb4f[x*4+0];
2074                 out4f[x*4+1] = ina4f[x*4+1] * inb4f[x*4+1];
2075                 out4f[x*4+2] = ina4f[x*4+2] * inb4f[x*4+2];
2076                 out4f[x*4+3] = ina4f[x*4+3] * inb4f[x*4+3];
2077         }
2078 }
2079
2080 void DPSOFTRAST_Draw_Span_AddBuffers(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *ina4f, const float *inb4f)
2081 {
2082         int x, startx = span->startx, endx = span->endx;
2083         for (x = startx;x < endx;x++)
2084         {
2085                 out4f[x*4+0] = ina4f[x*4+0] + inb4f[x*4+0];
2086                 out4f[x*4+1] = ina4f[x*4+1] + inb4f[x*4+1];
2087                 out4f[x*4+2] = ina4f[x*4+2] + inb4f[x*4+2];
2088                 out4f[x*4+3] = ina4f[x*4+3] + inb4f[x*4+3];
2089         }
2090 }
2091
2092 void DPSOFTRAST_Draw_Span_MixBuffers(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *ina4f, const float *inb4f)
2093 {
2094         int x, startx = span->startx, endx = span->endx;
2095         float a, b;
2096         for (x = startx;x < endx;x++)
2097         {
2098                 a = 1.0f - inb4f[x*4+3];
2099                 b = inb4f[x*4+3];
2100                 out4f[x*4+0] = ina4f[x*4+0] * a + inb4f[x*4+0] * b;
2101                 out4f[x*4+1] = ina4f[x*4+1] * a + inb4f[x*4+1] * b;
2102                 out4f[x*4+2] = ina4f[x*4+2] * a + inb4f[x*4+2] * b;
2103                 out4f[x*4+3] = ina4f[x*4+3] * a + inb4f[x*4+3] * b;
2104         }
2105 }
2106
2107 void DPSOFTRAST_Draw_Span_MixUniformColor(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *in4f, const float *color)
2108 {
2109         int x, startx = span->startx, endx = span->endx;
2110         float localcolor[4], ilerp, lerp;
2111         localcolor[0] = color[0];
2112         localcolor[1] = color[1];
2113         localcolor[2] = color[2];
2114         localcolor[3] = color[3];
2115         ilerp = 1.0f - localcolor[3];
2116         lerp = localcolor[3];
2117         for (x = startx;x < endx;x++)
2118         {
2119                 out4f[x*4+0] = in4f[x*4+0] * ilerp + localcolor[0] * lerp;
2120                 out4f[x*4+1] = in4f[x*4+1] * ilerp + localcolor[1] * lerp;
2121                 out4f[x*4+2] = in4f[x*4+2] * ilerp + localcolor[2] * lerp;
2122                 out4f[x*4+3] = in4f[x*4+3] * ilerp + localcolor[3] * lerp;
2123         }
2124 }
2125
2126
2127
2128 void DPSOFTRAST_Draw_Span_MultiplyVaryingBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *in4ub, int arrayindex, const float *zf)
2129 {
2130 #ifdef SSE2_PRESENT
2131         int x;
2132         int startx = span->startx;
2133         int endx = span->endx;
2134         __m128 data = _mm_load_ps(span->data[0][arrayindex]), slope = _mm_load_ps(span->data[1][arrayindex]);
2135         data = _mm_shuffle_ps(data, data, _MM_SHUFFLE(3, 0, 1, 2));
2136         slope = _mm_shuffle_ps(slope, slope, _MM_SHUFFLE(3, 0, 1, 2));
2137         data = _mm_add_ps(data, _mm_mul_ps(slope, _mm_set1_ps(startx)));
2138         data = _mm_mul_ps(data, _mm_set1_ps(256.0f));
2139         slope = _mm_mul_ps(slope, _mm_set1_ps(256.0f));
2140         for (x = startx;x+2 <= endx;x += 2, data = _mm_add_ps(data, slope))
2141         {
2142                 __m128i pix = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_loadl_epi64((const __m128i *)&in4ub[x*4]));
2143                 __m128i mod = _mm_cvtps_epi32(_mm_mul_ps(data, _mm_load1_ps(&zf[x]))), mod2;
2144                 data = _mm_add_ps(data, slope);
2145                 mod2 = _mm_cvtps_epi32(_mm_mul_ps(data, _mm_load1_ps(&zf[x+1])));
2146                 mod = _mm_unpacklo_epi64(_mm_packs_epi32(mod, mod), _mm_packs_epi32(mod2, mod2));
2147                 pix = _mm_mulhi_epu16(pix, mod);
2148                 _mm_storel_epi64((__m128i *)&out4ub[x*4], _mm_packus_epi16(pix, pix));
2149         }
2150         for (;x < endx;x++, data = _mm_add_ps(data, slope))
2151         {
2152                 __m128i pix = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&in4ub[x*4]));
2153                 __m128i mod = _mm_cvtps_epi32(_mm_mul_ps(data, _mm_load1_ps(&zf[x])));
2154                 mod = _mm_packs_epi32(mod, mod);
2155                 pix = _mm_mulhi_epu16(pix, mod);
2156                 *(int *)&out4ub[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix, pix));
2157         }
2158 #endif
2159 }
2160
2161 void DPSOFTRAST_Draw_Span_VaryingBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, int arrayindex, const float *zf)
2162 {
2163 #ifdef SSE2_PRESENT
2164         int x;
2165         int startx = span->startx;
2166         int endx = span->endx;
2167         __m128 data = _mm_load_ps(span->data[0][arrayindex]), slope = _mm_load_ps(span->data[1][arrayindex]);
2168         data = _mm_shuffle_ps(data, data, _MM_SHUFFLE(3, 0, 1, 2));
2169         slope = _mm_shuffle_ps(slope, slope, _MM_SHUFFLE(3, 0, 1, 2));
2170         data = _mm_add_ps(data, _mm_mul_ps(slope, _mm_set1_ps(startx)));
2171         data = _mm_mul_ps(data, _mm_set1_ps(255.0f));
2172         slope = _mm_mul_ps(slope, _mm_set1_ps(255.0f));
2173         for (x = startx;x+2 <= endx;x += 2, data = _mm_add_ps(data, slope))
2174         {
2175                 __m128i pix = _mm_cvtps_epi32(_mm_mul_ps(data, _mm_load1_ps(&zf[x]))), pix2;
2176                 data = _mm_add_ps(data, slope);
2177                 pix2 = _mm_cvtps_epi32(_mm_mul_ps(data, _mm_load1_ps(&zf[x+1])));
2178                 pix = _mm_unpacklo_epi64(_mm_packs_epi32(pix, pix), _mm_packs_epi32(pix2, pix2));
2179                 _mm_storel_epi64((__m128i *)&out4ub[x*4], _mm_packus_epi16(pix, pix));
2180         }
2181         for (;x < endx;x++, data = _mm_add_ps(data, slope))
2182         {
2183                 __m128i pix = _mm_cvtps_epi32(_mm_mul_ps(data, _mm_load1_ps(&zf[x])));
2184                 pix = _mm_packs_epi32(pix, pix);
2185                 *(int *)&out4ub[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix, pix));
2186         }
2187 #endif
2188 }
2189
2190 void DPSOFTRAST_Draw_Span_AddBloomBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *ina4ub, const unsigned char *inb4ub, const float *subcolor)
2191 {
2192 #ifdef SSE2_PRESENT
2193         int x, startx = span->startx, endx = span->endx;
2194         __m128i localcolor = _mm_shuffle_epi32(_mm_cvtps_epi32(_mm_mul_ps(_mm_loadu_ps(subcolor), _mm_set1_ps(255.0f))), _MM_SHUFFLE(3, 0, 1, 2));
2195         localcolor = _mm_shuffle_epi32(_mm_packs_epi32(localcolor, localcolor), _MM_SHUFFLE(1, 0, 1, 0));
2196         for (x = startx;x+2 <= endx;x+=2)
2197         {
2198                 __m128i pix1 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&ina4ub[x*4]), _mm_setzero_si128());
2199                 __m128i pix2 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&inb4ub[x*4]), _mm_setzero_si128());
2200                 pix1 = _mm_add_epi16(pix1, _mm_sub_epi16(pix2, localcolor));
2201                 _mm_storel_epi64((__m128i *)&out4ub[x*4], _mm_packus_epi16(pix1, pix1));
2202         }
2203         if(x < endx)
2204         {
2205                 __m128i pix1 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(*(const int *)&ina4ub[x*4]), _mm_setzero_si128());
2206                 __m128i pix2 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(*(const int *)&inb4ub[x*4]), _mm_setzero_si128());
2207                 pix1 = _mm_add_epi16(pix1, _mm_sub_epi16(pix2, localcolor));
2208                 *(int *)&out4ub[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix1, pix1));
2209         }
2210 #endif
2211 }
2212
2213 void DPSOFTRAST_Draw_Span_MultiplyBuffersBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *ina4ub, const unsigned char *inb4ub)
2214 {
2215 #ifdef SSE2_PRESENT
2216         int x, startx = span->startx, endx = span->endx;
2217         for (x = startx;x+2 <= endx;x+=2)
2218         {
2219                 __m128i pix1 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&ina4ub[x*4]), _mm_setzero_si128());
2220                 __m128i pix2 = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_loadl_epi64((const __m128i *)&inb4ub[x*4]));
2221                 pix1 = _mm_mulhi_epu16(pix1, pix2);
2222                 _mm_storel_epi64((__m128i *)&out4ub[x*4], _mm_packus_epi16(pix1, pix1));
2223         }
2224         if(x < endx)
2225         {
2226                 __m128i pix1 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(*(const int *)&ina4ub[x*4]), _mm_setzero_si128());
2227                 __m128i pix2 = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&inb4ub[x*4]));
2228                 pix1 = _mm_mulhi_epu16(pix1, pix2);
2229                 *(int *)&out4ub[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix1, pix1));
2230         }
2231 #endif
2232 }
2233
2234 void DPSOFTRAST_Draw_Span_AddBuffersBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *ina4ub, const unsigned char *inb4ub)
2235 {
2236 #ifdef SSE2_PRESENT
2237         int x, startx = span->startx, endx = span->endx;
2238         for (x = startx;x+2 <= endx;x+=2)
2239         {
2240                 __m128i pix1 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&ina4ub[x*4]), _mm_setzero_si128());
2241                 __m128i pix2 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&inb4ub[x*4]), _mm_setzero_si128());
2242                 pix1 = _mm_add_epi16(pix1, pix2);
2243                 _mm_storel_epi64((__m128i *)&out4ub[x*4], _mm_packus_epi16(pix1, pix1));
2244         }
2245         if(x < endx)
2246         {
2247                 __m128i pix1 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(*(const int *)&ina4ub[x*4]), _mm_setzero_si128());
2248                 __m128i pix2 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(*(const int *)&inb4ub[x*4]), _mm_setzero_si128());
2249                 pix1 = _mm_add_epi16(pix1, pix2);
2250                 *(int *)&out4ub[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix1, pix1));
2251         }
2252 #endif
2253 }
2254
2255 void DPSOFTRAST_Draw_Span_TintedAddBuffersBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *ina4ub, const unsigned char *inb4ub, const float *inbtintbgra)
2256 {
2257 #ifdef SSE2_PRESENT
2258         int x, startx = span->startx, endx = span->endx;
2259         __m128i tint = _mm_cvtps_epi32(_mm_mul_ps(_mm_loadu_ps(inbtintbgra), _mm_set1_ps(256.0f)));
2260         tint = _mm_shuffle_epi32(_mm_packs_epi32(tint, tint), _MM_SHUFFLE(1, 0, 1, 0));
2261         for (x = startx;x+2 <= endx;x+=2)
2262         {
2263                 __m128i pix1 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&ina4ub[x*4]), _mm_setzero_si128());
2264                 __m128i pix2 = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_loadl_epi64((const __m128i *)&inb4ub[x*4]));
2265                 pix1 = _mm_add_epi16(pix1, _mm_mulhi_epu16(tint, pix2));
2266                 _mm_storel_epi64((__m128i *)&out4ub[x*4], _mm_packus_epi16(pix1, pix1));
2267         }
2268         if(x < endx)
2269         {
2270                 __m128i pix1 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(*(const int *)&ina4ub[x*4]), _mm_setzero_si128());
2271                 __m128i pix2 = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&inb4ub[x*4]));
2272                 pix1 = _mm_add_epi16(pix1, _mm_mulhi_epu16(tint, pix2));
2273                 *(int *)&out4ub[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix1, pix1));
2274         }
2275 #endif
2276 }
2277
2278 void DPSOFTRAST_Draw_Span_MixBuffersBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *ina4ub, const unsigned char *inb4ub)
2279 {
2280 #ifdef SSE2_PRESENT
2281         int x, startx = span->startx, endx = span->endx;
2282         for (x = startx;x+2 <= endx;x+=2)
2283         {
2284                 __m128i pix1 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&ina4ub[x*4]), _mm_setzero_si128());
2285                 __m128i pix2 = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&inb4ub[x*4]), _mm_setzero_si128());
2286                 __m128i blend = _mm_shufflehi_epi16(_mm_shufflelo_epi16(pix2, _MM_SHUFFLE(3, 3, 3, 3)), _MM_SHUFFLE(3, 3, 3, 3));
2287                 pix1 = _mm_add_epi16(pix1, _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 4), _mm_slli_epi16(blend, 4)));
2288                 _mm_storel_epi64((__m128i *)&out4ub[x*4], _mm_packus_epi16(pix1, pix1));
2289         }
2290         if(x < endx)
2291         {
2292                 __m128i pix1 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(*(const int *)&ina4ub[x*4]), _mm_setzero_si128());
2293                 __m128i pix2 = _mm_unpacklo_epi8(_mm_cvtsi32_si128(*(const int *)&inb4ub[x*4]), _mm_setzero_si128());
2294                 __m128i blend = _mm_shufflelo_epi16(pix2, _MM_SHUFFLE(3, 3, 3, 3));
2295                 pix1 = _mm_add_epi16(pix1, _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(pix2, pix1), 4), _mm_slli_epi16(blend, 4)));
2296                 *(int *)&out4ub[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix1, pix1));
2297         }
2298 #endif
2299 }
2300
2301 void DPSOFTRAST_Draw_Span_MixUniformColorBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *in4ub, const float *color)
2302 {
2303 #ifdef SSE2_PRESENT
2304         int x, startx = span->startx, endx = span->endx;
2305         __m128i localcolor = _mm_shuffle_epi32(_mm_cvtps_epi32(_mm_mul_ps(_mm_loadu_ps(color), _mm_set1_ps(255.0f))), _MM_SHUFFLE(3, 0, 1, 2)), blend;
2306         localcolor = _mm_shuffle_epi32(_mm_packs_epi32(localcolor, localcolor), _MM_SHUFFLE(1, 0, 1, 0));
2307         blend = _mm_slli_epi16(_mm_shufflehi_epi16(_mm_shufflelo_epi16(localcolor, _MM_SHUFFLE(3, 3, 3, 3)), _MM_SHUFFLE(3, 3, 3, 3)), 4);
2308         for (x = startx;x+2 <= endx;x+=2)
2309         {
2310                 __m128i pix = _mm_unpacklo_epi8(_mm_loadl_epi64((const __m128i *)&in4ub[x*4]), _mm_setzero_si128());
2311                 pix = _mm_add_epi16(pix, _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(localcolor, pix), 4), blend));
2312                 _mm_storel_epi64((__m128i *)&out4ub[x*4], _mm_packus_epi16(pix, pix));
2313         }
2314         if(x < endx)
2315         {
2316                 __m128i pix = _mm_unpacklo_epi8(_mm_cvtsi32_si128(*(const int *)&in4ub[x*4]), _mm_setzero_si128());
2317                 pix = _mm_add_epi16(pix, _mm_mulhi_epi16(_mm_slli_epi16(_mm_sub_epi16(localcolor, pix), 4), blend));
2318                 *(int *)&out4ub[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix, pix));
2319         }
2320 #endif
2321 }
2322
2323
2324
2325 void DPSOFTRAST_VertexShader_Generic(void)
2326 {
2327         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
2328         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_COLOR], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_COLOR], dpsoftrast.draw.numvertices);
2329         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.numvertices);
2330         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SPECULAR)
2331                 DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1], dpsoftrast.draw.numvertices);
2332 }
2333
2334 void DPSOFTRAST_PixelShader_Generic(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2335 {
2336         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2337         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2338         unsigned char buffer_texture_lightmapbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2339         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2340         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2341         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_DIFFUSE)
2342         {
2343                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_FIRST, 2, buffer_z);
2344                 DPSOFTRAST_Draw_Span_MultiplyVaryingBGRA8(span, buffer_FragColorbgra8, buffer_texture_colorbgra8, 1, buffer_z);
2345                 if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SPECULAR)
2346                 {
2347                         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_lightmapbgra8, GL20TU_SECOND, 2, buffer_z);
2348                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
2349                         {
2350                                 // multiply
2351                                 DPSOFTRAST_Draw_Span_MultiplyBuffersBGRA8(span, buffer_FragColorbgra8, buffer_FragColorbgra8, buffer_texture_lightmapbgra8);
2352                         }
2353                         else if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
2354                         {
2355                                 // add
2356                                 DPSOFTRAST_Draw_Span_AddBuffersBGRA8(span, buffer_FragColorbgra8, buffer_FragColorbgra8, buffer_texture_lightmapbgra8);
2357                         }
2358                         else if (dpsoftrast.shader_permutation & SHADERPERMUTATION_VERTEXTEXTUREBLEND)
2359                         {
2360                                 // alphablend
2361                                 DPSOFTRAST_Draw_Span_MixBuffersBGRA8(span, buffer_FragColorbgra8, buffer_FragColorbgra8, buffer_texture_lightmapbgra8);
2362                         }
2363                 }
2364         }
2365         else
2366                 DPSOFTRAST_Draw_Span_VaryingBGRA8(span, buffer_FragColorbgra8, 1, buffer_z);
2367         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2368 }
2369
2370
2371
2372 void DPSOFTRAST_VertexShader_PostProcess(void)
2373 {
2374         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
2375         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.numvertices);
2376         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1], dpsoftrast.draw.numvertices);
2377 }
2378
2379 void DPSOFTRAST_PixelShader_PostProcess(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2380 {
2381         // TODO: optimize!!  at the very least there is no reason to use texture sampling on the frame texture
2382         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2383         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2384         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2385         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2386         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_FragColorbgra8, GL20TU_FIRST, 2, buffer_z);
2387         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_BLOOM)
2388         {
2389                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_SECOND, 3, buffer_z);
2390                 DPSOFTRAST_Draw_Span_AddBloomBGRA8(span, buffer_FragColorbgra8, buffer_FragColorbgra8, buffer_texture_colorbgra8, dpsoftrast.uniform4f + DPSOFTRAST_UNIFORM_BloomColorSubtract * 4);
2391         }
2392         DPSOFTRAST_Draw_Span_MixUniformColorBGRA8(span, buffer_FragColorbgra8, buffer_FragColorbgra8, dpsoftrast.uniform4f + DPSOFTRAST_UNIFORM_ViewTintColor * 4);
2393         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SATURATION)
2394         {
2395                 // TODO: implement saturation
2396         }
2397         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GAMMARAMPS)
2398         {
2399                 // TODO: implement gammaramps
2400         }
2401         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2402 }
2403
2404
2405
2406 void DPSOFTRAST_VertexShader_Depth_Or_Shadow(void)
2407 {
2408         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
2409 }
2410
2411 void DPSOFTRAST_PixelShader_Depth_Or_Shadow(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2412 {
2413         // this is never called (because colormask is off when this shader is used)
2414         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2415         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2416         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2417         memset(buffer_FragColorbgra8, 0, span->length*4);
2418         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2419 }
2420
2421
2422
2423 void DPSOFTRAST_VertexShader_FlatColor(void)
2424 {
2425         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
2426         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_TexMatrixM1);
2427 }
2428
2429 void DPSOFTRAST_PixelShader_FlatColor(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2430 {
2431         int x, startx = span->startx, endx = span->endx;
2432         int Color_Ambienti[4];
2433         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2434         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2435         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2436         Color_Ambienti[2] = (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+0]*256.0f);
2437         Color_Ambienti[1] = (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+1]*256.0f);
2438         Color_Ambienti[0] = (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+2]*256.0f);
2439         Color_Ambienti[3] = (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Alpha*4+0]        *256.0f);
2440         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2441         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_COLOR, 2, buffer_z);
2442         for (x = startx;x < endx;x++)
2443         {
2444                 buffer_FragColorbgra8[x*4+0] = (buffer_texture_colorbgra8[x*4+0] * Color_Ambienti[0])>>8;
2445                 buffer_FragColorbgra8[x*4+1] = (buffer_texture_colorbgra8[x*4+1] * Color_Ambienti[1])>>8;
2446                 buffer_FragColorbgra8[x*4+2] = (buffer_texture_colorbgra8[x*4+2] * Color_Ambienti[2])>>8;
2447                 buffer_FragColorbgra8[x*4+3] = (buffer_texture_colorbgra8[x*4+3] * Color_Ambienti[3])>>8;
2448         }
2449         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2450 }
2451
2452
2453
2454 void DPSOFTRAST_VertexShader_VertexColor(void)
2455 {
2456         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
2457         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_COLOR], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_COLOR], dpsoftrast.draw.numvertices);
2458         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_TexMatrixM1);
2459 }
2460
2461 void DPSOFTRAST_PixelShader_VertexColor(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2462 {
2463 #ifdef SSE2_PRESENT
2464         unsigned char * RESTRICT pixelmask = span->pixelmask;
2465         unsigned char * RESTRICT pixel = (unsigned char *)dpsoftrast.fb_colorpixels[0] + span->start * 4;
2466         int x, startx = span->startx, endx = span->endx;
2467         __m128i Color_Ambientm, Color_Diffusem;
2468         __m128 data, slope;
2469         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2470         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2471         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2472         int arrayindex = DPSOFTRAST_ARRAY_COLOR;
2473         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2474         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_COLOR, 2, buffer_z);
2475         if (dpsoftrast.user.alphatest || dpsoftrast.fb_blendmode != DPSOFTRAST_BLENDMODE_OPAQUE)
2476                 pixel = buffer_FragColorbgra8;
2477         Color_Ambientm = _mm_shuffle_epi32(_mm_cvtps_epi32(_mm_mul_ps(_mm_load_ps(&dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4]), _mm_set1_ps(256.0f))), _MM_SHUFFLE(3, 0, 1, 2));
2478         Color_Ambientm = _mm_and_si128(Color_Ambientm, _mm_setr_epi32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0));
2479         Color_Ambientm = _mm_or_si128(Color_Ambientm, _mm_setr_epi32(0, 0, 0, (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Alpha*4+0]*255.0f)));
2480         Color_Ambientm = _mm_packs_epi32(Color_Ambientm, Color_Ambientm);
2481         Color_Diffusem = _mm_shuffle_epi32(_mm_cvtps_epi32(_mm_mul_ps(_mm_load_ps(&dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4]), _mm_set1_ps(4096.0f))), _MM_SHUFFLE(3, 0, 1, 2));
2482         Color_Diffusem = _mm_and_si128(Color_Diffusem, _mm_setr_epi32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0));
2483         Color_Diffusem = _mm_packs_epi32(Color_Diffusem, Color_Diffusem);
2484         data = _mm_load_ps(span->data[0][arrayindex]); 
2485         slope = _mm_load_ps(span->data[1][arrayindex]);
2486         data = _mm_shuffle_ps(data, data, _MM_SHUFFLE(3, 0, 1, 2));
2487         slope = _mm_shuffle_ps(slope, slope, _MM_SHUFFLE(3, 0, 1, 2));
2488         data = _mm_add_ps(data, _mm_mul_ps(slope, _mm_set1_ps(startx)));
2489         data = _mm_mul_ps(data, _mm_set1_ps(4096.0f));
2490         slope = _mm_mul_ps(slope, _mm_set1_ps(4096.0f));
2491         for (x = startx;x < endx;x++, data = _mm_add_ps(data, slope))
2492         {
2493                 __m128i color, mod, pix;
2494                 if (x + 4 <= endx && *(const unsigned int *)&pixelmask[x] == 0x01010101)
2495                 {
2496                         __m128i pix2, mod2;
2497                         __m128 z = _mm_loadu_ps(&buffer_z[x]);
2498                         color = _mm_loadu_si128((const __m128i *)&buffer_texture_colorbgra8[x*4]);
2499                         mod = _mm_cvtps_epi32(_mm_mul_ps(data, _mm_shuffle_ps(z, z, _MM_SHUFFLE(0, 0, 0, 0))));
2500                         data = _mm_add_ps(data, slope);
2501                         mod = _mm_packs_epi32(mod, _mm_cvtps_epi32(_mm_mul_ps(data, _mm_shuffle_ps(z, z, _MM_SHUFFLE(1, 1, 1, 1)))));
2502                         data = _mm_add_ps(data, slope);
2503                         mod2 = _mm_cvtps_epi32(_mm_mul_ps(data, _mm_shuffle_ps(z, z, _MM_SHUFFLE(2, 2, 2, 2))));
2504                         data = _mm_add_ps(data, slope);
2505                         mod2 = _mm_packs_epi32(mod2, _mm_cvtps_epi32(_mm_mul_ps(data, _mm_shuffle_ps(z, z, _MM_SHUFFLE(3, 3, 3, 3)))));
2506                         pix = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, mod), Color_Ambientm),
2507                                                                   _mm_unpacklo_epi8(_mm_setzero_si128(), color));
2508                         pix2 = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, mod2), Color_Ambientm),
2509                                                                    _mm_unpackhi_epi8(_mm_setzero_si128(), color));
2510                         _mm_storeu_si128((__m128i *)&pixel[x*4], _mm_packus_epi16(pix, pix2));
2511                         x += 3;
2512                         continue;
2513                 }
2514                 if(!pixelmask[x])
2515                         continue;
2516                 color = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_colorbgra8[x*4]));
2517                 mod = _mm_cvtps_epi32(_mm_mul_ps(data, _mm_load1_ps(&buffer_z[x]))); 
2518                 mod = _mm_packs_epi32(mod, mod);
2519                 pix = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(mod, Color_Diffusem), Color_Ambientm), color);
2520                 *(int *)&pixel[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix, pix));
2521         }
2522         if(pixel == buffer_FragColorbgra8)
2523                 DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2524 #endif
2525 }
2526
2527
2528
2529 void DPSOFTRAST_VertexShader_Lightmap(void)
2530 {
2531         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
2532         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_TexMatrixM1);
2533         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD4], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD4], dpsoftrast.draw.numvertices);
2534 }
2535
2536 void DPSOFTRAST_PixelShader_Lightmap(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2537 {
2538 #ifdef SSE2_PRESENT
2539         unsigned char * RESTRICT pixelmask = span->pixelmask;
2540         unsigned char * RESTRICT pixel = (unsigned char *)dpsoftrast.fb_colorpixels[0] + span->start * 4;
2541         int x, startx = span->startx, endx = span->endx;
2542         __m128i Color_Ambientm, Color_Diffusem, Color_Glowm, Color_AmbientGlowm;
2543         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2544         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2545         unsigned char buffer_texture_lightmapbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2546         unsigned char buffer_texture_glowbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2547         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2548         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2549         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_COLOR, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2550         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_lightmapbgra8, GL20TU_LIGHTMAP, DPSOFTRAST_ARRAY_TEXCOORD4, buffer_z);
2551         if (dpsoftrast.user.alphatest || dpsoftrast.fb_blendmode != DPSOFTRAST_BLENDMODE_OPAQUE)
2552                 pixel = buffer_FragColorbgra8;
2553         Color_Ambientm = _mm_shuffle_epi32(_mm_cvtps_epi32(_mm_mul_ps(_mm_load_ps(&dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4]), _mm_set1_ps(256.0f))), _MM_SHUFFLE(3, 0, 1, 2));
2554         Color_Ambientm = _mm_and_si128(Color_Ambientm, _mm_setr_epi32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0));
2555         Color_Ambientm = _mm_or_si128(Color_Ambientm, _mm_setr_epi32(0, 0, 0, (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Alpha*4+0]*255.0f)));
2556         Color_Ambientm = _mm_packs_epi32(Color_Ambientm, Color_Ambientm);
2557         Color_Diffusem = _mm_shuffle_epi32(_mm_cvtps_epi32(_mm_mul_ps(_mm_load_ps(&dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4]), _mm_set1_ps(256.0f))), _MM_SHUFFLE(3, 0, 1, 2));
2558         Color_Diffusem = _mm_and_si128(Color_Diffusem, _mm_setr_epi32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0));
2559         Color_Diffusem = _mm_packs_epi32(Color_Diffusem, Color_Diffusem);
2560         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GLOW)
2561         {
2562                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_glowbgra8, GL20TU_GLOW, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2563                 Color_Glowm = _mm_shuffle_epi32(_mm_cvtps_epi32(_mm_mul_ps(_mm_load_ps(&dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4]), _mm_set1_ps(256.0f))), _MM_SHUFFLE(3, 0, 1, 2));
2564                 Color_Glowm = _mm_and_si128(Color_Glowm, _mm_setr_epi32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0));
2565                 Color_Glowm = _mm_packs_epi32(Color_Glowm, Color_Glowm);
2566                 Color_AmbientGlowm = _mm_unpacklo_epi64(Color_Ambientm, Color_Glowm);
2567                 for (x = startx;x < endx;x++)
2568                 {
2569                         __m128i color, lightmap, glow, pix;
2570                         if (x + 4 <= endx && *(const unsigned int *)&pixelmask[x] == 0x01010101)
2571                         {
2572                                 __m128i pix2;
2573                                 color = _mm_loadu_si128((const __m128i *)&buffer_texture_colorbgra8[x*4]);
2574                                 lightmap = _mm_loadu_si128((const __m128i *)&buffer_texture_lightmapbgra8[x*4]);
2575                                 glow = _mm_loadu_si128((const __m128i *)&buffer_texture_glowbgra8[x*4]);
2576                                 pix = _mm_add_epi16(_mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, _mm_unpacklo_epi8(_mm_setzero_si128(), lightmap)), Color_Ambientm), 
2577                                                                                                         _mm_unpacklo_epi8(_mm_setzero_si128(), color)),
2578                                                                         _mm_mulhi_epu16(Color_Glowm, _mm_unpacklo_epi8(_mm_setzero_si128(), glow)));
2579                                 pix2 = _mm_add_epi16(_mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, _mm_unpackhi_epi8(_mm_setzero_si128(), lightmap)), Color_Ambientm), 
2580                                                                                                         _mm_unpackhi_epi8(_mm_setzero_si128(), color)),
2581                                                                         _mm_mulhi_epu16(Color_Glowm, _mm_unpackhi_epi8(_mm_setzero_si128(), glow)));
2582                                 _mm_storeu_si128((__m128i *)&pixel[x*4], _mm_packus_epi16(pix, pix2));
2583                                 x += 3;
2584                                 continue;
2585                         }
2586                         if(!pixelmask[x])
2587                                 continue;
2588                         color = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_colorbgra8[x*4]));
2589                         lightmap = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_lightmapbgra8[x*4]));
2590                         glow = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_glowbgra8[x*4]));
2591                         pix = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, lightmap), Color_AmbientGlowm), _mm_unpacklo_epi64(color, glow));
2592                         pix = _mm_add_epi16(pix, _mm_shuffle_epi32(pix, _MM_SHUFFLE(3, 2, 3, 2)));
2593                         *(int *)&pixel[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix, pix));
2594                 }
2595         }
2596         else
2597         {
2598                 for (x = startx;x < endx;x++)
2599                 {
2600                         __m128i color, lightmap, pix;
2601                         if (x + 4 <= endx && *(const unsigned int *)&pixelmask[x] == 0x01010101)
2602                         {
2603                                 __m128i pix2;
2604                                 color = _mm_loadu_si128((const __m128i *)&buffer_texture_colorbgra8[x*4]);
2605                                 lightmap = _mm_loadu_si128((const __m128i *)&buffer_texture_lightmapbgra8[x*4]);
2606                                 pix = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, _mm_unpacklo_epi8(_mm_setzero_si128(), lightmap)), Color_Ambientm), 
2607                                                                           _mm_unpacklo_epi8(_mm_setzero_si128(), color));
2608                                 pix2 = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, _mm_unpackhi_epi8(_mm_setzero_si128(), lightmap)), Color_Ambientm),
2609                                                                            _mm_unpackhi_epi8(_mm_setzero_si128(), color));
2610                                 _mm_storeu_si128((__m128i *)&pixel[x*4], _mm_packus_epi16(pix, pix2));
2611                                 x += 3;
2612                                 continue;
2613                         }
2614                         if(!pixelmask[x]) 
2615                                 continue;
2616                         color = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_colorbgra8[x*4]));
2617                         lightmap = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_lightmapbgra8[x*4]));
2618                         pix = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(lightmap, Color_Diffusem), Color_Ambientm), color);
2619                         *(int *)&pixel[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix, pix));
2620                 }
2621         }
2622         if(pixel == buffer_FragColorbgra8)
2623                 DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2624 #endif
2625 }
2626
2627
2628
2629 void DPSOFTRAST_VertexShader_FakeLight(void)
2630 {
2631         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
2632 }
2633
2634 void DPSOFTRAST_PixelShader_FakeLight(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2635 {
2636         // TODO: IMPLEMENT
2637         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2638         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2639         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2640         memset(buffer_FragColorbgra8, 0, span->length*4);
2641         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2642 }
2643
2644
2645
2646 void DPSOFTRAST_VertexShader_LightDirectionMap_ModelSpace(void)
2647 {
2648         DPSOFTRAST_VertexShader_Lightmap();
2649 }
2650
2651 void DPSOFTRAST_PixelShader_LightDirectionMap_ModelSpace(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2652 {
2653         DPSOFTRAST_PixelShader_Lightmap(span);
2654         // TODO: IMPLEMENT
2655 }
2656
2657
2658
2659 void DPSOFTRAST_VertexShader_LightDirectionMap_TangentSpace(void)
2660 {
2661         DPSOFTRAST_VertexShader_Lightmap();
2662 }
2663
2664 void DPSOFTRAST_PixelShader_LightDirectionMap_TangentSpace(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2665 {
2666         DPSOFTRAST_PixelShader_Lightmap(span);
2667         // TODO: IMPLEMENT
2668 }
2669
2670
2671
2672 void DPSOFTRAST_VertexShader_LightDirection(void)
2673 {
2674         int i;
2675         int numvertices = dpsoftrast.draw.numvertices;
2676         float LightDir[4];
2677         float LightVector[4];
2678         float EyePosition[4];
2679         float EyeVectorModelSpace[4];
2680         float EyeVector[4];
2681         float position[4];
2682         float svector[4];
2683         float tvector[4];
2684         float normal[4];
2685         LightDir[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightDir*4+0];
2686         LightDir[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightDir*4+1];
2687         LightDir[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightDir*4+2];
2688         LightDir[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightDir*4+3];
2689         EyePosition[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+0];
2690         EyePosition[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+1];
2691         EyePosition[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+2];
2692         EyePosition[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+3];
2693         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
2694         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_TexMatrixM1);
2695         for (i = 0;i < numvertices;i++)
2696         {
2697                 position[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+0];
2698                 position[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+1];
2699                 position[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+2];
2700                 svector[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+0];
2701                 svector[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+1];
2702                 svector[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+2];
2703                 tvector[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+0];
2704                 tvector[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+1];
2705                 tvector[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+2];
2706                 normal[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+0];
2707                 normal[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+1];
2708                 normal[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+2];
2709                 LightVector[0] = svector[0] * LightDir[0] + svector[1] * LightDir[1] + svector[2] * LightDir[2];
2710                 LightVector[1] = tvector[0] * LightDir[0] + tvector[1] * LightDir[1] + tvector[2] * LightDir[2];
2711                 LightVector[2] = normal[0] * LightDir[0] + normal[1] * LightDir[1] + normal[2] * LightDir[2];
2712                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+0] = LightVector[0];
2713                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+1] = LightVector[1];
2714                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+2] = LightVector[2];
2715                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+3] = 0.0f;
2716                 EyeVectorModelSpace[0] = EyePosition[0] - position[0];
2717                 EyeVectorModelSpace[1] = EyePosition[1] - position[1];
2718                 EyeVectorModelSpace[2] = EyePosition[2] - position[2];
2719                 EyeVector[0] = svector[0] * EyeVectorModelSpace[0] + svector[1] * EyeVectorModelSpace[1] + svector[2] * EyeVectorModelSpace[2];
2720                 EyeVector[1] = tvector[0] * EyeVectorModelSpace[0] + tvector[1] * EyeVectorModelSpace[1] + tvector[2] * EyeVectorModelSpace[2];
2721                 EyeVector[2] = normal[0]  * EyeVectorModelSpace[0] + normal[1]  * EyeVectorModelSpace[1] + normal[2]  * EyeVectorModelSpace[2];
2722                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+0] = EyeVector[0];
2723                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+1] = EyeVector[1];
2724                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+2] = EyeVector[2];
2725                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+3] = 0.0f;
2726         }
2727 }
2728
2729 #define DPSOFTRAST_Min(a,b) ((a) < (b) ? (a) : (b))
2730 #define DPSOFTRAST_Max(a,b) ((a) > (b) ? (a) : (b))
2731 #define DPSOFTRAST_Vector3Dot(a,b) ((a)[0]*(b)[0]+(a)[1]*(b)[1]+(a)[2]*(b)[2])
2732 #define DPSOFTRAST_Vector3LengthSquared(v) (DPSOFTRAST_Vector3Dot((v),(v)))
2733 #define DPSOFTRAST_Vector3Length(v) (sqrt(DPSOFTRAST_Vector3LengthSquared(v)))
2734 #define DPSOFTRAST_Vector3Normalize(v)\
2735 do\
2736 {\
2737         float len = sqrt(DPSOFTRAST_Vector3Dot(v,v));\
2738         if (len)\
2739         {\
2740                 len = 1.0f / len;\
2741                 v[0] *= len;\
2742                 v[1] *= len;\
2743                 v[2] *= len;\
2744         }\
2745 }\
2746 while(0)
2747
2748 void DPSOFTRAST_PixelShader_LightDirection(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2749 {
2750         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2751         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2752         unsigned char buffer_texture_normalbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2753         unsigned char buffer_texture_glossbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2754         unsigned char buffer_texture_glowbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2755         unsigned char buffer_texture_pantsbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2756         unsigned char buffer_texture_shirtbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2757         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2758         int x, startx = span->startx, endx = span->endx;
2759         float Color_Ambient[4], Color_Diffuse[4], Color_Specular[4], Color_Glow[4], Color_Pants[4], Color_Shirt[4], LightColor[4];
2760         float LightVectordata[4];
2761         float LightVectorslope[4];
2762         float EyeVectordata[4];
2763         float EyeVectorslope[4];
2764         float z;
2765         float diffusetex[4];
2766         float glosstex[4];
2767         float surfacenormal[4];
2768         float lightnormal[4];
2769         float eyenormal[4];
2770         float specularnormal[4];
2771         float diffuse;
2772         float specular;
2773         float SpecularPower;
2774         int d[4];
2775         Color_Glow[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+0];
2776         Color_Glow[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+1];
2777         Color_Glow[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+2];
2778         Color_Glow[3] = 0.0f;
2779         Color_Ambient[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+0];
2780         Color_Ambient[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+1];
2781         Color_Ambient[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+2];
2782         Color_Ambient[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Alpha*4+0];
2783         Color_Pants[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+0];
2784         Color_Pants[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+1];
2785         Color_Pants[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+2];
2786         Color_Pants[3] = 0.0f;
2787         Color_Shirt[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+0];
2788         Color_Shirt[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+1];
2789         Color_Shirt[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+2];
2790         Color_Shirt[3] = 0.0f;
2791         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2792         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_COLOR, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2793         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
2794         {
2795                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_pantsbgra8, GL20TU_PANTS, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2796                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_shirtbgra8, GL20TU_SHIRT, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2797         }
2798         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GLOW)
2799         {
2800                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_glowbgra8, GL20TU_GLOW, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2801         }
2802         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SPECULAR)
2803         {
2804                 Color_Diffuse[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+0];
2805                 Color_Diffuse[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+1];
2806                 Color_Diffuse[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+2];
2807                 Color_Diffuse[3] = 0.0f;
2808                 LightColor[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+0];
2809                 LightColor[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+1];
2810                 LightColor[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+2];
2811                 LightColor[3] = 0.0f;
2812                 LightVectordata[0]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][0];
2813                 LightVectordata[1]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][1];
2814                 LightVectordata[2]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][2];
2815                 LightVectordata[3]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][3];
2816                 LightVectorslope[0] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][0];
2817                 LightVectorslope[1] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][1];
2818                 LightVectorslope[2] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][2];
2819                 LightVectorslope[3] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][3];
2820                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_normalbgra8, GL20TU_NORMAL, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2821                 Color_Specular[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+0];
2822                 Color_Specular[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+1];
2823                 Color_Specular[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+2];
2824                 Color_Specular[3] = 0.0f;
2825                 SpecularPower = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_SpecularPower*4+0] * (1.0f / 255.0f);
2826                 EyeVectordata[0]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][0];
2827                 EyeVectordata[1]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][1];
2828                 EyeVectordata[2]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][2];
2829                 EyeVectordata[3]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][3];
2830                 EyeVectorslope[0]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][0];
2831                 EyeVectorslope[1]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][1];
2832                 EyeVectorslope[2]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][2];
2833                 EyeVectorslope[3]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][3];
2834                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_glossbgra8, GL20TU_GLOSS, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2835                 for (x = startx;x < endx;x++)
2836                 {
2837                         z = buffer_z[x];
2838                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
2839                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
2840                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
2841                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
2842                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
2843                         {
2844                                 diffusetex[0] += buffer_texture_pantsbgra8[x*4+0] * Color_Pants[0] + buffer_texture_shirtbgra8[x*4+0] * Color_Shirt[0];
2845                                 diffusetex[1] += buffer_texture_pantsbgra8[x*4+1] * Color_Pants[1] + buffer_texture_shirtbgra8[x*4+1] * Color_Shirt[1];
2846                                 diffusetex[2] += buffer_texture_pantsbgra8[x*4+2] * Color_Pants[2] + buffer_texture_shirtbgra8[x*4+2] * Color_Shirt[2];
2847                                 diffusetex[3] += buffer_texture_pantsbgra8[x*4+3] * Color_Pants[3] + buffer_texture_shirtbgra8[x*4+3] * Color_Shirt[3];
2848                         }
2849                         glosstex[0] = buffer_texture_glossbgra8[x*4+0];
2850                         glosstex[1] = buffer_texture_glossbgra8[x*4+1];
2851                         glosstex[2] = buffer_texture_glossbgra8[x*4+2];
2852                         glosstex[3] = buffer_texture_glossbgra8[x*4+3];
2853                         surfacenormal[0] = buffer_texture_normalbgra8[x*4+2] * (1.0f / 128.0f) - 1.0f;
2854                         surfacenormal[1] = buffer_texture_normalbgra8[x*4+1] * (1.0f / 128.0f) - 1.0f;
2855                         surfacenormal[2] = buffer_texture_normalbgra8[x*4+0] * (1.0f / 128.0f) - 1.0f;
2856                         DPSOFTRAST_Vector3Normalize(surfacenormal);
2857
2858                         lightnormal[0] = (LightVectordata[0] + LightVectorslope[0]*x) * z;
2859                         lightnormal[1] = (LightVectordata[1] + LightVectorslope[1]*x) * z;
2860                         lightnormal[2] = (LightVectordata[2] + LightVectorslope[2]*x) * z;
2861                         DPSOFTRAST_Vector3Normalize(lightnormal);
2862
2863                         eyenormal[0] = (EyeVectordata[0] + EyeVectorslope[0]*x) * z;
2864                         eyenormal[1] = (EyeVectordata[1] + EyeVectorslope[1]*x) * z;
2865                         eyenormal[2] = (EyeVectordata[2] + EyeVectorslope[2]*x) * z;
2866                         DPSOFTRAST_Vector3Normalize(eyenormal);
2867
2868                         specularnormal[0] = lightnormal[0] + eyenormal[0];
2869                         specularnormal[1] = lightnormal[1] + eyenormal[1];
2870                         specularnormal[2] = lightnormal[2] + eyenormal[2];
2871                         DPSOFTRAST_Vector3Normalize(specularnormal);
2872
2873                         diffuse = DPSOFTRAST_Vector3Dot(surfacenormal, lightnormal);if (diffuse < 0.0f) diffuse = 0.0f;
2874                         specular = DPSOFTRAST_Vector3Dot(surfacenormal, specularnormal);if (specular < 0.0f) specular = 0.0f;
2875                         specular = pow(specular, SpecularPower * glosstex[3]);
2876                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GLOW)
2877                         {
2878                                 d[0] = (int)(buffer_texture_glowbgra8[x*4+0] * Color_Glow[0] + diffusetex[0] * Color_Ambient[0] + (diffusetex[0] * Color_Diffuse[0] * diffuse + glosstex[0] * Color_Specular[0] * specular) * LightColor[0]);if (d[0] > 255) d[0] = 255;
2879                                 d[1] = (int)(buffer_texture_glowbgra8[x*4+1] * Color_Glow[1] + diffusetex[1] * Color_Ambient[1] + (diffusetex[1] * Color_Diffuse[1] * diffuse + glosstex[1] * Color_Specular[1] * specular) * LightColor[1]);if (d[1] > 255) d[1] = 255;
2880                                 d[2] = (int)(buffer_texture_glowbgra8[x*4+2] * Color_Glow[2] + diffusetex[2] * Color_Ambient[2] + (diffusetex[2] * Color_Diffuse[2] * diffuse + glosstex[2] * Color_Specular[2] * specular) * LightColor[2]);if (d[2] > 255) d[2] = 255;
2881                                 d[3] = (int)(                                                  diffusetex[3] * Color_Ambient[3]);if (d[3] > 255) d[3] = 255;
2882                         }
2883                         else
2884                         {
2885                                 d[0] = (int)(                                                  diffusetex[0] * Color_Ambient[0] + (diffusetex[0] * Color_Diffuse[0] * diffuse + glosstex[0] * Color_Specular[0] * specular) * LightColor[0]);if (d[0] > 255) d[0] = 255;
2886                                 d[1] = (int)(                                                  diffusetex[1] * Color_Ambient[1] + (diffusetex[1] * Color_Diffuse[1] * diffuse + glosstex[1] * Color_Specular[1] * specular) * LightColor[1]);if (d[1] > 255) d[1] = 255;
2887                                 d[2] = (int)(                                                  diffusetex[2] * Color_Ambient[2] + (diffusetex[2] * Color_Diffuse[2] * diffuse + glosstex[2] * Color_Specular[2] * specular) * LightColor[2]);if (d[2] > 255) d[2] = 255;
2888                                 d[3] = (int)(                                                  diffusetex[3] * Color_Ambient[3]);if (d[3] > 255) d[3] = 255;
2889                         }
2890                         buffer_FragColorbgra8[x*4+0] = d[0];
2891                         buffer_FragColorbgra8[x*4+1] = d[1];
2892                         buffer_FragColorbgra8[x*4+2] = d[2];
2893                         buffer_FragColorbgra8[x*4+3] = d[3];
2894                 }
2895         }
2896         else if (dpsoftrast.shader_permutation & SHADERPERMUTATION_DIFFUSE)
2897         {
2898                 Color_Diffuse[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+0];
2899                 Color_Diffuse[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+1];
2900                 Color_Diffuse[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+2];
2901                 Color_Diffuse[3] = 0.0f;
2902                 LightColor[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+0];
2903                 LightColor[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+1];
2904                 LightColor[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+2];
2905                 LightColor[3] = 0.0f;
2906                 LightVectordata[0]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][0];
2907                 LightVectordata[1]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][1];
2908                 LightVectordata[2]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][2];
2909                 LightVectordata[3]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][3];
2910                 LightVectorslope[0] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][0];
2911                 LightVectorslope[1] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][1];
2912                 LightVectorslope[2] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][2];
2913                 LightVectorslope[3] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][3];
2914                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_normalbgra8, GL20TU_NORMAL, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2915                 for (x = startx;x < endx;x++)
2916                 {
2917                         z = buffer_z[x];
2918                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
2919                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
2920                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
2921                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
2922                         surfacenormal[0] = buffer_texture_normalbgra8[x*4+2] * (1.0f / 128.0f) - 1.0f;
2923                         surfacenormal[1] = buffer_texture_normalbgra8[x*4+1] * (1.0f / 128.0f) - 1.0f;
2924                         surfacenormal[2] = buffer_texture_normalbgra8[x*4+0] * (1.0f / 128.0f) - 1.0f;
2925                         DPSOFTRAST_Vector3Normalize(surfacenormal);
2926
2927                         lightnormal[0] = (LightVectordata[0] + LightVectorslope[0]*x) * z;
2928                         lightnormal[1] = (LightVectordata[1] + LightVectorslope[1]*x) * z;
2929                         lightnormal[2] = (LightVectordata[2] + LightVectorslope[2]*x) * z;
2930                         DPSOFTRAST_Vector3Normalize(lightnormal);
2931
2932                         diffuse = DPSOFTRAST_Vector3Dot(surfacenormal, lightnormal);if (diffuse < 0.0f) diffuse = 0.0f;
2933                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GLOW)
2934                         {
2935                                 d[0] = (int)(buffer_texture_glowbgra8[x*4+0] * Color_Glow[0] + diffusetex[0] * (Color_Ambient[0] + Color_Diffuse[0] * diffuse * LightColor[0]));if (d[0] > 255) d[0] = 255;
2936                                 d[1] = (int)(buffer_texture_glowbgra8[x*4+1] * Color_Glow[1] + diffusetex[1] * (Color_Ambient[1] + Color_Diffuse[1] * diffuse * LightColor[1]));if (d[1] > 255) d[1] = 255;
2937                                 d[2] = (int)(buffer_texture_glowbgra8[x*4+2] * Color_Glow[2] + diffusetex[2] * (Color_Ambient[2] + Color_Diffuse[2] * diffuse * LightColor[2]));if (d[2] > 255) d[2] = 255;
2938                                 d[3] = (int)(                                                  diffusetex[3] * (Color_Ambient[3]                                             ));if (d[3] > 255) d[3] = 255;
2939                         }
2940                         else
2941                         {
2942                                 d[0] = (int)(                                                + diffusetex[0] * (Color_Ambient[0] + Color_Diffuse[0] * diffuse * LightColor[0]));if (d[0] > 255) d[0] = 255;
2943                                 d[1] = (int)(                                                + diffusetex[1] * (Color_Ambient[1] + Color_Diffuse[1] * diffuse * LightColor[1]));if (d[1] > 255) d[1] = 255;
2944                                 d[2] = (int)(                                                + diffusetex[2] * (Color_Ambient[2] + Color_Diffuse[2] * diffuse * LightColor[2]));if (d[2] > 255) d[2] = 255;
2945                                 d[3] = (int)(                                                  diffusetex[3] * (Color_Ambient[3]                                             ));if (d[3] > 255) d[3] = 255;
2946                         }
2947                         buffer_FragColorbgra8[x*4+0] = d[0];
2948                         buffer_FragColorbgra8[x*4+1] = d[1];
2949                         buffer_FragColorbgra8[x*4+2] = d[2];
2950                         buffer_FragColorbgra8[x*4+3] = d[3];
2951                 }
2952         }
2953         else
2954         {
2955                 for (x = startx;x < endx;x++)
2956                 {
2957                         z = buffer_z[x];
2958                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
2959                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
2960                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
2961                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
2962
2963                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GLOW)
2964                         {
2965                                 d[0] = (int)(buffer_texture_glowbgra8[x*4+0] * Color_Glow[0] + diffusetex[0] * Color_Ambient[0]);if (d[0] > 255) d[0] = 255;
2966                                 d[1] = (int)(buffer_texture_glowbgra8[x*4+1] * Color_Glow[1] + diffusetex[1] * Color_Ambient[1]);if (d[1] > 255) d[1] = 255;
2967                                 d[2] = (int)(buffer_texture_glowbgra8[x*4+2] * Color_Glow[2] + diffusetex[2] * Color_Ambient[2]);if (d[2] > 255) d[2] = 255;
2968                                 d[3] = (int)(                                                  diffusetex[3] * Color_Ambient[3]);if (d[3] > 255) d[3] = 255;
2969                         }
2970                         else
2971                         {
2972                                 d[0] = (int)(                                                  diffusetex[0] * Color_Ambient[0]);if (d[0] > 255) d[0] = 255;
2973                                 d[1] = (int)(                                                  diffusetex[1] * Color_Ambient[1]);if (d[1] > 255) d[1] = 255;
2974                                 d[2] = (int)(                                                  diffusetex[2] * Color_Ambient[2]);if (d[2] > 255) d[2] = 255;
2975                                 d[3] = (int)(                                                  diffusetex[3] * Color_Ambient[3]);if (d[3] > 255) d[3] = 255;
2976                         }
2977                         buffer_FragColorbgra8[x*4+0] = d[0];
2978                         buffer_FragColorbgra8[x*4+1] = d[1];
2979                         buffer_FragColorbgra8[x*4+2] = d[2];
2980                         buffer_FragColorbgra8[x*4+3] = d[3];
2981                 }
2982         }
2983         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2984 }
2985
2986
2987
2988 void DPSOFTRAST_VertexShader_LightSource(void)
2989 {
2990         int i;
2991         int numvertices = dpsoftrast.draw.numvertices;
2992         float LightPosition[4];
2993         float LightVector[4];
2994         float LightVectorModelSpace[4];
2995         float EyePosition[4];
2996         float EyeVectorModelSpace[4];
2997         float EyeVector[4];
2998         float position[4];
2999         float svector[4];
3000         float tvector[4];
3001         float normal[4];
3002         LightPosition[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightPosition*4+0];
3003         LightPosition[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightPosition*4+1];
3004         LightPosition[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightPosition*4+2];
3005         LightPosition[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightPosition*4+3];
3006         EyePosition[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+0];
3007         EyePosition[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+1];
3008         EyePosition[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+2];
3009         EyePosition[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+3];
3010         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
3011         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_TexMatrixM1);
3012         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD3], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelToLightM1);
3013         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD4], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD4], dpsoftrast.draw.numvertices);
3014         for (i = 0;i < numvertices;i++)
3015         {
3016                 position[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+0];
3017                 position[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+1];
3018                 position[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+2];
3019                 svector[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+0];
3020                 svector[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+1];
3021                 svector[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+2];
3022                 tvector[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+0];
3023                 tvector[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+1];
3024                 tvector[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+2];
3025                 normal[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+0];
3026                 normal[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+1];
3027                 normal[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+2];
3028                 LightVectorModelSpace[0] = LightPosition[0] - position[0];
3029                 LightVectorModelSpace[1] = LightPosition[1] - position[1];
3030                 LightVectorModelSpace[2] = LightPosition[2] - position[2];
3031                 LightVector[0] = svector[0] * LightVectorModelSpace[0] + svector[1] * LightVectorModelSpace[1] + svector[2] * LightVectorModelSpace[2];
3032                 LightVector[1] = tvector[0] * LightVectorModelSpace[0] + tvector[1] * LightVectorModelSpace[1] + tvector[2] * LightVectorModelSpace[2];
3033                 LightVector[2] = normal[0]  * LightVectorModelSpace[0] + normal[1]  * LightVectorModelSpace[1] + normal[2]  * LightVectorModelSpace[2];
3034                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+0] = LightVector[0];
3035                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+1] = LightVector[1];
3036                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+2] = LightVector[2];
3037                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+3] = 0.0f;
3038                 EyeVectorModelSpace[0] = EyePosition[0] - position[0];
3039                 EyeVectorModelSpace[1] = EyePosition[1] - position[1];
3040                 EyeVectorModelSpace[2] = EyePosition[2] - position[2];
3041                 EyeVector[0] = svector[0] * EyeVectorModelSpace[0] + svector[1] * EyeVectorModelSpace[1] + svector[2] * EyeVectorModelSpace[2];
3042                 EyeVector[1] = tvector[0] * EyeVectorModelSpace[0] + tvector[1] * EyeVectorModelSpace[1] + tvector[2] * EyeVectorModelSpace[2];
3043                 EyeVector[2] = normal[0]  * EyeVectorModelSpace[0] + normal[1]  * EyeVectorModelSpace[1] + normal[2]  * EyeVectorModelSpace[2];
3044                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+0] = EyeVector[0];
3045                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+1] = EyeVector[1];
3046                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+2] = EyeVector[2];
3047                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+3] = 0.0f;
3048         }
3049 }
3050
3051 void DPSOFTRAST_PixelShader_LightSource(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3052 {
3053         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3054         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3055         unsigned char buffer_texture_normalbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3056         unsigned char buffer_texture_glossbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3057         unsigned char buffer_texture_cubebgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3058         unsigned char buffer_texture_pantsbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3059         unsigned char buffer_texture_shirtbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3060         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3061         int x, startx = span->startx, endx = span->endx;
3062         float Color_Ambient[4], Color_Diffuse[4], Color_Specular[4], Color_Glow[4], Color_Pants[4], Color_Shirt[4], LightColor[4];
3063         float CubeVectordata[4];
3064         float CubeVectorslope[4];
3065         float LightVectordata[4];
3066         float LightVectorslope[4];
3067         float EyeVectordata[4];
3068         float EyeVectorslope[4];
3069         float z;
3070         float diffusetex[4];
3071         float glosstex[4];
3072         float surfacenormal[4];
3073         float lightnormal[4];
3074         float eyenormal[4];
3075         float specularnormal[4];
3076         float diffuse;
3077         float specular;
3078         float SpecularPower;
3079         float CubeVector[4];
3080         float attenuation;
3081         int d[4];
3082         Color_Glow[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+0];
3083         Color_Glow[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+1];
3084         Color_Glow[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+2];
3085         Color_Glow[3] = 0.0f;
3086         Color_Ambient[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+0];
3087         Color_Ambient[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+1];
3088         Color_Ambient[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+2];
3089         Color_Ambient[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Alpha*4+0];
3090         Color_Diffuse[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+0];
3091         Color_Diffuse[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+1];
3092         Color_Diffuse[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+2];
3093         Color_Diffuse[3] = 0.0f;
3094         Color_Specular[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+0];
3095         Color_Specular[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+1];
3096         Color_Specular[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+2];
3097         Color_Specular[3] = 0.0f;
3098         Color_Pants[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+0];
3099         Color_Pants[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+1];
3100         Color_Pants[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+2];
3101         Color_Pants[3] = 0.0f;
3102         Color_Shirt[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+0];
3103         Color_Shirt[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+1];
3104         Color_Shirt[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+2];
3105         Color_Shirt[3] = 0.0f;
3106         LightColor[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+0];
3107         LightColor[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+1];
3108         LightColor[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+2];
3109         LightColor[3] = 0.0f;
3110         SpecularPower = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_SpecularPower*4+0] * (1.0f / 255.0f);
3111         EyeVectordata[0]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][0];
3112         EyeVectordata[1]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][1];
3113         EyeVectordata[2]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][2];
3114         EyeVectordata[3]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][3];
3115         EyeVectorslope[0]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][0];
3116         EyeVectorslope[1]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][1];
3117         EyeVectorslope[2]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][2];
3118         EyeVectorslope[3]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][3];
3119         LightVectordata[0]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][0];
3120         LightVectordata[1]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][1];
3121         LightVectordata[2]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][2];
3122         LightVectordata[3]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][3];
3123         LightVectorslope[0] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][0];
3124         LightVectorslope[1] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][1];
3125         LightVectorslope[2] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][2];
3126         LightVectorslope[3] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][3];
3127         CubeVectordata[0]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD3][0];
3128         CubeVectordata[1]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD3][1];
3129         CubeVectordata[2]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD3][2];
3130         CubeVectordata[3]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD3][3];
3131         CubeVectorslope[0] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD3][0];
3132         CubeVectorslope[1] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD3][1];
3133         CubeVectorslope[2] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD3][2];
3134         CubeVectorslope[3] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD3][3];
3135         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3136         memset(buffer_FragColorbgra8 + startx*4, 0, (endx-startx)*4); // clear first, because we skip writing black pixels, and there are a LOT of them...
3137         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_COLOR, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3138         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
3139         {
3140                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_pantsbgra8, GL20TU_PANTS, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3141                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_shirtbgra8, GL20TU_SHIRT, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3142         }
3143         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_CUBEFILTER)
3144                 DPSOFTRAST_Draw_Span_TextureCubeVaryingBGRA8(span, buffer_texture_cubebgra8, GL20TU_CUBE, DPSOFTRAST_ARRAY_TEXCOORD3, buffer_z);
3145         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SPECULAR)
3146         {
3147                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_normalbgra8, GL20TU_NORMAL, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3148                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_glossbgra8, GL20TU_GLOSS, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3149                 for (x = startx;x < endx;x++)
3150                 {
3151                         z = buffer_z[x];
3152                         CubeVector[0] = (CubeVectordata[0] + CubeVectorslope[0]*x) * z;
3153                         CubeVector[1] = (CubeVectordata[1] + CubeVectorslope[1]*x) * z;
3154                         CubeVector[2] = (CubeVectordata[2] + CubeVectorslope[2]*x) * z;
3155                         attenuation = 1.0f - DPSOFTRAST_Vector3LengthSquared(CubeVector);
3156                         if (attenuation < 0.01f)
3157                                 continue;
3158                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SHADOWMAP2D)
3159                         {
3160                                 attenuation *= DPSOFTRAST_SampleShadowmap(CubeVector);
3161                                 if (attenuation < 0.01f)
3162                                         continue;
3163                         }
3164
3165                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
3166                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
3167                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
3168                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
3169                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
3170                         {
3171                                 diffusetex[0] += buffer_texture_pantsbgra8[x*4+0] * Color_Pants[0] + buffer_texture_shirtbgra8[x*4+0] * Color_Shirt[0];
3172                                 diffusetex[1] += buffer_texture_pantsbgra8[x*4+1] * Color_Pants[1] + buffer_texture_shirtbgra8[x*4+1] * Color_Shirt[1];
3173                                 diffusetex[2] += buffer_texture_pantsbgra8[x*4+2] * Color_Pants[2] + buffer_texture_shirtbgra8[x*4+2] * Color_Shirt[2];
3174                                 diffusetex[3] += buffer_texture_pantsbgra8[x*4+3] * Color_Pants[3] + buffer_texture_shirtbgra8[x*4+3] * Color_Shirt[3];
3175                         }
3176                         glosstex[0] = buffer_texture_glossbgra8[x*4+0];
3177                         glosstex[1] = buffer_texture_glossbgra8[x*4+1];
3178                         glosstex[2] = buffer_texture_glossbgra8[x*4+2];
3179                         glosstex[3] = buffer_texture_glossbgra8[x*4+3];
3180                         surfacenormal[0] = buffer_texture_normalbgra8[x*4+2] * (1.0f / 128.0f) - 1.0f;
3181                         surfacenormal[1] = buffer_texture_normalbgra8[x*4+1] * (1.0f / 128.0f) - 1.0f;
3182                         surfacenormal[2] = buffer_texture_normalbgra8[x*4+0] * (1.0f / 128.0f) - 1.0f;
3183                         DPSOFTRAST_Vector3Normalize(surfacenormal);
3184
3185                         lightnormal[0] = (LightVectordata[0] + LightVectorslope[0]*x) * z;
3186                         lightnormal[1] = (LightVectordata[1] + LightVectorslope[1]*x) * z;
3187                         lightnormal[2] = (LightVectordata[2] + LightVectorslope[2]*x) * z;
3188                         DPSOFTRAST_Vector3Normalize(lightnormal);
3189
3190                         eyenormal[0] = (EyeVectordata[0] + EyeVectorslope[0]*x) * z;
3191                         eyenormal[1] = (EyeVectordata[1] + EyeVectorslope[1]*x) * z;
3192                         eyenormal[2] = (EyeVectordata[2] + EyeVectorslope[2]*x) * z;
3193                         DPSOFTRAST_Vector3Normalize(eyenormal);
3194
3195                         specularnormal[0] = lightnormal[0] + eyenormal[0];
3196                         specularnormal[1] = lightnormal[1] + eyenormal[1];
3197                         specularnormal[2] = lightnormal[2] + eyenormal[2];
3198                         DPSOFTRAST_Vector3Normalize(specularnormal);
3199
3200                         diffuse = DPSOFTRAST_Vector3Dot(surfacenormal, lightnormal);if (diffuse < 0.0f) diffuse = 0.0f;
3201                         specular = DPSOFTRAST_Vector3Dot(surfacenormal, specularnormal);if (specular < 0.0f) specular = 0.0f;
3202                         specular = pow(specular, SpecularPower * glosstex[3]);
3203                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_CUBEFILTER)
3204                         {
3205                                 // scale down the attenuation to account for the cubefilter multiplying everything by 255
3206                                 attenuation *= (1.0f / 255.0f);
3207                                 d[0] = (int)((diffusetex[0] * (Color_Ambient[0] + Color_Diffuse[0] * diffuse) + glosstex[0] * Color_Specular[0] * specular) * LightColor[0] * buffer_texture_cubebgra8[x*4+0] * attenuation);if (d[0] > 255) d[0] = 255;
3208                                 d[1] = (int)((diffusetex[1] * (Color_Ambient[1] + Color_Diffuse[1] * diffuse) + glosstex[1] * Color_Specular[1] * specular) * LightColor[1] * buffer_texture_cubebgra8[x*4+1] * attenuation);if (d[1] > 255) d[1] = 255;
3209                                 d[2] = (int)((diffusetex[2] * (Color_Ambient[2] + Color_Diffuse[2] * diffuse) + glosstex[2] * Color_Specular[2] * specular) * LightColor[2] * buffer_texture_cubebgra8[x*4+2] * attenuation);if (d[2] > 255) d[2] = 255;
3210                                 d[3] = (int)( diffusetex[3]                                                                                                                                                                );if (d[3] > 255) d[3] = 255;
3211                         }
3212                         else
3213                         {
3214                                 d[0] = (int)((diffusetex[0] * (Color_Ambient[0] + Color_Diffuse[0] * diffuse) + glosstex[0] * Color_Specular[0] * specular) * LightColor[0]                                   * attenuation);if (d[0] > 255) d[0] = 255;
3215                                 d[1] = (int)((diffusetex[1] * (Color_Ambient[1] + Color_Diffuse[1] * diffuse) + glosstex[1] * Color_Specular[1] * specular) * LightColor[1]                                   * attenuation);if (d[1] > 255) d[1] = 255;
3216                                 d[2] = (int)((diffusetex[2] * (Color_Ambient[2] + Color_Diffuse[2] * diffuse) + glosstex[2] * Color_Specular[2] * specular) * LightColor[2]                                   * attenuation);if (d[2] > 255) d[2] = 255;
3217                                 d[3] = (int)( diffusetex[3]                                                                                                                                                                );if (d[3] > 255) d[3] = 255;
3218                         }
3219                         buffer_FragColorbgra8[x*4+0] = d[0];
3220                         buffer_FragColorbgra8[x*4+1] = d[1];
3221                         buffer_FragColorbgra8[x*4+2] = d[2];
3222                         buffer_FragColorbgra8[x*4+3] = d[3];
3223                 }
3224         }
3225         else if (dpsoftrast.shader_permutation & SHADERPERMUTATION_DIFFUSE)
3226         {
3227                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_normalbgra8, GL20TU_NORMAL, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3228                 for (x = startx;x < endx;x++)
3229                 {
3230                         z = buffer_z[x];
3231                         CubeVector[0] = (CubeVectordata[0] + CubeVectorslope[0]*x) * z;
3232                         CubeVector[1] = (CubeVectordata[1] + CubeVectorslope[1]*x) * z;
3233                         CubeVector[2] = (CubeVectordata[2] + CubeVectorslope[2]*x) * z;
3234                         attenuation = 1.0f - DPSOFTRAST_Vector3LengthSquared(CubeVector);
3235                         if (attenuation < 0.01f)
3236                                 continue;
3237                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SHADOWMAP2D)
3238                         {
3239                                 attenuation *= DPSOFTRAST_SampleShadowmap(CubeVector);
3240                                 if (attenuation < 0.01f)
3241                                         continue;
3242                         }
3243
3244                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
3245                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
3246                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
3247                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
3248                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
3249                         {
3250                                 diffusetex[0] += buffer_texture_pantsbgra8[x*4+0] * Color_Pants[0] + buffer_texture_shirtbgra8[x*4+0] * Color_Shirt[0];
3251                                 diffusetex[1] += buffer_texture_pantsbgra8[x*4+1] * Color_Pants[1] + buffer_texture_shirtbgra8[x*4+1] * Color_Shirt[1];
3252                                 diffusetex[2] += buffer_texture_pantsbgra8[x*4+2] * Color_Pants[2] + buffer_texture_shirtbgra8[x*4+2] * Color_Shirt[2];
3253                                 diffusetex[3] += buffer_texture_pantsbgra8[x*4+3] * Color_Pants[3] + buffer_texture_shirtbgra8[x*4+3] * Color_Shirt[3];
3254                         }
3255                         surfacenormal[0] = buffer_texture_normalbgra8[x*4+2] * (1.0f / 128.0f) - 1.0f;
3256                         surfacenormal[1] = buffer_texture_normalbgra8[x*4+1] * (1.0f / 128.0f) - 1.0f;
3257                         surfacenormal[2] = buffer_texture_normalbgra8[x*4+0] * (1.0f / 128.0f) - 1.0f;
3258                         DPSOFTRAST_Vector3Normalize(surfacenormal);
3259
3260                         lightnormal[0] = (LightVectordata[0] + LightVectorslope[0]*x) * z;
3261                         lightnormal[1] = (LightVectordata[1] + LightVectorslope[1]*x) * z;
3262                         lightnormal[2] = (LightVectordata[2] + LightVectorslope[2]*x) * z;
3263                         DPSOFTRAST_Vector3Normalize(lightnormal);
3264
3265                         diffuse = DPSOFTRAST_Vector3Dot(surfacenormal, lightnormal);if (diffuse < 0.0f) diffuse = 0.0f;
3266                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_CUBEFILTER)
3267                         {
3268                                 // scale down the attenuation to account for the cubefilter multiplying everything by 255
3269                                 attenuation *= (1.0f / 255.0f);
3270                                 d[0] = (int)((diffusetex[0] * (Color_Ambient[0] + Color_Diffuse[0] * diffuse)) * LightColor[0] * buffer_texture_cubebgra8[x*4+0] * attenuation);if (d[0] > 255) d[0] = 255;
3271                                 d[1] = (int)((diffusetex[1] * (Color_Ambient[1] + Color_Diffuse[1] * diffuse)) * LightColor[1] * buffer_texture_cubebgra8[x*4+1] * attenuation);if (d[1] > 255) d[1] = 255;
3272                                 d[2] = (int)((diffusetex[2] * (Color_Ambient[2] + Color_Diffuse[2] * diffuse)) * LightColor[2] * buffer_texture_cubebgra8[x*4+2] * attenuation);if (d[2] > 255) d[2] = 255;
3273                                 d[3] = (int)( diffusetex[3]                                                                                                                   );if (d[3] > 255) d[3] = 255;
3274                         }
3275                         else
3276                         {
3277                                 d[0] = (int)((diffusetex[0] * (Color_Ambient[0] + Color_Diffuse[0] * diffuse)) * LightColor[0]                                   * attenuation);if (d[0] > 255) d[0] = 255;
3278                                 d[1] = (int)((diffusetex[1] * (Color_Ambient[1] + Color_Diffuse[1] * diffuse)) * LightColor[1]                                   * attenuation);if (d[1] > 255) d[1] = 255;
3279                                 d[2] = (int)((diffusetex[2] * (Color_Ambient[2] + Color_Diffuse[2] * diffuse)) * LightColor[2]                                   * attenuation);if (d[2] > 255) d[2] = 255;
3280                                 d[3] = (int)( diffusetex[3]                                                                                                                                                                );if (d[3] > 255) d[3] = 255;
3281                         }
3282                         buffer_FragColorbgra8[x*4+0] = d[0];
3283                         buffer_FragColorbgra8[x*4+1] = d[1];
3284                         buffer_FragColorbgra8[x*4+2] = d[2];
3285                         buffer_FragColorbgra8[x*4+3] = d[3];
3286                 }
3287         }
3288         else
3289         {
3290                 for (x = startx;x < endx;x++)
3291                 {
3292                         z = buffer_z[x];
3293                         CubeVector[0] = (CubeVectordata[0] + CubeVectorslope[0]*x) * z;
3294                         CubeVector[1] = (CubeVectordata[1] + CubeVectorslope[1]*x) * z;
3295                         CubeVector[2] = (CubeVectordata[2] + CubeVectorslope[2]*x) * z;
3296                         attenuation = 1.0f - DPSOFTRAST_Vector3LengthSquared(CubeVector);
3297                         if (attenuation < 0.01f)
3298                                 continue;
3299                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SHADOWMAP2D)
3300                         {
3301                                 attenuation *= DPSOFTRAST_SampleShadowmap(CubeVector);
3302                                 if (attenuation < 0.01f)
3303                                         continue;
3304                         }
3305
3306                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
3307                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
3308                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
3309                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
3310                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
3311                         {
3312                                 diffusetex[0] += buffer_texture_pantsbgra8[x*4+0] * Color_Pants[0] + buffer_texture_shirtbgra8[x*4+0] * Color_Shirt[0];
3313                                 diffusetex[1] += buffer_texture_pantsbgra8[x*4+1] * Color_Pants[1] + buffer_texture_shirtbgra8[x*4+1] * Color_Shirt[1];
3314                                 diffusetex[2] += buffer_texture_pantsbgra8[x*4+2] * Color_Pants[2] + buffer_texture_shirtbgra8[x*4+2] * Color_Shirt[2];
3315                                 diffusetex[3] += buffer_texture_pantsbgra8[x*4+3] * Color_Pants[3] + buffer_texture_shirtbgra8[x*4+3] * Color_Shirt[3];
3316                         }
3317                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_CUBEFILTER)
3318                         {
3319                                 // scale down the attenuation to account for the cubefilter multiplying everything by 255
3320                                 attenuation *= (1.0f / 255.0f);
3321                                 d[0] = (int)((diffusetex[0] * (Color_Ambient[0])) * LightColor[0] * buffer_texture_cubebgra8[x*4+0] * attenuation);if (d[0] > 255) d[0] = 255;
3322                                 d[1] = (int)((diffusetex[1] * (Color_Ambient[1])) * LightColor[1] * buffer_texture_cubebgra8[x*4+1] * attenuation);if (d[1] > 255) d[1] = 255;
3323                                 d[2] = (int)((diffusetex[2] * (Color_Ambient[2])) * LightColor[2] * buffer_texture_cubebgra8[x*4+2] * attenuation);if (d[2] > 255) d[2] = 255;
3324                                 d[3] = (int)( diffusetex[3]                                                                                      );if (d[3] > 255) d[3] = 255;
3325                         }
3326                         else
3327                         {
3328                                 d[0] = (int)((diffusetex[0] * (Color_Ambient[0])) * LightColor[0]                                   * attenuation);if (d[0] > 255) d[0] = 255;
3329                                 d[1] = (int)((diffusetex[1] * (Color_Ambient[1])) * LightColor[1]                                   * attenuation);if (d[1] > 255) d[1] = 255;
3330                                 d[2] = (int)((diffusetex[2] * (Color_Ambient[2])) * LightColor[2]                                   * attenuation);if (d[2] > 255) d[2] = 255;
3331                                 d[3] = (int)( diffusetex[3]                                                                                                                                                                );if (d[3] > 255) d[3] = 255;
3332                         }
3333                         buffer_FragColorbgra8[x*4+0] = d[0];
3334                         buffer_FragColorbgra8[x*4+1] = d[1];
3335                         buffer_FragColorbgra8[x*4+2] = d[2];
3336                         buffer_FragColorbgra8[x*4+3] = d[3];
3337                 }
3338         }
3339         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3340 }
3341
3342
3343
3344 void DPSOFTRAST_VertexShader_Refraction(void)
3345 {
3346         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
3347 }
3348
3349 void DPSOFTRAST_PixelShader_Refraction(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3350 {
3351         // TODO: IMPLEMENT
3352         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3353         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3354         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3355         memset(buffer_FragColorbgra8, 0, span->length*4);
3356         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3357 }
3358
3359
3360
3361 void DPSOFTRAST_VertexShader_Water(void)
3362 {
3363         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
3364 }
3365
3366
3367 void DPSOFTRAST_PixelShader_Water(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3368 {
3369         // TODO: IMPLEMENT
3370         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3371         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3372         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3373         memset(buffer_FragColorbgra8, 0, span->length*4);
3374         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3375 }
3376
3377
3378
3379 void DPSOFTRAST_VertexShader_ShowDepth(void)
3380 {
3381         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
3382 }
3383
3384 void DPSOFTRAST_PixelShader_ShowDepth(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3385 {
3386         // TODO: IMPLEMENT
3387         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3388         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3389         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3390         memset(buffer_FragColorbgra8, 0, span->length*4);
3391         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3392 }
3393
3394
3395
3396 void DPSOFTRAST_VertexShader_DeferredGeometry(void)
3397 {
3398         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
3399 }
3400
3401 void DPSOFTRAST_PixelShader_DeferredGeometry(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3402 {
3403         // TODO: IMPLEMENT
3404         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3405         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3406         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3407         memset(buffer_FragColorbgra8, 0, span->length*4);
3408         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3409 }
3410
3411
3412
3413 void DPSOFTRAST_VertexShader_DeferredLightSource(void)
3414 {
3415         DPSOFTRAST_Array_Transform(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION], dpsoftrast.draw.numvertices, dpsoftrast.uniform4f + 4*DPSOFTRAST_UNIFORM_ModelViewProjectionMatrixM1);
3416 }
3417
3418 void DPSOFTRAST_PixelShader_DeferredLightSource(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3419 {
3420         // TODO: IMPLEMENT
3421         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3422         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3423         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3424         memset(buffer_FragColorbgra8, 0, span->length*4);
3425         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3426 }
3427
3428
3429
3430 typedef struct DPSOFTRAST_ShaderModeInfo_s
3431 {
3432         int lodarrayindex;
3433         void (*Vertex)(void);
3434         void (*Span)(const DPSOFTRAST_State_Draw_Span * RESTRICT span);
3435 }
3436 DPSOFTRAST_ShaderModeInfo;
3437
3438 DPSOFTRAST_ShaderModeInfo DPSOFTRAST_ShaderModeTable[SHADERMODE_COUNT] =
3439 {
3440         {2, DPSOFTRAST_VertexShader_Generic,                        DPSOFTRAST_PixelShader_Generic,                      },
3441         {2, DPSOFTRAST_VertexShader_PostProcess,                    DPSOFTRAST_PixelShader_PostProcess,                  },
3442         {2, DPSOFTRAST_VertexShader_Depth_Or_Shadow,                DPSOFTRAST_PixelShader_Depth_Or_Shadow,              },
3443         {2, DPSOFTRAST_VertexShader_FlatColor,                      DPSOFTRAST_PixelShader_FlatColor,                    },
3444         {2, DPSOFTRAST_VertexShader_VertexColor,                    DPSOFTRAST_PixelShader_VertexColor,                  },
3445         {2, DPSOFTRAST_VertexShader_Lightmap,                       DPSOFTRAST_PixelShader_Lightmap,                     },
3446         {2, DPSOFTRAST_VertexShader_FakeLight,                      DPSOFTRAST_PixelShader_FakeLight,                    },
3447         {2, DPSOFTRAST_VertexShader_LightDirectionMap_ModelSpace,   DPSOFTRAST_PixelShader_LightDirectionMap_ModelSpace, },
3448         {2, DPSOFTRAST_VertexShader_LightDirectionMap_TangentSpace, DPSOFTRAST_PixelShader_LightDirectionMap_TangentSpace},
3449         {2, DPSOFTRAST_VertexShader_LightDirection,                 DPSOFTRAST_PixelShader_LightDirection,               },
3450         {2, DPSOFTRAST_VertexShader_LightSource,                    DPSOFTRAST_PixelShader_LightSource,                  },
3451         {2, DPSOFTRAST_VertexShader_Refraction,                     DPSOFTRAST_PixelShader_Refraction,                   },
3452         {2, DPSOFTRAST_VertexShader_Water,                          DPSOFTRAST_PixelShader_Water,                        },
3453         {2, DPSOFTRAST_VertexShader_ShowDepth,                      DPSOFTRAST_PixelShader_ShowDepth,                    },
3454         {2, DPSOFTRAST_VertexShader_DeferredGeometry,               DPSOFTRAST_PixelShader_DeferredGeometry,             },
3455         {2, DPSOFTRAST_VertexShader_DeferredLightSource,            DPSOFTRAST_PixelShader_DeferredLightSource,          }
3456 };
3457
3458
3459
3460 void DPSOFTRAST_Draw_ProcessSpans(void)
3461 {
3462         int i;
3463         int x;
3464         int startx;
3465         int endx;
3466         int numspans = dpsoftrast.draw.numspans;
3467 //      unsigned int c;
3468 //      unsigned int *colorpixel;
3469         unsigned int *depthpixel;
3470         float w;
3471         float wslope;
3472         int depth;
3473         int depthslope;
3474         unsigned int d;
3475         DPSOFTRAST_State_Draw_Span *span = dpsoftrast.draw.spanqueue;
3476         unsigned char pixelmask[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3477         for (i = 0;i < numspans;i++, span++)
3478         {
3479                 w = span->data[0][DPSOFTRAST_ARRAY_TOTAL][3];
3480                 wslope = span->data[1][DPSOFTRAST_ARRAY_TOTAL][3];
3481                 if (dpsoftrast.user.depthtest && dpsoftrast.fb_depthpixels)
3482                 {
3483                         depthslope = (int)(wslope*DPSOFTRAST_DEPTHSCALE);
3484                         depth = (int)(w*DPSOFTRAST_DEPTHSCALE - DPSOFTRAST_DEPTHOFFSET*(dpsoftrast.user.polygonoffset[1] + fabs(wslope)*dpsoftrast.user.polygonoffset[0]));
3485                         depthpixel = dpsoftrast.fb_depthpixels + span->start;
3486                         switch(dpsoftrast.fb_depthfunc)
3487                         {
3488                         default:
3489                         case GL_ALWAYS:  for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = true; break;
3490                         case GL_LESS:    for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = depthpixel[x] < d; break;
3491                         case GL_LEQUAL:  for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = depthpixel[x] <= d; break;
3492                         case GL_EQUAL:   for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = depthpixel[x] == d; break;
3493                         case GL_GEQUAL:  for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = depthpixel[x] >= d; break;
3494                         case GL_GREATER: for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = depthpixel[x] > d; break;
3495                         case GL_NEVER:   for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = false; break;
3496                         }
3497                         //colorpixel = dpsoftrast.fb_colorpixels[0] + span->start;
3498                         //for (x = 0;x < span->length;x++)
3499                         //      colorpixel[x] = (depthpixel[x] & 0xFF000000) ? (0x00FF0000) : (depthpixel[x] & 0x00FF0000);
3500                         // if there is no color buffer, skip pixel shader
3501                         startx = 0;
3502                         endx = span->length;
3503                         while (startx < endx && !pixelmask[startx])
3504                                 startx++;
3505                         while (endx > startx && !pixelmask[endx-1])
3506                                 endx--;
3507                         if (startx >= endx)
3508                                 continue; // no pixels to fill
3509                         span->pixelmask = pixelmask;
3510                         span->startx = startx;
3511                         span->endx = endx;
3512                         // run pixel shader if appropriate
3513                         // do this before running depthmask code, to allow the pixelshader
3514                         // to clear pixelmask values for alpha testing
3515                         if (dpsoftrast.fb_colorpixels[0] && dpsoftrast.fb_colormask)
3516                                 DPSOFTRAST_ShaderModeTable[dpsoftrast.shader_mode].Span(span);
3517                         if (dpsoftrast.user.depthmask)
3518                                 for (x = startx, d = depth + depthslope*startx;x < endx;x++, d += depthslope)
3519                                         if (pixelmask[x])
3520                                                 depthpixel[x] = d;
3521                 }
3522                 else
3523                 {
3524                         // no depth testing means we're just dealing with color...
3525                         // if there is no color buffer, skip pixel shader
3526                         if (dpsoftrast.fb_colorpixels[0] && dpsoftrast.fb_colormask)
3527                         {
3528                                 memset(pixelmask, 1, span->length);
3529                                 span->pixelmask = pixelmask;
3530                                 span->startx = 0;
3531                                 span->endx = span->length;
3532                                 DPSOFTRAST_ShaderModeTable[dpsoftrast.shader_mode].Span(span);
3533                         }
3534                 }
3535         }
3536 }
3537
3538 void DPSOFTRAST_Draw_ProcessTriangles(int firstvertex, int numtriangles, const int *element3i, const unsigned short *element3s, unsigned char *arraymask)
3539 {
3540 #ifdef SSE2_PRESENT
3541         int cullface = dpsoftrast.user.cullface;
3542         int width = dpsoftrast.fb_width;
3543         int height = dpsoftrast.fb_height;
3544         __m128i fbmax = _mm_sub_epi16(_mm_setr_epi16(width, height, width, height, width, height, width, height), _mm_set1_epi16(1));
3545         int i;
3546         int j;
3547         int k;
3548         int y;
3549         int e[3];
3550         __m128i screeny;
3551         int starty, endy;
3552         int numpoints;
3553         int edge0p;
3554         int edge0n;
3555         int edge1p;
3556         int edge1n;
3557         int startx;
3558         int endx;
3559         unsigned char mip[DPSOFTRAST_MAXTEXTUREUNITS];
3560         __m128 mipedgescale;
3561         float clipdist[4];
3562         __m128 clipfrac[4];
3563         __m128 clipped[DPSOFTRAST_ARRAY_TOTAL][4];
3564         __m128 screen[4];
3565         __m128 proj[DPSOFTRAST_ARRAY_TOTAL][4];
3566         DPSOFTRAST_Texture *texture;
3567         DPSOFTRAST_State_Draw_Span *span;
3568         DPSOFTRAST_State_Draw_Span *oldspan;
3569         for (i = 0;i < numtriangles;i++)
3570         {
3571                 // generate the 3 edges of this triangle
3572                 // generate spans for the triangle - switch based on left split or right split classification of triangle
3573                 if (element3i)
3574                 {
3575                         e[0] = element3i[i*3+0] - firstvertex;
3576                         e[1] = element3i[i*3+1] - firstvertex;
3577                         e[2] = element3i[i*3+2] - firstvertex;
3578                 }
3579                 else if (element3s)
3580                 {
3581                         e[0] = element3s[i*3+0] - firstvertex;
3582                         e[1] = element3s[i*3+1] - firstvertex;
3583                         e[2] = element3s[i*3+2] - firstvertex;
3584                 }
3585                 else
3586                 {
3587                         e[0] = i*3+0;
3588                         e[1] = i*3+1;
3589                         e[2] = i*3+2;
3590                 }
3591
3592 #define SKIPBACKFACE \
3593                 if(cullface != GL_NONE) \
3594                 { \
3595                         __m128 triangleedge[2]; \
3596                         __m128 trianglenormal; \
3597                         triangleedge[0] = _mm_sub_ps(screen[0], screen[1]); \
3598                         triangleedge[1] = _mm_sub_ps(screen[2], screen[1]); \
3599                         /* store normal in 2, 0, 1 order instead of 0, 1, 2 as it requires fewer shuffles and leaves z component accessible as scalar */ \
3600                         trianglenormal = _mm_sub_ss(_mm_mul_ss(triangleedge[0], _mm_shuffle_ps(triangleedge[1], triangleedge[1], _MM_SHUFFLE(3, 0, 2, 1))), \
3601                                                                                         _mm_mul_ss(_mm_shuffle_ps(triangleedge[0], triangleedge[0], _MM_SHUFFLE(3, 0, 2, 1)), triangleedge[1])); \
3602                         /* apply current cullface mode (this culls many triangles) */ \
3603                         switch(cullface) \
3604                         { \
3605                         case GL_BACK: \
3606                                 if (_mm_ucomilt_ss(trianglenormal, _mm_setzero_ps())) \
3607                                         continue; \
3608                                 break; \
3609                         case GL_FRONT: \
3610                                 if (_mm_ucomigt_ss(trianglenormal, _mm_setzero_ps())) \
3611                                         continue; \
3612                                 break; \
3613                         } \
3614                 }
3615                         //trianglenormal = _mm_sub_ps(_mm_mul_ps(triangleedge[0], _mm_shuffle_ps(triangleedge[1], triangleedge[1], _MM_SHUFFLE(3, 0, 2, 1))),
3616                         //                                                _mm_mul_ps(_mm_shuffle_ps(triangleedge[0], triangleedge[0], _MM_SHUFFLE(3, 0, 2, 1)), triangleedge[1]));
3617                         //trianglenormal[2] = triangleedge[0][0] * triangleedge[1][1] - triangleedge[0][1] * triangleedge[1][0];
3618                         //trianglenormal[0] = triangleedge[0][1] * triangleedge[1][2] - triangleedge[0][2] * triangleedge[1][1];
3619                         //trianglenormal[1] = triangleedge[0][2] * triangleedge[1][0] - triangleedge[0][0] * triangleedge[1][2];
3620
3621                         // macros for clipping vertices
3622 #define CLIPPEDVERTEXLERP(k,p1, p2) \
3623                         clipfrac[k] = _mm_set1_ps(clipdist[p1] / (clipdist[p1] - clipdist[p2])); \
3624                         { \
3625                                 __m128 v1 = _mm_load_ps(&dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[p1]*4]), v2 = _mm_load_ps(&dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[p2]*4]); \
3626                                 clipped[DPSOFTRAST_ARRAY_POSITION][k] = _mm_add_ps(v1, _mm_mul_ps(_mm_sub_ps(v2, v1), clipfrac[k])); \
3627                         } \
3628                         screen[k] = DPSOFTRAST_Draw_ProjectVertex(clipped[DPSOFTRAST_ARRAY_POSITION][k]);
3629 #define CLIPPEDATTRIBSLERP(k,p1,p2) \
3630                         for (j = DPSOFTRAST_ARRAY_POSITION+1;j < DPSOFTRAST_ARRAY_TOTAL;j++)\
3631                         {\
3632                                 /*if (arraymask[j])*/\
3633                                 {\
3634                                         __m128 v1 = _mm_load_ps(&dpsoftrast.draw.post_array4f[j][e[p1]*4]), v2 = _mm_load_ps(&dpsoftrast.draw.post_array4f[j][e[p2]*4]); \
3635                                         clipped[j][k] = _mm_add_ps(v1, _mm_mul_ps(_mm_sub_ps(v2, v1), clipfrac[k])); \
3636                                 }\
3637                         }
3638 #define CLIPPEDVERTEXCOPY(k,p1) \
3639                         screen[k] = _mm_load_ps(&dpsoftrast.draw.screencoord4f[e[p1]*4]);
3640 #define CLIPPEDATTRIBSCOPY(k,p1) \
3641                         for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)\
3642                         {\
3643                                 /*if (arraymask[j])*/\
3644                                 {\
3645                                         clipped[j][k] = _mm_load_ps(&dpsoftrast.draw.post_array4f[j][e[p1]*4]); \
3646                                 }\
3647                         }
3648
3649                 // calculate distance from nearplane
3650                 clipdist[0] = dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[0]*4+2] + dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[0]*4+3];
3651                 clipdist[1] = dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[1]*4+2] + dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[1]*4+3];
3652                 clipdist[2] = dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[2]*4+2] + dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[2]*4+3];
3653                 if (clipdist[0] >= 0.0f)
3654                 {
3655                         if (clipdist[1] >= 0.0f)
3656                         {
3657                                 if (clipdist[2] >= 0.0f)
3658                                 {
3659                                         // triangle is entirely in front of nearplane
3660                                         CLIPPEDVERTEXCOPY(0,0); CLIPPEDVERTEXCOPY(1,1); CLIPPEDVERTEXCOPY(2,2);
3661                                         numpoints = 3;
3662                                         SKIPBACKFACE;
3663                                         CLIPPEDATTRIBSCOPY(0,0); CLIPPEDATTRIBSCOPY(1,1); CLIPPEDATTRIBSCOPY(2,2);
3664                                 }
3665                                 else
3666                                 {
3667                                         CLIPPEDVERTEXCOPY(0,0); CLIPPEDVERTEXCOPY(1,1); CLIPPEDVERTEXLERP(2,1,2); CLIPPEDVERTEXLERP(3,2,0);
3668                                         numpoints = 4;
3669                                         SKIPBACKFACE;
3670                                         CLIPPEDATTRIBSCOPY(0,0); CLIPPEDATTRIBSCOPY(1,1); CLIPPEDATTRIBSLERP(2,1,2); CLIPPEDATTRIBSLERP(3,2,0);
3671                                 }
3672                         }
3673                         else 
3674                         {
3675                                 if (clipdist[2] >= 0.0f)
3676                                 {
3677                                         CLIPPEDVERTEXCOPY(0,0); CLIPPEDVERTEXLERP(1,0,1); CLIPPEDVERTEXLERP(2,1,2);     CLIPPEDVERTEXCOPY(3,2);
3678                                         numpoints = 4;
3679                                         SKIPBACKFACE;
3680                                         CLIPPEDATTRIBSCOPY(0,0); CLIPPEDATTRIBSLERP(1,0,1); CLIPPEDATTRIBSLERP(2,1,2); CLIPPEDATTRIBSCOPY(3,2);
3681                                 }
3682                                 else
3683                                 {
3684                                         CLIPPEDVERTEXCOPY(0,0); CLIPPEDVERTEXLERP(1,0,1); CLIPPEDVERTEXLERP(2,2,0);
3685                                         numpoints = 3;
3686                                         SKIPBACKFACE;
3687                                         CLIPPEDATTRIBSCOPY(0,0); CLIPPEDATTRIBSLERP(1,0,1); CLIPPEDATTRIBSLERP(2,2,0);
3688                                 }
3689                         }
3690                 }                       
3691                 else if (clipdist[1] >= 0.0f)
3692                 {
3693                         if (clipdist[2] >= 0.0f)
3694                         {
3695                                 CLIPPEDVERTEXLERP(0,0,1); CLIPPEDVERTEXCOPY(1,1); CLIPPEDVERTEXCOPY(2,2); CLIPPEDVERTEXLERP(3,2,0);
3696                                 numpoints = 4;
3697                                 SKIPBACKFACE;
3698                                 CLIPPEDATTRIBSLERP(0,0,1); CLIPPEDATTRIBSCOPY(1,1); CLIPPEDATTRIBSCOPY(2,2); CLIPPEDATTRIBSLERP(3,2,0);
3699                         }
3700                         else
3701                         {
3702                                 CLIPPEDVERTEXLERP(0,0,1); CLIPPEDVERTEXCOPY(1,1); CLIPPEDVERTEXLERP(2,1,2);
3703                                 numpoints = 3;
3704                                 SKIPBACKFACE;
3705                                 CLIPPEDATTRIBSLERP(0,0,1); CLIPPEDATTRIBSCOPY(1,1); CLIPPEDATTRIBSLERP(2,1,2);
3706                         }
3707                 }
3708                 else if (clipdist[2] >= 0.0f)
3709                 {
3710                         CLIPPEDVERTEXLERP(0,1,2); CLIPPEDVERTEXCOPY(1,2); CLIPPEDVERTEXLERP(2,2,0);
3711                         numpoints = 3;
3712                         SKIPBACKFACE;
3713                         CLIPPEDATTRIBSLERP(0,1,2); CLIPPEDATTRIBSCOPY(1,2); CLIPPEDATTRIBSLERP(2,2,0);
3714                 }
3715                 else continue; // triangle is entirely behind nearplane
3716
3717                 {
3718                         // calculate integer y coords for triangle points
3719                         __m128i screeni = _mm_packs_epi32(_mm_cvttps_epi32(_mm_shuffle_ps(screen[0], screen[1], _MM_SHUFFLE(1, 0, 1, 0))),
3720                                                                                   _mm_cvttps_epi32(_mm_shuffle_ps(screen[2], numpoints <= 3 ? screen[2] : screen[3], _MM_SHUFFLE(1, 0, 1, 0)))),
3721                                         screenir = _mm_shuffle_epi32(screeni, _MM_SHUFFLE(1, 0, 3, 2)), 
3722                                         screenmin = _mm_min_epi16(screeni, screenir), 
3723                                         screenmax = _mm_max_epi16(screeni, screenir);
3724                         screenmin = _mm_min_epi16(screenmin, _mm_shufflelo_epi16(screenmin, _MM_SHUFFLE(1, 0, 3, 2)));
3725                         screenmax = _mm_max_epi16(screenmax, _mm_shufflelo_epi16(screenmax, _MM_SHUFFLE(1, 0, 3, 2)));
3726                         screenmin = _mm_max_epi16(screenmin, _mm_setzero_si128());
3727                         screenmax = _mm_min_epi16(screenmax, fbmax);
3728                         // skip offscreen triangles
3729                         if (_mm_cvtsi128_si32(_mm_cmplt_epi16(screenmax, screenmin)))
3730                                 continue;
3731                         starty = _mm_extract_epi16(screenmin, 1);
3732                         endy = _mm_extract_epi16(screenmax, 1)+1;
3733                         screeny = _mm_srai_epi32(screeni, 16);
3734                 }
3735
3736                 // okay, this triangle is going to produce spans, we'd better project
3737                 // the interpolants now (this is what gives perspective texturing),
3738                 // this consists of simply multiplying all arrays by the W coord
3739                 // (which is basically 1/Z), which will be undone per-pixel
3740                 // (multiplying by Z again) to get the perspective-correct array
3741                 // values
3742                 for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)
3743                 {
3744                         //if (arraymask[j])
3745                         {
3746                                 for (k = 0;k < numpoints;k++)
3747                                 {
3748                                         proj[j][k] = _mm_mul_ps(clipped[j][k], _mm_shuffle_ps(screen[k], screen[k], _MM_SHUFFLE(3, 3, 3, 3)));
3749                                 }
3750                         }
3751                 }
3752                 // adjust texture LOD by texture density, in the simplest way possible...
3753                 mipedgescale = _mm_sub_ps(_mm_shuffle_ps(screen[0], screen[2], _MM_SHUFFLE(1, 0, 1, 0)), _mm_shuffle_ps(screen[1], screen[1], _MM_SHUFFLE(1, 0, 1, 0)));
3754                 mipedgescale = _mm_mul_ps(mipedgescale, mipedgescale);
3755                 mipedgescale = _mm_div_ps(_mm_set1_ps(1.0f), _mm_add_ps(mipedgescale, _mm_shuffle_ps(mipedgescale, mipedgescale, _MM_SHUFFLE(2, 3, 0, 1))));
3756                 for (j = 0;j < DPSOFTRAST_MAXTEXTUREUNITS;j++)
3757                 {
3758                         texture = dpsoftrast.texbound[j];
3759                         if (texture)
3760                         {
3761                                 __m128 mipedgetc;
3762                                 if (texture->filter <= DPSOFTRAST_TEXTURE_FILTER_LINEAR)
3763                                 {
3764                                         mip[j] = 0;
3765                                         continue;
3766                                 }
3767                                 k = DPSOFTRAST_ShaderModeTable[dpsoftrast.shader_mode].lodarrayindex;
3768                                 mipedgetc = _mm_sub_ps(_mm_shuffle_ps(clipped[k][0], clipped[k][2], _MM_SHUFFLE(1, 0, 1, 0)),
3769                                                                                 _mm_shuffle_ps(clipped[k][1], clipped[k][1], _MM_SHUFFLE(1, 0, 1, 0)));
3770                                 mipedgetc = _mm_mul_ps(mipedgetc, _mm_cvtepi32_ps(_mm_shuffle_epi32(_mm_loadl_epi64((const __m128i *)&texture->mipmap[0][2]), _MM_SHUFFLE(1, 0, 1, 0))));
3771                                 mipedgetc = _mm_mul_ps(mipedgetc, mipedgetc);
3772                                 mipedgetc = _mm_add_ps(mipedgetc, _mm_shuffle_ps(mipedgetc, mipedgetc, _MM_SHUFFLE(2, 3, 0, 1)));
3773                                 mipedgetc = _mm_mul_ps(mipedgetc, mipedgescale);
3774                                 mipedgetc = _mm_min_ss(mipedgetc, _mm_shuffle_ps(mipedgetc, mipedgetc, _MM_SHUFFLE(2, 2, 2, 2)));       
3775                                 // this will be multiplied in the texturing routine by the texture resolution
3776                                 y = _mm_cvtss_si32(mipedgetc);
3777                                 if (y > 0) 
3778                                 {
3779                                         y = (int)(log((float)y)/M_LN2);
3780                                         if (y > texture->mipmaps - 1)
3781                                                 y = texture->mipmaps - 1;
3782                                 }
3783                                 else y = 0;
3784                                 mip[j] = y;
3785                         }
3786                 }
3787                 // iterate potential spans
3788                 // TODO: optimize?  if we figured out the edge order beforehand, this
3789                 //         could do loops over the edges in the proper order rather than
3790                 //         selecting them for each span
3791                 // TODO: optimize?  the edges could have data slopes calculated
3792                 // TODO: optimize?  the data slopes could be calculated as a plane
3793                 //         (2D slopes) to avoid any interpolation along edges at all
3794                 for (y = starty+1;y < endy;)
3795                 {
3796                         int nexty = -1;
3797                         __m128 edge0offset, edge1offset, edge0scale, edge1scale, data[DPSOFTRAST_ARRAY_TOTAL+1][2], slope[DPSOFTRAST_ARRAY_TOTAL+1][2];
3798                         __m128i screenycc = _mm_cmpgt_epi32(_mm_set1_epi32(y), screeny);
3799                         int screenymask = _mm_movemask_epi8(screenycc);
3800                         if (numpoints == 4)
3801                         {
3802                                 switch(screenymask)
3803                                 {
3804                                 default:
3805                                 case 0xFFFF: /*0000*/ y++; continue;
3806                                 case 0xFFF0: /*1000*/ edge0p = 3;edge0n = 0;edge1p = 1;edge1n = 0;break;
3807                                 case 0xFF0F: /*0100*/ edge0p = 0;edge0n = 1;edge1p = 2;edge1n = 1;break;
3808                                 case 0xFF00: /*1100*/ edge0p = 3;edge0n = 0;edge1p = 2;edge1n = 1;break;
3809                                 case 0xF0FF: /*0010*/ edge0p = 1;edge0n = 2;edge1p = 3;edge1n = 2;break;
3810                                 case 0xF0F0: /*1010*/ edge0p = 1;edge0n = 2;edge1p = 3;edge1n = 2;break; // concave - nonsense
3811                                 case 0xF00F: /*0110*/ edge0p = 0;edge0n = 1;edge1p = 3;edge1n = 2;break;
3812                                 case 0xF000: /*1110*/ edge0p = 3;edge0n = 0;edge1p = 3;edge1n = 2;break;
3813                                 case 0x0FFF: /*0001*/ edge0p = 2;edge0n = 3;edge1p = 0;edge1n = 3;break;
3814                                 case 0x0FF0: /*1001*/ edge0p = 2;edge0n = 3;edge1p = 1;edge1n = 0;break;
3815                                 case 0x0F0F: /*0101*/ edge0p = 2;edge0n = 3;edge1p = 2;edge1n = 1;break; // concave - nonsense
3816                                 case 0x0F00: /*1101*/ edge0p = 2;edge0n = 3;edge1p = 2;edge1n = 1;break;
3817                                 case 0x00FF: /*0011*/ edge0p = 1;edge0n = 2;edge1p = 0;edge1n = 3;break;
3818                                 case 0x00F0: /*1011*/ edge0p = 1;edge0n = 2;edge1p = 1;edge1n = 0;break;
3819                                 case 0x000F: /*0111*/ edge0p = 0;edge0n = 1;edge1p = 0;edge1n = 3;break;
3820                                 case 0x0000: /*1111*/ y++; continue;
3821                                 }
3822                         }
3823                         else
3824                         {
3825                                 switch(screenymask)
3826                                 {
3827                                 default:
3828                                 case 0xFFFF: /*000*/ y++; continue;
3829                                 case 0xFFF0: /*100*/ edge0p = 2;edge0n = 0;edge1p = 1;edge1n = 0;break;
3830                                 case 0xFF0F: /*010*/ edge0p = 0;edge0n = 1;edge1p = 2;edge1n = 1;break;
3831                                 case 0xFF00: /*110*/ edge0p = 2;edge0n = 0;edge1p = 2;edge1n = 1;break;
3832                                 case 0x00FF: /*001*/ edge0p = 1;edge0n = 2;edge1p = 0;edge1n = 2;break;
3833                                 case 0x00F0: /*101*/ edge0p = 1;edge0n = 2;edge1p = 1;edge1n = 0;break;
3834                                 case 0x000F: /*011*/ edge0p = 0;edge0n = 1;edge1p = 0;edge1n = 2;break;
3835                                 case 0x0000: /*111*/ y++; continue;
3836                                 }
3837                         }
3838                         screenycc = _mm_max_epi16(_mm_srli_epi16(screenycc, 1), screeny);
3839                         screenycc = _mm_min_epi16(screenycc, _mm_shuffle_epi32(screenycc, _MM_SHUFFLE(1, 0, 3, 2)));  
3840                         screenycc = _mm_min_epi16(screenycc, _mm_shuffle_epi32(screenycc, _MM_SHUFFLE(2, 3, 0, 1)));
3841                         nexty = _mm_extract_epi16(screenycc, 0);        
3842                         if(nexty >= endy) nexty = endy-1;
3843                         if (_mm_ucomigt_ss(_mm_max_ss(screen[edge0n], screen[edge0p]), _mm_min_ss(screen[edge1n], screen[edge1p])))
3844                         {
3845                                 int tmp = edge0n;
3846                                 edge0n = edge1n;
3847                                 edge1n = tmp;
3848                                 tmp = edge0p;
3849                                 edge0p = edge1p;
3850                                 edge1p = tmp;
3851                         }       
3852                         edge0offset = _mm_shuffle_ps(screen[edge0p], screen[edge0p], _MM_SHUFFLE(1, 1, 1, 1));
3853                         edge0scale = _mm_div_ss(_mm_set1_ps(1.0f), _mm_sub_ss(_mm_shuffle_ps(screen[edge0n], screen[edge0n], _MM_SHUFFLE(1, 1, 1, 1)), edge0offset));
3854                         edge0scale = _mm_shuffle_ps(edge0scale, edge0scale, _MM_SHUFFLE(0, 0, 0, 0));
3855                         edge0offset = _mm_sub_ps(_mm_set1_ps(y), edge0offset);
3856                         edge1offset = _mm_shuffle_ps(screen[edge1p], screen[edge1p], _MM_SHUFFLE(1, 1, 1, 1));
3857                         edge1scale = _mm_div_ss(_mm_set1_ps(1.0f), _mm_sub_ss(_mm_shuffle_ps(screen[edge1n], screen[edge1n], _MM_SHUFFLE(1, 1, 1, 1)), edge1offset));
3858                         edge1offset = _mm_sub_ps(_mm_set1_ps(y), edge1offset);
3859                         edge1scale = _mm_shuffle_ps(edge1scale, edge1scale, _MM_SHUFFLE(0, 0, 0, 0));
3860                         j = DPSOFTRAST_ARRAY_TOTAL;
3861                         slope[j][0] = _mm_mul_ps(_mm_sub_ps(screen[edge0n], screen[edge0p]), edge0scale);
3862                         slope[j][1] = _mm_mul_ps(_mm_sub_ps(screen[edge1n], screen[edge1p]), edge1scale);
3863                         data[j][0] = _mm_add_ps(_mm_mul_ps(slope[j][0], edge0offset), screen[edge0p]);
3864                         data[j][1] = _mm_add_ps(_mm_mul_ps(slope[j][1], edge1offset), screen[edge1p]);
3865                         data[j][1] = _mm_sub_ps(data[j][1], data[j][0]);
3866                         slope[j][1] = _mm_sub_ps(slope[j][1], slope[j][0]);
3867                         for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)
3868                         {
3869                                 //if (arraymask[j])
3870                                 {
3871                                         slope[j][0] = _mm_mul_ps(_mm_sub_ps(proj[j][edge0n], proj[j][edge0p]), edge0scale);
3872                                         slope[j][1] = _mm_mul_ps(_mm_sub_ps(proj[j][edge1n], proj[j][edge1p]), edge1scale);
3873                                         data[j][0] = _mm_add_ps(_mm_mul_ps(slope[j][0], edge0offset), proj[j][edge0p]);
3874                                         data[j][1] = _mm_add_ps(_mm_mul_ps(slope[j][1], edge1offset), proj[j][edge1p]);
3875                                         data[j][1] = _mm_sub_ps(data[j][1], data[j][0]);
3876                                         slope[j][1] = _mm_sub_ps(slope[j][1], slope[j][0]);
3877                                 }
3878                         }
3879                         goto firstspan;
3880                         for(; y <= nexty; y++)
3881                         {
3882                                 __m128 data0, data1, spanilength, startxlerp;
3883                                 j = DPSOFTRAST_ARRAY_TOTAL;
3884                                 data[j][0] = _mm_add_ps(data[j][0], slope[j][0]);
3885                                 data[j][1] = _mm_add_ps(data[j][1], slope[j][1]);
3886                                 for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)
3887                                 {
3888                                         //if (arraymask[j])
3889                                         {
3890                                                 data[j][0] = _mm_add_ps(data[j][0], slope[j][0]);
3891                                                 data[j][1] = _mm_add_ps(data[j][1], slope[j][1]);
3892                                         }
3893                                 }
3894
3895                         firstspan:
3896                                 startx = _mm_cvtss_si32(_mm_add_ss(data[DPSOFTRAST_ARRAY_TOTAL][0], _mm_set1_ps(0.5f)));
3897                                 endx = _mm_cvtss_si32(_mm_add_ss(_mm_add_ss(data[DPSOFTRAST_ARRAY_TOTAL][0], data[DPSOFTRAST_ARRAY_TOTAL][1]), _mm_set1_ps(0.5f)));
3898                                 if (startx < 0) startx = 0;
3899                                 if (endx > width) endx = width;
3900                                 if (startx >= endx) continue;
3901 #if 0
3902                                 _mm_store_ss(&startxf, data0);
3903                                 _mm_store_ss(&endxf, data1);
3904                                 if (startxf > startx || endxf < endx-1) { printf("%s:%i X wrong (%i to %i is outside %f to %f)\n", __FILE__, __LINE__, startx, endx, startxf, endxf); }
3905 #endif
3906                                 spanilength = _mm_div_ss(_mm_set1_ps(1.0f), data[DPSOFTRAST_ARRAY_TOTAL][1]);
3907                                 spanilength = _mm_shuffle_ps(spanilength, spanilength, _MM_SHUFFLE(0, 0, 0, 0));
3908                                 startxlerp = _mm_sub_ss(_mm_cvtsi32_ss(_mm_setzero_ps(), startx), data[DPSOFTRAST_ARRAY_TOTAL][0]);
3909                                 startxlerp = _mm_shuffle_ps(startxlerp, startxlerp, _MM_SHUFFLE(0, 0, 0, 0));
3910                                 span = &dpsoftrast.draw.spanqueue[dpsoftrast.draw.numspans++];
3911                                 memcpy(span->mip, mip, sizeof(span->mip));
3912                                 span->start = y * width + startx;
3913                                 span->length = endx - startx;
3914                                 j = DPSOFTRAST_ARRAY_TOTAL;
3915                                 data1 = _mm_mul_ps(data[j][1], spanilength);
3916                                 data0 = _mm_add_ps(data[j][0], _mm_mul_ps(data1, startxlerp));
3917                                 _mm_store_ps(span->data[0][j], data0);
3918                                 _mm_store_ps(span->data[1][j], data1);
3919                                 for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)
3920                                 {
3921                                         //if (arraymask[j])
3922                                         {
3923                                                 data1 = _mm_mul_ps(data[j][1], spanilength);
3924                                                 data0 = _mm_add_ps(data[j][0], _mm_mul_ps(data1, startxlerp));
3925                                                 _mm_store_ps(span->data[0][j], data0);
3926                                                 _mm_store_ps(span->data[1][j], data1);
3927                                         }
3928                                 }
3929                                 // to keep the shader routines from needing more than a small
3930                                 // buffer for pixel intermediate data, we split long spans...
3931                                 while (span->length > DPSOFTRAST_DRAW_MAXSPANLENGTH)
3932                                 {
3933                                         span->length = DPSOFTRAST_DRAW_MAXSPANLENGTH;
3934                                         if (dpsoftrast.draw.numspans >= DPSOFTRAST_DRAW_MAXSPANQUEUE)
3935                                         {
3936                                                 DPSOFTRAST_Draw_ProcessSpans();
3937                                                 dpsoftrast.draw.numspans = 0;
3938                                         }
3939                                         oldspan = span;
3940                                         span = &dpsoftrast.draw.spanqueue[dpsoftrast.draw.numspans++];
3941                                         *span = *oldspan;
3942                                         startx += DPSOFTRAST_DRAW_MAXSPANLENGTH;
3943                                         span->start = y * width + startx;
3944                                         span->length = endx - startx;
3945                                         j = DPSOFTRAST_ARRAY_TOTAL;
3946                                         _mm_store_ps(span->data[0][j], _mm_add_ps(_mm_load_ps(span->data[0][j]), _mm_mul_ps(_mm_load_ps(span->data[1][j]), _mm_set1_ps(DPSOFTRAST_DRAW_MAXSPANLENGTH))));
3947                                         for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)
3948                                         {
3949                                                 //if (arraymask[j])
3950                                                 {
3951                                                          _mm_store_ps(span->data[0][j], _mm_add_ps(_mm_load_ps(span->data[0][j]), _mm_mul_ps(_mm_load_ps(span->data[1][j]), _mm_set1_ps(DPSOFTRAST_DRAW_MAXSPANLENGTH))));
3952                                                 }
3953                                         }
3954                                 }
3955                                 // after all that, we have a span suitable for the pixel shader...
3956                                 if (dpsoftrast.draw.numspans >= DPSOFTRAST_DRAW_MAXSPANQUEUE)
3957                                 {
3958                                         DPSOFTRAST_Draw_ProcessSpans();
3959                                         dpsoftrast.draw.numspans = 0;
3960                                 }
3961                         }
3962                 }
3963                 // draw outlines over triangle for debugging
3964         //      for (j = 0, k = numpoints-1;j < numpoints;k = j, j++)
3965         //              DPSOFTRAST_Draw_DebugEdgePoints(screen[k], screen[j]);
3966         }
3967         if (dpsoftrast.draw.numspans)
3968         {
3969                 DPSOFTRAST_Draw_ProcessSpans();
3970                 dpsoftrast.draw.numspans = 0;
3971         }
3972 #endif
3973 }
3974
3975 void DPSOFTRAST_Draw_DebugPoints(void)
3976 {
3977         int i;
3978         int x;
3979         int y;
3980         int numvertices = dpsoftrast.draw.numvertices;
3981         int w = dpsoftrast.fb_width;
3982         int bounds[4];
3983         unsigned int *pixels = dpsoftrast.fb_colorpixels[0];
3984         const float *c4f;
3985         bounds[0] = dpsoftrast.fb_viewportscissor[0];
3986         bounds[1] = dpsoftrast.fb_viewportscissor[1];
3987         bounds[2] = dpsoftrast.fb_viewportscissor[0] + dpsoftrast.fb_viewportscissor[2];
3988         bounds[3] = dpsoftrast.fb_viewportscissor[1] + dpsoftrast.fb_viewportscissor[3];
3989         for (i = 0;i < numvertices;i++)
3990         {
3991                 // check nearclip
3992                 //if (dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+3] != 1.0f)
3993                 //      continue;
3994                 x = (int)(dpsoftrast.draw.screencoord4f[i*4+0]);
3995                 y = (int)(dpsoftrast.draw.screencoord4f[i*4+1]);
3996                 //x = (int)(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+0] + 0.5f);
3997                 //y = (int)(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+1] + 0.5f);
3998                 //x = (int)((dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+0] + 1.0f) * dpsoftrast.fb_width * 0.5f + 0.5f);
3999                 //y = (int)((dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+1] + 1.0f) * dpsoftrast.fb_height * 0.5f + 0.5f);
4000                 if (x < bounds[0] || y < bounds[1] || x >= bounds[2] || y >= bounds[3])
4001                         continue;
4002                 c4f = dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_COLOR] + i*4;
4003                 pixels[y*w+x] = DPSOFTRAST_BGRA8_FROM_RGBA32F(c4f[0], c4f[1], c4f[2], c4f[3]);
4004         }
4005 }
4006
4007 void DPSOFTRAST_DrawTriangles(int firstvertex, int numvertices, int numtriangles, const int *element3i, const unsigned short *element3s)
4008 {
4009         unsigned char arraymask[DPSOFTRAST_ARRAY_TOTAL];
4010         arraymask[0] = true;
4011         arraymask[1] = dpsoftrast.fb_colorpixels[0] != NULL; // TODO: optimize (decide based on shadermode)
4012         arraymask[2] = dpsoftrast.pointer_texcoordf[0] != NULL;
4013         arraymask[3] = dpsoftrast.pointer_texcoordf[1] != NULL;
4014         arraymask[4] = dpsoftrast.pointer_texcoordf[2] != NULL;
4015         arraymask[5] = dpsoftrast.pointer_texcoordf[3] != NULL;
4016         arraymask[6] = dpsoftrast.pointer_texcoordf[4] != NULL;
4017         arraymask[7] = dpsoftrast.pointer_texcoordf[5] != NULL;
4018         arraymask[8] = dpsoftrast.pointer_texcoordf[6] != NULL;
4019         arraymask[9] = dpsoftrast.pointer_texcoordf[7] != NULL;
4020         DPSOFTRAST_Validate(DPSOFTRAST_VALIDATE_DRAW);
4021         DPSOFTRAST_Draw_LoadVertices(firstvertex, numvertices, true);
4022         DPSOFTRAST_ShaderModeTable[dpsoftrast.shader_mode].Vertex();
4023         DPSOFTRAST_Draw_ProjectVertices(dpsoftrast.draw.screencoord4f, dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], numvertices);
4024         DPSOFTRAST_Draw_ProcessTriangles(firstvertex, numtriangles, element3i, element3s, arraymask);
4025 }
4026
4027 void DPSOFTRAST_Init(int width, int height, unsigned int *colorpixels, unsigned int *depthpixels)
4028 {
4029         union
4030         {
4031                 int i;
4032                 unsigned char b[4];
4033         }
4034         u;
4035         u.i = 1;
4036         memset(&dpsoftrast, 0, sizeof(dpsoftrast));
4037         dpsoftrast.bigendian = u.b[3];
4038         dpsoftrast.fb_width = width;
4039         dpsoftrast.fb_height = height;
4040         dpsoftrast.fb_depthpixels = depthpixels;
4041         dpsoftrast.fb_colorpixels[0] = colorpixels;
4042         dpsoftrast.fb_colorpixels[1] = NULL;
4043         dpsoftrast.fb_colorpixels[1] = NULL;
4044         dpsoftrast.fb_colorpixels[1] = NULL;
4045         dpsoftrast.texture_firstfree = 1;
4046         dpsoftrast.texture_end = 1;
4047         dpsoftrast.texture_max = 0;
4048         dpsoftrast.user.colormask[0] = 1;
4049         dpsoftrast.user.colormask[1] = 1;
4050         dpsoftrast.user.colormask[2] = 1;
4051         dpsoftrast.user.colormask[3] = 1;
4052         dpsoftrast.user.blendfunc[0] = GL_ONE;
4053         dpsoftrast.user.blendfunc[1] = GL_ZERO;
4054         dpsoftrast.user.depthmask = true;
4055         dpsoftrast.user.depthtest = true;
4056         dpsoftrast.user.depthfunc = GL_LEQUAL;
4057         dpsoftrast.user.scissortest = false;
4058         dpsoftrast.user.cullface = GL_BACK;
4059         dpsoftrast.user.alphatest = false;
4060         dpsoftrast.user.alphafunc = GL_GREATER;
4061         dpsoftrast.user.alphavalue = 0.5f;
4062         dpsoftrast.user.scissor[0] = 0;
4063         dpsoftrast.user.scissor[1] = 0;
4064         dpsoftrast.user.scissor[2] = dpsoftrast.fb_width;
4065         dpsoftrast.user.scissor[3] = dpsoftrast.fb_height;
4066         dpsoftrast.user.viewport[0] = 0;
4067         dpsoftrast.user.viewport[1] = 0;
4068         dpsoftrast.user.viewport[2] = dpsoftrast.fb_width;
4069         dpsoftrast.user.viewport[3] = dpsoftrast.fb_height;
4070         dpsoftrast.user.depthrange[0] = 0;
4071         dpsoftrast.user.depthrange[1] = 1;
4072         dpsoftrast.user.polygonoffset[0] = 0;
4073         dpsoftrast.user.polygonoffset[1] = 0;
4074         dpsoftrast.user.color[0] = 1;
4075         dpsoftrast.user.color[1] = 1;
4076         dpsoftrast.user.color[2] = 1;
4077         dpsoftrast.user.color[3] = 1;
4078         dpsoftrast.validate = -1;
4079         DPSOFTRAST_Validate(-1);
4080         dpsoftrast.validate = 0;
4081 }
4082
4083 void DPSOFTRAST_Shutdown(void)
4084 {
4085         int i;
4086         for (i = 0;i < dpsoftrast.texture_end;i++)
4087                 if (dpsoftrast.texture[i].bytes)
4088                         MM_FREE(dpsoftrast.texture[i].bytes);
4089         if (dpsoftrast.texture)
4090                 free(dpsoftrast.texture);
4091         memset(&dpsoftrast, 0, sizeof(dpsoftrast));
4092 }
4093