src1.c
上传用户:yisoukefu
上传日期:2020-08-09
资源大小:39506k
文件大小:14k
- #include <windows.h>
- #include <math.h>
- #define ARCH_X86
- typedef UINT uint32_t;
- typedef WORD uint16_t;
- #define real float
- #include "mpg123.h"
- #define fast_memcpy memcpy
- static _inline uint16_t bswap_16(uint16_t x)
- {
- __asm mov ax, x
- __asm bswap eax;
- __asm shr eax, 16
- }
- static _inline uint32_t bswap_32(uint32_t x)
- {
- __asm mov eax, x
- __asm bswap eax;
- }
- #define DECLARE_ALIGNED(n,t,v) __declspec(align(n)) t v
- #define LOCAL static _inline
- #include <stdlib.h>
- #include <stdio.h>
- #include <string.h>
- #include <signal.h>
- #include <math.h>
- #include "mpg123.h"
- #include "huffman.h"
- //#include "mp_msg.h"
- int MP3_frames=0;
- int MP3_eof=0;
- int MP3_pause=0;
- int MP3_filesize=0;
- int MP3_fpos=0; // current file position
- int MP3_framesize=0; // current framesize
- int MP3_bitrate=0; // current bitrate
- int MP3_samplerate=0; // current samplerate
- int MP3_resync=0;
- int MP3_channels=0;
- int MP3_bps=2;
- static long outscale = 32768;
- #include "tabinit.c"
- #if 1
- extern int mplayer_audio_read(char *buf,int size);
- LOCAL int mp3_read(char *buf,int size){
- // int len=fread(buf,1,size,mp3_file);
- int len=mplayer_audio_read(buf,size);
- if(len>0) MP3_fpos+=len;
- // if(len!=size) MP3_eof=1;
- return len;
- }
- #else
- extern int mp3_read(char *buf,int size);
- #endif
- /*
- * Modified for use with MPlayer, for details see the changelog at
- * http://svn.mplayerhq.hu/mplayer/trunk/
- * $Id: sr1.c 23515 2007-06-08 14:38:25Z zuxy $
- */
- //void mp3_seek(int pos){
- // fseek(mp3_file,pos,SEEK_SET);
- // return (MP3_fpos=ftell(mp3_file));
- //}
- /* Frame reader */
- #define MAXFRAMESIZE 1280
- #define MAXFRAMESIZE2 (512+MAXFRAMESIZE)
- static int fsizeold=0,ssize=0;
- static unsigned char bsspace[2][MAXFRAMESIZE2]; /* !!!!! */
- static unsigned char *bsbufold=bsspace[0]+512;
- static unsigned char *bsbuf=bsspace[1]+512;
- static int bsnum=0;
- static int bitindex;
- static unsigned char *wordpointer;
- static int bitsleft;
- static unsigned char *pcm_sample; /* outbuffer address */
- static int pcm_point = 0; /* outbuffer offset */
- static struct frame fr;
- static int tabsel_123[2][3][16] = {
- { {0,32,64,96,128,160,192,224,256,288,320,352,384,416,448,},
- {0,32,48,56, 64, 80, 96,112,128,160,192,224,256,320,384,},
- {0,32,40,48, 56, 64, 80, 96,112,128,160,192,224,256,320,} },
- { {0,32,48,56,64,80,96,112,128,144,160,176,192,224,256,},
- {0,8,16,24,32,40,48,56,64,80,96,112,128,144,160,},
- {0,8,16,24,32,40,48,56,64,80,96,112,128,144,160,} }
- };
- static int freqs[9] = { 44100, 48000, 32000, 22050, 24000, 16000 , 11025 , 12000 , 8000 };
- LOCAL unsigned int getbits(short number_of_bits)
- {
- unsigned rval;
- // if(MP3_frames>=7741) printf("getbits: bits=%d bitsleft=%d wordptr=%xn",number_of_bits,bitsleft,wordpointer);
- if((bitsleft-=number_of_bits)<0) return 0;
- if(!number_of_bits) return 0;
- rval = wordpointer[0];
- rval <<= 8;
- rval |= wordpointer[1];
- rval <<= 8;
- rval |= wordpointer[2];
- rval <<= bitindex;
- rval &= 0xffffff;
- bitindex += number_of_bits;
- rval >>= (24-number_of_bits);
- wordpointer += (bitindex>>3);
- bitindex &= 7;
- return rval;
- }
- LOCAL unsigned int getbits_fast(short number_of_bits)
- {
- unsigned rval;
- // if(MP3_frames>=7741) printf("getbits_fast: bits=%d bitsleft=%d wordptr=%xn",number_of_bits,bitsleft,wordpointer);
- if((bitsleft-=number_of_bits)<0) return 0;
- if(!number_of_bits) return 0;
- #ifdef ARCH_X86
- rval = bswap_16(*((uint16_t *)wordpointer));
- #else
- /*
- * we may not be able to address unaligned 16-bit data on non-x86 cpus.
- * Fall back to some portable code.
- */
- rval = wordpointer[0] << 8 | wordpointer[1];
- #endif
- rval <<= bitindex;
- rval &= 0xffff;
- bitindex += number_of_bits;
- rval >>= (16-number_of_bits);
- wordpointer += (bitindex>>3);
- bitindex &= 7;
- return rval;
- }
- LOCAL unsigned int get1bit(void)
- {
- unsigned char rval;
- // if(MP3_frames>=7741) printf("get1bit: bitsleft=%d wordptr=%xn",bitsleft,wordpointer);
- if((--bitsleft)<0) return 0;
- rval = *wordpointer << bitindex;
- bitindex++;
- wordpointer += (bitindex>>3);
- bitindex &= 7;
- return ((rval>>7)&1);
- }
- LOCAL void set_pointer(int backstep)
- {
- // if(backstep!=512 && backstep>fsizeold)
- // printf("rWarning! backstep (%d>%d) n",backstep,fsizeold);
- wordpointer = bsbuf + ssize - backstep;
- if (backstep) fast_memcpy(wordpointer,bsbufold+fsizeold-backstep,backstep);
- bitindex = 0;
- bitsleft+=8*backstep;
- // printf("Backstep %d (bitsleft=%d)n",backstep,bitsleft);
- }
- LOCAL int stream_head_read(unsigned char *hbuf,uint32_t *newhead){
- if(mp3_read(hbuf,4) != 4) return FALSE;
- #ifdef ARCH_X86
- *newhead = bswap_32(*((uint32_t*)hbuf));
- #else
- /*
- * we may not be able to address unaligned 32-bit data on non-x86 cpus.
- * Fall back to some portable code.
- */
- *newhead =
- hbuf[0] << 24 |
- hbuf[1] << 16 |
- hbuf[2] << 8 |
- hbuf[3];
- #endif
- return TRUE;
- }
- LOCAL int stream_head_shift(unsigned char *hbuf,uint32_t *head){
- *((uint32_t*)hbuf) >>= 8;
- if(mp3_read(hbuf+3,1) != 1) return 0;
- *head <<= 8;
- *head |= hbuf[3];
- return 1;
- }
- /*
- * decode a header and write the information
- * into the frame structure
- */
- LOCAL int decode_header(struct frame *fr,uint32_t newhead){
- // head_check:
- if( (newhead & 0xffe00000) != 0xffe00000 ||
- (newhead & 0x0000fc00) == 0x0000fc00) return FALSE;
- fr->lay = 4-((newhead>>17)&3);
- // if(fr->lay!=3) return FALSE;
- if( newhead & (1<<20) ) {
- fr->lsf = (newhead & (1<<19)) ? 0x0 : 0x1;
- fr->mpeg25 = 0;
- } else {
- fr->lsf = 1;
- fr->mpeg25 = 1;
- }
- if(fr->mpeg25)
- fr->sampling_frequency = 6 + ((newhead>>10)&0x3);
- else
- fr->sampling_frequency = ((newhead>>10)&0x3) + (fr->lsf*3);
- if(fr->sampling_frequency>8) return FALSE; // valid: 0..8
- fr->error_protection = ((newhead>>16)&0x1)^0x1;
- fr->bitrate_index = ((newhead>>12)&0xf);
- fr->padding = ((newhead>>9)&0x1);
- fr->extension = ((newhead>>8)&0x1);
- fr->mode = ((newhead>>6)&0x3);
- fr->mode_ext = ((newhead>>4)&0x3);
- fr->copyright = ((newhead>>3)&0x1);
- fr->original = ((newhead>>2)&0x1);
- fr->emphasis = newhead & 0x3;
- MP3_channels = fr->stereo = (fr->mode == MPG_MD_MONO) ? 1 : 2;
- if(!fr->bitrate_index){
- // fprintf(stderr,"Free format not supported.n");
- return FALSE;
- }
- switch(fr->lay){
- case 2:
- MP3_bitrate=tabsel_123[fr->lsf][1][fr->bitrate_index];
- MP3_samplerate=freqs[fr->sampling_frequency];
- fr->framesize = MP3_bitrate * 144000;
- fr->framesize /= MP3_samplerate;
- MP3_framesize=fr->framesize;
- fr->framesize += fr->padding - 4;
- break;
- case 3:
- if(fr->lsf)
- ssize = (fr->stereo == 1) ? 9 : 17;
- else
- ssize = (fr->stereo == 1) ? 17 : 32;
- if(fr->error_protection) ssize += 2;
- MP3_bitrate=tabsel_123[fr->lsf][2][fr->bitrate_index];
- MP3_samplerate=freqs[fr->sampling_frequency];
- fr->framesize = MP3_bitrate * 144000;
- fr->framesize /= MP3_samplerate<<(fr->lsf);
- MP3_framesize=fr->framesize;
- fr->framesize += fr->padding - 4;
- break;
- case 1:
- // fr->jsbound = (fr->mode == MPG_MD_JOINT_STEREO) ? (fr->mode_ext<<2)+4 : 32;
- MP3_bitrate=tabsel_123[fr->lsf][0][fr->bitrate_index];
- MP3_samplerate=freqs[fr->sampling_frequency];
- fr->framesize = MP3_bitrate * 12000;
- fr->framesize /= MP3_samplerate;
- MP3_framesize = ((fr->framesize+fr->padding)<<2);
- fr->framesize = MP3_framesize-4;
- // printf("framesize=%dn",fr->framesize);
- break;
- default:
- MP3_framesize=fr->framesize=0;
- // fprintf(stderr,"Sorry, unsupported layer type.n");
- return 0;
- }
- if(fr->framesize<=0 || fr->framesize>MAXFRAMESIZE) return FALSE;
- return 1;
- }
- LOCAL int stream_read_frame_body(int size){
- /* flip/init buffer for Layer 3 */
- bsbufold = bsbuf;
- bsbuf = bsspace[bsnum]+512;
- bsnum = (bsnum + 1) & 1;
- if( mp3_read(bsbuf,size) != size) return 0; // broken frame
- bitindex = 0;
- wordpointer = (unsigned char *) bsbuf;
- bitsleft=8*size;
- return 1;
- }
- /*****************************************************************
- * read next frame return number of frames read.
- */
- LOCAL int read_frame(struct frame *fr){
- uint32_t newhead;
- union {
- unsigned char buf[8];
- unsigned long dummy; // for alignment
- } hbuf;
- int skipped,resyncpos;
- int frames=0;
- resync:
- skipped=MP3_fpos;
- resyncpos=MP3_fpos;
- set_pointer(512);
- fsizeold=fr->framesize; /* for Layer3 */
- if(!stream_head_read(hbuf.buf,&newhead)) return 0;
- if(!decode_header(fr,newhead)){
- // invalid header! try to resync stream!
- #ifdef DEBUG_RESYNC
- printf("ReSync: searching for a valid header... (pos=%X)n",MP3_fpos);
- #endif
- retry1:
- while(!decode_header(fr,newhead)){
- if(!stream_head_shift(hbuf.buf,&newhead)) return 0;
- }
- resyncpos=MP3_fpos-4;
- // found valid header
- #ifdef DEBUG_RESYNC
- printf("ReSync: found valid hdr at %X fsize=%ld ",resyncpos,fr->framesize);
- #endif
- if(!stream_read_frame_body(fr->framesize)) return 0; // read body
- set_pointer(512);
- fsizeold=fr->framesize; /* for Layer3 */
- if(!stream_head_read(hbuf.buf,&newhead)) return 0;
- if(!decode_header(fr,newhead)){
- // invalid hdr! go back...
- #ifdef DEBUG_RESYNC
- printf("INVALIDn");
- #endif
- // mp3_seek(resyncpos+1);
- if(!stream_head_read(hbuf.buf,&newhead)) return 0;
- goto retry1;
- }
- #ifdef DEBUG_RESYNC
- printf("OK!n");
- ++frames;
- #endif
- }
- skipped=resyncpos-skipped;
- // if(skipped && !MP3_resync) printf("r%d bad bytes skipped (resync at 0x%X) n",skipped,resyncpos);
- // printf("%8X [%08X] %d %d (%d)%s%sn",MP3_fpos-4,newhead,fr->framesize,fr->mode,fr->mode_ext,fr->error_protection?" CRC":"",fr->padding?" PAD":"");
- /* read main data into memory */
- if(!stream_read_frame_body(fr->framesize)){
- printf("nBroken frame at 0x%X n",resyncpos);
- return 0;
- }
- ++frames;
- if(MP3_resync){
- MP3_resync=0;
- if(frames==1) goto resync;
- }
- return frames;
- }
- static int _has_mmx = 0; // used by layer2.c, layer3.c to pre-scale coeffs
- #include "layer2.c"
- #include "layer3.c"
- #include "layer1.c"
- /******************************************************************************/
- /* PUBLIC FUNCTIONS */
- /******************************************************************************/
- /* It's hidden from gcc in assembler */
- extern void dct64_MMX(short *, short *, real *);
- extern void dct64_MMX_3dnow(short *, short *, real *);
- extern void dct64_MMX_3dnowex(short *, short *, real *);
- extern void dct64_sse(short *, short *, real *);
- void (*dct64_MMX_func)(short *, short *, real *);
- #include "cpudetect.h"
- // Init decoder tables. Call first, once!
- #ifdef USE_FAKE_MONO
- void MP3_Init(int fakemono){
- #else
- void MP3_Init(){
- #endif
- //gCpuCaps.hasMMX=gCpuCaps.hasMMX2=gCpuCaps.hasSSE=0; // for testing!
- _has_mmx = 0;
- dct36_func = dct36;
- make_decode_tables(outscale);
- #ifdef HAVE_MMX
- if (gCpuCaps.hasMMX)
- {
- _has_mmx = 1;
- synth_func = synth_1to1_MMX;
- }
- #endif
- #ifdef HAVE_3DNOWEX
- if (gCpuCaps.has3DNowExt)
- {
- dct36_func=dct36_3dnowex;
- dct64_MMX_func= dct64_MMX_3dnowex;
- mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using 3DNow!Ex optimized decore!n");
- }
- else
- #endif
- #ifdef HAVE_3DNOW
- if (gCpuCaps.has3DNow)
- {
- dct36_func = dct36_3dnow;
- dct64_MMX_func = dct64_MMX_3dnow;
- mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using 3DNow! optimized decore!n");
- }
- else
- #endif
- #ifdef HAVE_SSE
- if (gCpuCaps.hasSSE)
- {
- dct64_MMX_func = dct64_sse;
- mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using SSE optimized decore!n");
- }
- else
- #endif
- #ifdef ARCH_X86_32
- #ifdef HAVE_MMX
- if (gCpuCaps.hasMMX)
- {
- dct64_MMX_func = dct64_MMX;
- mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using MMX optimized decore!n");
- }
- else
- #endif
- if (gCpuCaps.cpuType >= CPUTYPE_I586)
- {
- synth_func = synth_1to1_pent;
- mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using Pentium optimized decore!n");
- }
- else
- #endif /* ARCH_X86_32 */
- #ifdef HAVE_ALTIVEC
- if (gCpuCaps.hasAltiVec)
- {
- mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using AltiVec optimized decore!n");
- }
- else
- #endif
- {
- synth_func = NULL; /* use default c version */
- /// mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using generic C decore!n");
- }
- #ifdef USE_FAKE_MONO
- if (fakemono == 1)
- fr.synth=synth_1to1_l;
- else if (fakemono == 2)
- fr.synth=synth_1to1_r;
- else
- fr.synth=synth_1to1;
- #else
- fr.synth=synth_1to1;
- #endif
- fr.synth_mono=synth_1to1_mono2stereo;
- fr.down_sample=0;
- fr.down_sample_sblimit = SBLIMIT>>(fr.down_sample);
- init_layer2();
- init_layer3(fr.down_sample_sblimit);
- /// mp_msg(MSGT_DECAUDIO,MSGL_V,"MP3lib: init layer2&3 finished, tables donen");
- }
- // Read & decode a single frame. Called by sound driver.
- int MP3_DecodeFrame(unsigned char *hova,short single){
- pcm_sample = hova;
- pcm_point = 0;
- if(!read_frame(&fr))return(0);
- if(single==-2){ set_pointer(512); return(1); }
- if(fr.error_protection) getbits(16); /* skip crc */
- fr.single=single;
- switch(fr.lay){
- case 2: do_layer2(&fr,single);break;
- case 3: do_layer3(&fr,single);break;
- case 1: do_layer1(&fr,single);break;
- default:
- return 0; // unsupported
- }
- // ++MP3_frames;
- return(pcm_point?pcm_point:2);
- }