[picodrive.git] / pico / z80if.c

#include "pico_int.h"
#include "sound/sn76496.h"

#define Z80_MEM_SHIFT 13

unsigned long z80_read_map [0x10000 >> Z80_MEM_SHIFT];
unsigned long z80_write_map[0x10000 >> Z80_MEM_SHIFT];

void MEMH_FUNC z80_map_set(unsigned long *map, int start_addr, int end_addr,
    void *func_or_mh, int is_func)
{
  unsigned long addr = (unsigned long)func_or_mh;
  int mask = (1 << Z80_MEM_SHIFT) - 1;
  int i;

  if ((start_addr & mask) != 0 || (end_addr & mask) != mask)
    elprintf(EL_STATUS|EL_ANOMALY, "z80_map_set: tried to map bad range: %04x-%04x",
      start_addr, end_addr);

  if (addr & 1) {
    elprintf(EL_STATUS|EL_ANOMALY, "z80_map_set: ptr is not aligned: %08lx", addr);
    return;
  }

  for (i = start_addr >> Z80_MEM_SHIFT; i <= end_addr >> Z80_MEM_SHIFT; i++)
    if (is_func)
      map[i] = (addr >> 1) | (1 << (sizeof(addr) * 8 - 1));
    else
      map[i] = (addr - (i << Z80_MEM_SHIFT)) >> 1;
}

#ifdef _USE_MZ80

// memhandlers for mz80 core
unsigned char mz80_read(UINT32 a,  struct MemoryReadByte *w)  { return z80_read(a); }
void mz80_write(UINT32 a, UINT8 d, struct MemoryWriteByte *w) { z80_write(d, a); }

// structures for mz80 core
static struct MemoryReadByte mz80_mem_read[]=
{
  {0x0000,0xffff,mz80_read},
  {(UINT32) -1,(UINT32) -1,NULL}
};
static struct MemoryWriteByte mz80_mem_write[]=
{
  {0x0000,0xffff,mz80_write},
  {(UINT32) -1,(UINT32) -1,NULL}
};
static struct z80PortRead mz80_io_read[] ={
  {(UINT16) -1,(UINT16) -1,NULL}
};
static struct z80PortWrite mz80_io_write[]={
  {(UINT16) -1,(UINT16) -1,NULL}
};

int mz80_run(int cycles)
{
  int ticks_pre = mz80GetElapsedTicks(0);
  mz80exec(cycles);
  return mz80GetElapsedTicks(0) - ticks_pre;
}

#endif

#ifdef _USE_DRZ80
struct DrZ80 drZ80;
#endif


PICO_INTERNAL void z80_init(void)
{
#ifdef _USE_MZ80
  struct mz80context z80;

  // z80
  mz80init();
  // Modify the default context
  mz80GetContext(&z80);

  // point mz80 stuff
  z80.z80Base=Pico.zram;
  z80.z80MemRead=mz80_mem_read;
  z80.z80MemWrite=mz80_mem_write;
  z80.z80IoRead=mz80_io_read;
  z80.z80IoWrite=mz80_io_write;

  mz80SetContext(&z80);
#endif
#ifdef _USE_DRZ80
  memset(&drZ80, 0, sizeof(drZ80));
  drZ80.z80_rebasePC=NULL; // unused, handled by xmap
  drZ80.z80_rebaseSP=NULL;
  drZ80.z80_read8   =(void *)z80_read_map;
  drZ80.z80_read16  =NULL;
  drZ80.z80_write8  =(void *)z80_write_map;
  drZ80.z80_write16 =NULL;
  drZ80.z80_irq_callback=NULL;
#endif
#ifdef _USE_CZ80
  memset(&CZ80, 0, sizeof(CZ80));
  Cz80_Init(&CZ80);
  Cz80_Set_ReadB(&CZ80, NULL); // unused (hacked in)
  Cz80_Set_WriteB(&CZ80, NULL);
#endif
}

