[picodrive.git] / pico / cd / gfx_cd.c

// This is a direct rewrite of gfx_cd.asm (x86 asm to C).
// You can even find some x86 register names :)
// Original code (c) 2002 by Stéphane Dallongeville

// (c) Copyright 2007, Grazvydas "notaz" Ignotas


#include "../pico_int.h"

#undef dprintf
#define dprintf(...)

#define _rot_comp Pico_mcd->rot_comp

static const int Table_Rot_Time[] =
{
	0x00054000, 0x00048000, 0x00040000, 0x00036000,          //; 008-032               ; briefing - sprite
	0x0002E000, 0x00028000, 0x00024000, 0x00022000,          //; 036-064               ; arbre souvent
	0x00021000, 0x00020000, 0x0001E000, 0x0001B800,          //; 068-096               ; map thunderstrike
	0x00019800, 0x00017A00, 0x00015C00, 0x00013E00,          //; 100-128               ; logo défoncé

	0x00012000, 0x00011800, 0x00011000, 0x00010800,          //; 132-160               ; briefing - map
	0x00010000, 0x0000F800, 0x0000F000, 0x0000E800,          //; 164-192
	0x0000E000, 0x0000D800, 0x0000D000, 0x0000C800,          //; 196-224
	0x0000C000, 0x0000B800, 0x0000B000, 0x0000A800,          //; 228-256               ; batman visage

	0x0000A000, 0x00009F00, 0x00009E00, 0x00009D00,          //; 260-288
	0x00009C00, 0x00009B00, 0x00009A00, 0x00009900,          //; 292-320
	0x00009800, 0x00009700, 0x00009600, 0x00009500,          //; 324-352
	0x00009400, 0x00009300, 0x00009200, 0x00009100,          //; 356-384

	0x00009000, 0x00008F00, 0x00008E00, 0x00008D00,          //; 388-416
	0x00008C00, 0x00008B00, 0x00008A00, 0x00008900,          //; 420-448
	0x00008800, 0x00008700, 0x00008600, 0x00008500,          //; 452-476
	0x00008400, 0x00008300, 0x00008200, 0x00008100,          //; 480-512
};


static void gfx_cd_start(void)
{
	int upd_len;

	// _rot_comp.XD_Mul = ((_rot_comp.Reg_5C & 0x1f) + 1) * 4; // unused
	_rot_comp.Function = (_rot_comp.Reg_58 & 7) | (Pico_mcd->s68k_regs[3] & 0x18);	// Jmp_Adr
	// _rot_comp.Buffer_Adr = (_rot_comp.Reg_5E & 0xfff8) << 2; // unused?
	_rot_comp.YD = (_rot_comp.Reg_60 >> 3) & 7;
	_rot_comp.Vector_Adr = (_rot_comp.Reg_66 & 0xfffe) << 2;

	upd_len = (_rot_comp.Reg_62 >> 3) & 0x3f;
	upd_len = Table_Rot_Time[upd_len];
	_rot_comp.Draw_Speed = _rot_comp.Float_Part = upd_len;

	_rot_comp.Reg_58 |= 0x8000;	// Stamp_Size,  we start a new GFX operation

	switch (_rot_comp.Reg_58 & 6)	// Scr_16?
	{
		case 0:	// ?
			_rot_comp.Stamp_Map_Adr = (_rot_comp.Reg_5A & 0xff80) << 2;
			break;
		case 2: // .Dot_32
			_rot_comp.Stamp_Map_Adr = (_rot_comp.Reg_5A & 0xffe0) << 2;
			break;
		case 4: // .Scr_16
			_rot_comp.Stamp_Map_Adr = 0x20000;
			break;
		case 6: // .Scr_16_Dot_32
			_rot_comp.Stamp_Map_Adr = (_rot_comp.Reg_5A & 0xe000) << 2;
			break;
	}

	dprintf("gfx_cd_start, stamp_map_addr=%06x", _rot_comp.Stamp_Map_Adr);

	gfx_cd_update();
}


static void gfx_completed(void)
{
	_rot_comp.Reg_58 &= 0x7fff;	// Stamp_Size
	_rot_comp.Reg_64  = 0;
	if (Pico_mcd->s68k_regs[0x33] & (1<<1))
	{
		elprintf(EL_INTS, "gfx_cd irq 1");
		SekInterruptS68k(1);
	}
}


