[pcsx_rearmed.git] / libpcsxcore / sio.c

/***************************************************************************
 *   Copyright (C) 2007 Ryan Schultz, PCSX-df Team, PCSX team              *
 *                                                                         *
 *   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     *
 *   (at your option) 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.,                                       *
 *   51 Franklin Street, Fifth Floor, Boston, MA 02111-1307 USA.           *
 ***************************************************************************/

/*
* SIO functions.
*/

#include "sio.h"
#include <sys/stat.h>

#ifdef USE_LIBRETRO_VFS
#include <streams/file_stream_transforms.h>
#endif

// Status Flags
#define TX_RDY		0x0001
#define RX_RDY		0x0002
#define TX_EMPTY	0x0004
#define PARITY_ERR	0x0008
#define RX_OVERRUN	0x0010
#define FRAMING_ERR	0x0020
#define SYNC_DETECT	0x0040
#define DSR			0x0080
#define CTS			0x0100
#define IRQ			0x0200

// Control Flags
#define TX_PERM		0x0001
#define DTR			0x0002
#define RX_PERM		0x0004
#define BREAK		0x0008
#define RESET_ERR	0x0010
#define RTS			0x0020
#define SIO_RESET	0x0040

// *** FOR WORKS ON PADS AND MEMORY CARDS *****

static unsigned char buf[256];
static unsigned char cardh1[4] = { 0xff, 0x08, 0x5a, 0x5d };
static unsigned char cardh2[4] = { 0xff, 0x08, 0x5a, 0x5d };

// Transfer Ready and the Buffer is Empty
// static unsigned short StatReg = 0x002b;
static unsigned short StatReg = TX_RDY | TX_EMPTY;
static unsigned short ModeReg;
static unsigned short CtrlReg;
static unsigned short BaudReg;

static unsigned int bufcount;
static unsigned int parp;
static unsigned int mcdst, rdwr;
static unsigned char adrH, adrL;
static unsigned int padst;

char Mcd1Data[MCD_SIZE], Mcd2Data[MCD_SIZE];
char McdDisable[2];

#define SIO_INT(eCycle) { \
	psxRegs.interrupt |= (1 << PSXINT_SIO); \
	psxRegs.intCycle[PSXINT_SIO].cycle = eCycle; \
	psxRegs.intCycle[PSXINT_SIO].sCycle = psxRegs.cycle; \
	new_dyna_set_event(PSXINT_SIO, eCycle); \
}

// clk cycle byte
// 4us * 8bits = (PSXCLK / 1000000) * 32; (linuzappz)
// TODO: add SioModePrescaler and BaudReg
#define SIO_CYCLES		535

void sioWrite8(unsigned char value) {
#ifdef PAD_LOG
	PAD_LOG("sio write8 %x\n", value);
#endif
	switch (padst) {
		case 1: SIO_INT(SIO_CYCLES);
			if ((value & 0x40) == 0x40) {
				padst = 2; parp = 1;
				if (!Config.UseNet) {
					switch (CtrlReg & 0x2002) {
						case 0x0002:
							buf[parp] = PAD1_poll(value);
							break;
						case 0x2002:
							buf[parp] = PAD2_poll(value);
							break;
					}
				}/* else {
//					SysPrintf("%x: %x, %x, %x, %x\n", CtrlReg&0x2002, buf[2], buf[3], buf[4], buf[5]);
				}*/

				if (!(buf[parp] & 0x0f)) {
					bufcount = 2 + 32;
				} else {
					bufcount = 2 + (buf[parp] & 0x0f) * 2;
				}
				if (buf[parp] == 0x41) {
					switch (value) {
						case 0x43:
							buf[1] = 0x43;
							break;
						case 0x45:
							buf[1] = 0xf3;
							break;
					}
				}
				// NegCon - Wipeout 3
				if( buf[parp] == 0x23 ) {
					switch (value) {
						// enter config mode
						case 0x43:
							buf[1] = 0x79;
							break;

						// get status
						case 0x45:
							buf[1] = 0xf3;
							break;
					}
				}
			}
			else padst = 0;
			return;
		case 2:
			parp++;
/*			if (buf[1] == 0x45) {
				buf[parp] = 0;
				SIO_INT(SIO_CYCLES);
				return;
			}*/
			if (!Config.UseNet) {
				switch (CtrlReg & 0x2002) {
					case 0x0002: buf[parp] = PAD1_poll(value); break;
					case 0x2002: buf[parp] = PAD2_poll(value); break;
				}
			}

			if (parp == bufcount) { padst = 0; return; }
			SIO_INT(SIO_CYCLES);
			return;
	}

	switch (mcdst) {
		case 1:
			SIO_INT(SIO_CYCLES);
			if (rdwr) { parp++; return; }
			parp = 1;
			switch (value) {
				case 0x52: rdwr = 1; break;
				case 0x57: rdwr = 2; break;
				default: mcdst = 0;
			}
			return;
		case 2: // address H
			SIO_INT(SIO_CYCLES);
			adrH = value;
			*buf = 0;
			parp = 0;
			bufcount = 1;
			mcdst = 3;
			return;
		case 3: // address L
			SIO_INT(SIO_CYCLES);
			adrL = value;
			*buf = adrH;
			parp = 0;
			bufcount = 1;
			mcdst = 4;
			return;
		case 4:
			SIO_INT(SIO_CYCLES);
			parp = 0;
			switch (rdwr) {
				case 1: // read
					buf[0] = 0x5c;
					buf[1] = 0x5d;
					buf[2] = adrH;
					buf[3] = adrL;
					switch (CtrlReg & 0x2002) {
						case 0x0002:
							memcpy(&buf[4], Mcd1Data + (adrL | (adrH << 8)) * 128, 128);
							break;
						case 0x2002:
							memcpy(&buf[4], Mcd2Data + (adrL | (adrH << 8)) * 128, 128);
							break;
					}
					{
					char xor = 0;
					int i;
					for (i = 2; i < 128 + 4; i++)
						xor ^= buf[i];
					buf[132] = xor;
					}
					buf[133] = 0x47;
					bufcount = 133;
					break;
				case 2: // write
					buf[0] = adrL;
					buf[1] = value;
					buf[129] = 0x5c;
					buf[130] = 0x5d;
					buf[131] = 0x47;
					bufcount = 131;
					break;
			}
			mcdst = 5;
			return;
		case 5:
			parp++;
			if ((rdwr == 1 && parp == 132) ||
			    (rdwr == 2 && parp == 129)) {
				// clear "new card" flags
				if (CtrlReg & 0x2000)
					cardh2[1] &= ~8;
				else
					cardh1[1] &= ~8;
			}
			if (rdwr == 2) {
				if (parp < 128) buf[parp + 1] = value;
			}
			SIO_INT(SIO_CYCLES);
			return;
	}

	switch (value) {
		case 0x01: // start pad
			StatReg |= RX_RDY;		// Transfer is Ready

			if (!Config.UseNet) {
				switch (CtrlReg & 0x2002) {
					case 0x0002: buf[0] = PAD1_startPoll(1); break;
					case 0x2002: buf[0] = PAD2_startPoll(2); break;
				}
			} else {
				if ((CtrlReg & 0x2002) == 0x0002) {
					int i, j;

					PAD1_startPoll(1);
					buf[0] = 0;
					buf[1] = PAD1_poll(0x42);
					if (!(buf[1] & 0x0f)) {
						bufcount = 32;
					} else {
						bufcount = (buf[1] & 0x0f) * 2;
					}
					buf[2] = PAD1_poll(0);
					i = 3;
					j = bufcount;
					while (j--) {
						buf[i++] = PAD1_poll(0);
					}
					bufcount+= 3;

					if (NET_sendPadData(buf, bufcount) == -1)
						netError();

					if (NET_recvPadData(buf, 1) == -1)
						netError();
					if (NET_recvPadData(buf + 128, 2) == -1)
						netError();
				} else {
					memcpy(buf, buf + 128, 32);
				}
			}

			bufcount = 2;
			parp = 0;
			padst = 1;
			SIO_INT(SIO_CYCLES);
			return;
		case 0x81: // start memcard
			if (CtrlReg & 0x2000)
			{
				if (McdDisable[1])
					goto no_device;
				memcpy(buf, cardh2, 4);
			}
			else
			{
				if (McdDisable[0])
					goto no_device;
				memcpy(buf, cardh1, 4);
			}
			StatReg |= RX_RDY;
			parp = 0;
			bufcount = 3;
			mcdst = 1;
			rdwr = 0;
			SIO_INT(SIO_CYCLES);
			return;
		default:
		no_device:
			StatReg |= RX_RDY;
			buf[0] = 0xff;
			parp = 0;
			bufcount = 0;
			return;
	}
}

