[picodrive.git] / platform / common / mp3_helix.c

// Some mp3 related code for Sega/Mega CD.
// Uses the Helix Fixed-point MP3 decoder

// (c) Copyright 2007, Grazvydas "notaz" Ignotas

#include <stdio.h>
#include <string.h>

#include "../../pico/pico_int.h"
#include "../../pico/sound/mix.h"
#include "helix/pub/mp3dec.h"
#include "lprintf.h"

static HMP3Decoder mp3dec = 0;
static int mp3_buffer_offs = 0;


static int find_sync_word(unsigned char *buf, int nBytes)
{
	unsigned char *p, *pe;

	/* find byte-aligned syncword - need 12 (MPEG 1,2) or 11 (MPEG 2.5) matching bits */
	for (p = buf, pe = buf + nBytes - 4; p < pe; p++)
	{
		int pn;
		if (p[0] != 0xff) continue;
		pn = p[1];
		if ((pn & 0xf8) != 0xf8 || // currently must be MPEG1
		    (pn & 6) == 0) {       // invalid layer
			p++; continue;
		}
		pn = p[2];
		if ((pn & 0xf0) < 0x20 || (pn & 0xf0) == 0xf0 || // bitrates
		    (pn & 0x0c) != 0) { // not 44kHz
			continue;
		}

		return p - buf;
	}

	return -1;
}


static int try_get_header(unsigned char *buff, MP3FrameInfo *fi)
{
	int ret, offs1, offs = 0;

	while (1)
	{
		offs1 = find_sync_word(buff + offs, 2048 - offs);
		if (offs1 < 0) return -2;
		offs += offs1;
		if (2048 - offs < 4) return -3;

		// printf("trying header %08x\n", *(int *)(buff + offs));

		ret = MP3GetNextFrameInfo(mp3dec, fi, buff + offs);
		if (ret == 0 && fi->bitrate != 0) break;
		offs++;
	}

	return ret;
}

int mp3_get_bitrate(FILE *f, int len)
{
	unsigned char buff[2048];
	MP3FrameInfo fi;
	int ret;

	memset(buff, 0, 2048);

	if (mp3dec) MP3FreeDecoder(mp3dec);
	mp3dec = MP3InitDecoder();

	fseek(f, 0, SEEK_SET);
	ret = fread(buff, 1, 2048, f);
	fseek(f, 0, SEEK_SET);
	if (ret <= 0) return -1;

	ret = try_get_header(buff, &fi);
	if (ret != 0 || fi.bitrate == 0) {
		// try to read somewhere around the middle
		fseek(f, len>>1, SEEK_SET);
		fread(buff, 1, 2048, f);
		fseek(f, 0, SEEK_SET);
		ret = try_get_header(buff, &fi);
	}
	if (ret != 0) return ret;

	// printf("bitrate: %i\n", fi.bitrate / 1000);

	return fi.bitrate / 1000;
}


#ifdef __GP2X__

#include "../gp2x/code940/940shared.h"

extern _940_ctl_t *shared_ctl;
extern unsigned char *mp3_mem;

static int mp3_decode(void)
{
	// tried copying this to cached mem, no improvement noticed
	int mp3_offs = shared_ctl->mp3_offs;
	unsigned char *readPtr = mp3_mem + mp3_offs;
	int bytesLeft = shared_ctl->mp3_len - mp3_offs;
	int offset; // frame offset from readPtr
	int retries = 0, err;

	if (bytesLeft <= 0) return 1; // EOF, nothing to do

retry:
	offset = find_sync_word(readPtr, bytesLeft);
	if (offset < 0) {
		shared_ctl->mp3_offs = shared_ctl->mp3_len;
		return 1; // EOF
	}
	readPtr += offset;
	bytesLeft -= offset;

	err = MP3Decode(mp3dec, &readPtr, &bytesLeft, cdda_out_buffer, 0);
	if (err) {
		if (err == ERR_MP3_INDATA_UNDERFLOW) {
			shared_ctl->mp3_offs = shared_ctl->mp3_len; // EOF
			return 1;
		} else if (err <= -6 && err >= -12) {
			// ERR_MP3_INVALID_FRAMEHEADER, ERR_MP3_INVALID_*
			// just try to skip the offending frame..
			readPtr++;
			bytesLeft--;
			if (retries++ < 2) goto retry;
			else lprintf("mp3 decode failed with %i after %i retries\n", err, retries);
		}
		shared_ctl->mp3_errors++;
		shared_ctl->mp3_lasterr = err;
	}
	shared_ctl->mp3_offs = readPtr - mp3_mem;
	return 0;
}

