/*
* Glide64 - Glide video plugin for Nintendo 64 emulators.
* Copyright (c) 2002  Dave2001
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
*/

//****************************************************************
//
// Glide64 - Glide Plugin for Nintendo 64 emulators (tested mostly with Project64)
// Project started on December 29th, 2001
//
// To modify Glide64:
// * Write your name and (optional)email, commented by your work, so I know who did it, and so that you can find which parts you modified when it comes time to send it to me.
// * Do NOT send me the whole project or file that you modified.  Take out your modified code sections, and tell me where to put them.  If people sent the whole thing, I would have many different versions, but no idea how to combine them all.
//
// Official Glide64 development channel: #Glide64 on EFnet
//
// Original author: Dave2001 (Dave2999@hotmail.com)
// Other authors: Gonetz, Gugaman
//
//****************************************************************


static void uc2_vertex ()
{
  // This is special, not handled in update(), but here
  // * Matrix Pre-multiplication idea by Gonetz (Gonetz@ngs.ru)
  if (rdp.update & UPDATE_MULT_MAT)
  {
    rdp.update ^= UPDATE_MULT_MAT;
    for (int i=0; i<4; i++)
    {
      for (int j=0; j<4; j++)
      {
        rdp.combined[j][i] =
          rdp.proj[0][i] * rdp.model[j][0] +
          rdp.proj[1][i] * rdp.model[j][1] +
          rdp.proj[2][i] * rdp.model[j][2] +
          rdp.proj[3][i] * rdp.model[j][3];
      }
    }
  }
  // *
  
  // This is special, not handled in update()
  if (rdp.update & UPDATE_LIGHTS)
  {
    rdp.update ^= UPDATE_LIGHTS;
    
    // Calculate light vectors
    mat_3x3_inverse (rdp.inverse, rdp.model);
	
    for (DWORD l=0; l<rdp.num_lights; l++)
    {
      TransformVector (&rdp.light[l].dir_x, rdp.light_vector[l], rdp.inverse);
      NormalizeVector (rdp.light_vector[l]);
    }
  }
  
  DWORD addr = segoffset(rdp.cmd1);
  int v0, i, n;
  float x, y, z;
  
  rdp.vn = n = (rdp.cmd0 >> 12) & 0xFF;
  rdp.v0 = v0 = ((rdp.cmd0 >> 1) & 0x7F) - n;
  
  FRDP ("uc2:vertex n: %d, v0: %d, from: %08lx\n", n, v0, addr);
  
  if (v0 < 0)
  {
    RDP_E ("** ERROR: uc2:vertex v0 < 0\n");
    RDP ("** ERROR: uc2:vertex v0 < 0\n");
    return;
  }
  
  for (i=0; i < (n<<4); i+=16)
  {
    VERTEX *v = &rdp.vtx[v0 + (i>>4)];
    x   = (float)((short*)gfx.RDRAM)[(((addr+i) >> 1) + 0)^1];
    y   = (float)((short*)gfx.RDRAM)[(((addr+i) >> 1) + 1)^1];
    z   = (float)((short*)gfx.RDRAM)[(((addr+i) >> 1) + 2)^1];
    v->flags  = ((WORD*)gfx.RDRAM)[(((addr+i) >> 1) + 3)^1];
    v->ou   = (float)((short*)gfx.RDRAM)[(((addr+i) >> 1) + 4)^1] * rdp.tiles[rdp.cur_tile].s_scale;
    v->ov   = (float)((short*)gfx.RDRAM)[(((addr+i) >> 1) + 5)^1] * rdp.tiles[rdp.cur_tile].t_scale;
    v->a    = ((BYTE*)gfx.RDRAM)[(addr+i + 15)^3];
	
#ifdef EXTREME_LOGGING
	//    FRDP ("before: v%d - x: %f, y: %f, z: %f, flags: %04lx, ou: %f, ov: %f\n", i>>4, x, y, z, v->flags, v->ou, v->ov);
#endif
	
    v->x = x*rdp.combined[0][0] + y*rdp.combined[1][0] + z*rdp.combined[2][0] + rdp.combined[3][0];
    v->y = x*rdp.combined[0][1] + y*rdp.combined[1][1] + z*rdp.combined[2][1] + rdp.combined[3][1];
    v->z = x*rdp.combined[0][2] + y*rdp.combined[1][2] + z*rdp.combined[2][2] + rdp.combined[3][2];
    v->w = x*rdp.combined[0][3] + y*rdp.combined[1][3] + z*rdp.combined[2][3] + rdp.combined[3][3];
	
#ifdef EXTREME_LOGGING
    FRDP ("v%d - x: %f, y: %f, z: %f, w: %f, u: %f, v: %f, a: 0x%02lx\n", i>>4, v->x, v->y, v->z, v->w, v->ou, v->ov, v->a);
#endif
	
    v->oow = 1.0f / v->w;
    v->x_w = v->x * v->oow;
    v->y_w = v->y * v->oow;
    v->z_w = v->z * v->oow;
	
    v->uv_calculated = 0xFFFFFFFF;
    v->screen_translated = 0;
	v->shade_mods_allowed = 1;
	v->uv_fixed = 0;
	
    v->scr_off = 0;
    if (v->x < -v->w) v->scr_off |= 1;
    if (v->x > v->w) v->scr_off |= 2;
    if (v->y < -v->w) v->scr_off |= 4;
    if (v->y > v->w) v->scr_off |= 8;
    if (v->w < 0.1f) v->scr_off |= 16;
	
    if (rdp.geom_mode & 0x00020000)
    {
      v->vec[0] = ((char*)gfx.RDRAM)[(addr+i + 12)^3];
      v->vec[1] = ((char*)gfx.RDRAM)[(addr+i + 13)^3];
      v->vec[2] = ((char*)gfx.RDRAM)[(addr+i + 14)^3];
	  
      if (!(rdp.geom_mode & 0x800000))
      {
        if (rdp.geom_mode & 0x80000) 
        {
        calc_linear (v);
#ifdef EXTREME_LOGGING
    FRDP ("calc linear: v%d - u: %f, v: %f\n", i>>4, v->ou, v->ov);
#endif
        }
        else if (rdp.geom_mode & 0x40000) 
        {
        calc_sphere (v);
#ifdef EXTREME_LOGGING
    FRDP ("calc sphere: v%d - u: %f, v: %f\n", i>>4, v->ou, v->ov);
#endif
        }
      }
	  
      NormalizeVector (v->vec);
	  
      calc_light (v);
    }
    else
    {
      v->r = ((BYTE*)gfx.RDRAM)[(addr+i + 12)^3];
      v->g = ((BYTE*)gfx.RDRAM)[(addr+i + 13)^3];
      v->b = ((BYTE*)gfx.RDRAM)[(addr+i + 14)^3];
    }
  }
}