void sioWriteStat16(unsigned short value) {
}

void sioWriteMode16(unsigned short value) {
	ModeReg = value;
}

void sioWriteCtrl16(unsigned short value) {
	CtrlReg = value & ~RESET_ERR;
	if (value & RESET_ERR) StatReg &= ~IRQ;
	if ((CtrlReg & SIO_RESET) || !(CtrlReg & DTR)) {
		padst = 0; mcdst = 0; parp = 0;
		StatReg = TX_RDY | TX_EMPTY;
		psxRegs.interrupt &= ~(1 << PSXINT_SIO);
	}
}

void sioWriteBaud16(unsigned short value) {
	BaudReg = value;
}

unsigned char sioRead8() {
	unsigned char ret = 0;

	if ((StatReg & RX_RDY)/* && (CtrlReg & RX_PERM)*/) {
//		StatReg &= ~RX_OVERRUN;
		ret = buf[parp];
		if (parp == bufcount) {
			StatReg &= ~RX_RDY;		// Receive is not Ready now
			if (mcdst == 5) {
				mcdst = 0;
				if (rdwr == 2) {
					switch (CtrlReg & 0x2002) {
						case 0x0002:
							memcpy(Mcd1Data + (adrL | (adrH << 8)) * 128, &buf[1], 128);
							SaveMcd(Config.Mcd1, Mcd1Data, (adrL | (adrH << 8)) * 128, 128);
							break;
						case 0x2002:
							memcpy(Mcd2Data + (adrL | (adrH << 8)) * 128, &buf[1], 128);
							SaveMcd(Config.Mcd2, Mcd2Data, (adrL | (adrH << 8)) * 128, 128);
							break;
					}
				}
			}
			if (padst == 2) padst = 0;
			if (mcdst == 1) {
				mcdst = 2;
				StatReg|= RX_RDY;
			}
		}
	}

#ifdef PAD_LOG
	PAD_LOG("sio read8 ;ret = %x\n", ret);
#endif
	return ret;
}

unsigned short sioReadStat16() {
	return StatReg;
}

unsigned short sioReadMode16() {
	return ModeReg;
}

unsigned short sioReadCtrl16() {
	return CtrlReg;
}

unsigned short sioReadBaud16() {
	return BaudReg;
}

void netError() {
	ClosePlugins();
	SysMessage(_("Connection closed!\n"));

	CdromId[0] = '\0';
	CdromLabel[0] = '\0';

	SysRunGui();
}

void sioInterrupt() {
#ifdef PAD_LOG
	PAD_LOG("Sio Interrupt (CP0.Status = %x)\n", psxRegs.CP0.n.Status);
#endif
//	SysPrintf("Sio Interrupt\n");
	if (!(StatReg & IRQ)) {
		StatReg |= IRQ;
		psxHu32ref(0x1070) |= SWAPu32(0x80);
	}
}

void LoadMcd(int mcd, char *str) {
	FILE *f;
	char *data = NULL;

	if (mcd != 1 && mcd != 2)
		return;

	if (mcd == 1) {
		data = Mcd1Data;
		cardh1[1] |= 8; // mark as new
	}
	if (mcd == 2) {
		data = Mcd2Data;
		cardh2[1] |= 8;
	}

	McdDisable[mcd - 1] = 0;
#ifdef HAVE_LIBRETRO
	// memcard1 is handled by libretro
	if (mcd == 1)
		return;
#endif

	if (str == NULL || strcmp(str, "none") == 0) {
		McdDisable[mcd - 1] = 1;
		return;
	}
	if (*str == 0)
		return;

	f = fopen(str, "rb");
	if (f == NULL) {
		SysPrintf(_("The memory card %s doesn't exist - creating it\n"), str);
		CreateMcd(str);
		f = fopen(str, "rb");
		if (f != NULL) {
			struct stat buf;

			if (stat(str, &buf) != -1) {
				if (buf.st_size == MCD_SIZE + 64)
					fseek(f, 64, SEEK_SET);
				else if(buf.st_size == MCD_SIZE + 3904)
					fseek(f, 3904, SEEK_SET);
			}
			if (fread(data, 1, MCD_SIZE, f) != MCD_SIZE) {
#ifndef NDEBUG
				SysPrintf(_("File IO error in <%s:%s>.\n"), __FILE__, __func__);
#endif
				memset(data, 0x00, MCD_SIZE);
			}
			fclose(f);
		}
		else
			SysMessage(_("Memory card %s failed to load!\n"), str);
	}
	else {
		struct stat buf;
		SysPrintf(_("Loading memory card %s\n"), str);
		if (stat(str, &buf) != -1) {
			if (buf.st_size == MCD_SIZE + 64)
				fseek(f, 64, SEEK_SET);
			else if(buf.st_size == MCD_SIZE + 3904)
				fseek(f, 3904, SEEK_SET);
		}
		if (fread(data, 1, MCD_SIZE, f) != MCD_SIZE) {
#ifndef NDEBUG
			SysPrintf(_("File IO error in <%s:%s>.\n"), __FILE__, __func__);
#endif
			memset(data, 0x00, MCD_SIZE);
		}
		fclose(f);
	}
}

