[libpicofe.git] / psp / mp3.c

// (c) Copyright 2007 notaz, All rights reserved.
// Free for non-commercial use.

// For commercial use, separate licencing terms must be obtained.

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

#include <pspkernel.h>
#include <pspsdk.h>
#include <pspaudiocodec.h>

#include "../../Pico/PicoInt.h"
#include "../../Pico/sound/mix.h"
#include "../common/lprintf.h"

int mp3_last_error = 0;

static int initialized = 0;
static SceUID thread_job_sem = -1;
static SceUID thread_busy_sem = -1;
static int thread_exit = 0;

// MPEG-1, layer 3
static int bitrates[] = { 0, 32, 40, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320, 0 };
//static int samplerates[] = { 44100, 48000, 32000, 0 };

#define MIN_INFRAME_SIZE 96
#define IN_BUFFER_SIZE (2*1024)

static unsigned long mp3_codec_struct[65] __attribute__((aligned(64)));

static unsigned char mp3_src_buffer[2][IN_BUFFER_SIZE] __attribute__((aligned(64)));
static short mp3_mix_buffer[2][1152*2] __attribute__((aligned(64)));
static int working_buf = 0;

static const char *mp3_fname = NULL;
static SceUID mp3_handle = -1;
static int mp3_src_pos = 0, mp3_src_size = 0;

static int decode_thread(SceSize args, void *argp);


static void psp_sem_lock(SceUID sem)
{
	int ret = sceKernelWaitSema(sem, 1, 0);
	if (ret < 0) lprintf("sceKernelWaitSema(%08x) failed with %08x\n", sem, ret);
}

static void psp_sem_unlock(SceUID sem)
{
	int ret = sceKernelSignalSema(sem, 1);
	if (ret < 0) lprintf("sceKernelSignalSema(%08x) failed with %08x\n", sem, ret);
}

// only accepts MPEG-1, layer3
static int find_sync_word(unsigned char *data, int len)
{
	int i;
	for (i = 0; i < len-1; i++)
	{
		if ( data[i+0] != 0xff) continue;
		if ((data[i+1] & 0xfe) == 0xfa) return i;
		i++;
	}
	return -1;
}

static int read_next_frame(int which_buffer)
{
	int i, bytes_read, frame_offset;
	int bitrate, padding, frame_size = 0;

	for (i = 0; i < 32; i++)
	{
		bytes_read = sceIoRead(mp3_handle, mp3_src_buffer[which_buffer], sizeof(mp3_src_buffer[which_buffer]));
		mp3_src_pos += bytes_read;
		if (bytes_read < MIN_INFRAME_SIZE) {
			mp3_src_pos = mp3_src_size;
			return 0; // EOF/IO failure
		}
		frame_offset = find_sync_word(mp3_src_buffer[which_buffer], bytes_read);
		if (frame_offset < 0) {
			lprintf("missing syncword, foffs=%i\n", mp3_src_pos - bytes_read);
			mp3_src_pos--;
			sceIoLseek32(mp3_handle, mp3_src_pos, PSP_SEEK_SET);
			continue;
		}
		if (bytes_read - frame_offset < 4) {
			lprintf("syncword @ EOB, foffs=%i\n", mp3_src_pos - bytes_read);
			mp3_src_pos--;
			sceIoLseek32(mp3_handle, mp3_src_pos, PSP_SEEK_SET);
			continue;
		}

		bitrate =  mp3_src_buffer[which_buffer][frame_offset+2] >> 4;
		padding = (mp3_src_buffer[which_buffer][frame_offset+2] & 2) >> 1;

		frame_size = 144000*bitrates[bitrate]/44100 + padding;
		if (frame_size <= 0) {
			lprintf("bad frame, foffs=%i\n", mp3_src_pos - bytes_read);
			continue; // bad frame
		}

		if (bytes_read - frame_offset < frame_size)
		{
			lprintf("unfit, foffs=%i\n", mp3_src_pos - bytes_read);
			mp3_src_pos -= bytes_read - frame_offset;
			if (mp3_src_size - mp3_src_pos < frame_size) {
				mp3_src_pos = mp3_src_size;
				return 0; // EOF
			}
			sceIoLseek32(mp3_handle, mp3_src_pos, PSP_SEEK_SET);
			continue; // didn't fit, re-read..
		}

		if (frame_offset) {
			//lprintf("unaligned, foffs=%i, offs=%i\n", mp3_src_pos - bytes_read, frame_offset);
			memmove(mp3_src_buffer[which_buffer], mp3_src_buffer[which_buffer] + frame_offset, frame_size);
		}

		// align for next frame read
		mp3_src_pos -= bytes_read - (frame_offset + frame_size);
		sceIoLseek32(mp3_handle, mp3_src_pos, PSP_SEEK_SET);

		break;
	}

	return frame_size > 0 ? frame_size : -1;
}


