[picodrive.git] / Pico / cd / cd_file.c

/***********************************************************
 *                                                         *
 * This source was taken from the Gens project             *
 * Written by Stéphane Dallongeville                       *
 * Copyright (c) 2002 by Stéphane Dallongeville            *
 * Modified/adapted for PicoDrive by notaz, 2007           *
 *                                                         *
 ***********************************************************/

#include "../PicoInt.h"
#include "cd_file.h"

#define cdprintf dprintf
//#define cdprintf(x...)
//#define cdprintf(f,...) printf(f "\n",##__VA_ARGS__) // tmp
#define DEBUG_CD

PICO_INTERNAL int Load_ISO(const char *iso_name, int is_bin)
{
	int i, j, num_track, Cur_LBA, index, ret, iso_name_len;
	_scd_track *Tracks = Pico_mcd->TOC.Tracks;
	char tmp_name[1024], tmp_ext[10];
	pm_file *pmf;
	static char *exts[] = {
		"%02d.mp3", " %02d.mp3", "-%02d.mp3", "_%02d.mp3", " - %02d.mp3",
		"%d.mp3", " %d.mp3", "-%d.mp3", "_%d.mp3", " - %d.mp3",
#if CASE_SENSITIVE_FS
		"%02d.MP3", " %02d.MP3", "-%02d.MP3", "_%02d.MP3", " - %02d.MP3",
#endif
	};

	if (PicoCDLoadProgressCB != NULL) PicoCDLoadProgressCB(1);

	Unload_ISO();

	Tracks[0].ftype = is_bin ? TYPE_BIN : TYPE_ISO;

	Tracks[0].F = pmf = pm_open(iso_name);
	if (Tracks[0].F == NULL)
	{
		Tracks[0].ftype = 0;
		Tracks[0].Length = 0;
		return -1;
	}

	if (Tracks[0].ftype == TYPE_ISO)
		Tracks[0].Length = pmf->size >>= 11;	// size in sectors
	else	Tracks[0].Length = pmf->size /= 2352;

	Tracks[0].MSF.M = 0; // minutes
	Tracks[0].MSF.S = 2; // seconds
	Tracks[0].MSF.F = 0; // frames

	cdprintf("Track 0 - %02d:%02d:%02d DATA", Tracks[0].MSF.M, Tracks[0].MSF.S, Tracks[0].MSF.F);

	Cur_LBA = Tracks[0].Length;				// Size in sectors

	iso_name_len = strlen(iso_name);
	if (iso_name_len >= sizeof(tmp_name))
		iso_name_len = sizeof(tmp_name) - 1;

	for (num_track = 2, i = 0; i < 100; i++)
	{
		if (PicoCDLoadProgressCB != NULL && i > 1) PicoCDLoadProgressCB(i);

		for (j = 0; j < sizeof(exts)/sizeof(char *); j++)
		{
			int ext_len;
			FILE *tmp_file;
			sprintf(tmp_ext, exts[j], i);
			ext_len = strlen(tmp_ext);

			memcpy(tmp_name, iso_name, iso_name_len + 1);
			tmp_name[iso_name_len - 4] = 0;
			strcat(tmp_name, tmp_ext);

			tmp_file = fopen(tmp_name, "rb");
			if (!tmp_file && i > 1 && iso_name_len > ext_len) {
				tmp_name[iso_name_len - ext_len] = 0;
				strcat(tmp_name, tmp_ext);
				tmp_file = fopen(tmp_name, "rb");
			}

			if (tmp_file)
			{
				int fs;
				index = num_track - 1;

				ret = fseek(tmp_file, 0, SEEK_END);
				fs = ftell(tmp_file);				// used to calculate lenght
				fseek(tmp_file, 0, SEEK_SET);

#if DONT_OPEN_MANY_FILES
				// some systems (like PSP) can't have many open files at a time,
				// so we work with their names instead.
				fclose(tmp_file);
				tmp_file = (void *) strdup(tmp_name);
#endif
				Tracks[index].KBtps = (short) mp3_get_bitrate(tmp_file, fs);
				Tracks[index].KBtps >>= 3;
				if (ret != 0 || Tracks[index].KBtps <= 0)
				{
					cdprintf("Error track %i: rate %i", index, Tracks[index].KBtps);
#if !DONT_OPEN_MANY_FILES
					fclose(tmp_file);
#else
					free(tmp_file);
#endif
					continue;
				}

				Tracks[index].F = tmp_file;

				LBA_to_MSF(Cur_LBA, &Tracks[index].MSF);

				// MP3 File
				Tracks[index].ftype = TYPE_MP3;
				fs *= 75;
				fs /= Tracks[index].KBtps * 1000;
				Tracks[index].Length = fs;
				Cur_LBA += Tracks[index].Length;

				cdprintf("Track %i: %s - %02d:%02d:%02d len=%i AUDIO", index, tmp_name, Tracks[index].MSF.M,
					Tracks[index].MSF.S, Tracks[index].MSF.F, fs);

				num_track++;
				break;
			}
		}
	}

	Pico_mcd->TOC.Last_Track = num_track - 1;

	index = num_track - 1;

	LBA_to_MSF(Cur_LBA, &Tracks[index].MSF);

	cdprintf("End CD - %02d:%02d:%02d\n\n", Tracks[index].MSF.M,
		Tracks[index].MSF.S, Tracks[index].MSF.F);

	if (PicoCDLoadProgressCB != NULL) PicoCDLoadProgressCB(100);

	return 0;
}


