From 11f4e72292ab00c686f2a2288e4f1cda3a0f7abd Mon Sep 17 00:00:00 2001
From: notaz <notasas@gmail.com>
Date: Thu, 4 Oct 2007 21:14:45 +0000
Subject: [PATCH] giz rc1 release

git-svn-id: file:///home/notaz/opt/svn/PicoDrive/platform@268 be3aeb3a-fb24-0410-a615-afba39da0efa
---
 common/emu.c           |   8 +-
 {gp2x => common}/mp3.h |   2 +
 common/mp3_helix.c     | 251 +++++++++++++++++++++++++++++++++++++++++
 gp2x/940ctl.c          |  14 +--
 gp2x/Makefile          |  13 +--
 gp2x/mp3.c             | 137 ----------------------
 6 files changed, 270 insertions(+), 155 deletions(-)
 rename {gp2x => common}/mp3.h (79%)
 create mode 100644 common/mp3_helix.c
 delete mode 100644 gp2x/mp3.c

diff --git a/common/emu.c b/common/emu.c
index c236778..723dfb7 100644
--- a/common/emu.c
+++ b/common/emu.c
@@ -687,7 +687,8 @@ int emu_SaveLoadGame(int load, int sram)
 
 	lprintf("saveLoad (%i, %i): %s\n", load, sram, saveFname);
 
