shithub: sms

ref: 8b4c7b422bd4338a2df0d4e70fc79de96d18537f
dir: /mem.c/

#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include "fns.h"
#include "dat.h"

#define sysfatal(fmt, ...){printf(fmt"\n", ##__VA_ARGS__); exit(EXIT_FAILURE);}

uint16_t ram[32768] = {0};
uint8_t vram[32768];
uint8_t cram[64], vsram[40];
uint32_t cramc[64];
uint8_t reg[16] = {
    0x36, 0x80, 0xff, 0xff,
    0xff, 0xff, 0xfb, 0x00,
    0x00, 0x00, 0xff, 0x00,
    0x00, 0x00, 0x00, 0x00,
};
uint8_t ctl[15];

uint8_t dma;
uint8_t vdplatch;

uint8_t z80bus = 0;
uint16_t ram_bank;
uint8_t ram_enabled = 0;

int slotaddr[3] = {0, 0, 0};
int nbank = 16;

void
cramwrite(uint16_t a, uint8_t v)
{
	cram[a & 0x1f] = v;

	uint8_t r = (v & 0x03) << 6;
	uint8_t g = (v & 0x0c) << 4;
	uint8_t b = (v & 0x30) << 2;

	cramc[a & 0x1f] = (b << 16) | (g << 8) | r;

	printf("cramwrite %x %x\n", a, v);
	for(int i=0;i<64;i++)
		printf("%x ", cram[i]);
	printf("\n");
}

uint8_t
z80read(uint16_t a)
{
	printf("z80read %x\n", a);
	uint16_t v;

	if (a < 0x400)
		return rom[a];
	else if (a < 0x4000)
		return rom[a + slotaddr[0]];
	else if (a < 0x8000)
		return rom[(a - 0x4000) + slotaddr[1]];
	else if (a < 0xC000){
		if (ram_enabled)
			return ram[(a - 0x8000) + ram_bank];
		else{
			printf("== page 2 %x %x %x\n", a, (a - 0x8000) + slotaddr[2], slotaddr[2]);
			printf("== rom[(a - 0x8000) + slotaddr[2]] %x\n", rom[(a - 0x8000) + slotaddr[2]]);
			return rom[(a - 0x8000) + slotaddr[2]];
		}
	}else
		return mem[a];
}

void
z80write(uint16_t a, uint8_t v)
{
	printf("z80write %x %x\n", a, v);
	if (a < 0x8000)
		printf("wrong z80write page 0 or 1 %x %x\n", a, v);
	else if (a < 0xC000)
		if (ram_enabled)
			ram[(a - 0x8000) + ram_bank] = v;
		else
			printf("wrong z80write page 2 %x %x\n", a, v);
	else if (a < 0xE000)
	{
		mem[a] = v;
		mem[a + 0x2000]  = v;
	}
	else
	{
		// printf("z80write > 0xE000 %x %x\n", a, v);
		mem[a] = v;
		mem[a - 0x2000]  = v;

		switch (a)
		{
			case 0xFFFC:
				ram_bank = (v & (1 << 2)) != 0 ? 0x4000 : 0;
				printf("RAM bank %x\n", ram_bank);
				ram_enabled = (v & (1 << 3)) != 0 ? 1 : 0;
				printf("RAM enabled %x\n", ram_enabled);
				break;
			case 0xFFFD:
				printf("Switch mapper slot 0 to %d\n", (v & nbank-1));
				slotaddr[0] = (v & nbank-1) * 0x4000;
				break;
			case 0xFFFE:
				printf("Switch mapper slot 1 to %d\n", (v & nbank-1));
				slotaddr[1] = (v & nbank-1) * 0x4000;
				break;
			case 0xFFFF:
				printf("Switch mapper slot 2 to %d\n", (v & nbank-1));
				slotaddr[2] = (v & nbank-1) * 0x4000;
				break;
		}
	}
}

uint8_t portDC = 0x00;
uint8_t portDD = 0xff;
uint8_t port3E = 0x00;
uint8_t port3F = 0x00;
uint8_t port3FHC = 0x00;

uint8_t
z80in(uint8_t port)
{
	printf("z80in %x\n", port);
	if (port < 0x40)
		return 0xff;
	else if (port >= 0x40 && port < 0x80)
		if ((port & 0x01) == 0x00)
			return vdpvcounter();
		else
			return vdphcounter();
	else if ((port >= 0x80) && (port < 0xC0))
		if ((port & 0x01) == 0x00)
			return vdpdataport();
		else
			return vdpstatus();
	else
		if ((port & 0x01) == 0x00){
			printf("  read port DC: %x\n", portDC);
			return portDC;
		}else
			return (portDD & 0x3f) | (port3F & 0xc0);
}

void
z80out(uint8_t port, uint8_t v)
{
	printf("z80out %x %x\n", port, v);
	if (port < 0x40){
		printf("  write to control register\n");
		if ((port & 0x01) == 0x00)
			port3E = v;
		else{
			port3FHC = v & 0x05;
			port3F = ((v & 0x80) | (v & 0x20) << 1) & 0xC0;
		}
	}else if ((port >= 0x40) && (port < 0x80))
		printf("  write to SN76489 PSG\n");
	else if ((port >= 0x80) && (port < 0xC0)){
		// printf("  write to VDP\n");
		if ((port & 0x01) == 0x00)
			vdpdata(v);
		else
			vdpctrl(v);
	}else
		printf("  write with no effect\n");
}