static SceUID load_start_module(const char *prxname)
{
	SceUID mod = pspSdkLoadStartModule(prxname, PSP_MEMORY_PARTITION_KERNEL);
	if (mod < 0)
		lprintf("failed to load %s: %08x\n", prxname, mod);
	return mod;
}


int mp3_init(void)
{
	SceUID thid, mod;
	int ret;

	/* load modules */
	/* <= 1.5 (and probably some other, not sure which) fw need this to for audiocodec to work,
	 * so if it fails, assume we are just on new enough firmware and continue.. */
	load_start_module("flash0:/kd/me_for_vsh.prx");

	if (sceKernelDevkitVersion() < 0x02070010)
	     mod = load_start_module("flash0:/kd/audiocodec.prx");
	else mod = load_start_module("flash0:/kd/avcodec.prx");
	if (mod < 0) {
		ret = mod = load_start_module("flash0:/kd/audiocodec_260.prx"); // last chance..
		if (mod < 0) goto fail;
	}

	/* audiocodec init */
	memset(mp3_codec_struct, 0, sizeof(mp3_codec_struct));
	ret = sceAudiocodecCheckNeedMem(mp3_codec_struct, 0x1002);
	if (ret < 0) {
		lprintf("sceAudiocodecCheckNeedMem failed with %08x\n", ret);
		goto fail;
	}

	ret = sceAudiocodecGetEDRAM(mp3_codec_struct, 0x1002);
	if (ret < 0) {
		lprintf("sceAudiocodecGetEDRAM failed with %08x\n", ret);
		goto fail;
	}

	ret = sceAudiocodecInit(mp3_codec_struct, 0x1002);
	if (ret < 0) {
		lprintf("sceAudiocodecInit failed with %08x\n", ret);
		goto fail1;
	}

	/* thread and stuff */
	thread_job_sem = sceKernelCreateSema("p_mp3job_sem", 0, 0, 1, NULL);
	if (thread_job_sem < 0) {
		lprintf("sceKernelCreateSema() failed: %08x\n", thread_job_sem);
		ret = thread_job_sem;
		goto fail1;
	}

	thread_busy_sem = sceKernelCreateSema("p_mp3busy_sem", 0, 1, 1, NULL);
	if (thread_busy_sem < 0) {
		lprintf("sceKernelCreateSema() failed: %08x\n", thread_busy_sem);
		ret = thread_busy_sem;
		goto fail2;
	}

	thread_exit = 0;
	thid = sceKernelCreateThread("mp3decode_thread", decode_thread, 30, 0x2000, 0, 0); /* use slightly higher prio then main */
	if (thid < 0) {
		lprintf("failed to create decode thread: %08x\n", thid);
		ret = thid;
		goto fail3;
	}
	ret = sceKernelStartThread(thid, 0, 0);
	if (ret < 0) {
		lprintf("failed to start decode thread: %08x\n", ret);
		goto fail3;
	}

	mp3_last_error = 0;
	initialized = 1;
	return 0;

fail3:
	sceKernelDeleteSema(thread_busy_sem);
	thread_busy_sem = -1;
fail2:
	sceKernelDeleteSema(thread_job_sem);
	thread_job_sem = -1;
fail1:
	sceAudiocodecReleaseEDRAM(mp3_codec_struct);
fail:
	mp3_last_error = ret;
	initialized = 0;
	return 1;
}

void mp3_deinit(void)
{
	lprintf("mp3_deinit, initialized=%i\n", initialized);

	if (!initialized) return;
	thread_exit = 1;
	psp_sem_lock(thread_busy_sem);
	psp_sem_unlock(thread_busy_sem);

	sceKernelSignalSema(thread_job_sem, 1);
	sceKernelDelayThread(100*1000);

	if (mp3_handle >= 0) sceIoClose(mp3_handle);
	mp3_handle = -1;
	mp3_fname = NULL;

	sceKernelDeleteSema(thread_busy_sem);
	thread_busy_sem = -1;
	sceKernelDeleteSema(thread_job_sem);
	thread_job_sem = -1;
	sceAudiocodecReleaseEDRAM(mp3_codec_struct);
	initialized = 0;
}