static void gfx_do(unsigned int func, unsigned short *stamp_base, unsigned int H_Dot)
{
	unsigned int eax, ebx, ecx, edx, esi, edi, pixel;
	unsigned int XD, Buffer_Adr;
	int DYXS;

	XD = _rot_comp.Reg_60 & 7;
	Buffer_Adr = ((_rot_comp.Reg_5E & 0xfff8) + _rot_comp.YD) << 2;
	ecx = *(unsigned int *)(Pico_mcd->word_ram2M + _rot_comp.Vector_Adr);
	edx = ecx >> 16;
	ecx = (ecx & 0xffff) << 8;
	edx <<= 8;
	DYXS = *(int *)(Pico_mcd->word_ram2M + _rot_comp.Vector_Adr + 4);
	_rot_comp.Vector_Adr += 8;

	// MAKE_IMAGE_LINE
	while (H_Dot)
	{
		// MAKE_IMAGE_PIXEL
		if (!(func & 1))	// NOT TILED
		{
			int mask = (func & 4) ? 0x00800000 : 0x00f80000;
			if ((ecx | edx) & mask)
			{
				if (func & 0x18) goto Next_Pixel;
				pixel = 0;
				goto Pixel_Out;
			}
		}

		if (func & 2)		// mode 32x32 dot
		{
			if (func & 4)	// 16x16 screen
			{
				ebx = ((ecx >> (11+5)) & 0x007f) |
				      ((edx >> (11-2)) & 0x3f80);
			}
			else		// 1x1 screen
			{
				ebx = ((ecx >> (11+5)) & 0x07) |
				      ((edx >> (11+2)) & 0x38);
			}
		}
		else			// mode 16x16 dot
		{
			if (func & 4)	// 16x16 screen
			{
				ebx = ((ecx >> (11+4)) & 0x00ff) |
				      ((edx >> (11-4)) & 0xff00);
			}
			else		// 1x1 screen
			{
				ebx = ((ecx >> (11+4)) & 0x0f) |
				      ((edx >> (11+0)) & 0xf0);
			}
		}

		edi = stamp_base[ebx];
		esi = (edi & 0x7ff) << 7;
		if (!esi) { pixel = 0; goto Pixel_Out; }
		edi >>= (11+1);
		edi &= (0x1c>>1);
		eax = ecx;
		ebx = edx;
		if (func & 2) edi |= 1;	// 32 dots?
		switch (edi)
		{
			case 0x00:	// No_Flip_0, 16x16 dots
				ebx = (ebx >> 9) & 0x3c;
				ebx += esi;
				edi = (eax & 0x3800) ^ 0x1000;		// bswap
				eax = ((eax >> 8) & 0x40) + ebx;
				break;
			case 0x01:	// No_Flip_0, 32x32 dots
				ebx = (ebx >> 9) & 0x7c;
				ebx += esi;
				edi = (eax & 0x3800) ^ 0x1000;		// bswap
				eax = ((eax >> 7) & 0x180) + ebx;
				break;
			case 0x02:	// No_Flip_90, 16x16 dots
				eax = (eax >> 9) & 0x3c;
				eax += esi;
				edi = (ebx & 0x3800) ^ 0x2800;		// bswap
				eax += ((ebx >> 8) & 0x40) ^ 0x40;
				break;
			case 0x03:	// No_Flip_90, 32x32 dots
				eax = (eax >> 9) & 0x7c;
				eax += esi;
				edi = (ebx & 0x3800) ^ 0x2800;		// bswap
				eax += ((ebx >> 7) & 0x180) ^ 0x180;
				break;
			case 0x04:	// No_Flip_180, 16x16 dots
				ebx = ((ebx >> 9) & 0x3c) ^ 0x3c;
				ebx += esi;
				edi = (eax & 0x3800) ^ 0x2800;		// bswap and flip
				eax = (((eax >> 8) & 0x40) ^ 0x40) + ebx;
				break;
			case 0x05:	// No_Flip_180, 32x32 dots
				ebx = ((ebx >> 9) & 0x7c) ^ 0x7c;
				ebx += esi;
				edi = (eax & 0x3800) ^ 0x2800;		// bswap and flip
				eax = (((eax >> 7) & 0x180) ^ 0x180) + ebx;
				break;
			case 0x06:	// No_Flip_270, 16x16 dots
				eax = ((eax >> 9) & 0x3c) ^ 0x3c;
				eax += esi;
				edi = (ebx & 0x3800) ^ 0x1000;		// bswap
				eax += (ebx >> 8) & 0x40;
				break;
			case 0x07:	// No_Flip_270, 32x32 dots
				eax = ((eax >> 9) & 0x7c) ^ 0x7c;
				eax += esi;
				edi = (ebx & 0x3800) ^ 0x1000;		// bswap
				eax += (ebx >> 7) & 0x180;
				break;
			case 0x08:	// Flip_0, 16x16 dots
				ebx = (ebx >> 9) & 0x3c;
				ebx += esi;
				edi = (eax & 0x3800) ^ 0x2800;		// bswap, flip
				eax = (((eax >> 8) & 0x40) ^ 0x40) + ebx;
				break;
			case 0x09:	// Flip_0, 32x32 dots
				ebx = (ebx >> 9) & 0x7c;
				ebx += esi;
				edi = (eax & 0x3800) ^ 0x2800;		// bswap, flip
				eax = (((eax >> 7) & 0x180) ^ 0x180) + ebx;
				break;
			case 0x0a:	// Flip_90, 16x16 dots
				eax = ((eax >> 9) & 0x3c) ^ 0x3c;
				eax += esi;
				edi = (ebx & 0x3800) ^ 0x2800;		// bswap, flip
				eax += ((ebx >> 8) & 0x40) ^ 0x40;
				break;
			case 0x0b:	// Flip_90, 32x32 dots
				eax = ((eax >> 9) & 0x7c) ^ 0x7c;
				eax += esi;
				edi = (ebx & 0x3800) ^ 0x2800;		// bswap, flip
				eax += ((ebx >> 7) & 0x180) ^ 0x180;
				break;
			case 0x0c:	// Flip_180, 16x16 dots
				ebx = ((ebx >> 9) & 0x3c) ^ 0x3c;
				ebx += esi;
				edi = (eax & 0x3800) ^ 0x1000;		// bswap
				eax = ((eax >> 8) & 0x40) + ebx;
				break;
			case 0x0d:	// Flip_180, 32x32 dots
				ebx = ((ebx >> 9) & 0x7c) ^ 0x7c;
				ebx += esi;
				edi = (eax & 0x3800) ^ 0x1000;		// bswap
				eax = ((eax >> 7) & 0x180) + ebx;
				break;
			case 0x0e:	// Flip_270, 16x16 dots
				eax = (eax >> 9) & 0x3c;
				eax += esi;
				edi = (ebx & 0x3800) ^ 0x1000;		// bswap, flip
				eax += (ebx >> 8) & 0x40;
				break;
			case 0x0f:	// Flip_270, 32x32 dots
				eax = (eax >> 9) & 0x7c;
				eax += esi;
				edi = (ebx & 0x3800) ^ 0x1000;		// bswap, flip
				eax += (ebx >> 7) & 0x180;
				break;
		}

		pixel = *(Pico_mcd->word_ram2M + (edi >> 12) + eax);
		if (!(edi & 0x800)) pixel >>= 4;
		else pixel &= 0x0f;

Pixel_Out:
		if (!pixel && (func & 0x18)) goto Next_Pixel;
		esi = Buffer_Adr + ((XD>>1)^1);				// pixel addr
		eax = *(Pico_mcd->word_ram2M + esi);			// old pixel
		if (XD & 1)
		{
			if ((eax & 0x0f) && (func & 0x18) == 0x08) goto Next_Pixel; // underwrite
			*(Pico_mcd->word_ram2M + esi) = pixel | (eax & 0xf0);
		}
		else
		{
			if ((eax & 0xf0) && (func & 0x18) == 0x08) goto Next_Pixel; // underwrite
			*(Pico_mcd->word_ram2M + esi) = (pixel << 4) | (eax & 0xf);
		}


Next_Pixel:
		ecx += (DYXS << 16) >> 16;	// _rot_comp.DXS;
		edx +=  DYXS >> 16;		// _rot_comp.DYS;
		XD++;
		if (XD >= 8)
		{
			Buffer_Adr += ((_rot_comp.Reg_5C & 0x1f) + 1) << 5;
			XD = 0;
		}
		H_Dot--;
	}
	// end while


// nothing_to_draw:
	_rot_comp.YD++;
	// _rot_comp.V_Dot--; // will be done by caller
}


