From 11f4e72292ab00c686f2a2288e4f1cda3a0f7abd Mon Sep 17 00:00:00 2001 From: notaz 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 +#include + +#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 -#include - -#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