PICO_INTERNAL void Unload_ISO(void)
{
	int i;

	if (Pico_mcd == NULL) return;

	if (Pico_mcd->TOC.Tracks[0].F) pm_close(Pico_mcd->TOC.Tracks[0].F);

	for(i = 1; i < 100; i++)
	{
		if (Pico_mcd->TOC.Tracks[i].F != NULL)
#if !DONT_OPEN_MANY_FILES
			fclose(Pico_mcd->TOC.Tracks[i].F);
#else
			free(Pico_mcd->TOC.Tracks[i].F);
#endif
	}
	memset(Pico_mcd->TOC.Tracks, 0, sizeof(Pico_mcd->TOC.Tracks));
}


PICO_INTERNAL int FILE_Read_One_LBA_CDC(void)
{
//	static char cp_buf[2560];

	if (Pico_mcd->s68k_regs[0x36] & 1)					// DATA
	{
		if (Pico_mcd->TOC.Tracks[0].F == NULL) return -1;

		// moved below..
		//fseek(Pico_mcd->TOC.Tracks[0].F, where_read, SEEK_SET);
		//fread(cp_buf, 1, 2048, Pico_mcd->TOC.Tracks[0].F);

		cdprintf("Read file CDC 1 data sector :\n");
	}
	else									// AUDIO
	{
		// int rate, channel;

		// if (Pico_mcd->TOC.Tracks[Pico_mcd->scd.Cur_Track - 1].ftype == TYPE_MP3)
		{
			// TODO
			// MP3_Update(cp_buf, &rate, &channel, 0);
			// Write_CD_Audio((short *) cp_buf, rate, channel, 588);
		}

		cdprintf("Read file CDC 1 audio sector :\n");
	}

	// Update CDC stuff

	CDC_Update_Header();

	if (Pico_mcd->s68k_regs[0x36] & 1)		// DATA track
	{
		if (Pico_mcd->cdc.CTRL.B.B0 & 0x80)		// DECEN = decoding enable
		{
			if (Pico_mcd->cdc.CTRL.B.B0 & 0x04)	// WRRQ : this bit enable write to buffer
			{
				int where_read = 0;

				// CAUTION : lookahead bit not implemented

				if (Pico_mcd->scd.Cur_LBA < 0)
					where_read = 0;
				else if (Pico_mcd->scd.Cur_LBA >= Pico_mcd->TOC.Tracks[0].Length)
					where_read = Pico_mcd->TOC.Tracks[0].Length - 1;
				else where_read = Pico_mcd->scd.Cur_LBA;

				Pico_mcd->scd.Cur_LBA++;

				Pico_mcd->cdc.WA.N = (Pico_mcd->cdc.WA.N + 2352) & 0x7FFF;		// add one sector to WA
				Pico_mcd->cdc.PT.N = (Pico_mcd->cdc.PT.N + 2352) & 0x7FFF;

				*(unsigned int *)(Pico_mcd->cdc.Buffer + Pico_mcd->cdc.PT.N) = Pico_mcd->cdc.HEAD.N;
				//memcpy(&Pico_mcd->cdc.Buffer[Pico_mcd->cdc.PT.N + 4], cp_buf, 2048);

				//pm_seek(Pico_mcd->TOC.Tracks[0].F, where_read, SEEK_SET);
				//pm_read(Pico_mcd->cdc.Buffer + Pico_mcd->cdc.PT.N + 4, 2048, Pico_mcd->TOC.Tracks[0].F);
				PicoCDBufferRead(Pico_mcd->cdc.Buffer + Pico_mcd->cdc.PT.N + 4, where_read);

#ifdef DEBUG_CD
				cdprintf("Read -> WA = %d  Buffer[%d] =", Pico_mcd->cdc.WA.N, Pico_mcd->cdc.PT.N & 0x3FFF);
				cdprintf("Header 1 = %.2X %.2X %.2X %.2X", Pico_mcd->cdc.HEAD.B.B0,
					Pico_mcd->cdc.HEAD.B.B1, Pico_mcd->cdc.HEAD.B.B2, Pico_mcd->cdc.HEAD.B.B3);
				cdprintf("Header 2 = %.2X %.2X %.2X %.2X --- %.2X %.2X\n\n",
					Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 0) & 0x3FFF],
					Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 1) & 0x3FFF],
					Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 2) & 0x3FFF],
					Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 3) & 0x3FFF],
					Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 4) & 0x3FFF],
					Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 5) & 0x3FFF]);
