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