// may overflow stack?
static int decode_thread(SceSize args, void *argp)
{
	int ret, frame_size;

	lprintf("decode_thread started with id %08x, priority %i\n",
                sceKernelGetThreadId(), sceKernelGetThreadCurrentPriority());

	while (!thread_exit)
	{
		psp_sem_lock(thread_job_sem);
		if (thread_exit) break;

		psp_sem_lock(thread_busy_sem);
		//lprintf("{ job\n");

		frame_size = read_next_frame(working_buf);
		if (frame_size > 0)
		{
			mp3_codec_struct[6] = (unsigned long)mp3_src_buffer[working_buf];
			mp3_codec_struct[8] = (unsigned long)mp3_mix_buffer[working_buf];
			mp3_codec_struct[7] = mp3_codec_struct[10] = frame_size;
			mp3_codec_struct[9] = 1152 * 4;

			ret = sceAudiocodecDecode(mp3_codec_struct, 0x1002);
			if (ret < 0) lprintf("sceAudiocodecDecode failed with %08x\n", ret);
		}

		//lprintf("} job\n");
		psp_sem_unlock(thread_busy_sem);
	}

	lprintf("leaving decode thread\n");
	sceKernelExitDeleteThread(0);
	return 0;
}


// might be called before initialization
int mp3_get_bitrate(FILE *f, int size)
{
	int ret, retval = -1, sample_rate, bitrate;
	// filenames are stored instead handles in PSP, due to stupid max open file limit
	char *fname = (char *)f;

	/* make sure thread is not busy.. */
	if (thread_busy_sem >= 0)
		psp_sem_lock(thread_busy_sem);

	if (mp3_handle >= 0) sceIoClose(mp3_handle);
	mp3_handle = sceIoOpen(fname, PSP_O_RDONLY, 0777);
	if (mp3_handle < 0) {
		lprintf("sceIoOpen(%s) failed\n", fname);
		goto end;
	}

	mp3_src_pos = 0;
	ret = read_next_frame(0);
	if (ret <= 0) {
		lprintf("read_next_frame() failed (%s)\n", fname);
		goto end;
	}
	sample_rate = (mp3_src_buffer[0][2] & 0x0c) >> 2;
	bitrate = mp3_src_buffer[0][2] >> 4;

	if (sample_rate != 0) {
		lprintf("unsupported samplerate (%s)\n", fname);
		goto end; // only 44kHz supported..
	}
	bitrate = bitrates[bitrate];
	if (bitrate == 0) {
		lprintf("unsupported bitrate (%s)\n", fname);
		goto end;
	}

	/* looking good.. */
	retval = bitrate;
end:
	if (mp3_handle >= 0) sceIoClose(mp3_handle);
	mp3_handle = -1;
	mp3_fname = NULL;
	if (thread_busy_sem >= 0)
		psp_sem_unlock(thread_busy_sem);
	if (retval < 0) mp3_last_error = -1; // remember we had a problem..
	return retval;
}


static int mp3_job_started = 0, mp3_samples_ready = 0, mp3_buffer_offs = 0, mp3_play_bufsel = 0;

void mp3_start_play(FILE *f, int pos)
{
	char *fname = (char *)f;

	if (!initialized) return;

	lprintf("mp3_start_play(%s) @ %i\n", fname, pos);
	psp_sem_lock(thread_busy_sem);

	if (mp3_fname != fname || mp3_handle < 0)
	{
		if (mp3_handle >= 0) sceIoClose(mp3_handle);
		mp3_handle = sceIoOpen(fname, PSP_O_RDONLY, 0777);
		if (mp3_handle < 0) {
			lprintf("sceIoOpen(%s) failed\n", fname);
			psp_sem_unlock(thread_busy_sem);
			return;
		}
		mp3_src_size = sceIoLseek32(mp3_handle, 0, PSP_SEEK_END);
		mp3_fname = fname;
	}

	// seek..
	mp3_src_pos = (int) (((float)pos / 1023.0f) * (float)mp3_src_size);
	sceIoLseek32(mp3_handle, mp3_src_pos, PSP_SEEK_SET);
	lprintf("seek %i: %i/%i\n", pos, mp3_src_pos, mp3_src_size);

	mp3_job_started = 1;
	mp3_samples_ready = mp3_buffer_offs = mp3_play_bufsel = 0;
	working_buf = 0;

	/* send a request to decode first frame */
	psp_sem_unlock(thread_busy_sem);
	psp_sem_unlock(thread_job_sem);
	sceKernelDelayThread(1); // reschedule
}


