Return to fdc.c CVS log

Up to [RetroPC.NET] / xmil / io

fix...

#include	"compiler.h"
#include	"dosio.h"
#include	"z80core.h"
#include	"pccore.h"
#include	"iocore.h"
#include	"fddfile.h"
#include	"fdd_2d.h"
#include	"fdd_d88.h"
#include	"fdd_mtr.h"


static const UINT8 fdctype[] = {1,1,1,1,1,1,1,1,2,2,2,2,3,4,3,3};


static void setbusy(UINT clock) {

	fdc.s.busystart = h_cntbase + h_cnt;
	fdc.s.busyclock = clock;
}

REG8 fdcisbusy(void) {

	UINT	clock;

	if (fdc.s.busyclock) {
		clock = h_cntbase + h_cnt;
		if ((clock - fdc.s.busystart) < fdc.s.busyclock) {
			return(0x01);
		}
		fdc.s.busyclock = 0;
		if ((fdc.s.type == 2) || (fdc.s.cmd == 0x0c) || (fdc.s.cmd == 0x0e)) {
			if (fdc.s.bufpos < fdc.s.bufsize) {
				TRACEOUT(("dma ready!"));
				dma.DMA_REDY = 0;
			}
		}
	}
	return(0x00);
}

static REG8 getstat(void) {

	FDDFILE	fdd;
	REG8	cmd;
	REG8	type;
	REG8	ret;

	fdd = fddfile + fdc.s.drv;
	cmd = (REG8)(fdc.s.cmd >> 4);
	type = fdc.s.type;
	if (fdd->type == DISKTYPE_NOTREADY) {
		ret = FDDSTAT_NOTREADY;
	}
	else if (type != 0) {
		ret = fdc.s.stat;
	}
	else {
		ret = 0;
	}
	if ((type == 1) && (fdc.s.c == 0)) {
		ret |= FDDSTAT_TRACK00;
	}
	if ((type == 0) || (type == 1) || (type == 4) ||
		(cmd == 0x0a) || (cmd == 0x0b) || (cmd == 0x0f)) {
		if (fdd->protect) {
			ret |= FDDSTAT_WRITEP;
		}
	}
	if ((type == 1) || (type == 4)) {
		fdc.s.hole++;
		if (fdc.s.hole < 8) {
			ret |= FDDSTAT_INDEX;
		}
	}
	else if (!(ret & 0xf0)) {
		if (FDDMTR_BUSY) {
			ret |= FDDSTAT_BUSY;
		}
		if (fdc.s.bufdir) {
			ret |= FDDSTAT_DRQ | FDDSTAT_BUSY;
		}
		else if (cmd == 0x0f) {
			ret |= FDDSTAT_LOSTDATA;
		}
	}
	return(ret);
}

static void seekcmd(void) {

	FDDFILE	fdd;
	UINT	track;

	fdc.s.crcnum = 0;
	fdc.s.creg = fdc.s.c;
	fdd = fddfile + fdc.s.drv;
	track = (fdc.s.c << 1) + fdc.s.h;
	fdc.s.stat = fdd->seek(fdd, fdc.s.media, track) | FDDSTAT_HEADENG;
	FDDMTR_MOVE;
}

static REG8 type2cmd(REG8 sc) {

	REG8	dir;
	UINT	track;
	UINT8	*p;
	FDDFILE	fdd;
	UINT	size;
	REG8	stat;

	track = (fdc.s.c << 1) + fdc.s.h;
	if (!(fdc.s.cmd & 0x20)) {
		p = fdc.s.buffer;
		dir = FDCDIR_IN;
	}
	else {
		p = NULL;
		dir = FDCDIR_OUT;
	}
	size = sizeof(fdc.s.buffer);
	fdd = fddfile + fdc.s.drv;
	stat = fdd->read(fdd, fdc.s.media, track, sc, p, &size);
	if (stat & FDDSTAT_RECNFND) {
		size = 0;
		dir = FDCDIR_NONE;
	}
	else if (dir == FDCDIR_OUT) {
		if (size) {
			ZeroMemory(fdc.s.buffer, size);
		}
		stat = stat & (~FDDSTAT_RECTYPE);
	}
	fdc.s.bufmedia = fdc.s.media;
	fdc.s.bufunit = fdc.s.drv;
	fdc.s.buftrack = track;
	fdc.s.bufsc = sc;
	fdc.s.bufwrite = FALSE;
	fdc.s.bufdir = dir;
	fdc.s.bufmark = fdc.s.cmd & 1;
	fdc.s.bufpos = 0;
	fdc.s.bufsize = size;
	return(stat);
}