static void uc2_modifyvtx ()
{
  BYTE where = (BYTE)((rdp.cmd0 >> 16) & 0xFF);
  WORD vtx = (WORD)((rdp.cmd0 >> 1) & 0xFFFF);
  //  DWORD val = rdp.cmd1;
  
  FRDP ("uc2:modifyvtx: vtx: %d, where: 0x%02lx, val: %08lx - ", vtx, where, rdp.cmd1);
  uc0_modifyvtx(where, vtx, rdp.cmd1);
}

static void uc2_culldl ()
{
  WORD vStart = (WORD)(rdp.cmd0 & 0xFFFF) >> 1;
  WORD vEnd = (WORD)(rdp.cmd1 & 0xFFFF) >> 1;
  DWORD cond = 0;
  FRDP ("uc2:culldl start: %d, end: %d\n", vStart, vEnd);

  if (vEnd < vStart) return;
  for (WORD i=vStart; i<=vEnd; i++)
  {
  /*    
  VERTEX v = &rdp.vtx[i];
  // Check if completely off the screen (quick frustrum clipping for 90 FOV)
  if (v->x >= -v->w)
  cond |= 0x01;
  if (v->x <= v->w)
  cond |= 0x02;
  if (v->y >= -v->w)
  cond |= 0x04;
  if (v->y <= v->w)
  cond |= 0x08;
  if (v->w >= 0.1f)
  cond |= 0x10;
  
    if (cond == 0x1F)
	return;
	//*/
	
#ifdef EXTREME_LOGGING
    FRDP (" v[%d] = (%02f, %02f, %02f, 0x%02lx)\n", i, rdp.vtx[i].x, rdp.vtx[i].y, rdp.vtx[i].w, rdp.vtx[i].scr_off);
#endif
	
    cond |= (~rdp.vtx[i].scr_off) & 0x1F;
    if (cond == 0x1F)
      return;
  }
  
  RDP (" - ");  // specify that the enddl is not a real command
  uc0_enddl ();
}