void mp3_update(int *buffer, int length, int stereo)
{
	int length_mp3;

	// playback was started, track not ended
	if (mp3_handle < 0 || mp3_src_pos >= mp3_src_size) return;

	length_mp3 = length;
	if (PsndRate == 22050) length_mp3 <<= 1;	// mp3s are locked to 44100Hz stereo
	else if (PsndRate == 11025) length_mp3 <<= 2;	// so make length 44100ish

	/* do we have to wait? */
	if (mp3_job_started && mp3_samples_ready < length_mp3)
	{
		psp_sem_lock(thread_busy_sem);
		psp_sem_unlock(thread_busy_sem);
		mp3_job_started = 0;
		mp3_samples_ready += 1152;
	}

	/* mix mp3 data, only stereo */
	if (mp3_samples_ready >= length_mp3)
	{
		int shr = 0;
		void (*mix_samples)(int *dest_buf, short *mp3_buf, int count) = mix_16h_to_32;
		if (PsndRate == 22050) { mix_samples = mix_16h_to_32_s1; shr = 1; }
		else if (PsndRate == 11025) { mix_samples = mix_16h_to_32_s2; shr = 2; }

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

			mp3_buffer_offs += length_mp3;
		} else {
			// collect samples from both buffers..
			int left = 1152 - mp3_buffer_offs;
			if (mp3_play_bufsel == 0)
			{
				mix_samples(buffer, mp3_mix_buffer[0] + mp3_buffer_offs*2, length<<1);
				mp3_buffer_offs = length_mp3 - left;
				mp3_play_bufsel = 1;
			} else {
				mix_samples(buffer, mp3_mix_buffer[1] + mp3_buffer_offs*2, (left>>shr)<<1);
				mp3_buffer_offs = length_mp3 - left;
				mix_samples(buffer + ((left>>shr)<<1),
					mp3_mix_buffer[0], (mp3_buffer_offs>>shr)<<1);
				mp3_play_bufsel = 0;
			}
		}
		mp3_samples_ready -= length_mp3;
	}

	// ask to decode more if we already can
	if (!mp3_job_started)
	{
		mp3_job_started = 1;
		working_buf ^= 1;

		/* next job.. */
		psp_sem_lock(thread_busy_sem);   // just in case
		psp_sem_unlock(thread_busy_sem);
		psp_sem_unlock(thread_job_sem);
		sceKernelDelayThread(1);
	}
}


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

	cdda_on = (PicoMCD & 1) && (PicoOpt&0x800) && !(Pico_mcd->s68k_regs[0x36] & 1) &&
			(Pico_mcd->scd.Status_CDC & 1) && mp3_handle >= 0;

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

	return offs1024;
}
Commit	Line	Data
63b796ca	1	// (c) Copyright 2007 notaz, All rights reserved.
	2	// Free for non-commercial use.
	3
	4	// For commercial use, separate licencing terms must be obtained.
	5
2951214e	6	#include <stdio.h>
a6df06b7	7	#include <string.h>
2951214e	8
a6df06b7	9	#include <pspkernel.h>
	10	#include <pspsdk.h>
	11	#include <pspaudiocodec.h>
	12
	13	#include "../../Pico/PicoInt.h"
	14	#include "../../Pico/sound/mix.h"
	15	#include "../common/lprintf.h"
	16
	17	int mp3_last_error = 0;
	18
fe9e3b25	19	static int initialized = 0;
a6df06b7	20	static SceUID thread_job_sem = -1;
	21	static SceUID thread_busy_sem = -1;
	22	static int thread_exit = 0;
	23
	24	// MPEG-1, layer 3
	25	static int bitrates[] = { 0, 32, 40, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320, 0 };
	26	//static int samplerates[] = { 44100, 48000, 32000, 0 };
	27
	28	#define MIN_INFRAME_SIZE 96
	29	#define IN_BUFFER_SIZE (2*1024)
	30
	31	static unsigned long mp3_codec_struct[65] __attribute__((aligned(64)));
	32
	33	static unsigned char mp3_src_buffer[2][IN_BUFFER_SIZE] __attribute__((aligned(64)));
	34	static short mp3_mix_buffer[2][1152*2] __attribute__((aligned(64)));
	35	static int working_buf = 0;
	36
	37	static const char *mp3_fname = NULL;
	38	static SceUID mp3_handle = -1;
	39	static int mp3_src_pos = 0, mp3_src_size = 0;
	40
	41	static int decode_thread(SceSize args, void *argp);
	42
	43
	44	static void psp_sem_lock(SceUID sem)