-	if(sram) {
+	if (sram)
+	{
 		FILE *sramFile;
 		int sram_size;
 		unsigned char *sram_data;
@@ -740,10 +741,11 @@ int emu_SaveLoadGame(int load, int sram)
 	else
 	{
 		void *PmovFile = NULL;
-		if (strcmp(saveFname + strlen(saveFname) - 3, ".gz") == 0) {
+		if (strcmp(saveFname + strlen(saveFname) - 3, ".gz") == 0)
+		{
 			if( (PmovFile = gzopen(saveFname, load ? "rb" : "wb")) ) {
 				emu_setSaveStateCbs(1);
-				if(!load) gzsetparams(PmovFile, 9, Z_DEFAULT_STRATEGY);
+				if (!load) gzsetparams(PmovFile, 9, Z_DEFAULT_STRATEGY);
 			}
 		}
 		else
diff --git a/gp2x/mp3.h b/common/mp3.h
similarity index 79%
rename from gp2x/mp3.h
rename to common/mp3.h
index 022d89c..aef65ff 100644
--- a/gp2x/mp3.h
+++ b/common/mp3.h
@@ -1,4 +1,6 @@
 
+#ifdef __GP2X__
 void mp3_update_local(int *buffer, int length, int stereo);
 void mp3_start_local(void);
+#endif
 
diff --git a/common/mp3_helix.c b/common/mp3_helix.c
new file mode 100644
index 0000000..a5da376
--- /dev/null
+++ b/common/mp3_helix.c
@@ -0,0 +1,251 @@
+// 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/PicoInt.h"
+#include "../../Pico/sound/mix.h"
+#include "helix/pub/mp3dec.h"
+#include "lprintf.h"
+
+static short mp3_out_buffer[2*1152];
+static HMP3Decoder mp3dec = 0;
+static int mp3_buffer_offs = 0;
+
+
+static int try_get_header(unsigned char *buff, MP3FrameInfo *fi)
+{
+	int ret, offs1, offs = 0;
+
+	while (1)
+	{
+		offs1 = MP3FindSyncWord(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) 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 err;
+
+	if (bytesLeft <= 0) return 1; // EOF, nothing to do
+
+	offset = MP3FindSyncWord(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, mp3_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++;
+		}
+		shared_ctl->mp3_errors++;
+		shared_ctl->mp3_lasterr = err;
+	}
+	shared_ctl->mp3_offs = readPtr - mp3_mem;
+	return 0;
+}
+
+void mp3_start_local(void)
+{
+	mp3_buffer_offs = 0;
+	mp3_decode();
+}
+
+#define mp3_update mp3_update_local
+
+#else
+
+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 = MP3FindSyncWord(mp3_input_buffer, bytesLeft);
+		if (offset < 0) {
+			//lprintf("MP3FindSyncWord (%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, mp3_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;
+
+	if (!(PicoOpt&0x800) || 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 = (PicoMCD & 1) && (PicoOpt&0x800) && !(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, mp3_out_buffer + mp3_buffer_offs*2, length<<1);
+
+		mp3_buffer_offs += length_mp3;
+	} else {
+		int ret, left = 1152 - mp3_buffer_offs;
+
+		mix_samples(buffer, mp3_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), mp3_out_buffer, (mp3_buffer_offs>>shr)<<1);
+		} else
+			mp3_buffer_offs = 0;
+	}
+}
+
+
diff --git a/gp2x/940ctl.c b/gp2x/940ctl.c
index 0cbdb1c..a927913 100644
--- a/gp2x/940ctl.c
+++ b/gp2x/940ctl.c
@@ -14,7 +14,7 @@
 #include "gp2x.h"
 #include "emu.h"
 #include "menu.h"
-#include "mp3.h"
+#include "../common/mp3.h"
 #include "../common/arm_utils.h"
 #include "../common/menu.h"
 #include "../common/emu.h"
@@ -533,9 +533,8 @@ void mp3_update(int *buffer, int length, int stereo)
 	int length_mp3;
 	int cdda_on;
 
-	// not data track, CDC is reading, playback was started, track not ended
-	cdda_on = !(Pico_mcd->s68k_regs[0x36] & 1) && (Pico_mcd->scd.Status_CDC & 1) &&
-			loaded_mp3 && shared_ctl->mp3_offs < shared_ctl->mp3_len;
+	// playback was started, track not ended
+	cdda_on = loaded_mp3 && shared_ctl->mp3_offs < shared_ctl->mp3_len;
 
 	if (!cdda_on) return;
 
@@ -649,7 +648,7 @@ void mp3_start_play(FILE *f, int pos) // pos is 0-1023
 
 int mp3_get_offset(void)
 {
-	int offs1024 = 0;
+	unsigned int offs1024 = 0;
 	int cdda_on;
 
 	cdda_on = (PicoMCD & 1) && (PicoOpt&0x800) && !(Pico_mcd->s68k_regs[0x36] & 1) &&
@@ -657,10 +656,9 @@ int mp3_get_offset(void)
 
 	if (cdda_on) {
 		offs1024  = shared_ctl->mp3_offs << 7;
-		offs1024 /= shared_ctl->mp3_len;
-		offs1024 <<= 3;
+		offs1024 /= shared_ctl->mp3_len  >> 3;
 	}
-	printf("offs1024=%i (%i/%i)\n", offs1024, shared_ctl->mp3_offs, shared_ctl->mp3_len);
+	printf("offs1024=%u (%i/%i)\n", offs1024, shared_ctl->mp3_offs, shared_ctl->mp3_len);
 
 	return offs1024;
 }
diff --git a/gp2x/Makefile b/gp2x/Makefile
index 65565f1..5c903b1 100644
--- a/gp2x/Makefile
+++ b/gp2x/Makefile
@@ -1,7 +1,7 @@
 
 # you may or may not need to change this
 #devkit_path = x:/stuff/dev/devkitgp2x/
-CROSS = arm-linux-
+export CROSS = arm-linux-
 #CROSS = $(devkit_path)bin/arm-linux-
 
 # settings
@@ -58,7 +58,8 @@ OBJS += main.o menu.o gp2x.o usbjoy.o emu.o squidgehack.o cpuctrl.o
 OBJS += 940ctl.o
 
 # common
-OBJS += ../common/emu.o ../common/menu.o ../common/fonts.o ../common/arm_utils.o ../common/readpng.o
+OBJS += ../common/emu.o ../common/menu.o ../common/fonts.o ../common/arm_utils.o \
+	../common/readpng.o ../common/mp3_helix.o
 
 # Pico
 ifeq "$(amalgamate)" "1"
@@ -111,8 +112,6 @@ OBJS += ../../zlib/gzio.o ../../zlib/inffast.o ../../zlib/inflate.o ../../zlib/i
 	../../zlib/deflate.o ../../zlib/crc32.o ../../zlib/adler32.o ../../zlib/zutil.o ../../zlib/compress.o
 # unzip
 OBJS += ../../unzip/unzip.o ../../unzip/unzip_stream.o
-# mp3
-OBJS += mp3.o
 # debug
 ifeq "$(debug_cyclone)" "1"
 OBJS += ../../Pico/_cyclone_debug.o ../../cpu/musashi/m68kdasm.o
@@ -138,7 +137,7 @@ endif
 
 all: PicoDrive.gpe
 
-PicoDrive.gpe : $(OBJS) helix/helix_mp3.a
+PicoDrive.gpe : $(OBJS) ../common/helix/helix_mp3.a
 	@echo $@
 	@$(GCC) -o $@ $(COPT) $^ -lm -lpng -Wl,-Map=PicoDrive.map
 ifeq ($(DEBUG),)
@@ -206,8 +205,8 @@ testrefr.gpe : test.o gp2x.o
 
 
 # build helix libs
-helix/helix_mp3.a:
-	make -C helix
+../common/helix/helix_mp3.a:
+	make -C ../common/helix
 
 
 # cleanup
diff --git a/gp2x/mp3.c b/gp2x/mp3.c
deleted file mode 100644
index 4fba953..0000000
--- a/gp2x/mp3.c
+++ /dev/null
@@ -1,137 +0,0 @@
-// Some mp3 related code for Sega/Mega CD
-// (c) Copyright 2007, Grazvydas "notaz" Ignotas
-
-#include <stdio.h>
-#include <string.h>
-
-#include "../../Pico/sound/mix.h"
-#include "code940/940shared.h"
-#include "helix/pub/mp3dec.h"
-
-static short mp3_out_buffer[2*1152];
-static HMP3Decoder mp3dec = 0;
-static int mp3_buffer_offs = 0;
-
-extern _940_ctl_t *shared_ctl;
-extern unsigned char *mp3_mem;
-extern int PsndRate;
-
-
-static int try_get_header(unsigned char *buff, MP3FrameInfo *fi)
-{
-	int ret, offs1, offs = 0;
-
-	while (1)
-	{
-		offs1 = MP3FindSyncWord(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) 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;
-}
-
-
-static void 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 err;
-
-	if (bytesLeft <= 0) return; // EOF, nothing to do
-
-	offset = MP3FindSyncWord(readPtr, bytesLeft);
-	if (offset < 0) {
-		shared_ctl->mp3_offs = shared_ctl->mp3_len;
-		return; // EOF
-	}
-	readPtr += offset;
-	bytesLeft -= offset;
-
-	err = MP3Decode(mp3dec, &readPtr, &bytesLeft, mp3_out_buffer, 0);
-	if (err) {
-		if (err == ERR_MP3_INDATA_UNDERFLOW) {
-			shared_ctl->mp3_offs = shared_ctl->mp3_len; // EOF
-			return;
-		} else if (err <= -6 && err >= -12) {
-			// ERR_MP3_INVALID_FRAMEHEADER, ERR_MP3_INVALID_*
-			// just try to skip the offending frame..
-			readPtr++;
-		}
-		shared_ctl->mp3_errors++;
-		shared_ctl->mp3_lasterr = err;
-	}
-	shared_ctl->mp3_offs = readPtr - mp3_mem;
-}
-
-
-void mp3_update_local(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;
-
-	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, mp3_out_buffer + mp3_buffer_offs*2, length<<1);
-
-		mp3_buffer_offs += length_mp3;
-	} else {
-		int left = 1152 - mp3_buffer_offs;
-
-		mix_samples(buffer, mp3_out_buffer + mp3_buffer_offs*2, (left>>shr)<<1);
-		mp3_decode();
-		mp3_buffer_offs = length_mp3 - left;
-		mix_samples(buffer + ((left>>shr)<<1), mp3_out_buffer, (mp3_buffer_offs>>shr)<<1);
-	}
-}
-
-
-void mp3_start_local(void)
-{
-	mp3_buffer_offs = 0;
-	mp3_decode();
-}
-
-- 
2.39.5