#endif
			}

		}
	}
	else		// music track
	{
		Pico_mcd->scd.Cur_LBA++;

		Pico_mcd->cdc.WA.N = (Pico_mcd->cdc.WA.N + 2352) & 0x7FFF;		// add one sector to WA
		Pico_mcd->cdc.PT.N = (Pico_mcd->cdc.PT.N + 2352) & 0x7FFF;

		if (Pico_mcd->cdc.CTRL.B.B0 & 0x80)		// DECEN = decoding enable
		{
			if (Pico_mcd->cdc.CTRL.B.B0 & 0x04)	// WRRQ : this bit enable write to buffer
			{
				// CAUTION : lookahead bit not implemented

				//memcpy(&Pico_mcd->cdc.Buffer[Pico_mcd->cdc.PT.N], cp_buf, 2352);
			}
		}
	}

	if (Pico_mcd->cdc.CTRL.B.B0 & 0x80)		// DECEN = decoding enable
	{
		Pico_mcd->cdc.STAT.B.B0 = 0x80;

		if (Pico_mcd->cdc.CTRL.B.B0 & 0x10)	// determine form bit form sub header ?
		{
			Pico_mcd->cdc.STAT.B.B2 = Pico_mcd->cdc.CTRL.B.B1 & 0x08;
		}
		else
		{
			Pico_mcd->cdc.STAT.B.B2 = Pico_mcd->cdc.CTRL.B.B1 & 0x0C;
		}

		if (Pico_mcd->cdc.CTRL.B.B0 & 0x02) Pico_mcd->cdc.STAT.B.B3 = 0x20;	// ECC done
		else Pico_mcd->cdc.STAT.B.B3 = 0x00;	// ECC not done

		if (Pico_mcd->cdc.IFCTRL & 0x20)
		{
			if (Pico_mcd->s68k_regs[0x33] & (1<<5))
			{
				dprintf("cdc dec irq 5");
				SekInterruptS68k(5);
			}

			Pico_mcd->cdc.IFSTAT &= ~0x20;		// DEC interrupt happen
			Pico_mcd->cdc.Decode_Reg_Read = 0;	// Reset read after DEC int
		}
	}


	return 0;
}


PICO_INTERNAL int FILE_Play_CD_LBA(void)
{
	int index = Pico_mcd->scd.Cur_Track - 1;
	Pico_mcd->m.audio_track = index;

	cdprintf("Play track #%i", Pico_mcd->scd.Cur_Track);

	if (Pico_mcd->TOC.Tracks[index].F == NULL)
	{
		return 1;
	}

	if (Pico_mcd->TOC.Tracks[index].ftype == TYPE_MP3)
	{
		int pos1024 = 0;
		int Track_LBA_Pos = Pico_mcd->scd.Cur_LBA - Track_to_LBA(Pico_mcd->scd.Cur_Track);
		if (Track_LBA_Pos < 0) Track_LBA_Pos = 0;
		if (Track_LBA_Pos)
			pos1024 = Track_LBA_Pos * 1024 / Pico_mcd->TOC.Tracks[index].Length;

		mp3_start_play(Pico_mcd->TOC.Tracks[index].F, pos1024);
	}
	else
	{
		return 3;
	}

	return 0;
}
Commit	Line	Data
6cadc2da	1	/***********************************************************
	2	* *
	3	* This source was taken from the Gens project *
	4	* Written by Stéphane Dallongeville *
	5	* Copyright (c) 2002 by Stéphane Dallongeville *
	6	* Modified/adapted for PicoDrive by notaz, 2007 *
	7	* *
	8	***********************************************************/
	9