PICO_INTERNAL void gfx_cd_update(void)
{
	int V_Dot = _rot_comp.Reg_64 & 0xff;
	int jobs;

	dprintf("gfx_cd_update, Reg_64 = %04x", _rot_comp.Reg_64);

	if (!V_Dot)
	{
		gfx_completed();
		return;
	}

	jobs = _rot_comp.Float_Part >> 16;

	if (!jobs)
	{
		_rot_comp.Float_Part += _rot_comp.Draw_Speed;
		return;
	}

	_rot_comp.Float_Part &= 0xffff;
	_rot_comp.Float_Part += _rot_comp.Draw_Speed;

	if (PicoOpt & POPT_EN_MCD_GFX)
	{
		unsigned int func = _rot_comp.Function;
		unsigned int H_Dot = _rot_comp.Reg_62 & 0x1ff;
		unsigned short *stamp_base = (unsigned short *) (Pico_mcd->word_ram2M + _rot_comp.Stamp_Map_Adr);

		while (jobs--)
		{
			gfx_do(func, stamp_base, H_Dot);	// jmp [Jmp_Adr]:

			V_Dot--;				// dec byte [V_Dot]
			if (V_Dot == 0)
			{
				// GFX_Completed:
				gfx_completed();
				return;
			}
		}
	}
	else
	{
		if (jobs >= V_Dot)
		{
			gfx_completed();
			return;
		}
		V_Dot -= jobs;
	}

	_rot_comp.Reg_64 = V_Dot;
}


PICO_INTERNAL_ASM unsigned int gfx_cd_read(unsigned int a)
{
	unsigned int d = 0;

	switch (a) {
		case 0x58: d = _rot_comp.Reg_58; break;
		case 0x5A: d = _rot_comp.Reg_5A; break;
		case 0x5C: d = _rot_comp.Reg_5C; break;
		case 0x5E: d = _rot_comp.Reg_5E; break;
		case 0x60: d = _rot_comp.Reg_60; break;
		case 0x62: d = _rot_comp.Reg_62; break;
		case 0x64: d = _rot_comp.Reg_64; break;
		case 0x66: break;
		default: dprintf("gfx_cd_read FIXME: unexpected address: %02x", a); break;
	}

	dprintf("gfx_cd_read(%02x) = %04x", a, d);

	return d;
}

PICO_INTERNAL_ASM void gfx_cd_write16(unsigned int a, unsigned int d)
{
	dprintf("gfx_cd_write16(%x, %04x)", a, d);

	switch (a) {
		case 0x58: // .Reg_Stamp_Size
			_rot_comp.Reg_58 = d & 7;
			return;

		case 0x5A: // .Reg_Stamp_Adr
			_rot_comp.Reg_5A = d & 0xffe0;
			return;

		case 0x5C: // .Reg_IM_VCell_Size
			_rot_comp.Reg_5C = d & 0x1f;
			return;

		case 0x5E: // .Reg_IM_Adr
			_rot_comp.Reg_5E = d & 0xFFF8;
			return;

		case 0x60: // .Reg_IM_Offset
			_rot_comp.Reg_60 = d & 0x3f;
			return;

		case 0x62: // .Reg_IM_HDot_Size
			_rot_comp.Reg_62 = d & 0x1ff;
			return;

		case 0x64: // .Reg_IM_VDot_Size
			_rot_comp.Reg_64 = d & 0xff;	// V_Dot, must be 32bit?
			return;

		case 0x66: // .Reg_Vector_Adr
			_rot_comp.Reg_66 = d & 0xfffe;
			if (Pico_mcd->s68k_regs[3]&4) return; // can't do tanformations in 1M mode
			gfx_cd_start();
			return;

		default: dprintf("gfx_cd_write16 FIXME: unexpected address: %02x", a); return;
	}
}


