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