#include #include #include #include #include #include #include #include #include "mpg123.h" #include "mpglib.h" struct parameter param = { 1 , 1 , 0 , 0 }; 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,} } }; long freqs[9] = { 44100, 48000, 32000, 22050, 24000, 16000 , 11025 , 12000 , 8000 }; #if 0 static void get_II_stuff(struct frame *fr) { static int translate[3][2][16] = { { { 0,2,2,2,2,2,2,0,0,0,1,1,1,1,1,0 } , { 0,2,2,0,0,0,1,1,1,1,1,1,1,1,1,0 } } , { { 0,2,2,2,2,2,2,0,0,0,0,0,0,0,0,0 } , { 0,2,2,0,0,0,0,0,0,0,0,0,0,0,0,0 } } , { { 0,3,3,3,3,3,3,0,0,0,1,1,1,1,1,0 } , { 0,3,3,0,0,0,1,1,1,1,1,1,1,1,1,0 } } }; int table,sblim; static struct al_table *tables[5] = { alloc_0, alloc_1, alloc_2, alloc_3 , alloc_4 }; static int sblims[5] = { 27 , 30 , 8, 12 , 30 }; if(fr->lsf) table = 4; else table = translate[fr->sampling_frequency][2-fr->stereo][fr->bitrate_index]; sblim = sblims[table]; fr->alloc = tables[table]; fr->II_sblimit = sblim; } #endif #define HDRCMPMASK 0xfffffd00 #if 0 int head_check(unsigned long head) { if( (head & 0xffe00000) != 0xffe00000) return FALSE; if(!((head>>17)&3)) return FALSE; if( ((head>>12)&0xf) == 0xf) return FALSE; if( ((head>>10)&0x3) == 0x3 ) return FALSE; return TRUE; } #endif /* * the code a header and write the information * into the frame structure */ int decode_header(struct frame *fr,unsigned long newhead) { if( newhead & (1<<20) ) { fr->lsf = (newhead & (1<<19)) ? 0x0 : 0x1; fr->mpeg25 = 0; } else { fr->lsf = 1; fr->mpeg25 = 1; } fr->lay = 4-((newhead>>17)&3); if( ((newhead>>10)&0x3) == 0x3) { ast_log(LOG_WARNING,"Stream error\n"); return (0); } if(fr->mpeg25) { fr->sampling_frequency = 6 + ((newhead>>10)&0x3); } else fr->sampling_frequency = ((newhead>>10)&0x3) + (fr->lsf*3); fr->error_protection = ((newhead>>16)&0x1)^0x1; if(fr->mpeg25) /* allow Bitrate change for 2.5 ... */ fr->bitrate_index = ((newhead>>12)&0xf); 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; fr->stereo = (fr->mode == MPG_MD_MONO) ? 1 : 2; if(!fr->bitrate_index) { ast_log(LOG_WARNING,"Free format not supported.\n"); return (0); } switch(fr->lay) { case 1: #if 0 fr->do_layer = do_layer1; fr->jsbound = (fr->mode == MPG_MD_JOINT_STEREO) ? (fr->mode_ext<<2)+4 : 32; fr->framesize = (long) tabsel_123[fr->lsf][0][fr->bitrate_index] * 12000; fr->framesize /= freqs[fr->sampling_frequency]; fr->framesize = ((fr->framesize+fr->padding)<<2)-4; #else ast_log(LOG_WARNING,"Layer 1 not supported!\n"); #endif break; case 2: #if 0 fr->do_layer = do_layer2; get_II_stuff(fr); fr->jsbound = (fr->mode == MPG_MD_JOINT_STEREO) ? (fr->mode_ext<<2)+4 : fr->II_sblimit; fr->framesize = (long) tabsel_123[fr->lsf][1][fr->bitrate_index] * 144000; fr->framesize /= freqs[fr->sampling_frequency]; fr->framesize += fr->padding - 4; #else ast_log(LOG_WARNING,"Layer 2 not supported!\n"); #endif break; case 3: #if 0 fr->do_layer = do_layer3; if(fr->lsf) ssize = (fr->stereo == 1) ? 9 : 17; else ssize = (fr->stereo == 1) ? 17 : 32; #endif #if 0 if(fr->error_protection) ssize += 2; #endif fr->framesize = (long) tabsel_123[fr->lsf][2][fr->bitrate_index] * 144000; fr->framesize /= freqs[fr->sampling_frequency]<<(fr->lsf); fr->framesize = fr->framesize + fr->padding - 4; break; default: ast_log(LOG_WARNING,"Sorry, unknown layer type.\n"); return (0); } return 1; } #if 0 void print_header(struct frame *fr) { static char *modes[4] = { "Stereo", "Joint-Stereo", "Dual-Channel", "Single-Channel" }; static char *layers[4] = { "Unknown" , "I", "II", "III" }; ast_log(LOG_WARNING,"MPEG %s, Layer: %s, Freq: %ld, mode: %s, modext: %d, BPF : %d\n", fr->mpeg25 ? "2.5" : (fr->lsf ? "2.0" : "1.0"), layers[fr->lay],freqs[fr->sampling_frequency], modes[fr->mode],fr->mode_ext,fr->framesize+4); ast_log(LOG_WARNING,"Channels: %d, copyright: %s, original: %s, CRC: %s, emphasis: %d.\n", fr->stereo,fr->copyright?"Yes":"No", fr->original?"Yes":"No",fr->error_protection?"Yes":"No", fr->emphasis); ast_log(LOG_WARNING,"Bitrate: %d Kbits/s, Extension value: %d\n", tabsel_123[fr->lsf][fr->lay-1][fr->bitrate_index],fr->extension); } void print_header_compact(struct frame *fr) { static char *modes[4] = { "stereo", "joint-stereo", "dual-channel", "mono" }; static char *layers[4] = { "Unknown" , "I", "II", "III" }; ast_log(LOG_WARNING,"MPEG %s layer %s, %d kbit/s, %ld Hz %s\n", fr->mpeg25 ? "2.5" : (fr->lsf ? "2.0" : "1.0"), layers[fr->lay], tabsel_123[fr->lsf][fr->lay-1][fr->bitrate_index], freqs[fr->sampling_frequency], modes[fr->mode]); } #endif unsigned int getbits(struct mpstr *mp, int number_of_bits) { unsigned long rval; if(!number_of_bits) return 0; { rval = (mp->worksample).wordpointer[0]; rval <<= 8; rval |= (mp->worksample).wordpointer[1]; rval <<= 8; rval |= (mp->worksample).wordpointer[2]; rval <<= (mp->worksample).bitindex; rval &= 0xffffff; (mp->worksample).bitindex += number_of_bits; rval >>= (24-number_of_bits); (mp->worksample).wordpointer += ((mp->worksample).bitindex>>3); (mp->worksample).bitindex &= 7; } return rval; } unsigned int getbits_fast(struct mpstr *mp, int number_of_bits) { unsigned long rval; { rval = (mp->worksample).wordpointer[0]; rval <<= 8; rval |= (mp->worksample).wordpointer[1]; rval <<= (mp->worksample).bitindex; rval &= 0xffff; (mp->worksample).bitindex += number_of_bits; rval >>= (16-number_of_bits); (mp->worksample).wordpointer += ((mp->worksample).bitindex>>3); (mp->worksample).bitindex &= 7; } return rval; } unsigned int get1bit(struct mpstr *mp) { unsigned char rval; rval = *((mp->worksample).wordpointer) << (mp->worksample).bitindex; (mp->worksample).bitindex++; (mp->worksample).wordpointer += ((mp->worksample).bitindex>>3); (mp->worksample).bitindex &= 7; return rval>>7; }