PICO_INTERNAL void gfx_cd_reset(void)
{
	memset(&_rot_comp.Reg_58, 0, sizeof(_rot_comp));
}


// --------------------------------

#include "cell_map.c"

#ifndef UTYPES_DEFINED
typedef unsigned short u16;
#endif

// check: Heart of the alien, jaguar xj 220
PICO_INTERNAL void DmaSlowCell(unsigned int source, unsigned int a, int len, unsigned char inc)
{
  unsigned char *base;
  unsigned int asrc, a2;
  u16 *r;

  base = Pico_mcd->word_ram1M[Pico_mcd->s68k_regs[3]&1];

  switch (Pico.video.type)
  {
    case 1: // vram
      r = Pico.vram;
      for(; len; len--)
      {
        asrc = cell_map(source >> 2) << 2;
        asrc |= source & 2;
        // if(a&1) d=(d<<8)|(d>>8); // ??
        r[a>>1] = *(u16 *)(base + asrc);
	source += 2;
        // AutoIncrement
        a=(u16)(a+inc);
      }
      rendstatus |= PDRAW_SPRITES_MOVED;
      break;

    case 3: // cram
      Pico.m.dirtyPal = 1;
      r = Pico.cram;
      for(a2=a&0x7f; len; len--)
      {
        asrc = cell_map(source >> 2) << 2;
        asrc |= source & 2;
        r[a2>>1] = *(u16 *)(base + asrc);
	source += 2;
        // AutoIncrement
        a2+=inc;
        // good dest?
        if(a2 >= 0x80) break;
      }
      a=(a&0xff00)|a2;
      break;

    case 5: // vsram[a&0x003f]=d;
      r = Pico.vsram;
      for(a2=a&0x7f; len; len--)
      {
        asrc = cell_map(source >> 2) << 2;
        asrc |= source & 2;
        r[a2>>1] = *(u16 *)(base + asrc);
	source += 2;
        // AutoIncrement
        a2+=inc;
        // good dest?
        if(a2 >= 0x80) break;
      }
      a=(a&0xff00)|a2;
      break;
  }
  // remember addr
  Pico.video.addr=(u16)a;
}
Commit	Line	Data
6cadc2da	1	// This is a direct rewrite of gfx_cd.asm (x86 asm to C).
	2	// You can even find some x86 register names :)
	3	// Original code (c) 2002 by Stéphane Dallongeville
	4
	5	// (c) Copyright 2007, Grazvydas "notaz" Ignotas
	6
cb4a513a	7
efcba75f	8	#include "../pico_int.h"
cb4a513a	9
9c9cda8c	10	#undef dprintf
	11	#define dprintf(...)
	12
eff55556	13	#define _rot_comp Pico_mcd->rot_comp
d1df8786	14
75736070	15	static const int Table_Rot_Time[] =
d1df8786	16	{
	17	0x00054000, 0x00048000, 0x00040000, 0x00036000, //; 008-032 ; briefing - sprite
	18	0x0002E000, 0x00028000, 0x00024000, 0x00022000, //; 036-064 ; arbre souvent
	19	0x00021000, 0x00020000, 0x0001E000, 0x0001B800, //; 068-096 ; map thunderstrike
	20	0x00019800, 0x00017A00, 0x00015C00, 0x00013E00, //; 100-128 ; logo défoncé
	21
	22	0x00012000, 0x00011800, 0x00011000, 0x00010800, //; 132-160 ; briefing - map
	23	0x00010000, 0x0000F800, 0x0000F000, 0x0000E800, //; 164-192
	24	0x0000E000, 0x0000D800, 0x0000D000, 0x0000C800, //; 196-224
	25	0x0000C000, 0x0000B800, 0x0000B000, 0x0000A800, //; 228-256 ; batman visage
	26
	27	0x0000A000, 0x00009F00, 0x00009E00, 0x00009D00, //; 260-288
	28	0x00009C00, 0x00009B00, 0x00009A00, 0x00009900, //; 292-320
	29	0x00009800, 0x00009700, 0x00009600, 0x00009500, //; 324-352
	30	0x00009400, 0x00009300, 0x00009200, 0x00009100, //; 356-384
	31
	32	0x00009000, 0x00008F00, 0x00008E00, 0x00008D00, //; 388-416
	33	0x00008C00, 0x00008B00, 0x00008A00, 0x00008900, //; 420-448
	34	0x00008800, 0x00008700, 0x00008600, 0x00008500, //; 452-476
	35	0x00008400, 0x00008300, 0x00008200, 0x00008100, //; 480-512
	36	};
	37
	38