/*
static void uc2_branch_z ()
{
// we need to get the previous command
DWORD addr = ((DWORD*)gfx.RDRAM)[((rdp.pc[rdp.pc_i] & BMASK) >> 2)-3];

  int vtx = (rdp.cmd0 & 0xFFF) >> 1;
  DWORD zcmp = rdp.cmd1;
  
	FRDP ("uc2:branch_z vtx: %d, z: %f, zcmp: %d, addr: %08lx\n", vtx, rdp.vtx[vtx].w, zcmp, addr);
	
	  if (fabs(rdp.vtx[vtx].z) < zcmp)
	  rdp.pc[rdp.pc_i] = segoffset (addr);
	  }
*/

static void uc6_obj_loadtxtr ();

static void uc2_tri1()
{
  if (rdp.skip_drawing)
  {
    RDP("uc2:tri1. skipped\n");
    return;
  }
  if ((rdp.cmd0 & 0x00FFFFFF) == 0x17)
  {
    uc6_obj_loadtxtr ();
    return;
  }
  
  FRDP("uc1:tri1 #%d - %d, %d, %d\n", rdp.tri_n,
    ((rdp.cmd0 >> 17) & 0x7F),
    ((rdp.cmd0 >> 9) & 0x7F),
    ((rdp.cmd0 >> 1) & 0x7F));
  
  VERTEX *v[3] = {
    &rdp.vtx[(rdp.cmd0 >> 17) & 0x7F],
	  &rdp.vtx[(rdp.cmd0 >> 9) & 0x7F],
	  &rdp.vtx[(rdp.cmd0 >> 1) & 0x7F]
  };
  
  if (cull_tri(v))
    rdp.tri_n ++;
  else
  {
    update ();
	
    DrawTri (v);
    rdp.tri_n ++;
  }
}

static void uc6_ldtx_rect_r ();

static void uc2_line3d ()
{
  if ( (rdp.cmd0&0xFF) == 0x2F )
    uc6_ldtx_rect_r ();
  else  
  {
    FRDP("uc2:line3d #%d, #%d - %d, %d\n", rdp.tri_n, rdp.tri_n+1,
      (rdp.cmd0 >> 17) & 0x7F,
      (rdp.cmd0 >> 9) & 0x7F);
	
    VERTEX *v[3] = {
      &rdp.vtx[(rdp.cmd0 >> 17) & 0x7F],
		&rdp.vtx[(rdp.cmd0 >> 9) & 0x7F],
		&rdp.vtx[(rdp.cmd0 >> 9) & 0x7F]
    };
    WORD width = (WORD)(rdp.cmd0&0xFF) + 1;
	
    if (cull_tri(v))
      rdp.tri_n ++;
    else
    {
      update ();
      DrawTri (v, width);
      rdp.tri_n ++;
    }
  }
}

static void uc2_special3 ()
{
  RDP ("uc2:special3\n");
}

static void uc2_special2 ()
{
  RDP ("uc2:special2\n");
}
#ifdef _WIN32
static void uc2_special1 ()
{
  RDP ("uc2:special1\n");
}
#endif // _WIN32
static void uc2_dma_io ()
{
  RDP ("uc2:dma_io\n");
}

static void uc2_pop_matrix ()
{
  FRDP ("uc2:pop_matrix %08lx, %08lx\n", rdp.cmd0, rdp.cmd1);
  
  // Just pop the modelview matrix
  modelview_pop (rdp.cmd1 >> 6);
}

