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