cb4a513a	39	static void gfx_cd_start(void)
cb4a513a	40	{
d1df8786	41	int upd_len;
d1df8786	42
eff55556	43	// _rot_comp.XD_Mul = ((_rot_comp.Reg_5C & 0x1f) + 1) * 4; // unused
	44	_rot_comp.Function = (_rot_comp.Reg_58 & 7) \| (Pico_mcd->s68k_regs[3] & 0x18); // Jmp_Adr
	45	// _rot_comp.Buffer_Adr = (_rot_comp.Reg_5E & 0xfff8) << 2; // unused?
	46	_rot_comp.YD = (_rot_comp.Reg_60 >> 3) & 7;
	47	_rot_comp.Vector_Adr = (_rot_comp.Reg_66 & 0xfffe) << 2;
a4030801	48
eff55556	49	upd_len = (_rot_comp.Reg_62 >> 3) & 0x3f;
d1df8786	50	upd_len = Table_Rot_Time[upd_len];
eff55556	51	_rot_comp.Draw_Speed = _rot_comp.Float_Part = upd_len;
d1df8786	52
eff55556	53	_rot_comp.Reg_58 \|= 0x8000; // Stamp_Size, we start a new GFX operation
d1df8786	54
eff55556	55	switch (_rot_comp.Reg_58 & 6) // Scr_16?
a4030801	56	{
a4030801	57	case 0: // ?
eff55556	58	_rot_comp.Stamp_Map_Adr = (_rot_comp.Reg_5A & 0xff80) << 2;
a4030801	59	break;
a4030801	60	case 2: // .Dot_32
eff55556	61	_rot_comp.Stamp_Map_Adr = (_rot_comp.Reg_5A & 0xffe0) << 2;
a4030801	62	break;
a4030801	63	case 4: // .Scr_16
eff55556	64	_rot_comp.Stamp_Map_Adr = 0x20000;
a4030801	65	break;
a4030801	66	case 6: // .Scr_16_Dot_32
eff55556	67	_rot_comp.Stamp_Map_Adr = (_rot_comp.Reg_5A & 0xe000) << 2;
a4030801	68	break;
	69	}
	70
eff55556	71	dprintf("gfx_cd_start, stamp_map_addr=%06x", _rot_comp.Stamp_Map_Adr);
c008977e	72
d1df8786	73	gfx_cd_update();
	74	}
	75
	76
	77	static void gfx_completed(void)
	78	{
eff55556	79	_rot_comp.Reg_58 &= 0x7fff; // Stamp_Size
eff55556	80	_rot_comp.Reg_64 = 0;
cb4a513a	81	if (Pico_mcd->s68k_regs[0x33] & (1<<1))
cb4a513a	82	{
ca61ee42	83	elprintf(EL_INTS, "gfx_cd irq 1");
cb4a513a	84	SekInterruptS68k(1);
	85	}
	86	}
	87
