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!
|
|
351 void MP3_Init(){
|
|
352 _CpuID=CpuDetect();
|
|
353 _i586=ipentium();
|
|
354 #ifdef HAVE_3DNOW
|
|
355 _3dnow=a3dnow();
|
|
356 #endif
|
|
357
|
|
358 printf( "mp3lib: Processor ID: %x\n",_CpuID );
|
|
359 printf( "mp3lib: i586 processor %sdetected.\n",(_i586?"":"not ") );
|
|
360 #ifdef HAVE_3DNOW
|
73
|
361 printf( "mp3lib: AMD 3dnow! extension %sdetected.\n",(_3dnow?"":"not ") );
|
1
|
362 #endif
|
|
363
|
|
364 make_decode_tables(outscale);
|
|
365 fr.synth=synth_1to1;
|
|
366 fr.synth_mono=synth_1to1_mono2stereo;
|
|
367 fr.down_sample=0;
|
|
368 fr.down_sample_sblimit = SBLIMIT>>(fr.down_sample);
|
|
369 init_layer2();
|
|
370 init_layer3(fr.down_sample_sblimit);
|
|
371 tables_done_flag=1;
|
|
372 }
|
|
373
|
|
374 #if 0
|
|
375
|
|
376 void MP3_Close(){
|
|
377 MP3_eof=1;
|
|
378 if(mp3_file) fclose(mp3_file);
|
|
379 mp3_file=NULL;
|
|
380 }
|
|
381
|
|
382 // Open a file, init buffers. Call once per file!
|
|
383 int MP3_Open(char *filename,int buffsize){
|
|
384 MP3_eof=1; // lock decoding
|
|
385 MP3_pause=1; // lock playing
|
|
386 if(mp3_file) MP3_Close(); // close prev. file
|
|
387 MP3_frames=0;
|
|
388
|
|
389 mp3_file=fopen(filename,"rb");
|
|
390 // printf("MP3_Open: file='%s'",filename);
|
|
391 // if(!mp3_file){ printf(" not found!\n"); return 0;} else printf("Ok!\n");
|
|
392 if(!mp3_file) return 0;
|
|
393
|
|
394 MP3_filesize=MP3_PrintTAG();
|
|
395 fseek(mp3_file,0,SEEK_SET);
|
|
396
|
|
397 MP3_InitBuffers(buffsize);
|
|
398 if(!tables_done_flag) MP3_Init();
|
|
399 MP3_eof=0; // allow decoding
|
|
400 MP3_pause=0; // allow playing
|
|
401 return MP3_filesize;
|
|
402 }
|
|
403
|
|
404 #endif
|
|
405
|
|
406 // Read & decode a single frame. Called by sound driver.
|
|
407 int MP3_DecodeFrame(unsigned char *hova,short single){
|
|
408 pcm_sample = hova;
|
|
409 pcm_point = 0;
|
|
410 if(!read_frame(&fr))return(0);
|
|
411 if(single==-2){ set_pointer(512); return(1); }
|
|
412 if(fr.error_protection) getbits(16); /* skip crc */
|
|
413 fr.single=single;
|
|
414 switch(fr.lay){
|
|
415 case 2: do_layer2(&fr,single);break;
|
|
416 case 3: do_layer3(&fr,single);break;
|
|
417 }
|
|
418 // ++MP3_frames;
|
|
419 return(pcm_point?pcm_point:2);
|
|
420 }
|
|
421
|
|
422 #if 0
|
|
423
|
|
424 // Prints last frame header in ascii.
|
|
425 void MP3_PrintHeader(){
|
|
426 static char *modes[4] = { "Stereo", "Joint-Stereo", "Dual-Channel", "Single-Channel" };
|
|
427 static char *layers[4] = { "???" , "I", "II", "III" };
|
|
428
|
|
429 printf("\rMPEG %s, Layer %s, %ld Hz %d kbit %s, BPF : %ld\n",
|
|
430 fr.mpeg25 ? "2.5" : (fr.lsf ? "2.0" : "1.0"),
|
|
431 layers[fr.lay],freqs[fr.sampling_frequency],
|
|
432 tabsel_123[fr.lsf][fr.lay-1][fr.bitrate_index],
|
|
433 modes[fr.mode],fr.framesize+4);
|
|
434 printf("Channels: %d, copyright: %s, original: %s, CRC: %s, emphasis: %d.\n\n",
|
|
435 fr.stereo,fr.copyright?"Yes":"No",
|
|
436 fr.original?"Yes":"No",fr.error_protection?"Yes":"No",
|
|
437 fr.emphasis);
|
|
438 }
|
|
439
|
|
440 #include "genre.h"
|
|
441
|
|
442 // Read & print ID3 TAG. Do not call when playing!!! returns filesize.
|
|
443 int MP3_PrintTAG(){
|
|
444 struct id3tag {
|
|
445 char tag[3];
|
|
446 char title[30];
|
|
447 char artist[30];
|
|
448 char album[30];
|
|
449 char year[4];
|
|
450 char comment[30];
|
|
451 unsigned char genre;
|
|
452 };
|
|
453 struct id3tag tag;
|
|
454 char title[31]={0,};
|
|
455 char artist[31]={0,};
|
|
456 char album[31]={0,};
|
|
457 char year[5]={0,};
|
|
458 char comment[31]={0,};
|
|
459 char genre[31]={0,};
|
|
460 int fsize;
|
|
461 int ret;
|
|
462
|
|
463 fseek(mp3_file,0,SEEK_END);
|
|
464 fsize=ftell(mp3_file);
|
|
465 if(fseek(mp3_file,-128,SEEK_END)) return fsize;
|
|
466 ret=fread(&tag,128,1,mp3_file);
|
|
467 if(ret!=1 || tag.tag[0]!='T' || tag.tag[1]!='A' || tag.tag[2]!='G') return fsize;
|
|
468
|
|
469 strncpy(title,tag.title,30);
|
|
470 strncpy(artist,tag.artist,30);
|
|
471 strncpy(album,tag.album,30);
|
|
472 strncpy(year,tag.year,4);
|
|
473 strncpy(comment,tag.comment,30);
|
|
474
|
|
475 if ( tag.genre <= sizeof(genre_table)/sizeof(*genre_table) ) {
|
|
476 strncpy(genre, genre_table[tag.genre], 30);
|
|
477 } else {
|
|
478 strncpy(genre,"Unknown",30);
|
|
479 }
|
|
480
|
|
481 // printf("\n");
|
|
482 printf("Title : %30s Artist: %s\n",title,artist);
|
|
483 printf("Album : %30s Year : %4s\n",album,year);
|
|
484 printf("Comment: %30s Genre : %s\n",comment,genre);
|
|
485 printf("\n");
|
|
486 return fsize-128;
|
|
487 }
|
|
488
|
|
489 #endif
|