bf098bc5	10	#include "../PicoInt.h"
eff55556	11	#include "cd_file.h"
bf098bc5	12
c459aefd	13	#define cdprintf dprintf
bf098bc5	14	//#define cdprintf(x...)
4b167c12	15	//#define cdprintf(f,...) printf(f "\n",##__VA_ARGS__) // tmp
c459aefd	16	#define DEBUG_CD
bf098bc5	17
eff55556	18	PICO_INTERNAL int Load_ISO(const char *iso_name, int is_bin)
bf098bc5	19	{
cb0316e4	20	int i, j, num_track, Cur_LBA, index, ret, iso_name_len;
75736070	21	_scd_track *Tracks = Pico_mcd->TOC.Tracks;
bf098bc5	22	char tmp_name[1024], tmp_ext[10];
83bd0b76	23	pm_file *pmf;
bf098bc5	24	static char *exts[] = {
	25	"%02d.mp3", " %02d.mp3", "-%02d.mp3", "_%02d.mp3", " - %02d.mp3",
	26	"%d.mp3", " %d.mp3", "-%d.mp3", "_%d.mp3", " - %d.mp3",
4b167c12	27	#if CASE_SENSITIVE_FS
51a902ae	28	"%02d.MP3", " %02d.MP3", "-%02d.MP3", "_%02d.MP3", " - %02d.MP3",
4b167c12	29	#endif
bf098bc5	30	};
bf098bc5	31
4b167c12	32	if (PicoCDLoadProgressCB != NULL) PicoCDLoadProgressCB(1);
4b167c12	33
bf098bc5	34	Unload_ISO();
bf098bc5	35
75736070	36	Tracks[0].ftype = is_bin ? TYPE_BIN : TYPE_ISO;
bf098bc5	37
83bd0b76	38	Tracks[0].F = pmf = pm_open(iso_name);
bf098bc5	39	if (Tracks[0].F == NULL)
bf098bc5	40	{
75736070	41	Tracks[0].ftype = 0;
cb0316e4	42	Tracks[0].Length = 0;
bf098bc5	43	return -1;
	44	}
	45
83bd0b76	46	if (Tracks[0].ftype == TYPE_ISO)
	47	Tracks[0].Length = pmf->size >>= 11; // size in sectors
	48	else Tracks[0].Length = pmf->size /= 2352;
bf098bc5	49
75736070	50	Tracks[0].MSF.M = 0; // minutes
	51	Tracks[0].MSF.S = 2; // seconds
	52	Tracks[0].MSF.F = 0; // frames
bf098bc5	53
75736070	54	cdprintf("Track 0 - %02d:%02d:%02d DATA", Tracks[0].MSF.M, Tracks[0].MSF.S, Tracks[0].MSF.F);
bf098bc5	55
cb0316e4	56	Cur_LBA = Tracks[0].Length; // Size in sectors
bf098bc5	57
cb0316e4	58	iso_name_len = strlen(iso_name);
4b167c12	59	if (iso_name_len >= sizeof(tmp_name))
4b167c12	60	iso_name_len = sizeof(tmp_name) - 1;
bf098bc5	61
cb0316e4	62	for (num_track = 2, i = 0; i < 100; i++)
bf098bc5	63	{
4b167c12	64	if (PicoCDLoadProgressCB != NULL && i > 1) PicoCDLoadProgressCB(i);
	65
	66	for (j = 0; j < sizeof(exts)/sizeof(char *); j++)
bf098bc5	67	{
cb0316e4	68	int ext_len;
83bd0b76	69	FILE *tmp_file;
bf098bc5	70	sprintf(tmp_ext, exts[j], i);
cb0316e4	71	ext_len = strlen(tmp_ext);
	72
	73	memcpy(tmp_name, iso_name, iso_name_len + 1);
	74	tmp_name[iso_name_len - 4] = 0;
bf098bc5	75	strcat(tmp_name, tmp_ext);
	76
	77	tmp_file = fopen(tmp_name, "rb");
cb0316e4	78	if (!tmp_file && i > 1 && iso_name_len > ext_len) {
	79	tmp_name[iso_name_len - ext_len] = 0;
	80	strcat(tmp_name, tmp_ext);
	81	tmp_file = fopen(tmp_name, "rb");
	82	}
bf098bc5	83
	84	if (tmp_file)
	85	{
cb0316e4	86	int fs;
75736070	87	index = num_track - 1;
bf098bc5	88
4b167c12	89	ret = fseek(tmp_file, 0, SEEK_END);
	90	fs = ftell(tmp_file); // used to calculate lenght
	91	fseek(tmp_file, 0, SEEK_SET);
bf098bc5	92
4b167c12	93	#if DONT_OPEN_MANY_FILES
	94	// some systems (like PSP) can't have many open files at a time,
	95	// so we work with their names instead.
	96	fclose(tmp_file);
	97	tmp_file = (void *) strdup(tmp_name);
	98	#endif
cb0316e4	99	Tracks[index].KBtps = (short) mp3_get_bitrate(tmp_file, fs);
	100	Tracks[index].KBtps >>= 3;
	101	if (ret != 0 \|\| Tracks[index].KBtps <= 0)
	102	{
4b167c12	103	cdprintf("Error track %i: rate %i", index, Tracks[index].KBtps);
4b167c12	104	#if !DONT_OPEN_MANY_FILES
cb0316e4	105	fclose(tmp_file);
4b167c12	106	#else
	107	free(tmp_file);
	108	#endif
cb0316e4	109	continue;
cb0316e4	110	}
bf098bc5	111
	112	Tracks[index].F = tmp_file;
	113
75736070	114	LBA_to_MSF(Cur_LBA, &Tracks[index].MSF);
bf098bc5	115
bf098bc5	116	// MP3 File
75736070	117	Tracks[index].ftype = TYPE_MP3;
bf098bc5	118	fs *= 75;
cb0316e4	119	fs /= Tracks[index].KBtps * 1000;
	120	Tracks[index].Length = fs;
	121	Cur_LBA += Tracks[index].Length;
	122
75736070	123	cdprintf("Track %i: %s - %02d:%02d:%02d len=%i AUDIO", index, tmp_name, Tracks[index].MSF.M,
75736070	124	Tracks[index].MSF.S, Tracks[index].MSF.F, fs);
bf098bc5	125
	126	num_track++;
	127	break;
	128	}
	129	}
	130	}
	131
75736070	132	Pico_mcd->TOC.Last_Track = num_track - 1;
bf098bc5	133
75736070	134	index = num_track - 1;
bf098bc5	135
75736070	136	LBA_to_MSF(Cur_LBA, &Tracks[index].MSF);
bf098bc5	137
75736070	138	cdprintf("End CD - %02d:%02d:%02d\n\n", Tracks[index].MSF.M,
75736070	139	Tracks[index].MSF.S, Tracks[index].MSF.F);
bf098bc5	140
4b167c12	141	if (PicoCDLoadProgressCB != NULL) PicoCDLoadProgressCB(100);
4b167c12	142
bf098bc5	143	return 0;
	144	}
	145
	146