d1df8786	88
00bd648e	89	static void gfx_do(unsigned int func, unsigned short *stamp_base, unsigned int H_Dot)
a4030801	90	{
528ec956	91	unsigned int eax, ebx, ecx, edx, esi, edi, pixel;
00bd648e	92	unsigned int XD, Buffer_Adr;
528ec956	93	int DYXS;
a4030801	94
eff55556	95	XD = _rot_comp.Reg_60 & 7;
	96	Buffer_Adr = ((_rot_comp.Reg_5E & 0xfff8) + _rot_comp.YD) << 2;
	97	ecx = (unsigned int )(Pico_mcd->word_ram2M + _rot_comp.Vector_Adr);
a4030801	98	edx = ecx >> 16;
	99	ecx = (ecx & 0xffff) << 8;
	100	edx <<= 8;
eff55556	101	DYXS = (int )(Pico_mcd->word_ram2M + _rot_comp.Vector_Adr + 4);
eff55556	102	_rot_comp.Vector_Adr += 8;
a4030801	103
a4030801	104	// MAKE_IMAGE_LINE
528ec956	105	while (H_Dot)
a4030801	106	{
c008977e	107	// MAKE_IMAGE_PIXEL
	108	if (!(func & 1)) // NOT TILED
	109	{
	110	int mask = (func & 4) ? 0x00800000 : 0x00f80000;
	111	if ((ecx \| edx) & mask)
	112	{
	113	if (func & 0x18) goto Next_Pixel;
	114	pixel = 0;
	115	goto Pixel_Out;
	116	}
	117	}
	118
a4030801	119	if (func & 2) // mode 32x32 dot
	120	{
	121	if (func & 4) // 16x16 screen
	122	{
00bd648e	123	ebx = ((ecx >> (11+5)) & 0x007f) \|
00bd648e	124	((edx >> (11-2)) & 0x3f80);
a4030801	125	}
	126	else // 1x1 screen
	127	{
00bd648e	128	ebx = ((ecx >> (11+5)) & 0x07) \|
00bd648e	129	((edx >> (11+2)) & 0x38);
a4030801	130	}
	131	}
	132	else // mode 16x16 dot
	133	{
	134	if (func & 4) // 16x16 screen
	135	{
00bd648e	136	ebx = ((ecx >> (11+4)) & 0x00ff) \|
00bd648e	137	((edx >> (11-4)) & 0xff00);
a4030801	138	}
	139	else // 1x1 screen
	140	{
00bd648e	141	ebx = ((ecx >> (11+4)) & 0x0f) \|
00bd648e	142	((edx >> (11+0)) & 0xf0);
a4030801	143	}
a4030801	144	}
a4030801	145
c008977e	146	edi = stamp_base[ebx];
00bd648e	147	esi = (edi & 0x7ff) << 7;
528ec956	148	if (!esi) { pixel = 0; goto Pixel_Out; }
00bd648e	149	edi >>= (11+1);
a4030801	150	edi &= (0x1c>>1);
	151	eax = ecx;
	152	ebx = edx;
	153	if (func & 2) edi \|= 1; // 32 dots?
	154	switch (edi)
	155	{
	156	case 0x00: // No_Flip_0, 16x16 dots
	157	ebx = (ebx >> 9) & 0x3c;
	158	ebx += esi;
	159	edi = (eax & 0x3800) ^ 0x1000; // bswap
	160	eax = ((eax >> 8) & 0x40) + ebx;
a4030801	161	break;
	162	case 0x01: // No_Flip_0, 32x32 dots
	163	ebx = (ebx >> 9) & 0x7c;
	164	ebx += esi;
	165	edi = (eax & 0x3800) ^ 0x1000; // bswap
	166	eax = ((eax >> 7) & 0x180) + ebx;
a4030801	167	break;
	168	case 0x02: // No_Flip_90, 16x16 dots
	169	eax = (eax >> 9) & 0x3c;
	170	eax += esi;
	171	edi = (ebx & 0x3800) ^ 0x2800; // bswap
	172	eax += ((ebx >> 8) & 0x40) ^ 0x40;
a4030801	173	break;
	174	case 0x03: // No_Flip_90, 32x32 dots
	175	eax = (eax >> 9) & 0x7c;
	176	eax += esi;
	177	edi = (ebx & 0x3800) ^ 0x2800; // bswap
01bc6b19	178	eax += ((ebx >> 7) & 0x180) ^ 0x180;
a4030801	179	break;
	180	case 0x04: // No_Flip_180, 16x16 dots
	181	ebx = ((ebx >> 9) & 0x3c) ^ 0x3c;
	182	ebx += esi;
	183	edi = (eax & 0x3800) ^ 0x2800; // bswap and flip
	184	eax = (((eax >> 8) & 0x40) ^ 0x40) + ebx;
a4030801	185	break;
	186	case 0x05: // No_Flip_180, 32x32 dots
	187	ebx = ((ebx >> 9) & 0x7c) ^ 0x7c;
	188	ebx += esi;
	189	edi = (eax & 0x3800) ^ 0x2800; // bswap and flip
	190	eax = (((eax >> 7) & 0x180) ^ 0x180) + ebx;
a4030801	191	break;
	192	case 0x06: // No_Flip_270, 16x16 dots
	193	eax = ((eax >> 9) & 0x3c) ^ 0x3c;
	194	eax += esi;
	195	edi = (ebx & 0x3800) ^ 0x1000; // bswap
	196	eax += (ebx >> 8) & 0x40;
a4030801	197	break;
	198	case 0x07: // No_Flip_270, 32x32 dots
	199	eax = ((eax >> 9) & 0x7c) ^ 0x7c;
	200	eax += esi;
	201	edi = (ebx & 0x3800) ^ 0x1000; // bswap
	202	eax += (ebx >> 7) & 0x180;
a4030801	203	break;
a4030801	204	case 0x08: // Flip_0, 16x16 dots
01bc6b19	205	ebx = (ebx >> 9) & 0x3c;
a4030801	206	ebx += esi;
	207	edi = (eax & 0x3800) ^ 0x2800; // bswap, flip
	208	eax = (((eax >> 8) & 0x40) ^ 0x40) + ebx;
a4030801	209	break;
a4030801	210	case 0x09: // Flip_0, 32x32 dots
01bc6b19	211	ebx = (ebx >> 9) & 0x7c;
a4030801	212	ebx += esi;
	213	edi = (eax & 0x3800) ^ 0x2800; // bswap, flip
	214	eax = (((eax >> 7) & 0x180) ^ 0x180) + ebx;
a4030801	215	break;
	216	case 0x0a: // Flip_90, 16x16 dots
	217	eax = ((eax >> 9) & 0x3c) ^ 0x3c;
	218	eax += esi;
	219	edi = (ebx & 0x3800) ^ 0x2800; // bswap, flip
	220	eax += ((ebx >> 8) & 0x40) ^ 0x40;
a4030801	221	break;
	222	case 0x0b: // Flip_90, 32x32 dots
	223	eax = ((eax >> 9) & 0x7c) ^ 0x7c;
	224	eax += esi;
	225	edi = (ebx & 0x3800) ^ 0x2800; // bswap, flip
	226	eax += ((ebx >> 7) & 0x180) ^ 0x180;
a4030801	227	break;
	228	case 0x0c: // Flip_180, 16x16 dots
	229	ebx = ((ebx >> 9) & 0x3c) ^ 0x3c;
	230	ebx += esi;
	231	edi = (eax & 0x3800) ^ 0x1000; // bswap
	232	eax = ((eax >> 8) & 0x40) + ebx;
a4030801	233	break;
	234	case 0x0d: // Flip_180, 32x32 dots
	235	ebx = ((ebx >> 9) & 0x7c) ^ 0x7c;
	236	ebx += esi;
	237	edi = (eax & 0x3800) ^ 0x1000; // bswap
	238	eax = ((eax >> 7) & 0x180) + ebx;
a4030801	239	break;
	240	case 0x0e: // Flip_270, 16x16 dots
	241	eax = (eax >> 9) & 0x3c;
	242	eax += esi;
	243	edi = (ebx & 0x3800) ^ 0x1000; // bswap, flip
	244	eax += (ebx >> 8) & 0x40;
a4030801	245	break;
	246	case 0x0f: // Flip_270, 32x32 dots
	247	eax = (eax >> 9) & 0x7c;
	248	eax += esi;
	249	edi = (ebx & 0x3800) ^ 0x1000; // bswap, flip
	250	eax += (ebx >> 7) & 0x180;
a4030801	251	break;
	252	}
	253
01bc6b19	254	pixel = *(Pico_mcd->word_ram2M + (edi >> 12) + eax);
01bc6b19	255	if (!(edi & 0x800)) pixel >>= 4;
528ec956	256	else pixel &= 0x0f;
01bc6b19	257
a4030801	258	Pixel_Out:
a4030801	259	if (!pixel && (func & 0x18)) goto Next_Pixel;
528ec956	260	esi = Buffer_Adr + ((XD>>1)^1); // pixel addr
a4030801	261	eax = *(Pico_mcd->word_ram2M + esi); // old pixel
528ec956	262	if (XD & 1)
a4030801	263	{
	264	if ((eax & 0x0f) && (func & 0x18) == 0x08) goto Next_Pixel; // underwrite
	265	*(Pico_mcd->word_ram2M + esi) = pixel \| (eax & 0xf0);
	266	}
	267	else
	268	{
	269	if ((eax & 0xf0) && (func & 0x18) == 0x08) goto Next_Pixel; // underwrite
	270	*(Pico_mcd->word_ram2M + esi) = (pixel << 4) \| (eax & 0xf);
	271	}
	272
	273
	274	Next_Pixel:
eff55556	275	ecx += (DYXS << 16) >> 16; // _rot_comp.DXS;
eff55556	276	edx += DYXS >> 16; // _rot_comp.DYS;
528ec956	277	XD++;
528ec956	278	if (XD >= 8)
a4030801	279	{
eff55556	280	Buffer_Adr += ((_rot_comp.Reg_5C & 0x1f) + 1) << 5;
528ec956	281	XD = 0;
a4030801	282	}
528ec956	283	H_Dot--;
a4030801	284	}
528ec956	285	// end while
a4030801	286
a4030801	287
00bd648e	288	// nothing_to_draw:
eff55556	289	_rot_comp.YD++;
eff55556	290	// _rot_comp.V_Dot--; // will be done by caller
a4030801	291	}
d1df8786	292
d1df8786	293
eff55556	294	PICO_INTERNAL void gfx_cd_update(void)
cb4a513a	295	{
eff55556	296	int V_Dot = _rot_comp.Reg_64 & 0xff;
d1df8786	297	int jobs;
d1df8786	298
eff55556	299	dprintf("gfx_cd_update, Reg_64 = %04x", _rot_comp.Reg_64);
d1df8786	300
00bd648e	301	if (!V_Dot)
d1df8786	302	{
d1df8786	303	gfx_completed();
	304	return;
	305	}
	306
eff55556	307	jobs = _rot_comp.Float_Part >> 16;
d1df8786	308
	309	if (!jobs)
	310	{
eff55556	311	_rot_comp.Float_Part += _rot_comp.Draw_Speed;
d1df8786	312	return;
	313	}
	314
eff55556	315	_rot_comp.Float_Part &= 0xffff;
eff55556	316	_rot_comp.Float_Part += _rot_comp.Draw_Speed;
d1df8786	317
602133e1	318	if (PicoOpt & POPT_EN_MCD_GFX)
d1df8786	319	{
eff55556	320	unsigned int func = _rot_comp.Function;
	321	unsigned int H_Dot = _rot_comp.Reg_62 & 0x1ff;
	322	unsigned short stamp_base = (unsigned short ) (Pico_mcd->word_ram2M + _rot_comp.Stamp_Map_Adr);
a4030801	323
00bd648e	324	while (jobs--)
	325	{
	326	gfx_do(func, stamp_base, H_Dot); // jmp [Jmp_Adr]:
d1df8786	327
00bd648e	328	V_Dot--; // dec byte [V_Dot]
	329	if (V_Dot == 0)
	330	{
	331	// GFX_Completed:
	332	gfx_completed();
	333	return;
	334	}
	335	}
	336	}
	337	else
	338	{
	339	if (jobs >= V_Dot)
d1df8786	340	{
d1df8786	341	gfx_completed();
	342	return;
	343	}
00bd648e	344	V_Dot -= jobs;
d1df8786	345	}
00bd648e	346
eff55556	347	_rot_comp.Reg_64 = V_Dot;
cb4a513a	348	}
	349
	350