void LoadMcds(char *mcd1, char *mcd2) {
	LoadMcd(1, mcd1);
	LoadMcd(2, mcd2);
}

void SaveMcd(char *mcd, char *data, uint32_t adr, int size) {
	FILE *f;

	if (mcd == NULL || *mcd == 0 || strcmp(mcd, "none") == 0)
		return;

	f = fopen(mcd, "r+b");
	if (f != NULL) {
		struct stat buf;

		if (stat(mcd, &buf) != -1) {
			if (buf.st_size == MCD_SIZE + 64)
				fseek(f, adr + 64, SEEK_SET);
			else if (buf.st_size == MCD_SIZE + 3904)
				fseek(f, adr + 3904, SEEK_SET);
			else
				fseek(f, adr, SEEK_SET);
		} else
			fseek(f, adr, SEEK_SET);

		fwrite(data + adr, 1, size, f);
		fclose(f);
		return;
	}

#if 0
	// try to create it again if we can't open it
	f = fopen(mcd, "wb");
	if (f != NULL) {
		fwrite(data, 1, MCD_SIZE, f);
		fclose(f);
	}
#endif

	ConvertMcd(mcd, data);
}

void CreateMcd(char *mcd) {
	FILE *f;
	struct stat buf;
	int s = MCD_SIZE;
	int i = 0, j;

	f = fopen(mcd, "wb");
	if (f == NULL)
		return;

	if (stat(mcd, &buf) != -1) {
		if ((buf.st_size == MCD_SIZE + 3904) || strstr(mcd, ".gme")) {
			s = s + 3904;
			fputc('1', f);
			s--;
			fputc('2', f);
			s--;
			fputc('3', f);
			s--;
			fputc('-', f);
			s--;
			fputc('4', f);
			s--;
			fputc('5', f);
			s--;
			fputc('6', f);
			s--;
			fputc('-', f);
			s--;
			fputc('S', f);
			s--;
			fputc('T', f);
			s--;
			fputc('D', f);
			s--;
			for (i = 0; i < 7; i++) {
				fputc(0, f);
				s--;
			}
			fputc(1, f);
			s--;
			fputc(0, f);
			s--;
			fputc(1, f);
			s--;
			fputc('M', f);
			s--;
			fputc('Q', f);
			s--;
			for (i = 0; i < 14; i++) {
				fputc(0xa0, f);
				s--;
			}
			fputc(0, f);
			s--;
			fputc(0xff, f);
			while (s-- > (MCD_SIZE + 1))
				fputc(0, f);
		} else if ((buf.st_size == MCD_SIZE + 64) || strstr(mcd, ".mem") || strstr(mcd, ".vgs")) {
			s = s + 64;
			fputc('V', f);
			s--;
			fputc('g', f);
			s--;
			fputc('s', f);
			s--;
			fputc('M', f);
			s--;
			for (i = 0; i < 3; i++) {
				fputc(1, f);
				s--;
				fputc(0, f);
				s--;
				fputc(0, f);
				s--;
				fputc(0, f);
				s--;
			}
			fputc(0, f);
			s--;
			fputc(2, f);
			while (s-- > (MCD_SIZE + 1))
				fputc(0, f);
		}
	}
	fputc('M', f);
	s--;
	fputc('C', f);
	s--;
	while (s-- > (MCD_SIZE - 127))
		fputc(0, f);
	fputc(0xe, f);
	s--;

	for (i = 0; i < 15; i++) { // 15 blocks
		fputc(0xa0, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0xff, f);
		s--;
		fputc(0xff, f);
		s--;
		for (j = 0; j < 117; j++) {
			fputc(0x00, f);
			s--;
		}
		fputc(0xa0, f);
		s--;
	}

	for (i = 0; i < 20; i++) {
		fputc(0xff, f);
		s--;
		fputc(0xff, f);
		s--;
		fputc(0xff, f);
		s--;
		fputc(0xff, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0x00, f);
		s--;
		fputc(0xff, f);
		s--;
		fputc(0xff, f);
		s--;
		for (j = 0; j < 118; j++) {
			fputc(0x00, f);
			s--;
		}
	}

	while ((s--) >= 0)
		fputc(0, f);

	fclose(f);
}

void ConvertMcd(char *mcd, char *data) {
	FILE *f;
	int i = 0;
	int s = MCD_SIZE;

	if (strstr(mcd, ".gme")) {
		f = fopen(mcd, "wb");
		if (f != NULL) {
			fwrite(data - 3904, 1, MCD_SIZE + 3904, f);
			fclose(f);
		}
		f = fopen(mcd, "r+");
		if (f == NULL) return;
		s = s + 3904;
		fputc('1', f); s--;
		fputc('2', f); s--;
		fputc('3', f); s--;
		fputc('-', f); s--;
		fputc('4', f); s--;
		fputc('5', f); s--;
		fputc('6', f); s--;
		fputc('-', f); s--;
		fputc('S', f); s--;
		fputc('T', f); s--;
		fputc('D', f); s--;
		for (i = 0; i < 7; i++) {
			fputc(0, f); s--;
		}
		fputc(1, f); s--;
		fputc(0, f); s--;
		fputc(1, f); s--;
		fputc('M', f); s--;
		fputc('Q', f); s--;
		for(i=0;i<14;i++) {
			fputc(0xa0, f); s--;
		}
		fputc(0, f); s--;
		fputc(0xff, f);
		while (s-- > (MCD_SIZE+1)) fputc(0, f);
		fclose(f);
	} else if(strstr(mcd, ".mem") || strstr(mcd,".vgs")) {
		f = fopen(mcd, "wb");
		if (f != NULL) {
			fwrite(data-64, 1, MCD_SIZE+64, f);
			fclose(f);
		}
		f = fopen(mcd, "r+");
		if (f == NULL) return;
		s = s + 64;
		fputc('V', f); s--;
		fputc('g', f); s--;
		fputc('s', f); s--;
		fputc('M', f); s--;
		for(i=0;i<3;i++) {
			fputc(1, f); s--;
			fputc(0, f); s--;
			fputc(0, f); s--;
			fputc(0, f); s--;
		}
		fputc(0, f); s--;
		fputc(2, f);
		while (s-- > (MCD_SIZE+1)) fputc(0, f);
		fclose(f);
	} else {
		f = fopen(mcd, "wb");
		if (f != NULL) {
			fwrite(data, 1, MCD_SIZE, f);
			fclose(f);
		}
	}
}

