Remove unused functions.
[mplayer/glamo.git] / mp3lib / sr1.c
blob694961ebc0138894b0d5cec6ca95abe71a52e095
1 // #define NEWBUFFERING
2 //#define DEBUG_RESYNC
4 /* 1 frame = 4608 byte PCM */
6 #define LOCAL static inline
8 //#undef LOCAL
9 //#define LOCAL
11 #include <stdlib.h>
12 #include <stdio.h>
13 #include <string.h>
14 #include <math.h>
16 #include "mpg123.h"
17 #include "huffman.h"
18 #include "mp3.h"
19 #include "mpbswap.h"
20 #include "cpudetect.h"
21 //#include "liba52/mm_accel.h"
22 #include "mp_msg.h"
23 #include "libmpcodecs/ad_mp3lib.h"
24 #include "libvo/fastmemcpy.h"
26 #include "libavutil/common.h"
27 #include "libavutil/internal.h"
29 #undef fprintf
30 #undef printf
32 #if ARCH_X86_64
33 // 3DNow! and 3DNow!Ext routines don't compile under AMD64
34 #undef HAVE_AMD3DNOW
35 #undef HAVE_AMD3DNOWEXT
36 #define HAVE_AMD3DNOW 0
37 #define HAVE_AMD3DNOWEXT 0
38 #endif
40 //static FILE* mp3_file=NULL;
42 int MP3_frames=0;
43 int MP3_eof=0;
44 int MP3_pause=0;
45 int MP3_filesize=0;
46 int MP3_fpos=0; // current file position
47 int MP3_framesize=0; // current framesize
48 int MP3_bitrate=0; // current bitrate
49 int MP3_samplerate=0; // current samplerate
50 int MP3_resync=0;
51 int MP3_channels=0;
52 int MP3_bps=2;
54 static long outscale = 32768;
55 #include "tabinit.c"
57 #if 1
58 LOCAL int mp3_read(char *buf,int size){
59 // int len=fread(buf,1,size,mp3_file);
60 int len=mplayer_audio_read(buf,size);
61 if(len>0) MP3_fpos+=len;
62 // if(len!=size) MP3_eof=1;
63 return len;
65 #else
66 int mp3_read(char *buf,int size);
67 #endif
69 * Modified for use with MPlayer, for details see the changelog at
70 * http://svn.mplayerhq.hu/mplayer/trunk/
71 * $Id$
75 //void mp3_seek(int pos){
76 // fseek(mp3_file,pos,SEEK_SET);
77 // return MP3_fpos = ftell(mp3_file);
78 //}
80 /* Frame reader */
82 #define MAXFRAMESIZE 1280
83 #define MAXFRAMESIZE2 (512+MAXFRAMESIZE)
85 static int fsizeold=0,ssize=0;
86 static unsigned char bsspace[2][MAXFRAMESIZE2]; /* !!!!! */
87 static unsigned char *bsbufold=bsspace[0]+512;
88 static unsigned char *bsbuf=bsspace[1]+512;
89 static int bsnum=0;
91 static int bitindex;
92 static unsigned char *wordpointer;
93 static int bitsleft;
95 static unsigned char *pcm_sample; /* outbuffer address */
96 static int pcm_point = 0; /* outbuffer offset */
98 static struct frame fr;
100 static int tabsel_123[2][3][16] = {
101 { {0,32,64,96,128,160,192,224,256,288,320,352,384,416,448,},
102 {0,32,48,56, 64, 80, 96,112,128,160,192,224,256,320,384,},
103 {0,32,40,48, 56, 64, 80, 96,112,128,160,192,224,256,320,} },
105 { {0,32,48,56,64,80,96,112,128,144,160,176,192,224,256,},
106 {0,8,16,24,32,40,48,56,64,80,96,112,128,144,160,},
107 {0,8,16,24,32,40,48,56,64,80,96,112,128,144,160,} }
110 static int freqs[9] = { 44100, 48000, 32000, 22050, 24000, 16000 , 11025 , 12000 , 8000 };
112 LOCAL unsigned int getbits(short number_of_bits)
114 unsigned rval;
115 // if(MP3_frames>=7741) printf("getbits: bits=%d bitsleft=%d wordptr=%x\n",number_of_bits,bitsleft,wordpointer);
116 if((bitsleft-=number_of_bits)<0) return 0;
117 if(!number_of_bits) return 0;
118 rval = wordpointer[0];
119 rval <<= 8;
120 rval |= wordpointer[1];
121 rval <<= 8;
122 rval |= wordpointer[2];
123 rval <<= bitindex;
124 rval &= 0xffffff;
125 bitindex += number_of_bits;
126 rval >>= (24-number_of_bits);
127 wordpointer += (bitindex>>3);
128 bitindex &= 7;
129 return rval;
133 LOCAL unsigned int getbits_fast(short number_of_bits)
135 unsigned rval;
136 // if(MP3_frames>=7741) printf("getbits_fast: bits=%d bitsleft=%d wordptr=%x\n",number_of_bits,bitsleft,wordpointer);
137 if((bitsleft-=number_of_bits)<0) return 0;
138 if(!number_of_bits) return 0;
139 #if ARCH_X86
140 rval = bswap_16(*((uint16_t *)wordpointer));
141 #else
143 * we may not be able to address unaligned 16-bit data on non-x86 cpus.
144 * Fall back to some portable code.
146 rval = wordpointer[0] << 8 | wordpointer[1];
147 #endif
148 rval <<= bitindex;
149 rval &= 0xffff;
150 bitindex += number_of_bits;
151 rval >>= (16-number_of_bits);
152 wordpointer += (bitindex>>3);
153 bitindex &= 7;
154 return rval;
157 LOCAL unsigned int get1bit(void)
159 unsigned char rval;
160 // if(MP3_frames>=7741) printf("get1bit: bitsleft=%d wordptr=%x\n",bitsleft,wordpointer);
161 if((--bitsleft)<0) return 0;
162 rval = *wordpointer << bitindex;
163 bitindex++;
164 wordpointer += (bitindex>>3);
165 bitindex &= 7;
166 return (rval >> 7) & 1;
169 LOCAL void set_pointer(int backstep)
171 // if(backstep!=512 && backstep>fsizeold)
172 // printf("\rWarning! backstep (%d>%d) \n",backstep,fsizeold);
173 wordpointer = bsbuf + ssize - backstep;
174 if (backstep) fast_memcpy(wordpointer,bsbufold+fsizeold-backstep,backstep);
175 bitindex = 0;
176 bitsleft+=8*backstep;
177 // printf("Backstep %d (bitsleft=%d)\n",backstep,bitsleft);
180 LOCAL int stream_head_read(unsigned char *hbuf,uint32_t *newhead){
181 if(mp3_read(hbuf,4) != 4) return FALSE;
182 #if ARCH_X86
183 *newhead = bswap_32(*((uint32_t*)hbuf));
184 #else
186 * we may not be able to address unaligned 32-bit data on non-x86 cpus.
187 * Fall back to some portable code.
189 *newhead =
190 hbuf[0] << 24 |
191 hbuf[1] << 16 |
192 hbuf[2] << 8 |
193 hbuf[3];
194 #endif
195 return TRUE;
198 LOCAL int stream_head_shift(unsigned char *hbuf,uint32_t *head){
199 *((uint32_t*)hbuf) >>= 8;
200 if(mp3_read(hbuf+3,1) != 1) return 0;
201 *head <<= 8;
202 *head |= hbuf[3];
203 return 1;
207 * decode a header and write the information
208 * into the frame structure
210 LOCAL int decode_header(struct frame *fr,uint32_t newhead){
212 // head_check:
213 if( (newhead & 0xffe00000) != 0xffe00000 ||
214 (newhead & 0x0000fc00) == 0x0000fc00) return FALSE;
216 fr->lay = 4-((newhead>>17)&3);
217 // if(fr->lay!=3) return FALSE;
219 if( newhead & (1<<20) ) {
220 fr->lsf = (newhead & (1<<19)) ? 0x0 : 0x1;
221 fr->mpeg25 = 0;
222 } else {
223 fr->lsf = 1;
224 fr->mpeg25 = 1;
227 if(fr->mpeg25)
228 fr->sampling_frequency = 6 + ((newhead>>10)&0x3);
229 else
230 fr->sampling_frequency = ((newhead>>10)&0x3) + (fr->lsf*3);
232 if(fr->sampling_frequency>8) return FALSE; // valid: 0..8
234 fr->error_protection = ((newhead>>16)&0x1)^0x1;
235 fr->bitrate_index = ((newhead>>12)&0xf);
236 fr->padding = ((newhead>>9)&0x1);
237 fr->extension = ((newhead>>8)&0x1);
238 fr->mode = ((newhead>>6)&0x3);
239 fr->mode_ext = ((newhead>>4)&0x3);
240 fr->copyright = ((newhead>>3)&0x1);
241 fr->original = ((newhead>>2)&0x1);
242 fr->emphasis = newhead & 0x3;
244 MP3_channels = fr->stereo = (fr->mode == MPG_MD_MONO) ? 1 : 2;
246 if(!fr->bitrate_index){
247 // fprintf(stderr,"Free format not supported.\n");
248 return FALSE;
251 switch(fr->lay){
252 case 2:
253 MP3_bitrate=tabsel_123[fr->lsf][1][fr->bitrate_index];
254 MP3_samplerate=freqs[fr->sampling_frequency];
255 fr->framesize = MP3_bitrate * 144000;
256 fr->framesize /= MP3_samplerate;
257 MP3_framesize=fr->framesize;
258 fr->framesize += fr->padding - 4;
259 break;
260 case 3:
261 if(fr->lsf)
262 ssize = (fr->stereo == 1) ? 9 : 17;
263 else
264 ssize = (fr->stereo == 1) ? 17 : 32;
265 if(fr->error_protection) ssize += 2;
267 MP3_bitrate=tabsel_123[fr->lsf][2][fr->bitrate_index];
268 MP3_samplerate=freqs[fr->sampling_frequency];
269 fr->framesize = MP3_bitrate * 144000;
270 fr->framesize /= MP3_samplerate<<(fr->lsf);
271 MP3_framesize=fr->framesize;
272 fr->framesize += fr->padding - 4;
273 break;
274 case 1:
275 // fr->jsbound = (fr->mode == MPG_MD_JOINT_STEREO) ? (fr->mode_ext<<2)+4 : 32;
276 MP3_bitrate=tabsel_123[fr->lsf][0][fr->bitrate_index];
277 MP3_samplerate=freqs[fr->sampling_frequency];
278 fr->framesize = MP3_bitrate * 12000;
279 fr->framesize /= MP3_samplerate;
280 MP3_framesize = ((fr->framesize+fr->padding)<<2);
281 fr->framesize = MP3_framesize-4;
282 // printf("framesize=%d\n",fr->framesize);
283 break;
284 default:
285 MP3_framesize=fr->framesize=0;
286 // fprintf(stderr,"Sorry, unsupported layer type.\n");
287 return 0;
289 if(fr->framesize<=0 || fr->framesize>MAXFRAMESIZE) return FALSE;
291 return 1;
295 LOCAL int stream_read_frame_body(int size){
297 /* flip/init buffer for Layer 3 */
298 bsbufold = bsbuf;
299 bsbuf = bsspace[bsnum]+512;
300 bsnum = (bsnum + 1) & 1;
302 if( mp3_read(bsbuf,size) != size) return 0; // broken frame
304 bitindex = 0;
305 wordpointer = (unsigned char *) bsbuf;
306 bitsleft=8*size;
308 return 1;
312 /*****************************************************************
313 * read next frame return number of frames read.
315 LOCAL int read_frame(struct frame *fr){
316 uint32_t newhead;
317 union {
318 unsigned char buf[8];
319 unsigned long dummy; // for alignment
320 } hbuf;
321 int skipped,resyncpos;
322 int frames=0;
324 resync:
325 skipped=MP3_fpos;
326 resyncpos=MP3_fpos;
328 set_pointer(512);
329 fsizeold=fr->framesize; /* for Layer3 */
330 if(!stream_head_read(hbuf.buf,&newhead)) return 0;
331 if(!decode_header(fr,newhead)){
332 // invalid header! try to resync stream!
333 #ifdef DEBUG_RESYNC
334 printf("ReSync: searching for a valid header... (pos=%X)\n",MP3_fpos);
335 #endif
336 retry1:
337 while(!decode_header(fr,newhead)){
338 if(!stream_head_shift(hbuf.buf,&newhead)) return 0;
340 resyncpos=MP3_fpos-4;
341 // found valid header
342 #ifdef DEBUG_RESYNC
343 printf("ReSync: found valid hdr at %X fsize=%ld ",resyncpos,fr->framesize);
344 #endif
345 if(!stream_read_frame_body(fr->framesize)) return 0; // read body
346 set_pointer(512);
347 fsizeold=fr->framesize; /* for Layer3 */
348 if(!stream_head_read(hbuf.buf,&newhead)) return 0;
349 if(!decode_header(fr,newhead)){
350 // invalid hdr! go back...
351 #ifdef DEBUG_RESYNC
352 printf("INVALID\n");
353 #endif
354 // mp3_seek(resyncpos+1);
355 if(!stream_head_read(hbuf.buf,&newhead)) return 0;
356 goto retry1;
358 #ifdef DEBUG_RESYNC
359 printf("OK!\n");
360 ++frames;
361 #endif
364 skipped=resyncpos-skipped;
365 // if(skipped && !MP3_resync) printf("\r%d bad bytes skipped (resync at 0x%X) \n",skipped,resyncpos);
367 // printf("%8X [%08X] %d %d (%d)%s%s\n",MP3_fpos-4,newhead,fr->framesize,fr->mode,fr->mode_ext,fr->error_protection?" CRC":"",fr->padding?" PAD":"");
369 /* read main data into memory */
370 if(!stream_read_frame_body(fr->framesize)){
371 printf("\nBroken frame at 0x%X \n",resyncpos);
372 return 0;
374 ++frames;
376 if(MP3_resync){
377 MP3_resync=0;
378 if(frames==1) goto resync;
381 return frames;
384 static int _has_mmx = 0; // used by layer2.c, layer3.c to pre-scale coeffs
386 /******************************************************************************/
387 /* PUBLIC FUNCTIONS */
388 /******************************************************************************/
390 void (*dct64_MMX_func)(short *, short *, real *);
392 #include "layer2.c"
393 #include "layer3.c"
394 #include "layer1.c"
396 #include "cpudetect.h"
398 // Init decoder tables. Call first, once!
399 #ifdef CONFIG_FAKE_MONO
400 void MP3_Init(int fakemono){
401 #else
402 void MP3_Init(void){
403 #endif
405 //gCpuCaps.hasMMX=gCpuCaps.hasMMX2=gCpuCaps.hasSSE=0; // for testing!
407 _has_mmx = 0;
408 dct36_func = dct36;
410 make_decode_tables(outscale);
412 #if HAVE_MMX
413 if (gCpuCaps.hasMMX)
415 _has_mmx = 1;
416 synth_func = synth_1to1_MMX;
418 #endif
420 #if HAVE_AMD3DNOWEXT
421 if (gCpuCaps.has3DNowExt)
423 dct36_func=dct36_3dnowex;
424 dct64_MMX_func= dct64_MMX_3dnowex;
425 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using 3DNow!Ex optimized decore!\n");
427 else
428 #endif
429 #if HAVE_AMD3DNOW
430 if (gCpuCaps.has3DNow)
432 dct36_func = dct36_3dnow;
433 dct64_MMX_func = dct64_MMX_3dnow;
434 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using 3DNow! optimized decore!\n");
436 else
437 #endif
438 #if HAVE_SSE
439 if (gCpuCaps.hasSSE)
441 dct64_MMX_func = dct64_sse;
442 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using SSE optimized decore!\n");
444 else
445 #endif
446 #if ARCH_X86_32
447 #if HAVE_MMX
448 if (gCpuCaps.hasMMX)
450 dct64_MMX_func = dct64_MMX;
451 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using MMX optimized decore!\n");
453 else
454 #endif
455 if (gCpuCaps.cpuType >= CPUTYPE_I586)
457 synth_func = synth_1to1_pent;
458 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using Pentium optimized decore!\n");
460 else
461 #endif /* ARCH_X86_32 */
462 #if HAVE_ALTIVEC
463 if (gCpuCaps.hasAltiVec)
465 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using AltiVec optimized decore!\n");
467 else
468 #endif
470 synth_func = NULL; /* use default c version */
471 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using generic C decore!\n");
474 #ifdef CONFIG_FAKE_MONO
475 if (fakemono == 1)
476 fr.synth=synth_1to1_l;
477 else if (fakemono == 2)
478 fr.synth=synth_1to1_r;
479 else
480 fr.synth=synth_1to1;
481 #else
482 fr.synth=synth_1to1;
483 #endif
484 fr.synth_mono=synth_1to1_mono2stereo;
485 fr.down_sample=0;
486 fr.down_sample_sblimit = SBLIMIT>>(fr.down_sample);
488 init_layer2();
489 init_layer3(fr.down_sample_sblimit);
490 mp_msg(MSGT_DECAUDIO,MSGL_V,"MP3lib: init layer2&3 finished, tables done\n");
493 #if 0
495 void MP3_Close(void){
496 MP3_eof=1;
497 if(mp3_file) fclose(mp3_file);
498 mp3_file=NULL;
501 // Open a file, init buffers. Call once per file!
502 int MP3_Open(char *filename,int buffsize){
503 MP3_eof=1; // lock decoding
504 MP3_pause=1; // lock playing
505 if(mp3_file) MP3_Close(); // close prev. file
506 MP3_frames=0;
508 mp3_file=fopen(filename,"rb");
509 // printf("MP3_Open: file='%s'",filename);
510 // if(!mp3_file){ printf(" not found!\n"); return 0;} else printf("Ok!\n");
511 if(!mp3_file) return 0;
513 MP3_filesize=MP3_PrintTAG();
514 fseek(mp3_file,0,SEEK_SET);
516 MP3_InitBuffers(buffsize);
517 if(!tables_done_flag) MP3_Init();
518 MP3_eof=0; // allow decoding
519 MP3_pause=0; // allow playing
520 return MP3_filesize;
523 #endif
525 // Read & decode a single frame. Called by sound driver.
526 int MP3_DecodeFrame(unsigned char *hova,short single){
527 pcm_sample = hova;
528 pcm_point = 0;
529 if(!read_frame(&fr)) return 0;
530 if(single==-2){ set_pointer(512); return 1; }
531 if(fr.error_protection) getbits(16); /* skip crc */
532 fr.single=single;
533 switch(fr.lay){
534 case 2: do_layer2(&fr,single);break;
535 case 3: do_layer3(&fr,single);break;
536 case 1: do_layer1(&fr,single);break;
537 default:
538 return 0; // unsupported
540 // ++MP3_frames;
541 return pcm_point ? pcm_point : 2;
544 // Prints last frame header in ascii.
545 void MP3_PrintHeader(void){
546 static char *modes[4] = { "Stereo", "Joint-Stereo", "Dual-Channel", "Single-Channel" };
547 static char *layers[4] = { "???" , "I", "II", "III" };
549 mp_msg(MSGT_DECAUDIO,MSGL_V,"\rMPEG %s, Layer %s, %d Hz %d kbit %s, BPF: %d\n",
550 fr.mpeg25 ? "2.5" : (fr.lsf ? "2.0" : "1.0"),
551 layers[fr.lay],freqs[fr.sampling_frequency],
552 tabsel_123[fr.lsf][fr.lay-1][fr.bitrate_index],
553 modes[fr.mode],fr.framesize+4);
554 mp_msg(MSGT_DECAUDIO,MSGL_V,"Channels: %d, copyright: %s, original: %s, CRC: %s, emphasis: %d\n",
555 fr.stereo,fr.copyright?"Yes":"No",
556 fr.original?"Yes":"No",fr.error_protection?"Yes":"No",
557 fr.emphasis);
560 #if 0
561 #include "genre.h"
563 // Read & print ID3 TAG. Do not call when playing!!! returns filesize.
564 int MP3_PrintTAG(void){
565 struct id3tag {
566 char tag[3];
567 char title[30];
568 char artist[30];
569 char album[30];
570 char year[4];
571 char comment[30];
572 unsigned char genre;
574 struct id3tag tag;
575 char title[31]={0,};
576 char artist[31]={0,};
577 char album[31]={0,};
578 char year[5]={0,};
579 char comment[31]={0,};
580 char genre[31]={0,};
581 int fsize;
582 int ret;
584 fseek(mp3_file,0,SEEK_END);
585 fsize=ftell(mp3_file);
586 if(fseek(mp3_file,-128,SEEK_END)) return fsize;
587 ret=fread(&tag,128,1,mp3_file);
588 if(ret!=1 || tag.tag[0]!='T' || tag.tag[1]!='A' || tag.tag[2]!='G') return fsize;
590 strncpy(title,tag.title,30);
591 strncpy(artist,tag.artist,30);
592 strncpy(album,tag.album,30);
593 strncpy(year,tag.year,4);
594 strncpy(comment,tag.comment,30);
596 if ( tag.genre <= sizeof(genre_table)/sizeof(*genre_table) ) {
597 strncpy(genre, genre_table[tag.genre], 30);
598 } else {
599 strncpy(genre,"Unknown",30);
602 // printf("\n");
603 printf("Title : %30s Artist: %s\n",title,artist);
604 printf("Album : %30s Year : %4s\n",album,year);
605 printf("Comment: %30s Genre : %s\n",comment,genre);
606 printf("\n");
607 return fsize-128;
610 #endif