static void uc2_geom_mode ()
{
  // Switch around some things
  DWORD clr_mode = (rdp.cmd0 & 0x00DFC9FF) |
    ((rdp.cmd0 & 0x00000600) << 3) |
    ((rdp.cmd0 & 0x00200000) >> 12) | 0xFF000000;
  DWORD set_mode = (rdp.cmd1 & 0xFFDFC9FF) |
    ((rdp.cmd1 & 0x00000600) << 3) |
    ((rdp.cmd1 & 0x00200000) >> 12);
  
  FRDP("uc2:geom_mode c:%08lx, s:%08lx ", clr_mode, set_mode);
  
  rdp.geom_mode &= clr_mode;
  rdp.geom_mode |= set_mode;
  
  FRDP ("result:%08lx\n", rdp.geom_mode);
  
  if (rdp.geom_mode & 0x00000001) // Z-Buffer enable
  {
    if (!(rdp.flags & ZBUF_ENABLED))
    {
      rdp.flags |= ZBUF_ENABLED;
      rdp.update |= UPDATE_ZBUF_ENABLED;
    }
  }
  else
  {
    if ((rdp.flags & ZBUF_ENABLED)) //&& (rdp.rm != 0x00504341))
    {
      if (!settings.flame_corona || (rdp.rm != 0x00504341)) //hack for flame's corona
        rdp.flags ^= ZBUF_ENABLED;
      rdp.update |= UPDATE_ZBUF_ENABLED;
    }
  }
  if (rdp.geom_mode & 0x00001000) // Front culling
  {
    if (!(rdp.flags & CULL_FRONT))
    {
      rdp.flags |= CULL_FRONT;
      rdp.update |= UPDATE_CULL_MODE;
    }
  }
  else
  {
    if (rdp.flags & CULL_FRONT)
    {
      rdp.flags ^= CULL_FRONT;
      rdp.update |= UPDATE_CULL_MODE;
    }
  }
  if (rdp.geom_mode & 0x00002000) // Back culling
  {
    if (!(rdp.flags & CULL_BACK))
    {
      rdp.flags |= CULL_BACK;
      rdp.update |= UPDATE_CULL_MODE;
    }
  }
  else
  {
    if (rdp.flags & CULL_BACK)
    {
      rdp.flags ^= CULL_BACK;
      rdp.update |= UPDATE_CULL_MODE;
    }
  }
  
  //Added by Gonetz
  if (rdp.geom_mode & 0x00010000)      // Fog enable
  {
    if (!(rdp.flags & FOG_ENABLED))
    {
      rdp.flags |= FOG_ENABLED;
      rdp.update |= UPDATE_FOG_ENABLED;
    }
  }
  else
  {
    if (rdp.flags & FOG_ENABLED)
    {
      rdp.flags ^= FOG_ENABLED;
      rdp.update |= UPDATE_FOG_ENABLED;
    }
  }
}

static void uc6_obj_rectangle_r ();