2951214e	45	{
a6df06b7	46	int ret = sceKernelWaitSema(sem, 1, 0);
	47	if (ret < 0) lprintf("sceKernelWaitSema(%08x) failed with %08x\n", sem, ret);
	48	}
	49
	50	static void psp_sem_unlock(SceUID sem)
	51	{
	52	int ret = sceKernelSignalSema(sem, 1);
	53	if (ret < 0) lprintf("sceKernelSignalSema(%08x) failed with %08x\n", sem, ret);
	54	}
	55
	56	// only accepts MPEG-1, layer3
	57	static int find_sync_word(unsigned char *data, int len)
	58	{
	59	int i;
	60	for (i = 0; i < len-1; i++)
	61	{
	62	if ( data[i+0] != 0xff) continue;
	63	if ((data[i+1] & 0xfe) == 0xfa) return i;
	64	i++;
	65	}
	66	return -1;
	67	}
	68
	69	static int read_next_frame(int which_buffer)
	70	{
	71	int i, bytes_read, frame_offset;
	72	int bitrate, padding, frame_size = 0;
	73
	74	for (i = 0; i < 32; i++)
	75	{
	76	bytes_read = sceIoRead(mp3_handle, mp3_src_buffer[which_buffer], sizeof(mp3_src_buffer[which_buffer]));
	77	mp3_src_pos += bytes_read;
	78	if (bytes_read < MIN_INFRAME_SIZE) {
	79	mp3_src_pos = mp3_src_size;
	80	return 0; // EOF/IO failure
	81	}
	82	frame_offset = find_sync_word(mp3_src_buffer[which_buffer], bytes_read);
	83	if (frame_offset < 0) {
	84	lprintf("missing syncword, foffs=%i\n", mp3_src_pos - bytes_read);
	85	mp3_src_pos--;
	86	sceIoLseek32(mp3_handle, mp3_src_pos, PSP_SEEK_SET);
	87	continue;
	88	}
	89	if (bytes_read - frame_offset < 4) {
	90	lprintf("syncword @ EOB, foffs=%i\n", mp3_src_pos - bytes_read);
	91	mp3_src_pos--;
	92	sceIoLseek32(mp3_handle, mp3_src_pos, PSP_SEEK_SET);
	93	continue;
	94	}
	95
	96	bitrate = mp3_src_buffer[which_buffer][frame_offset+2] >> 4;
	97	padding = (mp3_src_buffer[which_buffer][frame_offset+2] & 2) >> 1;
	98
	99	frame_size = 144000*bitrates[bitrate]/44100 + padding;
	100	if (frame_size <= 0) {
	101	lprintf("bad frame, foffs=%i\n", mp3_src_pos - bytes_read);
	102	continue; // bad frame
	103	}
	104
fe9e3b25	105	if (bytes_read - frame_offset < frame_size)
fe9e3b25	106	{
a6df06b7	107	lprintf("unfit, foffs=%i\n", mp3_src_pos - bytes_read);
a6df06b7	108	mp3_src_pos -= bytes_read - frame_offset;
fe9e3b25	109	if (mp3_src_size - mp3_src_pos < frame_size) {
	110	mp3_src_pos = mp3_src_size;
	111	return 0; // EOF
	112	}
a6df06b7	113	sceIoLseek32(mp3_handle, mp3_src_pos, PSP_SEEK_SET);
	114	continue; // didn't fit, re-read..
	115	}
	116
	117	if (frame_offset) {
60a10527	118	//lprintf("unaligned, foffs=%i, offs=%i\n", mp3_src_pos - bytes_read, frame_offset);
a6df06b7	119	memmove(mp3_src_buffer[which_buffer], mp3_src_buffer[which_buffer] + frame_offset, frame_size);
	120	}
	121
	122	// align for next frame read
	123	mp3_src_pos -= bytes_read - (frame_offset + frame_size);
	124	sceIoLseek32(mp3_handle, mp3_src_pos, PSP_SEEK_SET);
	125
	126	break;
	127	}
	128
	129	return frame_size > 0 ? frame_size : -1;
	130	}
	131
	132
	133	static SceUID load_start_module(const char *prxname)
	134	{
	135	SceUID mod = pspSdkLoadStartModule(prxname, PSP_MEMORY_PARTITION_KERNEL);
	136	if (mod < 0)
	137	lprintf("failed to load %s: %08x\n", prxname, mod);
	138	return mod;
	139	}
	140
	141
	142	int mp3_init(void)
	143	{
	144	SceUID thid, mod;
	145	int ret;
	146
	147	/* load modules */
	148	/* <= 1.5 (and probably some other, not sure which) fw need this to for audiocodec to work,
	149	* so if it fails, assume we are just on new enough firmware and continue.. */
	150	load_start_module("flash0:/kd/me_for_vsh.prx");
	151
	152	if (sceKernelDevkitVersion() < 0x02070010)
	153	mod = load_start_module("flash0:/kd/audiocodec.prx");
	154	else mod = load_start_module("flash0:/kd/avcodec.prx");
	155	if (mod < 0) {
	156	ret = mod = load_start_module("flash0:/kd/audiocodec_260.prx"); // last chance..
	157	if (mod < 0) goto fail;
	158	}
	159
	160	/* audiocodec init */
	161	memset(mp3_codec_struct, 0, sizeof(mp3_codec_struct));
	162	ret = sceAudiocodecCheckNeedMem(mp3_codec_struct, 0x1002);
	163	if (ret < 0) {
	164	lprintf("sceAudiocodecCheckNeedMem failed with %08x\n", ret);
	165	goto fail;
	166	}
	167
	168	ret = sceAudiocodecGetEDRAM(mp3_codec_struct, 0x1002);
	169	if (ret < 0) {
	170	lprintf("sceAudiocodecGetEDRAM failed with %08x\n", ret);
	171	goto fail;
	172	}
	173
	174	ret = sceAudiocodecInit(mp3_codec_struct, 0x1002);
	175	if (ret < 0) {
	176	lprintf("sceAudiocodecInit failed with %08x\n", ret);
	177	goto fail1;
	178	}
	179
	180	/* thread and stuff */
	181	thread_job_sem = sceKernelCreateSema("p_mp3job_sem", 0, 0, 1, NULL);
	182	if (thread_job_sem < 0) {
183	lprintf("sceKernelCreateSema() failed: %08x\n", thread_job_sem);
184	ret = thread_job_sem;
185	goto fail1;
186	}
187
188	thread_busy_sem = sceKernelCreateSema("p_mp3busy_sem", 0, 1, 1, NULL);
189	if (thread_busy_sem < 0) {
190	lprintf("sceKernelCreateSema() failed: %08x\n", thread_busy_sem);
191	ret = thread_busy_sem;
192	goto fail2;
193	}
194
a6df06b7	195	thread_exit = 0;
	196	thid = sceKernelCreateThread("mp3decode_thread", decode_thread, 30, 0x2000, 0, 0); /* use slightly higher prio then main */
	197	if (thid < 0) {
	198	lprintf("failed to create decode thread: %08x\n", thid);
	199	ret = thid;
	200	goto fail3;
	201	}
	202	ret = sceKernelStartThread(thid, 0, 0);
	203	if (ret < 0) {
	204	lprintf("failed to start decode thread: %08x\n", ret);
	205	goto fail3;
	206	}
	207
	208	mp3_last_error = 0;
fe9e3b25	209	initialized = 1;
2951214e	210	return 0;
a6df06b7	211
	212	fail3:
	213	sceKernelDeleteSema(thread_busy_sem);
	214	thread_busy_sem = -1;
	215	fail2:
	216	sceKernelDeleteSema(thread_job_sem);
	217	thread_job_sem = -1;
	218	fail1:
	219	sceAudiocodecReleaseEDRAM(mp3_codec_struct);
	220	fail:
	221	mp3_last_error = ret;
fe9e3b25	222	initialized = 0;
a6df06b7	223	return 1;
2951214e	224	}
2951214e	225
a6df06b7	226	void mp3_deinit(void)
2951214e	227	{
fe9e3b25	228	lprintf("mp3_deinit, initialized=%i\n", initialized);
	229
	230	if (!initialized) return;
a6df06b7	231	thread_exit = 1;
	232	psp_sem_lock(thread_busy_sem);
	233	psp_sem_unlock(thread_busy_sem);
	234
	235	sceKernelSignalSema(thread_job_sem, 1);
	236	sceKernelDelayThread(100*1000);
	237
	238	if (mp3_handle >= 0) sceIoClose(mp3_handle);
	239	mp3_handle = -1;
	240	mp3_fname = NULL;
	241
	242	sceKernelDeleteSema(thread_busy_sem);
	243	thread_busy_sem = -1;
	244	sceKernelDeleteSema(thread_job_sem);
	245	thread_job_sem = -1;
	246	sceAudiocodecReleaseEDRAM(mp3_codec_struct);
fe9e3b25	247	initialized = 0;
2951214e	248	}
2951214e	249
a6df06b7	250	// may overflow stack?
a6df06b7	251	static int decode_thread(SceSize args, void *argp)
2951214e	252	{
a6df06b7	253	int ret, frame_size;
	254
	255	lprintf("decode_thread started with id %08x, priority %i\n",
	256	sceKernelGetThreadId(), sceKernelGetThreadCurrentPriority());
	257
	258	while (!thread_exit)
	259	{
	260	psp_sem_lock(thread_job_sem);
	261	if (thread_exit) break;
	262
	263	psp_sem_lock(thread_busy_sem);
	264	//lprintf("{ job\n");
	265
	266	frame_size = read_next_frame(working_buf);
	267	if (frame_size > 0)
	268	{
	269	mp3_codec_struct[6] = (unsigned long)mp3_src_buffer[working_buf];
	270	mp3_codec_struct[8] = (unsigned long)mp3_mix_buffer[working_buf];
	271	mp3_codec_struct[7] = mp3_codec_struct[10] = frame_size;
	272	mp3_codec_struct[9] = 1152 * 4;
	273
	274	ret = sceAudiocodecDecode(mp3_codec_struct, 0x1002);
	275	if (ret < 0) lprintf("sceAudiocodecDecode failed with %08x\n", ret);
	276	}
	277
	278	//lprintf("} job\n");
	279	psp_sem_unlock(thread_busy_sem);
	280	}
	281
	282	lprintf("leaving decode thread\n");
	283	sceKernelExitDeleteThread(0);
2951214e	284	return 0;
	285	}
	286
