--- xmil/io/fdc.c	2004/08/02 13:38:46	1.1
+++ xmil/io/fdc.c	2004/08/10 10:41:53	1.6
@@ -9,143 +9,286 @@
 #include	"fdd_mtr.h"
 
 
-		BYTE		FDC_c[4];
-		BYTE		driveset = 0;
-		BYTE		fdcdummyread = 0;
-		WORD		readdiag = 0;
-
 static const UINT8 fdctype[] = {1,1,1,1,1,1,1,1,2,2,2,2,3,4,3,3};
 
 
-static BYTE fdd_stat(void) {
+static void setbusy(UINT clock) {
 
-	FDDFILE fdd;
+	fdc.s.busystart = h_cntbase + h_cnt;
+	fdc.s.busyclock = clock;
+}
 
-	fdd = fddfile + fdc.drv;
-	switch(fdd->type) {
-		case DISKTYPE_NOTREADY:
-			return(0);
+REG8 fdcisbusy(void) {
 
-		case DISKTYPE_BETA:
-			return(fdd_stat_2d());
+	UINT	clock;
 
-		case DISKTYPE_D88:
-		default:
-			return(fdd_stat_d88());
+	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(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 int inc_off(void) {
+static REG8 type2flash(void) {
 
-	BYTE	ret;
-	FDDFILE fdd;
+	FDDFILE	fdd;
 
-	if (!fdc.motor) {
-		return(0);
+	fdc.s.bufwrite = FALSE;
+	fdd = fddfile + fdc.s.bufunit;
+	if (fdd->protect) {
+		return(FDDSTAT_WRITEFAULT);
 	}
-	if (fdcdummyread) {
-		fdcdummyread--;
-		return(0);
+	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 {
-		fdd = fddfile + fdc.drv;
-		switch(fdd->type) {
-			case DISKTYPE_NOTREADY:
-				return(0);
+		fdc.s.bufdir = FDCDIR_NONE;
+		fdc.s.bufsize = 0;
+	}
+	fdc.s.bufwrite = FALSE;
+	return(stat);
+}
 
-			case DISKTYPE_BETA:
-				ret = fdd_incoff_2d();
-				break;
+static void bufposinc(void) {
 
-			case DISKTYPE_D88:
-			default:
-				ret = fdd_incoff_d88();
-				break;
+	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 (ret) {
-			dma.DMA_REDY = 8;	// <- DMA ノ レディシンゴウ ヲ クリア
+		if (!r) {
+			dma.DMA_REDY = 8;
+			fdc.s.bufdir = FDCDIR_NONE;
 		}
 	}
-	return(ret);
 }
 
 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) {						// コマンド
-		driveset = 0;
-		fdc.cmd = value;
+		fdc.s.cmd = value;
 		cmd = (REG8)(value >> 4);
-		fdc.type = fdctype[cmd];
-		fdc.skip = 2;
+		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
-					fdc.skip = 0;
-					fdc.busyclock = 20;				// ver0.25 (now testing)
-					fdc.busystart = h_cntbase + h_cnt;
-				}
-				fdc.motor = 0x80;					// モーターOn?
-				fdc.c = 0;
-				fdc.treg = 0;
-				FDDMTR_MOVE;
-				fdc.step = 1;
-#if 1												// ver0.25
-				fdc.r = 0;							// デゼニワールド
-				fdc.rreg = 0;
-#endif
+					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.motor = 0x80;					// モーターOn
-				fdc.step = (char)((fdc.c<=fdc.data)?1:-1);
-#if 0												// スタクル		// ver0.50
-				fdc.rreg = fdc.r = 0;
-#endif
-				fdc.c = fdc.data;
-				fdc.treg = fdc.data;
-				FDDMTR_MOVE;
+				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.motor) {
-					fdc.c += fdc.step;
+				if (fdc.s.motor) {
+					fdc.s.c += fdc.s.step;
 					if (cmd & 1) {
-						FDDMTR_MOVE;
-						fdc.treg = fdc.c;
+						seekcmd();
 					}
 				}
 				break;
 
 			case 0x04:								// ステップイン
 			case 0x05:
-				if (fdc.motor) {
-					fdc.step = 1;
-					fdc.c++;
+				if (fdc.s.motor) {
+					fdc.s.step = 1;
+					fdc.s.c++;
 					if (cmd & 1) {
-						FDDMTR_MOVE;
-						fdc.treg = fdc.c;
+						seekcmd();
 					}
 				}
 				break;
 
 			case 0x06:								// ステップアウト
 			case 0x07:
-				if (fdc.motor) {
-					fdc.step = -1;
-					fdc.c--;
+				if (fdc.s.motor) {
+					fdc.s.step = -1;
+					fdc.s.c--;
 					if (cmd & 1) {
-						FDDMTR_MOVE;
-						fdc.treg = fdc.c;
+						seekcmd();
 					}
 				}
 				break;
@@ -154,55 +297,33 @@ void IOOUTCALL fdc_o(UINT port, REG8 val
 			case 0x09:
 			case 0x0a:								// ライトデータ
 			case 0x0b:
-				fdc.off = 0;
-				fdcdummyread = 2;
-				if (fdc.motor) {
-					if (dma.DMA_ENBL) {
-						dma.DMA_REDY = 0;
-//						fdc.skip = 0;			// DMAで割り込みを監視する事！
-					}
-				}
+				setbusy(500);
+				fdc.s.stat = type2cmd(fdc.s.r);
 				break;
 
 			case 0xc:								// リードアドレス
-				fdc.crc_off = 0;
-				fdcdummyread = 2;
-				if (fdc.motor) {									// ver0.25
-					if (dma.DMA_ENBL) {
-						dma.DMA_REDY = 0;
-					}
-				}
-				{
-					FDDFILE fdd = fddfile + fdc.drv;
-					switch(fdd->type) {
-						case DISKTYPE_NOTREADY:
-							break;
-
-						case DISKTYPE_BETA:
-							fdd_crc_2d();
-							break;
-
-						case DISKTYPE_D88:
-						default:
-							fdd_crc_d88();
-							break;
-					}
-				}
+				setbusy(200);
+				fdc.s.stat = crccmd();
 				break;
 
 			case 0x0d:								// フォースインタラプト
-				fdcdummyread = 0;					// 必要ない？
-				fdc.skip = 0;						// 000330
+				setbusy(0);							// 必要ない？
+//				fdc.s.skip = 0;						// 000330
 				dma.DMA_REDY = 8;					// ver0.25
 				break;
 
 			case 0x0e:								// リードトラック
-				readdiag = 0;
+				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.drv;
+					FDDFILE fdd = fddfile + fdc.s.drv;
 					switch(fdd->type) {
 						case DISKTYPE_NOTREADY:
 						case DISKTYPE_BETA:
@@ -210,7 +331,7 @@ void IOOUTCALL fdc_o(UINT port, REG8 val
 
 						case DISKTYPE_D88:
 						default:
-							if (fdc.motor) {						// ver0.25
+							if (fdc.s.motor) {						// ver0.25
 								init_tao_d88();
 								if (dma.DMA_ENBL) {
 									dma.DMA_REDY = 0;
@@ -219,43 +340,33 @@ void IOOUTCALL fdc_o(UINT port, REG8 val
 							break;
 					}
 				}
+#endif
 				break;
 		}
 	}
 	else {
-		cmd = (REG8)(fdc.cmd >> 4);
+		cmd = (REG8)(fdc.s.cmd >> 4);
 		switch(port) {
 			case 0x09:								// トラック
-				fdc.treg = value;
+				fdc.s.c = value;
 				break;
 
 			case 0x0a:								// セクタ
 				FDDMTR_WAITSEC(value);
-				fdc.r = value;
-				fdc.rreg = value;
+				fdc.s.r = value;
+				fdc.s.rreg = value;
 				break;
 
 			case 0x0b:								// データ
-				fdc.data = value;
-				if ((cmd == 0x0a) || (cmd == 0x0b)) {
-					FDDFILE fdd = fddfile + fdc.drv;
-					switch(fdd->type) {
-						case DISKTYPE_NOTREADY:
-							break;
-
-						case DISKTYPE_BETA:
-							fdd_write_2d();
-							break;
-
-						case DISKTYPE_D88:
-						default:
-							fdd_write_d88();
-							break;
-					}
-					inc_off();
+				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.drv;
+					FDDFILE fdd = fddfile + fdc.s.drv;
 					switch(fdd->type) {
 						case DISKTYPE_NOTREADY:
 						case DISKTYPE_BETA:
@@ -267,28 +378,22 @@ void IOOUTCALL fdc_o(UINT port, REG8 val
 							break;
 					}
 				}
+#endif
 				break;
 
 			case 0x0c:								// ドライブ・サイド
-				driveset = 1;
-				FDC_c[fdc.drv] = fdc.c;
-				fdc.c = FDC_c[value & 0x03];			// XTAL !!!
-				fdc.motor = (UINT8)(value & 0x80);
-				fdc.drv = (UINT8)(value & 0x03);
-				fdc.h = (UINT8)((value >> 4) & 1);
-
-				fdc.cmd = 0;							// T&E SORCERIAN
-//				fdc.data = 0;							// 影の伝説
-				fdc.type = 0;
+				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.motor) {
-					fdc.r = 0;							// SACOM TELENET
-					fdc.rreg = 0;
-#if 0													// XTAL
-					fdc.c = 0;
-					fdc.step = 1;
-#endif
+				if (!fdc.s.motor) {
+					fdc.s.r = 0;						// SACOM TELENET
+					fdc.s.rreg = 0;
 				}
 				break;
 		}
@@ -300,11 +405,13 @@ REG8 IOINPCALL fdc_i(UINT port) {
 static	BYTE	timeoutwait;
 static	BYTE	last_r;
 static	short	last_off;
-		BYTE	ans;
-		REG8	cmd;
-
-	cmd = (REG8)(fdc.cmd >> 4);
+	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;
@@ -312,100 +419,53 @@ static	short	last_off;
 	}
 	switch(port) {
 		case 0x8:	// ステータス
-			ans = 0;
-			fdcdummyread = 0;
-			if (fdc.skip) {
-				fdc.skip--;
-				return(0x01);
-			}
-			if (fdc.busyclock) {					// ver0.25
-				if (((h_cntbase + h_cnt) - fdc.busystart) < fdc.busyclock) {
-					return(0x01);
-				}
-				fdc.busyclock = 0;
+			ret = fdcisbusy();
+			if (ret) {
+				return(ret);
 			}
-		{
-			FDDFILE fdd = fddfile + fdc.drv;
-			if (fdd->type == DISKTYPE_NOTREADY) {
-				if (fdc.type == 1 && fdc.c == 0) {	// ドライブチェック !!!
-					return(0x84);					// ←接続されてる時だけ
-				}
-				return(0x80);
-			}
-		}
-			if (fdc.type == 2) {
-				if (last_r == fdc.r && last_off == fdc.off &&
+#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_r = _fdc.r;
 				last_off = fdc.off;
 			}							// Read Write時のみの変化でいい筈
-			if (!((ans = fdd_stat()) & 2)) {
-				dma.DMA_REDY = 8;				// <- DMA ノ レディシンゴウ ヲ クリア
-			}
-#if 1
-			if (driveset) {					// 0xffcを叩いた直後だったら
-				ans &= 0xc4;
-			}
 #endif
-			return(ans);
+			ret = getstat();
+			if (!(ret & 0x02)) {
+				dma.DMA_REDY = 8;
+			}
+			return(ret);
 
-		case 0x9:							// トラック
-			return(fdc.treg);
+		case 0x9:							// トラック
+			return(fdc.s.creg);
 
-		case 0xa:							// セクタ
-			return(fdc.rreg);				// ver0.25
+		case 0xa:							// セクタ
+			return(fdc.s.rreg);
 
 		case 0xb:							// データ
-			if (fdc.motor) {
-				if ((cmd == 0x08) || (cmd == 0x09)) {	// リード・データ
-					FDDFILE fdd;
-					fdd = fddfile + fdc.drv;
-					switch(fdd->type) {
-						case DISKTYPE_NOTREADY:
-							break;
-
-						case DISKTYPE_BETA:
-							fdd_read_2d();
-							break;
-
-						case DISKTYPE_D88:
-						default:
-							fdd_read_d88();		// WOODY POCO !!!
-							break;
-					}
-					inc_off();
-				}
-				else if (cmd == 0x0c) {			// リード・アドレス
-					if (fdc.crc_off < 6) {		// ver0.25
-						fdc.data = fdc.crc_dat[fdc.crc_off];
-						if (fdcdummyread) {		// ver0.25
-							fdcdummyread--;
-						}
-						else {
-							fdc.crc_off++;
-						}
-					}
-				}
-				else if (cmd == 0x0e) {								// ver0.25
-					fdc.data = 0;
-					readdiag++;
+			if (fdc.s.motor) {
+				if (fdc.s.bufdir == FDCDIR_IN) {
+					fdc.s.data = fdc.s.buffer[fdc.s.bufpos];
+					TRACEOUT(("sector read %.2x (%.2x) [%.4x]", fdc.s.data, fdc.s.bufpos, Z80_PC));
+					bufposinc();
 				}
 			}
-			return(fdc.data);					// WOODY POCO !!!
+			return(fdc.s.data);					// WOODY POCO !!!
 
 //		case 0xc:								// FM
 //		case 0xd:								// MFM
 //			break;
 
 		case 0xe:								// 1.6M
-			fdc.media = 1;
+			fdc.s.media = DISKTYPE_2HD;
 			return(0xff);
 
 		case 0xf:								// 500K/1M
-			fdc.media = 0;
+			fdc.s.media = DISKTYPE_2D;
 			return(0xff);
 	}
 	return(0);
@@ -418,7 +478,6 @@ void fdc_reset(void) {
 
 	FDDMTR_INIT;
 	ZeroMemory(&fdc, sizeof(fdc));
-	fdc.step = 1;
-	ZeroMemory(FDC_c, 4);
+	fdc.s.step = 1;
 }