static void uc2_matrix ()
{
  if (!(rdp.cmd0 & 0x00FFFFFF))
  {
     uc6_obj_rectangle_r();
     return;
  }
  RDP ("uc2:matrix\n");
  
  DWORD addr = segoffset(rdp.cmd1);
  BYTE command = (BYTE)((rdp.cmd0 ^ 1) & 0xFF);
  
  float m[4][4];
  int x,y;  // matrix index
  
  addr >>= 1;
  
  for (x=0; x<16; x+=4) { // Adding 4 instead of one, just to remove mult. later
    for (y=0; y<4; y++) {
      m[x>>2][y] = (float)(
        (((__int32)((WORD*)gfx.RDRAM)[(addr+x+y)^1]) << 16) |
        ((WORD*)gfx.RDRAM)[(addr+x+y+16)^1]
        ) / 65536.0f;
    }
  }
  
  switch (command)
  {
  case 0: // modelview mul nopush
    RDP ("modelview mul\n");
    modelview_mul (m);
    break;
	
  case 1: // modelview mul push
    RDP ("modelview mul push\n");
    modelview_mul_push (m);
    break;
	
  case 2: // modelview load nopush
    RDP ("modelview load\n");
    modelview_load (m);
    break;
	
  case 3: // modelview load push
    RDP ("modelview load push\n");
    modelview_load_push (m);
    break;
	
  case 4: // projection mul nopush
  case 5: // projection mul push, can't push projection
    RDP ("projection mul\n");
    projection_mul (m);
	
    //Added by Gonetz
    if (rdp.proj[0][0] != rdp.proj[1][1] && rdp.proj[3][1] == 0.0f && rdp.proj[2][3] == -1.0f)
    {
      rdp.C1 = rdp.proj[2][2];
      rdp.C2 = rdp.proj[3][2];
      rdp.update |= UPDATE_FOG_ENABLED; /* added by Dave2001 */
    }
	
    break;
	
  case 6: // projection load nopush
  case 7: // projection load push, can't push projection
    RDP ("projection load\n");
    projection_load (m);
	
    //Added by Gonetz
    if (rdp.proj[0][0] != rdp.proj[1][1] && rdp.proj[3][1] == 0.0f && rdp.proj[2][3] == -1.0f)
    {
      rdp.C1 = rdp.proj[2][2];
      rdp.C2 = rdp.proj[3][2];
      rdp.update |= UPDATE_FOG_ENABLED; /* added by Dave2001 */
    }
	
    break;
	
  default:
    FRDP_E ("Unknown matrix command, %02lx", command);
    FRDP ("Unknown matrix command, %02lx", command);
  }
  
#ifdef EXTREME_LOGGING
  FRDP ("{%f,%f,%f,%f}\n", m[0][0], m[0][1], m[0][2], m[0][3]);
  FRDP ("{%f,%f,%f,%f}\n", m[1][0], m[1][1], m[1][2], m[1][3]);
  FRDP ("{%f,%f,%f,%f}\n", m[2][0], m[2][1], m[2][2], m[2][3]);
  FRDP ("{%f,%f,%f,%f}\n", m[3][0], m[3][1], m[3][2], m[3][3]);
  FRDP ("\nmodel\n{%f,%f,%f,%f}\n", rdp.model[0][0], rdp.model[0][1], rdp.model[0][2], rdp.model[0][3]);
  FRDP ("{%f,%f,%f,%f}\n", rdp.model[1][0], rdp.model[1][1], rdp.model[1][2], rdp.model[1][3]);
  FRDP ("{%f,%f,%f,%f}\n", rdp.model[2][0], rdp.model[2][1], rdp.model[2][2], rdp.model[2][3]);
  FRDP ("{%f,%f,%f,%f}\n", rdp.model[3][0], rdp.model[3][1], rdp.model[3][2], rdp.model[3][3]);
  FRDP ("\nproj\n{%f,%f,%f,%f}\n", rdp.proj[0][0], rdp.proj[0][1], rdp.proj[0][2], rdp.proj[0][3]);
  FRDP ("{%f,%f,%f,%f}\n", rdp.proj[1][0], rdp.proj[1][1], rdp.proj[1][2], rdp.proj[1][3]);
  FRDP ("{%f,%f,%f,%f}\n", rdp.proj[2][0], rdp.proj[2][1], rdp.proj[2][2], rdp.proj[2][3]);
  FRDP ("{%f,%f,%f,%f}\n", rdp.proj[3][0], rdp.proj[3][1], rdp.proj[3][2], rdp.proj[3][3]);
#endif
}