a6df06b7	287
fe9e3b25	288	// might be called before initialization
a6df06b7	289	int mp3_get_bitrate(FILE *f, int size)
a6df06b7	290	{
5ecedd0c	291	int ret, retval = -1, sample_rate, bitrate;
a6df06b7	292	// filenames are stored instead handles in PSP, due to stupid max open file limit
	293	char fname = (char )f;
	294
	295	/* make sure thread is not busy.. */
fe9e3b25	296	if (thread_busy_sem >= 0)
fe9e3b25	297	psp_sem_lock(thread_busy_sem);
a6df06b7	298
	299	if (mp3_handle >= 0) sceIoClose(mp3_handle);
	300	mp3_handle = sceIoOpen(fname, PSP_O_RDONLY, 0777);
	301	if (mp3_handle < 0) {
	302	lprintf("sceIoOpen(%s) failed\n", fname);
	303	goto end;
	304	}
	305
	306	mp3_src_pos = 0;
	307	ret = read_next_frame(0);
	308	if (ret <= 0) {
fe9e3b25	309	lprintf("read_next_frame() failed (%s)\n", fname);
a6df06b7	310	goto end;
	311	}
	312	sample_rate = (mp3_src_buffer[0][2] & 0x0c) >> 2;
	313	bitrate = mp3_src_buffer[0][2] >> 4;
	314
	315	if (sample_rate != 0) {
fe9e3b25	316	lprintf("unsupported samplerate (%s)\n", fname);
a6df06b7	317	goto end; // only 44kHz supported..
	318	}
	319	bitrate = bitrates[bitrate];
	320	if (bitrate == 0) {
fe9e3b25	321	lprintf("unsupported bitrate (%s)\n", fname);
a6df06b7	322	goto end;
	323	}
	324
	325	/* looking good.. */
5ecedd0c	326	retval = bitrate;
a6df06b7	327	end:
	328	if (mp3_handle >= 0) sceIoClose(mp3_handle);
	329	mp3_handle = -1;
	330	mp3_fname = NULL;
fe9e3b25	331	if (thread_busy_sem >= 0)
fe9e3b25	332	psp_sem_unlock(thread_busy_sem);
5ecedd0c	333	if (retval < 0) mp3_last_error = -1; // remember we had a problem..
5ecedd0c	334	return retval;
a6df06b7	335	}
	336
	337
	338	static int mp3_job_started = 0, mp3_samples_ready = 0, mp3_buffer_offs = 0, mp3_play_bufsel = 0;
	339
	340	void mp3_start_play(FILE *f, int pos)
	341	{
	342	char fname = (char )f;
	343
fe9e3b25	344	if (!initialized) return;
fe9e3b25	345
a6df06b7	346	lprintf("mp3_start_play(%s) @ %i\n", fname, pos);
	347	psp_sem_lock(thread_busy_sem);
	348
60a10527	349	if (mp3_fname != fname \|\| mp3_handle < 0)
a6df06b7	350	{
	351	if (mp3_handle >= 0) sceIoClose(mp3_handle);
	352	mp3_handle = sceIoOpen(fname, PSP_O_RDONLY, 0777);
	353	if (mp3_handle < 0) {
	354	lprintf("sceIoOpen(%s) failed\n", fname);
	355	psp_sem_unlock(thread_busy_sem);
	356	return;
	357	}
	358	mp3_src_size = sceIoLseek32(mp3_handle, 0, PSP_SEEK_END);
	359	mp3_fname = fname;
	360	}
	361
	362	// seek..
	363	mp3_src_pos = (int) (((float)pos / 1023.0f) * (float)mp3_src_size);
	364	sceIoLseek32(mp3_handle, mp3_src_pos, PSP_SEEK_SET);
	365	lprintf("seek %i: %i/%i\n", pos, mp3_src_pos, mp3_src_size);
	366
	367	mp3_job_started = 1;
	368	mp3_samples_ready = mp3_buffer_offs = mp3_play_bufsel = 0;
	369	working_buf = 0;
	370
	371	/* send a request to decode first frame */
	372	psp_sem_unlock(thread_busy_sem);
	373	psp_sem_unlock(thread_job_sem);
	374	sceKernelDelayThread(1); // reschedule
	375	}
	376
	377