void GetMcdBlockInfo(int mcd, int block, McdBlock *Info) {
	char *data = NULL, *ptr, *str, *sstr;
	unsigned short clut[16];
	unsigned short c;
	int i, x;

	memset(Info, 0, sizeof(McdBlock));

	if (mcd != 1 && mcd != 2)
		return;

	if (McdDisable[mcd - 1])
		return;

	if (mcd == 1) data = Mcd1Data;
	if (mcd == 2) data = Mcd2Data;

	ptr = data + block * 8192 + 2;

	Info->IconCount = *ptr & 0x3;

	ptr += 2;

	x = 0;

	str = Info->Title;
	sstr = Info->sTitle;

	for (i = 0; i < 48; i++) {
		c = *(ptr) << 8;
		c |= *(ptr + 1);
		if (!c) break;

		// Convert ASCII characters to half-width
		if (c >= 0x8281 && c <= 0x829A)
			c = (c - 0x8281) + 'a';
		else if (c >= 0x824F && c <= 0x827A)
			c = (c - 0x824F) + '0';
		else if (c == 0x8140) c = ' ';
		else if (c == 0x8143) c = ',';
		else if (c == 0x8144) c = '.';
		else if (c == 0x8146) c = ':';
		else if (c == 0x8147) c = ';';
		else if (c == 0x8148) c = '?';
		else if (c == 0x8149) c = '!';
		else if (c == 0x815E) c = '/';
		else if (c == 0x8168) c = '"';
		else if (c == 0x8169) c = '(';
		else if (c == 0x816A) c = ')';
		else if (c == 0x816D) c = '[';
		else if (c == 0x816E) c = ']';
		else if (c == 0x817C) c = '-';
		else {
			str[i] = ' ';
			sstr[x++] = *ptr++; sstr[x++] = *ptr++;
			continue;
		}

		str[i] = sstr[x++] = c;
		ptr += 2;
	}

	trim(str);
	trim(sstr);

	ptr = data + block * 8192 + 0x60; // icon palette data

	for (i = 0; i < 16; i++) {
		clut[i] = *((unsigned short *)ptr);
		ptr += 2;
	}

	for (i = 0; i < Info->IconCount; i++) {
		short *icon = &Info->Icon[i * 16 * 16];

		ptr = data + block * 8192 + 128 + 128 * i; // icon data

		for (x = 0; x < 16 * 16; x++) {
			icon[x++] = clut[*ptr & 0xf];
			icon[x] = clut[*ptr >> 4];
			ptr++;
		}
	}

	ptr = data + block * 128;

	Info->Flags = *ptr;

	ptr += 0xa;
	strncpy(Info->ID, ptr, 12);
	ptr += 12;
	strncpy(Info->Name, ptr, 16);
}

int sioFreeze(void *f, int Mode) {
	gzfreeze(buf, sizeof(buf));
	gzfreeze(&StatReg, sizeof(StatReg));
	gzfreeze(&ModeReg, sizeof(ModeReg));
	gzfreeze(&CtrlReg, sizeof(CtrlReg));
	gzfreeze(&BaudReg, sizeof(BaudReg));
	gzfreeze(&bufcount, sizeof(bufcount));
	gzfreeze(&parp, sizeof(parp));
	gzfreeze(&mcdst, sizeof(mcdst));
	gzfreeze(&rdwr, sizeof(rdwr));
	gzfreeze(&adrH, sizeof(adrH));
	gzfreeze(&adrL, sizeof(adrL));
	gzfreeze(&padst, sizeof(padst));

	return 0;
}
Commit	Line	Data
ef79bbde P	1	/***************************************************************************
	2	* Copyright (C) 2007 Ryan Schultz, PCSX-df Team, PCSX team *
	3	* *
	4	* This program is free software; you can redistribute it and/or modify *
	5	* it under the terms of the GNU General Public License as published by *
	6	* the Free Software Foundation; either version 2 of the License, or *
	7	* (at your option) any later version. *
	8	* *
	9	* This program is distributed in the hope that it will be useful, *
	10	* but WITHOUT ANY WARRANTY; without even the implied warranty of *
	11	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
	12	* GNU General Public License for more details. *
	13	* *
	14	* You should have received a copy of the GNU General Public License *
	15	* along with this program; if not, write to the *
	16	* Free Software Foundation, Inc., *
	17	* 51 Franklin Street, Fifth Floor, Boston, MA 02111-1307 USA. *
	18	***************************************************************************/
	19
	20	/*
	21	* SIO functions.
	22	*/
	23
	24	#include "sio.h"
	25	#include <sys/stat.h>
	26
226a5691	27	#ifdef USE_LIBRETRO_VFS
	28	#include <streams/file_stream_transforms.h>
	29	#endif
	30
ef79bbde P	31	// Status Flags
	32	#define TX_RDY 0x0001
	33	#define RX_RDY 0x0002
	34	#define TX_EMPTY 0x0004
	35	#define PARITY_ERR 0x0008
	36	#define RX_OVERRUN 0x0010
	37	#define FRAMING_ERR 0x0020
	38	#define SYNC_DETECT 0x0040
	39	#define DSR 0x0080
	40	#define CTS 0x0100
	41	#define IRQ 0x0200
	42
	43	// Control Flags
	44	#define TX_PERM 0x0001
	45	#define DTR 0x0002
	46	#define RX_PERM 0x0004
	47	#define BREAK 0x0008
	48	#define RESET_ERR 0x0010
	49	#define RTS 0x0020
	50	#define SIO_RESET 0x0040
	51
	52	// * FOR WORKS ON PADS AND MEMORY CARDS ***
	53
	54	static unsigned char buf[256];
f3a77032	55	static unsigned char cardh1[4] = { 0xff, 0x08, 0x5a, 0x5d };
f3a77032	56	static unsigned char cardh2[4] = { 0xff, 0x08, 0x5a, 0x5d };
ef79bbde P	57
	58	// Transfer Ready and the Buffer is Empty
	59	// static unsigned short StatReg = 0x002b;
	60	static unsigned short StatReg = TX_RDY \| TX_EMPTY;
	61	static unsigned short ModeReg;
	62	static unsigned short CtrlReg;
	63	static unsigned short BaudReg;
	64
	65	static unsigned int bufcount;
	66	static unsigned int parp;
	67	static unsigned int mcdst, rdwr;
	68	static unsigned char adrH, adrL;
	69	static unsigned int padst;
	70
	71	char Mcd1Data[MCD_SIZE], Mcd2Data[MCD_SIZE];
f3a77032	72	char McdDisable[2];
ef79bbde	73
d28b54b1	74	#define SIO_INT(eCycle) { \
840639a5	75	psxRegs.interrupt \|= (1 << PSXINT_SIO); \
	76	psxRegs.intCycle[PSXINT_SIO].cycle = eCycle; \
	77	psxRegs.intCycle[PSXINT_SIO].sCycle = psxRegs.cycle; \
	78	new_dyna_set_event(PSXINT_SIO, eCycle); \