void mp3_start_local(void)
{
	// must re-init decoder for new track
	if (mp3dec) MP3FreeDecoder(mp3dec);
	mp3dec = MP3InitDecoder();

	mp3_buffer_offs = 0;
	mp3_decode();
}

#define mp3_update mp3_update_local

#else // !__GP2X__

static FILE *mp3_current_file = NULL;
static int mp3_file_len = 0, mp3_file_pos = 0;
static unsigned char mp3_input_buffer[2*1024];

static int mp3_decode(void)
{
	unsigned char *readPtr;
	int bytesLeft;
	int offset; // mp3 frame offset from readPtr
	int err;

	do
	{
		if (mp3_file_pos >= mp3_file_len) return 1; // EOF, nothing to do

		fseek(mp3_current_file, mp3_file_pos, SEEK_SET);
		bytesLeft = fread(mp3_input_buffer, 1, sizeof(mp3_input_buffer), mp3_current_file);

		offset = find_sync_word(mp3_input_buffer, bytesLeft);
		if (offset < 0) {
			//lprintf("find_sync_word (%i/%i) err %i\n", mp3_file_pos, mp3_file_len, offset);
			mp3_file_pos = mp3_file_len;
			return 1; // EOF
		}
		readPtr = mp3_input_buffer + offset;
		bytesLeft -= offset;

		err = MP3Decode(mp3dec, &readPtr, &bytesLeft, cdda_out_buffer, 0);
		if (err) {
			//lprintf("MP3Decode err (%i/%i) %i\n", mp3_file_pos, mp3_file_len, err);
			if (err == ERR_MP3_INDATA_UNDERFLOW) {
				if (offset == 0)
					// something's really wrong here, frame had to fit
					mp3_file_pos = mp3_file_len;
				else
					mp3_file_pos += offset;
				continue;
			} else if (err <= -6 && err >= -12) {
				// ERR_MP3_INVALID_FRAMEHEADER, ERR_MP3_INVALID_*
				// just try to skip the offending frame..
				mp3_file_pos += offset + 1;
				continue;
			}
			mp3_file_pos = mp3_file_len;
			return 1;
		}
		mp3_file_pos += readPtr - mp3_input_buffer;
	}
	while (0);

	return 0;
}

void mp3_start_play(FILE *f, int pos)
{
	mp3_file_len = mp3_file_pos = 0;
	mp3_current_file = NULL;
	mp3_buffer_offs = 0;

	// must re-init decoder for new track
	if (mp3dec) MP3FreeDecoder(mp3dec);
	mp3dec = MP3InitDecoder();

	if (!(PicoOpt&POPT_EN_MCD_CDDA) || f == NULL) // cdda disabled or no file?
		return;

	//lprintf("mp3_start_play %p %i\n", f, pos);

	mp3_current_file = f;
	fseek(f, 0, SEEK_END);
	mp3_file_len = ftell(f);

	// seek..
	if (pos) {
		mp3_file_pos = (mp3_file_len << 6) >> 10;
		mp3_file_pos *= pos;
		mp3_file_pos >>= 6;
	}

	mp3_decode();
}

int mp3_get_offset(void)
{
	unsigned int offs1024 = 0;
	int cdda_on;

	cdda_on = (PicoAHW & PAHW_MCD) && (PicoOpt&POPT_EN_MCD_CDDA) && !(Pico_mcd->s68k_regs[0x36] & 1) &&
			(Pico_mcd->scd.Status_CDC & 1) && mp3_current_file != NULL;

	if (cdda_on) {
		offs1024  = mp3_file_pos << 7;
		offs1024 /= mp3_file_len >> 3;
	}
	//lprintf("mp3_get_offset offs1024=%u (%i/%i)\n", offs1024, mp3_file_pos, mp3_file_len);

	return offs1024;
}

#endif // ifndef __GP2X__