2951214e	378	void mp3_update(int *buffer, int length, int stereo)
2951214e	379	{
a6df06b7	380	int length_mp3;
	381
	382	// playback was started, track not ended
	383	if (mp3_handle < 0 \|\| mp3_src_pos >= mp3_src_size) return;
	384
	385	length_mp3 = length;
	386	if (PsndRate == 22050) length_mp3 <<= 1; // mp3s are locked to 44100Hz stereo
	387	else if (PsndRate == 11025) length_mp3 <<= 2; // so make length 44100ish
	388
	389	/* do we have to wait? */
	390	if (mp3_job_started && mp3_samples_ready < length_mp3)
	391	{
	392	psp_sem_lock(thread_busy_sem);
	393	psp_sem_unlock(thread_busy_sem);
	394	mp3_job_started = 0;
	395	mp3_samples_ready += 1152;
	396	}
	397
	398	/* mix mp3 data, only stereo */
	399	if (mp3_samples_ready >= length_mp3)
	400	{
	401	int shr = 0;
	402	void (mix_samples)(int dest_buf, short *mp3_buf, int count) = mix_16h_to_32;
	403	if (PsndRate == 22050) { mix_samples = mix_16h_to_32_s1; shr = 1; }
	404	else if (PsndRate == 11025) { mix_samples = mix_16h_to_32_s2; shr = 2; }
	405
	406	if (1152 - mp3_buffer_offs >= length_mp3) {
	407	mix_samples(buffer, mp3_mix_buffer[mp3_play_bufsel] + mp3_buffer_offs*2, length<<1);
	408
	409	mp3_buffer_offs += length_mp3;
	410	} else {
	411	// collect samples from both buffers..
	412	int left = 1152 - mp3_buffer_offs;
	413	if (mp3_play_bufsel == 0)
	414	{
	415	mix_samples(buffer, mp3_mix_buffer[0] + mp3_buffer_offs*2, length<<1);
	416	mp3_buffer_offs = length_mp3 - left;
	417	mp3_play_bufsel = 1;
	418	} else {
	419	mix_samples(buffer, mp3_mix_buffer[1] + mp3_buffer_offs*2, (left>>shr)<<1);
	420	mp3_buffer_offs = length_mp3 - left;
	421	mix_samples(buffer + ((left>>shr)<<1),
	422	mp3_mix_buffer[0], (mp3_buffer_offs>>shr)<<1);
	423	mp3_play_bufsel = 0;
	424	}
	425	}
	426	mp3_samples_ready -= length_mp3;
	427	}
	428
	429	// ask to decode more if we already can
	430	if (!mp3_job_started)
	431	{
	432	mp3_job_started = 1;
	433	working_buf ^= 1;
	434
	435	/* next job.. */
	436	psp_sem_lock(thread_busy_sem); // just in case
	437	psp_sem_unlock(thread_busy_sem);
	438	psp_sem_unlock(thread_job_sem);
	439	sceKernelDelayThread(1);
	440	}
	441	}
	442
	443
444	int mp3_get_offset(void) // 0-1023
445	{
446	unsigned int offs1024 = 0;
447	int cdda_on;
448
449	cdda_on = (PicoMCD & 1) && (PicoOpt&0x800) && !(Pico_mcd->s68k_regs[0x36] & 1) &&
450	(Pico_mcd->scd.Status_CDC & 1) && mp3_handle >= 0;
451
452	if (cdda_on) {
453	offs1024 = mp3_src_pos << 7;
454	offs1024 /= mp3_src_size >> 3;
455	}
456	lprintf("offs1024=%u (%i/%i)\n", offs1024, mp3_src_pos, mp3_src_size);
457
458	return offs1024;
2951214e	459	}
2951214e	460
a6df06b7	461