eff55556	351	PICO_INTERNAL_ASM unsigned int gfx_cd_read(unsigned int a)
cb4a513a	352	{
d1df8786	353	unsigned int d = 0;
	354
	355	switch (a) {
eff55556	356	case 0x58: d = _rot_comp.Reg_58; break;
	357	case 0x5A: d = _rot_comp.Reg_5A; break;
	358	case 0x5C: d = _rot_comp.Reg_5C; break;
	359	case 0x5E: d = _rot_comp.Reg_5E; break;
	360	case 0x60: d = _rot_comp.Reg_60; break;
	361	case 0x62: d = _rot_comp.Reg_62; break;
	362	case 0x64: d = _rot_comp.Reg_64; break;
d1df8786	363	case 0x66: break;
fa1e5e29	364	default: dprintf("gfx_cd_read FIXME: unexpected address: %02x", a); break;
d1df8786	365	}
	366
	367	dprintf("gfx_cd_read(%02x) = %04x", a, d);
cb4a513a	368
89fa852d	369	return d;
cb4a513a	370	}
cb4a513a	371
eff55556	372	PICO_INTERNAL_ASM void gfx_cd_write16(unsigned int a, unsigned int d)
cb4a513a	373	{
5c69a605	374	dprintf("gfx_cd_write16(%x, %04x)", a, d);
cb4a513a	375
cb4a513a	376	switch (a) {
d1df8786	377	case 0x58: // .Reg_Stamp_Size
eff55556	378	_rot_comp.Reg_58 = d & 7;
d1df8786	379	return;
	380
	381	case 0x5A: // .Reg_Stamp_Adr
eff55556	382	_rot_comp.Reg_5A = d & 0xffe0;
d1df8786	383	return;
	384
	385	case 0x5C: // .Reg_IM_VCell_Size
eff55556	386	_rot_comp.Reg_5C = d & 0x1f;
d1df8786	387	return;
	388
	389	case 0x5E: // .Reg_IM_Adr
eff55556	390	_rot_comp.Reg_5E = d & 0xFFF8;
d1df8786	391	return;
	392
	393	case 0x60: // .Reg_IM_Offset
eff55556	394	_rot_comp.Reg_60 = d & 0x3f;
d1df8786	395	return;
	396
	397	case 0x62: // .Reg_IM_HDot_Size
eff55556	398	_rot_comp.Reg_62 = d & 0x1ff;
d1df8786	399	return;
	400
	401	case 0x64: // .Reg_IM_VDot_Size
eff55556	402	_rot_comp.Reg_64 = d & 0xff; // V_Dot, must be 32bit?
d1df8786	403	return;
	404
	405	case 0x66: // .Reg_Vector_Adr
eff55556	406	_rot_comp.Reg_66 = d & 0xfffe;
cb4a513a	407	if (Pico_mcd->s68k_regs[3]&4) return; // can't do tanformations in 1M mode
	408	gfx_cd_start();
	409	return;
d1df8786	410
5c69a605	411	default: dprintf("gfx_cd_write16 FIXME: unexpected address: %02x", a); return;
cb4a513a	412	}
	413	}
	414