d28b54b1	79	}
d28b54b1	80
ef79bbde P	81	// clk cycle byte
	82	// 4us * 8bits = (PSXCLK / 1000000) * 32; (linuzappz)
	83	// TODO: add SioModePrescaler and BaudReg
d28b54b1	84	#define SIO_CYCLES 535
ef79bbde P	85
	86	void sioWrite8(unsigned char value) {
	87	#ifdef PAD_LOG
	88	PAD_LOG("sio write8 %x\n", value);
	89	#endif
	90	switch (padst) {
d28b54b1	91	case 1: SIO_INT(SIO_CYCLES);
ef79bbde P	92	if ((value & 0x40) == 0x40) {
	93	padst = 2; parp = 1;
	94	if (!Config.UseNet) {
	95	switch (CtrlReg & 0x2002) {
	96	case 0x0002:
	97	buf[parp] = PAD1_poll(value);
	98	break;
	99	case 0x2002:
	100	buf[parp] = PAD2_poll(value);
	101	break;
	102	}
	103	}/* else {
	104	// SysPrintf("%x: %x, %x, %x, %x\n", CtrlReg&0x2002, buf[2], buf[3], buf[4], buf[5]);
	105	}*/
	106
	107	if (!(buf[parp] & 0x0f)) {
	108	bufcount = 2 + 32;
	109	} else {
	110	bufcount = 2 + (buf[parp] & 0x0f) * 2;
	111	}
	112	if (buf[parp] == 0x41) {
	113	switch (value) {
	114	case 0x43:
	115	buf[1] = 0x43;
	116	break;
	117	case 0x45:
	118	buf[1] = 0xf3;
	119	break;
	120	}
	121	}
b62c0ebc	122	// NegCon - Wipeout 3
	123	if( buf[parp] == 0x23 ) {
	124	switch (value) {
	125	// enter config mode
	126	case 0x43:
	127	buf[1] = 0x79;
	128	break;
	129
	130	// get status
	131	case 0x45:
	132	buf[1] = 0xf3;
	133	break;
	134	}
	135	}
ef79bbde P	136	}
	137	else padst = 0;
	138	return;
	139	case 2:
	140	parp++;
	141	/* if (buf[1] == 0x45) {
	142	buf[parp] = 0;
d28b54b1	143	SIO_INT(SIO_CYCLES);
ef79bbde P	144	return;
	145	}*/
	146	if (!Config.UseNet) {
	147	switch (CtrlReg & 0x2002) {
	148	case 0x0002: buf[parp] = PAD1_poll(value); break;
	149	case 0x2002: buf[parp] = PAD2_poll(value); break;
	150	}
	151	}
	152
	153	if (parp == bufcount) { padst = 0; return; }
d28b54b1	154	SIO_INT(SIO_CYCLES);
ef79bbde P	155	return;
	156	}
	157
	158	switch (mcdst) {
	159	case 1:
d28b54b1	160	SIO_INT(SIO_CYCLES);
ef79bbde P	161	if (rdwr) { parp++; return; }
	162	parp = 1;
	163	switch (value) {
	164	case 0x52: rdwr = 1; break;
	165	case 0x57: rdwr = 2; break;
	166	default: mcdst = 0;
	167	}
	168	return;
	169	case 2: // address H
d28b54b1	170	SIO_INT(SIO_CYCLES);
ef79bbde P	171	adrH = value;
	172	*buf = 0;
	173	parp = 0;
	174	bufcount = 1;
	175	mcdst = 3;
	176	return;
	177	case 3: // address L
d28b54b1	178	SIO_INT(SIO_CYCLES);
ef79bbde P	179	adrL = value;
	180	*buf = adrH;
	181	parp = 0;
	182	bufcount = 1;
	183	mcdst = 4;
	184	return;
	185	case 4:
d28b54b1	186	SIO_INT(SIO_CYCLES);
ef79bbde P	187	parp = 0;
	188	switch (rdwr) {
	189	case 1: // read
	190	buf[0] = 0x5c;
	191	buf[1] = 0x5d;
	192	buf[2] = adrH;
	193	buf[3] = adrL;
	194	switch (CtrlReg & 0x2002) {
	195	case 0x0002:
	196	memcpy(&buf[4], Mcd1Data + (adrL \| (adrH << 8)) * 128, 128);
	197	break;
	198	case 0x2002:
	199	memcpy(&buf[4], Mcd2Data + (adrL \| (adrH << 8)) * 128, 128);
	200	break;
	201	}
	202	{
	203	char xor = 0;
	204	int i;
	205	for (i = 2; i < 128 + 4; i++)
	206	xor ^= buf[i];
	207	buf[132] = xor;
	208	}
	209	buf[133] = 0x47;
	210	bufcount = 133;
	211	break;
	212	case 2: // write
	213	buf[0] = adrL;
	214	buf[1] = value;
	215	buf[129] = 0x5c;
	216	buf[130] = 0x5d;
	217	buf[131] = 0x47;
	218	bufcount = 131;
	219	break;
	220	}
	221	mcdst = 5;
	222	return;
	223	case 5:
	224	parp++;
f3a77032	225	if ((rdwr == 1 && parp == 132) \|\|
	226	(rdwr == 2 && parp == 129)) {
	227	// clear "new card" flags
	228	if (CtrlReg & 0x2000)
	229	cardh2[1] &= ~8;
	230	else
	231	cardh1[1] &= ~8;
	232	}
ef79bbde P	233	if (rdwr == 2) {
	234	if (parp < 128) buf[parp + 1] = value;
	235	}
d28b54b1	236	SIO_INT(SIO_CYCLES);
ef79bbde P	237	return;
	238	}
	239
	240	switch (value) {
	241	case 0x01: // start pad
	242	StatReg \|= RX_RDY; // Transfer is Ready
	243
	244	if (!Config.UseNet) {
	245	switch (CtrlReg & 0x2002) {
	246	case 0x0002: buf[0] = PAD1_startPoll(1); break;
	247	case 0x2002: buf[0] = PAD2_startPoll(2); break;
	248	}
	249	} else {
	250	if ((CtrlReg & 0x2002) == 0x0002) {
	251	int i, j;
	252
	253	PAD1_startPoll(1);
	254	buf[0] = 0;
	255	buf[1] = PAD1_poll(0x42);
	256	if (!(buf[1] & 0x0f)) {
	257	bufcount = 32;
	258	} else {
	259	bufcount = (buf[1] & 0x0f) * 2;
	260	}
	261	buf[2] = PAD1_poll(0);
	262	i = 3;
	263	j = bufcount;
	264	while (j--) {
	265	buf[i++] = PAD1_poll(0);
	266	}
	267	bufcount+= 3;
	268
	269	if (NET_sendPadData(buf, bufcount) == -1)
	270	netError();
	271
	272	if (NET_recvPadData(buf, 1) == -1)
	273	netError();
	274	if (NET_recvPadData(buf + 128, 2) == -1)
	275	netError();
	276	} else {
	277	memcpy(buf, buf + 128, 32);
	278	}
	279	}
	280
	281	bufcount = 2;
	282	parp = 0;
	283	padst = 1;
d28b54b1	284	SIO_INT(SIO_CYCLES);
ef79bbde P	285	return;
ef79bbde P	286	case 0x81: // start memcard
f3a77032	287	if (CtrlReg & 0x2000)
	288	{
	289	if (McdDisable[1])
	290	goto no_device;
	291	memcpy(buf, cardh2, 4);
	292	}
	293	else
	294	{
	295	if (McdDisable[0])
	296	goto no_device;
	297	memcpy(buf, cardh1, 4);
	298	}
ef79bbde	299	StatReg \|= RX_RDY;
ef79bbde P	300	parp = 0;
	301	bufcount = 3;
	302	mcdst = 1;
	303	rdwr = 0;
d28b54b1	304	SIO_INT(SIO_CYCLES);
ef79bbde	305	return;
f3a77032	306	default:
	307	no_device:
	308	StatReg \|= RX_RDY;
	309	buf[0] = 0xff;
	310	parp = 0;
	311	bufcount = 0;
	312	return;
ef79bbde P	313	}
	314	}
	315
	316	void sioWriteStat16(unsigned short value) {
	317	}
	318
	319	void sioWriteMode16(unsigned short value) {
	320	ModeReg = value;
	321	}
	322
	323	void sioWriteCtrl16(unsigned short value) {
	324	CtrlReg = value & ~RESET_ERR;
	325	if (value & RESET_ERR) StatReg &= ~IRQ;
7d95d6fa	326	if ((CtrlReg & SIO_RESET) \|\| !(CtrlReg & DTR)) {
ef79bbde P	327	padst = 0; mcdst = 0; parp = 0;
ef79bbde P	328	StatReg = TX_RDY \| TX_EMPTY;
d28b54b1	329	psxRegs.interrupt &= ~(1 << PSXINT_SIO);
ef79bbde P	330	}
	331	}
	332
	333	void sioWriteBaud16(unsigned short value) {
	334	BaudReg = value;
	335	}
	336
	337	unsigned char sioRead8() {
	338	unsigned char ret = 0;
	339
	340	if ((StatReg & RX_RDY)/* && (CtrlReg & RX_PERM)*/) {
	341	// StatReg &= ~RX_OVERRUN;
	342	ret = buf[parp];
	343	if (parp == bufcount) {
	344	StatReg &= ~RX_RDY; // Receive is not Ready now
	345	if (mcdst == 5) {
	346	mcdst = 0;
	347	if (rdwr == 2) {
	348	switch (CtrlReg & 0x2002) {
	349	case 0x0002:
	350	memcpy(Mcd1Data + (adrL \| (adrH << 8)) * 128, &buf[1], 128);
	351	SaveMcd(Config.Mcd1, Mcd1Data, (adrL \| (adrH << 8)) * 128, 128);
	352	break;
	353	case 0x2002:
	354	memcpy(Mcd2Data + (adrL \| (adrH << 8)) * 128, &buf[1], 128);
	355	SaveMcd(Config.Mcd2, Mcd2Data, (adrL \| (adrH << 8)) * 128, 128);
	356	break;
	357	}
	358	}
	359	}
	360	if (padst == 2) padst = 0;
	361	if (mcdst == 1) {
	362	mcdst = 2;
	363	StatReg\|= RX_RDY;
	364	}
	365	}
	366	}
	367
	368	#ifdef PAD_LOG
	369	PAD_LOG("sio read8 ;ret = %x\n", ret);
	370	#endif
	371	return ret;
	372	}
	373
	374	unsigned short sioReadStat16() {
	375	return StatReg;
	376	}
	377
	378	unsigned short sioReadMode16() {
	379	return ModeReg;
	380	}
	381
	382	unsigned short sioReadCtrl16() {
	383	return CtrlReg;
	384	}
	385
	386	unsigned short sioReadBaud16() {
	387	return BaudReg;
	388	}
	389
	390	void netError() {
	391	ClosePlugins();
	392	SysMessage(_("Connection closed!\n"));
	393
394	CdromId[0] = '\0';
395	CdromLabel[0] = '\0';
396
397	SysRunGui();
398	}
399
400	void sioInterrupt() {
401	#ifdef PAD_LOG
402	PAD_LOG("Sio Interrupt (CP0.Status = %x)\n", psxRegs.CP0.n.Status);
403	#endif
404	// SysPrintf("Sio Interrupt\n");
aa35134a	405	if (!(StatReg & IRQ)) {
	406	StatReg \|= IRQ;
	407	psxHu32ref(0x1070) \|= SWAPu32(0x80);
	408	}
ef79bbde P	409	}
	410
	411	void LoadMcd(int mcd, char *str) {
	412	FILE *f;
	413	char *data = NULL;
	414
f3a77032	415	if (mcd != 1 && mcd != 2)
f3a77032	416	return;
ef79bbde	417
f3a77032	418	if (mcd == 1) {
	419	data = Mcd1Data;
	420	cardh1[1] \|= 8; // mark as new
	421	}
	422	if (mcd == 2) {
	423	data = Mcd2Data;
	424	cardh2[1] \|= 8;
	425	}
	426
	427	McdDisable[mcd - 1] = 0;
5bf56268	428	#ifdef HAVE_LIBRETRO
	429	// memcard1 is handled by libretro
	430	if (mcd == 1)
	431	return;
	432	#endif
	433
6f18d16a	434	if (str == NULL \|\| strcmp(str, "none") == 0) {
f3a77032	435	McdDisable[mcd - 1] = 1;
f3a77032	436	return;
ef79bbde	437	}
6f18d16a	438	if (*str == 0)
	439	return;
	440
226a5691	441	f = fopen(str, "rb");
ef79bbde P	442	if (f == NULL) {
	443	SysPrintf(_("The memory card %s doesn't exist - creating it\n"), str);
	444	CreateMcd(str);
226a5691	445	f = fopen(str, "rb");
ef79bbde P	446	if (f != NULL) {
	447	struct stat buf;
	448
	449	if (stat(str, &buf) != -1) {
	450	if (buf.st_size == MCD_SIZE + 64)
	451	fseek(f, 64, SEEK_SET);
	452	else if(buf.st_size == MCD_SIZE + 3904)
	453	fseek(f, 3904, SEEK_SET);
	454	}
9361a5aa EC	455	if (fread(data, 1, MCD_SIZE, f) != MCD_SIZE) {
	456	#ifndef NDEBUG
	457	SysPrintf(_("File IO error in <%s:%s>.\n"), __FILE__, __func__);
	458	#endif
	459	memset(data, 0x00, MCD_SIZE);
	460	}
ef79bbde P	461	fclose(f);
	462	}
	463	else
	464	SysMessage(_("Memory card %s failed to load!\n"), str);
	465	}
	466	else {
	467	struct stat buf;
	468	SysPrintf(_("Loading memory card %s\n"), str);
	469	if (stat(str, &buf) != -1) {
	470	if (buf.st_size == MCD_SIZE + 64)
	471	fseek(f, 64, SEEK_SET);
	472	else if(buf.st_size == MCD_SIZE + 3904)
	473	fseek(f, 3904, SEEK_SET);
	474	}
9361a5aa EC	475	if (fread(data, 1, MCD_SIZE, f) != MCD_SIZE) {
	476	#ifndef NDEBUG
	477	SysPrintf(_("File IO error in <%s:%s>.\n"), __FILE__, __func__);
	478	#endif
	479	memset(data, 0x00, MCD_SIZE);
	480	}
ef79bbde P	481	fclose(f);
	482	}
	483	}
	484
	485	void LoadMcds(char mcd1, char mcd2) {
	486	LoadMcd(1, mcd1);
	487	LoadMcd(2, mcd2);
	488	}
	489
	490	void SaveMcd(char mcd, char data, uint32_t adr, int size) {
	491	FILE *f;
	492
6f18d16a	493	if (mcd == NULL \|\| *mcd == 0 \|\| strcmp(mcd, "none") == 0)
	494	return;
	495
226a5691	496	f = fopen(mcd, "r+b");
ef79bbde P	497	if (f != NULL) {
	498	struct stat buf;
	499
	500	if (stat(mcd, &buf) != -1) {
	501	if (buf.st_size == MCD_SIZE + 64)
	502	fseek(f, adr + 64, SEEK_SET);
	503	else if (buf.st_size == MCD_SIZE + 3904)
	504	fseek(f, adr + 3904, SEEK_SET);
	505	else
	506	fseek(f, adr, SEEK_SET);
	507	} else
	508	fseek(f, adr, SEEK_SET);
	509
	510	fwrite(data + adr, 1, size, f);
	511	fclose(f);
	512	return;
	513	}
	514
	515	#if 0
	516	// try to create it again if we can't open it
	517	f = fopen(mcd, "wb");
	518	if (f != NULL) {
	519	fwrite(data, 1, MCD_SIZE, f);
	520	fclose(f);
	521	}
	522	#endif
	523
	524	ConvertMcd(mcd, data);
	525	}
	526
	527	void CreateMcd(char *mcd) {
	528	FILE *f;
	529	struct stat buf;
	530	int s = MCD_SIZE;
	531	int i = 0, j;
	532
226a5691	533	f = fopen(mcd, "wb");
ef79bbde P	534	if (f == NULL)
	535	return;
	536
	537	if (stat(mcd, &buf) != -1) {
	538	if ((buf.st_size == MCD_SIZE + 3904) \|\| strstr(mcd, ".gme")) {
	539	s = s + 3904;
	540	fputc('1', f);
	541	s--;
	542	fputc('2', f);
	543	s--;
	544	fputc('3', f);
	545	s--;
	546	fputc('-', f);
	547	s--;
	548	fputc('4', f);
	549	s--;
	550	fputc('5', f);
	551	s--;
	552	fputc('6', f);
	553	s--;
	554	fputc('-', f);
	555	s--;
	556	fputc('S', f);
	557	s--;
	558	fputc('T', f);
	559	s--;
	560	fputc('D', f);
	561	s--;
	562	for (i = 0; i < 7; i++) {
	563	fputc(0, f);
	564	s--;
	565	}
	566	fputc(1, f);
	567	s--;
	568	fputc(0, f);
	569	s--;
	570	fputc(1, f);
	571	s--;
	572	fputc('M', f);
	573	s--;
	574	fputc('Q', f);
	575	s--;
	576	for (i = 0; i < 14; i++) {
	577	fputc(0xa0, f);
	578	s--;
	579	}
	580	fputc(0, f);
	581	s--;
	582	fputc(0xff, f);
	583	while (s-- > (MCD_SIZE + 1))
	584	fputc(0, f);
	585	} else if ((buf.st_size == MCD_SIZE + 64) \|\| strstr(mcd, ".mem") \|\| strstr(mcd, ".vgs")) {
	586	s = s + 64;
	587	fputc('V', f);
	588	s--;
	589	fputc('g', f);
	590	s--;
	591	fputc('s', f);
	592	s--;
	593	fputc('M', f);
	594	s--;
	595	for (i = 0; i < 3; i++) {
	596	fputc(1, f);
	597	s--;
598	fputc(0, f);
599	s--;
600	fputc(0, f);
601	s--;
602	fputc(0, f);
603	s--;
604	}
605	fputc(0, f);
606	s--;
607	fputc(2, f);
608	while (s-- > (MCD_SIZE + 1))
609	fputc(0, f);
610	}
611	}
612	fputc('M', f);
613	s--;
614	fputc('C', f);
615	s--;
616	while (s-- > (MCD_SIZE - 127))
617	fputc(0, f);
618	fputc(0xe, f);
619	s--;
620
621	for (i = 0; i < 15; i++) { // 15 blocks
622	fputc(0xa0, f);
623	s--;
624	fputc(0x00, f);
625	s--;
626	fputc(0x00, f);
627	s--;
628	fputc(0x00, f);
629	s--;
630	fputc(0x00, f);
631	s--;
632	fputc(0x00, f);
633	s--;
634	fputc(0x00, f);
635	s--;
636	fputc(0x00, f);
637	s--;
638	fputc(0xff, f);
639	s--;
640	fputc(0xff, f);
641	s--;
642	for (j = 0; j < 117; j++) {
643	fputc(0x00, f);
644	s--;
645	}
646	fputc(0xa0, f);
647	s--;
648	}
649
650	for (i = 0; i < 20; i++) {
651	fputc(0xff, f);
652	s--;
653	fputc(0xff, f);
654	s--;
655	fputc(0xff, f);
656	s--;
657	fputc(0xff, f);
658	s--;
659	fputc(0x00, f);
660	s--;
661	fputc(0x00, f);
662	s--;
663	fputc(0x00, f);
664	s--;
665	fputc(0x00, f);
666	s--;
667	fputc(0xff, f);
668	s--;
669	fputc(0xff, f);
670	s--;
671	for (j = 0; j < 118; j++) {
672	fputc(0x00, f);
673	s--;
674	}
675	}
676
677	while ((s--) >= 0)
678	fputc(0, f);
679
680	fclose(f);
681	}
682
683	void ConvertMcd(char mcd, char data) {
684	FILE *f;
685	int i = 0;
686	int s = MCD_SIZE;
687
688	if (strstr(mcd, ".gme")) {
689	f = fopen(mcd, "wb");
690	if (f != NULL) {
691	fwrite(data - 3904, 1, MCD_SIZE + 3904, f);
692	fclose(f);
693	}
694	f = fopen(mcd, "r+");
ab91a058	695	if (f == NULL) return;
ef79bbde P	696	s = s + 3904;
	697	fputc('1', f); s--;
	698	fputc('2', f); s--;
	699	fputc('3', f); s--;
	700	fputc('-', f); s--;
	701	fputc('4', f); s--;
	702	fputc('5', f); s--;
	703	fputc('6', f); s--;
	704	fputc('-', f); s--;
	705	fputc('S', f); s--;
	706	fputc('T', f); s--;
	707	fputc('D', f); s--;
	708	for (i = 0; i < 7; i++) {
	709	fputc(0, f); s--;
	710	}
	711	fputc(1, f); s--;
	712	fputc(0, f); s--;
	713	fputc(1, f); s--;
	714	fputc('M', f); s--;
	715	fputc('Q', f); s--;
	716	for(i=0;i<14;i++) {
	717	fputc(0xa0, f); s--;
	718	}
	719	fputc(0, f); s--;
	720	fputc(0xff, f);
	721	while (s-- > (MCD_SIZE+1)) fputc(0, f);
	722	fclose(f);
	723	} else if(strstr(mcd, ".mem") \|\| strstr(mcd,".vgs")) {
	724	f = fopen(mcd, "wb");
	725	if (f != NULL) {
	726	fwrite(data-64, 1, MCD_SIZE+64, f);
	727	fclose(f);
	728	}
	729	f = fopen(mcd, "r+");
ab91a058	730	if (f == NULL) return;
ef79bbde P	731	s = s + 64;
	732	fputc('V', f); s--;
	733	fputc('g', f); s--;
	734	fputc('s', f); s--;
	735	fputc('M', f); s--;
	736	for(i=0;i<3;i++) {
	737	fputc(1, f); s--;
	738	fputc(0, f); s--;
	739	fputc(0, f); s--;
	740	fputc(0, f); s--;
	741	}
	742	fputc(0, f); s--;
	743	fputc(2, f);
	744	while (s-- > (MCD_SIZE+1)) fputc(0, f);
	745	fclose(f);
	746	} else {
	747	f = fopen(mcd, "wb");
	748	if (f != NULL) {
	749	fwrite(data, 1, MCD_SIZE, f);
	750	fclose(f);
	751	}
	752	}
	753	}
	754
	755	void GetMcdBlockInfo(int mcd, int block, McdBlock *Info) {
ab948f7e	756	char data = NULL, ptr, str, sstr;
ef79bbde P	757	unsigned short clut[16];
	758	unsigned short c;
	759	int i, x;
	760
	761	memset(Info, 0, sizeof(McdBlock));
	762
f3a77032	763	if (mcd != 1 && mcd != 2)
	764	return;
	765
	766	if (McdDisable[mcd - 1])
	767	return;
	768
ef79bbde P	769	if (mcd == 1) data = Mcd1Data;
	770	if (mcd == 2) data = Mcd2Data;
	771
	772	ptr = data + block * 8192 + 2;
	773
	774	Info->IconCount = *ptr & 0x3;
	775
	776	ptr += 2;
	777
	778	x = 0;
	779
	780	str = Info->Title;
	781	sstr = Info->sTitle;
	782
	783	for (i = 0; i < 48; i++) {
	784	c = *(ptr) << 8;
	785	c \|= *(ptr + 1);
	786	if (!c) break;
	787
	788	// Convert ASCII characters to half-width
	789	if (c >= 0x8281 && c <= 0x829A)
	790	c = (c - 0x8281) + 'a';
	791	else if (c >= 0x824F && c <= 0x827A)
	792	c = (c - 0x824F) + '0';
	793	else if (c == 0x8140) c = ' ';
	794	else if (c == 0x8143) c = ',';
	795	else if (c == 0x8144) c = '.';
	796	else if (c == 0x8146) c = ':';
	797	else if (c == 0x8147) c = ';';
	798	else if (c == 0x8148) c = '?';
	799	else if (c == 0x8149) c = '!';
	800	else if (c == 0x815E) c = '/';
	801	else if (c == 0x8168) c = '"';
	802	else if (c == 0x8169) c = '(';
	803	else if (c == 0x816A) c = ')';
	804	else if (c == 0x816D) c = '[';
	805	else if (c == 0x816E) c = ']';
	806	else if (c == 0x817C) c = '-';
	807	else {
	808	str[i] = ' ';
	809	sstr[x++] = ptr++; sstr[x++] = ptr++;
	810	continue;
	811	}
	812
	813	str[i] = sstr[x++] = c;
	814	ptr += 2;
	815	}
	816
	817	trim(str);
	818	trim(sstr);
	819
	820	ptr = data + block * 8192 + 0x60; // icon palette data
	821
	822	for (i = 0; i < 16; i++) {
	823	clut[i] = ((unsigned short )ptr);
	824	ptr += 2;
	825	}
	826
	827	for (i = 0; i < Info->IconCount; i++) {
	828	short icon = &Info->Icon[i 16 * 16];
	829
	830	ptr = data + block * 8192 + 128 + 128 * i; // icon data
	831
	832	for (x = 0; x < 16 * 16; x++) {
833	icon[x++] = clut[*ptr & 0xf];
834	icon[x] = clut[*ptr >> 4];
835	ptr++;
836	}
837	}
838
839	ptr = data + block * 128;
840
841	Info->Flags = *ptr;
842
843	ptr += 0xa;
844	strncpy(Info->ID, ptr, 12);
845	ptr += 12;
846	strncpy(Info->Name, ptr, 16);
847	}
848
496d88d4	849	int sioFreeze(void *f, int Mode) {
ef79bbde P	850	gzfreeze(buf, sizeof(buf));
	851	gzfreeze(&StatReg, sizeof(StatReg));
	852	gzfreeze(&ModeReg, sizeof(ModeReg));
	853	gzfreeze(&CtrlReg, sizeof(CtrlReg));
	854	gzfreeze(&BaudReg, sizeof(BaudReg));
	855	gzfreeze(&bufcount, sizeof(bufcount));
	856	gzfreeze(&parp, sizeof(parp));
	857	gzfreeze(&mcdst, sizeof(mcdst));
	858	gzfreeze(&rdwr, sizeof(rdwr));
	859	gzfreeze(&adrH, sizeof(adrH));
	860	gzfreeze(&adrL, sizeof(adrL));
	861	gzfreeze(&padst, sizeof(padst));
	862
	863	return 0;
	864	}