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                         tci[0] = (subtc[0]>>16) - tcimin[0];
1932                         tci[1] = (subtc[1]>>16) - tcimin[1];
1933                         tci1[0] = ((subtc[0] + (endsub - x)*substep[0])>>16);
1934                         tci1[1] = ((subtc[1] + (endsub - x)*substep[1])>>16);
1935                         if (tci[0] <= tcimax[0] && tci[1] <= tcimax[1] && tci1[0] <= tcimax[0] && tci1[1] <= tcimax[1])
1936                         {
1937                                 __m128i subtcm = _mm_setr_epi32(subtc[0], subtc[1], subtc[0] + substep[0], subtc[1] + substep[1]);
1938                                 __m128i substepm = _mm_slli_epi32(_mm_setr_epi32(substep[0], substep[1], substep[0], substep[1]), 1);
1939                                 __m128i scalem = _mm_set1_epi32((tciwidth<<18)+4);
1940                                 for (; x + 1 <= endsub; x += 2, subtcm = _mm_add_epi32(subtcm, substepm))
1941                                 {
1942                                         __m128i tcim = _mm_shufflehi_epi16(_mm_shufflelo_epi16(subtcm, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(3, 1, 3, 1));
1943                                         tcim = _mm_madd_epi16(tcim, scalem);
1944                                         outi[x] = *(const int *)&pixelbase[_mm_cvtsi128_si32(tcim)];
1945                                         outi[x+1] = *(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tcim, _MM_SHUFFLE(1, 1, 1, 1)))];
1946                                 }
1947                                 if (x <= endsub)
1948                                 {
1949                                         __m128i tcim = _mm_shufflelo_epi16(subtcm, _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 if (flags & DPSOFTRAST_TEXTURE_FLAG_CLAMPTOEDGE)
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 minm = _mm_slli_epi32(_mm_setr_epi32(tcimin[0], tcimin[1], tcimin[0], tcimin[1]), 16);
1960                                 __m128i maxm = _mm_slli_epi32(_mm_setr_epi32(tcimax[0], tcimax[1], tcimax[0], tcimax[1]), 16);
1961                                 __m128i scalem = _mm_set1_epi32((tciwidth<<18)+4);
1962                                 for (; x + 1 <= endsub; x += 2, subtcm = _mm_add_epi32(subtcm, substepm))
1963                                 {
1964                                         __m128i tcim = _mm_min_epi16(_mm_max_epi16(subtcm, minm), maxm);
1965                                         tcim = _mm_shufflehi_epi16(_mm_shufflelo_epi16(tcim, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(3, 1, 3, 1));
1966                                         tcim = _mm_madd_epi16(tcim, scalem);
1967                                         outi[x] = *(const int *)&pixelbase[_mm_cvtsi128_si32(tcim)];
1968                                         outi[x+1] = *(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tcim, _MM_SHUFFLE(1, 1, 1, 1)))];
1969                                 }
1970                                 if (x <= endsub)
1971                                 {
1972                                         __m128i tcim = _mm_min_epi16(_mm_max_epi16(subtcm, minm), maxm);
1973                                         tcim = _mm_shufflelo_epi16(tcim, _MM_SHUFFLE(3, 1, 3, 1));
1974                                         tcim = _mm_madd_epi16(tcim, scalem);
1975                                         outi[x] = *(const int *)&pixelbase[_mm_cvtsi128_si32(tcim)];
1976                                         x++;
1977                                 }
1978                         }
1979                         else
1980                         {
1981                                 __m128i subtcm = _mm_setr_epi32(subtc[0], subtc[1], subtc[0] + substep[0], subtc[1] + substep[1]);
1982                                 __m128i substepm = _mm_slli_epi32(_mm_setr_epi32(substep[0], substep[1], substep[0], substep[1]), 1);
1983                                 __m128i wrapm = _mm_slli_epi32(_mm_setr_epi32(tciwrapmask[0], tciwrapmask[1], tciwrapmask[0], tciwrapmask[1]), 16);
1984                                 __m128i scalem = _mm_set1_epi32((tciwidth<<18)+4);
1985                                 for (; x + 1 <= endsub; x += 2, subtcm = _mm_add_epi32(subtcm, substepm))
1986                                 {
1987                                         __m128i tcim = _mm_and_si128(subtcm, wrapm);
1988                                         tcim = _mm_shufflehi_epi16(_mm_shufflelo_epi16(tcim, _MM_SHUFFLE(3, 1, 3, 1)), _MM_SHUFFLE(3, 1, 3, 1));
1989                                         tcim = _mm_madd_epi16(tcim, scalem);
1990                                         outi[x] = *(const int *)&pixelbase[_mm_cvtsi128_si32(tcim)];
1991                                         outi[x+1] = *(const int *)&pixelbase[_mm_cvtsi128_si32(_mm_shuffle_epi32(tcim, _MM_SHUFFLE(1, 1, 1, 1)))];
1992                                 }
1993                                 if (x <= endsub)
1994                                 {
1995                                         __m128i tcim = _mm_and_si128(subtcm, wrapm);
1996                                         tcim = _mm_shufflelo_epi16(tcim, _MM_SHUFFLE(3, 1, 3, 1));
1997                                         tcim = _mm_madd_epi16(tcim, scalem);
1998                                         outi[x] = *(const int *)&pixelbase[_mm_cvtsi128_si32(tcim)];
1999                                         x++;
2000                                 }
2001                         }
2002                 }
2003         }
2004 #endif
2005 }
2006
2007 void DPSOFTRAST_Draw_Span_TextureCubeVaryingBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char * RESTRICT out4ub, int texunitindex, int arrayindex, const float * RESTRICT zf)
2008 {
2009         // TODO: IMPLEMENT
2010         memset(out4ub, 255, span->length*4);
2011 }
2012
2013 float DPSOFTRAST_SampleShadowmap(const float *vector)
2014 {
2015         // TODO: IMPLEMENT
2016         return 1.0f;
2017 }
2018
2019 void DPSOFTRAST_Draw_Span_MultiplyVarying(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *in4f, int arrayindex, const float *zf)
2020 {
2021         int x;
2022         int startx = span->startx;
2023         int endx = span->endx;
2024         float c[4];
2025         float data[4];
2026         float slope[4];
2027         float z;
2028         data[0] = span->data[0][arrayindex][0];
2029         data[1] = span->data[0][arrayindex][1];
2030         data[2] = span->data[0][arrayindex][2];
2031         data[3] = span->data[0][arrayindex][3];
2032         slope[0] = span->data[1][arrayindex][0];
2033         slope[1] = span->data[1][arrayindex][1];
2034         slope[2] = span->data[1][arrayindex][2];
2035         slope[3] = span->data[1][arrayindex][3];
2036         for (x = startx;x < endx;x++)
2037         {
2038                 z = zf[x];
2039                 c[0] = (data[0] + slope[0]*x) * z;
2040                 c[1] = (data[1] + slope[1]*x) * z;
2041                 c[2] = (data[2] + slope[2]*x) * z;
2042                 c[3] = (data[3] + slope[3]*x) * z;
2043                 out4f[x*4+0] = in4f[x*4+0] * c[0];
2044                 out4f[x*4+1] = in4f[x*4+1] * c[1];
2045                 out4f[x*4+2] = in4f[x*4+2] * c[2];
2046                 out4f[x*4+3] = in4f[x*4+3] * c[3];
2047         }
2048 }
2049
2050 void DPSOFTRAST_Draw_Span_Varying(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, int arrayindex, const float *zf)
2051 {
2052         int x;
2053         int startx = span->startx;
2054         int endx = span->endx;
2055         float c[4];
2056         float data[4];
2057         float slope[4];
2058         float z;
2059         data[0] = span->data[0][arrayindex][0];
2060         data[1] = span->data[0][arrayindex][1];
2061         data[2] = span->data[0][arrayindex][2];
2062         data[3] = span->data[0][arrayindex][3];
2063         slope[0] = span->data[1][arrayindex][0];
2064         slope[1] = span->data[1][arrayindex][1];
2065         slope[2] = span->data[1][arrayindex][2];
2066         slope[3] = span->data[1][arrayindex][3];
2067         for (x = startx;x < endx;x++)
2068         {
2069                 z = zf[x];
2070                 c[0] = (data[0] + slope[0]*x) * z;
2071                 c[1] = (data[1] + slope[1]*x) * z;
2072                 c[2] = (data[2] + slope[2]*x) * z;
2073                 c[3] = (data[3] + slope[3]*x) * z;
2074                 out4f[x*4+0] = c[0];
2075                 out4f[x*4+1] = c[1];
2076                 out4f[x*4+2] = c[2];
2077                 out4f[x*4+3] = c[3];
2078         }
2079 }
2080
2081 void DPSOFTRAST_Draw_Span_AddBloom(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *ina4f, const float *inb4f, const float *subcolor)
2082 {
2083         int x, startx = span->startx, endx = span->endx;
2084         float c[4], localcolor[4];
2085         localcolor[0] = subcolor[0];
2086         localcolor[1] = subcolor[1];
2087         localcolor[2] = subcolor[2];
2088         localcolor[3] = subcolor[3];
2089         for (x = startx;x < endx;x++)
2090         {
2091                 c[0] = inb4f[x*4+0] - localcolor[0];if (c[0] < 0.0f) c[0] = 0.0f;
2092                 c[1] = inb4f[x*4+1] - localcolor[1];if (c[1] < 0.0f) c[1] = 0.0f;
2093                 c[2] = inb4f[x*4+2] - localcolor[2];if (c[2] < 0.0f) c[2] = 0.0f;
2094                 c[3] = inb4f[x*4+3] - localcolor[3];if (c[3] < 0.0f) c[3] = 0.0f;
2095                 out4f[x*4+0] = ina4f[x*4+0] + c[0];
2096                 out4f[x*4+1] = ina4f[x*4+1] + c[1];
2097                 out4f[x*4+2] = ina4f[x*4+2] + c[2];
2098                 out4f[x*4+3] = ina4f[x*4+3] + c[3];
2099         }
2100 }
2101
2102 void DPSOFTRAST_Draw_Span_MultiplyBuffers(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         for (x = startx;x < endx;x++)
2106         {
2107                 out4f[x*4+0] = ina4f[x*4+0] * inb4f[x*4+0];
2108                 out4f[x*4+1] = ina4f[x*4+1] * inb4f[x*4+1];
2109                 out4f[x*4+2] = ina4f[x*4+2] * inb4f[x*4+2];
2110                 out4f[x*4+3] = ina4f[x*4+3] * inb4f[x*4+3];
2111         }
2112 }
2113
2114 void DPSOFTRAST_Draw_Span_AddBuffers(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *ina4f, const float *inb4f)
2115 {
2116         int x, startx = span->startx, endx = span->endx;
2117         for (x = startx;x < endx;x++)
2118         {
2119                 out4f[x*4+0] = ina4f[x*4+0] + inb4f[x*4+0];
2120                 out4f[x*4+1] = ina4f[x*4+1] + inb4f[x*4+1];
2121                 out4f[x*4+2] = ina4f[x*4+2] + inb4f[x*4+2];
2122                 out4f[x*4+3] = ina4f[x*4+3] + inb4f[x*4+3];
2123         }
2124 }
2125
2126 void DPSOFTRAST_Draw_Span_MixBuffers(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *ina4f, const float *inb4f)
2127 {
2128         int x, startx = span->startx, endx = span->endx;
2129         float a, b;
2130         for (x = startx;x < endx;x++)
2131         {
2132                 a = 1.0f - inb4f[x*4+3];
2133                 b = inb4f[x*4+3];
2134                 out4f[x*4+0] = ina4f[x*4+0] * a + inb4f[x*4+0] * b;
2135                 out4f[x*4+1] = ina4f[x*4+1] * a + inb4f[x*4+1] * b;
2136                 out4f[x*4+2] = ina4f[x*4+2] * a + inb4f[x*4+2] * b;
2137                 out4f[x*4+3] = ina4f[x*4+3] * a + inb4f[x*4+3] * b;
2138         }
2139 }
2140
2141 void DPSOFTRAST_Draw_Span_MixUniformColor(const DPSOFTRAST_State_Draw_Span * RESTRICT span, float *out4f, const float *in4f, const float *color)
2142 {
2143         int x, startx = span->startx, endx = span->endx;
2144         float localcolor[4], ilerp, lerp;
2145         localcolor[0] = color[0];
2146         localcolor[1] = color[1];
2147         localcolor[2] = color[2];
2148         localcolor[3] = color[3];
2149         ilerp = 1.0f - localcolor[3];
2150         lerp = localcolor[3];
2151         for (x = startx;x < endx;x++)
2152         {
2153                 out4f[x*4+0] = in4f[x*4+0] * ilerp + localcolor[0] * lerp;
2154                 out4f[x*4+1] = in4f[x*4+1] * ilerp + localcolor[1] * lerp;
2155                 out4f[x*4+2] = in4f[x*4+2] * ilerp + localcolor[2] * lerp;
2156                 out4f[x*4+3] = in4f[x*4+3] * ilerp + localcolor[3] * lerp;
2157         }
2158 }
2159
2160
2161
2162 void DPSOFTRAST_Draw_Span_MultiplyVaryingBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *in4ub, int arrayindex, const float *zf)
2163 {
2164         int x;
2165         int startx = span->startx;
2166         int endx = span->endx;
2167         float data[4];
2168         float slope[4];
2169         float z;
2170         data[2] = span->data[0][arrayindex][0];
2171         data[1] = span->data[0][arrayindex][1];
2172         data[0] = span->data[0][arrayindex][2];
2173         data[3] = span->data[0][arrayindex][3];
2174         slope[2] = span->data[1][arrayindex][0];
2175         slope[1] = span->data[1][arrayindex][1];
2176         slope[0] = span->data[1][arrayindex][2];
2177         slope[3] = span->data[1][arrayindex][3];
2178         for (x = startx;x < endx;x++)
2179         {
2180                 z = zf[x];
2181                 out4ub[x*4+0] = (int)(in4ub[x*4+0] * (data[0] + slope[0]*x) * z);
2182                 out4ub[x*4+1] = (int)(in4ub[x*4+1] * (data[1] + slope[1]*x) * z);
2183                 out4ub[x*4+2] = (int)(in4ub[x*4+2] * (data[2] + slope[2]*x) * z);
2184                 out4ub[x*4+3] = (int)(in4ub[x*4+3] * (data[3] + slope[3]*x) * z);
2185         }
2186 }
2187
2188 void DPSOFTRAST_Draw_Span_VaryingBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, int arrayindex, const float *zf)
2189 {
2190         int x;
2191         int startx = span->startx;
2192         int endx = span->endx;
2193         float data[4];
2194         float slope[4];
2195         float z;
2196         data[2] = span->data[0][arrayindex][0]*255.0f;
2197         data[1] = span->data[0][arrayindex][1]*255.0f;
2198         data[0] = span->data[0][arrayindex][2]*255.0f;
2199         data[3] = span->data[0][arrayindex][3]*255.0f;
2200         slope[2] = span->data[1][arrayindex][0]*255.0f;
2201         slope[1] = span->data[1][arrayindex][1]*255.0f;
2202         slope[0] = span->data[1][arrayindex][2]*255.0f;
2203         slope[3] = span->data[1][arrayindex][3]*255.0f;
2204         for (x = startx;x < endx;x++)
2205         {
2206                 z = zf[x];
2207                 out4ub[x*4+0] = (int)((data[0] + slope[0]*x) * z);
2208                 out4ub[x*4+1] = (int)((data[1] + slope[1]*x) * z);
2209                 out4ub[x*4+2] = (int)((data[2] + slope[2]*x) * z);
2210                 out4ub[x*4+3] = (int)((data[3] + slope[3]*x) * z);
2211         }
2212 }
2213
2214 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)
2215 {
2216         int x, startx = span->startx, endx = span->endx;
2217         int c[4], localcolor[4];
2218         localcolor[2] = (int)(subcolor[0] * 255.0f);
2219         localcolor[1] = (int)(subcolor[1] * 255.0f);
2220         localcolor[0] = (int)(subcolor[2] * 255.0f);
2221         localcolor[3] = (int)(subcolor[3] * 255.0f);
2222         for (x = startx;x < endx;x++)
2223         {
2224                 c[0] = inb4ub[x*4+0] - localcolor[0];if (c[0] < 0) c[0] = 0;
2225                 c[1] = inb4ub[x*4+1] - localcolor[1];if (c[1] < 0) c[1] = 0;
2226                 c[2] = inb4ub[x*4+2] - localcolor[2];if (c[2] < 0) c[2] = 0;
2227                 c[3] = inb4ub[x*4+3] - localcolor[3];if (c[3] < 0) c[3] = 0;
2228                 c[0] += ina4ub[x*4+0];if (c[0] > 255) c[0] = 255;
2229                 c[1] += ina4ub[x*4+1];if (c[1] > 255) c[1] = 255;
2230                 c[2] += ina4ub[x*4+2];if (c[2] > 255) c[2] = 255;
2231                 c[3] += ina4ub[x*4+3];if (c[3] > 255) c[3] = 255;
2232                 out4ub[x*4+0] = c[0];
2233                 out4ub[x*4+1] = c[1];
2234                 out4ub[x*4+2] = c[2];
2235                 out4ub[x*4+3] = c[3];
2236         }
2237 }
2238
2239 void DPSOFTRAST_Draw_Span_MultiplyBuffersBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *ina4ub, const unsigned char *inb4ub)
2240 {
2241         int x, startx = span->startx, endx = span->endx;
2242         for (x = startx;x < endx;x++)
2243         {
2244                 out4ub[x*4+0] = (ina4ub[x*4+0] * inb4ub[x*4+0])>>8;
2245                 out4ub[x*4+1] = (ina4ub[x*4+1] * inb4ub[x*4+1])>>8;
2246                 out4ub[x*4+2] = (ina4ub[x*4+2] * inb4ub[x*4+2])>>8;
2247                 out4ub[x*4+3] = (ina4ub[x*4+3] * inb4ub[x*4+3])>>8;
2248         }
2249 }
2250
2251 void DPSOFTRAST_Draw_Span_AddBuffersBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *ina4ub, const unsigned char *inb4ub)
2252 {
2253         int x, startx = span->startx, endx = span->endx;
2254         int d[4];
2255         for (x = startx;x < endx;x++)
2256         {
2257                 d[0] = ina4ub[x*4+0] + inb4ub[x*4+0];if (d[0] > 255) d[0] = 255;
2258                 d[1] = ina4ub[x*4+1] + inb4ub[x*4+1];if (d[1] > 255) d[1] = 255;
2259                 d[2] = ina4ub[x*4+2] + inb4ub[x*4+2];if (d[2] > 255) d[2] = 255;
2260                 d[3] = ina4ub[x*4+3] + inb4ub[x*4+3];if (d[3] > 255) d[3] = 255;
2261                 out4ub[x*4+0] = d[0];
2262                 out4ub[x*4+1] = d[1];
2263                 out4ub[x*4+2] = d[2];
2264                 out4ub[x*4+3] = d[3];
2265         }
2266 }
2267
2268 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)
2269 {
2270         int x, startx = span->startx, endx = span->endx;
2271         int d[4];
2272         int b[4];
2273         b[0] = (int)(inbtintbgra[0] * 256.0f);
2274         b[1] = (int)(inbtintbgra[1] * 256.0f);
2275         b[2] = (int)(inbtintbgra[2] * 256.0f);
2276         b[3] = (int)(inbtintbgra[3] * 256.0f);
2277         for (x = startx;x < endx;x++)
2278         {
2279                 d[0] = ina4ub[x*4+0] + ((inb4ub[x*4+0]*b[0])>>8);if (d[0] > 255) d[0] = 255;
2280                 d[1] = ina4ub[x*4+1] + ((inb4ub[x*4+1]*b[1])>>8);if (d[1] > 255) d[1] = 255;
2281                 d[2] = ina4ub[x*4+2] + ((inb4ub[x*4+2]*b[2])>>8);if (d[2] > 255) d[2] = 255;
2282                 d[3] = ina4ub[x*4+3] + ((inb4ub[x*4+3]*b[3])>>8);if (d[3] > 255) d[3] = 255;
2283                 out4ub[x*4+0] = d[0];
2284                 out4ub[x*4+1] = d[1];
2285                 out4ub[x*4+2] = d[2];
2286                 out4ub[x*4+3] = d[3];
2287         }
2288 }
2289
2290 void DPSOFTRAST_Draw_Span_MixBuffersBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *ina4ub, const unsigned char *inb4ub)
2291 {
2292         int x, startx = span->startx, endx = span->endx;
2293         int a, b;
2294         for (x = startx;x < endx;x++)
2295         {
2296                 a = 256 - inb4ub[x*4+3];
2297                 b = inb4ub[x*4+3];
2298                 out4ub[x*4+0] = (ina4ub[x*4+0] * a + inb4ub[x*4+0] * b)>>8;
2299                 out4ub[x*4+1] = (ina4ub[x*4+1] * a + inb4ub[x*4+1] * b)>>8;
2300                 out4ub[x*4+2] = (ina4ub[x*4+2] * a + inb4ub[x*4+2] * b)>>8;
2301                 out4ub[x*4+3] = (ina4ub[x*4+3] * a + inb4ub[x*4+3] * b)>>8;
2302         }
2303 }
2304
2305 void DPSOFTRAST_Draw_Span_MixUniformColorBGRA8(const DPSOFTRAST_State_Draw_Span * RESTRICT span, unsigned char *out4ub, const unsigned char *in4ub, const float *color)
2306 {
2307         int x, startx = span->startx, endx = span->endx;
2308         int localcolor[4], ilerp, lerp;
2309         localcolor[2] = (int)(color[0]*255.0f);
2310         localcolor[1] = (int)(color[1]*255.0f);
2311         localcolor[0] = (int)(color[2]*255.0f);
2312         localcolor[3] = (int)(color[3]*255.0f);
2313         ilerp = 256 - localcolor[3];
2314         lerp = localcolor[3];
2315         for (x = startx;x < endx;x++)
2316         {
2317                 out4ub[x*4+0] = (in4ub[x*4+0] * ilerp + localcolor[0] * lerp)>>8;
2318                 out4ub[x*4+1] = (in4ub[x*4+1] * ilerp + localcolor[1] * lerp)>>8;
2319                 out4ub[x*4+2] = (in4ub[x*4+2] * ilerp + localcolor[2] * lerp)>>8;
2320                 out4ub[x*4+3] = (in4ub[x*4+3] * ilerp + localcolor[3] * lerp)>>8;
2321         }
2322 }
2323
2324
2325
2326 void DPSOFTRAST_VertexShader_Generic(void)
2327 {
2328         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);
2329         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_COLOR], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_COLOR], dpsoftrast.draw.numvertices);
2330         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.numvertices);
2331         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SPECULAR)
2332                 DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1], dpsoftrast.draw.numvertices);
2333 }
2334
2335 void DPSOFTRAST_PixelShader_Generic(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2336 {
2337         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2338         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2339         unsigned char buffer_texture_lightmapbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2340         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2341         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2342         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_DIFFUSE)
2343         {
2344                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_FIRST, 2, buffer_z);
2345                 DPSOFTRAST_Draw_Span_MultiplyVaryingBGRA8(span, buffer_FragColorbgra8, buffer_texture_colorbgra8, 1, buffer_z);
2346                 if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SPECULAR)
2347                 {
2348                         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_lightmapbgra8, GL20TU_SECOND, 2, buffer_z);
2349                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
2350                         {
2351                                 // multiply
2352                                 DPSOFTRAST_Draw_Span_MultiplyBuffersBGRA8(span, buffer_FragColorbgra8, buffer_FragColorbgra8, buffer_texture_lightmapbgra8);
2353                         }
2354                         else if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
2355                         {
2356                                 // add
2357                                 DPSOFTRAST_Draw_Span_AddBuffersBGRA8(span, buffer_FragColorbgra8, buffer_FragColorbgra8, buffer_texture_lightmapbgra8);
2358                         }
2359                         else if (dpsoftrast.shader_permutation & SHADERPERMUTATION_VERTEXTEXTUREBLEND)
2360                         {
2361                                 // alphablend
2362                                 DPSOFTRAST_Draw_Span_MixBuffersBGRA8(span, buffer_FragColorbgra8, buffer_FragColorbgra8, buffer_texture_lightmapbgra8);
2363                         }
2364                 }
2365         }
2366         else
2367                 DPSOFTRAST_Draw_Span_VaryingBGRA8(span, buffer_FragColorbgra8, 1, buffer_z);
2368         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2369 }
2370
2371
2372
2373 void DPSOFTRAST_VertexShader_PostProcess(void)
2374 {
2375         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);
2376         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD0], dpsoftrast.draw.numvertices);
2377         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1], dpsoftrast.draw.numvertices);
2378 }
2379
2380 void DPSOFTRAST_PixelShader_PostProcess(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2381 {
2382         // TODO: optimize!!  at the very least there is no reason to use texture sampling on the frame texture
2383         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2384         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2385         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2386         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2387         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_FragColorbgra8, GL20TU_FIRST, 2, buffer_z);
2388         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_BLOOM)
2389         {
2390                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_SECOND, 3, buffer_z);
2391                 DPSOFTRAST_Draw_Span_AddBloomBGRA8(span, buffer_FragColorbgra8, buffer_FragColorbgra8, buffer_texture_colorbgra8, dpsoftrast.uniform4f + DPSOFTRAST_UNIFORM_BloomColorSubtract * 4);
2392         }
2393         DPSOFTRAST_Draw_Span_MixUniformColorBGRA8(span, buffer_FragColorbgra8, buffer_FragColorbgra8, dpsoftrast.uniform4f + DPSOFTRAST_UNIFORM_ViewTintColor * 4);
2394         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SATURATION)
2395         {
2396                 // TODO: implement saturation
2397         }
2398         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GAMMARAMPS)
2399         {
2400                 // TODO: implement gammaramps
2401         }
2402         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2403 }
2404
2405
2406
2407 void DPSOFTRAST_VertexShader_Depth_Or_Shadow(void)
2408 {
2409         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);
2410 }
2411
2412 void DPSOFTRAST_PixelShader_Depth_Or_Shadow(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2413 {
2414         // this is never called (because colormask is off when this shader is used)
2415         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2416         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2417         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2418         memset(buffer_FragColorbgra8, 0, span->length*4);
2419         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2420 }
2421
2422
2423
2424 void DPSOFTRAST_VertexShader_FlatColor(void)
2425 {
2426         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);
2427         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);
2428 }
2429
2430 void DPSOFTRAST_PixelShader_FlatColor(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2431 {
2432         int x, startx = span->startx, endx = span->endx;
2433         int Color_Ambienti[4];
2434         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2435         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2436         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2437         Color_Ambienti[2] = (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+0]*256.0f);
2438         Color_Ambienti[1] = (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+1]*256.0f);
2439         Color_Ambienti[0] = (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+2]*256.0f);
2440         Color_Ambienti[3] = (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Alpha*4+0]        *256.0f);
2441         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2442         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_COLOR, 2, buffer_z);
2443         for (x = startx;x < endx;x++)
2444         {
2445                 buffer_FragColorbgra8[x*4+0] = (buffer_texture_colorbgra8[x*4+0] * Color_Ambienti[0])>>8;
2446                 buffer_FragColorbgra8[x*4+1] = (buffer_texture_colorbgra8[x*4+1] * Color_Ambienti[1])>>8;
2447                 buffer_FragColorbgra8[x*4+2] = (buffer_texture_colorbgra8[x*4+2] * Color_Ambienti[2])>>8;
2448                 buffer_FragColorbgra8[x*4+3] = (buffer_texture_colorbgra8[x*4+3] * Color_Ambienti[3])>>8;
2449         }
2450         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2451 }
2452
2453
2454
2455 void DPSOFTRAST_VertexShader_VertexColor(void)
2456 {
2457         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);
2458         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_COLOR], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_COLOR], dpsoftrast.draw.numvertices);
2459         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);
2460 }
2461
2462 void DPSOFTRAST_PixelShader_VertexColor(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2463 {
2464         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2465         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2466         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2467         int x, startx = span->startx, endx = span->endx;
2468         float Color_Ambient[4], Color_Diffuse[4];
2469         float data[4];
2470         float slope[4];
2471         float z;
2472         int arrayindex = DPSOFTRAST_ARRAY_COLOR;
2473         data[2] = span->data[0][arrayindex][0];
2474         data[1] = span->data[0][arrayindex][1];
2475         data[0] = span->data[0][arrayindex][2];
2476         data[3] = span->data[0][arrayindex][3];
2477         slope[2] = span->data[1][arrayindex][0];
2478         slope[1] = span->data[1][arrayindex][1];
2479         slope[0] = span->data[1][arrayindex][2];
2480         slope[3] = span->data[1][arrayindex][3];
2481         Color_Ambient[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+0];
2482         Color_Ambient[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+1];
2483         Color_Ambient[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+2];
2484         Color_Ambient[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Alpha*4+0];
2485         Color_Diffuse[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+0];
2486         Color_Diffuse[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+1];
2487         Color_Diffuse[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+2];
2488         Color_Diffuse[3] = 0.0f;
2489         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2490         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_COLOR, 2, buffer_z);
2491         for (x = startx;x < endx;x++)
2492         {
2493                 z = buffer_z[x];
2494                 buffer_FragColorbgra8[x*4+0] = (int)(buffer_texture_colorbgra8[x*4+0] * (Color_Ambient[0] + ((data[0] + slope[0]*x) * z) * Color_Diffuse[0]));
2495                 buffer_FragColorbgra8[x*4+1] = (int)(buffer_texture_colorbgra8[x*4+1] * (Color_Ambient[1] + ((data[1] + slope[1]*x) * z) * Color_Diffuse[1]));
2496                 buffer_FragColorbgra8[x*4+2] = (int)(buffer_texture_colorbgra8[x*4+2] * (Color_Ambient[2] + ((data[2] + slope[2]*x) * z) * Color_Diffuse[2]));
2497                 buffer_FragColorbgra8[x*4+3] = (int)(buffer_texture_colorbgra8[x*4+3] * (Color_Ambient[3] + ((data[3] + slope[3]*x) * z) * Color_Diffuse[3]));
2498         }
2499         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2500 }
2501
2502
2503
2504 void DPSOFTRAST_VertexShader_Lightmap(void)
2505 {
2506         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);
2507         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);
2508         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD4], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD4], dpsoftrast.draw.numvertices);
2509 }
2510
2511 void DPSOFTRAST_PixelShader_Lightmap(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2512 {
2513 #ifdef SSE2_PRESENT
2514         unsigned char * RESTRICT pixelmask = span->pixelmask;
2515         unsigned char * RESTRICT pixel = (unsigned char *)dpsoftrast.fb_colorpixels[0] + span->start * 4;
2516         int x, startx = span->startx, endx = span->endx;
2517         __m128i Color_Ambientm, Color_Diffusem, Color_Glowm, Color_AmbientGlowm;
2518         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2519         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2520         unsigned char buffer_texture_lightmapbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2521         unsigned char buffer_texture_glowbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2522         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2523         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2524         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_COLOR, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2525         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_lightmapbgra8, GL20TU_LIGHTMAP, DPSOFTRAST_ARRAY_TEXCOORD4, buffer_z);
2526         if (dpsoftrast.user.alphatest || dpsoftrast.fb_blendmode != DPSOFTRAST_BLENDMODE_OPAQUE)
2527                 pixel = buffer_FragColorbgra8;
2528         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));
2529         Color_Ambientm = _mm_and_si128(Color_Ambientm, _mm_setr_epi32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0));
2530         Color_Ambientm = _mm_or_si128(Color_Ambientm, _mm_setr_epi32(0, 0, 0, (int)(dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Alpha*4+0]*255.0f)));
2531         Color_Ambientm = _mm_packs_epi32(Color_Ambientm, Color_Ambientm);
2532         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));
2533         Color_Diffusem = _mm_and_si128(Color_Diffusem, _mm_setr_epi32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0));
2534         Color_Diffusem = _mm_packs_epi32(Color_Diffusem, Color_Diffusem);
2535         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GLOW)
2536         {
2537                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_glowbgra8, GL20TU_GLOW, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2538                 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));
2539                 Color_Glowm = _mm_and_si128(Color_Glowm, _mm_setr_epi32(0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0));
2540                 Color_Glowm = _mm_packs_epi32(Color_Glowm, Color_Glowm);
2541                 Color_AmbientGlowm = _mm_unpacklo_epi64(Color_Ambientm, Color_Glowm);
2542                 for (x = startx;x < endx;x++)
2543                 {
2544                         __m128i color, lightmap, glow, pix;
2545                         if (x + 4 <= endx && *(const unsigned int *)&pixelmask[x] == 0x01010101)
2546                         {
2547                                 __m128i pix2;
2548                                 color = _mm_loadu_si128((const __m128i *)&buffer_texture_colorbgra8[x*4]);
2549                                 lightmap = _mm_loadu_si128((const __m128i *)&buffer_texture_lightmapbgra8[x*4]);
2550                                 glow = _mm_loadu_si128((const __m128i *)&buffer_texture_glowbgra8[x*4]);
2551                                 pix = _mm_add_epi16(_mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, _mm_unpacklo_epi8(_mm_setzero_si128(), lightmap)), Color_Ambientm),
2552                                                                                                         _mm_unpacklo_epi8(_mm_setzero_si128(), color)),
2553                                                                         _mm_mulhi_epu16(Color_Glowm, _mm_unpacklo_epi8(_mm_setzero_si128(), glow)));
2554                                 pix2 = _mm_add_epi16(_mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, _mm_unpackhi_epi8(_mm_setzero_si128(), lightmap)), Color_Ambientm),
2555                                                                                                         _mm_unpackhi_epi8(_mm_setzero_si128(), color)),
2556                                                                         _mm_mulhi_epu16(Color_Glowm, _mm_unpackhi_epi8(_mm_setzero_si128(), glow)));
2557                                 _mm_storeu_si128((__m128i *)&pixel[x*4], _mm_packus_epi16(pix, pix2));
2558                                 x += 3;
2559                                 continue;
2560                         }
2561                         if(!pixelmask[x])
2562                                 continue;
2563                         color = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_colorbgra8[x*4]));
2564                         lightmap = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_lightmapbgra8[x*4]));
2565                         glow = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_glowbgra8[x*4]));
2566                         pix = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, lightmap), Color_AmbientGlowm), _mm_unpacklo_epi64(color, glow));
2567                         pix = _mm_add_epi16(pix, _mm_shuffle_epi32(pix, _MM_SHUFFLE(3, 2, 3, 2)));
2568                         *(int *)&pixel[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix, pix));
2569                 }
2570         }
2571         else
2572         {
2573                 for (x = startx;x < endx;x++)
2574                 {
2575                         __m128i color, lightmap, pix;
2576                         if (x + 4 <= endx && *(const unsigned int *)&pixelmask[x] == 0x01010101)
2577                         {
2578                                 __m128i pix2;
2579                                 color = _mm_loadu_si128((const __m128i *)&buffer_texture_colorbgra8[x*4]);
2580                                 lightmap = _mm_loadu_si128((const __m128i *)&buffer_texture_lightmapbgra8[x*4]);
2581                                 pix = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, _mm_unpacklo_epi8(_mm_setzero_si128(), lightmap)), Color_Ambientm),
2582                                                                           _mm_unpacklo_epi8(_mm_setzero_si128(), color));
2583                                 pix2 = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(Color_Diffusem, _mm_unpackhi_epi8(_mm_setzero_si128(), lightmap)), Color_Ambientm),
2584                                                                            _mm_unpackhi_epi8(_mm_setzero_si128(), color));
2585                                 _mm_storeu_si128((__m128i *)&pixel[x*4], _mm_packus_epi16(pix, pix2));
2586                                 x += 3;
2587                                 continue;
2588                         }
2589                         if(!pixelmask[x])
2590                                 continue;
2591                         color = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_colorbgra8[x*4]));
2592                         lightmap = _mm_unpacklo_epi8(_mm_setzero_si128(), _mm_cvtsi32_si128(*(const int *)&buffer_texture_lightmapbgra8[x*4]));
2593                         pix = _mm_mulhi_epu16(_mm_add_epi16(_mm_mulhi_epu16(lightmap, Color_Diffusem), Color_Ambientm), color);
2594                         *(int *)&pixel[x*4] = _mm_cvtsi128_si32(_mm_packus_epi16(pix, pix));
2595                 }
2596         }
2597         if(pixel == buffer_FragColorbgra8)
2598                 DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2599 #endif
2600 }
2601
2602
2603
2604 void DPSOFTRAST_VertexShader_FakeLight(void)
2605 {
2606         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);
2607 }
2608
2609 void DPSOFTRAST_PixelShader_FakeLight(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2610 {
2611         // TODO: IMPLEMENT
2612         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2613         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2614         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2615         memset(buffer_FragColorbgra8, 0, span->length*4);
2616         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2617 }
2618
2619
2620
2621 void DPSOFTRAST_VertexShader_LightDirectionMap_ModelSpace(void)
2622 {
2623         DPSOFTRAST_VertexShader_Lightmap();
2624 }
2625
2626 void DPSOFTRAST_PixelShader_LightDirectionMap_ModelSpace(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2627 {
2628         DPSOFTRAST_PixelShader_Lightmap(span);
2629         // TODO: IMPLEMENT
2630 }
2631
2632
2633
2634 void DPSOFTRAST_VertexShader_LightDirectionMap_TangentSpace(void)
2635 {
2636         DPSOFTRAST_VertexShader_Lightmap();
2637 }
2638
2639 void DPSOFTRAST_PixelShader_LightDirectionMap_TangentSpace(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2640 {
2641         DPSOFTRAST_PixelShader_Lightmap(span);
2642         // TODO: IMPLEMENT
2643 }
2644
2645
2646
2647 void DPSOFTRAST_VertexShader_LightDirection(void)
2648 {
2649         int i;
2650         int numvertices = dpsoftrast.draw.numvertices;
2651         float LightDir[4];
2652         float LightVector[4];
2653         float EyePosition[4];
2654         float EyeVectorModelSpace[4];
2655         float EyeVector[4];
2656         float position[4];
2657         float svector[4];
2658         float tvector[4];
2659         float normal[4];
2660         LightDir[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightDir*4+0];
2661         LightDir[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightDir*4+1];
2662         LightDir[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightDir*4+2];
2663         LightDir[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightDir*4+3];
2664         EyePosition[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+0];
2665         EyePosition[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+1];
2666         EyePosition[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+2];
2667         EyePosition[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+3];
2668         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);
2669         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);
2670         for (i = 0;i < numvertices;i++)
2671         {
2672                 position[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+0];
2673                 position[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+1];
2674                 position[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+2];
2675                 svector[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+0];
2676                 svector[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+1];
2677                 svector[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+2];
2678                 tvector[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+0];
2679                 tvector[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+1];
2680                 tvector[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+2];
2681                 normal[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+0];
2682                 normal[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+1];
2683                 normal[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+2];
2684                 LightVector[0] = svector[0] * LightDir[0] + svector[1] * LightDir[1] + svector[2] * LightDir[2];
2685                 LightVector[1] = tvector[0] * LightDir[0] + tvector[1] * LightDir[1] + tvector[2] * LightDir[2];
2686                 LightVector[2] = normal[0] * LightDir[0] + normal[1] * LightDir[1] + normal[2] * LightDir[2];
2687                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+0] = LightVector[0];
2688                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+1] = LightVector[1];
2689                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+2] = LightVector[2];
2690                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+3] = 0.0f;
2691                 EyeVectorModelSpace[0] = EyePosition[0] - position[0];
2692                 EyeVectorModelSpace[1] = EyePosition[1] - position[1];
2693                 EyeVectorModelSpace[2] = EyePosition[2] - position[2];
2694                 EyeVector[0] = svector[0] * EyeVectorModelSpace[0] + svector[1] * EyeVectorModelSpace[1] + svector[2] * EyeVectorModelSpace[2];
2695                 EyeVector[1] = tvector[0] * EyeVectorModelSpace[0] + tvector[1] * EyeVectorModelSpace[1] + tvector[2] * EyeVectorModelSpace[2];
2696                 EyeVector[2] = normal[0]  * EyeVectorModelSpace[0] + normal[1]  * EyeVectorModelSpace[1] + normal[2]  * EyeVectorModelSpace[2];
2697                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+0] = EyeVector[0];
2698                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+1] = EyeVector[1];
2699                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+2] = EyeVector[2];
2700                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+3] = 0.0f;
2701         }
2702 }
2703
2704 #define DPSOFTRAST_Min(a,b) ((a) < (b) ? (a) : (b))
2705 #define DPSOFTRAST_Max(a,b) ((a) > (b) ? (a) : (b))
2706 #define DPSOFTRAST_Vector3Dot(a,b) ((a)[0]*(b)[0]+(a)[1]*(b)[1]+(a)[2]*(b)[2])
2707 #define DPSOFTRAST_Vector3LengthSquared(v) (DPSOFTRAST_Vector3Dot((v),(v)))
2708 #define DPSOFTRAST_Vector3Length(v) (sqrt(DPSOFTRAST_Vector3LengthSquared(v)))
2709 #define DPSOFTRAST_Vector3Normalize(v)\
2710 do\
2711 {\
2712         float len = sqrt(DPSOFTRAST_Vector3Dot(v,v));\
2713         if (len)\
2714         {\
2715                 len = 1.0f / len;\
2716                 v[0] *= len;\
2717                 v[1] *= len;\
2718                 v[2] *= len;\
2719         }\
2720 }\
2721 while(0)
2722
2723 void DPSOFTRAST_PixelShader_LightDirection(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
2724 {
2725         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
2726         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2727         unsigned char buffer_texture_normalbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2728         unsigned char buffer_texture_glossbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2729         unsigned char buffer_texture_glowbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2730         unsigned char buffer_texture_pantsbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2731         unsigned char buffer_texture_shirtbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2732         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
2733         int x, startx = span->startx, endx = span->endx;
2734         float Color_Ambient[4], Color_Diffuse[4], Color_Specular[4], Color_Glow[4], Color_Pants[4], Color_Shirt[4], LightColor[4];
2735         float LightVectordata[4];
2736         float LightVectorslope[4];
2737         float EyeVectordata[4];
2738         float EyeVectorslope[4];
2739         float z;
2740         float diffusetex[4];
2741         float glosstex[4];
2742         float surfacenormal[4];
2743         float lightnormal[4];
2744         float eyenormal[4];
2745         float specularnormal[4];
2746         float diffuse;
2747         float specular;
2748         float SpecularPower;
2749         int d[4];
2750         Color_Glow[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+0];
2751         Color_Glow[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+1];
2752         Color_Glow[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+2];
2753         Color_Glow[3] = 0.0f;
2754         Color_Ambient[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+0];
2755         Color_Ambient[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+1];
2756         Color_Ambient[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+2];
2757         Color_Ambient[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Alpha*4+0];
2758         Color_Pants[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+0];
2759         Color_Pants[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+1];
2760         Color_Pants[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+2];
2761         Color_Pants[3] = 0.0f;
2762         Color_Shirt[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+0];
2763         Color_Shirt[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+1];
2764         Color_Shirt[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+2];
2765         Color_Shirt[3] = 0.0f;
2766         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
2767         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_COLOR, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2768         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
2769         {
2770                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_pantsbgra8, GL20TU_PANTS, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2771                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_shirtbgra8, GL20TU_SHIRT, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2772         }
2773         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GLOW)
2774         {
2775                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_glowbgra8, GL20TU_GLOW, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2776         }
2777         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SPECULAR)
2778         {
2779                 Color_Diffuse[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+0];
2780                 Color_Diffuse[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+1];
2781                 Color_Diffuse[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+2];
2782                 Color_Diffuse[3] = 0.0f;
2783                 LightColor[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+0];
2784                 LightColor[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+1];
2785                 LightColor[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+2];
2786                 LightColor[3] = 0.0f;
2787                 LightVectordata[0]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][0];
2788                 LightVectordata[1]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][1];
2789                 LightVectordata[2]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][2];
2790                 LightVectordata[3]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][3];
2791                 LightVectorslope[0] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][0];
2792                 LightVectorslope[1] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][1];
2793                 LightVectorslope[2] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][2];
2794                 LightVectorslope[3] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][3];
2795                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_normalbgra8, GL20TU_NORMAL, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2796                 Color_Specular[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+0];
2797                 Color_Specular[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+1];
2798                 Color_Specular[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+2];
2799                 Color_Specular[3] = 0.0f;
2800                 SpecularPower = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_SpecularPower*4+0] * (1.0f / 255.0f);
2801                 EyeVectordata[0]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][0];
2802                 EyeVectordata[1]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][1];
2803                 EyeVectordata[2]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][2];
2804                 EyeVectordata[3]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][3];
2805                 EyeVectorslope[0]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][0];
2806                 EyeVectorslope[1]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][1];
2807                 EyeVectorslope[2]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][2];
2808                 EyeVectorslope[3]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][3];
2809                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_glossbgra8, GL20TU_GLOSS, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2810                 for (x = startx;x < endx;x++)
2811                 {
2812                         z = buffer_z[x];
2813                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
2814                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
2815                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
2816                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
2817                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
2818                         {
2819                                 diffusetex[0] += buffer_texture_pantsbgra8[x*4+0] * Color_Pants[0] + buffer_texture_shirtbgra8[x*4+0] * Color_Shirt[0];
2820                                 diffusetex[1] += buffer_texture_pantsbgra8[x*4+1] * Color_Pants[1] + buffer_texture_shirtbgra8[x*4+1] * Color_Shirt[1];
2821                                 diffusetex[2] += buffer_texture_pantsbgra8[x*4+2] * Color_Pants[2] + buffer_texture_shirtbgra8[x*4+2] * Color_Shirt[2];
2822                                 diffusetex[3] += buffer_texture_pantsbgra8[x*4+3] * Color_Pants[3] + buffer_texture_shirtbgra8[x*4+3] * Color_Shirt[3];
2823                         }
2824                         glosstex[0] = buffer_texture_glossbgra8[x*4+0];
2825                         glosstex[1] = buffer_texture_glossbgra8[x*4+1];
2826                         glosstex[2] = buffer_texture_glossbgra8[x*4+2];
2827                         glosstex[3] = buffer_texture_glossbgra8[x*4+3];
2828                         surfacenormal[0] = buffer_texture_normalbgra8[x*4+2] * (1.0f / 128.0f) - 1.0f;
2829                         surfacenormal[1] = buffer_texture_normalbgra8[x*4+1] * (1.0f / 128.0f) - 1.0f;
2830                         surfacenormal[2] = buffer_texture_normalbgra8[x*4+0] * (1.0f / 128.0f) - 1.0f;
2831                         DPSOFTRAST_Vector3Normalize(surfacenormal);
2832
2833                         lightnormal[0] = (LightVectordata[0] + LightVectorslope[0]*x) * z;
2834                         lightnormal[1] = (LightVectordata[1] + LightVectorslope[1]*x) * z;
2835                         lightnormal[2] = (LightVectordata[2] + LightVectorslope[2]*x) * z;
2836                         DPSOFTRAST_Vector3Normalize(lightnormal);
2837
2838                         eyenormal[0] = (EyeVectordata[0] + EyeVectorslope[0]*x) * z;
2839                         eyenormal[1] = (EyeVectordata[1] + EyeVectorslope[1]*x) * z;
2840                         eyenormal[2] = (EyeVectordata[2] + EyeVectorslope[2]*x) * z;
2841                         DPSOFTRAST_Vector3Normalize(eyenormal);
2842
2843                         specularnormal[0] = lightnormal[0] + eyenormal[0];
2844                         specularnormal[1] = lightnormal[1] + eyenormal[1];
2845                         specularnormal[2] = lightnormal[2] + eyenormal[2];
2846                         DPSOFTRAST_Vector3Normalize(specularnormal);
2847
2848                         diffuse = DPSOFTRAST_Vector3Dot(surfacenormal, lightnormal);if (diffuse < 0.0f) diffuse = 0.0f;
2849                         specular = DPSOFTRAST_Vector3Dot(surfacenormal, specularnormal);if (specular < 0.0f) specular = 0.0f;
2850                         specular = pow(specular, SpecularPower * glosstex[3]);
2851                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GLOW)
2852                         {
2853                                 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;
2854                                 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;
2855                                 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;
2856                                 d[3] = (int)(                                                  diffusetex[3] * Color_Ambient[3]);if (d[3] > 255) d[3] = 255;
2857                         }
2858                         else
2859                         {
2860                                 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;
2861                                 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;
2862                                 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;
2863                                 d[3] = (int)(                                                  diffusetex[3] * Color_Ambient[3]);if (d[3] > 255) d[3] = 255;
2864                         }
2865                         buffer_FragColorbgra8[x*4+0] = d[0];
2866                         buffer_FragColorbgra8[x*4+1] = d[1];
2867                         buffer_FragColorbgra8[x*4+2] = d[2];
2868                         buffer_FragColorbgra8[x*4+3] = d[3];
2869                 }
2870         }
2871         else if (dpsoftrast.shader_permutation & SHADERPERMUTATION_DIFFUSE)
2872         {
2873                 Color_Diffuse[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+0];
2874                 Color_Diffuse[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+1];
2875                 Color_Diffuse[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+2];
2876                 Color_Diffuse[3] = 0.0f;
2877                 LightColor[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+0];
2878                 LightColor[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+1];
2879                 LightColor[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+2];
2880                 LightColor[3] = 0.0f;
2881                 LightVectordata[0]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][0];
2882                 LightVectordata[1]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][1];
2883                 LightVectordata[2]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][2];
2884                 LightVectordata[3]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][3];
2885                 LightVectorslope[0] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][0];
2886                 LightVectorslope[1] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][1];
2887                 LightVectorslope[2] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][2];
2888                 LightVectorslope[3] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][3];
2889                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_normalbgra8, GL20TU_NORMAL, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
2890                 for (x = startx;x < endx;x++)
2891                 {
2892                         z = buffer_z[x];
2893                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
2894                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
2895                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
2896                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
2897                         surfacenormal[0] = buffer_texture_normalbgra8[x*4+2] * (1.0f / 128.0f) - 1.0f;
2898                         surfacenormal[1] = buffer_texture_normalbgra8[x*4+1] * (1.0f / 128.0f) - 1.0f;
2899                         surfacenormal[2] = buffer_texture_normalbgra8[x*4+0] * (1.0f / 128.0f) - 1.0f;
2900                         DPSOFTRAST_Vector3Normalize(surfacenormal);
2901
2902                         lightnormal[0] = (LightVectordata[0] + LightVectorslope[0]*x) * z;
2903                         lightnormal[1] = (LightVectordata[1] + LightVectorslope[1]*x) * z;
2904                         lightnormal[2] = (LightVectordata[2] + LightVectorslope[2]*x) * z;
2905                         DPSOFTRAST_Vector3Normalize(lightnormal);
2906
2907                         diffuse = DPSOFTRAST_Vector3Dot(surfacenormal, lightnormal);if (diffuse < 0.0f) diffuse = 0.0f;
2908                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GLOW)
2909                         {
2910                                 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;
2911                                 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;
2912                                 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;
2913                                 d[3] = (int)(                                                  diffusetex[3] * (Color_Ambient[3]                                             ));if (d[3] > 255) d[3] = 255;
2914                         }
2915                         else
2916                         {
2917                                 d[0] = (int)(                                                + diffusetex[0] * (Color_Ambient[0] + Color_Diffuse[0] * diffuse * LightColor[0]));if (d[0] > 255) d[0] = 255;
2918                                 d[1] = (int)(                                                + diffusetex[1] * (Color_Ambient[1] + Color_Diffuse[1] * diffuse * LightColor[1]));if (d[1] > 255) d[1] = 255;
2919                                 d[2] = (int)(                                                + diffusetex[2] * (Color_Ambient[2] + Color_Diffuse[2] * diffuse * LightColor[2]));if (d[2] > 255) d[2] = 255;
2920                                 d[3] = (int)(                                                  diffusetex[3] * (Color_Ambient[3]                                             ));if (d[3] > 255) d[3] = 255;
2921                         }
2922                         buffer_FragColorbgra8[x*4+0] = d[0];
2923                         buffer_FragColorbgra8[x*4+1] = d[1];
2924                         buffer_FragColorbgra8[x*4+2] = d[2];
2925                         buffer_FragColorbgra8[x*4+3] = d[3];
2926                 }
2927         }
2928         else
2929         {
2930                 for (x = startx;x < endx;x++)
2931                 {
2932                         z = buffer_z[x];
2933                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
2934                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
2935                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
2936                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
2937
2938                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_GLOW)
2939                         {
2940                                 d[0] = (int)(buffer_texture_glowbgra8[x*4+0] * Color_Glow[0] + diffusetex[0] * Color_Ambient[0]);if (d[0] > 255) d[0] = 255;
2941                                 d[1] = (int)(buffer_texture_glowbgra8[x*4+1] * Color_Glow[1] + diffusetex[1] * Color_Ambient[1]);if (d[1] > 255) d[1] = 255;
2942                                 d[2] = (int)(buffer_texture_glowbgra8[x*4+2] * Color_Glow[2] + diffusetex[2] * Color_Ambient[2]);if (d[2] > 255) d[2] = 255;
2943                                 d[3] = (int)(                                                  diffusetex[3] * Color_Ambient[3]);if (d[3] > 255) d[3] = 255;
2944                         }
2945                         else
2946                         {
2947                                 d[0] = (int)(                                                  diffusetex[0] * Color_Ambient[0]);if (d[0] > 255) d[0] = 255;
2948                                 d[1] = (int)(                                                  diffusetex[1] * Color_Ambient[1]);if (d[1] > 255) d[1] = 255;
2949                                 d[2] = (int)(                                                  diffusetex[2] * Color_Ambient[2]);if (d[2] > 255) d[2] = 255;
2950                                 d[3] = (int)(                                                  diffusetex[3] * Color_Ambient[3]);if (d[3] > 255) d[3] = 255;
2951                         }
2952                         buffer_FragColorbgra8[x*4+0] = d[0];
2953                         buffer_FragColorbgra8[x*4+1] = d[1];
2954                         buffer_FragColorbgra8[x*4+2] = d[2];
2955                         buffer_FragColorbgra8[x*4+3] = d[3];
2956                 }
2957         }
2958         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
2959 }
2960
2961
2962
2963 void DPSOFTRAST_VertexShader_LightSource(void)
2964 {
2965         int i;
2966         int numvertices = dpsoftrast.draw.numvertices;
2967         float LightPosition[4];
2968         float LightVector[4];
2969         float LightVectorModelSpace[4];
2970         float EyePosition[4];
2971         float EyeVectorModelSpace[4];
2972         float EyeVector[4];
2973         float position[4];
2974         float svector[4];
2975         float tvector[4];
2976         float normal[4];
2977         LightPosition[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightPosition*4+0];
2978         LightPosition[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightPosition*4+1];
2979         LightPosition[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightPosition*4+2];
2980         LightPosition[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightPosition*4+3];
2981         EyePosition[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+0];
2982         EyePosition[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+1];
2983         EyePosition[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+2];
2984         EyePosition[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_EyePosition*4+3];
2985         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);
2986         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);
2987         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);
2988         DPSOFTRAST_Array_Copy(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD4], dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD4], dpsoftrast.draw.numvertices);
2989         for (i = 0;i < numvertices;i++)
2990         {
2991                 position[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+0];
2992                 position[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+1];
2993                 position[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+2];
2994                 svector[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+0];
2995                 svector[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+1];
2996                 svector[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+2];
2997                 tvector[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+0];
2998                 tvector[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+1];
2999                 tvector[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+2];
3000                 normal[0] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+0];
3001                 normal[1] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+1];
3002                 normal[2] = dpsoftrast.draw.in_array4f[DPSOFTRAST_ARRAY_TEXCOORD3][i*4+2];
3003                 LightVectorModelSpace[0] = LightPosition[0] - position[0];
3004                 LightVectorModelSpace[1] = LightPosition[1] - position[1];
3005                 LightVectorModelSpace[2] = LightPosition[2] - position[2];
3006                 LightVector[0] = svector[0] * LightVectorModelSpace[0] + svector[1] * LightVectorModelSpace[1] + svector[2] * LightVectorModelSpace[2];
3007                 LightVector[1] = tvector[0] * LightVectorModelSpace[0] + tvector[1] * LightVectorModelSpace[1] + tvector[2] * LightVectorModelSpace[2];
3008                 LightVector[2] = normal[0]  * LightVectorModelSpace[0] + normal[1]  * LightVectorModelSpace[1] + normal[2]  * LightVectorModelSpace[2];
3009                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+0] = LightVector[0];
3010                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+1] = LightVector[1];
3011                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+2] = LightVector[2];
3012                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD1][i*4+3] = 0.0f;
3013                 EyeVectorModelSpace[0] = EyePosition[0] - position[0];
3014                 EyeVectorModelSpace[1] = EyePosition[1] - position[1];
3015                 EyeVectorModelSpace[2] = EyePosition[2] - position[2];
3016                 EyeVector[0] = svector[0] * EyeVectorModelSpace[0] + svector[1] * EyeVectorModelSpace[1] + svector[2] * EyeVectorModelSpace[2];
3017                 EyeVector[1] = tvector[0] * EyeVectorModelSpace[0] + tvector[1] * EyeVectorModelSpace[1] + tvector[2] * EyeVectorModelSpace[2];
3018                 EyeVector[2] = normal[0]  * EyeVectorModelSpace[0] + normal[1]  * EyeVectorModelSpace[1] + normal[2]  * EyeVectorModelSpace[2];
3019                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+0] = EyeVector[0];
3020                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+1] = EyeVector[1];
3021                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+2] = EyeVector[2];
3022                 dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_TEXCOORD2][i*4+3] = 0.0f;
3023         }
3024 }
3025
3026 void DPSOFTRAST_PixelShader_LightSource(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3027 {
3028         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3029         unsigned char buffer_texture_colorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3030         unsigned char buffer_texture_normalbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3031         unsigned char buffer_texture_glossbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3032         unsigned char buffer_texture_cubebgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3033         unsigned char buffer_texture_pantsbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3034         unsigned char buffer_texture_shirtbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3035         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3036         int x, startx = span->startx, endx = span->endx;
3037         float Color_Ambient[4], Color_Diffuse[4], Color_Specular[4], Color_Glow[4], Color_Pants[4], Color_Shirt[4], LightColor[4];
3038         float CubeVectordata[4];
3039         float CubeVectorslope[4];
3040         float LightVectordata[4];
3041         float LightVectorslope[4];
3042         float EyeVectordata[4];
3043         float EyeVectorslope[4];
3044         float z;
3045         float diffusetex[4];
3046         float glosstex[4];
3047         float surfacenormal[4];
3048         float lightnormal[4];
3049         float eyenormal[4];
3050         float specularnormal[4];
3051         float diffuse;
3052         float specular;
3053         float SpecularPower;
3054         float CubeVector[4];
3055         float attenuation;
3056         int d[4];
3057         Color_Glow[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+0];
3058         Color_Glow[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+1];
3059         Color_Glow[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Glow*4+2];
3060         Color_Glow[3] = 0.0f;
3061         Color_Ambient[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+0];
3062         Color_Ambient[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+1];
3063         Color_Ambient[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Ambient*4+2];
3064         Color_Ambient[3] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Alpha*4+0];
3065         Color_Diffuse[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+0];
3066         Color_Diffuse[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+1];
3067         Color_Diffuse[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Diffuse*4+2];
3068         Color_Diffuse[3] = 0.0f;
3069         Color_Specular[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+0];
3070         Color_Specular[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+1];
3071         Color_Specular[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Specular*4+2];
3072         Color_Specular[3] = 0.0f;
3073         Color_Pants[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+0];
3074         Color_Pants[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+1];
3075         Color_Pants[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Pants*4+2];
3076         Color_Pants[3] = 0.0f;
3077         Color_Shirt[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+0];
3078         Color_Shirt[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+1];
3079         Color_Shirt[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_Color_Shirt*4+2];
3080         Color_Shirt[3] = 0.0f;
3081         LightColor[2] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+0];
3082         LightColor[1] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+1];
3083         LightColor[0] = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_LightColor*4+2];
3084         LightColor[3] = 0.0f;
3085         SpecularPower = dpsoftrast.uniform4f[DPSOFTRAST_UNIFORM_SpecularPower*4+0] * (1.0f / 255.0f);
3086         EyeVectordata[0]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][0];
3087         EyeVectordata[1]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][1];
3088         EyeVectordata[2]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][2];
3089         EyeVectordata[3]    = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD2][3];
3090         EyeVectorslope[0]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][0];
3091         EyeVectorslope[1]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][1];
3092         EyeVectorslope[2]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][2];
3093         EyeVectorslope[3]   = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD2][3];
3094         LightVectordata[0]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][0];
3095         LightVectordata[1]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][1];
3096         LightVectordata[2]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][2];
3097         LightVectordata[3]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD1][3];
3098         LightVectorslope[0] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][0];
3099         LightVectorslope[1] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][1];
3100         LightVectorslope[2] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][2];
3101         LightVectorslope[3] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD1][3];
3102         CubeVectordata[0]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD3][0];
3103         CubeVectordata[1]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD3][1];
3104         CubeVectordata[2]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD3][2];
3105         CubeVectordata[3]  = span->data[0][DPSOFTRAST_ARRAY_TEXCOORD3][3];
3106         CubeVectorslope[0] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD3][0];
3107         CubeVectorslope[1] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD3][1];
3108         CubeVectorslope[2] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD3][2];
3109         CubeVectorslope[3] = span->data[1][DPSOFTRAST_ARRAY_TEXCOORD3][3];
3110         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3111         memset(buffer_FragColorbgra8 + startx*4, 0, (endx-startx)*4); // clear first, because we skip writing black pixels, and there are a LOT of them...
3112         DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_colorbgra8, GL20TU_COLOR, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3113         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
3114         {
3115                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_pantsbgra8, GL20TU_PANTS, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3116                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_shirtbgra8, GL20TU_SHIRT, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3117         }
3118         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_CUBEFILTER)
3119                 DPSOFTRAST_Draw_Span_TextureCubeVaryingBGRA8(span, buffer_texture_cubebgra8, GL20TU_CUBE, DPSOFTRAST_ARRAY_TEXCOORD3, buffer_z);
3120         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SPECULAR)
3121         {
3122                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_normalbgra8, GL20TU_NORMAL, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3123                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_glossbgra8, GL20TU_GLOSS, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3124                 for (x = startx;x < endx;x++)
3125                 {
3126                         z = buffer_z[x];
3127                         CubeVector[0] = (CubeVectordata[0] + CubeVectorslope[0]*x) * z;
3128                         CubeVector[1] = (CubeVectordata[1] + CubeVectorslope[1]*x) * z;
3129                         CubeVector[2] = (CubeVectordata[2] + CubeVectorslope[2]*x) * z;
3130                         attenuation = 1.0f - DPSOFTRAST_Vector3LengthSquared(CubeVector);
3131                         if (attenuation < 0.01f)
3132                                 continue;
3133                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SHADOWMAP2D)
3134                         {
3135                                 attenuation *= DPSOFTRAST_SampleShadowmap(CubeVector);
3136                                 if (attenuation < 0.01f)
3137                                         continue;
3138                         }
3139
3140                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
3141                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
3142                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
3143                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
3144                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
3145                         {
3146                                 diffusetex[0] += buffer_texture_pantsbgra8[x*4+0] * Color_Pants[0] + buffer_texture_shirtbgra8[x*4+0] * Color_Shirt[0];
3147                                 diffusetex[1] += buffer_texture_pantsbgra8[x*4+1] * Color_Pants[1] + buffer_texture_shirtbgra8[x*4+1] * Color_Shirt[1];
3148                                 diffusetex[2] += buffer_texture_pantsbgra8[x*4+2] * Color_Pants[2] + buffer_texture_shirtbgra8[x*4+2] * Color_Shirt[2];
3149                                 diffusetex[3] += buffer_texture_pantsbgra8[x*4+3] * Color_Pants[3] + buffer_texture_shirtbgra8[x*4+3] * Color_Shirt[3];
3150                         }
3151                         glosstex[0] = buffer_texture_glossbgra8[x*4+0];
3152                         glosstex[1] = buffer_texture_glossbgra8[x*4+1];
3153                         glosstex[2] = buffer_texture_glossbgra8[x*4+2];
3154                         glosstex[3] = buffer_texture_glossbgra8[x*4+3];
3155                         surfacenormal[0] = buffer_texture_normalbgra8[x*4+2] * (1.0f / 128.0f) - 1.0f;
3156                         surfacenormal[1] = buffer_texture_normalbgra8[x*4+1] * (1.0f / 128.0f) - 1.0f;
3157                         surfacenormal[2] = buffer_texture_normalbgra8[x*4+0] * (1.0f / 128.0f) - 1.0f;
3158                         DPSOFTRAST_Vector3Normalize(surfacenormal);
3159
3160                         lightnormal[0] = (LightVectordata[0] + LightVectorslope[0]*x) * z;
3161                         lightnormal[1] = (LightVectordata[1] + LightVectorslope[1]*x) * z;
3162                         lightnormal[2] = (LightVectordata[2] + LightVectorslope[2]*x) * z;
3163                         DPSOFTRAST_Vector3Normalize(lightnormal);
3164
3165                         eyenormal[0] = (EyeVectordata[0] + EyeVectorslope[0]*x) * z;
3166                         eyenormal[1] = (EyeVectordata[1] + EyeVectorslope[1]*x) * z;
3167                         eyenormal[2] = (EyeVectordata[2] + EyeVectorslope[2]*x) * z;
3168                         DPSOFTRAST_Vector3Normalize(eyenormal);
3169
3170                         specularnormal[0] = lightnormal[0] + eyenormal[0];
3171                         specularnormal[1] = lightnormal[1] + eyenormal[1];
3172                         specularnormal[2] = lightnormal[2] + eyenormal[2];
3173                         DPSOFTRAST_Vector3Normalize(specularnormal);
3174
3175                         diffuse = DPSOFTRAST_Vector3Dot(surfacenormal, lightnormal);if (diffuse < 0.0f) diffuse = 0.0f;
3176                         specular = DPSOFTRAST_Vector3Dot(surfacenormal, specularnormal);if (specular < 0.0f) specular = 0.0f;
3177                         specular = pow(specular, SpecularPower * glosstex[3]);
3178                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_CUBEFILTER)
3179                         {
3180                                 // scale down the attenuation to account for the cubefilter multiplying everything by 255
3181                                 attenuation *= (1.0f / 255.0f);
3182                                 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;
3183                                 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;
3184                                 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;
3185                                 d[3] = (int)( diffusetex[3]                                                                                                                                                                );if (d[3] > 255) d[3] = 255;
3186                         }
3187                         else
3188                         {
3189                                 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;
3190                                 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;
3191                                 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;
3192                                 d[3] = (int)( diffusetex[3]                                                                                                                                                                );if (d[3] > 255) d[3] = 255;
3193                         }
3194                         buffer_FragColorbgra8[x*4+0] = d[0];
3195                         buffer_FragColorbgra8[x*4+1] = d[1];
3196                         buffer_FragColorbgra8[x*4+2] = d[2];
3197                         buffer_FragColorbgra8[x*4+3] = d[3];
3198                 }
3199         }
3200         else if (dpsoftrast.shader_permutation & SHADERPERMUTATION_DIFFUSE)
3201         {
3202                 DPSOFTRAST_Draw_Span_Texture2DVaryingBGRA8(span, buffer_texture_normalbgra8, GL20TU_NORMAL, DPSOFTRAST_ARRAY_TEXCOORD0, buffer_z);
3203                 for (x = startx;x < endx;x++)
3204                 {
3205                         z = buffer_z[x];
3206                         CubeVector[0] = (CubeVectordata[0] + CubeVectorslope[0]*x) * z;
3207                         CubeVector[1] = (CubeVectordata[1] + CubeVectorslope[1]*x) * z;
3208                         CubeVector[2] = (CubeVectordata[2] + CubeVectorslope[2]*x) * z;
3209                         attenuation = 1.0f - DPSOFTRAST_Vector3LengthSquared(CubeVector);
3210                         if (attenuation < 0.01f)
3211                                 continue;
3212                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SHADOWMAP2D)
3213                         {
3214                                 attenuation *= DPSOFTRAST_SampleShadowmap(CubeVector);
3215                                 if (attenuation < 0.01f)
3216                                         continue;
3217                         }
3218
3219                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
3220                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
3221                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
3222                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
3223                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
3224                         {
3225                                 diffusetex[0] += buffer_texture_pantsbgra8[x*4+0] * Color_Pants[0] + buffer_texture_shirtbgra8[x*4+0] * Color_Shirt[0];
3226                                 diffusetex[1] += buffer_texture_pantsbgra8[x*4+1] * Color_Pants[1] + buffer_texture_shirtbgra8[x*4+1] * Color_Shirt[1];
3227                                 diffusetex[2] += buffer_texture_pantsbgra8[x*4+2] * Color_Pants[2] + buffer_texture_shirtbgra8[x*4+2] * Color_Shirt[2];
3228                                 diffusetex[3] += buffer_texture_pantsbgra8[x*4+3] * Color_Pants[3] + buffer_texture_shirtbgra8[x*4+3] * Color_Shirt[3];
3229                         }
3230                         surfacenormal[0] = buffer_texture_normalbgra8[x*4+2] * (1.0f / 128.0f) - 1.0f;
3231                         surfacenormal[1] = buffer_texture_normalbgra8[x*4+1] * (1.0f / 128.0f) - 1.0f;
3232                         surfacenormal[2] = buffer_texture_normalbgra8[x*4+0] * (1.0f / 128.0f) - 1.0f;
3233                         DPSOFTRAST_Vector3Normalize(surfacenormal);
3234
3235                         lightnormal[0] = (LightVectordata[0] + LightVectorslope[0]*x) * z;
3236                         lightnormal[1] = (LightVectordata[1] + LightVectorslope[1]*x) * z;
3237                         lightnormal[2] = (LightVectordata[2] + LightVectorslope[2]*x) * z;
3238                         DPSOFTRAST_Vector3Normalize(lightnormal);
3239
3240                         diffuse = DPSOFTRAST_Vector3Dot(surfacenormal, lightnormal);if (diffuse < 0.0f) diffuse = 0.0f;
3241                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_CUBEFILTER)
3242                         {
3243                                 // scale down the attenuation to account for the cubefilter multiplying everything by 255
3244                                 attenuation *= (1.0f / 255.0f);
3245                                 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;
3246                                 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;
3247                                 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;
3248                                 d[3] = (int)( diffusetex[3]                                                                                                                   );if (d[3] > 255) d[3] = 255;
3249                         }
3250                         else
3251                         {
3252                                 d[0] = (int)((diffusetex[0] * (Color_Ambient[0] + Color_Diffuse[0] * diffuse)) * LightColor[0]                                   * attenuation);if (d[0] > 255) d[0] = 255;
3253                                 d[1] = (int)((diffusetex[1] * (Color_Ambient[1] + Color_Diffuse[1] * diffuse)) * LightColor[1]                                   * attenuation);if (d[1] > 255) d[1] = 255;
3254                                 d[2] = (int)((diffusetex[2] * (Color_Ambient[2] + Color_Diffuse[2] * diffuse)) * LightColor[2]                                   * attenuation);if (d[2] > 255) d[2] = 255;
3255                                 d[3] = (int)( diffusetex[3]                                                                                                                                                                );if (d[3] > 255) d[3] = 255;
3256                         }
3257                         buffer_FragColorbgra8[x*4+0] = d[0];
3258                         buffer_FragColorbgra8[x*4+1] = d[1];
3259                         buffer_FragColorbgra8[x*4+2] = d[2];
3260                         buffer_FragColorbgra8[x*4+3] = d[3];
3261                 }
3262         }
3263         else
3264         {
3265                 for (x = startx;x < endx;x++)
3266                 {
3267                         z = buffer_z[x];
3268                         CubeVector[0] = (CubeVectordata[0] + CubeVectorslope[0]*x) * z;
3269                         CubeVector[1] = (CubeVectordata[1] + CubeVectorslope[1]*x) * z;
3270                         CubeVector[2] = (CubeVectordata[2] + CubeVectorslope[2]*x) * z;
3271                         attenuation = 1.0f - DPSOFTRAST_Vector3LengthSquared(CubeVector);
3272                         if (attenuation < 0.01f)
3273                                 continue;
3274                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_SHADOWMAP2D)
3275                         {
3276                                 attenuation *= DPSOFTRAST_SampleShadowmap(CubeVector);
3277                                 if (attenuation < 0.01f)
3278                                         continue;
3279                         }
3280
3281                         diffusetex[0] = buffer_texture_colorbgra8[x*4+0];
3282                         diffusetex[1] = buffer_texture_colorbgra8[x*4+1];
3283                         diffusetex[2] = buffer_texture_colorbgra8[x*4+2];
3284                         diffusetex[3] = buffer_texture_colorbgra8[x*4+3];
3285                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_COLORMAPPING)
3286                         {
3287                                 diffusetex[0] += buffer_texture_pantsbgra8[x*4+0] * Color_Pants[0] + buffer_texture_shirtbgra8[x*4+0] * Color_Shirt[0];
3288                                 diffusetex[1] += buffer_texture_pantsbgra8[x*4+1] * Color_Pants[1] + buffer_texture_shirtbgra8[x*4+1] * Color_Shirt[1];
3289                                 diffusetex[2] += buffer_texture_pantsbgra8[x*4+2] * Color_Pants[2] + buffer_texture_shirtbgra8[x*4+2] * Color_Shirt[2];
3290                                 diffusetex[3] += buffer_texture_pantsbgra8[x*4+3] * Color_Pants[3] + buffer_texture_shirtbgra8[x*4+3] * Color_Shirt[3];
3291                         }
3292                         if (dpsoftrast.shader_permutation & SHADERPERMUTATION_CUBEFILTER)
3293                         {
3294                                 // scale down the attenuation to account for the cubefilter multiplying everything by 255
3295                                 attenuation *= (1.0f / 255.0f);
3296                                 d[0] = (int)((diffusetex[0] * (Color_Ambient[0])) * LightColor[0] * buffer_texture_cubebgra8[x*4+0] * attenuation);if (d[0] > 255) d[0] = 255;
3297                                 d[1] = (int)((diffusetex[1] * (Color_Ambient[1])) * LightColor[1] * buffer_texture_cubebgra8[x*4+1] * attenuation);if (d[1] > 255) d[1] = 255;
3298                                 d[2] = (int)((diffusetex[2] * (Color_Ambient[2])) * LightColor[2] * buffer_texture_cubebgra8[x*4+2] * attenuation);if (d[2] > 255) d[2] = 255;
3299                                 d[3] = (int)( diffusetex[3]                                                                                      );if (d[3] > 255) d[3] = 255;
3300                         }
3301                         else
3302                         {
3303                                 d[0] = (int)((diffusetex[0] * (Color_Ambient[0])) * LightColor[0]                                   * attenuation);if (d[0] > 255) d[0] = 255;
3304                                 d[1] = (int)((diffusetex[1] * (Color_Ambient[1])) * LightColor[1]                                   * attenuation);if (d[1] > 255) d[1] = 255;
3305                                 d[2] = (int)((diffusetex[2] * (Color_Ambient[2])) * LightColor[2]                                   * attenuation);if (d[2] > 255) d[2] = 255;
3306                                 d[3] = (int)( diffusetex[3]                                                                                                                                                                );if (d[3] > 255) d[3] = 255;
3307                         }
3308                         buffer_FragColorbgra8[x*4+0] = d[0];
3309                         buffer_FragColorbgra8[x*4+1] = d[1];
3310                         buffer_FragColorbgra8[x*4+2] = d[2];
3311                         buffer_FragColorbgra8[x*4+3] = d[3];
3312                 }
3313         }
3314         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3315 }
3316
3317
3318
3319 void DPSOFTRAST_VertexShader_Refraction(void)
3320 {
3321         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);
3322 }
3323
3324 void DPSOFTRAST_PixelShader_Refraction(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3325 {
3326         // TODO: IMPLEMENT
3327         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3328         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3329         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3330         memset(buffer_FragColorbgra8, 0, span->length*4);
3331         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3332 }
3333
3334
3335
3336 void DPSOFTRAST_VertexShader_Water(void)
3337 {
3338         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);
3339 }
3340
3341
3342 void DPSOFTRAST_PixelShader_Water(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3343 {
3344         // TODO: IMPLEMENT
3345         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3346         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3347         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3348         memset(buffer_FragColorbgra8, 0, span->length*4);
3349         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3350 }
3351
3352
3353
3354 void DPSOFTRAST_VertexShader_ShowDepth(void)
3355 {
3356         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);
3357 }
3358
3359 void DPSOFTRAST_PixelShader_ShowDepth(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3360 {
3361         // TODO: IMPLEMENT
3362         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3363         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3364         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3365         memset(buffer_FragColorbgra8, 0, span->length*4);
3366         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3367 }
3368
3369
3370
3371 void DPSOFTRAST_VertexShader_DeferredGeometry(void)
3372 {
3373         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);
3374 }
3375
3376 void DPSOFTRAST_PixelShader_DeferredGeometry(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3377 {
3378         // TODO: IMPLEMENT
3379         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3380         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3381         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3382         memset(buffer_FragColorbgra8, 0, span->length*4);
3383         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3384 }
3385
3386
3387
3388 void DPSOFTRAST_VertexShader_DeferredLightSource(void)
3389 {
3390         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);
3391 }
3392
3393 void DPSOFTRAST_PixelShader_DeferredLightSource(const DPSOFTRAST_State_Draw_Span * RESTRICT span)
3394 {
3395         // TODO: IMPLEMENT
3396         float buffer_z[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3397         unsigned char buffer_FragColorbgra8[DPSOFTRAST_DRAW_MAXSPANLENGTH*4];
3398         DPSOFTRAST_Draw_Span_Begin(span, buffer_z);
3399         memset(buffer_FragColorbgra8, 0, span->length*4);
3400         DPSOFTRAST_Draw_Span_FinishBGRA8(span, buffer_FragColorbgra8);
3401 }
3402
3403
3404
3405 typedef struct DPSOFTRAST_ShaderModeInfo_s
3406 {
3407         int lodarrayindex;
3408         void (*Vertex)(void);
3409         void (*Span)(const DPSOFTRAST_State_Draw_Span * RESTRICT span);
3410 }
3411 DPSOFTRAST_ShaderModeInfo;
3412
3413 DPSOFTRAST_ShaderModeInfo DPSOFTRAST_ShaderModeTable[SHADERMODE_COUNT] =
3414 {
3415         {2, DPSOFTRAST_VertexShader_Generic,                        DPSOFTRAST_PixelShader_Generic,                      },
3416         {2, DPSOFTRAST_VertexShader_PostProcess,                    DPSOFTRAST_PixelShader_PostProcess,                  },
3417         {2, DPSOFTRAST_VertexShader_Depth_Or_Shadow,                DPSOFTRAST_PixelShader_Depth_Or_Shadow,              },
3418         {2, DPSOFTRAST_VertexShader_FlatColor,                      DPSOFTRAST_PixelShader_FlatColor,                    },
3419         {2, DPSOFTRAST_VertexShader_VertexColor,                    DPSOFTRAST_PixelShader_VertexColor,                  },
3420         {2, DPSOFTRAST_VertexShader_Lightmap,                       DPSOFTRAST_PixelShader_Lightmap,                     },
3421         {2, DPSOFTRAST_VertexShader_FakeLight,                      DPSOFTRAST_PixelShader_FakeLight,                    },
3422         {2, DPSOFTRAST_VertexShader_LightDirectionMap_ModelSpace,   DPSOFTRAST_PixelShader_LightDirectionMap_ModelSpace, },
3423         {2, DPSOFTRAST_VertexShader_LightDirectionMap_TangentSpace, DPSOFTRAST_PixelShader_LightDirectionMap_TangentSpace},
3424         {2, DPSOFTRAST_VertexShader_LightDirection,                 DPSOFTRAST_PixelShader_LightDirection,               },
3425         {2, DPSOFTRAST_VertexShader_LightSource,                    DPSOFTRAST_PixelShader_LightSource,                  },
3426         {2, DPSOFTRAST_VertexShader_Refraction,                     DPSOFTRAST_PixelShader_Refraction,                   },
3427         {2, DPSOFTRAST_VertexShader_Water,                          DPSOFTRAST_PixelShader_Water,                        },
3428         {2, DPSOFTRAST_VertexShader_ShowDepth,                      DPSOFTRAST_PixelShader_ShowDepth,                    },
3429         {2, DPSOFTRAST_VertexShader_DeferredGeometry,               DPSOFTRAST_PixelShader_DeferredGeometry,             },
3430         {2, DPSOFTRAST_VertexShader_DeferredLightSource,            DPSOFTRAST_PixelShader_DeferredLightSource,          }
3431 };
3432
3433
3434
3435 void DPSOFTRAST_Draw_ProcessSpans(void)
3436 {
3437         int i;
3438         int x;
3439         int startx;
3440         int endx;
3441         int numspans = dpsoftrast.draw.numspans;
3442 //      unsigned int c;
3443 //      unsigned int *colorpixel;
3444         unsigned int *depthpixel;
3445         float w;
3446         float wslope;
3447         int depth;
3448         int depthslope;
3449         unsigned int d;
3450         DPSOFTRAST_State_Draw_Span *span = dpsoftrast.draw.spanqueue;
3451         unsigned char pixelmask[DPSOFTRAST_DRAW_MAXSPANLENGTH];
3452         for (i = 0;i < numspans;i++, span++)
3453         {
3454                 w = span->data[0][DPSOFTRAST_ARRAY_TOTAL][3];
3455                 wslope = span->data[1][DPSOFTRAST_ARRAY_TOTAL][3];
3456                 if (dpsoftrast.user.depthtest && dpsoftrast.fb_depthpixels)
3457                 {
3458                         depth = (int)(w*DPSOFTRAST_DEPTHSCALE);
3459                         depthslope = (int)(wslope*DPSOFTRAST_DEPTHSCALE);
3460                         depthpixel = dpsoftrast.fb_depthpixels + span->start;
3461                         switch(dpsoftrast.fb_depthfunc)
3462                         {
3463                         default:
3464                         case GL_ALWAYS:  for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = true; break;
3465                         case GL_LESS:    for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = depthpixel[x] < d; break;
3466                         case GL_LEQUAL:  for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = depthpixel[x] <= d; break;
3467                         case GL_EQUAL:   for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = depthpixel[x] == d; break;
3468                         case GL_GEQUAL:  for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = depthpixel[x] >= d; break;
3469                         case GL_GREATER: for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = depthpixel[x] > d; break;
3470                         case GL_NEVER:   for (x = 0, d = depth;x < span->length;x++, d += depthslope) pixelmask[x] = false; break;
3471                         }
3472                         //colorpixel = dpsoftrast.fb_colorpixels[0] + span->start;
3473                         //for (x = 0;x < span->length;x++)
3474                         //      colorpixel[x] = (depthpixel[x] & 0xFF000000) ? (0x00FF0000) : (depthpixel[x] & 0x00FF0000);
3475                         // if there is no color buffer, skip pixel shader
3476                         startx = 0;
3477                         endx = span->length;
3478                         while (startx < endx && !pixelmask[startx])
3479                                 startx++;
3480                         while (endx > startx && !pixelmask[endx-1])
3481                                 endx--;
3482                         if (startx >= endx)
3483                                 continue; // no pixels to fill
3484                         span->pixelmask = pixelmask;
3485                         span->startx = startx;
3486                         span->endx = endx;
3487                         // run pixel shader if appropriate
3488                         // do this before running depthmask code, to allow the pixelshader
3489                         // to clear pixelmask values for alpha testing
3490                         if (dpsoftrast.fb_colorpixels[0] && dpsoftrast.fb_colormask)
3491                                 DPSOFTRAST_ShaderModeTable[dpsoftrast.shader_mode].Span(span);
3492                         if (dpsoftrast.user.depthmask)
3493                                 for (x = 0, d = depth;x < span->length;x++, d += depthslope)
3494                                         if (pixelmask[x])
3495                                                 depthpixel[x] = d;
3496                 }
3497                 else
3498                 {
3499                         // no depth testing means we're just dealing with color...
3500                         // if there is no color buffer, skip pixel shader
3501                         if (dpsoftrast.fb_colorpixels[0] && dpsoftrast.fb_colormask)
3502                         {
3503                                 memset(pixelmask, 1, span->length);
3504                                 span->pixelmask = pixelmask;
3505                                 span->startx = 0;
3506                                 span->endx = span->length;
3507                                 DPSOFTRAST_ShaderModeTable[dpsoftrast.shader_mode].Span(span);
3508                         }
3509                 }
3510         }
3511 }
3512
3513 void DPSOFTRAST_Draw_ProcessTriangles(int firstvertex, int numtriangles, const int *element3i, const unsigned short *element3s, unsigned char *arraymask)
3514 {
3515 #ifdef SSE2_PRESENT
3516         int cullface = dpsoftrast.user.cullface;
3517         int width = dpsoftrast.fb_width;
3518         int height = dpsoftrast.fb_height;
3519         int i;
3520         int j;
3521         int k;
3522         int y;
3523         int e[3];
3524         ALIGN(int screeny[4]);
3525         int starty, endy;
3526         int screenyless[4];
3527         int numpoints;
3528         int clipflags;
3529         int edge0p;
3530         int edge0n;
3531         int edge1p;
3532         int edge1n;
3533         int startx;
3534         int endx;
3535         float mip_edge0tc[2];
3536         float mip_edge1tc[2];
3537         float mip_edge0xy[2];
3538         float mip_edge1xy[2];
3539         float mip_edge0xymul;
3540         float mip_edge1xymul;
3541         float mip_edge0mip;
3542         float mip_edge1mip;
3543         float mipdensity;
3544         unsigned char mip[DPSOFTRAST_MAXTEXTUREUNITS];
3545         float startxf;
3546         float endxf;
3547         float edge0ylerp;
3548         float edge0yilerp;
3549         float edge1ylerp;
3550         float edge1yilerp;
3551         float edge0xf;
3552         float edge1xf;
3553         float spanilength;
3554         float startxlerp;
3555         float yc;
3556         float frac;
3557         float ifrac;
3558         //float trianglearea2;
3559         __m128 triangleedge[2];
3560         __m128 trianglenormal;
3561         ALIGN(float clipdist[4]);
3562         ALIGN(float clipped[DPSOFTRAST_ARRAY_TOTAL][4][4]);
3563         ALIGN(float screen[4][4]);
3564         __m128 proj[DPSOFTRAST_ARRAY_TOTAL][4];
3565         DPSOFTRAST_Texture *texture;
3566         DPSOFTRAST_State_Draw_Span *span;
3567         DPSOFTRAST_State_Draw_Span *oldspan;
3568         for (i = 0;i < numtriangles;i++)
3569         {
3570                 // generate the 3 edges of this triangle
3571                 // generate spans for the triangle - switch based on left split or right split classification of triangle
3572                 if (element3i)
3573                 {
3574                         e[0] = element3i[i*3+0] - firstvertex;
3575                         e[1] = element3i[i*3+1] - firstvertex;
3576                         e[2] = element3i[i*3+2] - firstvertex;
3577                 }
3578                 else if (element3s)
3579                 {
3580                         e[0] = element3s[i*3+0] - firstvertex;
3581                         e[1] = element3s[i*3+1] - firstvertex;
3582                         e[2] = element3s[i*3+2] - firstvertex;
3583                 }
3584                 else
3585                 {
3586                         e[0] = i*3+0;
3587                         e[1] = i*3+1;
3588                         e[2] = i*3+2;
3589                 }
3590                 {
3591                         __m128 v1 = _mm_load_ps(&dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[1]*4]);
3592                         triangleedge[0] = _mm_sub_ps(_mm_load_ps(&dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[0]*4]), v1);
3593                         triangleedge[1] = _mm_sub_ps(_mm_load_ps(&dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[2]*4]), v1);
3594                 }
3595                 // store normal in 2, 0, 1 order instead of 0, 1, 2 as it requires fewer shuffles and leaves z component accessible as scalar
3596                 trianglenormal = _mm_sub_ps(_mm_mul_ps(triangleedge[0], _mm_shuffle_ps(triangleedge[1], triangleedge[1], _MM_SHUFFLE(3, 0, 2, 1))),
3597                                                                         _mm_mul_ps(_mm_shuffle_ps(triangleedge[0], triangleedge[0], _MM_SHUFFLE(3, 0, 2, 1)), triangleedge[1]));
3598 #if 0
3599                 trianglenormal[2] = triangleedge[0][0] * triangleedge[1][1] - triangleedge[0][1] * triangleedge[1][0];
3600                 trianglenormal[0] = triangleedge[0][1] * triangleedge[1][2] - triangleedge[0][2] * triangleedge[1][1];
3601                 trianglenormal[1] = triangleedge[0][2] * triangleedge[1][0] - triangleedge[0][0] * triangleedge[1][2];
3602 #endif
3603                 // apply current cullface mode (this culls many triangles)
3604                 switch(cullface)
3605                 {
3606                 case GL_BACK:
3607                         if (_mm_ucomilt_ss(trianglenormal, _mm_setzero_ps()))
3608                                 continue;
3609                         break;
3610                 case GL_FRONT:
3611                         if (_mm_ucomigt_ss(trianglenormal, _mm_setzero_ps()))
3612                                 continue;
3613                         break;
3614                 }
3615 #if 0
3616                 trianglearea2 = trianglenormal[0] * trianglenormal[0] + trianglenormal[1] * trianglenormal[1] + trianglenormal[2] * trianglenormal[2];
3617                 // skip degenerate triangles, nothing good can come from them...
3618                 if (trianglearea2 == 0.0f)
3619                         continue;
3620 #endif
3621
3622                 // calculate distance from nearplane
3623                 clipdist[0] = dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[0]*4+2] + 1.0f;
3624                 clipdist[1] = dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[1]*4+2] + 1.0f;
3625                 clipdist[2] = dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][e[2]*4+2] + 1.0f;
3626                 clipflags = 0;
3627                 if (clipdist[0] < 0.0f)
3628                         clipflags |= 1;
3629                 if (clipdist[1] < 0.0f)
3630                         clipflags |= 2;
3631                 if (clipdist[2] < 0.0f)
3632                         clipflags |= 4;
3633                 // clip triangle if necessary
3634                 switch(clipflags)
3635                 {
3636                 case 0: /*000*/
3637                         // triangle is entirely in front of nearplane
3638
3639                         // macros for clipping vertices
3640 #define CLIPPEDVERTEXLERP(k,p1,p2) \
3641                         frac = clipdist[p1] / (clipdist[p1] - clipdist[p2]);\
3642                         ifrac = 1.0f - frac;\
3643                         for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)\
3644                         {\
3645                                 /*if (arraymask[j])*/\
3646                                 {\
3647                                         clipped[j][k][0] = dpsoftrast.draw.post_array4f[j][e[p1]*4+0]*ifrac+dpsoftrast.draw.post_array4f[j][e[p2]*4+0]*frac;\
3648                                         clipped[j][k][1] = dpsoftrast.draw.post_array4f[j][e[p1]*4+1]*ifrac+dpsoftrast.draw.post_array4f[j][e[p2]*4+1]*frac;\
3649                                         clipped[j][k][2] = dpsoftrast.draw.post_array4f[j][e[p1]*4+2]*ifrac+dpsoftrast.draw.post_array4f[j][e[p2]*4+2]*frac;\
3650                                         clipped[j][k][3] = dpsoftrast.draw.post_array4f[j][e[p1]*4+3]*ifrac+dpsoftrast.draw.post_array4f[j][e[p2]*4+3]*frac;\
3651                                 }\
3652                         }\
3653                         DPSOFTRAST_Draw_ProjectVertices(screen[k], clipped[DPSOFTRAST_ARRAY_POSITION][k], 1)
3654 #define CLIPPEDVERTEXCOPY(k,p1) \
3655                         for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)\
3656                         {\
3657                                 /*if (arraymask[j])*/\
3658                                 {\
3659                                         clipped[j][k][0] = dpsoftrast.draw.post_array4f[j][e[p1]*4+0];\
3660                                         clipped[j][k][1] = dpsoftrast.draw.post_array4f[j][e[p1]*4+1];\
3661                                         clipped[j][k][2] = dpsoftrast.draw.post_array4f[j][e[p1]*4+2];\
3662                                         clipped[j][k][3] = dpsoftrast.draw.post_array4f[j][e[p1]*4+3];\
3663                                 }\
3664                         }\
3665                         screen[k][0] = dpsoftrast.draw.screencoord4f[e[p1]*4+0];\
3666                         screen[k][1] = dpsoftrast.draw.screencoord4f[e[p1]*4+1];\
3667                         screen[k][2] = dpsoftrast.draw.screencoord4f[e[p1]*4+2];\
3668                         screen[k][3] = dpsoftrast.draw.screencoord4f[e[p1]*4+3];
3669
3670                         CLIPPEDVERTEXCOPY(0,0);
3671                         CLIPPEDVERTEXCOPY(1,1);
3672                         CLIPPEDVERTEXCOPY(2,2);
3673                         numpoints = 3;
3674                         break;
3675                 case 1: /*100*/
3676                         CLIPPEDVERTEXLERP(0,0,1);
3677                         CLIPPEDVERTEXCOPY(1,1);
3678                         CLIPPEDVERTEXCOPY(2,2);
3679                         CLIPPEDVERTEXLERP(3,2,0);
3680                         numpoints = 4;
3681                         break;
3682                 case 2: /*010*/
3683                         CLIPPEDVERTEXCOPY(0,0);
3684                         CLIPPEDVERTEXLERP(1,0,1);
3685                         CLIPPEDVERTEXLERP(2,1,2);
3686                         CLIPPEDVERTEXCOPY(3,2);
3687                         numpoints = 4;
3688                         break;
3689                 case 3: /*110*/
3690                         CLIPPEDVERTEXLERP(0,1,2);
3691                         CLIPPEDVERTEXCOPY(1,2);
3692                         CLIPPEDVERTEXLERP(2,2,0);
3693                         numpoints = 3;
3694                         break;
3695                 case 4: /*001*/
3696                         CLIPPEDVERTEXCOPY(0,0);
3697                         CLIPPEDVERTEXCOPY(1,1);
3698                         CLIPPEDVERTEXLERP(2,1,2);
3699                         CLIPPEDVERTEXLERP(3,2,0);
3700                         numpoints = 4;
3701                         break;
3702                 case 5: /*101*/
3703                         CLIPPEDVERTEXLERP(0,0,1);
3704                         CLIPPEDVERTEXCOPY(1,1);
3705                         CLIPPEDVERTEXLERP(2,1,2);
3706                         numpoints = 3;
3707                         break;
3708                 case 6: /*011*/
3709                         CLIPPEDVERTEXCOPY(0,0);
3710                         CLIPPEDVERTEXLERP(1,0,1);
3711                         CLIPPEDVERTEXLERP(2,2,0);
3712                         numpoints = 3;
3713                         break;
3714                 case 7: /*111*/
3715                         // triangle is entirely behind nearplane
3716                         continue;
3717                 }
3718                 {
3719                         // calculate integer y coords for triangle points
3720                         __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))),
3721                                                                                   _mm_cvttps_epi32(_mm_shuffle_ps(_mm_load_ps(screen[2]), _mm_load_ps(screen[3]), _MM_SHUFFLE(1, 0, 1, 0)))),
3722                                         screenir, screenmin, screenmax;
3723                         if (numpoints <= 3) screeni = _mm_shuffle_epi32(screeni, _MM_SHUFFLE(2, 2, 1, 0));
3724                         screenir = _mm_shuffle_epi32(screeni, _MM_SHUFFLE(1, 0, 3, 2)),
3725                         screenmin = _mm_min_epi16(screeni, screenir);
3726                         screenmax = _mm_max_epi16(screeni, screenir);
3727                         screenmin = _mm_min_epi16(screenmin, _mm_shufflelo_epi16(screenmin, _MM_SHUFFLE(1, 0, 3, 2)));
3728                         screenmax = _mm_max_epi16(screenmax, _mm_shufflelo_epi16(screenmax, _MM_SHUFFLE(1, 0, 3, 2)));
3729                         screenmin = _mm_max_epi16(screenmin, _mm_setzero_si128());
3730                         screenmax = _mm_min_epi16(screenmax, _mm_setr_epi16(width-1, height-1, 0, 0, 0, 0, 0, 0));
3731                         // skip offscreen triangles
3732                         {
3733                                 __m128i cc = _mm_cmplt_epi16(screenmax, screenmin);
3734                                 if (_mm_extract_epi16(cc, 0)|_mm_extract_epi16(cc, 1))
3735                                         continue;
3736                         }
3737                         starty = _mm_extract_epi16(screenmin, 1);
3738                         endy = _mm_extract_epi16(screenmax, 1)+1;
3739                         _mm_store_si128((__m128i *)screeny, _mm_srai_epi32(screeni, 16));
3740                 }
3741
3742                 // okay, this triangle is going to produce spans, we'd better project
3743                 // the interpolants now (this is what gives perspective texturing),
3744                 // this consists of simply multiplying all arrays by the W coord
3745                 // (which is basically 1/Z), which will be undone per-pixel
3746                 // (multiplying by Z again) to get the perspective-correct array
3747                 // values
3748                 for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)
3749                 {
3750                         //if (arraymask[j])
3751                         {
3752                                 for (k = 0;k < numpoints;k++)
3753                                 {
3754                                         proj[j][k] = _mm_mul_ps(_mm_load_ps(clipped[j][k]), _mm_set1_ps(screen[k][3]));
3755                                 }
3756                         }
3757                 }
3758                 // adjust texture LOD by texture density, in the simplest way possible...
3759                 mip_edge0xy[0] = screen[0][0] - screen[1][0];
3760                 mip_edge0xy[1] = screen[0][1] - screen[1][1];
3761                 mip_edge1xy[0] = screen[2][0] - screen[1][0];
3762                 mip_edge1xy[1] = screen[2][1] - screen[1][1];
3763                 mip_edge0xymul = 1.0f / (mip_edge0xy[0]*mip_edge0xy[0]+mip_edge0xy[1]*mip_edge0xy[1]);
3764                 mip_edge1xymul = 1.0f / (mip_edge1xy[0]*mip_edge1xy[0]+mip_edge1xy[1]*mip_edge1xy[1]);
3765                 for (j = 0;j < DPSOFTRAST_MAXTEXTUREUNITS;j++)
3766                 {
3767                         texture = dpsoftrast.texbound[j];
3768                         if (texture)
3769                         {
3770                                 if (texture->filter <= DPSOFTRAST_TEXTURE_FILTER_LINEAR)
3771                                 {
3772                                         mip[j] = 0;
3773                                         continue;
3774                                 }
3775                                 k = DPSOFTRAST_ShaderModeTable[dpsoftrast.shader_mode].lodarrayindex;
3776                                 mip_edge0tc[0] = (clipped[k][0][0] - clipped[k][1][0]) * texture->mipmap[0][2];
3777                                 mip_edge0tc[1] = (clipped[k][0][1] - clipped[k][1][1]) * texture->mipmap[0][3];
3778                                 mip_edge1tc[0] = (clipped[k][2][0] - clipped[k][1][0]) * texture->mipmap[0][2];
3779                                 mip_edge1tc[1] = (clipped[k][2][1] - clipped[k][1][1]) * texture->mipmap[0][3];
3780                                 mip_edge0mip = (mip_edge0tc[0]*mip_edge0tc[0]+mip_edge0tc[1]*mip_edge0tc[1]) * mip_edge0xymul;
3781                                 mip_edge1mip = (mip_edge1tc[0]*mip_edge1tc[0]+mip_edge1tc[1]*mip_edge1tc[1]) * mip_edge1xymul;
3782                                 // this will be multiplied in the texturing routine by the texture resolution
3783                                 mipdensity = mip_edge0mip < mip_edge1mip ? mip_edge0mip : mip_edge1mip;
3784                                 y = (int)(log(mipdensity)/log(2.0f));
3785                                 if (y < 0)
3786                                         y = 0;
3787                                 if (y > texture->mipmaps - 1)
3788                                         y = texture->mipmaps - 1;
3789                                 mip[j] = y;
3790                         }
3791                 }
3792                 // iterate potential spans
3793                 // TODO: optimize?  if we figured out the edge order beforehand, this
3794                 //       could do loops over the edges in the proper order rather than
3795                 //       selecting them for each span
3796                 // TODO: optimize?  the edges could have data slopes calculated
3797                 // TODO: optimize?  the data slopes could be calculated as a plane
3798                 //       (2D slopes) to avoid any interpolation along edges at all
3799                 for (y = starty;y < endy;y++)
3800                 {
3801                         // get center of pixel y
3802                         yc = y;
3803                         // do the compares all at once
3804                         screenyless[0] = y <= screeny[0];
3805                         screenyless[1] = y <= screeny[1];
3806                         screenyless[2] = y <= screeny[2];
3807                         screenyless[3] = y <= screeny[3];
3808                         if (numpoints == 4)
3809                         {
3810                                 switch(screenyless[0] + screenyless[1] * 2 + screenyless[2] * 4 + screenyless[3] * 8)
3811                                 {
3812                                 case  0: /*0000*/ continue;
3813                                 case  1: /*1000*/ edge0p = 3;edge0n = 0;edge1p = 0;edge1n = 1;break;
3814                                 case  2: /*0100*/ edge0p = 0;edge0n = 1;edge1p = 1;edge1n = 2;break;
3815                                 case  3: /*1100*/ edge0p = 3;edge0n = 0;edge1p = 1;edge1n = 2;break;
3816                                 case  4: /*0010*/ edge0p = 1;edge0n = 2;edge1p = 2;edge1n = 3;break;
3817                                 case  5: /*1010*/ edge0p = 1;edge0n = 2;edge1p = 2;edge1n = 3;break; // concave - nonsense
3818                                 case  6: /*0110*/ edge0p = 0;edge0n = 1;edge1p = 2;edge1n = 3;break;
3819                                 case  7: /*1110*/ edge0p = 3;edge0n = 0;edge1p = 2;edge1n = 3;break;
3820                                 case  8: /*0001*/ edge0p = 2;edge0n = 3;edge1p = 3;edge1n = 0;break;
3821                                 case  9: /*1001*/ edge0p = 2;edge0n = 3;edge1p = 0;edge1n = 1;break;
3822                                 case 10: /*0101*/ edge0p = 2;edge0n = 3;edge1p = 1;edge1n = 2;break; // concave - nonsense
3823                                 case 11: /*1101*/ edge0p = 2;edge0n = 3;edge1p = 1;edge1n = 2;break;
3824                                 case 12: /*0011*/ edge0p = 1;edge0n = 2;edge1p = 3;edge1n = 0;break;
3825                                 case 13: /*1011*/ edge0p = 1;edge0n = 2;edge1p = 0;edge1n = 1;break;
3826                                 case 14: /*0111*/ edge0p = 0;edge0n = 1;edge1p = 3;edge1n = 0;break;
3827                                 case 15: /*1111*/ continue;
3828                                 }
3829                         }
3830                         else
3831                         {
3832                                 switch(screenyless[0] + screenyless[1] * 2 + screenyless[2] * 4)
3833                                 {
3834                                 case 0: /*000*/ continue;
3835                                 case 1: /*100*/ edge0p = 2;edge0n = 0;edge1p = 0;edge1n = 1;break;
3836                                 case 2: /*010*/ edge0p = 0;edge0n = 1;edge1p = 1;edge1n = 2;break;
3837                                 case 3: /*110*/ edge0p = 2;edge0n = 0;edge1p = 1;edge1n = 2;break;
3838                                 case 4: /*001*/ edge0p = 1;edge0n = 2;edge1p = 2;edge1n = 0;break;
3839                                 case 5: /*101*/ edge0p = 1;edge0n = 2;edge1p = 0;edge1n = 1;break;
3840                                 case 6: /*011*/ edge0p = 0;edge0n = 1;edge1p = 2;edge1n = 0;break;
3841                                 case 7: /*111*/ continue;
3842                                 }
3843                         }
3844 #if 0
3845                 {
3846                         int foundedges = 0;
3847                         int cedge0p = 0;
3848                         int cedge0n = 0;
3849                         int cedge1p = 0;
3850                         int cedge1n = 0;
3851                         for (j = 0, k = numpoints-1;j < numpoints;k = j, j++)
3852                         {
3853                                 if (screenyless[k] && !screenyless[j])
3854                                 {
3855                                         cedge1p = k;
3856                                         cedge1n = j;
3857                                         foundedges |= 1;
3858                                 }
3859                                 else if (screenyless[j] && !screenyless[k])
3860                                 {
3861                                         cedge0p = k;
3862                                         cedge0n = j;
3863                                         foundedges |= 2;
3864                                 }
3865                         }
3866                         if (foundedges != 3)
3867                                 continue;
3868                         if (cedge0p != edge0p || cedge0n != edge0n || cedge1p != edge1p || cedge1n != edge1n)
3869                         {
3870                                 if (numpoints == 4)
3871                                         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);
3872                                 else
3873                                         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);
3874                         }
3875                 }
3876 #endif
3877                         edge0ylerp = (yc - screen[edge0p][1]) / (screen[edge0n][1] - screen[edge0p][1]);
3878                         edge1ylerp = (yc - screen[edge1p][1]) / (screen[edge1n][1] - screen[edge1p][1]);
3879                         if (edge0ylerp < 0 || edge0ylerp > 1 || edge1ylerp < 0 || edge1ylerp > 1)
3880                                 continue;
3881                         edge0yilerp = 1.0f - edge0ylerp;
3882                         edge1yilerp = 1.0f - edge1ylerp;
3883                         edge0xf = screen[edge0p][0] * edge0yilerp + screen[edge0n][0] * edge0ylerp;
3884                         edge1xf = screen[edge1p][0] * edge1yilerp + screen[edge1n][0] * edge1ylerp;
3885                         if (edge0xf < edge1xf)
3886                         {
3887                                 startxf = edge0xf;
3888                                 endxf = edge1xf;
3889                         }
3890                         else
3891                         {
3892                                 startxf = edge1xf;
3893                                 endxf = edge0xf;
3894                         }
3895                         startx = (int)ceil(startxf);
3896                         endx = (int)ceil(endxf);
3897                         if (startx < 0)
3898                                 startx = 0;
3899                         if (endx > width)
3900                                 endx = width;
3901                         if (startx >= endx)
3902                                 continue;
3903                         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); }
3904                         spanilength = 1.0f / (endxf - startxf);
3905                         startxlerp = startx - startxf;
3906                         span = &dpsoftrast.draw.spanqueue[dpsoftrast.draw.numspans++];
3907                         memcpy(span->mip, mip, sizeof(span->mip));
3908                         span->start = y * width + startx;
3909                         span->length = endx - startx;
3910                         {
3911                                 __m128 edge0ylerpm = _mm_set1_ps(edge0ylerp), edge0yilerpm = _mm_set1_ps(edge0yilerp),
3912                                            edge1ylerpm = _mm_set1_ps(edge1ylerp), edge1yilerpm = _mm_set1_ps(edge1yilerp),
3913                                            spanilengthm = _mm_set1_ps(spanilength), startxlerpm = _mm_set1_ps(startxlerp),
3914                                            data0, data1;
3915                                 j = DPSOFTRAST_ARRAY_TOTAL;
3916                                 if (edge0xf < edge1xf)
3917                                 {
3918                                         data0 = _mm_add_ps(_mm_mul_ps(_mm_load_ps(screen[edge0p]), edge0yilerpm), _mm_mul_ps(_mm_load_ps(screen[edge0n]), edge0ylerpm));
3919                                         data1 = _mm_add_ps(_mm_mul_ps(_mm_load_ps(screen[edge1p]), edge1yilerpm), _mm_mul_ps(_mm_load_ps(screen[edge1n]), edge1ylerpm));
3920                                         data1 = _mm_mul_ps(_mm_sub_ps(data1, data0), spanilengthm);
3921                                         data0 = _mm_add_ps(data0, _mm_mul_ps(data1, startxlerpm));
3922                                         _mm_store_ps(span->data[0][j], data0);
3923                                         _mm_store_ps(span->data[1][j], data1);
3924                                         for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)
3925                                         {
3926                                                 //if (arraymask[j])
3927                                                 {
3928                                                         data0 = _mm_add_ps(_mm_mul_ps(proj[j][edge0p], edge0yilerpm), _mm_mul_ps(proj[j][edge0n], edge0ylerpm));
3929                                                         data1 = _mm_add_ps(_mm_mul_ps(proj[j][edge1p], edge1yilerpm), _mm_mul_ps(proj[j][edge1n], edge1ylerpm));
3930                                                         data1 = _mm_mul_ps(_mm_sub_ps(data1, data0), spanilengthm);
3931                                                         data0 = _mm_add_ps(data0, _mm_mul_ps(data1, startxlerpm));
3932                                                         _mm_store_ps(span->data[0][j], data0);
3933                                                         _mm_store_ps(span->data[1][j], data1);
3934                                                 }
3935                                         }
3936                                 }
3937                                 else
3938                                 {
3939                                         data0 = _mm_add_ps(_mm_mul_ps(_mm_load_ps(screen[edge1p]), edge1yilerpm), _mm_mul_ps(_mm_load_ps(screen[edge1n]), edge1ylerpm));
3940                                         data1 = _mm_add_ps(_mm_mul_ps(_mm_load_ps(screen[edge0p]), edge0yilerpm), _mm_mul_ps(_mm_load_ps(screen[edge0n]), edge0ylerpm));
3941                                         data1 = _mm_mul_ps(_mm_sub_ps(data1, data0), spanilengthm);
3942                                         data0 = _mm_add_ps(data0, _mm_mul_ps(data1, startxlerpm));
3943                                         _mm_store_ps(span->data[0][j], data0);
3944                                         _mm_store_ps(span->data[1][j], data1);
3945                                         for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)
3946                                         {
3947                                                 //if (arraymask[j])
3948                                                 {
3949                                                         data0 = _mm_add_ps(_mm_mul_ps(proj[j][edge1p], edge1yilerpm), _mm_mul_ps(proj[j][edge1n], edge1ylerpm));
3950                                                         data1 = _mm_add_ps(_mm_mul_ps(proj[j][edge0p], edge0yilerpm), _mm_mul_ps(proj[j][edge0n], edge0ylerpm));
3951                                                         data1 = _mm_mul_ps(_mm_sub_ps(data1, data0), spanilengthm);
3952                                                         data0 = _mm_add_ps(data0, _mm_mul_ps(data1, startxlerpm));
3953                                                         _mm_store_ps(span->data[0][j], data0);
3954                                                         _mm_store_ps(span->data[1][j], data1);
3955                                                 }
3956                                         }
3957                                 }
3958                         }
3959                         // to keep the shader routines from needing more than a small
3960                         // buffer for pixel intermediate data, we split long spans...
3961                         while (span->length > DPSOFTRAST_DRAW_MAXSPANLENGTH)
3962                         {
3963                                 __m128 maxspanlengthm;
3964                                 span->length = DPSOFTRAST_DRAW_MAXSPANLENGTH;
3965                                 if (dpsoftrast.draw.numspans >= DPSOFTRAST_DRAW_MAXSPANQUEUE)
3966                                 {
3967                                         DPSOFTRAST_Draw_ProcessSpans();
3968                                         dpsoftrast.draw.numspans = 0;
3969                                 }
3970                                 oldspan = span;
3971                                 span = &dpsoftrast.draw.spanqueue[dpsoftrast.draw.numspans++];
3972                                 *span = *oldspan;
3973                                 startx += DPSOFTRAST_DRAW_MAXSPANLENGTH;
3974                                 span->start = y * width + startx;
3975                                 span->length = endx - startx;
3976                                 j = DPSOFTRAST_ARRAY_TOTAL;
3977                                 maxspanlengthm = _mm_set1_ps(DPSOFTRAST_DRAW_MAXSPANLENGTH);
3978                                 _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)));
3979                                 for (j = 0;j < DPSOFTRAST_ARRAY_TOTAL;j++)
3980                                 {
3981                                         //if (arraymask[j])
3982                                         {
3983                                                  _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)));
3984                                         }
3985                                 }
3986                         }
3987                         // after all that, we have a span suitable for the pixel shader...
3988                         if (dpsoftrast.draw.numspans >= DPSOFTRAST_DRAW_MAXSPANQUEUE)
3989                         {
3990                                 DPSOFTRAST_Draw_ProcessSpans();
3991                                 dpsoftrast.draw.numspans = 0;
3992                         }
3993                 }
3994                 // draw outlines over triangle for debugging
3995         //      for (j = 0, k = numpoints-1;j < numpoints;k = j, j++)
3996         //              DPSOFTRAST_Draw_DebugEdgePoints(screen[k], screen[j]);
3997         }
3998         if (dpsoftrast.draw.numspans)
3999         {
4000                 DPSOFTRAST_Draw_ProcessSpans();
4001                 dpsoftrast.draw.numspans = 0;
4002         }
4003 #endif
4004 }
4005
4006 void DPSOFTRAST_Draw_DebugPoints(void)
4007 {
4008         int i;
4009         int x;
4010         int y;
4011         int numvertices = dpsoftrast.draw.numvertices;
4012         int w = dpsoftrast.fb_width;
4013         int bounds[4];
4014         unsigned int *pixels = dpsoftrast.fb_colorpixels[0];
4015         const float *c4f;
4016         bounds[0] = dpsoftrast.fb_viewportscissor[0];
4017         bounds[1] = dpsoftrast.fb_viewportscissor[1];
4018         bounds[2] = dpsoftrast.fb_viewportscissor[0] + dpsoftrast.fb_viewportscissor[2];
4019         bounds[3] = dpsoftrast.fb_viewportscissor[1] + dpsoftrast.fb_viewportscissor[3];
4020         for (i = 0;i < numvertices;i++)
4021         {
4022                 // check nearclip
4023                 //if (dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+3] != 1.0f)
4024                 //      continue;
4025                 x = (int)(dpsoftrast.draw.screencoord4f[i*4+0]);
4026                 y = (int)(dpsoftrast.draw.screencoord4f[i*4+1]);
4027                 //x = (int)(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+0] + 0.5f);
4028                 //y = (int)(dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+1] + 0.5f);
4029                 //x = (int)((dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+0] + 1.0f) * dpsoftrast.fb_width * 0.5f + 0.5f);
4030                 //y = (int)((dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION][i*4+1] + 1.0f) * dpsoftrast.fb_height * 0.5f + 0.5f);
4031                 if (x < bounds[0] || y < bounds[1] || x >= bounds[2] || y >= bounds[3])
4032                         continue;
4033                 c4f = dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_COLOR] + i*4;
4034                 pixels[y*w+x] = DPSOFTRAST_BGRA8_FROM_RGBA32F(c4f[0], c4f[1], c4f[2], c4f[3]);
4035         }
4036 }
4037
4038 void DPSOFTRAST_DrawTriangles(int firstvertex, int numvertices, int numtriangles, const int *element3i, const unsigned short *element3s)
4039 {
4040         unsigned char arraymask[DPSOFTRAST_ARRAY_TOTAL];
4041         arraymask[0] = true;
4042         arraymask[1] = dpsoftrast.fb_colorpixels[0] != NULL; // TODO: optimize (decide based on shadermode)
4043         arraymask[2] = dpsoftrast.pointer_texcoordf[0] != NULL;
4044         arraymask[3] = dpsoftrast.pointer_texcoordf[1] != NULL;
4045         arraymask[4] = dpsoftrast.pointer_texcoordf[2] != NULL;
4046         arraymask[5] = dpsoftrast.pointer_texcoordf[3] != NULL;
4047         arraymask[6] = dpsoftrast.pointer_texcoordf[4] != NULL;
4048         arraymask[7] = dpsoftrast.pointer_texcoordf[5] != NULL;
4049         arraymask[8] = dpsoftrast.pointer_texcoordf[6] != NULL;
4050         arraymask[9] = dpsoftrast.pointer_texcoordf[7] != NULL;
4051         DPSOFTRAST_Validate(DPSOFTRAST_VALIDATE_DRAW);
4052         DPSOFTRAST_Draw_LoadVertices(firstvertex, numvertices, true);
4053         DPSOFTRAST_ShaderModeTable[dpsoftrast.shader_mode].Vertex();
4054         DPSOFTRAST_Draw_ProjectVertices(dpsoftrast.draw.screencoord4f, dpsoftrast.draw.post_array4f[DPSOFTRAST_ARRAY_POSITION], numvertices);
4055         DPSOFTRAST_Draw_ProcessTriangles(firstvertex, numtriangles, element3i, element3s, arraymask);
4056 }
4057
4058 void DPSOFTRAST_Init(int width, int height, unsigned int *colorpixels, unsigned int *depthpixels)
4059 {
4060         union
4061         {
4062                 int i;
4063                 unsigned char b[4];
4064         }
4065         u;
4066         u.i = 1;
4067         memset(&dpsoftrast, 0, sizeof(dpsoftrast));
4068         dpsoftrast.bigendian = u.b[3];
4069         dpsoftrast.fb_width = width;
4070         dpsoftrast.fb_height = height;
4071         dpsoftrast.fb_depthpixels = depthpixels;
4072         dpsoftrast.fb_colorpixels[0] = colorpixels;
4073         dpsoftrast.fb_colorpixels[1] = NULL;
4074         dpsoftrast.fb_colorpixels[1] = NULL;
4075         dpsoftrast.fb_colorpixels[1] = NULL;
4076         dpsoftrast.texture_firstfree = 1;
4077         dpsoftrast.texture_end = 1;
4078         dpsoftrast.texture_max = 0;
4079         dpsoftrast.user.colormask[0] = 1;
4080         dpsoftrast.user.colormask[1] = 1;
4081         dpsoftrast.user.colormask[2] = 1;
4082         dpsoftrast.user.colormask[3] = 1;
4083         dpsoftrast.user.blendfunc[0] = GL_ONE;
4084         dpsoftrast.user.blendfunc[1] = GL_ZERO;
4085         dpsoftrast.user.depthmask = true;
4086         dpsoftrast.user.depthtest = true;
4087         dpsoftrast.user.depthfunc = GL_LEQUAL;
4088         dpsoftrast.user.scissortest = false;
4089         dpsoftrast.user.cullface = GL_BACK;
4090         dpsoftrast.user.alphatest = false;
4091         dpsoftrast.user.alphafunc = GL_GREATER;
4092         dpsoftrast.user.alphavalue = 0.5f;
4093         dpsoftrast.user.scissor[0] = 0;
4094         dpsoftrast.user.scissor[1] = 0;
4095         dpsoftrast.user.scissor[2] = dpsoftrast.fb_width;
4096         dpsoftrast.user.scissor[3] = dpsoftrast.fb_height;
4097         dpsoftrast.user.viewport[0] = 0;
4098         dpsoftrast.user.viewport[1] = 0;
4099         dpsoftrast.user.viewport[2] = dpsoftrast.fb_width;
4100         dpsoftrast.user.viewport[3] = dpsoftrast.fb_height;
4101         dpsoftrast.user.depthrange[0] = 0;
4102         dpsoftrast.user.depthrange[1] = 1;
4103         dpsoftrast.user.polygonoffset[0] = 0;
4104         dpsoftrast.user.polygonoffset[1] = 0;
4105         dpsoftrast.user.color[0] = 1;
4106         dpsoftrast.user.color[1] = 1;
4107         dpsoftrast.user.color[2] = 1;
4108         dpsoftrast.user.color[3] = 1;
4109         dpsoftrast.validate = -1;
4110         DPSOFTRAST_Validate(-1);
4111         dpsoftrast.validate = 0;
4112 }
4113
4114 void DPSOFTRAST_Shutdown(void)
4115 {
4116         int i;
4117         for (i = 0;i < dpsoftrast.texture_end;i++)
4118                 if (dpsoftrast.texture[i].bytes)
4119                         free(dpsoftrast.texture[i].bytes);
4120         if (dpsoftrast.texture)
4121                 free(dpsoftrast.texture);
4122         memset(&dpsoftrast, 0, sizeof(dpsoftrast));
4123 }
4124