static void uc2_moveword ()
{
  BYTE index = (BYTE)((rdp.cmd0 >> 16) & 0xFF);
  WORD offset = (WORD)(rdp.cmd0 & 0xFFFF);
  DWORD data = rdp.cmd1;
  
  FRDP ("uc2:moveword ");
  
  switch (index)
  {
    // NOTE: right now it's assuming that it sets the integer part first.  This could
    //  be easily fixed, but only if i had something to test with.
	
  case 0x00:  // moveword matrix
    {
	  // do matrix pre-mult so it's re-updated next time
	  if (rdp.update & UPDATE_MULT_MAT)
	  {
		rdp.update ^= UPDATE_MULT_MAT;
		for (int i=0; i<4; i++)
		{
		  for (int j=0; j<4; j++)
		  {
			rdp.combined[j][i] =
			  rdp.proj[0][i] * rdp.model[j][0] +
			  rdp.proj[1][i] * rdp.model[j][1] +
			  rdp.proj[2][i] * rdp.model[j][2] +
			  rdp.proj[3][i] * rdp.model[j][3];
		  }
		}
	  }
	  
	  if (rdp.cmd0 & 0x20)  // fractional part
	  {
		int index_x = (rdp.cmd0 & 0x1F) >> 1;
		int index_y = index_x >> 2;
		index_x &= 3;
		
		float fpart = (rdp.cmd1>>16)/65536.0f;
		rdp.combined[index_y][index_x] = (float)(int)rdp.combined[index_y][index_x];
		rdp.combined[index_y][index_x] += fpart;
		
		fpart = (rdp.cmd1&0xFFFF)/65536.0f;
		rdp.combined[index_y][index_x+1] = (float)(int)rdp.combined[index_y][index_x+1];
		rdp.combined[index_y][index_x+1] += fpart;
	  }
	  else
	  {
		int index_x = (rdp.cmd0 & 0x1F) >> 1;
		int index_y = index_x >> 2;
		index_x &= 3;
		
		float fpart = (float)fabs(rdp.combined[index_y][index_x] - (int)rdp.combined[index_y][index_x]);
		rdp.combined[index_y][index_x] = (short)(rdp.cmd1>>16);
		
		fpart = (float)fabs(rdp.combined[index_y][index_x+1] - (int)rdp.combined[index_y][index_x+1]);
		rdp.combined[index_y][index_x+1] = (short)(rdp.cmd1&0xFFFF);
	  }
	  
	  RDP ("matrix\n");
    }
    break;
	
  case 0x02:
    rdp.num_lights = data / 24;
    rdp.update |= UPDATE_LIGHTS;
    FRDP ("numlights: %d\n", rdp.num_lights);
    break;
	
  case 0x04:
    FRDP ("mw_clip %08lx, %08lx\n", rdp.cmd0, rdp.cmd1);
    break;
	
  case 0x06:  // moveword SEGMENT
    {
      FRDP ("SEGMENT %08lx -> seg%d\n", data, offset >> 2);
      if ((data&BMASK)<BMASK)
        rdp.segment[(offset >> 2) & 0xF] = data;
    }
    break;
	
	
  case 0x08:
    {
	/*
    float fm = (float)((short)(rdp.cmd1 >> 16));
    float fo = (float)((short)(rdp.cmd1 & 0x0000FFFF));
    float min = 500 - (500 * fo / fm);
    float max = (128000 / fm) + min;
	
	  rdp.fogdiff = 128000 / fm;
	  rdp.fogMin = min;
	  rdp.fogMax = max;
	  
		FRDP ("** fog min: %f, max: %f\n", min, max);
	  */
	  rdp.update |= UPDATE_FOG_ENABLED; /* added by Dave2001 */
    }
    break;
	
  case 0x0a:  // moveword LIGHTCOL
    {
      int n = offset / 24;
      FRDP ("lightcol light:%d, %08lx\n", n, data);
	  
      rdp.light[n].r = (float)((data >> 24) & 0xFF) / 255.0f;
      rdp.light[n].g = (float)((data >> 16) & 0xFF) / 255.0f;
      rdp.light[n].b = (float)((data >> 8) & 0xFF) / 255.0f;
      rdp.light[n].a = 255;
    }
    break;
	
  case 0x0c:
    RDP_E ("uc2:moveword forcemtx - IGNORED\n");
    RDP ("forcemtx - IGNORED\n");
    break;
	
  case 0x0e:
    RDP ("perspnorm - IGNORED\n");
    break;
	
  default:
    FRDP_E("uc2:moveword unknown (index: 0x%08lx, offset 0x%08lx)\n", index, offset);
    FRDP ("unknown (index: 0x%08lx, offset 0x%08lx)\n", index, offset);
  }
}

static void uc6_obj_movemem ();