d1df8786	415
eff55556	416	PICO_INTERNAL void gfx_cd_reset(void)
51a902ae	417	{
eff55556	418	memset(&_rot_comp.Reg_58, 0, sizeof(_rot_comp));
fa1e5e29	419	}
	420
	421
	422	// --------------------------------
	423
	424	#include "cell_map.c"
	425
eff55556	426	#ifndef UTYPES_DEFINED
fa1e5e29	427	typedef unsigned short u16;
eff55556	428	#endif
fa1e5e29	429
0a051f55	430	// check: Heart of the alien, jaguar xj 220
eff55556	431	PICO_INTERNAL void DmaSlowCell(unsigned int source, unsigned int a, int len, unsigned char inc)
fa1e5e29	432	{
	433	unsigned char *base;
	434	unsigned int asrc, a2;
	435	u16 *r;
	436
	437	base = Pico_mcd->word_ram1M[Pico_mcd->s68k_regs[3]&1];
	438
	439	switch (Pico.video.type)
	440	{
	441	case 1: // vram
	442	r = Pico.vram;
	443	for(; len; len--)
	444	{
	445	asrc = cell_map(source >> 2) << 2;
	446	asrc \|= source & 2;
	447	// if(a&1) d=(d<<8)\|(d>>8); // ??
	448	r[a>>1] = (u16 )(base + asrc);
	449	source += 2;
	450	// AutoIncrement
	451	a=(u16)(a+inc);
	452	}
602133e1	453	rendstatus \|= PDRAW_SPRITES_MOVED;
fa1e5e29	454	break;
	455
	456	case 3: // cram
	457	Pico.m.dirtyPal = 1;
	458	r = Pico.cram;
	459	for(a2=a&0x7f; len; len--)
	460	{
	461	asrc = cell_map(source >> 2) << 2;
	462	asrc \|= source & 2;
	463	r[a2>>1] = (u16 )(base + asrc);
	464	source += 2;
	465	// AutoIncrement
	466	a2+=inc;
	467	// good dest?
	468	if(a2 >= 0x80) break;
	469	}
	470	a=(a&0xff00)\|a2;
	471	break;
	472
	473	case 5: // vsram[a&0x003f]=d;
	474	r = Pico.vsram;
	475	for(a2=a&0x7f; len; len--)
	476	{
	477	asrc = cell_map(source >> 2) << 2;
	478	asrc \|= source & 2;
	479	r[a2>>1] = (u16 )(base + asrc);
	480	source += 2;
	481	// AutoIncrement
	482	a2+=inc;
	483	// good dest?
	484	if(a2 >= 0x80) break;
	485	}
	486	a=(a&0xff00)\|a2;
	487	break;
	488	}
	489	// remember addr
	490	Pico.video.addr=(u16)a;
51a902ae	491	}
51a902ae	492