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

/*
 * PicoDrive
 * (C) notaz, 2010,2013
 *
 * This work is licensed under the terms of MAME license.
 * See COPYING file in the top-level directory.
 */
#include <stdio.h>
#include <string.h>

#include <pico/pico_int.h>
#include <pico/sound/mix.h>
#include "mp3.h"

static FILE *mp3_current_file;
static int mp3_file_len, mp3_file_pos;
static int cdda_out_pos;
static int decoder_active;

unsigned short mpeg1_l3_bitrates[16] = {
	0, 32, 40, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320
};

int mp3_find_sync_word(const unsigned char *buf, int size)
{
	const 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 + size - 3; 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_bitrate(unsigned char *buf, int buf_size)
{
	int offs1, offs = 0;
	int ret;

	while (1)
	{
		offs1 = mp3_find_sync_word(buf + offs, buf_size - offs);
		if (offs1 < 0)
			return -2;
		offs += offs1;
		if (buf_size - offs < 4)
			return -3;

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

		ret = mpeg1_l3_bitrates[buf[offs + 2] >> 4];
		if (ret > 0)
			return ret;
	}

	return -2;
}

int mp3_get_bitrate(void *f_, int len)
{
	unsigned char buf[2048];
	FILE *f = f_;
	int retval = -1;
	int ret;

	memset(buf, 0, sizeof(buf));

	fseek(f, 0, SEEK_SET);
	ret = fread(buf, 1, sizeof(buf), f);
	if (ret != sizeof(buf))
		goto out;

	ret = try_get_bitrate(buf, sizeof(buf));
	if (ret <= 0) {
		// try to read somewhere around the middle
		fseek(f, len / 2, SEEK_SET);
		ret = fread(buf, 1, sizeof(buf), f);
		if (ret == sizeof(buf))
			ret = try_get_bitrate(buf, sizeof(buf));
	}
	if (ret > 0)
		retval = ret;

	//printf("bitrate: %i\n", retval);

out:
	fseek(f, 0, SEEK_SET);
	return retval;
}

void mp3_start_play(void *f_, int pos1024)
{
	unsigned char buf[2048];
	FILE *f = f_;
	int ret;

	mp3_file_len = mp3_file_pos = 0;
	mp3_current_file = NULL;
	cdda_out_pos = 0;
	decoder_active = 0;

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

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

	// search for first sync word, skipping stuff like ID3 tags
	while (mp3_file_pos < 128*1024) {
		int offs, bytes;

		fseek(f, mp3_file_pos, SEEK_SET);
		bytes = fread(buf, 1, sizeof(buf), f);
		if (bytes < 4)
			break;
		offs = mp3_find_sync_word(buf, bytes);
		if (offs >= 0) {
			mp3_file_pos += offs;
			break;
		}
		mp3_file_pos += bytes - 3;
	}

	// seek..
	if (pos1024 != 0) {
		unsigned long long pos64 = mp3_file_len - mp3_file_pos;
		pos64 *= pos1024;
		mp3_file_pos += pos64 >> 10;
	}

	ret = mp3dec_start(f, mp3_file_pos);
	if (ret != 0) {
		return;
	}

	mp3_current_file = f;
	decoder_active = 1;

	mp3dec_decode(mp3_current_file, &mp3_file_pos, mp3_file_len);
}

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;

	if (mp3_current_file == NULL || mp3_file_pos >= mp3_file_len)
		return; /* no file / EOF */

	if (!decoder_active)
		return;

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

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

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

		if (left > 0)
			mix_samples(buffer, cdda_out_buffer + cdda_out_pos * 2,
				(left >> shr) * 2);

		ret = mp3dec_decode(mp3_current_file, &mp3_file_pos,
			mp3_file_len);
		if (ret == 0) {
			cdda_out_pos = length_mp3 - left;
			mix_samples(buffer + (left >> shr) * 2,
				cdda_out_buffer,
				(cdda_out_pos >> shr) * 2);
		} else
			cdda_out_pos = 0;
	}
}
Commit	Line	Data
cff531af	1	/*
cff531af	2	* PicoDrive
fc11dd05	3	* (C) notaz, 2010,2013
cff531af	4	*
	5	* This work is licensed under the terms of MAME license.
	6	* See COPYING file in the top-level directory.
	7	*/
fc11dd05	8	#include <stdio.h>
	9	#include <string.h>
	10
	11	#include <pico/pico_int.h>
	12	#include <pico/sound/mix.h>
7c18e34a	13	#include "mp3.h"
7c18e34a	14
fc11dd05	15	static FILE *mp3_current_file;
	16	static int mp3_file_len, mp3_file_pos;
	17	static int cdda_out_pos;
	18	static int decoder_active;
	19
	20	unsigned short mpeg1_l3_bitrates[16] = {
	21	0, 32, 40, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320
	22	};
	23
7c18e34a	24	int mp3_find_sync_word(const unsigned char *buf, int size)
	25	{
	26	const unsigned char p, pe;
	27
	28	/* find byte-aligned syncword - need 12 (MPEG 1,2) or 11 (MPEG 2.5) matching bits */
	29	for (p = buf, pe = buf + size - 3; p <= pe; p++)
	30	{
	31	int pn;
	32	if (p[0] != 0xff)
	33	continue;
	34	pn = p[1];
	35	if ((pn & 0xf8) != 0xf8 \|\| // currently must be MPEG1
	36	(pn & 6) == 0) { // invalid layer
	37	p++; continue;
	38	}
	39	pn = p[2];
	40	if ((pn & 0xf0) < 0x20 \|\| (pn & 0xf0) == 0xf0 \|\| // bitrates
	41	(pn & 0x0c) != 0) { // not 44kHz
	42	continue;
	43	}
	44
	45	return p - buf;
	46	}
	47
	48	return -1;
	49	}
	50
