Mercurial > mplayer.hg
annotate mp3lib/sr1.c @ 732:e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
author | arpi_esp |
---|---|
date | Tue, 08 May 2001 21:49:00 +0000 |
parents | 4b18920568e2 |
children | 7fc213046812 |
rev | line source |
---|---|
1 | 1 // #define NEWBUFFERING |
2 //#define DEBUG_RESYNC | |
3 | |
4 /* 1 frame = 4608 byte PCM */ | |
5 | |
6 #ifdef __GNUC__ | |
7 #define LOCAL static inline | |
8 #else | |
9 #define LOCAL static _inline | |
10 #endif | |
11 | |
12 //#undef LOCAL | |
13 //#define LOCAL | |
14 | |
15 #include <stdlib.h> | |
16 #include <stdio.h> | |
17 #include <string.h> | |
18 #include <signal.h> | |
19 #include <math.h> | |
20 | |
21 #define real float | |
22 // #define int long | |
23 | |
24 #include "mpg123.h" | |
25 #include "huffman.h" | |
26 #include "mp3.h" | |
27 | |
28 #include "d_cpu.h" | |
29 | |
30 //static FILE* mp3_file=NULL; | |
31 | |
32 int MP3_frames=0; | |
33 int MP3_eof=0; | |
34 int MP3_pause=0; | |
35 int MP3_filesize=0; | |
36 int MP3_fpos=0; // current file position | |
37 int MP3_framesize=0; // current framesize | |
38 int MP3_bitrate=0; // current bitrate | |
39 int MP3_samplerate=0; // current samplerate | |
40 int MP3_resync=0; | |
41 int MP3_channels=0; | |
42 int MP3_bps=2; | |
43 | |
44 static long outscale = 32768; | |
45 #include "tabinit.c" | |
46 | |
47 extern int mplayer_audio_read(char *buf,int size); | |
48 | |
49 #if 1 | |
50 LOCAL int mp3_read(char *buf,int size){ | |
51 // int len=fread(buf,1,size,mp3_file); | |
52 int len=mplayer_audio_read(buf,size); | |
53 if(len>0) MP3_fpos+=len; | |
54 // if(len!=size) MP3_eof=1; | |
55 return len; | |
56 } | |
57 #else | |
58 extern int mp3_read(char *buf,int size); | |
59 #endif | |
60 | |
61 //void mp3_seek(int pos){ | |
62 // fseek(mp3_file,pos,SEEK_SET); | |
63 // return (MP3_fpos=ftell(mp3_file)); | |
64 //} | |
65 | |
66 /* Frame reader */ | |
67 | |
68 #define MAXFRAMESIZE 1280 | |
69 #define MAXFRAMESIZE2 (512+MAXFRAMESIZE) | |
70 | |
71 static int fsizeold=0,ssize=0; | |
72 static unsigned char bsspace[2][MAXFRAMESIZE2]; /* !!!!! */ | |
73 static unsigned char *bsbufold=bsspace[0]+512; | |
74 static unsigned char *bsbuf=bsspace[1]+512; | |
75 static int bsnum=0; | |
76 | |
77 static int bitindex; | |
78 static unsigned char *wordpointer; | |
79 static int bitsleft; | |
80 | |
81 unsigned char *pcm_sample; /* az outbuffer CIME */ | |
82 int pcm_point = 0; /* ez az outbuffer pozicioja */ | |
83 | |
84 static struct frame fr; | |
85 | |
86 static int tabsel_123[2][3][16] = { | |
87 { {0,32,64,96,128,160,192,224,256,288,320,352,384,416,448,}, | |
88 {0,32,48,56, 64, 80, 96,112,128,160,192,224,256,320,384,}, | |
89 {0,32,40,48, 56, 64, 80, 96,112,128,160,192,224,256,320,} }, | |
90 | |
91 { {0,32,48,56,64,80,96,112,128,144,160,176,192,224,256,}, | |
92 {0,8,16,24,32,40,48,56,64,80,96,112,128,144,160,}, | |
93 {0,8,16,24,32,40,48,56,64,80,96,112,128,144,160,} } | |
94 }; | |
95 | |
96 static long freqs[9] = { 44100, 48000, 32000, 22050, 24000, 16000 , 11025 , 12000 , 8000 }; | |
97 | |
98 LOCAL unsigned int getbits(short number_of_bits) | |
99 { | |
100 unsigned long rval; | |
101 // if(MP3_frames>=7741) printf("getbits: bits=%d bitsleft=%d wordptr=%x\n",number_of_bits,bitsleft,wordpointer); | |
102 if((bitsleft-=number_of_bits)<0) return 0; | |
103 if(!number_of_bits) return 0; | |
104 rval = wordpointer[0]; | |
105 rval <<= 8; | |
106 rval |= wordpointer[1]; | |
107 rval <<= 8; | |
108 rval |= wordpointer[2]; | |
109 rval <<= bitindex; | |
110 rval &= 0xffffff; | |
111 bitindex += number_of_bits; | |
112 rval >>= (24-number_of_bits); | |
113 wordpointer += (bitindex>>3); | |
114 bitindex &= 7; | |
115 return rval; | |
116 } | |
117 | |
118 | |
119 LOCAL unsigned int getbits_fast(short number_of_bits) | |
120 { | |
121 unsigned long rval; | |
122 // if(MP3_frames>=7741) printf("getbits_fast: bits=%d bitsleft=%d wordptr=%x\n",number_of_bits,bitsleft,wordpointer); | |
123 if((bitsleft-=number_of_bits)<0) return 0; | |
124 if(!number_of_bits) return 0; | |
125 rval = wordpointer[0]; | |
126 rval <<= 8; | |
127 rval |= wordpointer[1]; | |
128 rval <<= bitindex; | |
129 rval &= 0xffff; | |
130 bitindex += number_of_bits; | |
131 rval >>= (16-number_of_bits); | |
132 wordpointer += (bitindex>>3); | |
133 bitindex &= 7; | |
134 return rval; | |
135 } | |
136 | |
137 LOCAL unsigned int get1bit(void) | |
138 { | |
139 unsigned char rval; | |
140 // if(MP3_frames>=7741) printf("get1bit: bitsleft=%d wordptr=%x\n",bitsleft,wordpointer); | |
141 if((--bitsleft)<0) return 0; | |
142 rval = *wordpointer << bitindex; | |
143 bitindex++; | |
144 wordpointer += (bitindex>>3); | |
145 bitindex &= 7; | |
146 return ((rval>>7)&1); | |
147 } | |
148 | |
149 LOCAL void set_pointer(long backstep) | |
150 { | |
151 // if(backstep!=512 && backstep>fsizeold) | |
152 // printf("\rWarning! backstep (%d>%d) \n",backstep,fsizeold); | |
153 wordpointer = bsbuf + ssize - backstep; | |
154 if (backstep) memcpy(wordpointer,bsbufold+fsizeold-backstep,backstep); | |
155 bitindex = 0; | |
156 bitsleft+=8*backstep; | |
157 // printf("Backstep %d (bitsleft=%d)\n",backstep,bitsleft); | |
158 } | |
159 | |
160 LOCAL int stream_head_read(unsigned char *hbuf,unsigned long *newhead){ | |
161 if(mp3_read(hbuf,4) != 4) return FALSE; | |
162 *newhead = ((unsigned long) hbuf[0] << 24) | | |
163 ((unsigned long) hbuf[1] << 16) | | |
164 ((unsigned long) hbuf[2] << 8) | | |
165 (unsigned long) hbuf[3]; | |
166 return TRUE; | |
167 } | |
168 | |
169 LOCAL int stream_head_shift(unsigned char *hbuf,unsigned long *head){ | |
170 memmove (&hbuf[0], &hbuf[1], 3); | |
171 if(mp3_read(hbuf+3,1) != 1) return 0; | |
172 *head <<= 8; | |
173 *head |= hbuf[3]; | |
174 *head &= 0xffffffff; | |
175 return 1; | |
176 } | |
177 | |
178 /* | |
179 * decode a header and write the information | |
180 * into the frame structure | |
181 */ | |
182 LOCAL int decode_header(struct frame *fr,unsigned long newhead){ | |
183 | |
184 // head_check: | |
185 if( (newhead & 0xffe00000) != 0xffe00000) return FALSE; | |
186 if( ((newhead>>12)&0xf) == 0xf) return FALSE; | |
187 if( ((newhead>>10)&0x3) == 0x3 ) return FALSE; | |
188 | |
189 fr->lay = 4-((newhead>>17)&3); | |
190 // if(fr->lay!=3) return FALSE; | |
191 | |
192 if( newhead & ((long)1<<20) ) { | |
193 fr->lsf = (newhead & ((long)1<<19)) ? 0x0 : 0x1; | |
194 fr->mpeg25 = 0; | |
195 } else { | |
196 fr->lsf = 1; | |
197 fr->mpeg25 = 1; | |
198 } | |
199 | |
200 if(fr->mpeg25) | |
201 fr->sampling_frequency = 6 + ((newhead>>10)&0x3); | |
202 else | |
203 fr->sampling_frequency = ((newhead>>10)&0x3) + (fr->lsf*3); | |
204 | |
205 fr->error_protection = ((newhead>>16)&0x1)^0x1; | |
206 fr->bitrate_index = ((newhead>>12)&0xf); | |
207 fr->padding = ((newhead>>9)&0x1); | |
208 fr->extension = ((newhead>>8)&0x1); | |
209 fr->mode = ((newhead>>6)&0x3); | |
210 fr->mode_ext = ((newhead>>4)&0x3); | |
211 fr->copyright = ((newhead>>3)&0x1); | |
212 fr->original = ((newhead>>2)&0x1); | |
213 fr->emphasis = newhead & 0x3; | |
214 | |
215 MP3_channels = fr->stereo = (fr->mode == MPG_MD_MONO) ? 1 : 2; | |
216 | |
217 if(!fr->bitrate_index){ | |
218 // fprintf(stderr,"Free format not supported.\n"); | |
219 return FALSE; | |
220 } | |
221 | |
222 switch(fr->lay){ | |
223 case 2: | |
224 MP3_bitrate=tabsel_123[fr->lsf][1][fr->bitrate_index]; | |
225 MP3_samplerate=freqs[fr->sampling_frequency]; | |
226 fr->framesize = (long) MP3_bitrate * 144000; | |
227 fr->framesize /= MP3_samplerate; | |
228 MP3_framesize=fr->framesize; | |
229 fr->framesize += fr->padding - 4; | |
230 break; | |
231 case 3: | |
232 if(fr->lsf) | |
233 ssize = (fr->stereo == 1) ? 9 : 17; | |
234 else | |
235 ssize = (fr->stereo == 1) ? 17 : 32; | |
236 if(fr->error_protection) ssize += 2; | |
237 | |
238 MP3_bitrate=tabsel_123[fr->lsf][2][fr->bitrate_index]; | |
239 MP3_samplerate=freqs[fr->sampling_frequency]; | |
240 fr->framesize = (long) MP3_bitrate * 144000; | |
241 fr->framesize /= MP3_samplerate<<(fr->lsf); | |
242 MP3_framesize=fr->framesize; | |
243 fr->framesize += fr->padding - 4; | |
244 break; | |
245 default: | |
246 // fprintf(stderr,"Sorry, unsupported layer type.\n"); | |
247 return 0; | |
248 } | |
249 if(fr->framesize<=0 || fr->framesize>MAXFRAMESIZE) return FALSE; | |
250 | |
251 return 1; | |
252 } | |
253 | |
254 | |
255 LOCAL int stream_read_frame_body(int size){ | |
256 | |
257 /* flip/init buffer for Layer 3 */ | |
258 bsbufold = bsbuf; | |
259 bsbuf = bsspace[bsnum]+512; | |
260 bsnum = (bsnum + 1) & 1; | |
261 | |
262 if( mp3_read(bsbuf,size) != size) return 0; // broken frame | |
263 | |
264 bitindex = 0; | |
265 wordpointer = (unsigned char *) bsbuf; | |
266 bitsleft=8*size; | |
267 | |
268 return 1; | |
269 } | |
270 | |
271 | |
272 /***************************************************************** | |
273 * read next frame return number of frames read. | |
274 */ | |
275 LOCAL int read_frame(struct frame *fr){ | |
276 unsigned long newhead; | |
277 unsigned char hbuf[8]; | |
278 int skipped,resyncpos; | |
279 int frames=0; | |
280 | |
281 resync: | |
282 skipped=MP3_fpos; | |
283 resyncpos=MP3_fpos; | |
284 | |
285 set_pointer(512); | |
286 fsizeold=fr->framesize; /* for Layer3 */ | |
287 if(!stream_head_read(hbuf,&newhead)) return 0; | |
288 if(!decode_header(fr,newhead)){ | |
289 // invalid header! try to resync stream! | |
290 #ifdef DEBUG_RESYNC | |
291 printf("ReSync: searching for a valid header... (pos=%X)\n",MP3_fpos); | |
292 #endif | |
293 retry1: | |
294 while(!decode_header(fr,newhead)){ | |
295 if(!stream_head_shift(hbuf,&newhead)) return 0; | |
296 } | |
297 resyncpos=MP3_fpos-4; | |
298 // found valid header | |
299 #ifdef DEBUG_RESYNC | |
300 printf("ReSync: found valid hdr at %X fsize=%ld ",resyncpos,fr->framesize); | |
301 #endif | |
302 if(!stream_read_frame_body(fr->framesize)) return 0; // read body | |
303 set_pointer(512); | |
304 fsizeold=fr->framesize; /* for Layer3 */ | |
305 if(!stream_head_read(hbuf,&newhead)) return 0; | |
306 if(!decode_header(fr,newhead)){ | |
307 // invalid hdr! go back... | |
308 #ifdef DEBUG_RESYNC | |
309 printf("INVALID\n"); | |
310 #endif | |
311 // mp3_seek(resyncpos+1); | |
312 if(!stream_head_read(hbuf,&newhead)) return 0; | |
313 goto retry1; | |
314 } | |
315 #ifdef DEBUG_RESYNC | |
316 printf("OK!\n"); | |
317 ++frames; | |
318 #endif | |
319 } | |
320 | |
321 skipped=resyncpos-skipped; | |
322 // if(skipped && !MP3_resync) printf("\r%d bad bytes skipped (resync at 0x%X) \n",skipped,resyncpos); | |
323 | |
324 // 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":""); | |
325 | |
326 /* read main data into memory */ | |
327 if(!stream_read_frame_body(fr->framesize)){ | |
328 printf("\nBroken frame at 0x%X \n",resyncpos); | |
329 return 0; | |
330 } | |
331 ++frames; | |
332 | |
333 if(MP3_resync){ | |
334 MP3_resync=0; | |
335 if(frames==1) goto resync; | |
336 } | |
337 | |
338 return frames; | |
339 } | |
340 | |
341 #include "layer2.c" | |
342 #include "layer3.c" | |
343 | |
344 /******************************************************************************/ | |
345 /* PUBLIC FUNCTIONS */ | |
346 /******************************************************************************/ | |
347 | |
348 static int tables_done_flag=0; | |
349 | |
350 // Init decoder tables. Call first, once! | |
732
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
351 #ifdef USE_FAKE_MONO |
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
352 void MP3_Init(int fakemono){ |
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
353 #else |
1 | 354 void MP3_Init(){ |
732
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
355 #endif |
1 | 356 _CpuID=CpuDetect(); |
357 _i586=ipentium(); | |
358 #ifdef HAVE_3DNOW | |
359 _3dnow=a3dnow(); | |
360 #endif | |
361 | |
362 printf( "mp3lib: Processor ID: %x\n",_CpuID ); | |
363 printf( "mp3lib: i586 processor %sdetected.\n",(_i586?"":"not ") ); | |
364 #ifdef HAVE_3DNOW | |
73 | 365 printf( "mp3lib: AMD 3dnow! extension %sdetected.\n",(_3dnow?"":"not ") ); |
1 | 366 #endif |
367 | |
368 make_decode_tables(outscale); | |
732
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
369 #ifdef USE_FAKE_MONO |
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
370 if (fakemono == 1) |
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
371 fr.synth=synth_1to1_l; |
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
372 else if (fakemono == 2) |
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
373 fr.synth=synth_1to1_r; |
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
374 else |
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
375 fr.synth=synth_1to1; |
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
376 #else |
1 | 377 fr.synth=synth_1to1; |
732
e14114170e01
applied 'fakemono' patch by Bryan Chan scorpio@acm.org
arpi_esp
parents:
73
diff
changeset
|
378 #endif |
1 | 379 fr.synth_mono=synth_1to1_mono2stereo; |
380 fr.down_sample=0; | |
381 fr.down_sample_sblimit = SBLIMIT>>(fr.down_sample); | |
382 init_layer2(); | |
383 init_layer3(fr.down_sample_sblimit); | |
384 tables_done_flag=1; | |
385 } | |
386 | |
387 #if 0 | |
388 | |
389 void MP3_Close(){ | |
390 MP3_eof=1; | |
391 if(mp3_file) fclose(mp3_file); | |
392 mp3_file=NULL; | |
393 } | |
394 | |
395 // Open a file, init buffers. Call once per file! | |
396 int MP3_Open(char *filename,int buffsize){ | |
397 MP3_eof=1; // lock decoding | |
398 MP3_pause=1; // lock playing | |
399 if(mp3_file) MP3_Close(); // close prev. file | |
400 MP3_frames=0; | |
401 | |
402 mp3_file=fopen(filename,"rb"); | |
403 // printf("MP3_Open: file='%s'",filename); | |
404 // if(!mp3_file){ printf(" not found!\n"); return 0;} else printf("Ok!\n"); | |
405 if(!mp3_file) return 0; | |
406 | |
407 MP3_filesize=MP3_PrintTAG(); | |
408 fseek(mp3_file,0,SEEK_SET); | |
409 | |
410 MP3_InitBuffers(buffsize); | |
411 if(!tables_done_flag) MP3_Init(); | |
412 MP3_eof=0; // allow decoding | |
413 MP3_pause=0; // allow playing | |
414 return MP3_filesize; | |
415 } | |
416 | |
417 #endif | |
418 | |
419 // Read & decode a single frame. Called by sound driver. | |
420 int MP3_DecodeFrame(unsigned char *hova,short single){ | |
421 pcm_sample = hova; | |
422 pcm_point = 0; | |
423 if(!read_frame(&fr))return(0); | |
424 if(single==-2){ set_pointer(512); return(1); } | |
425 if(fr.error_protection) getbits(16); /* skip crc */ | |
426 fr.single=single; | |
427 switch(fr.lay){ | |
428 case 2: do_layer2(&fr,single);break; | |
429 case 3: do_layer3(&fr,single);break; | |
430 } | |
431 // ++MP3_frames; | |
432 return(pcm_point?pcm_point:2); | |
433 } | |
434 | |
435 #if 0 | |
436 | |
437 // Prints last frame header in ascii. | |
438 void MP3_PrintHeader(){ | |
439 static char *modes[4] = { "Stereo", "Joint-Stereo", "Dual-Channel", "Single-Channel" }; | |
440 static char *layers[4] = { "???" , "I", "II", "III" }; | |
441 | |
442 printf("\rMPEG %s, Layer %s, %ld Hz %d kbit %s, BPF : %ld\n", | |
443 fr.mpeg25 ? "2.5" : (fr.lsf ? "2.0" : "1.0"), | |
444 layers[fr.lay],freqs[fr.sampling_frequency], | |
445 tabsel_123[fr.lsf][fr.lay-1][fr.bitrate_index], | |
446 modes[fr.mode],fr.framesize+4); | |
447 printf("Channels: %d, copyright: %s, original: %s, CRC: %s, emphasis: %d.\n\n", | |
448 fr.stereo,fr.copyright?"Yes":"No", | |
449 fr.original?"Yes":"No",fr.error_protection?"Yes":"No", | |
450 fr.emphasis); | |
451 } | |
452 | |
453 #include "genre.h" | |
454 | |
455 // Read & print ID3 TAG. Do not call when playing!!! returns filesize. | |
456 int MP3_PrintTAG(){ | |
457 struct id3tag { | |
458 char tag[3]; | |
459 char title[30]; | |
460 char artist[30]; | |
461 char album[30]; | |
462 char year[4]; | |
463 char comment[30]; | |
464 unsigned char genre; | |
465 }; | |
466 struct id3tag tag; | |
467 char title[31]={0,}; | |
468 char artist[31]={0,}; | |
469 char album[31]={0,}; | |
470 char year[5]={0,}; | |
471 char comment[31]={0,}; | |
472 char genre[31]={0,}; | |
473 int fsize; | |
474 int ret; | |
475 | |
476 fseek(mp3_file,0,SEEK_END); | |
477 fsize=ftell(mp3_file); | |
478 if(fseek(mp3_file,-128,SEEK_END)) return fsize; | |
479 ret=fread(&tag,128,1,mp3_file); | |
480 if(ret!=1 || tag.tag[0]!='T' || tag.tag[1]!='A' || tag.tag[2]!='G') return fsize; | |
481 | |
482 strncpy(title,tag.title,30); | |
483 strncpy(artist,tag.artist,30); | |
484 strncpy(album,tag.album,30); | |
485 strncpy(year,tag.year,4); | |
486 strncpy(comment,tag.comment,30); | |
487 | |
488 if ( tag.genre <= sizeof(genre_table)/sizeof(*genre_table) ) { | |
489 strncpy(genre, genre_table[tag.genre], 30); | |
490 } else { | |
491 strncpy(genre,"Unknown",30); | |
492 } | |
493 | |
494 // printf("\n"); | |
495 printf("Title : %30s Artist: %s\n",title,artist); | |
496 printf("Album : %30s Year : %4s\n",album,year); | |
497 printf("Comment: %30s Genre : %s\n",comment,genre); | |
498 printf("\n"); | |
499 return fsize-128; | |
500 } | |
501 | |
502 #endif |