Add a comment that explains why this header has no multiple inclusion guards.
[mplayer/greg.git] / mp3lib / sr1.c
blobf1c11cf7c4f0231531acdf1d287485db628f6982
1 // #define NEWBUFFERING
2 //#define DEBUG_RESYNC
4 /* 1 frame = 4608 byte PCM */
6 #ifdef __GNUC__
7 #define LOCAL static inline
8 #else
9 #define LOCAL static _inline
10 #endif
12 //#undef LOCAL
13 //#define LOCAL
15 #include <stdlib.h>
16 #include <stdio.h>
17 #include <string.h>
18 #include <signal.h>
19 #include <math.h>
21 #define real float
22 // #define int long
24 #include "mpg123.h"
25 #include "huffman.h"
26 #include "mp3.h"
27 #include "libavutil/common.h"
28 #include "mpbswap.h"
29 #include "cpudetect.h"
30 //#include "liba52/mm_accel.h"
31 #include "mp_msg.h"
33 #include "libvo/fastmemcpy.h"
35 #ifdef ARCH_X86_64
36 // 3DNow! and 3DNow!Ext routines don't compile under AMD64
37 #undef HAVE_3DNOW
38 #undef HAVE_3DNOWEX
39 #endif
41 //static FILE* mp3_file=NULL;
43 int MP3_frames=0;
44 int MP3_eof=0;
45 int MP3_pause=0;
46 int MP3_filesize=0;
47 int MP3_fpos=0; // current file position
48 int MP3_framesize=0; // current framesize
49 int MP3_bitrate=0; // current bitrate
50 int MP3_samplerate=0; // current samplerate
51 int MP3_resync=0;
52 int MP3_channels=0;
53 int MP3_bps=2;
55 static long outscale = 32768;
56 #include "tabinit.c"
58 #if 1
59 extern int mplayer_audio_read(char *buf,int size);
61 LOCAL int mp3_read(char *buf,int size){
62 // int len=fread(buf,1,size,mp3_file);
63 int len=mplayer_audio_read(buf,size);
64 if(len>0) MP3_fpos+=len;
65 // if(len!=size) MP3_eof=1;
66 return len;
68 #else
69 extern int mp3_read(char *buf,int size);
70 #endif
72 * Modified for use with MPlayer, for details see the changelog at
73 * http://svn.mplayerhq.hu/mplayer/trunk/
74 * $Id$
78 //void mp3_seek(int pos){
79 // fseek(mp3_file,pos,SEEK_SET);
80 // return (MP3_fpos=ftell(mp3_file));
81 //}
83 /* Frame reader */
85 #define MAXFRAMESIZE 1280
86 #define MAXFRAMESIZE2 (512+MAXFRAMESIZE)
88 static int fsizeold=0,ssize=0;
89 static unsigned char bsspace[2][MAXFRAMESIZE2]; /* !!!!! */
90 static unsigned char *bsbufold=bsspace[0]+512;
91 static unsigned char *bsbuf=bsspace[1]+512;
92 static int bsnum=0;
94 static int bitindex;
95 static unsigned char *wordpointer;
96 static int bitsleft;
98 static unsigned char *pcm_sample; /* outbuffer address */
99 static int pcm_point = 0; /* outbuffer offset */
101 static struct frame fr;
103 static int tabsel_123[2][3][16] = {
104 { {0,32,64,96,128,160,192,224,256,288,320,352,384,416,448,},
105 {0,32,48,56, 64, 80, 96,112,128,160,192,224,256,320,384,},
106 {0,32,40,48, 56, 64, 80, 96,112,128,160,192,224,256,320,} },
108 { {0,32,48,56,64,80,96,112,128,144,160,176,192,224,256,},
109 {0,8,16,24,32,40,48,56,64,80,96,112,128,144,160,},
110 {0,8,16,24,32,40,48,56,64,80,96,112,128,144,160,} }
113 static int freqs[9] = { 44100, 48000, 32000, 22050, 24000, 16000 , 11025 , 12000 , 8000 };
115 LOCAL unsigned int getbits(short number_of_bits)
117 unsigned rval;
118 // if(MP3_frames>=7741) printf("getbits: bits=%d bitsleft=%d wordptr=%x\n",number_of_bits,bitsleft,wordpointer);
119 if((bitsleft-=number_of_bits)<0) return 0;
120 if(!number_of_bits) return 0;
121 rval = wordpointer[0];
122 rval <<= 8;
123 rval |= wordpointer[1];
124 rval <<= 8;
125 rval |= wordpointer[2];
126 rval <<= bitindex;
127 rval &= 0xffffff;
128 bitindex += number_of_bits;
129 rval >>= (24-number_of_bits);
130 wordpointer += (bitindex>>3);
131 bitindex &= 7;
132 return rval;
136 LOCAL unsigned int getbits_fast(short number_of_bits)
138 unsigned rval;
139 // if(MP3_frames>=7741) printf("getbits_fast: bits=%d bitsleft=%d wordptr=%x\n",number_of_bits,bitsleft,wordpointer);
140 if((bitsleft-=number_of_bits)<0) return 0;
141 if(!number_of_bits) return 0;
142 #ifdef ARCH_X86
143 rval = bswap_16(*((uint16_t *)wordpointer));
144 #else
146 * we may not be able to address unaligned 16-bit data on non-x86 cpus.
147 * Fall back to some portable code.
149 rval = wordpointer[0] << 8 | wordpointer[1];
150 #endif
151 rval <<= bitindex;
152 rval &= 0xffff;
153 bitindex += number_of_bits;
154 rval >>= (16-number_of_bits);
155 wordpointer += (bitindex>>3);
156 bitindex &= 7;
157 return rval;
160 LOCAL unsigned int get1bit(void)
162 unsigned char rval;
163 // if(MP3_frames>=7741) printf("get1bit: bitsleft=%d wordptr=%x\n",bitsleft,wordpointer);
164 if((--bitsleft)<0) return 0;
165 rval = *wordpointer << bitindex;
166 bitindex++;
167 wordpointer += (bitindex>>3);
168 bitindex &= 7;
169 return ((rval>>7)&1);
172 LOCAL void set_pointer(int backstep)
174 // if(backstep!=512 && backstep>fsizeold)
175 // printf("\rWarning! backstep (%d>%d) \n",backstep,fsizeold);
176 wordpointer = bsbuf + ssize - backstep;
177 if (backstep) fast_memcpy(wordpointer,bsbufold+fsizeold-backstep,backstep);
178 bitindex = 0;
179 bitsleft+=8*backstep;
180 // printf("Backstep %d (bitsleft=%d)\n",backstep,bitsleft);
183 LOCAL int stream_head_read(unsigned char *hbuf,uint32_t *newhead){
184 if(mp3_read(hbuf,4) != 4) return FALSE;
185 #ifdef ARCH_X86
186 *newhead = bswap_32(*((uint32_t*)hbuf));
187 #else
189 * we may not be able to address unaligned 32-bit data on non-x86 cpus.
190 * Fall back to some portable code.
192 *newhead =
193 hbuf[0] << 24 |
194 hbuf[1] << 16 |
195 hbuf[2] << 8 |
196 hbuf[3];
197 #endif
198 return TRUE;
201 LOCAL int stream_head_shift(unsigned char *hbuf,uint32_t *head){
202 *((uint32_t*)hbuf) >>= 8;
203 if(mp3_read(hbuf+3,1) != 1) return 0;
204 *head <<= 8;
205 *head |= hbuf[3];
206 return 1;
210 * decode a header and write the information
211 * into the frame structure
213 LOCAL int decode_header(struct frame *fr,uint32_t newhead){
215 // head_check:
216 if( (newhead & 0xffe00000) != 0xffe00000 ||
217 (newhead & 0x0000fc00) == 0x0000fc00) return FALSE;
219 fr->lay = 4-((newhead>>17)&3);
220 // if(fr->lay!=3) return FALSE;
222 if( newhead & (1<<20) ) {
223 fr->lsf = (newhead & (1<<19)) ? 0x0 : 0x1;
224 fr->mpeg25 = 0;
225 } else {
226 fr->lsf = 1;
227 fr->mpeg25 = 1;
230 if(fr->mpeg25)
231 fr->sampling_frequency = 6 + ((newhead>>10)&0x3);
232 else
233 fr->sampling_frequency = ((newhead>>10)&0x3) + (fr->lsf*3);
235 if(fr->sampling_frequency>8) return FALSE; // valid: 0..8
237 fr->error_protection = ((newhead>>16)&0x1)^0x1;
238 fr->bitrate_index = ((newhead>>12)&0xf);
239 fr->padding = ((newhead>>9)&0x1);
240 fr->extension = ((newhead>>8)&0x1);
241 fr->mode = ((newhead>>6)&0x3);
242 fr->mode_ext = ((newhead>>4)&0x3);
243 fr->copyright = ((newhead>>3)&0x1);
244 fr->original = ((newhead>>2)&0x1);
245 fr->emphasis = newhead & 0x3;
247 MP3_channels = fr->stereo = (fr->mode == MPG_MD_MONO) ? 1 : 2;
249 if(!fr->bitrate_index){
250 // fprintf(stderr,"Free format not supported.\n");
251 return FALSE;
254 switch(fr->lay){
255 case 2:
256 MP3_bitrate=tabsel_123[fr->lsf][1][fr->bitrate_index];
257 MP3_samplerate=freqs[fr->sampling_frequency];
258 fr->framesize = MP3_bitrate * 144000;
259 fr->framesize /= MP3_samplerate;
260 MP3_framesize=fr->framesize;
261 fr->framesize += fr->padding - 4;
262 break;
263 case 3:
264 if(fr->lsf)
265 ssize = (fr->stereo == 1) ? 9 : 17;
266 else
267 ssize = (fr->stereo == 1) ? 17 : 32;
268 if(fr->error_protection) ssize += 2;
270 MP3_bitrate=tabsel_123[fr->lsf][2][fr->bitrate_index];
271 MP3_samplerate=freqs[fr->sampling_frequency];
272 fr->framesize = MP3_bitrate * 144000;
273 fr->framesize /= MP3_samplerate<<(fr->lsf);
274 MP3_framesize=fr->framesize;
275 fr->framesize += fr->padding - 4;
276 break;
277 case 1:
278 // fr->jsbound = (fr->mode == MPG_MD_JOINT_STEREO) ? (fr->mode_ext<<2)+4 : 32;
279 MP3_bitrate=tabsel_123[fr->lsf][0][fr->bitrate_index];
280 MP3_samplerate=freqs[fr->sampling_frequency];
281 fr->framesize = MP3_bitrate * 12000;
282 fr->framesize /= MP3_samplerate;
283 MP3_framesize = ((fr->framesize+fr->padding)<<2);
284 fr->framesize = MP3_framesize-4;
285 // printf("framesize=%d\n",fr->framesize);
286 break;
287 default:
288 MP3_framesize=fr->framesize=0;
289 // fprintf(stderr,"Sorry, unsupported layer type.\n");
290 return 0;
292 if(fr->framesize<=0 || fr->framesize>MAXFRAMESIZE) return FALSE;
294 return 1;
298 LOCAL int stream_read_frame_body(int size){
300 /* flip/init buffer for Layer 3 */
301 bsbufold = bsbuf;
302 bsbuf = bsspace[bsnum]+512;
303 bsnum = (bsnum + 1) & 1;
305 if( mp3_read(bsbuf,size) != size) return 0; // broken frame
307 bitindex = 0;
308 wordpointer = (unsigned char *) bsbuf;
309 bitsleft=8*size;
311 return 1;
315 /*****************************************************************
316 * read next frame return number of frames read.
318 LOCAL int read_frame(struct frame *fr){
319 uint32_t newhead;
320 union {
321 unsigned char buf[8];
322 unsigned long dummy; // for alignment
323 } hbuf;
324 int skipped,resyncpos;
325 int frames=0;
327 resync:
328 skipped=MP3_fpos;
329 resyncpos=MP3_fpos;
331 set_pointer(512);
332 fsizeold=fr->framesize; /* for Layer3 */
333 if(!stream_head_read(hbuf.buf,&newhead)) return 0;
334 if(!decode_header(fr,newhead)){
335 // invalid header! try to resync stream!
336 #ifdef DEBUG_RESYNC
337 printf("ReSync: searching for a valid header... (pos=%X)\n",MP3_fpos);
338 #endif
339 retry1:
340 while(!decode_header(fr,newhead)){
341 if(!stream_head_shift(hbuf.buf,&newhead)) return 0;
343 resyncpos=MP3_fpos-4;
344 // found valid header
345 #ifdef DEBUG_RESYNC
346 printf("ReSync: found valid hdr at %X fsize=%ld ",resyncpos,fr->framesize);
347 #endif
348 if(!stream_read_frame_body(fr->framesize)) return 0; // read body
349 set_pointer(512);
350 fsizeold=fr->framesize; /* for Layer3 */
351 if(!stream_head_read(hbuf.buf,&newhead)) return 0;
352 if(!decode_header(fr,newhead)){
353 // invalid hdr! go back...
354 #ifdef DEBUG_RESYNC
355 printf("INVALID\n");
356 #endif
357 // mp3_seek(resyncpos+1);
358 if(!stream_head_read(hbuf.buf,&newhead)) return 0;
359 goto retry1;
361 #ifdef DEBUG_RESYNC
362 printf("OK!\n");
363 ++frames;
364 #endif
367 skipped=resyncpos-skipped;
368 // if(skipped && !MP3_resync) printf("\r%d bad bytes skipped (resync at 0x%X) \n",skipped,resyncpos);
370 // 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":"");
372 /* read main data into memory */
373 if(!stream_read_frame_body(fr->framesize)){
374 printf("\nBroken frame at 0x%X \n",resyncpos);
375 return 0;
377 ++frames;
379 if(MP3_resync){
380 MP3_resync=0;
381 if(frames==1) goto resync;
384 return frames;
387 static int _has_mmx = 0; // used by layer2.c, layer3.c to pre-scale coeffs
389 /******************************************************************************/
390 /* PUBLIC FUNCTIONS */
391 /******************************************************************************/
393 /* It's hidden from gcc in assembler */
394 extern void dct64_MMX(short *, short *, real *);
395 extern void dct64_MMX_3dnow(short *, short *, real *);
396 extern void dct64_MMX_3dnowex(short *, short *, real *);
397 extern void dct64_sse(short *, short *, real *);
398 extern void dct64_altivec(real *, real *, real *);
399 void (*dct64_MMX_func)(short *, short *, real *);
401 #include "layer2.c"
402 #include "layer3.c"
403 #include "layer1.c"
405 #include "cpudetect.h"
407 // Init decoder tables. Call first, once!
408 #ifdef USE_FAKE_MONO
409 void MP3_Init(int fakemono){
410 #else
411 void MP3_Init(){
412 #endif
414 //gCpuCaps.hasMMX=gCpuCaps.hasMMX2=gCpuCaps.hasSSE=0; // for testing!
416 _has_mmx = 0;
417 dct36_func = dct36;
419 make_decode_tables(outscale);
421 #ifdef HAVE_MMX
422 if (gCpuCaps.hasMMX)
424 _has_mmx = 1;
425 synth_func = synth_1to1_MMX;
427 #endif
429 #ifdef HAVE_3DNOWEX
430 if (gCpuCaps.has3DNowExt)
432 dct36_func=dct36_3dnowex;
433 dct64_MMX_func= dct64_MMX_3dnowex;
434 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using 3DNow!Ex optimized decore!\n");
436 else
437 #endif
438 #ifdef HAVE_3DNOW
439 if (gCpuCaps.has3DNow)
441 dct36_func = dct36_3dnow;
442 dct64_MMX_func = dct64_MMX_3dnow;
443 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using 3DNow! optimized decore!\n");
445 else
446 #endif
447 #ifdef HAVE_SSE
448 if (gCpuCaps.hasSSE)
450 dct64_MMX_func = dct64_sse;
451 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using SSE optimized decore!\n");
453 else
454 #endif
455 #ifdef ARCH_X86_32
456 #ifdef HAVE_MMX
457 if (gCpuCaps.hasMMX)
459 dct64_MMX_func = dct64_MMX;
460 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using MMX optimized decore!\n");
462 else
463 #endif
464 if (gCpuCaps.cpuType >= CPUTYPE_I586)
466 synth_func = synth_1to1_pent;
467 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using Pentium optimized decore!\n");
469 else
470 #endif /* ARCH_X86_32 */
471 #ifdef HAVE_ALTIVEC
472 if (gCpuCaps.hasAltiVec)
474 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using AltiVec optimized decore!\n");
476 else
477 #endif
479 synth_func = NULL; /* use default c version */
480 mp_msg(MSGT_DECAUDIO,MSGL_V,"mp3lib: using generic C decore!\n");
483 #ifdef USE_FAKE_MONO
484 if (fakemono == 1)
485 fr.synth=synth_1to1_l;
486 else if (fakemono == 2)
487 fr.synth=synth_1to1_r;
488 else
489 fr.synth=synth_1to1;
490 #else
491 fr.synth=synth_1to1;
492 #endif
493 fr.synth_mono=synth_1to1_mono2stereo;
494 fr.down_sample=0;
495 fr.down_sample_sblimit = SBLIMIT>>(fr.down_sample);
497 init_layer2();
498 init_layer3(fr.down_sample_sblimit);
499 mp_msg(MSGT_DECAUDIO,MSGL_V,"MP3lib: init layer2&3 finished, tables done\n");
502 #if 0
504 void MP3_Close(){
505 MP3_eof=1;
506 if(mp3_file) fclose(mp3_file);
507 mp3_file=NULL;
510 // Open a file, init buffers. Call once per file!
511 int MP3_Open(char *filename,int buffsize){
512 MP3_eof=1; // lock decoding
513 MP3_pause=1; // lock playing
514 if(mp3_file) MP3_Close(); // close prev. file
515 MP3_frames=0;
517 mp3_file=fopen(filename,"rb");
518 // printf("MP3_Open: file='%s'",filename);
519 // if(!mp3_file){ printf(" not found!\n"); return 0;} else printf("Ok!\n");
520 if(!mp3_file) return 0;
522 MP3_filesize=MP3_PrintTAG();
523 fseek(mp3_file,0,SEEK_SET);
525 MP3_InitBuffers(buffsize);
526 if(!tables_done_flag) MP3_Init();
527 MP3_eof=0; // allow decoding
528 MP3_pause=0; // allow playing
529 return MP3_filesize;
532 #endif
534 // Read & decode a single frame. Called by sound driver.
535 int MP3_DecodeFrame(unsigned char *hova,short single){
536 pcm_sample = hova;
537 pcm_point = 0;
538 if(!read_frame(&fr))return(0);
539 if(single==-2){ set_pointer(512); return(1); }
540 if(fr.error_protection) getbits(16); /* skip crc */
541 fr.single=single;
542 switch(fr.lay){
543 case 2: do_layer2(&fr,single);break;
544 case 3: do_layer3(&fr,single);break;
545 case 1: do_layer1(&fr,single);break;
546 default:
547 return 0; // unsupported
549 // ++MP3_frames;
550 return(pcm_point?pcm_point:2);
553 // Prints last frame header in ascii.
554 void MP3_PrintHeader(void){
555 static char *modes[4] = { "Stereo", "Joint-Stereo", "Dual-Channel", "Single-Channel" };
556 static char *layers[4] = { "???" , "I", "II", "III" };
558 mp_msg(MSGT_DECAUDIO,MSGL_V,"\rMPEG %s, Layer %s, %d Hz %d kbit %s, BPF: %d\n",
559 fr.mpeg25 ? "2.5" : (fr.lsf ? "2.0" : "1.0"),
560 layers[fr.lay],freqs[fr.sampling_frequency],
561 tabsel_123[fr.lsf][fr.lay-1][fr.bitrate_index],
562 modes[fr.mode],fr.framesize+4);
563 mp_msg(MSGT_DECAUDIO,MSGL_V,"Channels: %d, copyright: %s, original: %s, CRC: %s, emphasis: %d\n",
564 fr.stereo,fr.copyright?"Yes":"No",
565 fr.original?"Yes":"No",fr.error_protection?"Yes":"No",
566 fr.emphasis);
569 #if 0
570 #include "genre.h"
572 // Read & print ID3 TAG. Do not call when playing!!! returns filesize.
573 int MP3_PrintTAG(){
574 struct id3tag {
575 char tag[3];
576 char title[30];
577 char artist[30];
578 char album[30];
579 char year[4];
580 char comment[30];
581 unsigned char genre;
583 struct id3tag tag;
584 char title[31]={0,};
585 char artist[31]={0,};
586 char album[31]={0,};
587 char year[5]={0,};
588 char comment[31]={0,};
589 char genre[31]={0,};
590 int fsize;
591 int ret;
593 fseek(mp3_file,0,SEEK_END);
594 fsize=ftell(mp3_file);
595 if(fseek(mp3_file,-128,SEEK_END)) return fsize;
596 ret=fread(&tag,128,1,mp3_file);
597 if(ret!=1 || tag.tag[0]!='T' || tag.tag[1]!='A' || tag.tag[2]!='G') return fsize;
599 strncpy(title,tag.title,30);
600 strncpy(artist,tag.artist,30);
601 strncpy(album,tag.album,30);
602 strncpy(year,tag.year,4);
603 strncpy(comment,tag.comment,30);
605 if ( tag.genre <= sizeof(genre_table)/sizeof(*genre_table) ) {
606 strncpy(genre, genre_table[tag.genre], 30);
607 } else {
608 strncpy(genre,"Unknown",30);
611 // printf("\n");
612 printf("Title : %30s Artist: %s\n",title,artist);
613 printf("Album : %30s Year : %4s\n",album,year);
614 printf("Comment: %30s Genre : %s\n",comment,genre);
615 printf("\n");
616 return fsize-128;
619 #endif