?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
add_savefile: remove callback parameter
[vlc/asuraparaju-public.git] / modules / codec / shine / shine.c
blobfcc5b2645d194b0c10de6adf90ed7d9bd0ec4ae4
1 /***************************************************************************
2 * __________ __ ___.
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
7 * \/ \/ \/ \/ \/
8 * $Id$
9 *
10 * Copyright (C) 2006 Antonius Hellmann
11 *
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License
14 * as published by the Free Software Foundation; either version 2
15 * of the License, or (at your option) any later version.
16 *
17 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
18 * KIND, either express or implied.
19 *
20 ****************************************************************************/
21
22 // Shine is an MP3 encoder
23 // Copyright (C) 1999-2000 Gabriel Bouvigne
24 //
25 // This library is free software; you can redistribute it and/or
26 // modify it under the terms of the GNU Library General Public
27 // License as published by the Free Software Foundation; either
28 // version 2 of the License, or (at your option) any later version.
29 //
30 // This library is distributed in the hope that it will be useful,
31 // but WITHOUT ANY WARRANTY; without even the implied warranty of
32 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
33 // Library General Public License for more details.
34
35 #define IBSS_ATTR
36
37 #ifdef WORDS_BIGENDIAN
38 #define ROCKBOX_BIG_ENDIAN
39 #else
40 #define ROCKBOX_LITTLE_ENDIAN
41 #endif
42
43 #include <stdbool.h>
44 #include <stdlib.h>
45 #include <inttypes.h>
46 #include <string.h>
47 #include <limits.h>
48 #include <assert.h>
49
50 #include "../wmafixed/bswap.h"
51 #include "enc_base.h"
52
53 #define ENC_PADDING_FRAMES1 2
54 #define ENC_PADDING_FRAMES2 4
55 #define ENC_DELAY_SAMP 576
56 #define ENC_DELAY_SIZE (ENC_DELAY_SAMP*4)
57 #define SAMP_PER_FRAME1 1152
58 #define SAMP_PER_FRAME2 576
59 #define PCM_CHUNK_SIZE1 (SAMP_PER_FRAME1*4)
60 #define PCM_CHUNK_SIZE2 (SAMP_PER_FRAME2*4)
61 #define SAMPL2 576
62 #define SBLIMIT 32
63 #define HTN 16
64
65 #define putlong(c, s) if(s+sz <= 32) { cc = (cc << s) | c; sz+= s; } \
66 else { putbits(cc, sz); cc = c; sz = s; }
67
68 typedef struct {
69 int type; /* 0=(MPEG2 - 22.05,24,16kHz) 1=(MPEG1 - 44.1,48,32kHz) */
70 int mode; /* 0=stereo, 1=jstereo, 2=dual, 3=mono */
71 int bitrate;
72 int padding;
73 int num_bands;
74 long bitr_id;
75 int smpl_id;
76 } mpeg_t;
77
78 /* Side information */
79 typedef struct {
80 uint32_t part2_3_length;
81 int count1; /* number of 0-1-quadruples */
82 uint32_t global_gain;
83 uint32_t table_select[4];
84 uint32_t region_0_1;
85 uint32_t address1;
86 uint32_t address2;
87 uint32_t address3;
88 long quantStep;
89 long additStep;
90 uint32_t max_val;
91 } side_info_t;
92
93 typedef struct {
94 side_info_t cod_info[2][2];
95 mpeg_t mpg;
96 long frac_per_frame;
97 long byte_per_frame;
98 long slot_lag;
99 int sideinfo_len;
100 int mean_bits;
101 int ResvSize;
102 int channels;
103 int granules;
104 long samplerate;
105 } config_t;
106
107 typedef struct {
108 int bitpos; /* current bitpos for writing */
109 uint32_t bbuf[263];
110 } BF_Data;
111
112 struct huffcodetab {
113 int len; /* max. index */
114 const uint8_t *table; /* pointer to array[len][len] */
115 const uint8_t *hlen; /* pointer to array[len][len] */
116 };
117
118 struct huffcodebig {
119 int len; /* max. index */
120 int linbits; /* number of linbits */
121 int linmax; /* max number stored in linbits */
122 };
123
124 #define shft4(x) ((x + 8) >> 4)
125 #define shft9(x) ((x + 256) >> 9)
126 #define shft13(x) ((x + 4096) >> 13)
127 #define shft15(x) ((x + 16384) >> 15)
128 #define shft16(x) ((x + 32768) >> 16)
129 #define shft_n(x,n) ((x) >> n)
130 #define SQRT 724 /* sqrt(2) * 512 */
131
132 static short mfbuf [2*(1152+512)] IBSS_ATTR; /* 3328 Bytes */
133 static int sb_data [2][2][18][SBLIMIT] IBSS_ATTR; /* 13824 Bytes */
134 static int mdct_freq [SAMPL2] IBSS_ATTR; /* 2304 Bytes */
135 static char mdct_sign [SAMPL2] IBSS_ATTR; /* 576 Bytes */
136 static short enc_data [SAMPL2] IBSS_ATTR; /* 1152 Bytes */
137 static uint32_t scalefac [23] IBSS_ATTR; /* 92 Bytes */
138 static BF_Data CodedData IBSS_ATTR; /* 1056 Bytes */
139 static int ca [8] IBSS_ATTR; /* 32 Bytes */
140 static int cs [8] IBSS_ATTR; /* 32 Bytes */
141 static int cx [9] IBSS_ATTR; /* 36 Bytes */
142 static int win [18][4] IBSS_ATTR; /* 288 Bytes */
143 static short enwindow [15*27+24] IBSS_ATTR; /* 862 Bytes */
144 static short int2idx [4096] IBSS_ATTR; /* 8192 Bytes */
145 static uint8_t ht_count [2][2][16] IBSS_ATTR; /* 64 Bytes */
146 static uint32_t tab01 [ 16] IBSS_ATTR; /* 64 Bytes */
147 static uint32_t tab23 [ 9] IBSS_ATTR; /* 36 Bytes */
148 static uint32_t tab56 [ 16] IBSS_ATTR; /* 64 Bytes */
149 static uint32_t tab1315 [256] IBSS_ATTR; /* 1024 Bytes */
150 static uint32_t tab1624 [256] IBSS_ATTR; /* 1024 Bytes */
151 static uint32_t tab789 [ 36] IBSS_ATTR; /* 144 Bytes */
152 static uint32_t tabABC [ 64] IBSS_ATTR; /* 256 Bytes */
153 static uint8_t t1HB [ 4] IBSS_ATTR;
154 static uint8_t t2HB [ 9] IBSS_ATTR;
155 static uint8_t t3HB [ 9] IBSS_ATTR;
156 static uint8_t t5HB [ 16] IBSS_ATTR;
157 static uint8_t t6HB [ 16] IBSS_ATTR;
158 static uint8_t t7HB [ 36] IBSS_ATTR;
159 static uint8_t t8HB [ 36] IBSS_ATTR;
160 static uint8_t t9HB [ 36] IBSS_ATTR;
161 static uint8_t t10HB [ 64] IBSS_ATTR;
162 static uint8_t t11HB [ 64] IBSS_ATTR;
163 static uint8_t t12HB [ 64] IBSS_ATTR;
164 static uint8_t t13HB [256] IBSS_ATTR;
165 static uint8_t t15HB [256] IBSS_ATTR;
166 static uint16_t t16HB [256] IBSS_ATTR;
167 static uint16_t t24HB [256] IBSS_ATTR;
168 static uint8_t t1l [ 8] IBSS_ATTR;
169 static uint8_t t2l [ 9] IBSS_ATTR;
170 static uint8_t t3l [ 9] IBSS_ATTR;
171 static uint8_t t5l [ 16] IBSS_ATTR;
172 static uint8_t t6l [ 16] IBSS_ATTR;
173 static uint8_t t7l [ 36] IBSS_ATTR;
174 static uint8_t t8l [ 36] IBSS_ATTR;
175 static uint8_t t9l [ 36] IBSS_ATTR;
176 static uint8_t t10l [ 64] IBSS_ATTR;
177 static uint8_t t11l [ 64] IBSS_ATTR;
178 static uint8_t t12l [ 64] IBSS_ATTR;
179 static uint8_t t13l [256] IBSS_ATTR;
180 static uint8_t t15l [256] IBSS_ATTR;
181 static uint8_t t16l [256] IBSS_ATTR;
182 static uint8_t t24l [256] IBSS_ATTR;
183 static struct huffcodetab ht [HTN] IBSS_ATTR;
184
185 static unsigned pcm_chunk_size IBSS_ATTR;
186 static unsigned samp_per_frame IBSS_ATTR;
187
188 static config_t cfg IBSS_ATTR;
189 //static char *res_buffer;
190 static int32_t err IBSS_ATTR;
191 static uint8_t band_scale_f[22];
192
193 static const uint8_t ht_count_const[2][2][16] =
194 { { { 1, 5, 4, 5, 6, 5, 4, 4, 7, 3, 6, 0, 7, 2, 3, 1 }, /* table0 */
195 { 1, 5, 5, 7, 5, 8, 7, 9, 5, 7, 7, 9, 7, 9, 9,10 } }, /* hleng0 */
196 { {15, 14, 13, 12, 11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0 }, /* table1 */
197 { 4, 5, 5, 6, 5, 6, 6, 7, 5, 6, 6, 7, 6, 7, 7, 8 } } }; /* hleng1 */
198
199 static const uint8_t t1HB_const[4] = {1,1,1,0};
200 static const uint8_t t2HB_const[9] = {1,2,1,3,1,1,3,2,0};
201 static const uint8_t t3HB_const[9] = {3,2,1,1,1,1,3,2,0};
202 static const uint8_t t5HB_const[16] = {1,2,6,5,3,1,4,4,7,5,7,1,6,1,1,0};
203 static const uint8_t t6HB_const[16] = {7,3,5,1,6,2,3,2,5,4,4,1,3,3,2,0};
204
205 static const uint8_t t7HB_const[36] =
206 { 1, 2,10,19,16,10, 3, 3, 7,10, 5, 3,11, 4,13,17, 8, 4,
207 12,11,18,15,11, 2, 7, 6, 9,14, 3, 1, 6, 4, 5, 3, 2, 0 };
208
209 static const uint8_t t8HB_const[36] =
210 { 3, 4, 6,18,12, 5, 5, 1, 2,16, 9, 3, 7, 3, 5,14, 7, 3,
211 19,17,15,13,10, 4,13, 5, 8,11, 5, 1,12, 4, 4, 1, 1, 0 };
212
213 static const uint8_t t9HB_const[36] =
214 { 7, 5, 9,14,15, 7, 6, 4, 5, 5, 6, 7, 7, 6, 8, 8, 8, 5,
215 15, 6, 9,10, 5, 1,11, 7, 9, 6, 4, 1,14, 4, 6, 2, 6, 0 };
216
217 static const uint8_t t10HB_const[64] =
218 {1,2,10,23,35,30,12,17,3,3,8,12,18,21,12,7,11,9,15,21,32,
219 40,19,6,14,13,22,34,46,23,18,7,20,19,33,47,27,22,9,3,31,22,
220 41,26,21,20,5,3,14,13,10,11,16,6,5,1,9,8,7,8,4,4,2,0 };
221
222 static const uint8_t t11HB_const[64] =
223 {3,4,10,24,34,33,21,15,5,3,4,10,32,17,11,10,11,7,13,18,30,
224 31,20,5,25,11,19,59,27,18,12,5,35,33,31,58,30,16,7,5,28,26,
225 32,19,17,15,8,14,14,12,9,13,14,9,4,1,11,4,6,6,6,3,2,0 };
226
227 static const uint8_t t12HB_const[64] =
228 {9,6,16,33,41,39,38,26,7,5,6,9,23,16,26,11,17,7,11,14,21,
229 30,10,7,17,10,15,12,18,28,14,5,32,13,22,19,18,16,9,5,40,17,
230 31,29,17,13,4,2,27,12,11,15,10,7,4,1,27,12,8,12,6,3,1,0 };
231
232 static const uint8_t t13HB_const[256] =
233 {1,5,14,21,34,51,46,71,42,52,68,52,67,44,43,19,3,4,12,19,31,26,44,33,31,24,32,
234 24,31,35,22,14,15,13,23,36,59,49,77,65,29,40,30,40,27,33,42,16,22,20,37,61,56,
235 79,73,64,43,76,56,37,26,31,25,14,35,16,60,57,97,75,114,91,54,73,55,41,48,53,
236 23,24,58,27,50,96,76,70,93,84,77,58,79,29,74,49,41,17,47,45,78,74,115,94,90,
237 79,69,83,71,50,59,38,36,15,72,34,56,95,92,85,91,90,86,73,77,65,51,44,43,42,43,
238 20,30,44,55,78,72,87,78,61,46,54,37,30,20,16,53,25,41,37,44,59,54,81,66,76,57,
239 54,37,18,39,11,35,33,31,57,42,82,72,80,47,58,55,21,22,26,38,22,53,25,23,38,70,
240 60,51,36,55,26,34,23,27,14,9,7,34,32,28,39,49,75,30,52,48,40,52,28,18,17,9,5,
241 45,21,34,64,56,50,49,45,31,19,12,15,10,7,6,3,48,23,20,39,36,35,53,21,16,23,13,
242 10,6,1,4,2,16,15,17,27,25,20,29,11,17,12,16,8,1,1,0,1 };
243
244 static const uint8_t t15HB_const[256] =
245 {7,12,18,53,47,76,124,108,89,123,108,119,107,81,122,63,13,5,16,27,46,36,61,51,
246 42,70,52,83,65,41,59,36,19,17,15,24,41,34,59,48,40,64,50,78,62,80,56,33,29,28,
247 25,43,39,63,55,93,76,59,93,72,54,75,50,29,52,22,42,40,67,57,95,79,72,57,89,69,
248 49,66,46,27,77,37,35,66,58,52,91,74,62,48,79,63,90,62,40,38,125,32,60,56,50,
249 92,78,65,55,87,71,51,73,51,70,30,109,53,49,94,88,75,66,122,91,73,56,42,64,44,
250 21,25,90,43,41,77,73,63,56,92,77,66,47,67,48,53,36,20,71,34,67,60,58,49,88,76,
251 67,106,71,54,38,39,23,15,109,53,51,47,90,82,58,57,48,72,57,41,23,27,62,9,86,
252 42,40,37,70,64,52,43,70,55,42,25,29,18,11,11,118,68,30,55,50,46,74,65,49,39,
253 24,16,22,13,14,7,91,44,39,38,34,63,52,45,31,52,28,19,14,8,9,3,123,60,58,53,47,
254 43,32,22,37,24,17,12,15,10,2,1,71,37,34,30,28,20,17,26,21,16,10,6,8,6,2,0};
255
256 static const uint16_t t16HB_const[256] =
257 {1,5,14,44,74,63,110,93,172,149,138,242,225,195,376,17,3,4,12,20,35,62,53,47,
258 83,75,68,119,201,107,207,9,15,13,23,38,67,58,103,90,161,72,127,117,110,209,
259 206,16,45,21,39,69,64,114,99,87,158,140,252,212,199,387,365,26,75,36,68,65,
260 115,101,179,164,155,264,246,226,395,382,362,9,66,30,59,56,102,185,173,265,142,
261 253,232,400,388,378,445,16,111,54,52,100,184,178,160,133,257,244,228,217,385,
262 366,715,10,98,48,91,88,165,157,148,261,248,407,397,372,380,889,884,8,85,84,81,
263 159,156,143,260,249,427,401,392,383,727,713,708,7,154,76,73,141,131,256,245,
264 426,406,394,384,735,359,710,352,11,139,129,67,125,247,233,229,219,393,743,737,
265 720,885,882,439,4,243,120,118,115,227,223,396,746,742,736,721,712,706,223,436,
266 6,202,224,222,218,216,389,386,381,364,888,443,707,440,437,1728,4,747,211,210,
267 208,370,379,734,723,714,1735,883,877,876,3459,865,2,377,369,102,187,726,722,
268 358,711,709,866,1734,871,3458,870,434,0,12,10,7,11,10,17,11,9,13,12,10,7,5,3,
269 1,3};
270
271 static const uint16_t t24HB_const[256] =
272 {15,13,46,80,146,262,248,434,426,669,653,649,621,517,1032,88,14,12,21,38,71,
273 130,122,216,209,198,327,345,319,297,279,42,47,22,41,74,68,128,120,221,207,194,
274 182,340,315,295,541,18,81,39,75,70,134,125,116,220,204,190,178,325,311,293,
275 271,16,147,72,69,135,127,118,112,210,200,188,352,323,306,285,540,14,263,66,
276 129,126,119,114,214,202,192,180,341,317,301,281,262,12,249,123,121,117,113,
277 215,206,195,185,347,330,308,291,272,520,10,435,115,111,109,211,203,196,187,
278 353,332,313,298,283,531,381,17,427,212,208,205,201,193,186,177,169,320,303,
279 286,268,514,377,16,335,199,197,191,189,181,174,333,321,305,289,275,521,379,
280 371,11,668,184,183,179,175,344,331,314,304,290,277,530,383,373,366,10,652,346,
281 171,168,164,318,309,299,287,276,263,513,375,368,362,6,648,322,316,312,307,302,
282 292,284,269,261,512,376,370,364,359,4,620,300,296,294,288,282,273,266,515,380,
283 374,369,365,361,357,2,1033,280,278,274,267,264,259,382,378,372,367,363,360,
284 358,356,0,43,20,19,17,15,13,11,9,7,6,4,7,5,3,1,3};
285
286 static const uint32_t tab1315_const[256] =
287 { 0x010003,0x050005,0x070006,0x080008,0x090008,0x0a0009,0x0a000a,0x0b000a,
288 0x0a000a,0x0b000b,0x0c000b,0x0c000c,0x0d000c,0x0d000c,0x0e000d,0x0e000e,
289 0x040005,0x060005,0x080007,0x090008,0x0a0009,0x0a0009,0x0b000a,0x0b000a,
290 0x0b000a,0x0b000b,0x0c000b,0x0c000c,0x0d000c,0x0e000c,0x0e000d,0x0e000d,
291 0x070006,0x080007,0x090007,0x0a0008,0x0b0009,0x0b0009,0x0c000a,0x0c000a,
292 0x0b000a,0x0c000b,0x0c000b,0x0d000c,0x0d000c,0x0e000d,0x0f000d,0x0f000d,
293 0x080007,0x090008,0x0a0008,0x0b0009,0x0b0009,0x0c000a,0x0c000a,0x0c000b,
294 0x0c000b,0x0d000b,0x0d000c,0x0d000c,0x0d000c,0x0e000d,0x0f000d,0x0f000d,
295 0x090008,0x090008,0x0b0009,0x0b0009,0x0c000a,0x0c000a,0x0d000b,0x0d000b,
296 0x0c000b,0x0d000b,0x0d000c,0x0e000c,0x0e000c,0x0f000d,0x0f000d,0x10000d,
297 0x0a0009,0x0a0009,0x0b0009,0x0c000a,0x0c000a,0x0c000a,0x0d000b,0x0d000b,
298 0x0d000b,0x0d000b,0x0e000c,0x0d000c,0x0f000d,0x0f000d,0x10000d,0x10000e,
299 0x0a000a,0x0b0009,0x0c000a,0x0c000a,0x0d000a,0x0d000b,0x0d000b,0x0d000b,
300 0x0d000b,0x0e000c,0x0e000c,0x0e000c,0x0f000d,0x0f000d,0x10000e,0x10000e,
301 0x0b000a,0x0b000a,0x0c000a,0x0d000b,0x0d000b,0x0d000b,0x0e000b,0x0e000c,
302 0x0e000c,0x0e000c,0x0f000c,0x0f000c,0x0f000d,0x10000d,0x12000d,0x12000e,
303 0x0a000a,0x0a000a,0x0b000a,0x0c000b,0x0c000b,0x0d000b,0x0d000b,0x0e000c,
304 0x0e000c,0x0e000c,0x0e000c,0x0f000d,0x0f000d,0x10000e,0x11000e,0x11000e,
305 0x0b000a,0x0b000a,0x0c000b,0x0c000b,0x0d000b,0x0d000b,0x0d000c,0x0f000c,
306 0x0e000c,0x0f000d,0x0f000d,0x10000d,0x10000d,0x10000e,0x12000e,0x11000e,
307 0x0b000b,0x0c000b,0x0c000b,0x0d000b,0x0d000c,0x0e000c,0x0e000c,0x0f000c,
308 0x0e000c,0x0f000d,0x10000d,0x0f000d,0x10000d,0x11000e,0x12000f,0x13000e,
309 0x0c000b,0x0c000b,0x0c000b,0x0d000b,0x0e000c,0x0e000c,0x0e000c,0x0e000c,
310 0x0f000d,0x0f000d,0x0f000d,0x10000d,0x11000e,0x11000e,0x11000e,0x12000f,
311 0x0c000c,0x0d000c,0x0d000b,0x0e000c,0x0e000c,0x0f000c,0x0e000d,0x0f000d,
312 0x10000d,0x10000d,0x11000d,0x11000d,0x11000e,0x12000e,0x12000f,0x12000f,
313 0x0d000c,0x0d000c,0x0e000c,0x0f000c,0x0f000c,0x0f000d,0x10000d,0x10000d,
314 0x10000d,0x10000e,0x10000e,0x11000e,0x12000e,0x11000e,0x12000f,0x12000f,
315 0x0e000d,0x0e000d,0x0e000d,0x0f000d,0x0f000d,0x0f000d,0x11000d,0x10000d,
316 0x10000e,0x13000e,0x11000e,0x11000e,0x11000f,0x13000f,0x12000e,0x12000f,
317 0x0d000d,0x0e000d,0x0f000d,0x10000d,0x10000d,0x10000d,0x11000d,0x10000e,
318 0x11000e,0x11000e,0x12000e,0x12000e,0x15000f,0x14000f,0x15000f,0x12000f };
319
320 static const uint32_t tab01_const[16] =
321 { 0x10004,0x50005,0x50005,0x70006,0x50005,0x80006,0x70006,0x90007,
322 0x50005,0x70006,0x70006,0x90007,0x70006,0x90007,0x90007,0xa0008 };
323
324 static const uint32_t tab23_const[ 9] =
325 { 0x10002,0x40003,0x70007,0x40004,0x50004,0x70007,0x60006,0x70007,0x80008 };
326
327 static const uint32_t tab56_const[16] =
328 { 0x10003,0x40004,0x70006,0x80008,0x40004,0x50004,0x80006,0x90007,
329 0x70005,0x80006,0x90007,0xa0008,0x80007,0x80007,0x90008,0xa0009 };
330
331 static const uint32_t tab789_const[36] =
332 {0x00100803,0x00401004,0x00701c06,0x00902407,0x00902409,0x00a0280a,0x00401004,
333 0x00601005,0x00801806,0x00902807,0x00902808,0x00a0280a,0x00701c05,0x00701806,
334 0x00902007,0x00a02808,0x00a02809,0x00b02c0a,0x00802407,0x00902807,0x00a02808,
335 0x00b02c09,0x00b02c09,0x00b0300a,0x00802408,0x00902408,0x00a02809,0x00b02c09,
336 0x00b0300a,0x00c0300b,0x00902809,0x00a02809,0x00b02c0a,0x00c02c0a,0x00c0340b,
337 0x00c0340b};
338
339 static const uint32_t tabABC_const[64] =
340 {0x00100804,0x00401004,0x00701806,0x00902008,0x00a02409,0x00a0280a,0x00a0240a,
341 0x00b0280a,0x00401004,0x00601405,0x00801806,0x00902007,0x00a02809,0x00b02809,
342 0x00a0240a,0x00a0280a,0x00701806,0x00801c06,0x00902007,0x00a02408,0x00b02809,
343 0x00c02c0a,0x00b02809,0x00b0280a,0x00802007,0x00902007,0x00a02408,0x00b02c08,
344 0x00c02809,0x00c0300a,0x00b0280a,0x00c02c0a,0x00902408,0x00a02808,0x00b02809,
345 0x00c02c09,0x00c02c0a,0x00c0300a,0x00c02c0a,0x00c0300b,0x00a02409,0x00b02809,
346 0x00c02c0a,0x00c0300a,0x00d0300a,0x00d0340b,0x00c0300a,0x00d0340b,0x00902409,
347 0x00a02409,0x00b02409,0x00c0280a,0x00c02c0a,0x00c0300b,0x00d0300b,0x00d0300c,
348 0x00a0240a,0x00a0240a,0x00b0280a,0x00c02c0b,0x00c0300b,0x00d0300b,0x00d0300b,
349 0x00d0300c};
350
351 static const uint32_t tab1624_const[256] =
352 {0x00010004,0x00050005,0x00070007,0x00090008,0x000a0009,0x000a000a,0x000b000a,
353 0x000b000b,0x000c000b,0x000c000c,0x000c000c,0x000d000c,0x000d000c,0x000d000c,
354 0x000e000d,0x000a000a,0x00040005,0x00060006,0x00080007,0x00090008,0x000a0009,
355 0x000b000a,0x000b000a,0x000b000b,0x000c000b,0x000c000b,0x000c000c,0x000d000c,
356 0x000e000c,0x000d000c,0x000e000c,0x000a000a,0x00070007,0x00080007,0x00090008,
357 0x000a0009,0x000b0009,0x000b000a,0x000c000a,0x000c000b,0x000d000b,0x000c000b,
358 0x000d000b,0x000d000c,0x000d000c,0x000e000c,0x000e000d,0x000b0009,0x00090008,
359 0x00090008,0x000a0009,0x000b0009,0x000b000a,0x000c000a,0x000c000a,0x000c000b,
360 0x000d000b,0x000d000b,0x000e000b,0x000e000c,0x000e000c,0x000f000c,0x000f000c,
361 0x000c0009,0x000a0009,0x000a0009,0x000b0009,0x000b000a,0x000c000a,0x000c000a,
362 0x000d000a,0x000d000b,0x000d000b,0x000e000b,0x000e000c,0x000e000c,0x000f000c,
363 0x000f000c,0x000f000d,0x000b0009,0x000a000a,0x000a0009,0x000b000a,0x000b000a,
364 0x000c000a,0x000d000a,0x000d000b,0x000e000b,0x000d000b,0x000e000b,0x000e000c,
365 0x000f000c,0x000f000c,0x000f000c,0x0010000c,0x000c0009,0x000b000a,0x000b000a,
366 0x000b000a,0x000c000a,0x000d000a,0x000d000b,0x000d000b,0x000d000b,0x000e000b,
367 0x000e000c,0x000e000c,0x000e000c,0x000f000c,0x000f000c,0x0010000d,0x000c0009,
368 0x000b000b,0x000b000a,0x000c000a,0x000c000a,0x000d000b,0x000d000b,0x000d000b,
369 0x000e000b,0x000e000c,0x000f000c,0x000f000c,0x000f000c,0x000f000c,0x0011000d,
370 0x0011000d,0x000c000a,0x000b000b,0x000c000b,0x000c000b,0x000d000b,0x000d000b,
371 0x000d000b,0x000e000b,0x000e000b,0x000f000b,0x000f000c,0x000f000c,0x000f000c,
372 0x0010000c,0x0010000d,0x0010000d,0x000c000a,0x000c000b,0x000c000b,0x000c000b,
373 0x000d000b,0x000d000b,0x000e000b,0x000e000b,0x000f000c,0x000f000c,0x000f000c,
374 0x000f000c,0x0010000c,0x000f000d,0x0010000d,0x000f000d,0x000d000a,0x000c000c,
375 0x000d000b,0x000c000b,0x000d000b,0x000e000b,0x000e000c,0x000e000c,0x000e000c,
376 0x000f000c,0x0010000c,0x0010000c,0x0010000d,0x0011000d,0x0011000d,0x0010000d,
377 0x000c000a,0x000d000c,0x000d000c,0x000d000b,0x000d000b,0x000e000b,0x000e000c,
378 0x000f000c,0x0010000c,0x0010000c,0x0010000c,0x0010000c,0x0010000d,0x0010000d,
379 0x000f000d,0x0010000d,0x000d000a,0x000d000c,0x000e000c,0x000e000c,0x000e000c,
380 0x000e000c,0x000f000c,0x000f000c,0x000f000c,0x000f000c,0x0011000c,0x0010000d,
381 0x0010000d,0x0010000d,0x0010000d,0x0012000d,0x000d000a,0x000f000c,0x000e000c,
382 0x000e000c,0x000e000c,0x000f000c,0x000f000c,0x0010000c,0x0010000c,0x0010000d,
383 0x0012000d,0x0011000d,0x0011000d,0x0011000d,0x0013000d,0x0011000d,0x000d000a,
384 0x000e000d,0x000f000c,0x000d000c,0x000e000c,0x0010000c,0x0010000c,0x000f000c,
385 0x0010000d,0x0010000d,0x0011000d,0x0012000d,0x0011000d,0x0013000d,0x0011000d,
386 0x0010000d,0x000d000a,0x000a0009,0x000a0009,0x000a0009,0x000b0009,0x000b0009,
387 0x000c0009,0x000c0009,0x000c0009,0x000d0009,0x000d0009,0x000d0009,0x000d000a,
388 0x000d000a,0x000d000a,0x000d000a,0x000a0006};
389
390 static const uint8_t t1l_const[8] = {1,3,2,3,1,4,3,5};
391 static const uint8_t t2l_const[9] = {1,3,6,3,3,5,5,5,6};
392 static const uint8_t t3l_const[9] = {2,2,6,3,2,5,5,5,6};
393 static const uint8_t t5l_const[16] = {1,3,6,7,3,3,6,7,6,6,7,8,7,6,7,8};
394 static const uint8_t t6l_const[16] = {3,3,5,7,3,2,4,5,4,4,5,6,6,5,6,7};
395
396 static const uint8_t t7l_const[36] =
397 {1,3,6,8,8,9,3,4,6,7,7,8,6,5,7,8,8,9,7,7,8,9,9,9,7,7,8,9,9,10,8,8,9,10,10,10};
398
399 static const uint8_t t8l_const[36] =
400 {2,3,6,8,8,9,3,2,4,8,8,8,6,4,6,8,8,9,8,8,8,9,9,10,8,7,8,9,10,10,9,8,9,9,11,11};
401
402 static const uint8_t t9l_const[36] =
403 {3,3,5,6,8,9,3,3,4,5,6,8,4,4,5,6,7,8,6,5,6,7,7,8,7,6,7,7,8,9,8,7,8,8,9,9};
404
405 static const uint8_t t10l_const[64] =
406 {1,3,6,8,9,9,9,10,3,4,6,7,8,9,8,8,6,6,7,8,9,10,9,9,7,7,8,9,10,10,9,10,8,8,9,10,
407 10,10,10,10,9,9,10,10,11,11,10,11,8,8,9,10,10,10,11,11,9,8,9,10,10,11,11,11};
408
409 static const uint8_t t11l_const[64] =
410 {2,3,5,7,8,9,8,9,3,3,4,6,8,8,7,8,5,5,6,7,8,9,8,8,7,6,7,9,8,10,8,9,8,8,8,9,9,10,
411 9,10,8,8,9,10,10,11,10,11,8,7,7,8,9,10,10,10,8,7,8,9,10,10,10,10};
412
413 static const uint8_t t12l_const[64] =
414 {4,3,5,7,8,9,9,9,3,3,4,5,7,7,8,8,5,4,5,6,7,8,7,8,6,5,6,6,7,8,8,8,7,6,7,7,8,
415 8,8,9,8,7,8,8,8,9,8,9,8,7,7,8,8,9,9,10,9,8,8,9,9,9,9,10};
416
417 static const uint8_t t13l_const[256] =
418 {1,4,6,7,8,9,9,10,9,10,11,11,12,12,13,13,3,4,6,7,8,8,9,9,9,9,10,10,11,12,12,12,
419 6,6,7,8,9,9,10,10,9,10,10,11,11,12,13,13,7,7,8,9,9,10,10,10,10,11,11,11,11,12,
420 13,13,8,7,9,9,10,10,11,11,10,11,11,12,12,13,13,14,9,8,9,10,10,10,11,11,11,11,
421 12,11,13,13,14,14,9,9,10,10,11,11,11,11,11,12,12,12,13,13,14,14,10,9,10,11,11,
422 11,12,12,12,12,13,13,13,14,16,16,9,8,9,10,10,11,11,12,12,12,12,13,13,14,15,15,
423 10,9,10,10,11,11,11,13,12,13,13,14,14,14,16,15,10,10,10,11,11,12,12,13,12,13,
424 14,13,14,15,16,17,11,10,10,11,12,12,12,12,13,13,13,14,15,15,15,16,11,11,11,12,
425 12,13,12,13,14,14,15,15,15,16,16,16,12,11,12,13,13,13,14,14,14,14,14,15,16,15,
426 16,16,13,12,12,13,13,13,15,14,14,17,15,15,15,17,16,16,12,12,13,14,14,14,15,14,
427 15,15,16,16,19,18,19,16};
428
429 static const uint8_t t15l_const[256] =
430 {3,4,5,7,7,8,9,9,9,10,10,11,11,11,12,13,4,3,5,6,7,7,8,8,8,9,9,10,10,10,11,11,5,
431 5,5,6,7,7,8,8,8,9,9,10,10,11,11,11,6,6,6,7,7,8,8,9,9,9,10,10,10,11,11,11,7,6,
432 7,7,8,8,9,9,9,9,10,10,10,11,11,11,8,7,7,8,8,8,9,9,9,9,10,10,11,11,11,12,9,7,8,
433 8,8,9,9,9,9,10,10,10,11,11,12,12,9,8,8,9,9,9,9,10,10,10,10,10,11,11,11,12,9,8,
434 8,9,9,9,9,10,10,10,10,11,11,12,12,12,9,8,9,9,9,9,10,10,10,11,11,11,11,12,12,
435 12,10,9,9,9,10,10,10,10,10,11,11,11,11,12,13,12,10,9,9,9,10,10,10,10,11,11,11,
436 11,12,12,12,13,11,10,9,10,10,10,11,11,11,11,11,11,12,12,13,13,11,10,10,10,10,
437 11,11,11,11,12,12,12,12,12,13,13,12,11,11,11,11,11,11,11,12,12,12,12,13,13,12,
438 13,12,11,11,11,11,11,11,12,12,12,12,12,13,13,13,13};
439
440 static const uint8_t t16l_const[256] =
441 {1,4,6,8,9,9,10,10,11,11,11,12,12,12,13,9,3,4,6,7,8,9,9,9,10,10,10,11,12,11,12,
442 8,6,6,7,8,9,9,10,10,11,10,11,11,11,12,12,9,8,7,8,9,9,10,10,10,11,11,12,12,12,
443 13,13,10,9,8,9,9,10,10,11,11,11,12,12,12,13,13,13,9,9,8,9,9,10,11,11,12,11,12,
444 12,13,13,13,14,10,10,9,9,10,11,11,11,11,12,12,12,12,13,13,14,10,10,9,10,10,11,
445 11,11,12,12,13,13,13,13,15,15,10,10,10,10,11,11,11,12,12,13,13,13,13,14,14,14,
446 10,11,10,10,11,11,12,12,13,13,13,13,14,13,14,13,11,11,11,10,11,12,12,12,12,13,
447 14,14,14,15,15,14,10,12,11,11,11,12,12,13,14,14,14,14,14,14,13,14,11,12,12,12,
448 12,12,13,13,13,13,15,14,14,14,14,16,11,14,12,12,12,13,13,14,14,14,16,15,15,15,
449 17,15,11,13,13,11,12,14,14,13,14,14,15,16,15,17,15,14,11,9,8,8,9,9,10,10,10,
450 11,11,11,11,11,11,11,8};
451
452 static const uint8_t t24l_const[256] =
453 {4,4,6,7,8,9,9,10,10,11,11,11,11,11,12,9,4,4,5,6,7,8,8,9,9,9,10,10,10,10,10,8,
454 6,5,6,7,7,8,8,9,9,9,9,10,10,10,11,7,7,6,7,7,8,8,8,9,9,9,9,10,10,10,10,7,8,7,7,
455 8,8,8,8,9,9,9,10,10,10,10,11,7,9,7,8,8,8,8,9,9,9,9,10,10,10,10,10,7,9,8,8,8,8,
456 9,9,9,9,10,10,10,10,10,11,7,10,8,8,8,9,9,9,9,10,10,10,10,10,11,11,8,10,9,9,9,
457 9,9,9,9,9,10,10,10,10,11,11,8,10,9,9,9,9,9,9,10,10,10,10,10,11,11,11,8,11,9,9,
458 9,9,10,10,10,10,10,10,11,11,11,11,8,11,10,9,9,9,10,10,10,10,10,10,11,11,11,11,
459 8,11,10,10,10,10,10,10,10,10,10,11,11,11,11,11,8,11,10,10,10,10,10,10,10,11,
460 11,11,11,11,11,11,8,12,10,10,10,10,10,10,11,11,11,11,11,11,11,11,8,8,7,7,7,7,
461 7,7,7,7,7,7,8,8,8,8,4};
462
463 static const struct huffcodetab ht_const[HTN] =
464 { { 0, NULL, NULL}, /* Apparently not used */
465 { 2, t1HB, t1l},
466 { 3, t2HB, t2l},
467 { 3, t3HB, t3l},
468 { 0, NULL, NULL}, /* Apparently not used */
469 { 4, t5HB, t5l},
470 { 4, t6HB, t6l},
471 { 6, t7HB, t7l},
472 { 6, t8HB, t8l},
473 { 6, t9HB, t9l},
474 { 8, t10HB, t10l},
475 { 8, t11HB, t11l},
476 { 8, t12HB, t12l},
477 {16, t13HB, t13l},
478 { 0, NULL, NULL}, /* Apparently not used */
479 {16, t15HB, t15l} };
480
481 static const struct huffcodebig ht_big[HTN] =
482 { { 16, 1, 1 },
483 { 16, 2, 3 },
484 { 16, 3, 7 },
485 { 16, 4, 15 },
486 { 16, 6, 63 },
487 { 16, 8, 255 },
488 { 16, 10, 1023 },
489 { 16, 13, 8191 },
490 { 16, 4, 15 },
491 { 16, 5, 31 },
492 { 16, 6, 63 },
493 { 16, 7, 127 },
494 { 16, 8, 255 },
495 { 16, 9, 511 },
496 { 16, 11, 2047 },
497 { 16, 13, 8191 } };
498
499 static const struct
500 {
501 uint32_t region0_cnt;
502 uint32_t region1_cnt;
503 } subdv_table[23] =
504 { {0, 0}, /* 0 bands */
505 {0, 0}, /* 1 bands */
506 {0, 0}, /* 2 bands */
507 {0, 0}, /* 3 bands */
508 {0, 0}, /* 4 bands */
509 {0, 1}, /* 5 bands */
510 {1, 1}, /* 6 bands */
511 {1, 1}, /* 7 bands */
512 {1, 2}, /* 8 bands */
513 {2, 2}, /* 9 bands */
514 {2, 3}, /* 10 bands */
515 {2, 3}, /* 11 bands */
516 {3, 4}, /* 12 bands */
517 {3, 4}, /* 13 bands */
518 {3, 4}, /* 14 bands */
519 {4, 5}, /* 15 bands */
520 {4, 5}, /* 16 bands */
521 {4, 6}, /* 17 bands */
522 {5, 6}, /* 18 bands */
523 {5, 6}, /* 19 bands */
524 {5, 7}, /* 20 bands */
525 {6, 7}, /* 21 bands */
526 {6, 7}, /* 22 bands */
527 };
528
529 static const uint32_t sfBand[6][23] =
530 {
531 /* Table B.2.b: 22.05 kHz */
532 {0,6,12,18,24,30,36,44,54,66,80,96,116,140,168,200,238,284,336,396,464,522,576},
533 /* Table B.2.c: 24 kHz */
534 {0,6,12,18,24,30,36,44,54,66,80,96,114,136,162,194,232,278,330,394,464,540,576},
535 /* Table B.2.a: 16 kHz */
536 {0,6,12,18,24,30,36,44,45,66,80,96,116,140,168,200,238,248,336,396,464,522,576},
537 /* Table B.8.b: 44.1 kHz */
538 {0,4, 8,12,16,20,24,30,36,44,52,62, 74, 90,110,134,162,196,238,288,342,418,576},
539 /* Table B.8.c: 48 kHz */
540 {0,4, 8,12,16,20,24,30,36,42,50,60, 72, 88,106,128,156,190,230,276,330,384,576},
541 /* Table B.8.a: 32 kHz */
542 {0,4, 8,12,16,20,24,30,36,44,54,66, 82,102,126,156,194,240,296,364,448,550,576} };
543
544
545 static const short int2idx_const[4096] = /* int2idx[i] = sqrt(i*sqrt(i)); */
546 {
547 0, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 8, 8, 8, 9, 9,
548 9, 10, 10, 11, 11, 11, 12, 12, 12, 12, 13, 13, 13, 14, 14, 14, 15, 15, 15, 16,
549 16, 16, 16, 17, 17, 17, 18, 18, 18, 19, 19, 19, 19, 20, 20, 20, 20, 21, 21, 21,
550 22, 22, 22, 22, 23, 23, 23, 23, 24, 24, 24, 24, 25, 25, 25, 25, 26, 26, 26, 26,
551 27, 27, 27, 27, 28, 28, 28, 28, 29, 29, 29, 29, 30, 30, 30, 30, 31, 31, 31, 31,
552 32, 32, 32, 32, 33, 33, 33, 33, 34, 34, 34, 34, 34, 35, 35, 35, 35, 36, 36, 36,
553 36, 36, 37, 37, 37, 37, 38, 38, 38, 38, 38, 39, 39, 39, 39, 40, 40, 40, 40, 40,
554 41, 41, 41, 41, 42, 42, 42, 42, 42, 43, 43, 43, 43, 44, 44, 44, 44, 44, 45, 45,
555 45, 45, 45, 46, 46, 46, 46, 46, 47, 47, 47, 47, 47, 48, 48, 48, 48, 49, 49, 49,
556 49, 49, 50, 50, 50, 50, 50, 51, 51, 51, 51, 51, 52, 52, 52, 52, 52, 53, 53, 53,
557 53, 53, 54, 54, 54, 54, 54, 55, 55, 55, 55, 55, 56, 56, 56, 56, 56, 57, 57, 57,
558 57, 57, 58, 58, 58, 58, 58, 58, 59, 59, 59, 59, 59, 60, 60, 60, 60, 60, 61, 61,
559 61, 61, 61, 62, 62, 62, 62, 62, 62, 63, 63, 63, 63, 63, 64, 64, 64, 64, 64, 65,
560 65, 65, 65, 65, 65, 66, 66, 66, 66, 66, 67, 67, 67, 67, 67, 68, 68, 68, 68, 68,
561 68, 69, 69, 69, 69, 69, 70, 70, 70, 70, 70, 70, 71, 71, 71, 71, 71, 72, 72, 72,
562 72, 72, 72, 73, 73, 73, 73, 73, 74, 74, 74, 74, 74, 74, 75, 75, 75, 75, 75, 75,
563 76, 76, 76, 76, 76, 77, 77, 77, 77, 77, 77, 78, 78, 78, 78, 78, 78, 79, 79, 79,
564 79, 79, 80, 80, 80, 80, 80, 80, 81, 81, 81, 81, 81, 81, 82, 82, 82, 82, 82, 82,
565 83, 83, 83, 83, 83, 84, 84, 84, 84, 84, 84, 85, 85, 85, 85, 85, 85, 86, 86, 86,
566 86, 86, 86, 87, 87, 87, 87, 87, 87, 88, 88, 88, 88, 88, 88, 89, 89, 89, 89, 89,
567 89, 90, 90, 90, 90, 90, 90, 91, 91, 91, 91, 91, 91, 92, 92, 92, 92, 92, 92, 93,
568 93, 93, 93, 93, 93, 94, 94, 94, 94, 94, 94, 95, 95, 95, 95, 95, 95, 96, 96, 96,
569 96, 96, 96, 97, 97, 97, 97, 97, 97, 98, 98, 98, 98, 98, 98, 99, 99, 99, 99, 99,
570 99, 99,100,100,100,100,100,100,101,101,101,101,101,101,102,102,102,102,102,102,
571 103,103,103,103,103,103,104,104,104,104,104,104,104,105,105,105,105,105,105,106,
572 106,106,106,106,106,107,107,107,107,107,107,107,108,108,108,108,108,108,109,109,
573 109,109,109,109,110,110,110,110,110,110,110,111,111,111,111,111,111,112,112,112,
574 112,112,112,112,113,113,113,113,113,113,114,114,114,114,114,114,115,115,115,115,
575 115,115,115,116,116,116,116,116,116,117,117,117,117,117,117,117,118,118,118,118,
576 118,118,118,119,119,119,119,119,119,120,120,120,120,120,120,120,121,121,121,121,
577 121,121,122,122,122,122,122,122,122,123,123,123,123,123,123,123,124,124,124,124,
578 124,124,125,125,125,125,125,125,125,126,126,126,126,126,126,126,127,127,127,127,
579 127,127,128,128,128,128,128,128,128,129,129,129,129,129,129,129,130,130,130,130,
580 130,130,131,131,131,131,131,131,131,132,132,132,132,132,132,132,133,133,133,133,
581 133,133,133,134,134,134,134,134,134,134,135,135,135,135,135,135,136,136,136,136,
582 136,136,136,137,137,137,137,137,137,137,138,138,138,138,138,138,138,139,139,139,
583 139,139,139,139,140,140,140,140,140,140,140,141,141,141,141,141,141,141,142,142,
584 142,142,142,142,142,143,143,143,143,143,143,143,144,144,144,144,144,144,144,145,
585 145,145,145,145,145,145,146,146,146,146,146,146,146,147,147,147,147,147,147,147,
586 148,148,148,148,148,148,148,149,149,149,149,149,149,149,150,150,150,150,150,150,
587 150,151,151,151,151,151,151,151,152,152,152,152,152,152,152,153,153,153,153,153,
588 153,153,154,154,154,154,154,154,154,154,155,155,155,155,155,155,155,156,156,156,
589 156,156,156,156,157,157,157,157,157,157,157,158,158,158,158,158,158,158,159,159,
590 159,159,159,159,159,160,160,160,160,160,160,160,160,161,161,161,161,161,161,161,
591 162,162,162,162,162,162,162,163,163,163,163,163,163,163,163,164,164,164,164,164,
592 164,164,165,165,165,165,165,165,165,166,166,166,166,166,166,166,167,167,167,167,
593 167,167,167,167,168,168,168,168,168,168,168,169,169,169,169,169,169,169,169,170,
594 170,170,170,170,170,170,171,171,171,171,171,171,171,172,172,172,172,172,172,172,
595 172,173,173,173,173,173,173,173,174,174,174,174,174,174,174,174,175,175,175,175,
596 175,175,175,176,176,176,176,176,176,176,176,177,177,177,177,177,177,177,178,178,
597 178,178,178,178,178,178,179,179,179,179,179,179,179,180,180,180,180,180,180,180,
598 180,181,181,181,181,181,181,181,182,182,182,182,182,182,182,182,183,183,183,183,
599 183,183,183,184,184,184,184,184,184,184,184,185,185,185,185,185,185,185,186,186,
600 186,186,186,186,186,186,187,187,187,187,187,187,187,187,188,188,188,188,188,188,
601 188,189,189,189,189,189,189,189,189,190,190,190,190,190,190,190,190,191,191,191,
602 191,191,191,191,192,192,192,192,192,192,192,192,193,193,193,193,193,193,193,193,
603 194,194,194,194,194,194,194,195,195,195,195,195,195,195,195,196,196,196,196,196,
604 196,196,196,197,197,197,197,197,197,197,197,198,198,198,198,198,198,198,199,199,
605 199,199,199,199,199,199,200,200,200,200,200,200,200,200,201,201,201,201,201,201,
606 201,201,202,202,202,202,202,202,202,202,203,203,203,203,203,203,203,204,204,204,
607 204,204,204,204,204,205,205,205,205,205,205,205,205,206,206,206,206,206,206,206,
608 206,207,207,207,207,207,207,207,207,208,208,208,208,208,208,208,208,209,209,209,
609 209,209,209,209,209,210,210,210,210,210,210,210,210,211,211,211,211,211,211,211,
610 211,212,212,212,212,212,212,212,212,213,213,213,213,213,213,213,213,214,214,214,
611 214,214,214,214,214,215,215,215,215,215,215,215,215,216,216,216,216,216,216,216,
612 216,217,217,217,217,217,217,217,217,218,218,218,218,218,218,218,218,219,219,219,
613 219,219,219,219,219,220,220,220,220,220,220,220,220,221,221,221,221,221,221,221,
614 221,222,222,222,222,222,222,222,222,223,223,223,223,223,223,223,223,224,224,224,
615 224,224,224,224,224,225,225,225,225,225,225,225,225,226,226,226,226,226,226,226,
616 226,227,227,227,227,227,227,227,227,228,228,228,228,228,228,228,228,229,229,229,
617 229,229,229,229,229,229,230,230,230,230,230,230,230,230,231,231,231,231,231,231,
618 231,231,232,232,232,232,232,232,232,232,233,233,233,233,233,233,233,233,234,234,
619 234,234,234,234,234,234,234,235,235,235,235,235,235,235,235,236,236,236,236,236,
620 236,236,236,237,237,237,237,237,237,237,237,238,238,238,238,238,238,238,238,238,
621 239,239,239,239,239,239,239,239,240,240,240,240,240,240,240,240,241,241,241,241,
622 241,241,241,241,242,242,242,242,242,242,242,242,242,243,243,243,243,243,243,243,
623 243,244,244,244,244,244,244,244,244,245,245,245,245,245,245,245,245,245,246,246,
624 246,246,246,246,246,246,247,247,247,247,247,247,247,247,248,248,248,248,248,248,
625 248,248,248,249,249,249,249,249,249,249,249,250,250,250,250,250,250,250,250,250,
626 251,251,251,251,251,251,251,251,252,252,252,252,252,252,252,252,253,253,253,253,
627 253,253,253,253,253,254,254,254,254,254,254,254,254,255,255,255,255,255,255,255,
628 255,255,256,256,256,256,256,256,256,256,257,257,257,257,257,257,257,257,257,258,
629 258,258,258,258,258,258,258,259,259,259,259,259,259,259,259,259,260,260,260,260,
630 260,260,260,260,261,261,261,261,261,261,261,261,261,262,262,262,262,262,262,262,
631 262,263,263,263,263,263,263,263,263,263,264,264,264,264,264,264,264,264,265,265,
632 265,265,265,265,265,265,265,266,266,266,266,266,266,266,266,267,267,267,267,267,
633 267,267,267,267,268,268,268,268,268,268,268,268,268,269,269,269,269,269,269,269,
634 269,270,270,270,270,270,270,270,270,270,271,271,271,271,271,271,271,271,271,272,
635 272,272,272,272,272,272,272,273,273,273,273,273,273,273,273,273,274,274,274,274,
636 274,274,274,274,275,275,275,275,275,275,275,275,275,276,276,276,276,276,276,276,
637 276,276,277,277,277,277,277,277,277,277,277,278,278,278,278,278,278,278,278,279,
638 279,279,279,279,279,279,279,279,280,280,280,280,280,280,280,280,280,281,281,281,
639 281,281,281,281,281,282,282,282,282,282,282,282,282,282,283,283,283,283,283,283,
640 283,283,283,284,284,284,284,284,284,284,284,284,285,285,285,285,285,285,285,285,
641 286,286,286,286,286,286,286,286,286,287,287,287,287,287,287,287,287,287,288,288,
642 288,288,288,288,288,288,288,289,289,289,289,289,289,289,289,289,290,290,290,290,
643 290,290,290,290,291,291,291,291,291,291,291,291,291,292,292,292,292,292,292,292,
644 292,292,293,293,293,293,293,293,293,293,293,294,294,294,294,294,294,294,294,294,
645 295,295,295,295,295,295,295,295,295,296,296,296,296,296,296,296,296,296,297,297,
646 297,297,297,297,297,297,297,298,298,298,298,298,298,298,298,299,299,299,299,299,
647 299,299,299,299,300,300,300,300,300,300,300,300,300,301,301,301,301,301,301,301,
648 301,301,302,302,302,302,302,302,302,302,302,303,303,303,303,303,303,303,303,303,
649 304,304,304,304,304,304,304,304,304,305,305,305,305,305,305,305,305,305,306,306,
650 306,306,306,306,306,306,306,307,307,307,307,307,307,307,307,307,308,308,308,308,
651 308,308,308,308,308,309,309,309,309,309,309,309,309,309,310,310,310,310,310,310,
652 310,310,310,311,311,311,311,311,311,311,311,311,312,312,312,312,312,312,312,312,
653 312,313,313,313,313,313,313,313,313,313,314,314,314,314,314,314,314,314,314,315,
654 315,315,315,315,315,315,315,315,316,316,316,316,316,316,316,316,316,317,317,317,
655 317,317,317,317,317,317,318,318,318,318,318,318,318,318,318,318,319,319,319,319,
656 319,319,319,319,319,320,320,320,320,320,320,320,320,320,321,321,321,321,321,321,
657 321,321,321,322,322,322,322,322,322,322,322,322,323,323,323,323,323,323,323,323,
658 323,324,324,324,324,324,324,324,324,324,325,325,325,325,325,325,325,325,325,325,
659 326,326,326,326,326,326,326,326,326,327,327,327,327,327,327,327,327,327,328,328,
660 328,328,328,328,328,328,328,329,329,329,329,329,329,329,329,329,330,330,330,330,
661 330,330,330,330,330,330,331,331,331,331,331,331,331,331,331,332,332,332,332,332,
662 332,332,332,332,333,333,333,333,333,333,333,333,333,334,334,334,334,334,334,334,
663 334,334,335,335,335,335,335,335,335,335,335,335,336,336,336,336,336,336,336,336,
664 336,337,337,337,337,337,337,337,337,337,338,338,338,338,338,338,338,338,338,338,
665 339,339,339,339,339,339,339,339,339,340,340,340,340,340,340,340,340,340,341,341,
666 341,341,341,341,341,341,341,341,342,342,342,342,342,342,342,342,342,343,343,343,
667 343,343,343,343,343,343,344,344,344,344,344,344,344,344,344,344,345,345,345,345,
668 345,345,345,345,345,346,346,346,346,346,346,346,346,346,347,347,347,347,347,347,
669 347,347,347,347,348,348,348,348,348,348,348,348,348,349,349,349,349,349,349,349,
670 349,349,350,350,350,350,350,350,350,350,350,350,351,351,351,351,351,351,351,351,
671 351,352,352,352,352,352,352,352,352,352,352,353,353,353,353,353,353,353,353,353,
672 354,354,354,354,354,354,354,354,354,355,355,355,355,355,355,355,355,355,355,356,
673 356,356,356,356,356,356,356,356,357,357,357,357,357,357,357,357,357,357,358,358,
674 358,358,358,358,358,358,358,359,359,359,359,359,359,359,359,359,359,360,360,360,
675 360,360,360,360,360,360,361,361,361,361,361,361,361,361,361,361,362,362,362,362,
676 362,362,362,362,362,363,363,363,363,363,363,363,363,363,363,364,364,364,364,364,
677 364,364,364,364,365,365,365,365,365,365,365,365,365,365,366,366,366,366,366,366,
678 366,366,366,367,367,367,367,367,367,367,367,367,367,368,368,368,368,368,368,368,
679 368,368,369,369,369,369,369,369,369,369,369,369,370,370,370,370,370,370,370,370,
680 370,370,371,371,371,371,371,371,371,371,371,372,372,372,372,372,372,372,372,372,
681 372,373,373,373,373,373,373,373,373,373,374,374,374,374,374,374,374,374,374,374,
682 375,375,375,375,375,375,375,375,375,375,376,376,376,376,376,376,376,376,376,377,
683 377,377,377,377,377,377,377,377,377,378,378,378,378,378,378,378,378,378,379,379,
684 379,379,379,379,379,379,379,379,380,380,380,380,380,380,380,380,380,380,381,381,
685 381,381,381,381,381,381,381,382,382,382,382,382,382,382,382,382,382,383,383,383,
686 383,383,383,383,383,383,383,384,384,384,384,384,384,384,384,384,385,385,385,385,
687 385,385,385,385,385,385,386,386,386,386,386,386,386,386,386,386,387,387,387,387,
688 387,387,387,387,387,387,388,388,388,388,388,388,388,388,388,389,389,389,389,389,
689 389,389,389,389,389,390,390,390,390,390,390,390,390,390,390,391,391,391,391,391,
690 391,391,391,391,391,392,392,392,392,392,392,392,392,392,393,393,393,393,393,393,
691 393,393,393,393,394,394,394,394,394,394,394,394,394,394,395,395,395,395,395,395,
692 395,395,395,395,396,396,396,396,396,396,396,396,396,397,397,397,397,397,397,397,
693 397,397,397,398,398,398,398,398,398,398,398,398,398,399,399,399,399,399,399,399,
694 399,399,399,400,400,400,400,400,400,400,400,400,400,401,401,401,401,401,401,401,
695 401,401,402,402,402,402,402,402,402,402,402,402,403,403,403,403,403,403,403,403,
696 403,403,404,404,404,404,404,404,404,404,404,404,405,405,405,405,405,405,405,405,
697 405,405,406,406,406,406,406,406,406,406,406,406,407,407,407,407,407,407,407,407,
698 407,407,408,408,408,408,408,408,408,408,408,408,409,409,409,409,409,409,409,409,
699 409,410,410,410,410,410,410,410,410,410,410,411,411,411,411,411,411,411,411,411,
700 411,412,412,412,412,412,412,412,412,412,412,413,413,413,413,413,413,413,413,413,
701 413,414,414,414,414,414,414,414,414,414,414,415,415,415,415,415,415,415,415,415,
702 415,416,416,416,416,416,416,416,416,416,416,417,417,417,417,417,417,417,417,417,
703 417,418,418,418,418,418,418,418,418,418,418,419,419,419,419,419,419,419,419,419,
704 419,420,420,420,420,420,420,420,420,420,420,421,421,421,421,421,421,421,421,421,
705 421,422,422,422,422,422,422,422,422,422,422,423,423,423,423,423,423,423,423,423,
706 423,424,424,424,424,424,424,424,424,424,424,425,425,425,425,425,425,425,425,425,
707 425,426,426,426,426,426,426,426,426,426,426,427,427,427,427,427,427,427,427,427,
708 427,428,428,428,428,428,428,428,428,428,428,429,429,429,429,429,429,429,429,429,
709 429,430,430,430,430,430,430,430,430,430,430,431,431,431,431,431,431,431,431,431,
710 431,432,432,432,432,432,432,432,432,432,432,433,433,433,433,433,433,433,433,433,
711 433,434,434,434,434,434,434,434,434,434,434,435,435,435,435,435,435,435,435,435,
712 435,435,436,436,436,436,436,436,436,436,436,436,437,437,437,437,437,437,437,437,
713 437,437,438,438,438,438,438,438,438,438,438,438,439,439,439,439,439,439,439,439,
714 439,439,440,440,440,440,440,440,440,440,440,440,441,441,441,441,441,441,441,441,
715 441,441,442,442,442,442,442,442,442,442,442,442,443,443,443,443,443,443,443,443,
716 443,443,443,444,444,444,444,444,444,444,444,444,444,445,445,445,445,445,445,445,
717 445,445,445,446,446,446,446,446,446,446,446,446,446,447,447,447,447,447,447,447,
718 447,447,447,448,448,448,448,448,448,448,448,448,448,448,449,449,449,449,449,449,
719 449,449,449,449,450,450,450,450,450,450,450,450,450,450,451,451,451,451,451,451,
720 451,451,451,451,452,452,452,452,452,452,452,452,452,452,453,453,453,453,453,453,
721 453,453,453,453,453,454,454,454,454,454,454,454,454,454,454,455,455,455,455,455,
722 455,455,455,455,455,456,456,456,456,456,456,456,456,456,456,457,457,457,457,457,
723 457,457,457,457,457,457,458,458,458,458,458,458,458,458,458,458,459,459,459,459,
724 459,459,459,459,459,459,460,460,460,460,460,460,460,460,460,460,460,461,461,461,
725 461,461,461,461,461,461,461,462,462,462,462,462,462,462,462,462,462,463,463,463,
726 463,463,463,463,463,463,463,463,464,464,464,464,464,464,464,464,464,464,465,465,
727 465,465,465,465,465,465,465,465,466,466,466,466,466,466,466,466,466,466,466,467,
728 467,467,467,467,467,467,467,467,467,468,468,468,468,468,468,468,468,468,468,469,
729 469,469,469,469,469,469,469,469,469,469,470,470,470,470,470,470,470,470,470,470,
730 471,471,471,471,471,471,471,471,471,471,472,472,472,472,472,472,472,472,472,472,
731 472,473,473,473,473,473,473,473,473,473,473,474,474,474,474,474,474,474,474,474,
732 474,475,475,475,475,475,475,475,475,475,475,475,476,476,476,476,476,476,476,476,
733 476,476,477,477,477,477,477,477,477,477,477,477,477,478,478,478,478,478,478,478,
734 478,478,478,479,479,479,479,479,479,479,479,479,479,479,480,480,480,480,480,480,
735 480,480,480,480,481,481,481,481,481,481,481,481,481,481,482,482,482,482,482,482,
736 482,482,482,482,482,483,483,483,483,483,483,483,483,483,483,484,484,484,484,484,
737 484,484,484,484,484,484,485,485,485,485,485,485,485,485,485,485,486,486,486,486,
738 486,486,486,486,486,486,486,487,487,487,487,487,487,487,487,487,487,488,488,488,
739 488,488,488,488,488,488,488,488,489,489,489,489,489,489,489,489,489,489,490,490,
740 490,490,490,490,490,490,490,490,490,491,491,491,491,491,491,491,491,491,491,492,
741 492,492,492,492,492,492,492,492,492,492,493,493,493,493,493,493,493,493,493,493,
742 494,494,494,494,494,494,494,494,494,494,494,495,495,495,495,495,495,495,495,495,
743 495,496,496,496,496,496,496,496,496,496,496,496,497,497,497,497,497,497,497,497,
744 497,497,497,498,498,498,498,498,498,498,498,498,498,499,499,499,499,499,499,499,
745 499,499,499,499,500,500,500,500,500,500,500,500,500,500,501,501,501,501,501,501,
746 501,501,501,501,501,502,502,502,502,502,502,502,502,502,502,503,503,503,503,503,
747 503,503,503,503,503,503,504,504,504,504,504,504,504,504,504,504,504,505,505,505,
748 505,505,505,505,505,505,505,506,506,506,506,506,506,506,506,506,506,506,507,507,
749 507,507,507,507,507,507,507,507,507,508,508,508,508,508,508,508,508,508,508,509,
750 509,509,509,509,509,509,509,509,509,509,510,510,510,510,510,510,510,510,510,510,
751 510,511,511,511,511,511,511,511,511,511,511,512,512,512,512,512 };
752
753 static const int order[32] =
754 { 0, 1, 16, 17, 8, 9, 24, 25, 4, 5, 20, 21, 12, 13, 28, 29,
755 2, 3, 18, 19,10,11, 26, 27, 6, 7, 22, 23, 14, 15, 30, 31 };
756
757 static const unsigned long sampr_index[2][3] =
758 { { 22050, 24000, 16000 }, /* MPEG 2 */
759 { 44100, 48000, 32000 } }; /* MPEG 1 */
760
761 static const long bitr_index[2][15] =
762 { {0, 8,16,24,32,40,48,56, 64, 80, 96,112,128,144,160}, /* MPEG 2 */
763 {0,32,40,48,56,64,80,96,112,128,160,192,224,256,320} }; /* MPEG 1 */
764
765 static const int num_bands[3][15] =
766 { {0,10,10,10,10,12,14,16, 20, 22, 24, 26, 28, 30, 32},
767 {0,10,10,10,10,10,12,14, 18, 24, 26, 28, 30, 32, 32},
768 {0,10,12,14,18,24,26,28, 30, 32, 32, 32, 32, 32, 32} };
769
770 static const int cx_const[9] =
771 { 16135, 10531, 5604, 15396, -2845,-12551, 14189, 8192, 16384 };
772
773 static const int ca_const[8] =
774 {-16859,-15458,-10269, -5961, -3099, -1342, -465, -121 };
775
776 static const int cs_const[8] =
777 { 28098, 28893, 31117, 32221, 32621, 32740, 32765, 32768 };
778
779 static const short enwindow_const[15*27+24] =
780 { 0, 65, 593, 1766, 22228, 2115, 611, 62,
781 8, 119, 1419, 10564,-11659,-1635,-154, -9,
782 -8, -119,-1419,-10564, 11659, 1635, 154, 9, 464, 100, 91,
783 0, 69, 604, 1635, 23148, 2363, 643, 62,
784 7, 107, 1368, 10449,-12733,-1818,-180,-11,
785 -7, -107,-1368,-10449, 12733, 1818, 180, 11, 420, 200, 164,
786 0, 72, 608, 1465, 23979, 2600, 671, 63,
787 7, 94, 1305, 10265,-13818,-2004,-207,-12,
788 -7, -94,-1305,-10265, 13818, 2004, 207, 12, 380, 297, 220,
789 0, 76, 606, 1256, 24718, 2825, 693, 63,
790 6, 81, 1232, 10016,-14908,-2192,-236,-14,
791 -6, -81,-1232,-10016, 14908, 2192, 236, 14, 342, 392, 262,
792 0, 78, 597, 1007, 25359, 3033, 712, 63,
793 6, 68, 1150, 9706,-15995,-2380,-267,-15,
794 -6, -68,-1150, -9706, 15995, 2380, 267, 15, 307, 483, 289,
795 0, 80, 580, 719, 25901, 3224, 726, 62,
796 6, 54, 1060, 9343,-17072,-2565,-299,-17,
797 -6, -54,-1060, -9343, 17072, 2565, 299, 17, 274, 569, 304,
798 -1, 82, 555, 391, 26339, 3395, 735, 61,
799 5, 40, 963, 8930,-18131,-2747,-332,-19,
800 -5, -40, -963, -8930, 18131, 2747, 332, 19, 242, 650, 307,
801 -1, 83, 523, 26, 26672, 3545, 740, 60,
802 5, 27, 861, 8474,-19164,-2923,-366,-21,
803 -5, -27, -861, -8474, 19164, 2923, 366, 21, 212, 724, 300,
804 -1, 83, 482, -376, 26900, 3672, 739, 58,
805 4, 14, 756, 7981,-20163,-3092,-401,-24,
806 -4, -14, -756, -7981, 20163, 3092, 401, 24, 183, 792, 283,
807 -1, 82, 433, -812, 27022, 3776, 735, 56,
808 4, 1, 648, 7456,-21122,-3250,-435,-26,
809 -4, -1, -648, -7456, 21122, 3250, 435, 26, 155, 851, 258,
810 -1, 81, 376, -1281, 27038, 3855, 726, 54,
811 3, -11, 539, 6907,-22032,-3397,-470,-28,
812 -3, 11, -539, -6907, 22032, 3397, 470, 28, 128, 903, 226,
813 -1, 78, 312, -1778, 26951, 3910, 713, 52,
814 3, -22, 430, 6338,-22887,-3530,-503,-31,
815 -3, 22, -430, -6338, 22887, 3530, 503, 31, 102, 946, 188,
816 -2, 75, 239, -2302, 26761, 3941, 696, 49,
817 3, -33, 322, 5757,-23678,-3648,-537,-34,
818 -3, 33, -322, -5757, 23678, 3648, 537, 34, 76, 980, 145,
819 -2, 70, 160, -2848, 26472, 3948, 676, 47,
820 3, -42, 217, 5167,-24399,-3749,-568,-36,
821 -3, 42, -217, -5167, 24399, 3749, 568, 36, 50, 1004, 99,
822 -2, 65, 74, -3412, 26087, 3931, 653, 44,
823 2, -51, 115, 4577,-25045,-3830,-599,-39,
824 -2, 51, -115, -4577, 25045, 3830, 599, 39, 25, 1019, 50,
825
826 25610,3891,627,42,-3990,-18,58,-2,
827 21226,-21226,10604,-10604,1860,-1860,1458,-1458,576,-576,130,-130,60,-60,8,-8
828 };
829
830 static const int win_const[18][4] = {
831 { -3072, -134, -146, 3352 },
832 { -2747, -362, -471, 3579 },
833 { -2387, -529, -831, 3747 },
834 { -2004, -632,-1214, 3850 },
835 { -1609, -666,-1609, 3884 },
836 { -1214, -632,-2004, 3850 },
837 { -831, -529,-2387, 3747 },
838 { -471, -362,-2747, 3579 },
839 { -146, -134,-3072, 3352 },
840 { 134,-3072,-3352, -146 },
841 { 362,-2747,-3579, -471 },
842 { 529,-2387,-3747, -831 },
843 { 632,-2004,-3850,-1214 },
844 { 666,-1609,-3884,-1609 },
845 { 632,-1214,-3850,-2004 },
846 { 529, -831,-3747,-2387 },
847 { 362, -471,-3579,-2747 },
848 { 134, -146,-3352,-3072 } };
849
850 /* forward declarations */
851 static int HuffmanCode( short *ix, char *xr_sign, uint32_t begin, uint32_t end, int table);
852 static int HuffmanCod1( short *ix, char *xr_sign, uint32_t begin, uint32_t end, int table);
853 static void putbits(uint32_t val, uint32_t nbit);
854 static int find_best_2( short *ix, uint32_t start, uint32_t end, const uint32_t *table,
855 uint32_t len, int *bits);
856 static int find_best_3( short *ix, uint32_t start, uint32_t end, const uint32_t *table,
857 uint32_t len, int *bits);
858 static int count_bit1 ( short *ix, uint32_t start, uint32_t end, int *bits );
859 static int count_bigv ( short *ix, uint32_t start, uint32_t end, int table0, int table1,
860 int *bits);
861
862 /* implementations */
863 static void encodeSideInfo( side_info_t si[2][2] )
864 {
865 int gr, ch, header;
866 uint32_t cc=0, sz=0;
867
868 /*
869 * MPEG header layout:
870 * AAAAAAAA AAABBCCD EEEEFFGH IIJJKLMM
871 * A (31-21) = frame sync
872 * B (20-19) = MPEG type
873 * C (18-17) = MPEG layer
874 * D (16) = protection bit
875 * E (15-12) = bitrate index
876 * F (11-10) = samplerate index
877 * G (9) = padding bit
878 * H (8) = private bit
879 * I (7-6) = channel mode
880 * J (5-4) = mode extension (jstereo only)
881 * K (3) = copyright bit
882 * L (2) = original
883 * M (1-0) = emphasis
884 */
885
886 header = (0xfff00000) | /* frame sync (AAAAAAAAA AAA)
887 mp3 type (upper): 1 (B) */
888 (0x01 << 17) | /* mp3 layer: 01 (CC) */
889 ( 0x1 << 16) | /* mp3 crc: 1 (D) */
890 ( 0x1 << 2); /* mp3 org: 1 (L) */
891 header |= cfg.mpg.type << 19;
892 header |= cfg.mpg.bitr_id << 12;
893 header |= cfg.mpg.smpl_id << 10;
894 header |= cfg.mpg.padding << 9;
895 header |= cfg.mpg.mode << 6;
896 /* no emphasis (bits 0-1) */
897 putbits( header, 32 );
898
899 if(cfg.mpg.type == 1)
900 { /* MPEG1 */
901 if(cfg.channels == 2) { putlong( 0, 20); }
902 else { putlong( 0, 18); }
903
904 for(gr=0; gr<cfg.granules; gr++)
905 for(ch=0; ch<cfg.channels; ch++)
906 {
907 side_info_t *gi = &si[gr][ch];
908
909 putlong((gi->part2_3_length+42),12 ); /* add scale_facs array size */
910 putlong( gi->address3>>1, 9 );
911 putlong( gi->global_gain, 8 );
912 putlong( 9, 4 ); /* set scale_facs compr type */
913 putlong( gi->table_select[0], 6 );
914 putlong( gi->table_select[1], 5 );
915 putlong( gi->table_select[2], 5 );
916 putlong( gi->region_0_1, 7 );
917 putlong( 1 , 2 ); /* set scale_facs to 1bit */
918 putlong( gi->table_select[3], 1 );
919 }
920 }
921 else
922 { /* MPEG2 */
923 if(cfg.channels == 2) { putlong( 0, 10); }
924 else { putlong( 0, 9); }
925
926 for(ch=0; ch<cfg.channels; ch++)
927 {
928 side_info_t *gi = &si[0][ch];
929
930 putlong((gi->part2_3_length+42),12 ); /* add scale_facs array size */
931 putlong( gi->address3>>1, 9 );
932 putlong( gi->global_gain, 8 );
933 putlong( 0xCA, 9 ); /* set scale_facs compr type */
934 putlong( gi->table_select[0], 6 );
935 putlong( gi->table_select[1], 5 );
936 putlong( gi->table_select[2], 5 );
937 putlong( gi->region_0_1 , 7 );
938 putlong( 1 , 1 ); /* set scale_facs to 1bit */
939 putlong( gi->table_select[3], 1 );
940 }
941 }
942 /* flush remaining bits */
943 putbits(cc, sz);
944 }
945
946 /* Note the discussion of huffmancodebits() on pages 28 and 29 of the IS,
947 as well as the definitions of the side information on pages 26 and 27. */
948 static void Huffmancodebits( short *ix, char *xr_sign, side_info_t *gi )
949 {
950 int region1 = gi->address1;
951 int region2 = gi->address2;
952 int bigvals = gi->address3;
953 int count1 = bigvals + (gi->count1 << 2);
954 int stuffBits = 0;
955 int bits = 0;
956 int i, v;
957
958 for(i=v=0; i<32; i+=2)
959 v |= band_scale_f[i>>1] << (30-i);
960 putbits(v, 32); // store scale_facs (part1)
961
962 for(v=0; i<42; i+=2)
963 v |= band_scale_f[i>>1] << (40-i);
964 putbits(v, 10); // store scale_facs (part2)
965
966 if(region1 > 0)
967 bits += HuffmanCode(ix, xr_sign, 0 , region1, gi->table_select[0]);
968
969 if(region2 > region1)
970 bits += HuffmanCode(ix, xr_sign, region1, region2, gi->table_select[1]);
971
972 if(bigvals > region2)
973 bits += HuffmanCode(ix, xr_sign, region2, bigvals, gi->table_select[2]);
974
975 if(count1 > bigvals)
976 bits += HuffmanCod1(ix, xr_sign, bigvals, count1, gi->table_select[3]);
977
978 if((stuffBits = gi->part2_3_length - bits) > 0)
979 {
980 int stuffWords = stuffBits >> 5;
981 int remainBits = stuffBits & 31;
982
983 if( remainBits )
984 putbits( ~0, remainBits );
985
986 while( stuffWords-- )
987 putbits( ~0, 32 ); /* Huffman code tables leed to padding ones */
988 }
989 }
990
991 int HuffmanCod1( short *ix, char *xr_sign, uint32_t begin, uint32_t end, int tbl)
992 {
993 uint32_t cc=0, sz=0;
994 uint32_t i, d, p;
995 int sumbit=0, s=0, l=0, v, w, x, y;
996 #define sgnv xr_sign[i+0]
997 #define sgnw xr_sign[i+1]
998 #define sgnx xr_sign[i+2]
999 #define sgny xr_sign[i+3]
1000
1001 for(i=begin; i<end; i+=4)
1002 {
1003 v = ix[i+0];
1004 w = ix[i+1];
1005 x = ix[i+2];
1006 y = ix[i+3];
1007 p = (v << 3) + (w << 2) + (x << 1) + y;
1008
1009 switch(p)
1010 {
1011 case 0: l=0; s = 0; break;
1012 case 1: l=1; s = sgny; break;
1013 case 2: l=1; s = sgnx; break;
1014 case 3: l=2; s = (sgnx << 1) + sgny; break;
1015 case 4: l=1; s = sgnw; break;
1016 case 5: l=2; s = (sgnw << 1) + sgny; break;
1017 case 6: l=2; s = (sgnw << 1) + sgnx; break;
1018 case 7: l=3; s = (sgnw << 2) + (sgnx << 1) + sgny; break;
1019 case 8: l=1; s = sgnv; break;
1020 case 9: l=2; s = (sgnv << 1) + sgny; break;
1021 case 10: l=2; s = (sgnv << 1) + sgnx; break;
1022 case 11: l=3; s = (sgnv << 2) + (sgnx << 1) + sgny; break;
1023 case 12: l=2; s = (sgnv << 1) + sgnw; break;
1024 case 13: l=3; s = (sgnv << 2) + (sgnw << 1) + sgny; break;
1025 case 14: l=3; s = (sgnv << 2) + (sgnw << 1) + sgnx; break;
1026 case 15: l=4; s = (sgnv << 3) + (sgnw << 2) + (sgnx << 1) + sgny; break;
1027 }
1028
1029 d = (ht_count[tbl][0][p] << l) + s;
1030 l = ht_count[tbl][1][p];
1031 putlong( d, l );
1032 sumbit += l;
1033 }
1034
1035 /* flush remaining bits */
1036 putbits(cc, sz);
1037
1038 return sumbit;
1039 }
1040
1041 /* Implements the pseudocode of page 98 of the IS */
1042 int HuffmanCode(short *ix, char *xr_sign, uint32_t begin, uint32_t end, int table)
1043 {
1044 uint32_t cc=0, sz=0, code;
1045 uint32_t i, xl=0, yl=0, idx;
1046 int x, y, bit, sumbit=0;
1047 #define sign_x xr_sign[i+0]
1048 #define sign_y xr_sign[i+1]
1049
1050 if(table == 0)
1051 return 0;
1052
1053 if( table > 15 )
1054 { /* ESC-table is used */
1055 uint32_t linbits = ht_big[table-16].linbits;
1056 uint16_t *hffcode = table < 24 ? t16HB : t24HB;
1057 uint8_t *hlen = table < 24 ? t16l : t24l;
1058
1059 for(i=begin; i<end; i+=2)
1060 {
1061 x = ix[ i ];
1062 y = ix[i+1];
1063
1064 if(x > 14) { xl = x - 15; x = 15; }
1065 if(y > 14) { yl = y - 15; y = 15; }
1066
1067 idx = x * 16 + y;
1068 code = hffcode[idx];
1069 bit = hlen [idx];
1070
1071 if(x)
1072 {
1073 if(x > 14)
1074 {
1075 code = (code << linbits) | xl;
1076 bit += linbits;
1077 }
1078
1079 code = (code << 1) | sign_x;
1080 bit += 1;
1081 }
1082
1083 if(y)
1084 {
1085 if(y > 14)
1086 {
1087 if(bit + linbits + 1 > 32)
1088 {
1089 putlong( code, bit );
1090 sumbit += bit;
1091 code = bit = 0;
1092 }
1093
1094 code = (code << linbits) | yl;
1095 bit += linbits;
1096 }
1097
1098 code = (code << 1) | sign_y;
1099 bit += 1;
1100 }
1101
1102 putlong( code, bit );
1103 sumbit += bit;
1104 }
1105 }
1106 else
1107 { /* No ESC-words */
1108 const struct huffcodetab *h = &ht[table];
1109
1110 for(i=begin; i<end; i+=2)
1111 {
1112 x = ix[i];
1113 y = ix[i+1];
1114
1115 idx = x * h->len + y;
1116 code = h->table[idx];
1117 bit = h->hlen [idx];
1118
1119 if(x)
1120 {
1121 code = (code << 1) | sign_x;
1122 bit += 1;
1123 }
1124
1125 if(y)
1126 {
1127 code = (code << 1) | sign_y;
1128 bit += 1;
1129 }
1130
1131 putlong( code, bit );
1132 sumbit += bit;
1133 }
1134 }
1135
1136 /* flush remaining bits */
1137 putbits(cc, sz);
1138
1139 return sumbit;
1140 }
1141
1142 void putbits(uint32_t val, uint32_t nbit)
1143 {
1144 int new_bitpos = CodedData.bitpos + nbit;
1145 int ptrpos = CodedData.bitpos >> 5;
1146
1147 val = val & (0xffffffff >> (32 - nbit));
1148
1149 /* data fit in one uint32_t */
1150 if(((new_bitpos - 1) >> 5) == ptrpos)
1151 CodedData.bbuf[ptrpos] |= val << ((32 - new_bitpos) & 31);
1152 else
1153 {
1154 CodedData.bbuf[ptrpos ] |= val >> ((new_bitpos - 32) & 31);
1155 CodedData.bbuf[ptrpos+1] |= val << ((32 - new_bitpos) & 31);
1156 }
1157
1158 CodedData.bitpos = new_bitpos;
1159 }
1160
1161 /***************************************************************************/
1162 /* Choose the Huffman table that will encode ix[begin..end] with */
1163 /* the fewest bits. */
1164 /* Note: This code contains knowledge about the sizes and characteristic */
1165 /* of the Huffman tables as defined in the IS (Table B.7), and will not */
1166 /* work with any arbitrary tables. */
1167 /***************************************************************************/
1168 static int choose_table( short *ix, uint32_t begin, uint32_t end, int *bits )
1169 {
1170 uint32_t i;
1171 int max, table0, table1;
1172
1173 for(i=begin,max=0; i<end; i++)
1174 if(ix[i] > max)
1175 max = ix[i];
1176
1177 if(max < 16)
1178 {
1179 /* tables without linbits */
1180 /* indx: 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */
1181 /* len: 0, 2, 3, 3, 0, 4, 4, 6, 6, 6, 8, 8, 8, 16, 0, 16 */
1182 switch(max)
1183 {
1184 case 0: return 0;
1185 case 1: return count_bit1(ix, begin, end, bits);
1186 case 2: return 2 + find_best_2(ix, begin, end, tab23, 3, bits);
1187 case 3: return 5 + find_best_2(ix, begin, end, tab56, 4, bits);
1188 case 4:
1189 case 5: return 7 + find_best_3(ix, begin, end, tab789, 6, bits);
1190 case 6:
1191 case 7: return 10 + find_best_3(ix, begin, end, tabABC, 8, bits);
1192 default: return 13 + find_best_2(ix, begin, end, tab1315, 16, bits) * 2;
1193 }
1194 }
1195 else
1196 {
1197 /* tables with linbits */
1198 max -= 15;
1199
1200 for(table0=0; table0<8; table0++)
1201 if(ht_big[table0].linmax >= max)
1202 break;
1203
1204 for(table1=8; table1<16; table1++)
1205 if(ht_big[table1].linmax >= max)
1206 break;
1207
1208 return 16 + count_bigv(ix, begin, end, table0, table1, bits);
1209 }
1210 }
1211
1212 int find_best_2(short *ix, uint32_t start, uint32_t end, const uint32_t *table,
1213 uint32_t len, int *bits)
1214 {
1215 uint32_t i, sum = 0;
1216
1217 for(i=start; i<end; i+=2)
1218 sum += table[ix[i] * len + ix[i+1]];
1219
1220 if((sum & 0xffff) <= (sum >> 16))
1221 {
1222 *bits = (sum & 0xffff);
1223 return 1;
1224 }
1225 else
1226 {
1227 *bits = sum >> 16;
1228 return 0;
1229 }
1230 }
1231
1232 int find_best_3(short *ix, uint32_t start, uint32_t end, const uint32_t *table,
1233 uint32_t len, int *bits)
1234 {
1235 uint32_t i, j, sum = 0;
1236 int sum1 = 0;
1237 int sum2 = 0;
1238 int sum3 = 0;
1239
1240 /* avoid overflow in packed additions: 78*13 < 1024 */
1241 for(i=start; i<end; )
1242 {
1243 j = i + 2*78 > end ? end : i + 2*78;
1244
1245 for(sum=0; i<j; i+=2)
1246 sum += table[ix[i] * len + ix[i+1]];
1247
1248 sum1 += (sum >> 20);
1249 sum2 += (sum >> 10) & 0x3ff;
1250 sum3 += (sum >> 0) & 0x3ff;
1251 }
1252
1253 i = 0;
1254 if(sum1 > sum2) { sum1 = sum2; i = 1; }
1255 if(sum1 > sum3) { sum1 = sum3; i = 2; }
1256
1257 *bits = sum1;
1258
1259 return i;
1260 }
1261
1262 /*************************************************************************/
1263 /* Function: Count the number of bits necessary to code the subregion. */
1264 /*************************************************************************/
1265 int count_bit1(short *ix, uint32_t start, uint32_t end, int *bits )
1266 {
1267 uint32_t i, sum = 0;
1268
1269 for(i=start; i<end; i+=2)
1270 sum += t1l[4 + ix[i] * 2 + ix[i+1]];
1271
1272 *bits = sum;
1273
1274 return 1; /* this is table1 */
1275 }
1276
1277 int count_bigv(short *ix, uint32_t start, uint32_t end, int table0,
1278 int table1, int *bits )
1279 {
1280 uint32_t i, sum0, sum1, sum=0, bigv=0, x, y;
1281
1282 /* ESC-table is used */
1283 for(i=start; i<end; i+=2)
1284 {
1285 x = ix[i];
1286 y = ix[i+1];
1287
1288 if(x > 14) { x = 15; bigv++; }
1289 if(y > 14) { y = 15; bigv++; }
1290
1291 sum += tab1624[x * 16 + y];
1292 }
1293
1294 sum0 = (sum >> 16) + bigv * ht_big[table0].linbits;
1295 sum1 = (sum & 0xffff) + bigv * ht_big[table1].linbits;
1296
1297 if(sum0 <= sum1)
1298 {
1299 *bits = sum0;
1300 return table0;
1301 }
1302 else
1303 {
1304 *bits = sum1;
1305 return table1;
1306 }
1307 }
1308
1309 /*************************************************************************/
1310 /* Function: Calculation of rzero, count1, address3 */
1311 /* (Partitions ix into big values, quadruples and zeros). */
1312 /*************************************************************************/
1313 static int calc_runlen( short *ix, side_info_t *si )
1314 {
1315 int p, i, sum = 0;
1316
1317 for(i=SAMPL2; i-=2; )
1318 if(*(uint32_t*)&ix[i-2]) /* !!!! short *ix; !!!!! */
1319 break;
1320
1321 si->count1 = 0;
1322
1323 for( ; i>3; i-=4)
1324 {
1325 int v = ix[i-1];
1326 int w = ix[i-2];
1327 int x = ix[i-3];
1328 int y = ix[i-4];
1329
1330 if((v | w | x | y) <= 1)
1331 {
1332 p = (y<<3) + (x<<2) + (w<<1) + (v);
1333
1334 sum += tab01[p];
1335
1336 si->count1++;
1337 }
1338 else break;
1339 }
1340
1341 si->address3 = i;
1342
1343 if((sum >> 16) < (sum & 0xffff))
1344 {
1345 si->table_select[3] = 0;
1346 return sum >> 16;
1347 }
1348 else
1349 {
1350 si->table_select[3] = 1;
1351 return sum & 0xffff;
1352 }
1353 }
1354
1355
1356 /*************************************************************************/
1357 /* Function: Quantization of the vector xr ( -> ix) */
1358 /*************************************************************************/
1359 static int quantize_int(int *xr, short *ix, side_info_t *si)
1360 {
1361 unsigned int i, idx, s, frac_pow[] = { 0x10000, 0xd745, 0xb505, 0x9838 };
1362
1363 s = frac_pow[si->quantStep & 3] >> si->quantStep / 4;
1364
1365 /* check for possible 'out of range' values */
1366 if(((si->max_val + 256) >> 8) * s >= (65536 << 8))
1367 return 0;
1368
1369 if(((si->max_val + 256) >> 8) * s < (4096 << 8))
1370 { /* all values fit the table size */
1371 for(i=SAMPL2; i--; )
1372 ix[i] = int2idx[(xr[i] * s + 0x8000) >> 16];
1373 }
1374 else
1375 { /* check each index wether it fits the table */
1376 for(i=SAMPL2; i--; )
1377 {
1378 idx = (xr[i] * s + 0x08000) >> 16;
1379
1380 if(idx > 4095) ix[i] = int2idx[(idx + 8) >> 4] << 3;
1381 else ix[i] = int2idx[idx];
1382 }
1383 }
1384
1385 return 1;
1386 }
1387
1388 /*************************************************************************/
1389 /* subdivides the bigvalue region which will use separate Huffman tables */
1390 /*************************************************************************/
1391 static void subdivide(side_info_t *si)
1392 {
1393 int scfb, count0, count1;
1394
1395 if( !si->address3 )
1396 { /* no bigvalue region */
1397 si->region_0_1 = 0;
1398 si->address1 = 0;
1399 si->address2 = 0;
1400 }
1401 else
1402 {
1403 /* Calculate scale factor band index */
1404 for(scfb=0; scalefac[scfb] < si->address3; )
1405 scfb++;
1406
1407 count0 = subdv_table[scfb].region0_cnt;
1408 count1 = subdv_table[scfb].region1_cnt;
1409
1410 si->region_0_1 = (count0 << 3) | count1;
1411 si->address1 = scalefac[count0 + 1];
1412 si->address2 = scalefac[count0 + 1 + count1 + 1];
1413 }
1414 }
1415
1416 /*******************************************************************/
1417 /* Count the number of bits necessary to code the bigvalues region */
1418 /*******************************************************************/
1419 static int bigv_bitcount(short *ix, side_info_t *gi)
1420 {
1421 int b1=0, b2=0, b3=0;
1422
1423 /* Select huffman code tables for bigvalues regions */
1424 gi->table_select[0] = 0;
1425 gi->table_select[1] = 0;
1426 gi->table_select[2] = 0;
1427
1428 if( gi->address1 > 0 ) /* region0 */
1429 gi->table_select[0] = choose_table(ix, 0 , gi->address1, &b1);
1430
1431 if( gi->address2 > gi->address1 ) /* region1 */
1432 gi->table_select[1] = choose_table(ix, gi->address1, gi->address2, &b2);
1433
1434 if( gi->address3 > gi->address2 ) /* region2 */
1435 gi->table_select[2] = choose_table(ix, gi->address2, gi->address3, &b3);
1436
1437 return b1+b2+b3;
1438 }
1439
1440 static int quantize_and_count_bits(int *xr, short *ix, side_info_t *si)
1441 {
1442 int bits = 10000;
1443
1444 if(quantize_int(xr, ix, si))
1445 {
1446 bits = calc_runlen(ix, si); /* rzero,count1,address3 */
1447 subdivide(si); /* bigvalues sfb division */
1448 bits += bigv_bitcount(ix,si); /* bit count */
1449 }
1450
1451 return bits;
1452 }
1453
1454 /************************************************************************/
1455 /* The code selects the best quantStep for a particular set of scalefacs*/
1456 /************************************************************************/
1457 static int inner_loop(int *xr, int max_bits, side_info_t *si)
1458 {
1459 int bits;
1460
1461 while((bits=quantize_and_count_bits(xr, enc_data, si)) < max_bits-64)
1462 {
1463 if(si->quantStep == 0)
1464 break;
1465
1466 if(si->quantStep <= 2)
1467 si->quantStep = 0;
1468 else
1469 si->quantStep -= 2;
1470 }
1471
1472 while(bits > max_bits)
1473 {
1474 si->quantStep++;
1475 bits = quantize_and_count_bits(xr, enc_data, si);
1476 }
1477
1478 return bits;
1479 }
1480
1481 static void iteration_loop(int *xr, side_info_t *si, int gr_cnt)
1482 {
1483 int remain, tar_bits, max_bits = cfg.mean_bits;
1484
1485 /* distribute reserved bits to remaining granules */
1486 tar_bits = max_bits + (cfg.ResvSize / gr_cnt & ~7);
1487 if(tar_bits > max_bits + max_bits/2)
1488 tar_bits = max_bits + max_bits/2;
1489
1490 si->part2_3_length = inner_loop(xr, tar_bits, si);
1491 si->global_gain = si->quantStep + 142 - si->additStep;
1492
1493 /* unused bits of the reservoir can be used for remaining granules */
1494 cfg.ResvSize += max_bits - si->part2_3_length;
1495
1496 /* end: distribute the reserved bits to one or two granules */
1497 if(gr_cnt == 1)
1498 {
1499 si->part2_3_length += cfg.ResvSize;
1500 /* mp3 format allows max 12bits for granule length */
1501 if(si->part2_3_length > 4092)
1502 {
1503 remain = (si->part2_3_length - 4092 + 31) >> 5;
1504 si->part2_3_length -= remain << 5;
1505 si[-1].part2_3_length += remain << 5;
1506
1507 while(remain--)
1508 putbits(~0, 32);
1509 }
1510 }
1511 }
1512
1513 /* returns sum_j=0^31 a[j]*cos(PI*j*(k+1/2)/32), 0<=k<32 */
1514 static void window_subband1(short *wk, int sb0[SBLIMIT], int sb1[SBLIMIT])
1515 {
1516 int k, i, u, v;
1517 short *wp, *x1, *x2;
1518
1519 #ifdef CPU_COLDFIRE
1520 int s0, s1, t0, t1;
1521
1522 for(k=0; k<18; k++, wk+=64, sb0+=SBLIMIT, sb1+=SBLIMIT)
1523 {
1524 wp = enwindow;
1525 x1 = wk;
1526 x2 = x1 - 124;
1527
1528 for(i=-15; i<0; i++)
1529 {
1530 asm volatile(
1531 "move.l (-224*4,%[x2]), %%d4\n" /* d4 = x2[-224] */
1532 "movem.l (%[wp]), %%d0-%%d3\n" /* load 8 values */
1533 "mac.w %%d0u, %%d4u, %%acc0\n"
1534 "mac.w %%d0u, %%d4l, (-160*4,%[x2]), %%d4, %%acc1\n"
1535 "mac.w %%d0l, %%d4u, %%acc0\n"
1536 "mac.w %%d0l, %%d4l, ( -96*4,%[x2]), %%d4, %%acc1\n"
1537 "mac.w %%d1u, %%d4u, %%acc0\n"
1538 "mac.w %%d1u, %%d4l, ( -32*4,%[x2]), %%d4, %%acc1\n"
1539 "mac.w %%d1l, %%d4u, %%acc0\n"
1540 "mac.w %%d1l, %%d4l, ( 32*4,%[x2]), %%d4, %%acc1\n"
1541 "mac.w %%d2u, %%d4u, %%acc0\n"
1542 "mac.w %%d2u, %%d4l, ( 96*4,%[x2]), %%d4, %%acc1\n"
1543 "mac.w %%d2l, %%d4u, %%acc0\n"
1544 "mac.w %%d2l, %%d4l, ( 160*4,%[x2]), %%d4, %%acc1\n"
1545 "mac.w %%d3u, %%d4u, %%acc0\n"
1546 "mac.w %%d3u, %%d4l, ( 224*4,%[x2]), %%d4, %%acc1\n"
1547 "mac.w %%d3l, %%d4u, %%acc0\n"
1548 "mac.w %%d3l, %%d4l, (-256*4,%[x1]), %%d4, %%acc1\n"
1549 "movem.l (16,%[wp]), %%d0-%%d3\n" /* load 8 values */
1550 "mac.w %%d0u, %%d4u, %%acc0\n"
1551 "mac.w %%d0u, %%d4l, (-192*4,%[x1]), %%d4, %%acc1\n"
1552 "mac.w %%d0l, %%d4u, %%acc0\n"
1553 "mac.w %%d0l, %%d4l, (-128*4,%[x1]), %%d4, %%acc1\n"
1554 "mac.w %%d1u, %%d4u, %%acc0\n"
1555 "mac.w %%d1u, %%d4l, ( -64*4,%[x1]), %%d4, %%acc1\n"
1556 "mac.w %%d1l, %%d4u, %%acc0\n"
1557 "mac.w %%d1l, %%d4l, ( 0*4,%[x1]), %%d4, %%acc1\n"
1558 "mac.w %%d2u, %%d4u, %%acc0\n"
1559 "mac.w %%d2u, %%d4l, ( 64*4,%[x1]), %%d4, %%acc1\n"
1560 "mac.w %%d2l, %%d4u, %%acc0\n"
1561 "mac.w %%d2l, %%d4l, ( 128*4,%[x1]), %%d4, %%acc1\n"
1562 "mac.w %%d3u, %%d4u, %%acc0\n"
1563 "mac.w %%d3u, %%d4l, ( 192*4,%[x1]), %%d4, %%acc1\n"
1564 "mac.w %%d3l, %%d4u, %%acc0\n"
1565 "mac.w %%d3l, %%d4l, ( 224*4,%[x1]), %%d4, %%acc1\n"
1566 "movclr.l %%acc0, %%d0\n"
1567 "move.l %%d0, %[s0]\n"
1568 "movclr.l %%acc1, %%d0\n"
1569 "move.l %%d0, %[s1]\n"
1570
1571 "movem.l (%[wp]), %%d0-%%d3\n" /* load 8 values */
1572 "mac.w %%d0u, %%d4u, %%acc0\n"
1573 "mac.w %%d0u, %%d4l, ( 160*4,%[x1]), %%d4, %%acc1\n"
1574 "mac.w %%d0l, %%d4u, %%acc0\n"
1575 "mac.w %%d0l, %%d4l, ( 96*4,%[x1]), %%d4, %%acc1\n"
1576 "mac.w %%d1u, %%d4u, %%acc0\n"
1577 "mac.w %%d1u, %%d4l, ( 32*4,%[x1]), %%d4, %%acc1\n"
1578 "mac.w %%d1l, %%d4u, %%acc0\n"
1579 "mac.w %%d1l, %%d4l, ( -32*4,%[x1]), %%d4, %%acc1\n"
1580 "mac.w %%d2u, %%d4u, %%acc0\n"
1581 "mac.w %%d2u, %%d4l, ( -96*4,%[x1]), %%d4, %%acc1\n"
1582 "mac.w %%d2l, %%d4u, %%acc0\n"
1583 "mac.w %%d2l, %%d4l, (-160*4,%[x1]), %%d4, %%acc1\n"
1584 "mac.w %%d3u, %%d4u, %%acc0\n"
1585 "mac.w %%d3u, %%d4l, (-224*4,%[x1]), %%d4, %%acc1\n"
1586 "mac.w %%d3l, %%d4u, %%acc0\n"
1587 "mac.w %%d3l, %%d4l, ( 256*4,%[x2]), %%d4, %%acc1\n"
1588 "movem.l (32,%[wp]), %%d0-%%d3\n" /* load 8 values */
1589 "mac.w %%d0u, %%d4u, %%acc0\n"
1590 "mac.w %%d0u, %%d4l, ( 192*4,%[x2]), %%d4, %%acc1\n"
1591 "mac.w %%d0l, %%d4u, %%acc0\n"
1592 "mac.w %%d0l, %%d4l, ( 128*4,%[x2]), %%d4, %%acc1\n"
1593 "mac.w %%d1u, %%d4u, %%acc0\n"
1594 "mac.w %%d1u, %%d4l, ( 64*4,%[x2]), %%d4, %%acc1\n"
1595 "mac.w %%d1l, %%d4u, %%acc0\n"
1596 "mac.w %%d1l, %%d4l, ( 0*4,%[x2]), %%d4, %%acc1\n"
1597 "mac.w %%d2u, %%d4u, %%acc0\n"
1598 "mac.w %%d2u, %%d4l, ( -64*4,%[x2]), %%d4, %%acc1\n"
1599 "mac.w %%d2l, %%d4u, %%acc0\n"
1600 "mac.w %%d2l, %%d4l, (-128*4,%[x2]), %%d4, %%acc1\n"
1601 "mac.w %%d3u, %%d4u, %%acc0\n"
1602 "mac.w %%d3u, %%d4l, (-192*4,%[x2]), %%d4, %%acc1\n"
1603 "mac.w %%d3l, %%d4u, %%acc0\n"
1604 "mac.w %%d3l, %%d4l, %%acc1\n"
1605 "movclr.l %%acc0, %%d0\n"
1606 "move.l %%d0, %[t0]\n"
1607 "movclr.l %%acc1, %%d0\n"
1608 "move.l %%d0, %[t1]\n"
1609
1610 : [x1] "+a" (x1), [x2] "+a" (x2), [s0] "+m" (s0), [t0] "+m" (t0),
1611 [s1] "+m" (s1), [t1] "+m" (t1)
1612 : [wp] "a" (wp) : "d0", "d1", "d2", "d3", "d4");
1613
1614 sb0[30+i*2] = shft4(t0) + shft13(s0) * wp[24];
1615 sb0[31+i*2] = shft13(t0) * wp[25] - shft13(s0) * wp[26];
1616 sb1[30+i*2] = shft4(t1) + shft13(s1) * wp[24];
1617 sb1[31+i*2] = shft13(t1) * wp[25] - shft13(s1) * wp[26];
1618 wp += 27;
1619 x1 -= 2;
1620 x2 += 2;
1621 }
1622
1623 asm volatile(
1624 "move.l ( -32*4,%[x1]), %%d4\n" /* d4 = x1[-32] */
1625 "movem.l (%[wp]), %%d0-%%d3\n" /* load 8 values */
1626
1627 "mac.w %%d0u, %%d4u, %%acc0\n"
1628 "mac.w %%d0u, %%d4l, ( -96*4,%[x1]), %%d4, %%acc1\n"
1629 "mac.w %%d0l, %%d4u, %%acc0\n"
1630 "mac.w %%d0l, %%d4l, (-160*4,%[x1]), %%d4, %%acc1\n"
1631 "mac.w %%d1u, %%d4u, %%acc0\n"
1632 "mac.w %%d1u, %%d4l, (-224*4,%[x1]), %%d4, %%acc1\n"
1633 "mac.w %%d1l, %%d4u, %%acc0\n"
1634 "mac.w %%d1l, %%d4l, ( 32*4,%[x1]), %%d4, %%acc1\n"
1635 "mac.w %%d2u, %%d4u, %%acc0\n"
1636 "mac.w %%d2u, %%d4l, ( 96*4,%[x1]), %%d4, %%acc1\n"
1637 "mac.w %%d2l, %%d4u, %%acc0\n"
1638 "mac.w %%d2l, %%d4l, ( 160*4,%[x1]), %%d4, %%acc1\n"
1639 "mac.w %%d3u, %%d4u, %%acc0\n"
1640 "mac.w %%d3u, %%d4l, ( 224*4,%[x1]), %%d4, %%acc1\n"
1641 "mac.w %%d3l, %%d4u, %%acc0\n"
1642 "mac.w %%d3l, %%d4l, ( -16*4,%[x1]), %%d4, %%acc1\n"
1643 "movclr.l %%acc0, %%d0\n"
1644 "move.l %%d0, %[s0]\n"
1645 "movclr.l %%acc1, %%d0\n"
1646 "move.l %%d0, %[s1]\n"
1647
1648 "movem.l (16,%[wp]), %%d0-%%d3\n" /* load 8 values */
1649 "mac.w %%d0u, %%d4u, %%acc0\n"
1650 "mac.w %%d0u, %%d4l, ( -48*4,%[x1]), %%d4, %%acc1\n"
1651 "mac.w %%d1u, %%d4u, %%acc0\n"
1652 "mac.w %%d1u, %%d4l, ( 16*4,%[x1]), %%d4, %%acc1\n"
1653 "mac.w %%d1l, %%d4u, %%acc0\n"
1654 "mac.w %%d1l, %%d4l, ( -80*4,%[x1]), %%d4, %%acc1\n"
1655 "mac.w %%d2u, %%d4u, %%acc0\n"
1656 "mac.w %%d2u, %%d4l, ( 48*4,%[x1]), %%d4, %%acc1\n"
1657 "mac.w %%d2u, %%d4u, %%acc0\n"
1658 "mac.w %%d2u, %%d4l, (-112*4,%[x1]), %%d4, %%acc1\n"
1659 "mac.w %%d3u, %%d4u, %%acc0\n"
1660 "mac.w %%d3u, %%d4l, ( 80*4,%[x1]), %%d4, %%acc1\n"
1661 "mac.w %%d3l, %%d4u, %%acc0\n"
1662 "mac.w %%d3l, %%d4l, (-144*4,%[x1]), %%d4, %%acc1\n"
1663 "movem.l (32,%[wp]), %%d0-%%d3\n" /* load 8 values */
1664 "mac.w %%d0u, %%d4u, %%acc0\n"
1665 "mac.w %%d0u, %%d4l, ( 112*4,%[x1]), %%d4, %%acc1\n"
1666 "mac.w %%d0u, %%d4u, %%acc0\n"
1667 "mac.w %%d0u, %%d4l, (-176*4,%[x1]), %%d4, %%acc1\n"
1668 "mac.w %%d1u, %%d4u, %%acc0\n"
1669 "mac.w %%d1u, %%d4l, ( 144*4,%[x1]), %%d4, %%acc1\n"
1670 "mac.w %%d1l, %%d4u, %%acc0\n"
1671 "mac.w %%d1l, %%d4l, (-208*4,%[x1]), %%d4, %%acc1\n"
1672 "mac.w %%d2u, %%d4u, %%acc0\n"
1673 "mac.w %%d2u, %%d4l, ( 176*4,%[x1]), %%d4, %%acc1\n"
1674 "mac.w %%d2u, %%d4u, %%acc0\n"
1675 "mac.w %%d2u, %%d4l, (-240*4,%[x1]), %%d4, %%acc1\n"
1676 "mac.w %%d3u, %%d4u, %%acc0\n"
1677 "mac.w %%d3u, %%d4l, ( 208*4,%[x1]), %%d4, %%acc1\n"
1678 "mac.w %%d3l, %%d4u, %%acc0\n"
1679 "mac.w %%d3l, %%d4l, %%acc1\n"
1680 "movclr.l %%acc0, %%d0\n"
1681 "move.l %%d0, %[t0]\n"
1682 "movclr.l %%acc1, %%d0\n"
1683 "move.l %%d0, %[t1]\n"
1684
1685 : [x1] "+a" (x1), [s0] "+m" (s0), [t0] "+m" (t0),
1686 [s1] "+m" (s1), [t1] "+m" (t1)
1687 : [wp] "a" (wp) : "d0", "d1", "d2", "d3", "d4");
1688
1689 u = shft4(s0 - t0);
1690 v = shft4(s0 + t0);
1691 t0 = sb0[14];
1692 s0 = sb0[15] - t0;
1693
1694 sb0[31] = v + t0; /* A0 */
1695 sb0[30] = u + s0; /* A1 */
1696 sb0[15] = u - s0; /* A2 */
1697 sb0[14] = v - t0; /* A3 */
1698
1699 u = shft4(s1 - t1);
1700 v = shft4(s1 + t1);
1701 t1 = sb1[14];
1702 s1 = sb1[15] - t1;
1703
1704 sb1[31] = v + t1; /* A0 */
1705 sb1[30] = u + s1; /* A1 */
1706 sb1[15] = u - s1; /* A2 */
1707 sb1[14] = v - t1; /* A3 */
1708 }
1709 #else
1710 int ch, s, t, *a;
1711
1712 for(ch=0; ch<cfg.channels; ch++)
1713 {
1714 a = ch ? sb1 : sb0;
1715 for(k=0; k<18; k++, wk+=64, a+=SBLIMIT)
1716 {
1717 wp = enwindow;
1718 x1 = wk;
1719 x2 = x1 - 124;
1720
1721 /* x1[-572] .... x1[448] = 1022 */
1722 /* 18*4*16*32 */
1723 for(i=-15; i<0; i++)
1724 {
1725 s = (int)x2[-224*2] * wp[ 0]; t = (int)x1[ 224*2] * wp[ 0];
1726 s += (int)x2[-160*2] * wp[ 1]; t += (int)x1[ 160*2] * wp[ 1];
1727 s += (int)x2[- 96*2] * wp[ 2]; t += (int)x1[ 96*2] * wp[ 2];
1728 s += (int)x2[- 32*2] * wp[ 3]; t += (int)x1[ 32*2] * wp[ 3];
1729 s += (int)x2[ 32*2] * wp[ 4]; t += (int)x1[- 32*2] * wp[ 4];
1730 s += (int)x2[ 96*2] * wp[ 5]; t += (int)x1[- 96*2] * wp[ 5];
1731 s += (int)x2[ 160*2] * wp[ 6]; t += (int)x1[-160*2] * wp[ 6];
1732 s += (int)x2[ 224*2] * wp[ 7]; t += (int)x1[-224*2] * wp[ 7];
1733 s += (int)x1[-256*2] * wp[ 8]; t += (int)x2[ 256*2] * wp[16];
1734 s += (int)x1[-192*2] * wp[ 9]; t += (int)x2[ 192*2] * wp[17];
1735 s += (int)x1[-128*2] * wp[10]; t += (int)x2[ 128*2] * wp[18];
1736 s += (int)x1[- 64*2] * wp[11]; t += (int)x2[ 64*2] * wp[19];
1737 s += (int)x1[ 0*2] * wp[12]; t += (int)x2[ 0*2] * wp[20];
1738 s += (int)x1[ 64*2] * wp[13]; t += (int)x2[- 64*2] * wp[21];
1739 s += (int)x1[ 128*2] * wp[14]; t += (int)x2[-128*2] * wp[22];
1740 s += (int)x1[ 192*2] * wp[15]; t += (int)x2[-192*2] * wp[23];
1741
1742 a[30+i*2] = shft4(t) + shft13(s) * wp[24];
1743 a[31+i*2] = shft13(t) * wp[25] - shft13(s) * wp[26];
1744 wp += 27;
1745 x1 -= 2;
1746 x2 += 2;
1747 }
1748
1749 t = (int)x1[- 16*2] * wp[ 8]; s = (int)x1[ -32*2] * wp[0];
1750 t += ((int)x1[- 48*2]-x1[ 16*2]) * wp[10]; s += (int)x1[ -96*2] * wp[1];
1751 t += ((int)x1[- 80*2]+x1[ 48*2]) * wp[12]; s += (int)x1[-160*2] * wp[2];
1752 t += ((int)x1[-112*2]-x1[ 80*2]) * wp[14]; s += (int)x1[-224*2] * wp[3];
1753 t += ((int)x1[-144*2]+x1[112*2]) * wp[16]; s += (int)x1[ 32*2] * wp[4];
1754 t += ((int)x1[-176*2]-x1[144*2]) * wp[18]; s += (int)x1[ 96*2] * wp[5];
1755 t += ((int)x1[-208*2]+x1[176*2]) * wp[20]; s += (int)x1[ 160*2] * wp[6];
1756 t += ((int)x1[-240*2]-x1[208*2]) * wp[22]; s += (int)x1[ 224*2] * wp[7];
1757
1758 u = shft4(s - t);
1759 v = shft4(s + t);
1760 t = a[14];
1761 s = a[15] - t;
1762
1763 a[31] = v + t; /* A0 */
1764 a[30] = u + s; /* A1 */
1765 a[15] = u - s; /* A2 */
1766 a[14] = v - t; /* A3 */
1767 }
1768 wk -= 18 * 64 - 1; /* rewind wk (to next channel start) */
1769 }
1770 #endif
1771 }
1772
1773 static void window_subband2(short *x1, int a[SBLIMIT])
1774 {
1775 int xr;
1776 short *wp = enwindow;
1777 short *x2 = x1 - 124;
1778
1779 wp += 27 * 15;
1780 x1 -= 2 * 15;
1781 x2 += 2 * 15;
1782
1783 xr = a[28] - a[0]; a[0] += a[28]; a[28] = shft9(xr) * wp[-2*27+25];
1784 xr = a[29] - a[1]; a[1] += a[29]; a[29] = shft9(xr) * wp[-2*27+25];
1785 xr = a[26] - a[2]; a[2] += a[26]; a[26] = shft9(xr) * wp[-4*27+25];
1786 xr = a[27] - a[3]; a[3] += a[27]; a[27] = shft9(xr) * wp[-4*27+25];
1787 xr = a[24] - a[4]; a[4] += a[24]; a[24] = shft9(xr) * wp[-6*27+25];
1788 xr = a[25] - a[5]; a[5] += a[25]; a[25] = shft9(xr) * wp[-6*27+25];
1789 xr = a[22] - a[6]; a[6] += a[22]; a[22] = shft9(xr) * SQRT ;
1790 xr = a[23] - a[7]; a[7] += a[23]; a[23] = shft9(xr) * SQRT - a[7];
1791 a[ 7] -= a[ 6];
1792 a[22] -= a[ 7];
1793 a[23] -= a[22];
1794
1795 xr = a[ 6]; a[ 6] = a[31] - xr; a[31] = a[31] + xr;
1796 xr = a[ 7]; a[ 7] = a[30] - xr; a[30] = a[30] + xr;
1797 xr = a[22]; a[22] = a[15] - xr; a[15] = a[15] + xr;
1798 xr = a[23]; a[23] = a[14] - xr; a[14] = a[14] + xr;
1799
1800 xr = a[20] - a[ 8]; a[ 8] += a[20]; a[20] = shft9(xr) * wp[-10*27+25];
1801 xr = a[21] - a[ 9]; a[ 9] += a[21]; a[21] = shft9(xr) * wp[-10*27+25];
1802 xr = a[18] - a[10]; a[10] += a[18]; a[18] = shft9(xr) * wp[-12*27+25];
1803 xr = a[19] - a[11]; a[11] += a[19]; a[19] = shft9(xr) * wp[-12*27+25];
1804 xr = a[16] - a[12]; a[12] += a[16]; a[16] = shft9(xr) * wp[-14*27+25];
1805 xr = a[17] - a[13]; a[13] += a[17]; a[17] = shft9(xr) * wp[-14*27+25];
1806 xr =-a[20] + a[24]; a[20] += a[24]; a[24] = shft9(xr) * wp[-12*27+25];
1807 xr =-a[21] + a[25]; a[21] += a[25]; a[25] = shft9(xr) * wp[-12*27+25];
1808 xr = a[ 4] - a[ 8]; a[ 4] += a[ 8]; a[ 8] = shft9(xr) * wp[-12*27+25];
1809 xr = a[ 5] - a[ 9]; a[ 5] += a[ 9]; a[ 9] = shft9(xr) * wp[-12*27+25];
1810 xr = a[ 0] - a[12]; a[ 0] += a[12]; a[12] = shft9(xr) * wp[ -4*27+25];
1811 xr = a[ 1] - a[13]; a[ 1] += a[13]; a[13] = shft9(xr) * wp[ -4*27+25];
1812 xr = a[16] - a[28]; a[16] += a[28]; a[28] = shft9(xr) * wp[ -4*27+25];
1813 xr =-a[17] + a[29]; a[17] += a[29]; a[29] = shft9(xr) * wp[ -4*27+25];
1814
1815 xr = SQRT * shft9(a[ 2] - a[10]); a[ 2] += a[10]; a[10] = xr;
1816 xr = SQRT * shft9(a[ 3] - a[11]); a[ 3] += a[11]; a[11] = xr;
1817 xr = SQRT * shft9(a[26] - a[18]); a[18] += a[26]; a[26] = xr - a[18];
1818 xr = SQRT * shft9(a[27] - a[19]); a[19] += a[27]; a[27] = xr - a[19];
1819
1820 xr = a[ 2]; a[19] -= a[ 3]; a[ 3] -= xr; a[ 2] = a[31] - xr; a[31] += xr;
1821 xr = a[ 3]; a[11] -= a[19]; a[18] -= xr; a[ 3] = a[30] - xr; a[30] += xr;
1822 xr = a[18]; a[27] -= a[11]; a[19] -= xr; a[18] = a[15] - xr; a[15] += xr;
1823
1824 xr = a[19]; a[10] -= xr; a[19] = a[14] - xr; a[14] += xr;
1825 xr = a[10]; a[11] -= xr; a[10] = a[23] - xr; a[23] += xr;
1826 xr = a[11]; a[26] -= xr; a[11] = a[22] - xr; a[22] += xr;
1827 xr = a[26]; a[27] -= xr; a[26] = a[ 7] - xr; a[ 7] += xr;
1828
1829 xr = a[27]; a[27] = a[6] - xr; a[6] += xr;
1830
1831 xr = SQRT * shft9(a[ 0] - a[ 4]); a[ 0] += a[ 4]; a[ 4] = xr;
1832 xr = SQRT * shft9(a[ 1] - a[ 5]); a[ 1] += a[ 5]; a[ 5] = xr;
1833 xr = SQRT * shft9(a[16] - a[20]); a[16] += a[20]; a[20] = xr;
1834 xr = SQRT * shft9(a[17] - a[21]); a[17] += a[21]; a[21] = xr;
1835 xr =-SQRT * shft9(a[ 8] - a[12]); a[ 8] += a[12]; a[12] = xr - a[ 8];
1836 xr =-SQRT * shft9(a[ 9] - a[13]); a[ 9] += a[13]; a[13] = xr - a[ 9];
1837 xr =-SQRT * shft9(a[25] - a[29]); a[25] += a[29]; a[29] = xr - a[25];
1838 xr =-SQRT * shft9(a[24] + a[28]); a[24] -= a[28]; a[28] = xr - a[24];
1839
1840 xr = a[24] - a[16]; a[24] = xr;
1841 xr = a[20] - xr; a[20] = xr;
1842 xr = a[28] - xr; a[28] = xr;
1843
1844 xr = a[25] - a[17]; a[25] = xr;
1845 xr = a[21] - xr; a[21] = xr;
1846 xr = a[29] - xr; a[29] = xr;
1847
1848 xr = a[17] - a[1]; a[17] = xr;
1849 xr = a[ 9] - xr; a[ 9] = xr;
1850 xr = a[25] - xr; a[25] = xr;
1851 xr = a[ 5] - xr; a[ 5] = xr;
1852 xr = a[21] - xr; a[21] = xr;
1853 xr = a[13] - xr; a[13] = xr;
1854 xr = a[29] - xr; a[29] = xr;
1855
1856 xr = a[ 1] - a[0]; a[ 1] = xr;
1857 xr = a[16] - xr; a[16] = xr;
1858 xr = a[17] - xr; a[17] = xr;
1859 xr = a[ 8] - xr; a[ 8] = xr;
1860 xr = a[ 9] - xr; a[ 9] = xr;
1861 xr = a[24] - xr; a[24] = xr;
1862 xr = a[25] - xr; a[25] = xr;
1863 xr = a[ 4] - xr; a[ 4] = xr;
1864 xr = a[ 5] - xr; a[ 5] = xr;
1865 xr = a[20] - xr; a[20] = xr;
1866 xr = a[21] - xr; a[21] = xr;
1867 xr = a[12] - xr; a[12] = xr;
1868 xr = a[13] - xr; a[13] = xr;
1869 xr = a[28] - xr; a[28] = xr;
1870 xr = a[29] - xr; a[29] = xr;
1871
1872 xr = a[ 0]; a[ 0] += a[31]; a[31] -= xr;
1873 xr = a[ 1]; a[ 1] += a[30]; a[30] -= xr;
1874 xr = a[16]; a[16] += a[15]; a[15] -= xr;
1875 xr = a[17]; a[17] += a[14]; a[14] -= xr;
1876 xr = a[ 8]; a[ 8] += a[23]; a[23] -= xr;
1877 xr = a[ 9]; a[ 9] += a[22]; a[22] -= xr;
1878 xr = a[24]; a[24] += a[ 7]; a[ 7] -= xr;
1879 xr = a[25]; a[25] += a[ 6]; a[ 6] -= xr;
1880 xr = a[ 4]; a[ 4] += a[27]; a[27] -= xr;
1881 xr = a[ 5]; a[ 5] += a[26]; a[26] -= xr;
1882 xr = a[20]; a[20] += a[11]; a[11] -= xr;
1883 xr = a[21]; a[21] += a[10]; a[10] -= xr;
1884 xr = a[12]; a[12] += a[19]; a[19] -= xr;
1885 xr = a[13]; a[13] += a[18]; a[18] -= xr;
1886 xr = a[28]; a[28] += a[ 3]; a[ 3] -= xr;
1887 xr = a[29]; a[29] += a[ 2]; a[ 2] -= xr;
1888 }
1889
1890 static void mdct_long(int *out, int *in)
1891 {
1892 int ct,st;
1893 int tc1, tc2, tc3, tc4, ts5, ts6, ts7, ts8;
1894 int ts1, ts2, ts3, ts4, tc5, tc6, tc7, tc8;
1895
1896 /* 1,2, 5,6, 9,10, 13,14, 17 */
1897 tc1 = in[17] - in[ 9];
1898 tc3 = in[15] - in[11];
1899 tc4 = in[14] - in[12];
1900 ts5 = in[ 0] + in[ 8];
1901 ts6 = in[ 1] + in[ 7];
1902 ts7 = in[ 2] + in[ 6];
1903 ts8 = in[ 3] + in[ 5];
1904
1905 out[17] = (ts5 + ts7 - ts8) * cx[8] - (ts6 - in[4]) * cx[8];
1906 st = (ts5 + ts7 - ts8) * cx[7] + (ts6 - in[4]) * cx[8];
1907 ct = (tc1 - tc3 - tc4) * cx[6];
1908 out[5] = ct + st;
1909 out[6] = ct - st;
1910
1911 tc2 = (in[16] - in[10]) * cx[6];
1912 ts6 = ts6 * cx[7] + in[4] * cx[8];
1913
1914 ct = tc1 * cx[0] + tc2 + tc3 * cx[1] + tc4 * cx[2];
1915 st = -ts5 * cx[4] + ts6 - ts7 * cx[5] + ts8 * cx[3];
1916 out[1] = ct + st;
1917 out[2] = ct - st;
1918
1919 ct = tc1 * cx[1] - tc2 - tc3 * cx[2] + tc4 * cx[0];
1920 st = -ts5 * cx[5] + ts6 - ts7 * cx[3] + ts8 * cx[4];
1921 out[ 9] = ct + st;
1922 out[10] = ct - st;
1923
1924 ct = tc1 * cx[2] - tc2 + tc3 * cx[0] - tc4 * cx[1];
1925 st = ts5 * cx[3] - ts6 + ts7 * cx[4] - ts8 * cx[5];
1926 out[13] = ct + st;
1927 out[14] = ct - st;
1928
1929 ts1 = in[ 8] - in[ 0];
1930 ts3 = in[ 6] - in[ 2];
1931 ts4 = in[ 5] - in[ 3];
1932 tc5 = in[17] + in[ 9];
1933 tc6 = in[16] + in[10];
1934 tc7 = in[15] + in[11];
1935 tc8 = in[14] + in[12];
1936
1937 out[0] = (tc5 + tc7 + tc8) * cx[8] + (tc6 + in[13]) * cx[8];
1938 ct = (tc5 + tc7 + tc8) * cx[7] - (tc6 + in[13]) * cx[8];
1939 st = (ts1 - ts3 + ts4) * cx[6];
1940 out[11] = ct + st;
1941 out[12] = ct - st;
1942
1943 ts2 = (in[7] - in[1]) * cx[6];
1944 tc6 = in[13] * cx[8] - tc6 * cx[7];
1945
1946 ct = tc5 * cx[3] - tc6 + tc7 * cx[4] + tc8 * cx[5];
1947 st = ts1 * cx[2] + ts2 + ts3 * cx[0] + ts4 * cx[1];
1948 out[3] = ct + st;
1949 out[4] = ct - st;
1950
1951 ct =-tc5 * cx[5] + tc6 - tc7 * cx[3] - tc8 * cx[4];
1952 st = ts1 * cx[1] + ts2 - ts3 * cx[2] - ts4 * cx[0];
1953 out[7] = ct + st;
1954 out[8] = ct - st;
1955
1956 ct =-tc5 * cx[4] + tc6 - tc7 * cx[5] - tc8 * cx[3];
1957 st = ts1 * cx[0] - ts2 + ts3 * cx[1] - ts4 * cx[2];
1958 out[15] = ct + st;
1959 out[16] = ct - st;
1960 }
1961
1962 static int find_bitrate_index(int type, int bitrate /*, bool stereo */)
1963 {
1964 int i;
1965
1966 for(i=0;i<14;i++)
1967 if(bitrate == bitr_index[type][i])
1968 break;
1969 return i;
1970 }
1971
1972 static int find_samplerate_index(unsigned long freq, int *mp3_type)
1973 {
1974 int mpeg = freq >= (32000+24000)/2 ? 1 : 0;
1975
1976 unsigned long dmin = ULONG_MAX;
1977 int idmin = -1, i;
1978
1979 for (i = 0; i < 3; i++)
1980 {
1981 unsigned long diff;
1982
1983 if (sampr_index[mpeg][i] == freq)
1984 {
1985 idmin = i;
1986 break;
1987 }
1988
1989 if ((long)sampr_index[mpeg][i] < (long)freq)
1990 diff = freq - sampr_index[mpeg][i];
1991 else
1992 diff = sampr_index[mpeg][i] - freq;
1993
1994 if (diff < dmin)
1995 {
1996 dmin = diff;
1997 idmin = i;
1998 }
1999 }
2000
2001 *mp3_type = mpeg;
2002 return idmin;
2003 }
2004
2005 static bool init_mp3_encoder_engine(int sample_rate, int num_channels, int bitrate)
2006 {
2007 const bool stereo = num_channels > 1;
2008 uint32_t avg_byte_per_frame;
2009
2010 cfg.channels = stereo ? 2 : 1;
2011 cfg.mpg.mode = stereo ? 0 : 3; /* 0=stereo, 3=mono */
2012 cfg.mpg.smpl_id = find_samplerate_index(sample_rate, &cfg.mpg.type);
2013 cfg.samplerate = sampr_index[cfg.mpg.type][cfg.mpg.smpl_id];
2014 cfg.mpg.bitr_id = find_bitrate_index(cfg.mpg.type, bitrate /*, stereo */);
2015 cfg.mpg.bitrate = bitr_index[cfg.mpg.type][cfg.mpg.bitr_id];
2016 cfg.mpg.num_bands = num_bands[stereo ? cfg.mpg.type : 2][cfg.mpg.bitr_id];
2017
2018 if (cfg.mpg.type == 1)
2019 {
2020 cfg.granules = 2;
2021 pcm_chunk_size = PCM_CHUNK_SIZE1;
2022 samp_per_frame = SAMP_PER_FRAME1;
2023 }
2024 else
2025 {
2026 cfg.granules = 1;
2027 pcm_chunk_size = PCM_CHUNK_SIZE2;
2028 samp_per_frame = SAMP_PER_FRAME2;
2029 }
2030
2031 memcpy(scalefac, sfBand[cfg.mpg.smpl_id + 3*cfg.mpg.type], sizeof(scalefac));
2032 memset(mfbuf , 0 , sizeof(mfbuf ));
2033 memset(mdct_freq , 0 , sizeof(mdct_freq ));
2034 memset(enc_data , 0 , sizeof(enc_data ));
2035 memset(sb_data , 0 , sizeof(sb_data ));
2036 memset(&CodedData, 0 , sizeof(CodedData ));
2037 memcpy(ca , ca_const , sizeof(ca ));
2038 memcpy(cs , cs_const , sizeof(cs ));
2039 memcpy(cx , cx_const , sizeof(cx ));
2040 memcpy(win , win_const , sizeof(win ));
2041 memcpy(enwindow , enwindow_const , sizeof(enwindow ));
2042 memcpy(int2idx , int2idx_const , sizeof(int2idx ));
2043 memcpy(ht_count , ht_count_const , sizeof(ht_count ));
2044 memcpy( tab01 , tab01_const , sizeof(tab01 ));
2045 memcpy( tab23 , tab23_const , sizeof(tab23 ));
2046 memcpy( tab56 , tab56_const , sizeof(tab56 ));
2047 memcpy( tab1315 , tab1315_const , sizeof(tab1315 ));
2048 memcpy( tab1624 , tab1624_const , sizeof(tab1624 ));
2049 memcpy( tab789 , tab789_const , sizeof(tab789 ));
2050 memcpy( tabABC , tabABC_const , sizeof(tabABC ));
2051 memcpy( t1HB , t1HB_const , sizeof(t1HB ));
2052 memcpy( t2HB , t2HB_const , sizeof(t2HB ));
2053 memcpy( t3HB , t3HB_const , sizeof(t3HB ));
2054 memcpy( t5HB , t5HB_const , sizeof(t5HB ));
2055 memcpy( t6HB , t6HB_const , sizeof(t6HB ));
2056 memcpy( t7HB , t7HB_const , sizeof(t7HB ));
2057 memcpy( t8HB , t8HB_const , sizeof(t8HB ));
2058 memcpy( t9HB , t9HB_const , sizeof(t9HB ));
2059 memcpy(t10HB , t10HB_const , sizeof(t10HB ));
2060 memcpy(t11HB , t11HB_const , sizeof(t11HB ));
2061 memcpy(t12HB , t12HB_const , sizeof(t12HB ));
2062 memcpy(t13HB , t13HB_const , sizeof(t13HB ));
2063 memcpy(t15HB , t15HB_const , sizeof(t15HB ));
2064 memcpy(t16HB , t16HB_const , sizeof(t16HB ));
2065 memcpy(t24HB , t24HB_const , sizeof(t24HB ));
2066 memcpy( t1l , t1l_const , sizeof(t1l ));
2067 memcpy( t2l , t2l_const , sizeof(t2l ));
2068 memcpy( t3l , t3l_const , sizeof(t3l ));
2069 memcpy( t5l , t5l_const , sizeof(t5l ));
2070 memcpy( t6l , t6l_const , sizeof(t6l ));
2071 memcpy( t7l , t7l_const , sizeof(t7l ));
2072 memcpy( t8l , t8l_const , sizeof(t8l ));
2073 memcpy( t9l , t9l_const , sizeof(t9l ));
2074 memcpy(t10l , t10l_const , sizeof(t10l ));
2075 memcpy(t11l , t11l_const , sizeof(t11l ));
2076 memcpy(t12l , t12l_const , sizeof(t12l ));
2077 memcpy(t13l , t13l_const , sizeof(t13l ));
2078 memcpy(t15l , t15l_const , sizeof(t15l ));
2079 memcpy(t16l , t16l_const , sizeof(t16l ));
2080 memcpy(t24l , t24l_const , sizeof(t24l ));
2081 memcpy(ht , ht_const , sizeof(ht ));
2082
2083 ht[ 0].table = NULL; ht[ 0].hlen = NULL; /* Apparently not used */
2084 ht[ 1].table = t1HB; ht[ 1].hlen = t1l;
2085 ht[ 2].table = t2HB; ht[ 2].hlen = t2l;
2086 ht[ 3].table = t3HB; ht[ 3].hlen = t3l;
2087 ht[ 4].table = NULL; ht[ 4].hlen = NULL; /* Apparently not used */
2088 ht[ 5].table = t5HB; ht[ 5].hlen = t5l;
2089 ht[ 6].table = t6HB; ht[ 6].hlen = t6l;
2090 ht[ 7].table = t7HB; ht[ 7].hlen = t7l;
2091 ht[ 8].table = t8HB; ht[ 8].hlen = t8l;
2092 ht[ 9].table = t9HB; ht[ 9].hlen = t9l;
2093 ht[10].table = t10HB; ht[10].hlen = t10l;
2094 ht[11].table = t11HB; ht[11].hlen = t11l;
2095 ht[12].table = t12HB; ht[12].hlen = t12l;
2096 ht[13].table = t13HB; ht[13].hlen = t13l;
2097 ht[14].table = NULL; ht[14].hlen = NULL; /* Apparently not used */
2098 ht[15].table = t15HB; ht[15].hlen = t15l;
2099
2100 /* Figure average number of 'bytes' per frame */
2101 avg_byte_per_frame = SAMPL2 * 16000 * cfg.mpg.bitrate / (2 - cfg.mpg.type);
2102 avg_byte_per_frame = avg_byte_per_frame / cfg.samplerate;
2103 cfg.byte_per_frame = avg_byte_per_frame / 64;
2104 cfg.frac_per_frame = avg_byte_per_frame & 63;
2105 cfg.slot_lag = 0;
2106 cfg.sideinfo_len = 32 + (cfg.mpg.type ? (cfg.channels == 1 ? 136 : 256)
2107 : (cfg.channels == 1 ? 72 : 136));
2108
2109 return true;
2110 }
2111
2112 static inline void to_mono(uint32_t **samp)
2113 {
2114 int32_t lr = **samp;
2115 int32_t m = (int16_t)lr + (lr >> 16) + err;
2116 err = m & 1;
2117 m >>= 1;
2118 *(*samp)++ = (m << 16) | (uint16_t)m;
2119 } /* to_mono */
2120
2121 static void to_mono_mm(void)
2122 {
2123 /* |llllllllllllllll|rrrrrrrrrrrrrrrr| =>
2124 * |mmmmmmmmmmmmmmmm|mmmmmmmmmmmmmmmm|
2125 */
2126 uint32_t *samp = (uint32_t *)&mfbuf[2*512];
2127 uint32_t *samp_end = samp + samp_per_frame;
2128
2129 do
2130 {
2131 to_mono(&samp);
2132 to_mono(&samp);
2133 to_mono(&samp);
2134 to_mono(&samp);
2135 to_mono(&samp);
2136 to_mono(&samp);
2137 to_mono(&samp);
2138 to_mono(&samp);
2139 }
2140 while (samp < samp_end);
2141 } /* to_mono_mm */
2142
2143 #ifdef ROCKBOX_LITTLE_ENDIAN
2144
2145 /* Swaps a frame to big endian */
2146 static inline void byte_swap_frame32(uint32_t *dst, uint32_t *src,
2147 size_t size)
2148 {
2149 assert(dst); assert(src);
2150 uint32_t *src_end = SKIPBYTES(src, size);
2151
2152 do
2153 {
2154 #define swap32 bswap_32
2155 *dst++ = swap32(*src); src++;
2156 *dst++ = swap32(*src); src++;
2157 *dst++ = swap32(*src); src++;
2158 *dst++ = swap32(*src); src++;
2159 *dst++ = swap32(*src); src++;
2160 *dst++ = swap32(*src); src++;
2161 *dst++ = swap32(*src); src++;
2162 *dst++ = swap32(*src); src++;
2163 }
2164 while(src < src_end);
2165 } /* byte_swap_frame32 */
2166 #endif /* ROCKBOX_LITTLE_ENDIAN */
2167
2168 static void set_scale_facs(int *mdct_freq)
2169 {
2170 unsigned int i, is, ie, k, s;
2171 int max_freq_val, avrg_freq_val;
2172
2173 /* calc average of first 256 frequency values */
2174 for(avrg_freq_val=i=0; i<256; i++)
2175 avrg_freq_val += mdct_freq[i];
2176 avrg_freq_val >>= 8;
2177
2178 /* if max of current band is smaller than average, increase precision */
2179 /* last band keeps untouched (not scaled) */
2180 for(is=k=0; is<scalefac[21]; k++)
2181 {
2182 max_freq_val = 0;
2183
2184 for(i=is, ie=scalefac[k+1]; i<ie; i++)
2185 if(max_freq_val < mdct_freq[i])
2186 max_freq_val = mdct_freq[i];
2187
2188 for(s=0; s<3; s++)
2189 if((max_freq_val<<s) > avrg_freq_val)
2190 break;
2191
2192 band_scale_f[k] = (unsigned char)s;
2193
2194 for(i=is; s && i<ie; i++)
2195 mdct_freq[i] <<= s;
2196
2197 is = ie;
2198 }
2199 }
2200
2201 static void encode_frame(char *buffer, struct enc_chunk_hdr *chunk)
2202 {
2203 int gr, gr_cnt;
2204 uint32_t max;
2205 /* encode one mp3 frame in this loop */
2206 CodedData.bitpos = 0;
2207 memset(CodedData.bbuf, 0, sizeof(CodedData.bbuf));
2208
2209 if((cfg.slot_lag += cfg.frac_per_frame) >= 64)
2210 { /* Padding for this frame */
2211 cfg.slot_lag -= 64;
2212 cfg.mpg.padding = 1;
2213 }
2214 else
2215 cfg.mpg.padding = 0;
2216
2217 cfg.mean_bits = (8 * cfg.byte_per_frame + 8 * cfg.mpg.padding
2218 - cfg.sideinfo_len) / cfg.granules / cfg.channels
2219 - 42; // reserved for scale_facs
2220
2221 /* shift out old samples */
2222 memcpy(mfbuf, mfbuf + 2*cfg.granules*576, 4*512);
2223
2224 if (chunk->flags & CHUNKF_START_FILE)
2225 {
2226 /* prefix silent samples for encoder delay */
2227 memset(mfbuf + 2*512, 0, ENC_DELAY_SIZE);
2228 /* read new samples to iram for further processing */
2229 memcpy(mfbuf + 2*512 + ENC_DELAY_SIZE/2,
2230 buffer, pcm_chunk_size - ENC_DELAY_SIZE);
2231 chunk->num_pcm = samp_per_frame - ENC_DELAY_SAMP;
2232 }
2233 else
2234 {
2235 /* read new samples to iram for further processing */
2236 memcpy(mfbuf + 2*512, buffer, pcm_chunk_size);
2237 chunk->num_pcm = samp_per_frame;
2238 }
2239
2240 if (cfg.channels == 1)
2241 to_mono_mm();
2242
2243 cfg.ResvSize = 0;
2244 gr_cnt = cfg.granules * cfg.channels;
2245 CodedData.bitpos = cfg.sideinfo_len; /* leave space for mp3 header */
2246
2247 for(gr=0; gr<cfg.granules; gr++)
2248 {
2249 short *wk = mfbuf + 2*286 + gr*1152;
2250 int ch;
2251
2252 /* 16bit packed wav data can be windowed efficiently on coldfire */
2253 window_subband1(wk, sb_data[0][1-gr][0], sb_data[1][1-gr][0]);
2254
2255 for(ch=0; ch<cfg.channels; ch++)
2256 {
2257 int ii, k, shift;
2258
2259 wk = mfbuf + 2*286 + gr*1152 + ch;
2260
2261 /* 36864=4*18*16*32 */
2262 for(k=0; k<18; k++, wk+=64)
2263 {
2264 window_subband2(wk, sb_data[ch][1-gr][k]);
2265 /* Compensate for inversion in the analysis filter */
2266 if(k & 1)
2267 {
2268 int band;
2269 for(band=1; band<32; band+=2)
2270 sb_data[ch][1-gr][k][band] *= -1;
2271 }
2272 }
2273
2274 /* Perform imdct of 18 previous + 18 current subband samples */
2275 /* for integer precision do this loop again (if neccessary) */
2276 shift = 14 - (cfg.cod_info[gr][ch].additStep >> 2);
2277 for(k=1,ii=0; ii<3 && k; ii++)
2278 {
2279 int *mdct = mdct_freq;
2280 int band;
2281
2282 cfg.cod_info[gr][ch].additStep = 4 * (14 - shift);
2283
2284 for(band=0; band<cfg.mpg.num_bands; band++, mdct+=18)
2285 {
2286 int *band0 = sb_data[ch][ gr][0] + order[band];
2287 int *band1 = sb_data[ch][1-gr][0] + order[band];
2288 int work[18];
2289
2290 /* 9216=4*32*9*8 */
2291 for(k=-9; k<0; k++)
2292 {
2293 int a = shft_n(band1[(k+9)*32], shift);
2294 int b = shft_n(band1[(8-k)*32], shift);
2295 int c = shft_n(band0[(k+9)*32], shift);
2296 int d = shft_n(band0[(8-k)*32], shift);
2297
2298 work[k+ 9] = shft16(a * win[k+ 9][0] +
2299 b * win[k+ 9][1] +
2300 c * win[k+ 9][2] +
2301 d * win[k+ 9][3]);
2302
2303 work[k+18] = shft16(c * win[k+18][0] +
2304 d * win[k+18][1] +
2305 a * win[k+18][2] +
2306 b * win[k+18][3]);
2307 }
2308
2309 /* 7200=4*18*100 */
2310 mdct_long(mdct, work);
2311
2312 /* Perform aliasing reduction butterfly */
2313 if(band != 0)
2314 {
2315 for(k=7; k>=0; --k)
2316 {
2317 int bu, bd;
2318 bu = shft15(mdct[k]) * ca[k] +
2319 shft15(mdct[-1-k]) * cs[k];
2320 bd = shft15(mdct[k]) * cs[k] -
2321 shft15(mdct[-1-k]) * ca[k];
2322 mdct[-1-k] = bu;
2323 mdct[ k ] = bd;
2324 }
2325 }
2326 }
2327
2328 max = 0;
2329 for(k=0; k<576; k++)
2330 {
2331 if(mdct_freq[k] < 0)
2332 {
2333 mdct_sign[k] = 1; /* negative */
2334 mdct_freq[k] = shft13(-mdct_freq[k]);
2335 }
2336 else
2337 {
2338 mdct_sign[k] = 0; /* positive */
2339 mdct_freq[k] = shft13(mdct_freq[k]);
2340 }
2341
2342 if(max < (uint32_t)mdct_freq[k])
2343 max = (uint32_t)mdct_freq[k];
2344 }
2345 cfg.cod_info[gr][ch].max_val = max;
2346
2347 /* calc new shift for higher integer precision */
2348 for(k=0; max<(uint32_t)(0x7800>>k); k++) shift--;
2349 for( ; (max>>k)>=(uint32_t)0x10000; k++) shift++;
2350 if(shift < 0) shift = 0;
2351 }
2352
2353 cfg.cod_info[gr][ch].quantStep +=
2354 cfg.cod_info[gr][ch].additStep;
2355
2356 set_scale_facs(mdct_freq);
2357
2358 /* bit and noise allocation */
2359 iteration_loop(mdct_freq, &cfg.cod_info[gr][ch],
2360 gr_cnt--);
2361
2362 /* write the frame to the bitstream */
2363 Huffmancodebits(enc_data, mdct_sign,
2364 &cfg.cod_info[gr][ch]);
2365
2366 cfg.cod_info[gr][ch].quantStep -=
2367 cfg.cod_info[gr][ch].additStep;
2368
2369 if(cfg.granules == 1)
2370 {
2371 memcpy(sb_data[ch][0], sb_data[ch][1],
2372 sizeof(sb_data[ch][0]));
2373 }
2374 }
2375 }
2376 chunk->enc_size = cfg.byte_per_frame + cfg.mpg.padding;
2377
2378 /* finish this chunk by adding sideinfo header data */
2379 CodedData.bitpos = 0;
2380 encodeSideInfo( cfg.cod_info );
2381
2382 #ifdef ROCKBOX_BIG_ENDIAN
2383 /* copy chunk to enc_buffer */
2384 memcpy(chunk->enc_data, CodedData.bbuf, chunk->enc_size);
2385 #else
2386 /* swap frame to big endian */
2387 byte_swap_frame32((uint32_t *)chunk->enc_data, CodedData.bbuf, chunk->enc_size);
2388 #endif
2389 } /* encode_frame */