PICO_INTERNAL void z80_reset(void)
{
#ifdef _USE_MZ80
  mz80reset();
#endif
#ifdef _USE_DRZ80
  memset(&drZ80, 0, 0x54);
  drZ80.Z80F  = (1<<2);  // set ZFlag
  drZ80.Z80F2 = (1<<2);  // set ZFlag
  drZ80.Z80IX = 0xFFFF << 16;
  drZ80.Z80IY = 0xFFFF << 16;
  drZ80.Z80IM = 0; // 1?
  drZ80.z80irqvector = 0xff0000; // RST 38h
  drZ80.Z80PC_BASE = drZ80.Z80PC = z80_read_map[0] << 1;
  // drZ80 is locked in single bank
  drZ80.Z80SP_BASE = ((PicoAHW & PAHW_SMS) ?
    z80_read_map[0xc000 >> Z80_MEM_SHIFT] : z80_read_map[0]) << 1;
//  drZ80.Z80SP = drZ80.z80_rebaseSP(0x2000); // 0xf000 ?
#endif
#ifdef _USE_CZ80
  Cz80_Reset(&CZ80);
  Cz80_Set_Reg(&CZ80, CZ80_IX, 0xffff);
  Cz80_Set_Reg(&CZ80, CZ80_IY, 0xffff);
  Cz80_Set_Reg(&CZ80, CZ80_SP, 0x2000);
#endif
  Pico.m.z80_fakeval = 0; // for faking when Z80 is disabled
}

// XXX TODO: should better use universal z80 save format
PICO_INTERNAL void z80_pack(unsigned char *data)
{
#if defined(_USE_MZ80)
  struct mz80context mz80;
  *(int *)data = 0x00005A6D; // "mZ"
  mz80GetContext(&mz80);
  memcpy(data+4, &mz80.z80clockticks, sizeof(mz80)-5*4); // don't save base&memhandlers
#elif defined(_USE_DRZ80)
  *(int *)data = 0x015A7244; // "DrZ" v1
//  drZ80.Z80PC = drZ80.z80_rebasePC(drZ80.Z80PC-drZ80.Z80PC_BASE);
//  drZ80.Z80SP = drZ80.z80_rebaseSP(drZ80.Z80SP-drZ80.Z80SP_BASE);
  memcpy(data+4, &drZ80, 0x54);
#elif defined(_USE_CZ80)
  *(int *)data = 0x00007a43; // "Cz"
  *(int *)(data+4) = Cz80_Get_Reg(&CZ80, CZ80_PC);
  memcpy(data+8, &CZ80, (INT32)&CZ80.BasePC - (INT32)&CZ80);
#endif
}

PICO_INTERNAL void z80_unpack(unsigned char *data)
{
#if defined(_USE_MZ80)
  if (*(int *)data == 0x00005A6D) { // "mZ" save?
    struct mz80context mz80;
    mz80GetContext(&mz80);
    memcpy(&mz80.z80clockticks, data+4, sizeof(mz80)-5*4);
    mz80SetContext(&mz80);
  } else {
    z80_reset();
    z80_int();
  }
#elif defined(_USE_DRZ80)
  if (*(int *)data == 0x015A7244) { // "DrZ" v1 save?
    int pc, sp;
    memcpy(&drZ80, data+4, 0x54);
    pc = (drZ80.Z80PC - drZ80.Z80PC_BASE) & 0xffff;
    sp = (drZ80.Z80SP - drZ80.Z80SP_BASE) & 0xffff;
    // update bases
    drZ80.Z80PC_BASE = z80_read_map[pc >> Z80_MEM_SHIFT];
    if (drZ80.Z80PC & (1<<31)) {
      elprintf(EL_STATUS|EL_ANOMALY, "bad PC in z80 save: %04x", pc);
      drZ80.Z80PC_BASE = drZ80.Z80PC = z80_read_map[0];
    } else {
      drZ80.Z80PC_BASE <<= 1;
      drZ80.Z80PC = drZ80.Z80PC_BASE + pc;
    }
    drZ80.Z80SP_BASE = z80_read_map[sp >> Z80_MEM_SHIFT];
    if (drZ80.Z80SP & (1<<31)) {
      elprintf(EL_STATUS|EL_ANOMALY, "bad SP in z80 save: %04x", sp);
      drZ80.Z80SP_BASE = z80_read_map[0];
      drZ80.Z80SP = drZ80.Z80SP_BASE + (1 << Z80_MEM_SHIFT);
    } else {
      drZ80.Z80SP_BASE <<= 1;
      drZ80.Z80SP = drZ80.Z80SP_BASE + sp;
    }
  } else {
    z80_reset();
    drZ80.Z80IM = 1;
    z80_int(); // try to goto int handler, maybe we won't execute trash there?
  }
#elif defined(_USE_CZ80)
  if (*(int *)data == 0x00007a43) { // "Cz" save?
    memcpy(&CZ80, data+8, (INT32)&CZ80.BasePC - (INT32)&CZ80);
    Cz80_Set_Reg(&CZ80, CZ80_PC, *(int *)(data+4));
  } else {
    z80_reset();
    z80_int();
  }
#endif
}

