home *** CD-ROM | disk | FTP | other *** search
/ RISC DISC 2 / RISC_DISC_2.iso / resources / mpeg / mpegdec / audiompeg / !AudioMPEG_c_common < prev    next >
Encoding:
Text File  |  1995-05-14  |  30.3 KB  |  954 lines
  1. /**********************************************************************
  2. Copyright (c) 1991 MPEG/audio software simulation group, All Rights Reserved
  3. common.c
  4. **********************************************************************/
  5. /**********************************************************************
  6.  * MPEG/audio coding/decoding software, work in progress              *
  7.  *   NOT for public distribution until verified and approved by the   *
  8.  *   MPEG/audio committee.  For further information, please contact   *
  9.  *   Davis Pan, 508-493-2241, e-mail: pan@3d.enet.dec.com             *
  10.  *                                                                    *
  11.  * VERSION 4.0                                                        *
  12.  *   changes made since last update:                                  *
  13.  *   date   programmers         comment                               *
  14.  * 2/25/91  Doulas Wong,        start of version 1.0 records          *
  15.  *          Davis Pan                                                 *
  16.  * 5/10/91  W. Joseph Carter    Created this file for all common      *
  17.  *                              functions and global variables.       *
  18.  *                              Ported to Macintosh and Unix.         *
  19.  *                              Added Jean-Georges Fritsch's          *
  20.  *                              "bitstream.c" package.                *
  21.  *                              Added routines to handle AIFF PCM     *
  22.  *                              sound files.                          *
  23.  *                              Added "mem_alloc()" and "mem_free()"  *
  24.  *                              routines for memory allocation        *
  25.  *                              portability.                          *
  26.  *                              Added routines to convert between     *
  27.  *                              Apple SANE extended floating point    *
  28.  *                              format and IEEE double precision      *
  29.  *                              floating point format.  For AIFF.     *
  30.  * 02jul91 dpwe (Aware Inc)     Moved allocation table input here;    *
  31.  *                              Tables read from subdir TABLES_PATH.  *
  32.  *                              Added some debug printout fns (Write*)*
  33.  * 7/10/91 Earle Jennings       replacement of the one float by FLOAT *
  34.  *                              port to MsDos from MacIntosh version  *
  35.  * 8/ 5/91 Jean-Georges Fritsch fixed bug in open_bit_stream_r()      *
  36.  *10/ 1/91 S.I. Sudharsanan,    Ported to IBM AIX platform.           *
  37.  *         Don H. Lee,                                                *
  38.  *         Peter W. Farrett                                           *
  39.  *10/3/91  Don H. Lee           implemented CRC-16 error protection   *
  40.  *                              newly introduced functions are        *
  41.  *                              I_CRC_calc, II_CRC_calc and           *
  42.  *                              update_CRC. Additions and revisions   *
  43.  *                              are marked with dhl for clarity       *
  44.  *10/18/91 Jean-Georges Fritsch fixed bug in update_CRC(),            *
  45.  *                              II_CRC_calc() and I_CRC_calc()        *
  46.  * 2/11/92  W. Joseph Carter    Ported new code to Macintosh.  Most   *
  47.  *                              important fixes involved changing     *
  48.  *                              16-bit ints to long or unsigned in    *
  49.  *                              bit alloc routines for quant of 65535 *
  50.  *                              and passing proper function args.     *
  51.  *                              Removed "Other Joint Stereo" option   *
  52.  *                              and made bitrate be total channel     *
  53.  *                              bitrate, irrespective of the mode.    *
  54.  *                              Fixed many small bugs & reorganized.  *
  55.  * 3/20/92 Jean-Georges Fritsch  fixed bug in start-of-frame search   *
  56.  * 6/15/92 Juan Pineda          added refill_buffer(bs) "n"           *
  57.  *                              initialization                        *
  58.  * 7/08/92 Susanne Ritscher     MS-DOS, MSC6.0 port fixes             *
  59.  * 7/27/92 Mike Li               (re-)Port to MS-DOS                  *
  60.  * 8/19/92 Soren H. Nielsen     Fixed bug in I_CRC_calc and in        *
  61.  *                              II_CRC_calc.  Added function: new_ext *
  62.  *                              for better MS-DOS compatability       *
  63.  * 3/10/93 Kevin Peterson       changed aiff_read_headers to handle   *
  64.  *                              chunks in any order.  now returns     *
  65.  *                              position of sound data in file.       *
  66.  * 3/31/93 Jens Spille          changed IFF_* string compares to use  *
  67.  *                              strcmp()                              *
  68.  * 5/30/93 Masahiro Iwadare    ?? the previous modification does not *
  69.  *                  work. recovered to the original. ?? *
  70.  * 8/27/93 Seymour Shlien,      Fixes in Unix and MSDOS ports,        *
  71.  *         Daniel Lauzon, and                                         *
  72.  *         Bill Truerniet                                             *
  73.  **********************************************************************/
  74.  
  75. /***********************************************************************
  76. *
  77. *  Global Include Files
  78. *
  79. ***********************************************************************/
  80.  
  81. #include        "common.h"
  82.  
  83. #ifdef  MACINTOSH
  84.  
  85. #include        <SANE.h>
  86. #include        <pascal.h>
  87.  
  88. #endif
  89.  
  90. #include <ctype.h>
  91.  
  92. /***********************************************************************
  93. *
  94. *  Global Variable Definitions
  95. *
  96. ***********************************************************************/
  97.  
  98. char *mode_names[4] = { "stereo", "j-stereo", "dual-ch", "single-ch" };
  99. char *layer_names[3] = { "I", "II", "III" };
  100.  
  101. double  s_freq[4] = {44.1, 48, 32, 0};
  102.  
  103. int     bitrate[3][15] = {
  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}
  107.         };
  108.  
  109. double FAR multiple[64] = {
  110. 2.00000000000000, 1.58740105196820, 1.25992104989487,
  111. 1.00000000000000, 0.79370052598410, 0.62996052494744, 0.50000000000000,
  112. 0.39685026299205, 0.31498026247372, 0.25000000000000, 0.19842513149602,
  113. 0.15749013123686, 0.12500000000000, 0.09921256574801, 0.07874506561843,
  114. 0.06250000000000, 0.04960628287401, 0.03937253280921, 0.03125000000000,
  115. 0.02480314143700, 0.01968626640461, 0.01562500000000, 0.01240157071850,
  116. 0.00984313320230, 0.00781250000000, 0.00620078535925, 0.00492156660115,
  117. 0.00390625000000, 0.00310039267963, 0.00246078330058, 0.00195312500000,
  118. 0.00155019633981, 0.00123039165029, 0.00097656250000, 0.00077509816991,
  119. 0.00061519582514, 0.00048828125000, 0.00038754908495, 0.00030759791257,
  120. 0.00024414062500, 0.00019377454248, 0.00015379895629, 0.00012207031250,
  121. 0.00009688727124, 0.00007689947814, 0.00006103515625, 0.00004844363562,
  122. 0.00003844973907, 0.00003051757813, 0.00002422181781, 0.00001922486954,
  123. 0.00001525878906, 0.00001211090890, 0.00000961243477, 0.00000762939453,
  124. 0.00000605545445, 0.00000480621738, 0.00000381469727, 0.00000302772723,
  125. 0.00000240310869, 0.00000190734863, 0.00000151386361, 0.00000120155435,
  126. 1E-20
  127. };
  128.  
  129. /***********************************************************************
  130. *
  131. *  Global Function Definitions
  132. *
  133. ***********************************************************************/
  134.  
  135. /* The system uses a variety of data files.  By opening them via this
  136.    function, we can accommodate various locations. */
  137.  
  138. FILE *OpenTableFile(name)
  139. char *name;
  140. {
  141. char fulname[80];
  142. FILE *f;
  143.  
  144.     fulname[0] = '\0';
  145.  
  146.     strcat(fulname, "<AudioMPEG$Tables>.");
  147.     strcat(fulname, name);
  148.     if( (f=fopen(fulname,"r"))==NULL ) {
  149.         fprintf(stderr,"OpenTable: could not find %s\n", fulname);
  150.  
  151.     }
  152.     return f;
  153. }
  154.  
  155. /***********************************************************************
  156.  *
  157.  * Read one of the data files ("alloc_*") specifying the bit allocation/
  158.  * quatization parameters for each subband in layer II encoding
  159.  *
  160.  **********************************************************************/
  161.  
  162. int read_bit_alloc(table, alloc)        /* read in table, return # subbands */
  163. int table;
  164. al_table *alloc;
  165. {
  166.         unsigned int a, b, c, d, i, j;
  167.         FILE *fp;
  168.         char name[16], t[80];
  169.         int sblim;
  170.  
  171.         strcpy(name, "alloc_0");
  172.  
  173.         switch (table) {
  174.                 case 0 : name[6] = '0';         break;
  175.                 case 1 : name[6] = '1';         break;
  176.                 case 2 : name[6] = '2';         break;
  177.                 case 3 : name[6] = '3';         break;
  178.                 default : name[6] = '0';
  179.         }
  180.  
  181.         if (!(fp = OpenTableFile(name))) {
  182.                 printf("Please check bit allocation table %s\n", name);
  183.                 exit(1);
  184.         }
  185.  
  186.         fgets(t, 80, fp);
  187.         sscanf(t, "%d\n", &sblim);
  188.         while (!feof(fp)) {
  189.                 fgets(t, 80, fp);
  190.                 sscanf(t, "%d %d %d %d %d %d\n", &i, &j, &a, &b, &c, &d);
  191.                         (*alloc)[i][j].steps = a;
  192.                         (*alloc)[i][j].bits  = b;
  193.                         (*alloc)[i][j].group = c;
  194.                         (*alloc)[i][j].quant = d;
  195.         }
  196.         fclose(fp);
  197.         return sblim;
  198. }
  199.  
  200. /***********************************************************************
  201.  *
  202.  * Using the decoded info the appropriate possible quantization per
  203.  * subband table is loaded
  204.  *
  205.  **********************************************************************/
  206.  
  207. int pick_table(fr_ps)   /* choose table, load if necess, return # sb's */
  208. frame_params *fr_ps;
  209. {
  210.         int table, lay, ws, bsp, br_per_ch, sfrq;
  211.         int sblim = fr_ps->sblimit;     /* return current value if no load */
  212.  
  213.         lay = fr_ps->header->lay - 1;
  214.         bsp = fr_ps->header->bitrate_index;
  215.         br_per_ch = bitrate[lay][bsp] / fr_ps->stereo;
  216.         ws = fr_ps->header->sampling_frequency;
  217.         sfrq = s_freq[ws];
  218.         /* decision rules refer to per-channel bitrates (kbits/sec/chan) */
  219.         if ((sfrq == 48 && br_per_ch >= 56) ||
  220.             (br_per_ch >= 56 && br_per_ch <= 80)) table = 0;
  221.         else if (sfrq != 48 && br_per_ch >= 96) table = 1;
  222.         else if (sfrq != 32 && br_per_ch <= 48) table = 2;
  223.         else table = 3;
  224.         if (fr_ps->tab_num != table) {
  225.            if (fr_ps->tab_num >= 0)
  226.               mem_free((void **)&(fr_ps->alloc));
  227.            fr_ps->alloc = (al_table FAR *) mem_alloc(sizeof(al_table),
  228.                                                          "alloc");
  229.            sblim = read_bit_alloc(fr_ps->tab_num = table, fr_ps->alloc);
  230.         }
  231.         return sblim;
  232. }
  233.  
  234. int js_bound(lay, m_ext)
  235. int lay, m_ext;
  236. {
  237. static int jsb_table[3][4] =  { { 4, 8, 12, 16 }, { 4, 8, 12, 16},
  238.                                 { 0, 4, 8, 16} };  /* lay+m_e -> jsbound */
  239.  
  240.     if(lay<1 || lay >3 || m_ext<0 || m_ext>3) {
  241.         fprintf(stderr, "js_bound bad layer/modext (%d/%d)\n", lay, m_ext);
  242.         exit(1);
  243.     }
  244.     return(jsb_table[lay-1][m_ext]);
  245. }
  246.  
  247. void hdr_to_frps(fr_ps) /* interpret data in hdr str to fields in fr_ps */
  248. frame_params *fr_ps;
  249. {
  250. layer *hdr = fr_ps->header;     /* (or pass in as arg?) */
  251.  
  252.     fr_ps->actual_mode = hdr->mode;
  253.     fr_ps->stereo = (hdr->mode == MPG_MD_MONO) ? 1 : 2;
  254.     if (hdr->lay == 2)          fr_ps->sblimit = pick_table(fr_ps);
  255.     else                        fr_ps->sblimit = SBLIMIT;
  256.     if(hdr->mode == MPG_MD_JOINT_STEREO)
  257.         fr_ps->jsbound = js_bound(hdr->lay, hdr->mode_ext);
  258.     else
  259.         fr_ps->jsbound = fr_ps->sblimit;
  260.     /* alloc, tab_num set in pick_table */
  261. }
  262.  
  263.  
  264. int NumericQ(s) /* see if a string lookd like a numeric argument */
  265. char *s;
  266. {
  267. char    c;
  268.  
  269.     while( (c = *s++)!='\0' && isspace((int)c)) /* strip leading ws */
  270.         ;
  271.     if( c == '+' || c == '-' )
  272.         c = *s++;               /* perhaps skip leading + or - */
  273.     return isdigit((int)c);
  274. }
  275.  
  276. int BitrateIndex(layr, bRate)   /* convert bitrate in kbps to index */
  277. int     layr;           /* 1 or 2 */
  278. int     bRate;          /* legal rates from 32 to 448 */
  279. {
  280. int     index = 0;
  281. int     found = 0;
  282.  
  283.     while(!found && index<15)   {
  284.         if(bitrate[layr-1][index] == bRate)
  285.             found = 1;
  286.         else
  287.             ++index;
  288.     }
  289.     if(found)
  290.         return(index);
  291.     else {
  292.         fprintf(stderr, "BitrateIndex: %d (layer %d) is not a legal bitrate\n",
  293.                 bRate, layr);
  294.         return(-1);     /* Error! */
  295.     }
  296. }
  297.  
  298. int SmpFrqIndex(sRate)  /* convert samp frq in Hz to index */
  299. long sRate;             /* legal rates 32000, 44100, 48000 */
  300. {
  301.     if(sRate == 44100L)
  302.         return(0);
  303.     else if(sRate == 48000L)
  304.         return(1);
  305.     else if(sRate == 32000L)
  306.         return(2);
  307.     else {
  308.         fprintf(stderr, "SmpFrqIndex: %ld is not a legal sample rate\n", sRate);
  309.         return(-1);      /* Error! */
  310.     }
  311. }
  312.  
  313. /*******************************************************************************
  314. *
  315. *  Allocate number of bytes of memory equal to "block".
  316. *
  317. *******************************************************************************/
  318.  
  319. void  FAR *mem_alloc(block, item)
  320. unsigned long   block;
  321. char            *item;
  322. {
  323.  
  324.     void    *ptr;
  325.  
  326.     ptr = (void FAR *) malloc(block);
  327.  
  328.     if (ptr != NULL)
  329.     {
  330.       memset(ptr, 0, block);
  331.     }
  332.     else
  333.     {
  334.         printf("Unable to allocate %s\n", item);
  335.         exit(0);
  336.     }
  337.     return(ptr);
  338. }
  339.  
  340.  
  341. /****************************************************************************
  342. *
  343. *  Free memory pointed to by "*ptr_addr".
  344. *
  345. *****************************************************************************/
  346.  
  347. void    mem_free(ptr_addr)
  348. void    **ptr_addr;
  349. {
  350.  
  351.     if (*ptr_addr != NULL){
  352.         free(*ptr_addr);
  353.         *ptr_addr = NULL;
  354.     }
  355.  
  356. }
  357.  
  358. /*******************************************************************************
  359. *
  360. *  Check block of memory all equal to a single byte, else return FALSE
  361. *
  362. *******************************************************************************/
  363.  
  364. int memcheck(array, test, num)
  365. char *array;
  366. int test;       /* but only tested as a char (bottom 8 bits) */
  367. int num;
  368. {
  369.  int i=0;
  370.  
  371.    while (array[i] == test && i<num) i++;
  372.    if (i==num) return TRUE;
  373.    else return FALSE;
  374. }
  375.  
  376. /*****************************************************************************
  377. *
  378. *  bit_stream.c package
  379. *  Author:  Jean-Georges Fritsch, C-Cube Microsystems
  380. *
  381. *****************************************************************************/
  382.  
  383. /********************************************************************
  384.   This package provides functions to write (exclusive or read)
  385.   information from (exclusive or to) the bit stream.
  386.  
  387.   If the bit stream is opened in read mode only the get functions are
  388.   available. If the bit stream is opened in write mode only the put
  389.   functions are available.
  390. ********************************************************************/
  391.  
  392. /*open_bit_stream_w(); open the device to write the bit stream into it    */
  393. /*open_bit_stream_r(); open the device to read the bit stream from it     */
  394. /*close_bit_stream();  close the device containing the bit stream         */
  395. /*alloc_buffer();      open and initialize the buffer;                    */
  396. /*desalloc_buffer();   empty and close the buffer                         */
  397. /*back_track_buffer();     goes back N bits in the buffer                 */
  398. /*unsigned int get1bit();  read 1 bit from the bit stream                 */
  399. /*unsigned long getbits(); read N bits from the bit stream                */
  400. /*unsigned long byte_ali_getbits();   read the next byte aligned N bits from*/
  401. /*                                    the bit stream                        */
  402. /*unsigned long look_ahead(); grep the next N bits in the bit stream without*/
  403. /*                            changing the buffer pointer                   */
  404. /*put1bit(); write 1 bit from the bit stream  */
  405. /*put1bit(); write 1 bit from the bit stream  */
  406. /*putbits(); write N bits from the bit stream */
  407. /*byte_ali_putbits(); write byte aligned the next N bits into the bit stream*/
  408. /*unsigned long sstell(); return the current bit stream length (in bits)    */
  409. /*int end_bs(); return 1 if the end of bit stream reached otherwise 0       */
  410. /*int seek_sync(); return 1 if a sync word was found in the bit stream      */
  411. /*                 otherwise returns 0                                      */
  412.  
  413. /* refill the buffer from the input device when the buffer becomes empty    */
  414. int refill_buffer(bs)
  415. Bit_stream_struc *bs;   /* bit stream structure */
  416. {
  417.    register int i=bs->buf_size-2-bs->buf_byte_idx;
  418.    register unsigned long n=1;
  419.    register int index=0;
  420.    char val[2];
  421.  
  422.    while ((i>=0) && (!bs->eob)) {
  423.  
  424.       if (bs->format == BINARY)
  425.          n = fread(&bs->buf[i--], sizeof(unsigned char), 1, bs->pt);
  426.  
  427.       else {
  428.          while((index < 2) && n) {
  429.             n = fread(&val[index], sizeof(char), 1, bs->pt);
  430.             switch (val[index]) {
  431.                   case 0x30:
  432.                   case 0x31:
  433.                   case 0x32:
  434.                   case 0x33:
  435.                   case 0x34:
  436.                   case 0x35:
  437.                   case 0x36:
  438.                   case 0x37:
  439.                   case 0x38:
  440.                   case 0x39:
  441.                   case 0x41:
  442.                   case 0x42:
  443.                   case 0x43:
  444.                   case 0x44:
  445.                   case 0x45:
  446.                   case 0x46:
  447.                   index++;
  448.                   break;
  449.                   default: break;
  450.             }
  451.          }
  452.  
  453.          if (val[0] <= 0x39)   bs->buf[i] = (val[0] - 0x30) << 4;
  454.                  else  bs->buf[i] = (val[0] - 0x37) << 4;
  455.          if (val[1] <= 0x39)   bs->buf[i--] |= (val[1] - 0x30);
  456.                  else  bs->buf[i--] |= (val[1] - 0x37);
  457.          index = 0;
  458.       }
  459.  
  460.       if (!n) {
  461.          bs->eob= i+1;
  462.       }
  463.  
  464.     }
  465. }
  466.  
  467. static char *he = "0123456789ABCDEF";
  468.  
  469. /* empty the buffer to the output device when the buffer becomes full */
  470. void empty_buffer(bs, minimum)
  471. Bit_stream_struc *bs;   /* bit stream structure */
  472. int minimum;            /* end of the buffer to empty */
  473. {
  474.    register int i;
  475.  
  476. #if BS_FORMAT == BINARY
  477.    for (i=bs->buf_size-1;i>=minimum;i--)
  478.       fwrite(&bs->buf[i], sizeof(unsigned char), 1, bs->pt);
  479. #else
  480.    for (i=bs->buf_size-1;i>=minimum;i--) {
  481.        char val[2];
  482.        val[0] = he[((bs->buf[i] >> 4) & 0x0F)];
  483.        val[1] = he[(bs->buf[i] & 0x0F)];
  484.        fwrite(val, sizeof(char), 2, bs->pt);
  485.    }
  486. #endif
  487.  
  488.    for (i=minimum-1; i>=0; i--)
  489.        bs->buf[bs->buf_size - minimum + i] = bs->buf[i];
  490.  
  491.    bs->buf_byte_idx = bs->buf_size -1 - minimum;
  492.    bs->buf_bit_idx = 8;
  493. }
  494.  
  495. /* open the device to write the bit stream into it */
  496. void open_bit_stream_w(bs, bs_filenam, size)
  497. Bit_stream_struc *bs;   /* bit stream structure */
  498. char *bs_filenam;       /* name of the bit stream file */
  499. int size;               /* size of the buffer */
  500. {
  501.    if ((bs->pt = fopen(bs_filenam, "wb")) == NULL) {
  502.       printf("Could not create \"%s\".\n", bs_filenam);
  503.       exit(1);
  504.    }
  505.    alloc_buffer(bs, size);
  506.    bs->buf_byte_idx = size-1;
  507.    bs->buf_bit_idx=8;
  508.    bs->totbit=0;
  509.    bs->mode = WRITE_MODE;
  510.    bs->eob = FALSE;
  511.    bs->eobs = FALSE;
  512. }
  513.  
  514. /* open the device to read the bit stream from it */
  515. void open_bit_stream_r(bs, bs_filenam, size)
  516. Bit_stream_struc *bs;   /* bit stream structure */
  517. char *bs_filenam;       /* name of the bit stream file */
  518. int size;               /* size of the buffer */
  519. {
  520.    register unsigned long n;
  521.    register unsigned char flag = 1;
  522.    unsigned char val;
  523.  
  524.    if ((bs->pt = fopen(bs_filenam, "rb")) == NULL) {
  525.       printf("Could not find \"%s\".\n", bs_filenam);
  526.       exit(1);
  527.    }
  528.  
  529.    do {
  530.      n = fread(&val, sizeof(unsigned char), 1, bs->pt);
  531.      switch (val) {
  532.       case 0x30:
  533.       case 0x31:
  534.       case 0x32:
  535.       case 0x33:
  536.       case 0x34:
  537.       case 0x35:
  538.       case 0x36:
  539.       case 0x37:
  540.       case 0x38:
  541.       case 0x39:
  542.       case 0x41:
  543.       case 0x42:
  544.       case 0x43:
  545.       case 0x44:
  546.       case 0x45:
  547.       case 0x46:
  548.       case 0xa:  /* \n */
  549.       case 0xd:  /* cr */
  550.       case 0x1a:  /* sub */
  551.           break;
  552.  
  553.       default: /* detection of an binary character */
  554.           flag--;
  555.           break;
  556.      }
  557.  
  558.    } while (flag & n);
  559.  
  560.    if (flag) {
  561.       bs->format = ASCII;
  562.    }
  563.    else {
  564.       bs->format = BINARY;
  565.    }
  566.  
  567.    fclose(bs->pt);
  568.  
  569.    if ((bs->pt = fopen(bs_filenam, "rb")) == NULL) {
  570.       printf("Could not find \"%s\".\n", bs_filenam);
  571.       exit(1);
  572.    }
  573.  
  574.    alloc_buffer(bs, size);
  575.    bs->buf_byte_idx=0;
  576.    bs->buf_bit_idx=0;
  577.    bs->totbit=0;
  578.    bs->mode = READ_MODE;
  579.    bs->eob = FALSE;
  580.    bs->eobs = FALSE;
  581. }
  582.  
  583. /*close the device containing the bit stream after a read process*/
  584. void close_bit_stream_r(bs)
  585. Bit_stream_struc *bs;   /* bit stream structure */
  586. {
  587.    fclose(bs->pt);
  588.    desalloc_buffer(bs);
  589. }
  590.  
  591. /*close the device containing the bit stream after a write process*/
  592. void close_bit_stream_w(bs)
  593. Bit_stream_struc *bs;   /* bit stream structure */
  594. {
  595.    empty_buffer(bs, bs->buf_byte_idx);
  596.    fclose(bs->pt);
  597.    desalloc_buffer(bs);
  598. }
  599.  
  600. /*open and initialize the buffer; */
  601. void alloc_buffer(bs, size)
  602. Bit_stream_struc *bs;   /* bit stream structure */
  603. int size;
  604. {
  605.    bs->buf = (unsigned char FAR *) mem_alloc(size*sizeof(unsigned
  606.               char), "buffer");
  607.    bs->buf_size = size;
  608. }
  609.  
  610. /*empty and close the buffer */
  611. void desalloc_buffer(bs)
  612. Bit_stream_struc *bs;   /* bit stream structure */
  613. {
  614.    free(bs->buf);
  615. }
  616.  
  617. int putmask[9]={0x0, 0x1, 0x3, 0x7, 0xf, 0x1f, 0x3f, 0x7f, 0xff};
  618. int clearmask[9]={0xff, 0xfe, 0xfc, 0xf8, 0xf0, 0xe0, 0xc0, 0x80, 0x0};
  619.  
  620. void back_track_buffer(bs, N) /* goes back N bits in the buffer */
  621. Bit_stream_struc *bs;   /* bit stream structure */
  622. int N;
  623. {
  624.    int tmp = N - (N/8)*8;
  625.    register int i;
  626.  
  627.    bs->totbit -= N;
  628.    for (i=bs->buf_byte_idx;i< bs->buf_byte_idx+N/8-1;i++) bs->buf[i] = 0;
  629.    bs->buf_byte_idx += N/8;
  630.    if ( (tmp + bs->buf_bit_idx) <= 8) {
  631.       bs->buf_bit_idx += tmp;
  632.    }
  633.    else {
  634.       bs->buf_byte_idx ++;
  635.       bs->buf_bit_idx += (tmp - 8);
  636.    }
  637.    bs->buf[bs->buf_byte_idx] &= clearmask[bs->buf_bit_idx];
  638. }
  639.  
  640. int mask[8]={0x1, 0x2, 0x4, 0x8, 0x10, 0x20, 0x40, 0x80};
  641.  
  642. /*read 1 bit from the bit stream */
  643. unsigned int get1bit(bs)
  644. Bit_stream_struc *bs;   /* bit stream structure */
  645. {
  646.    unsigned int bit;
  647.    register int i;
  648.  
  649.    bs->totbit++;
  650.  
  651.    if (!bs->buf_bit_idx) {
  652.         bs->buf_bit_idx = 8;
  653.         bs->buf_byte_idx--;
  654.         if ((bs->buf_byte_idx < MINIMUM) || (bs->buf_byte_idx < bs->eob)) {
  655.              if (bs->eob)
  656.                 bs->eobs = TRUE;
  657.              else {
  658.                 for (i=bs->buf_byte_idx; i>=0;i--)
  659.                   bs->buf[bs->buf_size-1-bs->buf_byte_idx+i] = bs->buf[i];
  660.                 refill_buffer(bs);
  661.                 bs->buf_byte_idx = bs->buf_size-1;
  662.              }
  663.         }
  664.    }
  665.    bit = bs->buf[bs->buf_byte_idx]&mask[bs->buf_bit_idx-1];
  666.    bit = bit >> (bs->buf_bit_idx-1);
  667.    bs->buf_bit_idx--;
  668.    return(bit);
  669. }
  670.  
  671. /*write 1 bit from the bit stream */
  672. void put1bit(bs, bit)
  673. Bit_stream_struc *bs;   /* bit stream structure */
  674. int bit;                /* bit to write into the buffer */
  675. {
  676.    bs->totbit++;
  677.  
  678.    bs->buf[bs->buf_byte_idx] |= (bit&0x1) << (bs->buf_bit_idx-1);
  679.    bs->buf_bit_idx--;
  680.    if (!bs->buf_bit_idx) {
  681.        bs->buf_bit_idx = 8;
  682.        bs->buf_byte_idx--;
  683.        if (bs->buf_byte_idx < 0)
  684.           empty_buffer(bs, MINIMUM);
  685.        bs->buf[bs->buf_byte_idx] = 0;
  686.    }
  687. }
  688.  
  689. /*look ahead for the next N bits from the bit stream */
  690. unsigned long look_ahead(bs, N)
  691. Bit_stream_struc *bs;   /* bit stream structure */
  692. int N;                  /* number of bits to read from the bit stream */
  693. {
  694.  unsigned long val=0;
  695.  register int j = N;
  696.  register int k, tmp;
  697.  register int bit_idx = bs->buf_bit_idx;
  698.  register int byte_idx = bs->buf_byte_idx;
  699.  
  700.  if (N > MAX_LENGTH)
  701.     printf("Cannot read or write more than %d bits at a time.\n", MAX_LENGTH);
  702.  
  703.  while (j > 0) {
  704.     if (!bit_idx) {
  705.         bit_idx = 8;
  706.         byte_idx--;
  707.     }
  708.     k = MIN (j, bit_idx);
  709.     tmp = bs->buf[byte_idx]&putmask[bit_idx];
  710.     tmp = tmp >> (bit_idx-k);
  711.     val |= tmp << (j-k);
  712.     bit_idx -= k;
  713.     j -= k;
  714.  }
  715.  return(val);
  716. }
  717.  
  718. /*read N bit from the bit stream */
  719. unsigned long getbits(bs, N)
  720. Bit_stream_struc *bs;   /* bit stream structure */
  721. int N;                  /* number of bits to read from the bit stream */
  722. {
  723.  unsigned long val=0;
  724.  register int i;
  725.  register int j = N;
  726.  register int k, tmp;
  727.  
  728.  if (N > MAX_LENGTH)
  729.     printf("Cannot read or write more than %d bits at a time.\n", MAX_LENGTH);
  730.  
  731.  bs->totbit += N;
  732.  while (j > 0) {
  733.    if (!bs->buf_bit_idx) {
  734.         bs->buf_bit_idx = 8;
  735.         bs->buf_byte_idx--;
  736.         if ((bs->buf_byte_idx < MINIMUM) || (bs->buf_byte_idx < bs->eob)) {
  737.              if (bs->eob)
  738.                 bs->eobs = TRUE;
  739.              else {
  740.                 for (i=bs->buf_byte_idx; i>=0;i--)
  741.                    bs->buf[bs->buf_size-1-bs->buf_byte_idx+i] = bs->buf[i];
  742.                 refill_buffer(bs);
  743.                 bs->buf_byte_idx = bs->buf_size-1;
  744.              }
  745.         }
  746.    }
  747.    k = MIN (j, bs->buf_bit_idx);
  748.    tmp = bs->buf[bs->buf_byte_idx]&putmask[bs->buf_bit_idx];
  749.    tmp = tmp >> (bs->buf_bit_idx-k);
  750.    val |= tmp << (j-k);
  751.    bs->buf_bit_idx -= k;
  752.    j -= k;
  753.  }
  754.  return(val);
  755. }
  756.  
  757. /*write N bits into the bit stream */
  758. void putbits(bs, val, N)
  759. Bit_stream_struc *bs;   /* bit stream structure */
  760. unsigned int val;       /* val to write into the buffer */
  761. int N;                  /* number of bits of val */
  762. {
  763.  register int j = N;
  764.  register int k, tmp;
  765.  
  766.  if (N > MAX_LENGTH)
  767.     printf("Cannot read or write more than %d bits at a time.\n", MAX_LENGTH);
  768.  
  769.  bs->totbit += N;
  770.  while (j > 0) {
  771.    k = MIN(j, bs->buf_bit_idx);
  772.    tmp = val >> (j-k);
  773.    bs->buf[bs->buf_byte_idx] |= (tmp&putmask[k]) << (bs->buf_bit_idx-k);
  774.    bs->buf_bit_idx -= k;
  775.    if (!bs->buf_bit_idx) {
  776.        bs->buf_bit_idx = 8;
  777.        bs->buf_byte_idx--;
  778.        if (bs->buf_byte_idx < 0)
  779.           empty_buffer(bs, MINIMUM);
  780.        bs->buf[bs->buf_byte_idx] = 0;
  781.    }
  782.    j -= k;
  783.  }
  784. }
  785.  
  786. /*write N bits byte aligned into the bit stream */
  787. void byte_ali_putbits(bs, val, N)
  788. Bit_stream_struc *bs;   /* bit stream structure */
  789. unsigned int val;       /* val to write into the buffer */
  790. int N;                  /* number of bits of val */
  791. {
  792.  unsigned long aligning, sstell();
  793.  
  794.  if (N > MAX_LENGTH)
  795.     printf("Cannot read or write more than %d bits at a time.\n", MAX_LENGTH);
  796.  aligning = sstell(bs)%8;
  797.  if (aligning)
  798.      putbits(bs, (unsigned int)0, (int)(8-aligning)); 
  799.  
  800.  putbits(bs, val, N);
  801. }
  802.  
  803. /*read the next bute aligned N bits from the bit stream */
  804. unsigned long byte_ali_getbits(bs, N)
  805. Bit_stream_struc *bs;   /* bit stream structure */
  806. int N;                  /* number of bits of val */
  807. {
  808.  unsigned long aligning, sstell();
  809.  
  810.  if (N > MAX_LENGTH)
  811.     printf("Cannot read or write more than %d bits at a time.\n", MAX_LENGTH);
  812.  aligning = sstell(bs)%8;
  813.  if (aligning)
  814.     getbits(bs, (int)(8-aligning));
  815.  
  816.  return(getbits(bs, N));
  817. }
  818.  
  819. /*return the current bit stream length (in bits)*/
  820. unsigned long sstell(bs)
  821. Bit_stream_struc *bs;   /* bit stream structure */
  822. {
  823.   return(bs->totbit);
  824. }
  825.  
  826. /*return the status of the bit stream*/
  827. /* returns 1 if end of bit stream was reached */
  828. /* returns 0 if end of bit stream was not reached */
  829. int end_bs(bs)
  830. Bit_stream_struc *bs;   /* bit stream structure */
  831. {
  832.   return(bs->eobs);
  833. }
  834.  
  835. /*this function seeks for a byte aligned sync word in the bit stream and
  836.   places the bit stream pointer right after the sync.
  837.   This function returns 1 if the sync was found otherwise it returns 0  */
  838. int seek_sync(bs, sync, N)
  839. Bit_stream_struc *bs;   /* bit stream structure */
  840. long sync;      /* sync word maximum 32 bits */
  841. int N;          /* sync word length */
  842. {
  843.  double pow();
  844.  unsigned long aligning, stell();
  845.  unsigned long val;
  846.  long maxi = (int)pow(2.0, (FLOAT)N) - 1;
  847.  
  848.  aligning = sstell(bs)%ALIGNING;
  849.  if (aligning)
  850.     getbits(bs, (int)(ALIGNING-aligning));
  851.  
  852.   val = getbits(bs, N);
  853.   while (((val&maxi) != sync) && (!end_bs(bs))) {
  854.         val <<= ALIGNING;
  855.         val |= getbits(bs, ALIGNING);
  856.   }
  857.  
  858.  if (end_bs(bs)) return(0);
  859.  else return(1);
  860. }
  861. /*****************************************************************************
  862. *
  863. *  End of bit_stream.c package
  864. *
  865. *****************************************************************************/
  866.  
  867. /*****************************************************************************
  868. *
  869. *  CRC error protection package
  870. *
  871. *****************************************************************************/
  872.  
  873. void I_CRC_calc(fr_ps, bit_alloc, crc)
  874. frame_params *fr_ps;
  875. unsigned int bit_alloc[2][SBLIMIT];
  876. unsigned int *crc;
  877. {
  878.         int i, k;
  879.         layer *info = fr_ps->header;
  880.         int stereo  = fr_ps->stereo;
  881.         int jsbound = fr_ps->jsbound;
  882.  
  883.         *crc = 0xffff; /* changed from '0' 92-08-11 shn */
  884.         update_CRC(info->bitrate_index, 4, crc);
  885.         update_CRC(info->sampling_frequency, 2, crc);
  886.         update_CRC(info->padding, 1, crc);
  887.         update_CRC(info->extension, 1, crc);
  888.         update_CRC(info->mode, 2, crc);
  889.         update_CRC(info->mode_ext, 2, crc);
  890.         update_CRC(info->copyright, 1, crc);
  891.         update_CRC(info->original, 1, crc);
  892.         update_CRC(info->emphasis, 2, crc);
  893.  
  894.         for (i=0;i<SBLIMIT;i++)
  895.                 for (k=0;k<((i<jsbound)?stereo:1);k++)
  896.                         update_CRC(bit_alloc[k][i], 4, crc);
  897. }
  898.  
  899. void II_CRC_calc(fr_ps, bit_alloc, scfsi, crc)
  900. frame_params *fr_ps;
  901. unsigned int bit_alloc[2][SBLIMIT], scfsi[2][SBLIMIT];
  902. unsigned int *crc;
  903. {
  904.         int i, k;
  905.         layer *info = fr_ps->header;
  906.         int stereo  = fr_ps->stereo;
  907.         int sblimit = fr_ps->sblimit;
  908.         int jsbound = fr_ps->jsbound;
  909.         al_table *alloc = fr_ps->alloc;
  910.  
  911.         *crc = 0xffff; /* changed from '0' 92-08-11 shn */
  912.         update_CRC(info->bitrate_index, 4, crc);
  913.         update_CRC(info->sampling_frequency, 2, crc);
  914.         update_CRC(info->padding, 1, crc);
  915.         update_CRC(info->extension, 1, crc);
  916.         update_CRC(info->mode, 2, crc);
  917.         update_CRC(info->mode_ext, 2, crc);
  918.         update_CRC(info->copyright, 1, crc);
  919.         update_CRC(info->original, 1, crc);
  920.         update_CRC(info->emphasis, 2, crc);
  921.  
  922.         for (i=0;i<sblimit;i++)
  923.                 for (k=0;k<((i<jsbound)?stereo:1);k++)
  924.                         update_CRC(bit_alloc[k][i], (*alloc)[i][0].bits, crc);
  925.  
  926.         for (i=0;i<sblimit;i++)
  927.                 for (k=0;k<stereo;k++)
  928.                         if (bit_alloc[k][i])
  929.                                 update_CRC(scfsi[k][i], 2, crc);
  930. }
  931.  
  932. void update_CRC(data, length, crc)
  933. unsigned int data, length, *crc;
  934. {
  935.         unsigned int  masking, carry;
  936.  
  937.         masking = 1 << length;
  938.  
  939.         while((masking >>= 1)){
  940.                 carry = *crc & 0x8000;
  941.                 *crc <<= 1;
  942.                 if (!carry ^ !(data & masking))
  943.                         *crc ^= CRC16_POLYNOMIAL;
  944.         }
  945.         *crc &= 0xffff;
  946. }
  947.  
  948. /*****************************************************************************
  949. *
  950. *  End of CRC error protection package
  951. *
  952. *****************************************************************************/
  953.  
  954.