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


int FILE_Read_One_LBA_CDC(void)
{
	int where_read = 0;
//	static char cp_buf[2560];

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

		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;

		if (Pico_mcd->TOC.Tracks[0].ftype == TYPE_ISO) where_read <<= 11;
		else where_read = (where_read * 2352 + 16);

		// 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
			{
				// CAUTION : lookahead bit not implemented

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

#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
	144	int FILE_Read_One_LBA_CDC(void)
	145	{
75736070	146	int where_read = 0;
75736070	147	// static char cp_buf[2560];
bf098bc5	148
	149	if (Pico_mcd->s68k_regs[0x36] & 1) // DATA
	150	{
75736070	151	if (Pico_mcd->TOC.Tracks[0].F == NULL) return -1;
bf098bc5	152
75736070	153	if (Pico_mcd->scd.Cur_LBA < 0)
	154	where_read = 0;
	155	else if (Pico_mcd->scd.Cur_LBA >= Pico_mcd->TOC.Tracks[0].Length)
	156	where_read = Pico_mcd->TOC.Tracks[0].Length - 1;
bf098bc5	157	else where_read = Pico_mcd->scd.Cur_LBA;
bf098bc5	158
75736070	159	if (Pico_mcd->TOC.Tracks[0].ftype == TYPE_ISO) where_read <<= 11;
bf098bc5	160	else where_read = (where_read * 2352 + 16);
bf098bc5	161
75736070	162	// moved below..
	163	//fseek(Pico_mcd->TOC.Tracks[0].F, where_read, SEEK_SET);
	164	//fread(cp_buf, 1, 2048, Pico_mcd->TOC.Tracks[0].F);
bf098bc5	165
c459aefd	166	cdprintf("Read file CDC 1 data sector :\n");
bf098bc5	167	}
	168	else // AUDIO
	169	{
	170	// int rate, channel;
	171
75736070	172	if (Pico_mcd->TOC.Tracks[Pico_mcd->scd.Cur_Track - 1].ftype == TYPE_MP3)
bf098bc5	173	{
	174	// TODO
	175	// MP3_Update(cp_buf, &rate, &channel, 0);
	176	// Write_CD_Audio((short *) cp_buf, rate, channel, 588);
	177	}
	178
c459aefd	179	cdprintf("Read file CDC 1 audio sector :\n");
bf098bc5	180	}
	181
	182	// Update CDC stuff
	183
	184	CDC_Update_Header();
	185
	186	if (Pico_mcd->s68k_regs[0x36] & 1) // DATA track
	187	{
	188	if (Pico_mcd->cdc.CTRL.B.B0 & 0x80) // DECEN = decoding enable
	189	{
	190	if (Pico_mcd->cdc.CTRL.B.B0 & 0x04) // WRRQ : this bit enable write to buffer
	191	{
	192	// CAUTION : lookahead bit not implemented
	193
	194	Pico_mcd->scd.Cur_LBA++;
	195
	196	Pico_mcd->cdc.WA.N = (Pico_mcd->cdc.WA.N + 2352) & 0x7FFF; // add one sector to WA
	197	Pico_mcd->cdc.PT.N = (Pico_mcd->cdc.PT.N + 2352) & 0x7FFF;
	198
83bd0b76	199	(unsigned int )(Pico_mcd->cdc.Buffer + Pico_mcd->cdc.PT.N) = Pico_mcd->cdc.HEAD.N;
75736070	200	//memcpy(&Pico_mcd->cdc.Buffer[Pico_mcd->cdc.PT.N + 4], cp_buf, 2048);
75736070	201
83bd0b76	202	pm_seek(Pico_mcd->TOC.Tracks[0].F, where_read, SEEK_SET);
83bd0b76	203	pm_read(Pico_mcd->cdc.Buffer + Pico_mcd->cdc.PT.N + 4, 2048, Pico_mcd->TOC.Tracks[0].F);
bf098bc5	204
bf098bc5	205	#ifdef DEBUG_CD
c459aefd	206	cdprintf("Read -> WA = %d Buffer[%d] =", Pico_mcd->cdc.WA.N, Pico_mcd->cdc.PT.N & 0x3FFF);
c459aefd	207	cdprintf("Header 1 = %.2X %.2X %.2X %.2X", Pico_mcd->cdc.HEAD.B.B0,
bf098bc5	208	Pico_mcd->cdc.HEAD.B.B1, Pico_mcd->cdc.HEAD.B.B2, Pico_mcd->cdc.HEAD.B.B3);
	209	cdprintf("Header 2 = %.2X %.2X %.2X %.2X --- %.2X %.2X\n\n",
	210	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 0) & 0x3FFF],
	211	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 1) & 0x3FFF],
	212	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 2) & 0x3FFF],
	213	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 3) & 0x3FFF],
	214	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 4) & 0x3FFF],
	215	Pico_mcd->cdc.Buffer[(Pico_mcd->cdc.PT.N + 5) & 0x3FFF]);
	216	#endif
	217	}
	218
	219	}
	220	}
	221	else // music track
	222	{
	223	Pico_mcd->scd.Cur_LBA++;
	224
	225	Pico_mcd->cdc.WA.N = (Pico_mcd->cdc.WA.N + 2352) & 0x7FFF; // add one sector to WA
	226	Pico_mcd->cdc.PT.N = (Pico_mcd->cdc.PT.N + 2352) & 0x7FFF;
	227
	228	if (Pico_mcd->cdc.CTRL.B.B0 & 0x80) // DECEN = decoding enable
	229	{
	230	if (Pico_mcd->cdc.CTRL.B.B0 & 0x04) // WRRQ : this bit enable write to buffer
	231	{
	232	// CAUTION : lookahead bit not implemented
	233
75736070	234	//memcpy(&Pico_mcd->cdc.Buffer[Pico_mcd->cdc.PT.N], cp_buf, 2352);
bf098bc5	235	}
	236	}
	237	}
	238
	239	if (Pico_mcd->cdc.CTRL.B.B0 & 0x80) // DECEN = decoding enable
	240	{
	241	Pico_mcd->cdc.STAT.B.B0 = 0x80;
	242
	243	if (Pico_mcd->cdc.CTRL.B.B0 & 0x10) // determine form bit form sub header ?
	244	{
	245	Pico_mcd->cdc.STAT.B.B2 = Pico_mcd->cdc.CTRL.B.B1 & 0x08;
	246	}
	247	else
	248	{
	249	Pico_mcd->cdc.STAT.B.B2 = Pico_mcd->cdc.CTRL.B.B1 & 0x0C;
	250	}
	251
	252	if (Pico_mcd->cdc.CTRL.B.B0 & 0x02) Pico_mcd->cdc.STAT.B.B3 = 0x20; // ECC done
	253	else Pico_mcd->cdc.STAT.B.B3 = 0x00; // ECC not done
	254
	255	if (Pico_mcd->cdc.IFCTRL & 0x20)
	256	{
	257	if (Pico_mcd->s68k_regs[0x33] & (1<<5))
	258	{
	259	dprintf("cdc dec irq 5");
	260	SekInterruptS68k(5);
	261	}
	262
75736070	263	Pico_mcd->cdc.IFSTAT &= ~0x20; // DEC interrupt happen
75736070	264	Pico_mcd->cdc.Decode_Reg_Read = 0; // Reset read after DEC int
bf098bc5	265	}
	266	}
	267
	268
	269	return 0;
	270	}
	271
	272
	273	int FILE_Play_CD_LBA(void)
	274	{
75736070	275	int index = Pico_mcd->scd.Cur_Track - 1;
75736070	276	Pico_mcd->m.audio_track = index;
bf098bc5	277
75736070	278	cdprintf("Play track #%i", Pico_mcd->scd.Cur_Track);
bf098bc5	279
75736070	280	if (Pico_mcd->TOC.Tracks[index].F == NULL)
bf098bc5	281	{
	282	return 1;
	283	}
	284
75736070	285	if (Pico_mcd->TOC.Tracks[index].ftype == TYPE_MP3)
bf098bc5	286	{
75736070	287	int pos1024 = 0;
bf098bc5	288	int Track_LBA_Pos = Pico_mcd->scd.Cur_LBA - Track_to_LBA(Pico_mcd->scd.Cur_Track);
bf098bc5	289	if (Track_LBA_Pos < 0) Track_LBA_Pos = 0;
cb0316e4	290	if (Track_LBA_Pos)
75736070	291	pos1024 = Track_LBA_Pos * 1024 / Pico_mcd->TOC.Tracks[index].Length;
bf098bc5	292
75736070	293	mp3_start_play(Pico_mcd->TOC.Tracks[index].F, pos1024);
bf098bc5	294	}
	295	else
	296	{
	297	return 3;
	298	}
	299
	300	return 0;
	301	}
	302