eff55556	147	PICO_INTERNAL void Unload_ISO(void)
bf098bc5	148	{
	149	int i;
	150
75736070	151	if (Pico_mcd == NULL) return;
bf098bc5	152
83bd0b76	153	if (Pico_mcd->TOC.Tracks[0].F) pm_close(Pico_mcd->TOC.Tracks[0].F);
	154
	155	for(i = 1; i < 100; i++)
bf098bc5	156	{
4b167c12	157	if (Pico_mcd->TOC.Tracks[i].F != NULL)
	158	#if !DONT_OPEN_MANY_FILES
	159	fclose(Pico_mcd->TOC.Tracks[i].F);
	160	#else
	161	free(Pico_mcd->TOC.Tracks[i].F);
	162	#endif
bf098bc5	163	}
83bd0b76	164	memset(Pico_mcd->TOC.Tracks, 0, sizeof(Pico_mcd->TOC.Tracks));
bf098bc5	165	}
	166
	167
eff55556	168	PICO_INTERNAL int FILE_Read_One_LBA_CDC(void)
bf098bc5	169	{
75736070	170	// static char cp_buf[2560];
bf098bc5	171
	172	if (Pico_mcd->s68k_regs[0x36] & 1) // DATA
	173	{
75736070	174	if (Pico_mcd->TOC.Tracks[0].F == NULL) return -1;
bf098bc5	175
75736070	176	// moved below..
	177	//fseek(Pico_mcd->TOC.Tracks[0].F, where_read, SEEK_SET);
	178	//fread(cp_buf, 1, 2048, Pico_mcd->TOC.Tracks[0].F);
bf098bc5	179
c459aefd	180	cdprintf("Read file CDC 1 data sector :\n");
bf098bc5	181	}
	182	else // AUDIO
	183	{
	184	// int rate, channel;
	185
0a051f55	186	// if (Pico_mcd->TOC.Tracks[Pico_mcd->scd.Cur_Track - 1].ftype == TYPE_MP3)
bf098bc5	187	{
	188	// TODO
	189	// MP3_Update(cp_buf, &rate, &channel, 0);
	190	// Write_CD_Audio((short *) cp_buf, rate, channel, 588);
	191	}
	192
c459aefd	193	cdprintf("Read file CDC 1 audio sector :\n");
bf098bc5	194	}
	195
	196	// Update CDC stuff
	197
	198	CDC_Update_Header();
	199
	200	if (Pico_mcd->s68k_regs[0x36] & 1) // DATA track
	201	{
	202	if (Pico_mcd->cdc.CTRL.B.B0 & 0x80) // DECEN = decoding enable
	203	{
	204	if (Pico_mcd->cdc.CTRL.B.B0 & 0x04) // WRRQ : this bit enable write to buffer
	205	{
0a051f55	206	int where_read = 0;
0a051f55	207
bf098bc5	208	// CAUTION : lookahead bit not implemented
bf098bc5	209
0a051f55	210	if (Pico_mcd->scd.Cur_LBA < 0)
	211	where_read = 0;
	212	else if (Pico_mcd->scd.Cur_LBA >= Pico_mcd->TOC.Tracks[0].Length)
	213	where_read = Pico_mcd->TOC.Tracks[0].Length - 1;
	214	else where_read = Pico_mcd->scd.Cur_LBA;
	215
bf098bc5	216	Pico_mcd->scd.Cur_LBA++;
	217
	218	Pico_mcd->cdc.WA.N = (Pico_mcd->cdc.WA.N + 2352) & 0x7FFF; // add one sector to WA
	219	Pico_mcd->cdc.PT.N = (Pico_mcd->cdc.PT.N + 2352) & 0x7FFF;
	220
83bd0b76	221	(unsigned int )(Pico_mcd->cdc.Buffer + Pico_mcd->cdc.PT.N) = Pico_mcd->cdc.HEAD.N;
75736070	222	//memcpy(&Pico_mcd->cdc.Buffer[Pico_mcd->cdc.PT.N + 4], cp_buf, 2048);
75736070	223
0a051f55	224	//pm_seek(Pico_mcd->TOC.Tracks[0].F, where_read, SEEK_SET);
	225	//pm_read(Pico_mcd->cdc.Buffer + Pico_mcd->cdc.PT.N + 4, 2048, Pico_mcd->TOC.Tracks[0].F);
	226	PicoCDBufferRead(Pico_mcd->cdc.Buffer + Pico_mcd->cdc.PT.N + 4, where_read);
bf098bc5	227
bf098bc5	228	#ifdef DEBUG_CD
c459aefd	229	cdprintf("Read -> WA = %d Buffer[%d] =", Pico_mcd->cdc.WA.N, Pico_mcd->cdc.PT.N & 0x3FFF);
c459aefd	230	cdprintf("Header 1 = %.2X %.2X %.2X %.2X", Pico_mcd->cdc.HEAD.B.B0,
bf098bc5	231	Pico_mcd->cdc.HEAD.B.B1, Pico_mcd->cdc.HEAD.B.B2, Pico_mcd->cdc.HEAD.B.B3);
	232	cdprintf("Header 2 = %.2X %.2X %.2X %.2X --- %.2X %.2X\n\n",
	233	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 0) & 0x3FFF],
	234	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 1) & 0x3FFF],
	235	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 2) & 0x3FFF],
	236	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 3) & 0x3FFF],
	237	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 4) & 0x3FFF],
	238	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 5) & 0x3FFF]);
	239	#endif
	240	}
	241
	242	}
	243	}
	244	else // music track
	245	{
	246	Pico_mcd->scd.Cur_LBA++;
	247
	248	Pico_mcd->cdc.WA.N = (Pico_mcd->cdc.WA.N + 2352) & 0x7FFF; // add one sector to WA
	249	Pico_mcd->cdc.PT.N = (Pico_mcd->cdc.PT.N + 2352) & 0x7FFF;
	250
	251	if (Pico_mcd->cdc.CTRL.B.B0 & 0x80) // DECEN = decoding enable
	252	{
	253	if (Pico_mcd->cdc.CTRL.B.B0 & 0x04) // WRRQ : this bit enable write to buffer
	254	{
	255	// CAUTION : lookahead bit not implemented
	256
75736070	257	//memcpy(&Pico_mcd->cdc.Buffer[Pico_mcd->cdc.PT.N], cp_buf, 2352);
bf098bc5	258	}
	259	}
	260	}
	261
	262	if (Pico_mcd->cdc.CTRL.B.B0 & 0x80) // DECEN = decoding enable
	263	{
	264	Pico_mcd->cdc.STAT.B.B0 = 0x80;
	265
	266	if (Pico_mcd->cdc.CTRL.B.B0 & 0x10) // determine form bit form sub header ?
	267	{
	268	Pico_mcd->cdc.STAT.B.B2 = Pico_mcd->cdc.CTRL.B.B1 & 0x08;
	269	}
	270	else
	271	{
	272	Pico_mcd->cdc.STAT.B.B2 = Pico_mcd->cdc.CTRL.B.B1 & 0x0C;
	273	}
	274
	275	if (Pico_mcd->cdc.CTRL.B.B0 & 0x02) Pico_mcd->cdc.STAT.B.B3 = 0x20; // ECC done
	276	else Pico_mcd->cdc.STAT.B.B3 = 0x00; // ECC not done
	277
	278	if (Pico_mcd->cdc.IFCTRL & 0x20)
	279	{
	280	if (Pico_mcd->s68k_regs[0x33] & (1<<5))
	281	{
	282	dprintf("cdc dec irq 5");
	283	SekInterruptS68k(5);
	284	}
	285
75736070	286	Pico_mcd->cdc.IFSTAT &= ~0x20; // DEC interrupt happen
75736070	287	Pico_mcd->cdc.Decode_Reg_Read = 0; // Reset read after DEC int
bf098bc5	288	}
	289	}
	290
	291
	292	return 0;
	293	}
	294
	295