static void uc2_movemem ()
{
  int idx = rdp.cmd0 & 0xFF;
  DWORD addr = segoffset(rdp.cmd1);
  int ofs = (rdp.cmd0 >> 5) & 0x7F8;
  
  FRDP ("uc2:movemem ofs:%d ", ofs);
  
  switch (idx)
  {
  case 0:
  case 2:
    uc6_obj_movemem ();
    break;
	
  case 8:   // VIEWPORT
    {
      DWORD a = addr >> 1;
      short scale_x = ((short*)gfx.RDRAM)[(a+0)^1] >> 2;
      short scale_y = ((short*)gfx.RDRAM)[(a+1)^1] >> 2;
      short scale_z = ((short*)gfx.RDRAM)[(a+2)^1];
      short trans_x = ((short*)gfx.RDRAM)[(a+4)^1] >> 2;
      short trans_y = ((short*)gfx.RDRAM)[(a+5)^1] >> 2;
      short trans_z = ((short*)gfx.RDRAM)[(a+6)^1];
      rdp.view_scale[0] = scale_x * rdp.scale_x;
      rdp.view_scale[1] = -scale_y * rdp.scale_y;
      rdp.view_scale[2] = float(scale_z);
      rdp.view_trans[0] = trans_x * rdp.scale_x;
      rdp.view_trans[1] = trans_y * rdp.scale_y;
      rdp.view_trans[2] = float(trans_z);
	  
      rdp.update |= UPDATE_VIEWPORT;
	  
      FRDP ("viewport scale(%d, %d), trans(%d, %d), from:%08lx\n", scale_x, scale_y,
        trans_x, trans_y, a);
    }
    break;
	
  case 10:  // LIGHT
    {
      int n = ofs / 24 - 2;
	  
      if (n < 0) return;
      if (n > 7) return;
	  
      // Get the data
      rdp.light[n].r = (float)(((BYTE*)gfx.RDRAM)[(addr+0)^3]) / 255.0f;
      rdp.light[n].g = (float)(((BYTE*)gfx.RDRAM)[(addr+1)^3]) / 255.0f;
      rdp.light[n].b = (float)(((BYTE*)gfx.RDRAM)[(addr+2)^3]) / 255.0f;
      rdp.light[n].a = 1.0f;
      // ** Thanks to Icepir8 for pointing this out **
      // Lighting must be signed byte instead of byte
      rdp.light[n].dir_x = (float)(((char*)gfx.RDRAM)[(addr+8)^3]) / 127.0f;
      rdp.light[n].dir_y = (float)(((char*)gfx.RDRAM)[(addr+9)^3]) / 127.0f;
      rdp.light[n].dir_z = (float)(((char*)gfx.RDRAM)[(addr+10)^3]) / 127.0f;
      // **
	  
      //rdp.update |= UPDATE_LIGHTS;
	  
      FRDP ("light: n: %d, r: %.3f, g: %.3f, b: %.3f, x: %.3f, y: %.3f, z: %.3f\n",
        n, rdp.light[n].r, rdp.light[n].g, rdp.light[n].b,
        rdp.light_vector[n][0], rdp.light_vector[n][1], rdp.light_vector[n][2]);
      break;
    }
    break;
	
  case 14:  // matrix
    {
      // do not update the combined matrix!
      rdp.update &= ~UPDATE_MULT_MAT;
	  
      int addr = segoffset(rdp.cmd1);
      FRDP ("matrix - addr: %08lx\n", addr);
	  
      addr >>= 1;
      int x,y;
      for (x=0; x<16; x+=4) { // Adding 4 instead of one, just to remove mult. later
        for (y=0; y<4; y++) {
          rdp.combined[x>>2][y] = (float)(
            (((__int32)((WORD*)gfx.RDRAM)[(addr+x+y)^1]) << 16) |
            ((WORD*)gfx.RDRAM)[(addr+x+y+16)^1]
            ) / 65536.0f;
        }
      }
	  
#ifdef EXTREME_LOGGING
      FRDP ("{%f,%f,%f,%f}\n", rdp.combined[0][0], rdp.combined[0][1], rdp.combined[0][2], rdp.combined[0][3]);
      FRDP ("{%f,%f,%f,%f}\n", rdp.combined[1][0], rdp.combined[1][1], rdp.combined[1][2], rdp.combined[1][3]);
      FRDP ("{%f,%f,%f,%f}\n", rdp.combined[2][0], rdp.combined[2][1], rdp.combined[2][2], rdp.combined[2][3]);
      FRDP ("{%f,%f,%f,%f}\n", rdp.combined[3][0], rdp.combined[3][1], rdp.combined[3][2], rdp.combined[3][3]);
#endif
    }
    break;
	
  default:
    FRDP ("uc2:matrix unknown (%d)\n", idx);
    FRDP ("** UNKNOWN %d\n", idx);
  }
}