void mp3_update(int *buffer, int length, int stereo)
{
	int length_mp3, shr = 0;
	void (*mix_samples)(int *dest_buf, short *mp3_buf, int count) = mix_16h_to_32;

#ifndef __GP2X__
	if (mp3_current_file == NULL || mp3_file_pos >= mp3_file_len) return; // no file / EOF
#endif

	length_mp3 = length;
	if (PsndRate == 22050) { mix_samples = mix_16h_to_32_s1; length_mp3 <<= 1; shr = 1; }
	else if (PsndRate == 11025) { mix_samples = mix_16h_to_32_s2; length_mp3 <<= 2; shr = 2; }

	if (1152 - mp3_buffer_offs >= length_mp3) {
		mix_samples(buffer, cdda_out_buffer + mp3_buffer_offs*2, length<<1);

		mp3_buffer_offs += length_mp3;
	} else {
		int ret, left = 1152 - mp3_buffer_offs;

		mix_samples(buffer, cdda_out_buffer + mp3_buffer_offs*2, (left>>shr)<<1);
		ret = mp3_decode();
		if (ret == 0) {
			mp3_buffer_offs = length_mp3 - left;
			mix_samples(buffer + ((left>>shr)<<1), cdda_out_buffer, (mp3_buffer_offs>>shr)<<1);
		} else
			mp3_buffer_offs = 0;
	}
}
Commit	Line	Data
da42200b	1	// Some mp3 related code for Sega/Mega CD.
	2	// Uses the Helix Fixed-point MP3 decoder
	3
	4	// (c) Copyright 2007, Grazvydas "notaz" Ignotas
	5
	6	#include <stdio.h>
	7	#include <string.h>
	8
efcba75f	9	#include "../../pico/pico_int.h"
efcba75f	10	#include "../../pico/sound/mix.h"
da42200b	11	#include "helix/pub/mp3dec.h"
	12	#include "lprintf.h"
	13
da42200b	14	static HMP3Decoder mp3dec = 0;
	15	static int mp3_buffer_offs = 0;
	16
	17
091facb8	18	static int find_sync_word(unsigned char *buf, int nBytes)
	19	{
	20	unsigned char p, pe;
	21
	22	/* find byte-aligned syncword - need 12 (MPEG 1,2) or 11 (MPEG 2.5) matching bits */
	23	for (p = buf, pe = buf + nBytes - 4; p < pe; p++)
	24	{
	25	int pn;
	26	if (p[0] != 0xff) continue;
	27	pn = p[1];
	28	if ((pn & 0xf8) != 0xf8 \|\| // currently must be MPEG1
	29	(pn & 6) == 0) { // invalid layer
	30	p++; continue;
	31	}
	32	pn = p[2];
	33	if ((pn & 0xf0) < 0x20 \|\| (pn & 0xf0) == 0xf0 \|\| // bitrates
	34	(pn & 0x0c) != 0) { // not 44kHz
	35	continue;
	36	}
	37
	38	return p - buf;
	39	}
	40
	41	return -1;
	42	}
	43
	44