fc11dd05	51	static int try_get_bitrate(unsigned char *buf, int buf_size)
	52	{
	53	int offs1, offs = 0;
	54	int ret;
	55
	56	while (1)
	57	{
	58	offs1 = mp3_find_sync_word(buf + offs, buf_size - offs);
	59	if (offs1 < 0)
	60	return -2;
	61	offs += offs1;
	62	if (buf_size - offs < 4)
	63	return -3;
	64
	65	// printf("trying header %08x\n", (int )(buf + offs));
	66
	67	ret = mpeg1_l3_bitrates[buf[offs + 2] >> 4];
	68	if (ret > 0)
	69	return ret;
	70	}
	71
	72	return -2;
	73	}
	74
	75	int mp3_get_bitrate(void *f_, int len)
	76	{
	77	unsigned char buf[2048];
	78	FILE *f = f_;
	79	int retval = -1;
	80	int ret;
	81
	82	memset(buf, 0, sizeof(buf));
	83
	84	fseek(f, 0, SEEK_SET);
	85	ret = fread(buf, 1, sizeof(buf), f);
	86	if (ret != sizeof(buf))
	87	goto out;
	88
	89	ret = try_get_bitrate(buf, sizeof(buf));
	90	if (ret <= 0) {
	91	// try to read somewhere around the middle
	92	fseek(f, len / 2, SEEK_SET);
8e5639bc	93	ret = fread(buf, 1, sizeof(buf), f);
	94	if (ret == sizeof(buf))
	95	ret = try_get_bitrate(buf, sizeof(buf));
fc11dd05	96	}
	97	if (ret > 0)
	98	retval = ret;
	99
	100	//printf("bitrate: %i\n", retval);
	101
	102	out:
	103	fseek(f, 0, SEEK_SET);
	104	return retval;
	105	}
	106
75a30842	107	void mp3_start_play(void *f_, int pos1024)
fc11dd05	108	{
	109	unsigned char buf[2048];
	110	FILE *f = f_;
	111	int ret;
	112
	113	mp3_file_len = mp3_file_pos = 0;
	114	mp3_current_file = NULL;
	115	cdda_out_pos = 0;
	116	decoder_active = 0;
	117
93f9619e	118	if (!(PicoIn.opt & POPT_EN_MCD_CDDA) \|\| f == NULL) // cdda disabled or no file?
fc11dd05	119	return;
fc11dd05	120
fc11dd05	121	fseek(f, 0, SEEK_END);
	122	mp3_file_len = ftell(f);
	123
	124	// search for first sync word, skipping stuff like ID3 tags
	125	while (mp3_file_pos < 128*1024) {
	126	int offs, bytes;
	127
	128	fseek(f, mp3_file_pos, SEEK_SET);
	129	bytes = fread(buf, 1, sizeof(buf), f);
	130	if (bytes < 4)
	131	break;
	132	offs = mp3_find_sync_word(buf, bytes);
	133	if (offs >= 0) {
	134	mp3_file_pos += offs;
	135	break;
	136	}
	137	mp3_file_pos += bytes - 3;
	138	}
	139
	140	// seek..
75a30842	141	if (pos1024 != 0) {
fc11dd05	142	unsigned long long pos64 = mp3_file_len - mp3_file_pos;
75a30842	143	pos64 *= pos1024;
fc11dd05	144	mp3_file_pos += pos64 >> 10;
	145	}
	146
75a30842	147	ret = mp3dec_start(f, mp3_file_pos);
	148	if (ret != 0) {
	149	return;
	150	}
	151
	152	mp3_current_file = f;
	153	decoder_active = 1;
	154
fc11dd05	155	mp3dec_decode(mp3_current_file, &mp3_file_pos, mp3_file_len);
	156	}
	157
	158	void mp3_update(int *buffer, int length, int stereo)
	159	{
	160	int length_mp3, shr = 0;
	161	void (mix_samples)(int dest_buf, short *mp3_buf, int count) = mix_16h_to_32;
	162
	163	if (mp3_current_file == NULL \|\| mp3_file_pos >= mp3_file_len)
	164	return; /* no file / EOF */
	165
	166	if (!decoder_active)
	167	return;
	168
	169	length_mp3 = length;
	170	if (PsndRate <= 11025 + 100) {
	171	mix_samples = mix_16h_to_32_s2;
	172	length_mp3 <<= 2; shr = 2;
	173	}
	174	else if (PsndRate <= 22050 + 100) {
	175	mix_samples = mix_16h_to_32_s1;
	176	length_mp3 <<= 1; shr = 1;
	177	}
	178
	179	if (1152 - cdda_out_pos >= length_mp3) {
	180	mix_samples(buffer, cdda_out_buffer + cdda_out_pos * 2,
	181	length * 2);
	182
	183	cdda_out_pos += length_mp3;
	184	} else {
	185	int ret, left = 1152 - cdda_out_pos;
	186
75a30842	187	if (left > 0)
	188	mix_samples(buffer, cdda_out_buffer + cdda_out_pos * 2,
	189	(left >> shr) * 2);
fc11dd05	190
	191	ret = mp3dec_decode(mp3_current_file, &mp3_file_pos,
	192	mp3_file_len);
	193	if (ret == 0) {
	194	cdda_out_pos = length_mp3 - left;
	195	mix_samples(buffer + (left >> shr) * 2,
	196	cdda_out_buffer,
	197	(cdda_out_pos >> shr) * 2);
	198	} else
	199	cdda_out_pos = 0;
	200	}
	201	}
	202