static REG8 type2flash(void) {

	FDDFILE	fdd;

	fdc.s.bufwrite = FALSE;
	fdd = fddfile + fdc.s.bufunit;
	if (fdd->protect) {
		return(FDDSTAT_WRITEFAULT);
	}
	return(fdd->write(fdd, fdc.s.bufmedia, fdc.s.buftrack,
									fdc.s.bufsc, fdc.s.buffer, fdc.s.bufpos));
}

static REG8 crccmd(void) {

	UINT	track;
	FDDFILE	fdd;
	REG8	stat;

	track = (fdc.s.c << 1) + fdc.s.h;
	fdd = fddfile + fdc.s.drv;
	stat = fdd->crc(fdd, fdc.s.media, track, fdc.s.crcnum, fdc.s.buffer);
	if (stat & FDDSTAT_RECNFND) {
		fdc.s.crcnum = 0;
		stat = fdd->crc(fdd, fdc.s.media, track, 0, fdc.s.buffer);
	}
	if (!(stat & FDDSTAT_RECNFND)) {
		fdc.s.bufdir = FDCDIR_IN;
		fdc.s.bufsize = 6;
		fdc.s.rreg = fdc.s.buffer[0];
	}
	else {
		fdc.s.bufdir = FDCDIR_NONE;
		fdc.s.bufsize = 0;
	}
	fdc.s.bufwrite = FALSE;
	return(stat);
}

static void bufposinc(void) {

	BRESULT	r;
	REG8	stat;

	if (fdcisbusy()) {
		return;
	}
	fdc.s.bufpos++;
	if (fdc.s.bufpos >= fdc.s.bufsize) {
		r = FALSE;
		if (fdc.s.type == 2) {
			stat = 0;
			if (fdc.s.cmd & 0x10) {
				r = TRUE;
			}
			if ((fdc.s.cmd & 0x20) && (fdc.s.bufwrite)) {
				stat = type2flash();
				if (stat & (FDDSTAT_RECNFND | FDDSTAT_WRITEFAULT)) {
					r = FALSE;
				}
				fdc.s.stat = stat;
			}
			if (r) {
				fdc.s.rreg = fdc.s.r + 1;
				stat = type2cmd(fdc.s.rreg);
				if (!(stat & FDDSTAT_RECNFND)) {
					fdc.s.r = fdc.s.r + 1;
					fdc.s.stat = stat;
				}
				else {
					r = FALSE;
				}
			}
		}
		if (!r) {
			dma.DMA_REDY = 8;
			fdc.s.bufdir = FDCDIR_NONE;
		}
	}
}