da42200b	45	static int try_get_header(unsigned char buff, MP3FrameInfo fi)
	46	{
	47	int ret, offs1, offs = 0;
	48
	49	while (1)
	50	{
091facb8	51	offs1 = find_sync_word(buff + offs, 2048 - offs);
da42200b	52	if (offs1 < 0) return -2;
	53	offs += offs1;
	54	if (2048 - offs < 4) return -3;
	55
	56	// printf("trying header %08x\n", (int )(buff + offs));
	57
	58	ret = MP3GetNextFrameInfo(mp3dec, fi, buff + offs);
	59	if (ret == 0 && fi->bitrate != 0) break;
	60	offs++;
	61	}
	62
	63	return ret;
	64	}
	65
	66	int mp3_get_bitrate(FILE *f, int len)
	67	{
	68	unsigned char buff[2048];
	69	MP3FrameInfo fi;
	70	int ret;
	71
	72	memset(buff, 0, 2048);
	73
091facb8	74	if (mp3dec) MP3FreeDecoder(mp3dec);
091facb8	75	mp3dec = MP3InitDecoder();
da42200b	76
	77	fseek(f, 0, SEEK_SET);
	78	ret = fread(buff, 1, 2048, f);
	79	fseek(f, 0, SEEK_SET);
	80	if (ret <= 0) return -1;
	81
	82	ret = try_get_header(buff, &fi);
	83	if (ret != 0 \|\| fi.bitrate == 0) {
	84	// try to read somewhere around the middle
	85	fseek(f, len>>1, SEEK_SET);
	86	fread(buff, 1, 2048, f);
	87	fseek(f, 0, SEEK_SET);
	88	ret = try_get_header(buff, &fi);
	89	}
	90	if (ret != 0) return ret;
	91
	92	// printf("bitrate: %i\n", fi.bitrate / 1000);
	93
	94	return fi.bitrate / 1000;
	95	}
	96
	97
	98	#ifdef __GP2X__
	99
	100	#include "../gp2x/code940/940shared.h"
	101
	102	extern _940_ctl_t *shared_ctl;
	103	extern unsigned char *mp3_mem;
	104
	105	static int mp3_decode(void)
	106	{
	107	// tried copying this to cached mem, no improvement noticed
	108	int mp3_offs = shared_ctl->mp3_offs;
	109	unsigned char *readPtr = mp3_mem + mp3_offs;
	110	int bytesLeft = shared_ctl->mp3_len - mp3_offs;
	111	int offset; // frame offset from readPtr
091facb8	112	int retries = 0, err;
da42200b	113
	114	if (bytesLeft <= 0) return 1; // EOF, nothing to do
	115
091facb8	116	retry:
091facb8	117	offset = find_sync_word(readPtr, bytesLeft);
da42200b	118	if (offset < 0) {
	119	shared_ctl->mp3_offs = shared_ctl->mp3_len;
	120	return 1; // EOF
	121	}
	122	readPtr += offset;
	123	bytesLeft -= offset;
	124
c9e1affc	125	err = MP3Decode(mp3dec, &readPtr, &bytesLeft, cdda_out_buffer, 0);
da42200b	126	if (err) {
	127	if (err == ERR_MP3_INDATA_UNDERFLOW) {
	128	shared_ctl->mp3_offs = shared_ctl->mp3_len; // EOF
	129	return 1;
	130	} else if (err <= -6 && err >= -12) {
	131	// ERR_MP3_INVALID_FRAMEHEADER, ERR_MP3_INVALID_*
	132	// just try to skip the offending frame..
	133	readPtr++;
091facb8	134	bytesLeft--;
	135	if (retries++ < 2) goto retry;
	136	else lprintf("mp3 decode failed with %i after %i retries\n", err, retries);
da42200b	137	}
	138	shared_ctl->mp3_errors++;
	139	shared_ctl->mp3_lasterr = err;
	140	}
	141	shared_ctl->mp3_offs = readPtr - mp3_mem;
	142	return 0;
	143	}
	144
	145	void mp3_start_local(void)
	146	{
091facb8	147	// must re-init decoder for new track
	148	if (mp3dec) MP3FreeDecoder(mp3dec);
	149	mp3dec = MP3InitDecoder();
	150
da42200b	151	mp3_buffer_offs = 0;
	152	mp3_decode();
	153	}
	154
	155	#define mp3_update mp3_update_local
	156
