Code cleanups (bug #66)
[asterisk/asterisk.git] / codecs / mp3 / src / cupL1.c
1 /*____________________________________________________________________________
2         
3         FreeAmp - The Free MP3 Player
4
5         MP3 Decoder originally Copyright (C) 1995-1997 Xing Technology
6         Corp.  http://www.xingtech.com
7
8         Portions Copyright (C) 1998-1999 EMusic.com
9
10         This program is free software; you can redistribute it and/or modify
11         it under the terms of the GNU General Public License as published by
12         the Free Software Foundation; either version 2 of the License, or
13         (at your option) any later version.
14
15         This program is distributed in the hope that it will be useful,
16         but WITHOUT ANY WARRANTY; without even the implied warranty of
17         MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18         GNU General Public License for more details.
19
20         You should have received a copy of the GNU General Public License
21         along with this program; if not, write to the Free Software
22         Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23         
24         $Id$
25 ____________________________________________________________________________*/
26
27 /****  cupL1.c  ***************************************************
28
29 MPEG audio decoder Layer I mpeg1 and mpeg2
30
31 include to clup.c
32
33
34 ******************************************************************/
35 /*======================================================================*/
36
37
38 /* Read Only */
39 static int bat_bit_masterL1[] =
40 {
41    0, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16};
42
43 /*======================================================================*/
44 static void unpack_baL1(MPEG *m)
45 {
46    int j;
47    int nstereo;
48
49    m->cup.bit_skip = 0;
50    nstereo = m->cup.stereo_sb;
51
52    for (j = 0; j < m->cup.nbatL1; j++)
53    {
54       mac_load_check(4);
55       m->cup.ballo[j] = m->cup.samp_dispatch[j] = mac_load(4);
56       if (j >= m->cup.nsb_limit)
57          m->cup.bit_skip += bat_bit_masterL1[m->cup.samp_dispatch[j]];
58       m->cup.c_value[j] = m->cup.look_c_valueL1[m->cup.samp_dispatch[j]];
59       if (--nstereo < 0)
60       {
61          m->cup.ballo[j + 1] = m->cup.ballo[j];
62          m->cup.samp_dispatch[j] += 15; /* flag as joint */
63          m->cup.samp_dispatch[j + 1] = m->cup.samp_dispatch[j]; /* flag for sf */
64          m->cup.c_value[j + 1] = m->cup.c_value[j];
65          j++;
66       }
67    }
68 /*-- terminate with bit skip and end --*/
69    m->cup.samp_dispatch[m->cup.nsb_limit] = 31;
70    m->cup.samp_dispatch[j] = 30;
71 }
72 /*-------------------------------------------------------------------------*/
73 static void unpack_sfL1(MPEG *m)        /* unpack scale factor */
74 {                               /* combine dequant and scale factors */
75    int i;
76
77    for (i = 0; i < m->cup.nbatL1; i++)
78    {
79       if (m->cup.ballo[i])
80       {
81          mac_load_check(6);
82          m->cup.cs_factorL1[i] = m->cup.c_value[i] * m->cup.sf_table[mac_load(6)];
83       }
84    }
85 /*-- done --*/
86 }
87 /*-------------------------------------------------------------------------*/
88 #define UNPACKL1_N(n) s[k]     =  m->cup.cs_factorL1[k]*(load(m,n)-((1 << (n-1)) -1));  \
89     goto dispatch;
90 #define UNPACKL1J_N(n) tmp        =  (load(m,n)-((1 << (n-1)) -1));                 \
91     s[k]       =  m->cup.cs_factorL1[k]*tmp;                        \
92     s[k+1]     =  m->cup.cs_factorL1[k+1]*tmp;                      \
93     k++;                                                     \
94     goto dispatch;
95 /*-------------------------------------------------------------------------*/
96 static void unpack_sampL1(MPEG *m)      /* unpack samples */
97 {
98    int j, k;
99    float *s;
100    long tmp;
101
102    s = m->cup.sample;
103    for (j = 0; j < 12; j++)
104    {
105       k = -1;
106     dispatch:switch (m->cup.samp_dispatch[++k])
107       {
108          case 0:
109             s[k] = 0.0F;
110             goto dispatch;
111          case 1:
112             UNPACKL1_N(2)       /*  3 levels */
113          case 2:
114             UNPACKL1_N(3)       /*  7 levels */
115          case 3:
116             UNPACKL1_N(4)       /* 15 levels */
117          case 4:
118             UNPACKL1_N(5)       /* 31 levels */
119          case 5:
120             UNPACKL1_N(6)       /* 63 levels */
121          case 6:
122             UNPACKL1_N(7)       /* 127 levels */
123          case 7:
124             UNPACKL1_N(8)       /* 255 levels */
125          case 8:
126             UNPACKL1_N(9)       /* 511 levels */
127          case 9:
128             UNPACKL1_N(10)      /* 1023 levels */
129          case 10:
130             UNPACKL1_N(11)      /* 2047 levels */
131          case 11:
132             UNPACKL1_N(12)      /* 4095 levels */
133          case 12:
134             UNPACKL1_N(13)      /* 8191 levels */
135          case 13:
136             UNPACKL1_N(14)      /* 16383 levels */
137          case 14:
138             UNPACKL1_N(15)      /* 32767 levels */
139 /* -- joint ---- */
140          case 15 + 0:
141             s[k + 1] = s[k] = 0.0F;
142             k++;                /* skip right chan dispatch */
143             goto dispatch;
144 /* -- joint ---- */
145          case 15 + 1:
146             UNPACKL1J_N(2)      /*  3 levels */
147          case 15 + 2:
148             UNPACKL1J_N(3)      /*  7 levels */
149          case 15 + 3:
150             UNPACKL1J_N(4)      /* 15 levels */
151          case 15 + 4:
152             UNPACKL1J_N(5)      /* 31 levels */
153          case 15 + 5:
154             UNPACKL1J_N(6)      /* 63 levels */
155          case 15 + 6:
156             UNPACKL1J_N(7)      /* 127 levels */
157          case 15 + 7:
158             UNPACKL1J_N(8)      /* 255 levels */
159          case 15 + 8:
160             UNPACKL1J_N(9)      /* 511 levels */
161          case 15 + 9:
162             UNPACKL1J_N(10)     /* 1023 levels */
163          case 15 + 10:
164             UNPACKL1J_N(11)     /* 2047 levels */
165          case 15 + 11:
166             UNPACKL1J_N(12)     /* 4095 levels */
167          case 15 + 12:
168             UNPACKL1J_N(13)     /* 8191 levels */
169          case 15 + 13:
170             UNPACKL1J_N(14)     /* 16383 levels */
171          case 15 + 14:
172             UNPACKL1J_N(15)     /* 32767 levels */
173
174 /* -- end of dispatch -- */
175          case 31:
176             skip(m,m->cup.bit_skip);
177          case 30:
178             s += 64;
179       }                         /* end switch */
180    }                            /* end j loop */
181
182 /*-- done --*/
183 }
184 /*-------------------------------------------------------------------*/
185 IN_OUT L1audio_decode(void *mv, unsigned char *bs, signed short *pcm)
186 {
187    MPEG *m = mv;
188    int sync, prot;
189    IN_OUT in_out;
190
191    load_init(m, bs);            /* initialize bit getter */
192 /* test sync */
193    in_out.in_bytes = 0;         /* assume fail */
194    in_out.out_bytes = 0;
195    sync = load(m,12);
196    if (sync != 0xFFF)
197       return in_out;            /* sync fail */
198
199
200    load(m,3);                   /* skip id and option (checked by init) */
201    prot = load(m,1);            /* load prot bit */
202    load(m,6);                   /* skip to pad */
203    m->cup.pad = (load(m,1)) << 2;
204    load(m,1);                   /* skip to mode */
205    m->cup.stereo_sb = look_joint[load(m,4)];
206    if (prot)
207       load(m,4);                        /* skip to data */
208    else
209       load(m,20);                       /* skip crc */
210
211    unpack_baL1(m);              /* unpack bit allocation */
212    unpack_sfL1(m);              /* unpack scale factor */
213    unpack_sampL1(m);            /* unpack samples */
214
215    m->cup.sbt(m, m->cup.sample, pcm, 12);
216 /*-----------*/
217    in_out.in_bytes = m->cup.framebytes + m->cup.pad;
218    in_out.out_bytes = m->cup.outbytes;
219
220    return in_out;
221 }
222 /*-------------------------------------------------------------------------*/
223 int L1audio_decode_init(MPEG *m, MPEG_HEAD * h, int framebytes_arg,
224                    int reduction_code, int transform_code, int convert_code,
225                         int freq_limit)
226 {
227    int i, k;
228    long samprate;
229    int limit;
230    long step;
231    int bit_code;
232
233 /*--- sf init done by layer II init ---*/
234    if (m->cup.first_pass_L1)
235    {
236       for (step = 4, i = 1; i < 16; i++, step <<= 1)
237          m->cup.look_c_valueL1[i] = (float) (2.0 / (step - 1));
238       m->cup.first_pass_L1 = 0;
239    }
240
241    transform_code = transform_code;     /* not used, asm compatability */
242
243    bit_code = 0;
244    if (convert_code & 8)
245       bit_code = 1;
246    convert_code = convert_code & 3;     /* higher bits used by dec8 freq cvt */
247    if (reduction_code < 0)
248       reduction_code = 0;
249    if (reduction_code > 2)
250       reduction_code = 2;
251    if (freq_limit < 1000)
252       freq_limit = 1000;
253
254
255    m->cup.framebytes = framebytes_arg;
256 /* check if code handles */
257    if (h->option != 3)
258       return 0;                 /* layer I only */
259
260    m->cup.nbatL1 = 32;
261    m->cup.max_sb = m->cup.nbatL1;
262 /*----- compute nsb_limit --------*/
263    samprate = sr_table[4 * h->id + h->sr_index];
264    m->cup.nsb_limit = (freq_limit * 64L + samprate / 2) / samprate;
265 /*- caller limit -*/
266 /*---- limit = 0.94*(32>>reduction_code);  ----*/
267    limit = (32 >> reduction_code);
268    if (limit > 8)
269       limit--;
270    if (m->cup.nsb_limit > limit)
271       m->cup.nsb_limit = limit;
272    if (m->cup.nsb_limit > m->cup.max_sb)
273       m->cup.nsb_limit = m->cup.max_sb;
274
275    m->cup.outvalues = 384 >> reduction_code;
276    if (h->mode != 3)
277    {                            /* adjust for 2 channel modes */
278       m->cup.nbatL1 *= 2;
279       m->cup.max_sb *= 2;
280       m->cup.nsb_limit *= 2;
281    }
282
283 /* set sbt function */
284    k = 1 + convert_code;
285    if (h->mode == 3)
286    {
287       k = 0;
288    }
289    m->cup.sbt = sbt_table[bit_code][reduction_code][k];
290    m->cup.outvalues *= out_chans[k];
291
292    if (bit_code)
293       m->cup.outbytes = m->cup.outvalues;
294    else
295       m->cup.outbytes = sizeof(short) * m->cup.outvalues;
296
297    m->cup.decinfo.channels = out_chans[k];
298    m->cup.decinfo.outvalues = m->cup.outvalues;
299    m->cup.decinfo.samprate = samprate >> reduction_code;
300    if (bit_code)
301       m->cup.decinfo.bits = 8;
302    else
303       m->cup.decinfo.bits = sizeof(short) * 8;
304
305    m->cup.decinfo.framebytes = m->cup.framebytes;
306    m->cup.decinfo.type = 0;
307
308
309 /* clear sample buffer, unused sub bands must be 0 */
310    for (i = 0; i < 768; i++)
311       m->cup.sample[i] = 0.0F;
312
313
314 /* init sub-band transform */
315    sbt_init(m);
316
317    return 1;
318 }
319 /*---------------------------------------------------------*/