static void uc2_load_ucode ()
{
  RDP ("uc2:load_ucode\n");
}

/*
static void uc2_rdphalf_1 ()
{
RDP ("uc2:rdphalf_1\n");
}
*/
/*
static void uc2_setothermode_l ()
{
RDP ("uc2:setothermode_l\n");
}

  static void uc2_setothermode_h ()
  {
  RDP ("uc2:setothermode_h\n");
  }
*/
static void uc2_rdphalf_2 ()
{
  RDP ("uc2:rdphalf_2\n");
}

/*
static void uc2_tri4() //by Gugaman Apr 19
{ 
  
  FRDP("uc2:tri4 (#%d - #%d), %d-%d-%d, %d-%d-%d, %d-%d-%d, %d-%d-%d\n",
    rdp.tri_n,
    rdp.tri_n+3,
    ((rdp.cmd0 >> 23) & 0x1F),
    ((rdp.cmd0 >> 18) & 0x1F),
    ((((rdp.cmd0 >> 15) & 0x7) << 2) | ((rdp.cmd1 >> 30) &0x3)),
    ((rdp.cmd0 >> 10) & 0x1F),
    ((rdp.cmd0 >> 5) & 0x1F),
    ((rdp.cmd0 >> 0) & 0x1F),
    ((rdp.cmd1 >> 25) & 0x1F),
    ((rdp.cmd1 >> 20) & 0x1F),
    ((rdp.cmd1 >> 15) & 0x1F),
    ((rdp.cmd1 >> 10) & 0x1F),
    ((rdp.cmd1 >> 5) & 0x1F),
    ((rdp.cmd1 >> 0) & 0x1F));
  
  VERTEX *v[4][3] = {
    // 0
    {
      &rdp.vtx[(rdp.cmd0 >> 23) & 0x1F],
		&rdp.vtx[(rdp.cmd0 >> 18) & 0x1F],
		&rdp.vtx[((((rdp.cmd0 >> 15) & 0x7) << 2) | ((rdp.cmd1 >> 30) &0x3))]
    },
    // 1
    {
		&rdp.vtx[(rdp.cmd0 >> 10) & 0x1F],
		  &rdp.vtx[(rdp.cmd0 >> 5) & 0x1F],
		  &rdp.vtx[(rdp.cmd0 >> 0) & 0x1F]
	  },
	  // 2
	  {
		  &rdp.vtx[(rdp.cmd1 >> 25) & 0x1F],
			&rdp.vtx[(rdp.cmd1 >> 20) & 0x1F],
			&rdp.vtx[(rdp.cmd1 >> 15) & 0x1F]
		},
		// 3
		{
			&rdp.vtx[(rdp.cmd1 >> 10) & 0x1F],
			  &rdp.vtx[(rdp.cmd1 >> 5) & 0x1F],
			  &rdp.vtx[(rdp.cmd1 >> 0) & 0x1F]
		  }
		  // 4
  };
  bool allculled = true;
  bool culled[4];
  for (int num=0; num<4; num++)
  {
    if (cull_tri(v[num])) {
      rdp.tri_n ++;
      culled[num] = true;
    }
    else {
      culled[num] = false;
      allculled = false;
    }
  }
  if (!allculled)
  {
    update ();
    for (int num=0; num<4; num++)
    {
      if (!culled[num]) DrawTri (v[num]);
      rdp.tri_n ++;
    }
    
  }
}
*/

static void uc2_dlist_cnt ()
{
  DWORD addr = segoffset(rdp.cmd1) & BMASK;
  int count = rdp.cmd0 & 0x000000FF;
  FRDP ("dl_count - addr: %08lx, count: %d\n", addr, count);
  if (addr == 0)
    return;
  
  if (rdp.pc_i >= 9) {
    RDP_E ("** DL stack overflow **\n");
    RDP ("** DL stack overflow **\n");
    return;
  }
  rdp.pc_i ++;  // go to the next PC in the stack
  rdp.pc[rdp.pc_i] = addr;  // jump to the address
  rdp.dl_count = count + 1;
}