void IOOUTCALL fdc_o(UINT port, REG8 value) {

	REG8	cmd;

	if ((port & (~7)) != 0x0ff8) {
		return;
	}
	TRACEOUT(("fdc %.4x,%.2x [%.4x]", port, value, Z80_PC));
	port &= 0xf;
	if (port == 8) {						// コマンド
		fdc.s.cmd = value;
		cmd = (REG8)(value >> 4);
		fdc.s.type = fdctype[cmd];
		TRACEOUT(("fdc cmd: %.2x", value));
		if (fdc.s.bufwrite) {
			fdc.s.stat = type2flash();
		}
		setbusy(20);
		switch(cmd) {
			case 0x00:								// リストア
				if (value & 8) {					// LAYDOCK
					setbusy(0);
				}
				fdc.s.motor = 0x80;					// モーターOn?
				fdc.s.c = 0;
				fdc.s.step = 1;
				fdc.s.r = 0;						// デゼニワールド
				seekcmd();
				fdc.s.rreg = 0;
				break;

			case 0x01:								// シーク
				fdc.s.motor = 0x80;					// モーターOn
				fdc.s.step = (SINT8)((fdc.s.c<=fdc.s.data)?1:-1);
				fdc.s.c = fdc.s.data;
				seekcmd();
				break;

			case 0x02:								// ステップ
			case 0x03:
				if (fdc.s.motor) {
					fdc.s.c += fdc.s.step;
					if (cmd & 1) {
						seekcmd();
					}
				}
				break;

			case 0x04:								// ステップイン
			case 0x05:
				if (fdc.s.motor) {
					fdc.s.step = 1;
					fdc.s.c++;
					if (cmd & 1) {
						seekcmd();
					}
				}
				break;

			case 0x06:								// ステップアウト
			case 0x07:
				if (fdc.s.motor) {
					fdc.s.step = -1;
					fdc.s.c--;
					if (cmd & 1) {
						seekcmd();
					}
				}
				break;

			case 0x08:								// リードデータ
			case 0x09:
			case 0x0a:								// ライトデータ
			case 0x0b:
				setbusy(200);
				fdc.s.stat = type2cmd(fdc.s.r);
				break;

			case 0xc:								// リードアドレス
				setbusy(200);
				fdc.s.stat = crccmd();
				break;

			case 0x0d:								// フォースインタラプト
				setbusy(0);							// 必要ない？
//				fdc.s.skip = 0;						// 000330
				dma.DMA_REDY = 8;					// ver0.25
				break;

			case 0x0e:								// リードトラック
				setbusy(200);
				ZeroMemory(fdc.s.buffer, 0x1a00);
				fdc.s.bufpos = 0;
				fdc.s.bufsize = 0x1a00;
				fdc.s.bufdir = FDCDIR_IN;
				break;

			case 0x0f:								// ライトトラック
#if 0
				{
					FDDFILE fdd = fddfile + fdc.s.drv;
					switch(fdd->type) {
						case DISKTYPE_NOTREADY:
						case DISKTYPE_BETA:
							break;

						case DISKTYPE_D88:
						default:
							if (fdc.s.motor) {						// ver0.25
								init_tao_d88();
								if (dma.DMA_ENBL) {
									dma.DMA_REDY = 0;
								}
							}
							break;
					}
				}
#endif
				break;
		}
	}
	else {
		cmd = (REG8)(fdc.s.cmd >> 4);
		switch(port) {
			case 0x09:								// トラック
				fdc.s.c = value;
				break;

			case 0x0a:								// セクタ
				FDDMTR_WAITSEC(value);
				fdc.s.r = value;
				fdc.s.rreg = value;
				break;

			case 0x0b:								// データ
				fdc.s.data = value;
				if ((fdc.s.motor) && (fdc.s.bufdir == FDCDIR_OUT)) {
					fdc.s.buffer[fdc.s.bufpos] = value;
					fdc.s.bufwrite = TRUE;
					bufposinc();
				}
#if 0
				else if (cmd == 0x0f) {				// TRACK WRITE
					FDDFILE fdd = fddfile + fdc.s.drv;
					switch(fdd->type) {
						case DISKTYPE_NOTREADY:
						case DISKTYPE_BETA:
							break;

						case DISKTYPE_D88:
						default:
							fdd_wtao_d88(value);
							break;
					}
				}
#endif
				break;

			case 0x0c:								// ドライブ・サイド
				fdc.s.ctbl[fdc.s.drv] = fdc.s.c;
				fdc.s.c = fdc.s.ctbl[value & 0x03];
				fdc.s.motor = (UINT8)(value & 0x80);
				fdc.s.drv = (UINT8)(value & 0x03);
				fdc.s.h = (UINT8)((value >> 4) & 1);
				fdc.s.cmd = 0;							// T&E SORCERIAN
				fdc.s.type = 0;

				FDDMTR_DRVSET;
				if (!fdc.s.motor) {
					fdc.s.r = 0;						// SACOM TELENET
					fdc.s.rreg = 0;
				}
				break;
		}
	}
}

REG8 IOINPCALL fdc_i(UINT port) {

static	BYTE	timeoutwait;
static	BYTE	last_r;
static	short	last_off;
	REG8	cmd;
	REG8	ret;

	if ((port & (~7)) != 0x0ff8) {
		return(0xff);
	}
	cmd = (REG8)(fdc.s.cmd >> 4);
	if ((port &= 0xf) != 8) {
		last_r = -1;
		last_off = -1;
		timeoutwait = 4;
	}
	switch(port) {
		case 0x8:	// ｽﾃｰﾀｽ
			ret = fdcisbusy();
			if (ret) {
				return(ret);
			}
#if 0
			if (fdc.s.type == 2) {
				if (last_r == _fdc.r && last_off == fdc.off &&
						!(--timeoutwait)) {
					inc_off();
					timeoutwait = 4;
				}
				last_r = _fdc.r;
				last_off = fdc.off;
			}							// Read Write時のみの変化でいい筈
#endif
			ret = getstat();
			if (!(ret & 0x02)) {
				dma.DMA_REDY = 8;
			}
			return(ret);

		case 0x9:							// トラック
			return(fdc.s.creg);

		case 0xa:							// セクタ
			return(fdc.s.rreg);

		case 0xb:							// ﾃﾞｰﾀ
			if (fdc.s.motor) {
				if (fdc.s.bufdir == FDCDIR_IN) {
					fdc.s.data = fdc.s.buffer[fdc.s.bufpos];
//					TRACEOUT(("sector read %.2x [%.2x]", fdc.s.data, fdc.s.bufpos));
					bufposinc();
				}
			}
			return(fdc.s.data);					// WOODY POCO !!!

//		case 0xc:								// FM
//		case 0xd:								// MFM
//			break;

		case 0xe:								// 1.6M
			fdc.s.media = DISKTYPE_2HD;
			return(0xff);

		case 0xf:								// 500K/1M
			fdc.s.media = DISKTYPE_2D;
			return(0xff);
	}
	return(0);
}


// ----

void fdc_reset(void) {

	FDDMTR_INIT;
	ZeroMemory(&fdc, sizeof(fdc));
	fdc.s.step = 1;
}