PICO_INTERNAL void z80_exit(void)
{
#if defined(_USE_MZ80)
  mz80shutdown();
#endif
}

PICO_INTERNAL void z80_debug(char *dstr)
{
#if defined(_USE_DRZ80)
  sprintf(dstr, "Z80 state: PC: %04x SP: %04x\n", drZ80.Z80PC-drZ80.Z80PC_BASE, drZ80.Z80SP-drZ80.Z80SP_BASE);
#elif defined(_USE_CZ80)
  sprintf(dstr, "Z80 state: PC: %04x SP: %04x\n", CZ80.PC - CZ80.BasePC, CZ80.SP.W);
#endif
}
Commit	Line	Data
	1	#include "pico_int.h"
	2	#include "sound/sn76496.h"
	3
	4	#define Z80_MEM_SHIFT 13
	5
	6	unsigned long z80_read_map [0x10000 >> Z80_MEM_SHIFT];
	7	unsigned long z80_write_map[0x10000 >> Z80_MEM_SHIFT];
	8
	9	void MEMH_FUNC z80_map_set(unsigned long *map, int start_addr, int end_addr,
	10	void *func_or_mh, int is_func)
	11	{
	12	unsigned long addr = (unsigned long)func_or_mh;
	13	int mask = (1 << Z80_MEM_SHIFT) - 1;
	14	int i;
	15
	16	if ((start_addr & mask) != 0 \|\| (end_addr & mask) != mask)
	17	elprintf(EL_STATUS\|EL_ANOMALY, "z80_map_set: tried to map bad range: %04x-%04x",
	18	start_addr, end_addr);
	19
	20	if (addr & 1) {
	21	elprintf(EL_STATUS\|EL_ANOMALY, "z80_map_set: ptr is not aligned: %08lx", addr);
	22	return;
	23	}
	24
	25	for (i = start_addr >> Z80_MEM_SHIFT; i <= end_addr >> Z80_MEM_SHIFT; i++)
	26	if (is_func)
	27	map[i] = (addr >> 1) \| (1 << (sizeof(addr) * 8 - 1));
	28	else
	29	map[i] = (addr - (i << Z80_MEM_SHIFT)) >> 1;
	30	}
	31
	32	#ifdef _USE_MZ80
	33
	34	// memhandlers for mz80 core
	35	unsigned char mz80_read(UINT32 a, struct MemoryReadByte *w) { return z80_read(a); }
	36	void mz80_write(UINT32 a, UINT8 d, struct MemoryWriteByte *w) { z80_write(d, a); }
	37
	38	// structures for mz80 core
	39	static struct MemoryReadByte mz80_mem_read[]=
	40	{
	41	{0x0000,0xffff,mz80_read},
	42	{(UINT32) -1,(UINT32) -1,NULL}
	43	};
	44	static struct MemoryWriteByte mz80_mem_write[]=
	45	{
	46	{0x0000,0xffff,mz80_write},
	47	{(UINT32) -1,(UINT32) -1,NULL}
	48	};
	49	static struct z80PortRead mz80_io_read[] ={
	50	{(UINT16) -1,(UINT16) -1,NULL}
	51	};
	52	static struct z80PortWrite mz80_io_write[]={
	53	{(UINT16) -1,(UINT16) -1,NULL}
	54	};
	55
	56	int mz80_run(int cycles)
	57	{
	58	int ticks_pre = mz80GetElapsedTicks(0);
	59	mz80exec(cycles);
	60	return mz80GetElapsedTicks(0) - ticks_pre;
	61	}
	62
	63	#endif
	64
	65	#ifdef _USE_DRZ80
	66	struct DrZ80 drZ80;
	67	#endif
	68
	69
	70	PICO_INTERNAL void z80_init(void)
	71	{
	72	#ifdef _USE_MZ80
	73	struct mz80context z80;
	74
	75	// z80
	76	mz80init();
	77	// Modify the default context
	78	mz80GetContext(&z80);
	79
	80	// point mz80 stuff
	81	z80.z80Base=Pico.zram;
	82	z80.z80MemRead=mz80_mem_read;
	83	z80.z80MemWrite=mz80_mem_write;
	84	z80.z80IoRead=mz80_io_read;
	85	z80.z80IoWrite=mz80_io_write;
	86
	87	mz80SetContext(&z80);
	88	#endif
	89	#ifdef _USE_DRZ80
	90	memset(&drZ80, 0, sizeof(drZ80));
	91	drZ80.z80_rebasePC=NULL; // unused, handled by xmap
	92	drZ80.z80_rebaseSP=NULL;
	93	drZ80.z80_read8 =(void *)z80_read_map;
	94	drZ80.z80_read16 =NULL;
	95	drZ80.z80_write8 =(void *)z80_write_map;
	96	drZ80.z80_write16 =NULL;
	97	drZ80.z80_irq_callback=NULL;
	98	#endif
	99	#ifdef _USE_CZ80
	100	memset(&CZ80, 0, sizeof(CZ80));
	101	Cz80_Init(&CZ80);
	102	Cz80_Set_ReadB(&CZ80, NULL); // unused (hacked in)
	103	Cz80_Set_WriteB(&CZ80, NULL);
	104	#endif
	105	}
	106
	107	PICO_INTERNAL void z80_reset(void)
	108	{
	109	#ifdef _USE_MZ80
	110	mz80reset();
	111	#endif
	112	#ifdef _USE_DRZ80
	113	memset(&drZ80, 0, 0x54);
	114	drZ80.Z80F = (1<<2); // set ZFlag
	115	drZ80.Z80F2 = (1<<2); // set ZFlag
	116	drZ80.Z80IX = 0xFFFF << 16;
	117	drZ80.Z80IY = 0xFFFF << 16;
	118	drZ80.Z80IM = 0; // 1?
	119	drZ80.z80irqvector = 0xff0000; // RST 38h
	120	drZ80.Z80PC_BASE = drZ80.Z80PC = z80_read_map[0] << 1;
	121	// drZ80 is locked in single bank
	122	drZ80.Z80SP_BASE = ((PicoAHW & PAHW_SMS) ?
	123	z80_read_map[0xc000 >> Z80_MEM_SHIFT] : z80_read_map[0]) << 1;
	124	// drZ80.Z80SP = drZ80.z80_rebaseSP(0x2000); // 0xf000 ?
	125	#endif
	126	#ifdef _USE_CZ80
	127	Cz80_Reset(&CZ80);
	128	Cz80_Set_Reg(&CZ80, CZ80_IX, 0xffff);
	129	Cz80_Set_Reg(&CZ80, CZ80_IY, 0xffff);
	130	Cz80_Set_Reg(&CZ80, CZ80_SP, 0x2000);
	131	#endif
	132	Pico.m.z80_fakeval = 0; // for faking when Z80 is disabled
	133	}
	134
	135	// XXX TODO: should better use universal z80 save format
	136	PICO_INTERNAL void z80_pack(unsigned char *data)
	137	{
	138	#if defined(_USE_MZ80)
	139	struct mz80context mz80;
	140	(int )data = 0x00005A6D; // "mZ"
	141	mz80GetContext(&mz80);
	142	memcpy(data+4, &mz80.z80clockticks, sizeof(mz80)-5*4); // don't save base&memhandlers
	143	#elif defined(_USE_DRZ80)
	144	(int )data = 0x015A7244; // "DrZ" v1
	145	// drZ80.Z80PC = drZ80.z80_rebasePC(drZ80.Z80PC-drZ80.Z80PC_BASE);
	146	// drZ80.Z80SP = drZ80.z80_rebaseSP(drZ80.Z80SP-drZ80.Z80SP_BASE);
	147	memcpy(data+4, &drZ80, 0x54);
	148	#elif defined(_USE_CZ80)
	149	(int )data = 0x00007a43; // "Cz"
	150	(int )(data+4) = Cz80_Get_Reg(&CZ80, CZ80_PC);
	151	memcpy(data+8, &CZ80, (INT32)&CZ80.BasePC - (INT32)&CZ80);
	152	#endif
	153	}
	154
	155	PICO_INTERNAL void z80_unpack(unsigned char *data)
	156	{
	157	#if defined(_USE_MZ80)
	158	if ((int )data == 0x00005A6D) { // "mZ" save?
	159	struct mz80context mz80;
	160	mz80GetContext(&mz80);
	161	memcpy(&mz80.z80clockticks, data+4, sizeof(mz80)-5*4);
	162	mz80SetContext(&mz80);
	163	} else {
	164	z80_reset();
	165	z80_int();
	166	}
	167	#elif defined(_USE_DRZ80)
	168	if ((int )data == 0x015A7244) { // "DrZ" v1 save?
	169	int pc, sp;
	170	memcpy(&drZ80, data+4, 0x54);
	171	pc = (drZ80.Z80PC - drZ80.Z80PC_BASE) & 0xffff;
	172	sp = (drZ80.Z80SP - drZ80.Z80SP_BASE) & 0xffff;
	173	// update bases
	174	drZ80.Z80PC_BASE = z80_read_map[pc >> Z80_MEM_SHIFT];
	175	if (drZ80.Z80PC & (1<<31)) {
	176	elprintf(EL_STATUS\|EL_ANOMALY, "bad PC in z80 save: %04x", pc);
	177	drZ80.Z80PC_BASE = drZ80.Z80PC = z80_read_map[0];
	178	} else {
	179	drZ80.Z80PC_BASE <<= 1;
	180	drZ80.Z80PC = drZ80.Z80PC_BASE + pc;
	181	}
	182	drZ80.Z80SP_BASE = z80_read_map[sp >> Z80_MEM_SHIFT];
	183	if (drZ80.Z80SP & (1<<31)) {
	184	elprintf(EL_STATUS\|EL_ANOMALY, "bad SP in z80 save: %04x", sp);
	185	drZ80.Z80SP_BASE = z80_read_map[0];
	186	drZ80.Z80SP = drZ80.Z80SP_BASE + (1 << Z80_MEM_SHIFT);
	187	} else {
	188	drZ80.Z80SP_BASE <<= 1;
	189	drZ80.Z80SP = drZ80.Z80SP_BASE + sp;
	190	}
	191	} else {
	192	z80_reset();
	193	drZ80.Z80IM = 1;
	194	z80_int(); // try to goto int handler, maybe we won't execute trash there?
	195	}
	196	#elif defined(_USE_CZ80)
	197	if ((int )data == 0x00007a43) { // "Cz" save?
	198	memcpy(&CZ80, data+8, (INT32)&CZ80.BasePC - (INT32)&CZ80);
	199	Cz80_Set_Reg(&CZ80, CZ80_PC, (int )(data+4));
	200	} else {
	201	z80_reset();
	202	z80_int();
	203	}
	204	#endif
	205	}
	206
	207	PICO_INTERNAL void z80_exit(void)
	208	{
	209	#if defined(_USE_MZ80)
	210	mz80shutdown();
	211	#endif
	212	}
	213
	214	PICO_INTERNAL void z80_debug(char *dstr)
	215	{
	216	#if defined(_USE_DRZ80)
	217	sprintf(dstr, "Z80 state: PC: %04x SP: %04x\n", drZ80.Z80PC-drZ80.Z80PC_BASE, drZ80.Z80SP-drZ80.Z80SP_BASE);
	218	#elif defined(_USE_CZ80)
	219	sprintf(dstr, "Z80 state: PC: %04x SP: %04x\n", CZ80.PC - CZ80.BasePC, CZ80.SP.W);
	220	#endif
	221	}