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

#include <sys/stat.h>
#include "cd_file.h"

#include "../PicoInt.h"

#define cdprintf dprintf
//#define cdprintf(x...)
#define DEBUG_CD


void FILE_End(void)
{
	Unload_ISO();
}


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",
		"%02d.MP3", " %02d.MP3", "-%02d.MP3", "_%02d.MP3", " - %02d.MP3",
		/* "%02d.wav", " %02d.wav", "-%02d.wav", "_%02d.wav", " - %02d.wav",
		"%d.wav", " %d.wav", "-%d.wav", "_%d.wav", " - %2d.wav" */
	};

	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);

	for (num_track = 2, i = 0; i < 100; 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;
				struct stat file_stat;
				index = num_track - 1;

				ret = stat(tmp_name, &file_stat);
				fs = file_stat.st_size;				// used to calculate lenght

				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: stat %i, rate %i", index, ret, Tracks[index].KBtps);
					fclose(tmp_file);
					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);

	return 0;
}


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) fclose(Pico_mcd->TOC.Tracks[i].F);
	}
	memset(Pico_mcd->TOC.Tracks, 0, sizeof(Pico_mcd->TOC.Tracks));
}


void PicoCDBufferRead(void *dest, int lba);


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;
}


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