--- np2/cbus/ideio.c	2004/03/22 05:38:47	1.2
+++ np2/cbus/ideio.c	2004/08/04 16:28:46	1.5
@@ -1,6 +1,6 @@
 #include	"compiler.h"
 
-// winでidentifyまでは取得に行くんだけどな…
+// winでidentifyまでは取得に行くんだけどな…ってAnex86も同じか
 
 #if defined(SUPPORT_IDEIO)
 
@@ -62,17 +62,14 @@ static BOOL setidentify(IDEDRV drv) {
 
 	ZeroMemory(tmp, sizeof(tmp));
 	// とりあえず使ってる部分だけ
-	tmp[0] = 0x045a;
+	tmp[0] = 0x0040;
 	tmp[1] = sxsi->cylinders;
 	tmp[3] = sxsi->surfaces;
 	tmp[4] = sxsi->sectors * 512;
-//	tmp[5] = 0;					// ???
 	tmp[6] = sxsi->sectors;
 	for (i=0; i<10; i++) {
 		tmp[10+i] = (serial[i*2] << 8) + serial[i*2+1];
 	}
-	tmp[20] = 3;
-	tmp[21] = 16;
 	tmp[22] = 4;
 	for (i=0; i<4; i++) {
 		tmp[23+i] = (firm[i*2] << 8) + firm[i*2+1];
@@ -80,12 +77,10 @@ static BOOL setidentify(IDEDRV drv) {
 	for (i=0; i<20; i++) {
 		tmp[27+i] = (model[i*2] << 8) + model[i*2+1];
 	}
-//	tmp[47] = 0;				// multiple
-	tmp[49] = 0x0f00;
-	tmp[50] = 0x4000;
+	tmp[47] = 0x00;				// multiple
+	tmp[49] = 0x0000;			// LBA(1 << 9)
 	tmp[51] = 0x0200;
-	tmp[52] = 0x0200;
-	tmp[53] = 0x0007;
+	tmp[53] = 0x0001;
 	tmp[54] = sxsi->cylinders;
 	tmp[55] = sxsi->surfaces;
 	tmp[56] = sxsi->sectors;
@@ -95,10 +90,10 @@ static BOOL setidentify(IDEDRV drv) {
 //	tmp[59] = 0;
 	tmp[60] = (UINT16)size;
 	tmp[61] = (UINT16)(size >> 16);
-	tmp[63] = 0x0407;
+	tmp[63] = 0;				// multi word DMA
 
-	tmp[80] = 0x001e;
-	tmp[81] = 0x0011;
+	tmp[80] = 0x0006;			// support ATA-1/2
+	tmp[81] = 0;
 
 	p = drv->buf;
 	for (i=0; i<256; i++) {
@@ -106,6 +101,7 @@ static BOOL setidentify(IDEDRV drv) {
 		p[1] = (BYTE)(tmp[i] >> 8);
 		p += 2;
 	}
+	drv->bufdir = IDEDIR_IN;
 	drv->bufpos = 0;
 	drv->bufsize = 512;
 	return(SUCCESS);
@@ -113,16 +109,19 @@ static BOOL setidentify(IDEDRV drv) {
 
 static void setintr(IDEDRV drv) {
 
-	ideio.bank[0] = ideio.bank[1] | 0x80;			// ????
-	pic_setirq(IDE_IRQ);
+	if (!(drv->ctrl & IDECTRL_NIEN)) {
+		TRACEOUT(("ideio: setintr()"));
+		ideio.bank[0] = ideio.bank[1] | 0x80;			// ????
+		pic_setirq(IDE_IRQ);
+	}
 }
 
 static void cmdabort(IDEDRV drv) {
 
+	TRACEOUT(("ideio: cmdabort()"));
 	drv->status = IDESTAT_DRDY | IDESTAT_ERR;
 	drv->error = IDEERR_ABRT;
-	ideio.bank[0] = ideio.bank[1] | 0x80;			// ????
-	pic_setirq(IDE_IRQ);
+	setintr(drv);
 }
 
 static void panic(const char *str, ...) {
@@ -143,36 +142,50 @@ static void panic(const char *str, ...) 
 
 static void incsec(IDEDRV drv) {
 
-	if (drv->dr & IDEDEV_LBA) {
-		TRACEOUT(("ideio: incsec() LBA mode?"));
-		return;
-	}
-	drv->sn++;
-	if (drv->sn <= drv->sectors) {
-		return;
+	if (!(drv->dr & IDEDEV_LBA)) {
+		drv->sn++;
+		if (drv->sn <= drv->sectors) {
+			return;
+		}
+		drv->sn = 1;
+		drv->hd++;
+		if (drv->hd < drv->surfaces) {
+			return;
+		}
+		drv->hd = 0;
+		drv->cy++;
 	}
-	drv->sn = 1;
-	drv->hd++;
-	if (drv->hd < drv->surfaces) {
-		return;
+	else {
+		TRACEOUT(("ideio: incsec() LBA mode?"));
+		drv->sn++;
+		if (drv->sn) {
+			return;
+		}
+		drv->cy++;
+		if (drv->cy) {
+			return;
+		}
+		drv->hd++;
 	}
-	drv->hd = 0;
-	drv->cy++;
 }
 
 static long getcursec(const _IDEDRV *drv) {
 
 	long	ret;
 
-	if (drv->dr & IDEDEV_LBA) {
+	if (!(drv->dr & IDEDEV_LBA)) {
+		ret = drv->cy;
+		ret *= drv->surfaces;
+		ret += drv->hd;
+		ret *= drv->sectors;
+		ret += (drv->sn - 1);
+	}
+	else {
 		TRACEOUT(("ideio: getcursec() LBA mode?"));
-		return(-1);
+		ret = drv->sn;
+		ret |= (drv->cy << 8);
+		ret |= (drv->hd << 24);
 	}
-	ret = drv->cy;
-	ret *= drv->surfaces;
-	ret += drv->hd;
-	ret *= drv->sectors;
-	ret += (drv->sn - 1);
 	return(ret);
 }
 
@@ -186,7 +199,7 @@ static void readsec(IDEDRV drv) {
 	sec = getcursec(drv);
 	TRACEOUT(("readsec->drv %d sec %x", drv->sxsidrv, sec));
 	if (sxsi_read(drv->sxsidrv, sec, drv->buf, 512)) {
-		TRACEOUT(("readerror!"));
+		TRACEOUT(("read error!"));
 		goto read_err;
 	}
 	drv->bufdir = IDEDIR_IN;
@@ -239,17 +252,20 @@ static void IOOUTCALL ideio_o642(UINT po
 		drv->wp = dat;
 		TRACEOUT(("ideio set WP %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
 	}
+	(void)port;
 }
 
 static void IOOUTCALL ideio_o644(UINT port, REG8 dat) {
 
 	IDEDRV	drv;
 
+	(void)port;
 	drv = getidedrv();
 	if (drv) {
 		drv->sc = dat;
 		TRACEOUT(("ideio set SC %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
 	}
+	(void)port;
 }
 
 static void IOOUTCALL ideio_o646(UINT port, REG8 dat) {
@@ -261,6 +277,7 @@ static void IOOUTCALL ideio_o646(UINT po
 		drv->sn = dat;
 		TRACEOUT(("ideio set SN %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
 	}
+	(void)port;
 }
 
 static void IOOUTCALL ideio_o648(UINT port, REG8 dat) {
@@ -273,6 +290,7 @@ static void IOOUTCALL ideio_o648(UINT po
 		drv->cy |= dat;
 		TRACEOUT(("ideio set CYL %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
 	}
+	(void)port;
 }
 
 static void IOOUTCALL ideio_o64a(UINT port, REG8 dat) {
@@ -285,6 +303,7 @@ static void IOOUTCALL ideio_o64a(UINT po
 		drv->cy |= dat << 8;
 		TRACEOUT(("ideio set CYH %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
 	}
+	(void)port;
 }
 
 static void IOOUTCALL ideio_o64c(UINT port, REG8 dat) {
@@ -306,11 +325,13 @@ static void IOOUTCALL ideio_o64c(UINT po
 	dev->drv[drvnum].dr = dat & 0xf0;
 	dev->drv[drvnum].hd = dat & 0x0f;
 	TRACEOUT(("ideio set DRHD %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
+	(void)port;
 }
 
 static void IOOUTCALL ideio_o64e(UINT port, REG8 dat) {
 
 	IDEDRV	drv;
+	IDEDEV	dev;
 
 	drv = getidedrv();
 	if (drv == NULL) {
@@ -319,14 +340,30 @@ static void IOOUTCALL ideio_o64e(UINT po
 	drv->cmd = dat;
 	TRACEOUT(("ideio set cmd %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
 	switch(dat) {
-		case 0x08:		// atapi reset
+		case 0x08:		// device reset
 			if (drv->device == IDETYPE_CDROM) {
-				drv->hd = 0;
-				drv->sc = 1;
-				drv->sn = 1;
+				drv->hd = 0x10;
+				drv->sc = 0x01;
+				drv->sn = 0x01;
 				drv->cy = 0xeb14;
-				drv->status = 0;
-				drv->error = 0;
+				drv->status = 0x00;
+				drv->error = 0x01;
+				dev = getidedev();
+				if (dev) {
+					if (dev->drivesel == 0) {
+						if (dev->drv[0].device == IDETYPE_NONE) {
+							drv->error = 0x00;
+						}
+						if (dev->drv[1].device == IDETYPE_NONE) {
+							drv->error |= 0x80;
+						}
+					}
+					else {
+						if (dev->drv[1].device == IDETYPE_NONE) {
+							drv->error = 0x00;
+						}
+					}
+				}
 			}
 			break;
 
@@ -350,6 +387,41 @@ static void IOOUTCALL ideio_o64e(UINT po
 			readsec(drv);
 			break;
 
+		case 0x90:		// execute device diagnostic
+			TRACEOUT(("ideio execute device diagnostic [%.4x:%.8x]",
+											CPU_CS, CPU_EIP));
+			dev = getidedev();
+			if (dev) {
+				if (drv->device == IDETYPE_HDD) {
+					drv->hd = 0x00;
+					drv->sc = 0x01;
+					drv->sn = 0x01;
+					drv->cy = 0x0000;
+				}
+				else if (drv->device == IDETYPE_CDROM) {
+					drv->hd = 0x10;
+					drv->sc = 0x01;
+					drv->sn = 0x01;
+					drv->cy = 0xeb14;
+				}
+				drv->status = IDESTAT_DRDY;
+				drv->error = 0x01;
+				if (dev->drivesel == 0) {
+					if (dev->drv[0].device == IDETYPE_NONE) {
+						drv->error = 0x00;
+					}
+					if (dev->drv[1].device == IDETYPE_NONE) {
+						drv->error |= 0x80;
+					}
+				}
+				else {
+					if (dev->drv[1].device == IDETYPE_NONE) {
+						drv->error = 0x00;
+					}
+				}
+			}
+			break;
+
 		case 0x91:		// set parameters
 			TRACEOUT(("ideio: set parameters dh=%x sec=%x",
 											drv->dr | drv->hd, drv->sc));
@@ -379,6 +451,7 @@ static void IOOUTCALL ideio_o64e(UINT po
 			}
 			break;
 
+		case 0xa1:		// identify
 		case 0xec:		// identify
 			TRACEOUT(("ideio: identify"));
 			if (setidentify(drv) == SUCCESS) {
@@ -395,6 +468,7 @@ static void IOOUTCALL ideio_o64e(UINT po
 			panic("command:%.2x", dat);
 			break;
 	}
+	(void)port;
 }
 
 static void IOOUTCALL ideio_o74c(UINT port, REG8 dat) {
@@ -427,12 +501,16 @@ static void IOOUTCALL ideio_o74c(UINT po
 			}
 		}
 	}
-	TRACEOUT(("ideio %.4x,%.2x [%.4x:%.8x]", port, dat, CPU_CS, CPU_EIP));
+	TRACEOUT(("ideio interrupt %sable", (dat & IDECTRL_NIEN) ? "dis" : "en"));
+	TRACEOUT(("ideio devctrl %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
+	(void)port;
 }
 
 static void IOOUTCALL ideio_o74e(UINT port, REG8 dat) {
 
 	TRACEOUT(("ideio %.4x,%.2x [%.4x:%.8x]", port, dat, CPU_CS, CPU_EIP));
+	(void)port;
+	(void)dat;
 }
 
 
@@ -442,6 +520,8 @@ static REG8 IOINPCALL ideio_i642(UINT po
 
 	IDEDRV	drv;
 
+	(void)port;
+
 	drv = getidedrv();
 	if (drv) {
 		drv->status &= ~IDESTAT_ERR;
@@ -458,6 +538,8 @@ static REG8 IOINPCALL ideio_i644(UINT po
 
 	IDEDRV	drv;
 
+	(void)port;
+
 	drv = getidedrv();
 	if (drv) {
 		TRACEOUT(("ideio get SC %.2x [%.4x:%.8x]", drv->sc, CPU_CS, CPU_EIP));
@@ -472,6 +554,8 @@ static REG8 IOINPCALL ideio_i646(UINT po
 
 	IDEDRV	drv;
 
+	(void)port;
+
 	drv = getidedrv();
 	if (drv) {
 		TRACEOUT(("ideio get SN %.2x [%.4x:%.8x]", drv->sn, CPU_CS, CPU_EIP));
@@ -486,6 +570,8 @@ static REG8 IOINPCALL ideio_i648(UINT po
 
 	IDEDRV	drv;
 
+	(void)port;
+
 	drv = getidedrv();
 	if (drv) {
 		TRACEOUT(("ideio get CYL %.4x [%.4x:%.8x]", drv->cy, CPU_CS, CPU_EIP));
@@ -500,6 +586,8 @@ static REG8 IOINPCALL ideio_i64a(UINT po
 
 	IDEDRV	drv;
 
+	(void)port;
+
 	drv = getidedrv();
 	if (drv) {
 		TRACEOUT(("ideio get CYH %.4x [%.4x:%.8x]", drv->cy, CPU_CS, CPU_EIP));
@@ -515,6 +603,8 @@ static REG8 IOINPCALL ideio_i64c(UINT po
 	IDEDRV	drv;
 	REG8	ret;
 
+	(void)port;
+
 	drv = getidedrv();
 	if (drv) {
 		ret = drv->dr | drv->hd;
@@ -530,10 +620,16 @@ static REG8 IOINPCALL ideio_i64e(UINT po
 
 	IDEDRV	drv;
 
+	(void)port;
+
 	drv = getidedrv();
 	if (drv) {
 		TRACEOUT(("ideio status %.2x [%.4x:%.8x]",
 											drv->status, CPU_CS, CPU_EIP));
+		if (!(drv->ctrl & IDECTRL_NIEN)) {
+			TRACEOUT(("ideio: resetirq"));
+			pic_resetirq(IDE_IRQ);
+		}
 		return(drv->status);
 	}
 	else {
@@ -543,8 +639,19 @@ static REG8 IOINPCALL ideio_i64e(UINT po
 
 static REG8 IOINPCALL ideio_i74c(UINT port) {
 
-	TRACEOUT(("ideio %.4x [%.4x:%.8x]", port, CPU_CS, CPU_EIP));
-	return(0xff);
+	IDEDRV	drv;
+
+	(void)port;
+
+	drv = getidedrv();
+	if (drv) {
+		TRACEOUT(("ideio alt status %.2x [%.4x:%.8x]",
+											drv->status, CPU_CS, CPU_EIP));
+		return(drv->status);
+	}
+	else {
+		return(0xff);
+	}
 }
 
 
@@ -573,14 +680,17 @@ void IOOUTCALL ideio_w16(UINT port, REG1
 			}
 		}
 	}
+	(void)port;
 }
 
-REG16 IOOUTCALL ideio_r16(UINT port) {
+REG16 IOINPCALL ideio_r16(UINT port) {
 
 	IDEDRV	drv;
 	REG16	ret;
 	BYTE	*p;
 
+	(void)port;
+
 	drv = getidedrv();
 	if (drv == NULL) {
 		return(0xff);
@@ -589,7 +699,7 @@ REG16 IOOUTCALL ideio_r16(UINT port) {
 	if ((drv->status & IDESTAT_DRQ) && (drv->bufdir == IDEDIR_IN)) {
 		p = drv->buf + drv->bufpos;
 		ret = p[0] + (p[1] << 8);
-		TRACEOUT(("ide-data recv %4x (%.4x) [%.4x:%.8x]",
+		TRACEOUT(("ide-data recv %.4x (%.4x) [%.4x:%.8x]",
 										ret, drv->bufpos, CPU_CS, CPU_EIP));
 		drv->bufpos += 2;
 		if (drv->bufpos >= drv->bufsize) {
@@ -706,5 +816,5 @@ void ideio_bind(void) {
 		iocore_attachinp(0x074c, ideio_i74c);
 	}
 }
-#endif
 
+#endif	/* SUPPORT_IDEIO */