c9e1affc	157	#else // !__GP2X__
da42200b	158
	159	static FILE *mp3_current_file = NULL;
	160	static int mp3_file_len = 0, mp3_file_pos = 0;
	161	static unsigned char mp3_input_buffer[2*1024];
	162
	163	static int mp3_decode(void)
	164	{
	165	unsigned char *readPtr;
	166	int bytesLeft;
	167	int offset; // mp3 frame offset from readPtr
	168	int err;
	169
	170	do
	171	{
	172	if (mp3_file_pos >= mp3_file_len) return 1; // EOF, nothing to do
	173
	174	fseek(mp3_current_file, mp3_file_pos, SEEK_SET);
	175	bytesLeft = fread(mp3_input_buffer, 1, sizeof(mp3_input_buffer), mp3_current_file);
	176
091facb8	177	offset = find_sync_word(mp3_input_buffer, bytesLeft);
da42200b	178	if (offset < 0) {
091facb8	179	//lprintf("find_sync_word (%i/%i) err %i\n", mp3_file_pos, mp3_file_len, offset);
da42200b	180	mp3_file_pos = mp3_file_len;
	181	return 1; // EOF
	182	}
	183	readPtr = mp3_input_buffer + offset;
	184	bytesLeft -= offset;
	185
c9e1affc	186	err = MP3Decode(mp3dec, &readPtr, &bytesLeft, cdda_out_buffer, 0);
da42200b	187	if (err) {
	188	//lprintf("MP3Decode err (%i/%i) %i\n", mp3_file_pos, mp3_file_len, err);
	189	if (err == ERR_MP3_INDATA_UNDERFLOW) {
	190	if (offset == 0)
	191	// something's really wrong here, frame had to fit
	192	mp3_file_pos = mp3_file_len;
	193	else
	194	mp3_file_pos += offset;
	195	continue;
	196	} else if (err <= -6 && err >= -12) {
	197	// ERR_MP3_INVALID_FRAMEHEADER, ERR_MP3_INVALID_*
	198	// just try to skip the offending frame..
	199	mp3_file_pos += offset + 1;
	200	continue;
	201	}
	202	mp3_file_pos = mp3_file_len;
	203	return 1;
	204	}
	205	mp3_file_pos += readPtr - mp3_input_buffer;
	206	}
	207	while (0);
	208
	209	return 0;
	210	}
	211
	212	void mp3_start_play(FILE *f, int pos)
	213	{
	214	mp3_file_len = mp3_file_pos = 0;
	215	mp3_current_file = NULL;
	216	mp3_buffer_offs = 0;
	217
091facb8	218	// must re-init decoder for new track
	219	if (mp3dec) MP3FreeDecoder(mp3dec);
	220	mp3dec = MP3InitDecoder();
	221
602133e1	222	if (!(PicoOpt&POPT_EN_MCD_CDDA) \|\| f == NULL) // cdda disabled or no file?
da42200b	223	return;
	224
	225	//lprintf("mp3_start_play %p %i\n", f, pos);
	226
	227	mp3_current_file = f;
	228	fseek(f, 0, SEEK_END);
	229	mp3_file_len = ftell(f);
	230
	231	// seek..
	232	if (pos) {
	233	mp3_file_pos = (mp3_file_len << 6) >> 10;
	234	mp3_file_pos *= pos;
	235	mp3_file_pos >>= 6;
	236	}
	237
	238	mp3_decode();
	239	}
	240
	241	int mp3_get_offset(void)
	242	{
	243	unsigned int offs1024 = 0;
	244	int cdda_on;
	245
602133e1	246	cdda_on = (PicoAHW & PAHW_MCD) && (PicoOpt&POPT_EN_MCD_CDDA) && !(Pico_mcd->s68k_regs[0x36] & 1) &&
da42200b	247	(Pico_mcd->scd.Status_CDC & 1) && mp3_current_file != NULL;
	248
	249	if (cdda_on) {
	250	offs1024 = mp3_file_pos << 7;
	251	offs1024 /= mp3_file_len >> 3;
	252	}
	253	//lprintf("mp3_get_offset offs1024=%u (%i/%i)\n", offs1024, mp3_file_pos, mp3_file_len);
	254
	255	return offs1024;
	256	}
	257
	258	#endif // ifndef __GP2X__
	259
	260	void mp3_update(int *buffer, int length, int stereo)
	261	{
	262	int length_mp3, shr = 0;
	263	void (mix_samples)(int dest_buf, short *mp3_buf, int count) = mix_16h_to_32;
	264
	265	#ifndef __GP2X__
	266	if (mp3_current_file == NULL \|\| mp3_file_pos >= mp3_file_len) return; // no file / EOF
	267	#endif
	268
	269	length_mp3 = length;
	270	if (PsndRate == 22050) { mix_samples = mix_16h_to_32_s1; length_mp3 <<= 1; shr = 1; }
	271	else if (PsndRate == 11025) { mix_samples = mix_16h_to_32_s2; length_mp3 <<= 2; shr = 2; }
	272
	273	if (1152 - mp3_buffer_offs >= length_mp3) {
c9e1affc	274	mix_samples(buffer, cdda_out_buffer + mp3_buffer_offs*2, length<<1);
da42200b	275
	276	mp3_buffer_offs += length_mp3;
	277	} else {
	278	int ret, left = 1152 - mp3_buffer_offs;
	279
c9e1affc	280	mix_samples(buffer, cdda_out_buffer + mp3_buffer_offs*2, (left>>shr)<<1);
da42200b	281	ret = mp3_decode();
	282	if (ret == 0) {
	283	mp3_buffer_offs = length_mp3 - left;
c9e1affc	284	mix_samples(buffer + ((left>>shr)<<1), cdda_out_buffer, (mp3_buffer_offs>>shr)<<1);
da42200b	285	} else
	286	mp3_buffer_offs = 0;
	287	}
	288	}
	289
	290