eff55556	296	PICO_INTERNAL int FILE_Play_CD_LBA(void)
bf098bc5	297	{
75736070	298	int index = Pico_mcd->scd.Cur_Track - 1;
75736070	299	Pico_mcd->m.audio_track = index;
bf098bc5	300
75736070	301	cdprintf("Play track #%i", Pico_mcd->scd.Cur_Track);
bf098bc5	302
75736070	303	if (Pico_mcd->TOC.Tracks[index].F == NULL)
bf098bc5	304	{
	305	return 1;
	306	}
	307
75736070	308	if (Pico_mcd->TOC.Tracks[index].ftype == TYPE_MP3)
bf098bc5	309	{
75736070	310	int pos1024 = 0;
bf098bc5	311	int Track_LBA_Pos = Pico_mcd->scd.Cur_LBA - Track_to_LBA(Pico_mcd->scd.Cur_Track);
bf098bc5	312	if (Track_LBA_Pos < 0) Track_LBA_Pos = 0;
cb0316e4	313	if (Track_LBA_Pos)
75736070	314	pos1024 = Track_LBA_Pos * 1024 / Pico_mcd->TOC.Tracks[index].Length;
bf098bc5	315
75736070	316	mp3_start_play(Pico_mcd->TOC.Tracks[index].F, pos1024);
bf098bc5	317	}
	318	else
	319	{
	320	return 3;
	321	}
	322
	323	return 0;
	324	}
	325