--- np2/cbus/atapicmd.c	2005/04/04 11:50:59	1.6
+++ np2/cbus/atapicmd.c	2005/04/05 20:37:07	1.8
@@ -17,7 +17,7 @@
 #include	"atapicmd.h"
 #include	"sxsi.h"
 
-// #define	YUIDEBUG
+#define	YUIDEBUG
 
 
 // INQUIRY
@@ -115,7 +115,10 @@ static void atapi_cmd_read_capacity(IDED
 static void atapi_cmd_read(IDEDRV drv, UINT32 lba, UINT32 leng);
 static void atapi_cmd_mode_select(IDEDRV drv);
 static void atapi_cmd_mode_sense(IDEDRV drv);
+static void atapi_cmd_readsubch(IDEDRV drv);
 static void atapi_cmd_readtoc(IDEDRV drv);
+static void atapi_cmd_playaudiomsf(IDEDRV drv);
+static void atapi_cmd_pauseresume(IDEDRV drv);
 
 void atapicmd_a0(IDEDRV drv) {
 
@@ -194,11 +197,26 @@ void atapicmd_a0(IDEDRV drv) {
 		atapi_cmd_mode_sense(drv);
 		break;
 
+	case 0x42:
+		TRACEOUT(("atapicmd: read sub channel"));
+		atapi_cmd_readsubch(drv);
+		break;
+
 	case 0x43:		// read TOC
 		TRACEOUT(("atapicmd: read TOC"));
 		atapi_cmd_readtoc(drv);
 		break;
 
+	case 0x47:		// Play Audio MSF
+		TRACEOUT(("atapicmd: Play Audio MSF"));
+		atapi_cmd_playaudiomsf(drv);
+		break;
+
+	case 0x4b:
+		TRACEOUT(("atapicmd: pause resume"));
+		atapi_cmd_pauseresume(drv);
+		break;
+
 	default:
 		TRACEOUT(("atapicmd: unknown command = %.2x", cmd));
 		sendabort(drv);
@@ -502,82 +520,111 @@ length_exceeded:
 	senddata(drv, cnt, leng);
 }
 
+
+// ---- Audio
+
+static void storemsf(UINT8 *ptr, UINT32 pos) {
+
+	UINT	f;
+	UINT	m;
+
+	f = pos % 75;
+	pos = pos / 75;
+	m = pos % 60;
+	pos = pos / 60;
+	ptr[0] = 0;
+	ptr[1] = (UINT8)pos;
+	ptr[2] = (UINT8)m;
+	ptr[3] = (UINT8)f;
+}
+
+
+// 0x43: READ SUB CHANNEL
+static void atapi_cmd_readsubch(IDEDRV drv) {
+
+	SXSIDEV	sxsi;
+	UINT	leng;
+	CDTRK	trk;
+	UINT	tracks;
+	UINT	r;
+	UINT32	pos;
+
+	sxsi = sxsi_getptr(drv->sxsidrv);
+	if ((sxsi == NULL) || (sxsi->devtype != SXSIDEV_CDROM) ||
+		(!(sxsi->flag & SXSIFLAG_READY))) {
+		senderror(drv);
+		return;
+	}
+	trk = sxsicd_gettrk(sxsi, &tracks);
+	leng = (drv->buf[7] << 8) + drv->buf[8];
+	switch(drv->buf[3]) {
+		case 0x01:			// CD-ROM current pos
+			ZeroMemory(drv->buf, 16);
+			drv->buf[4] = 0x01;
+			pos = drv->dacurpos + (rand() & 7);
+			r = tracks;
+			while(r) {
+				r--;
+				if (trk[r].pos <= pos) {
+					break;
+				}
+			}
+			drv->buf[5] = trk[r].type;
+			drv->buf[6] = trk[r].track;
+			drv->buf[7] = 1;
+			storemsf(drv->buf + 8, pos + 150);
+			storemsf(drv->buf + 12, pos - trk[r].pos);
+			senddata(drv, 16, leng);
+			break;
+
+		default:
+			senderror(drv);
+			break;
+	}
+}
+
+// 0x43: READ TOC
 static void atapi_cmd_readtoc(IDEDRV drv) {
 
+	SXSIDEV	sxsi;
 	UINT	leng;
 	UINT	format;
+	CDTRK	trk;
+	UINT	tracks;
+	UINT	datasize;
+	UINT8	*ptr;
+	UINT	i;
+
+	sxsi = sxsi_getptr(drv->sxsidrv);
+	if ((sxsi == NULL) || (sxsi->devtype != SXSIDEV_CDROM) ||
+		(!(sxsi->flag & SXSIFLAG_READY))) {
+		senderror(drv);
+		return;
+	}
+	trk = sxsicd_gettrk(sxsi, &tracks);
 
 	leng = (drv->buf[7] << 8) + drv->buf[8];
 	format = (drv->buf[9] >> 6);
 	TRACEOUT(("atapi_cmd_readtoc fmt=%d leng=%d", format, leng));
 
 	switch (format) {
-#ifdef YUIDEBUG
 	case 0: // track info
-		// これ、PN専用。
-		// 後で ccd等からデータを作ろう
-		drv->buf[0x00] = 0x00;	drv->buf[0x01] = 0x3a;
-		drv->buf[0x02] = 0x01;
-		drv->buf[0x03] = 0x06;
-
-		drv->buf[0x04] = 0x00;	drv->buf[0x05] = 0x14;
-		drv->buf[0x06] = 0x01;
-		drv->buf[0x07] = 0x00;
-		drv->buf[0x08] = 0x00;
-		drv->buf[0x09] = 0x00;
-		drv->buf[0x0a] = 0x02;
-		drv->buf[0x0b] = 0x00;
-
-		drv->buf[0x0c] = 0x00;	drv->buf[0x0d] = 0x10;
-		drv->buf[0x0e] = 0x02;
-		drv->buf[0x0f] = 0x00;
-		drv->buf[0x10] = 0x00;
-		drv->buf[0x11] = 0x29;
-		drv->buf[0x12] = 0x1c;
-		drv->buf[0x13] = 0x34;
-
-		drv->buf[0x14] = 0x00;	drv->buf[0x15] = 0x10;
-		drv->buf[0x16] = 0x03;
-		drv->buf[0x17] = 0x00;
-		drv->buf[0x18] = 0x00;
-		drv->buf[0x19] = 0x29;
-		drv->buf[0x1a] = 0x20;
-		drv->buf[0x1b] = 0x43;
-
-		drv->buf[0x1c] = 0x00;	drv->buf[0x1d] = 0x10;
-		drv->buf[0x1e] = 0x04;
-		drv->buf[0x1f] = 0x00;
-		drv->buf[0x20] = 0x00;
-		drv->buf[0x21] = 0x2b;
-		drv->buf[0x22] = 0x07;
-		drv->buf[0x23] = 0x19;
-
-		drv->buf[0x24] = 0x00;	drv->buf[0x25] = 0x10;
-		drv->buf[0x26] = 0x05;
-		drv->buf[0x27] = 0x00;
-		drv->buf[0x28] = 0x00;
-		drv->buf[0x29] = 0x2e;
-		drv->buf[0x2a] = 0x39;
-		drv->buf[0x2b] = 0x1d;
-
-		drv->buf[0x2c] = 0x00;	drv->buf[0x2d] = 0x10;
-		drv->buf[0x2e] = 0x06;
-		drv->buf[0x2f] = 0x00;
-		drv->buf[0x30] = 0x00;
-		drv->buf[0x31] = 0x34;
-		drv->buf[0x32] = 0x0b;
-		drv->buf[0x33] = 0x13;
-
-		drv->buf[0x34] = 0x00;	drv->buf[0x35] = 0x10;
-		drv->buf[0x36] = 0xaa;
-		drv->buf[0x37] = 0x00;
-		drv->buf[0x38] = 0x00;
-		drv->buf[0x39] = 0x3b;
-		drv->buf[0x3a] = 0x1e;
-		drv->buf[0x3b] = 0x0b;
-		senddata(drv, 0x3c, leng);
+		datasize = (tracks * 8) + 10;
+		drv->buf[0] = (UINT8)(datasize >> 8);
+		drv->buf[1] = (UINT8)(datasize >> 0);
+		drv->buf[2] = 1;
+		drv->buf[3] = (UINT8)tracks;
+		ptr = drv->buf + 4;
+		for (i=0; i<=tracks; i++) {
+			ptr[0] = 0;
+			ptr[1] = trk[i].type;
+			ptr[2] = trk[i].track;
+			ptr[3] = 0;
+			storemsf(ptr + 4, trk[i].pos + 150);
+			ptr += 8;
+		}
+		senddata(drv, (tracks * 8) + 12, leng);
 		break;
-#endif
 
 	case 1:	// multi session
 		ZeroMemory(drv->buf, 12);
@@ -596,4 +643,28 @@ static void atapi_cmd_readtoc(IDEDRV drv
 	}
 }
 
+// 0x47: Play Audio MSF
+static void atapi_cmd_playaudiomsf(IDEDRV drv) {
+
+	UINT32	pos;
+
+	pos = (((drv->buf[6] * 60) + drv->buf[7]) * 75) + drv->buf[8];
+	if (pos >= 150) {
+		pos -= 150;
+	}
+	else {
+		pos = 0;
+	}
+	drv->daendpos = pos;
+	drv->dacurpos = pos;		// 終了したことにする。
+	cmddone(drv);
+}
+
+// 0x4B: PAUSE RESUME
+static void atapi_cmd_pauseresume(IDEDRV drv) {
+
+	cmddone(drv);
+}
+
 #endif	/* SUPPORT_IDEIO */
+