diff options
Diffstat (limited to 'baseline/source/adpcm_enc/adpcm_enc.c')
-rw-r--r-- | baseline/source/adpcm_enc/adpcm_enc.c | 758 |
1 files changed, 758 insertions, 0 deletions
diff --git a/baseline/source/adpcm_enc/adpcm_enc.c b/baseline/source/adpcm_enc/adpcm_enc.c new file mode 100644 index 0000000..d9fb09a --- /dev/null +++ b/baseline/source/adpcm_enc/adpcm_enc.c | |||
@@ -0,0 +1,758 @@ | |||
1 | /* | ||
2 | |||
3 | This program is part of the TACLeBench benchmark suite. | ||
4 | Version V 2.0 | ||
5 | |||
6 | Name: adpcm_enc | ||
7 | |||
8 | Author: Sung-Soo Lim | ||
9 | |||
10 | Function: CCITT G.722 ADPCM (Adaptive Differential Pulse Code Modulation) | ||
11 | algorithm. 16khz sample rate data is stored in the array test_data[SIZE]. | ||
12 | Results are stored in the array compressed[SIZE]. | ||
13 | Execution time is determined by the constant SIZE (default value is 2000). | ||
14 | |||
15 | |||
16 | Source: C Algorithms for Real-Time DSP by P. M. Embree | ||
17 | and SNU-RT Benchmark Suite for Worst Case Timing Analysis | ||
18 | collected and modified by S.-S. Lim <sslim@archi.snu.ac.kr> | ||
19 | |||
20 | Original name: adpcm_encoder | ||
21 | |||
22 | Changes: no major functional changes | ||
23 | |||
24 | License: may be used, modified, and re-distributed freely, but the | ||
25 | SNU-RT Benchmark Suite must be acknowledged | ||
26 | |||
27 | */ | ||
28 | |||
29 | |||
30 | /* common sampling rate for sound cards on IBM/PC */ | ||
31 | |||
32 | #include "../extra.h" | ||
33 | #define SAMPLE_RATE 11025 | ||
34 | |||
35 | #define PI 3141 | ||
36 | #define SIZE 3 | ||
37 | #define IN_END 4 | ||
38 | |||
39 | |||
40 | /* | ||
41 | Forward declaration of functions | ||
42 | */ | ||
43 | |||
44 | int adpcm_enc_encode( int, int ); | ||
45 | int adpcm_enc_filtez( int *bpl, int *dlt ); | ||
46 | void adpcm_enc_upzero( int dlt, int *dlti, int *bli ); | ||
47 | int adpcm_enc_filtep( int rlt1, int al1, int rlt2, int al2 ); | ||
48 | int adpcm_enc_quantl( int el, int detl ); | ||
49 | int adpcm_enc_logscl( int il, int nbl ); | ||
50 | int adpcm_enc_scalel( int nbl, int shift_constant ); | ||
51 | int adpcm_enc_uppol2( int al1, int al2, int plt, int plt1, int plt2 ); | ||
52 | int adpcm_enc_uppol1( int al1, int apl2, int plt, int plt1 ); | ||
53 | int adpcm_enc_logsch( int ih, int nbh ); | ||
54 | void adpcm_enc_reset(); | ||
55 | int adpcm_enc_fabs( int n ); | ||
56 | int adpcm_enc_cos( int n ); | ||
57 | int adpcm_enc_sin( int n ); | ||
58 | int adpcm_enc_abs( int n ); | ||
59 | void adpcm_enc_init(void); | ||
60 | void adpcm_enc_main(void); | ||
61 | int adpcm_enc_return(void); | ||
62 | //int main(void); | ||
63 | |||
64 | /* | ||
65 | Forward declaration of global variables | ||
66 | */ | ||
67 | |||
68 | int adpcm_enc_test_data[SIZE * 2], adpcm_enc_compressed[SIZE]; | ||
69 | |||
70 | |||
71 | /* G722 C code */ | ||
72 | |||
73 | /* variables for transimit quadrature mirror filter here */ | ||
74 | int adpcm_enc_tqmf[24]; | ||
75 | |||
76 | /* QMF filter coefficients: | ||
77 | scaled by a factor of 4 compared to G722 CCITT recommendation */ | ||
78 | int adpcm_enc_h[24] = { | ||
79 | 12, -44, -44, 212, 48, -624, 128, 1448, | ||
80 | -840, -3220, 3804, 15504, 15504, 3804, -3220, -840, | ||
81 | 1448, 128, -624, 48, 212, -44, -44, 12 | ||
82 | }; | ||
83 | |||
84 | int adpcm_enc_xl, adpcm_enc_xh; | ||
85 | |||
86 | /* variables for encoder (hi and lo) here */ | ||
87 | |||
88 | int adpcm_enc_il, adpcm_enc_szl, adpcm_enc_spl, adpcm_enc_sl, adpcm_enc_el; | ||
89 | |||
90 | int adpcm_enc_qq4_code4_table[16] = { | ||
91 | 0, -20456, -12896, -8968, -6288, -4240, -2584, -1200, | ||
92 | 20456, 12896, 8968, 6288, 4240, 2584, 1200, 0 | ||
93 | }; | ||
94 | |||
95 | int adpcm_enc_qq5_code5_table[32] = { | ||
96 | -280, -280, -23352, -17560, -14120, -11664, -9752, -8184, | ||
97 | -6864, -5712, -4696, -3784, -2960, -2208, -1520, -880, | ||
98 | 23352, 17560, 14120, 11664, 9752, 8184, 6864, 5712, | ||
99 | 4696, 3784, 2960, 2208, 1520, 880, 280, -280 | ||
100 | }; | ||
101 | |||
102 | int adpcm_enc_qq6_code6_table[64] = { | ||
103 | -136, -136, -136, -136, -24808, -21904, -19008, -16704, | ||
104 | -14984, -13512, -12280, -11192, -10232, -9360, -8576, -7856, | ||
105 | -7192, -6576, -6000, -5456, -4944, -4464, -4008, -3576, | ||
106 | -3168, -2776, -2400, -2032, -1688, -1360, -1040, -728, | ||
107 | 24808, 21904, 19008, 16704, 14984, 13512, 12280, 11192, | ||
108 | 10232, 9360, 8576, 7856, 7192, 6576, 6000, 5456, | ||
109 | 4944, 4464, 4008, 3576, 3168, 2776, 2400, 2032, | ||
110 | 1688, 1360, 1040, 728, 432, 136, -432, -136 | ||
111 | }; | ||
112 | |||
113 | int adpcm_enc_delay_bpl[6]; | ||
114 | |||
115 | int adpcm_enc_delay_dltx[6]; | ||
116 | |||
117 | int adpcm_enc_wl_code_table[16] = { | ||
118 | -60, 3042, 1198, 538, 334, 172, 58, -30, | ||
119 | 3042, 1198, 538, 334, 172, 58, -30, -60 | ||
120 | }; | ||
121 | |||
122 | int adpcm_enc_ilb_table[32] = { | ||
123 | 2048, 2093, 2139, 2186, 2233, 2282, 2332, 2383, | ||
124 | 2435, 2489, 2543, 2599, 2656, 2714, 2774, 2834, | ||
125 | 2896, 2960, 3025, 3091, 3158, 3228, 3298, 3371, | ||
126 | 3444, 3520, 3597, 3676, 3756, 3838, 3922, 4008 | ||
127 | }; | ||
128 | |||
129 | int adpcm_enc_nbl; /* delay line */ | ||
130 | int adpcm_enc_al1, adpcm_enc_al2; | ||
131 | int adpcm_enc_plt, adpcm_enc_plt1, adpcm_enc_plt2; | ||
132 | int adpcm_enc_dlt; | ||
133 | int adpcm_enc_rlt, adpcm_enc_rlt1, adpcm_enc_rlt2; | ||
134 | |||
135 | /* decision levels - pre-multiplied by 8, 0 to indicate end */ | ||
136 | int adpcm_enc_decis_levl[30] = { | ||
137 | 280, 576, 880, 1200, 1520, 1864, 2208, 2584, | ||
138 | 2960, 3376, 3784, 4240, 4696, 5200, 5712, 6288, | ||
139 | 6864, 7520, 8184, 8968, 9752, 10712, 11664, 12896, | ||
140 | 14120, 15840, 17560, 20456, 23352, 32767 | ||
141 | }; | ||
142 | |||
143 | int adpcm_enc_detl; | ||
144 | |||
145 | /* quantization table 31 long to make quantl look-up easier, | ||
146 | last entry is for mil=30 case when wd is max */ | ||
147 | int adpcm_enc_quant26bt_pos[31] = { | ||
148 | 61, 60, 59, 58, 57, 56, 55, 54, | ||
149 | 53, 52, 51, 50, 49, 48, 47, 46, | ||
150 | 45, 44, 43, 42, 41, 40, 39, 38, | ||
151 | 37, 36, 35, 34, 33, 32, 32 | ||
152 | }; | ||
153 | |||
154 | /* quantization table 31 long to make quantl look-up easier, | ||
155 | last entry is for mil=30 case when wd is max */ | ||
156 | int adpcm_enc_quant26bt_neg[31] = { | ||
157 | 63, 62, 31, 30, 29, 28, 27, 26, | ||
158 | 25, 24, 23, 22, 21, 20, 19, 18, | ||
159 | 17, 16, 15, 14, 13, 12, 11, 10, | ||
160 | 9, 8, 7, 6, 5, 4, 4 | ||
161 | }; | ||
162 | |||
163 | |||
164 | int adpcm_enc_deth; | ||
165 | int adpcm_enc_sh; /* this comes from adaptive predictor */ | ||
166 | int adpcm_enc_eh; | ||
167 | |||
168 | int adpcm_enc_qq2_code2_table[4] = { | ||
169 | -7408, -1616, 7408, 1616 | ||
170 | }; | ||
171 | |||
172 | int adpcm_enc_wh_code_table[4] = { | ||
173 | 798, -214, 798, -214 | ||
174 | }; | ||
175 | |||
176 | |||
177 | int adpcm_enc_dh, adpcm_enc_ih; | ||
178 | int adpcm_enc_nbh, adpcm_enc_szh; | ||
179 | int adpcm_enc_sph, adpcm_enc_ph, adpcm_enc_yh; | ||
180 | |||
181 | int adpcm_enc_delay_dhx[6]; | ||
182 | int adpcm_enc_delay_bph[6]; | ||
183 | |||
184 | int adpcm_enc_ah1, adpcm_enc_ah2; | ||
185 | int adpcm_enc_ph1, adpcm_enc_ph2; | ||
186 | int adpcm_enc_rh1, adpcm_enc_rh2; | ||
187 | |||
188 | |||
189 | /* G722 encode function two ints in, one 8 bit output */ | ||
190 | |||
191 | /* put input samples in xin1 = first value, xin2 = second value */ | ||
192 | /* returns il and ih stored together */ | ||
193 | |||
194 | |||
195 | /* MAX: 1 */ | ||
196 | int adpcm_enc_abs( int n ) | ||
197 | { | ||
198 | int m; | ||
199 | |||
200 | |||
201 | if ( n >= 0 ) | ||
202 | m = n; | ||
203 | else | ||
204 | m = -n; | ||
205 | |||
206 | return m; | ||
207 | } | ||
208 | |||
209 | |||
210 | /* MAX: 1 */ | ||
211 | int adpcm_enc_fabs( int n ) | ||
212 | { | ||
213 | int f; | ||
214 | |||
215 | |||
216 | if ( n >= 0 ) | ||
217 | f = n; | ||
218 | else | ||
219 | f = -n; | ||
220 | |||
221 | return f; | ||
222 | } | ||
223 | |||
224 | |||
225 | int adpcm_enc_sin( int rad ) | ||
226 | { | ||
227 | int diff; | ||
228 | int app = 0; | ||
229 | int inc = 1; | ||
230 | |||
231 | |||
232 | /* MAX dependent on rad's value, say 50 */ | ||
233 | _Pragma("loopbound min 0 max 0") | ||
234 | while ( rad > 2 * PI ) { | ||
235 | rad -= 2 * PI; | ||
236 | } | ||
237 | |||
238 | /* MAX dependent on rad's value, say 50 */ | ||
239 | _Pragma("loopbound min 0 max 1999") | ||
240 | while ( rad < -2 * PI ) { | ||
241 | rad += 2 * PI; | ||
242 | } | ||
243 | |||
244 | diff = rad; | ||
245 | app = diff; | ||
246 | diff = (diff * (-(rad*rad))) / ((2 * inc) * (2 * inc + 1)); | ||
247 | app = app + diff; | ||
248 | inc++; | ||
249 | |||
250 | /* REALLY: while(my_fabs(diff) >= 0.00001) { */ | ||
251 | /* MAX: 1000 */ | ||
252 | _Pragma("loopbound min 849 max 2424") | ||
253 | while ( adpcm_enc_fabs( diff ) >= 1 ) { | ||
254 | diff = (diff * (-(rad*rad))) / ((2 * inc) * (2 * inc + 1)); | ||
255 | app = app + diff; | ||
256 | inc++; | ||
257 | } | ||
258 | |||
259 | return app; | ||
260 | } | ||
261 | |||
262 | |||
263 | int adpcm_enc_cos( int rad ) | ||
264 | { | ||
265 | return( adpcm_enc_sin( PI / 2 - rad ) ); | ||
266 | } | ||
267 | |||
268 | |||
269 | /* MAX: 1 */ | ||
270 | int adpcm_enc_encode( int xin1, int xin2 ) | ||
271 | { | ||
272 | int i; | ||
273 | int *h_ptr, *tqmf_ptr, *tqmf_ptr1; | ||
274 | long int xa, xb; | ||
275 | int decis; | ||
276 | |||
277 | |||
278 | /* transmit quadrature mirror filters implemented here */ | ||
279 | h_ptr = adpcm_enc_h; | ||
280 | tqmf_ptr = adpcm_enc_tqmf; | ||
281 | xa = (long)(*tqmf_ptr++) * (*h_ptr++); | ||
282 | xb = (long)(*tqmf_ptr++) * (*h_ptr++); | ||
283 | |||
284 | /* main multiply accumulate loop for samples and coefficients */ | ||
285 | /* MAX: 10 */ | ||
286 | _Pragma("loopbound min 10 max 10") | ||
287 | for ( i = 0; i < 10; i++ ) { | ||
288 | xa += (long)(*tqmf_ptr++) * (*h_ptr++); | ||
289 | xb += (long)(*tqmf_ptr++) * (*h_ptr++); | ||
290 | } | ||
291 | |||
292 | /* final mult/accumulate */ | ||
293 | xa += (long)(*tqmf_ptr++) * (*h_ptr++); | ||
294 | xb += (long)(*tqmf_ptr) * (*h_ptr++); | ||
295 | |||
296 | /* update delay line tqmf */ | ||
297 | tqmf_ptr1 = tqmf_ptr - 2; | ||
298 | /* MAX: 22 */ | ||
299 | _Pragma("loopbound min 22 max 22") | ||
300 | for ( i = 0; i < 22; i++ ) { | ||
301 | *tqmf_ptr-- = *tqmf_ptr1--; | ||
302 | } | ||
303 | |||
304 | *tqmf_ptr-- = xin1; | ||
305 | *tqmf_ptr = xin2; | ||
306 | |||
307 | /* scale outputs */ | ||
308 | adpcm_enc_xl = (xa + xb) >> 15; | ||
309 | adpcm_enc_xh = (xa - xb) >> 15; | ||
310 | |||
311 | /* end of quadrature mirror filter code */ | ||
312 | |||
313 | /* starting with lower sub band encoder */ | ||
314 | |||
315 | /* filtez - compute predictor output section - zero section */ | ||
316 | adpcm_enc_szl = adpcm_enc_filtez( adpcm_enc_delay_bpl, adpcm_enc_delay_dltx ); | ||
317 | |||
318 | /* filtep - compute predictor output signal (pole section) */ | ||
319 | adpcm_enc_spl = adpcm_enc_filtep( adpcm_enc_rlt1, adpcm_enc_al1, adpcm_enc_rlt2, adpcm_enc_al2 ); | ||
320 | |||
321 | /* compute the predictor output value in the lower sub_band encoder */ | ||
322 | adpcm_enc_sl = adpcm_enc_szl + adpcm_enc_spl; | ||
323 | adpcm_enc_el = adpcm_enc_xl - adpcm_enc_sl; | ||
324 | |||
325 | /* quantl: quantize the difference signal */ | ||
326 | adpcm_enc_il = adpcm_enc_quantl( adpcm_enc_el, adpcm_enc_detl ); | ||
327 | |||
328 | /* invqxl: computes quantized difference signal */ | ||
329 | /* for invqbl, truncate by 2 lsbs, so mode = 3 */ | ||
330 | adpcm_enc_dlt = ( (long) adpcm_enc_detl * adpcm_enc_qq4_code4_table[adpcm_enc_il >> 2] ) >> 15; | ||
331 | |||
332 | /* logscl: updates logarithmic quant. scale factor in low sub band */ | ||
333 | adpcm_enc_nbl = adpcm_enc_logscl( adpcm_enc_il, adpcm_enc_nbl ); | ||
334 | |||
335 | /* scalel: compute the quantizer scale factor in the lower sub band */ | ||
336 | /* calling parameters nbl and 8 (constant such that scalel can be scaleh) */ | ||
337 | adpcm_enc_detl = adpcm_enc_scalel( adpcm_enc_nbl, 8 ); | ||
338 | |||
339 | /* parrec - simple addition to compute recontructed signal for adaptive pred */ | ||
340 | adpcm_enc_plt = adpcm_enc_dlt + adpcm_enc_szl; | ||
341 | |||
342 | /* upzero: update zero section predictor coefficients (sixth order)*/ | ||
343 | /* calling parameters: dlt, dlt1, dlt2, ..., dlt6 from dlt */ | ||
344 | /* bpli (linear_buffer in which all six values are delayed */ | ||
345 | /* return params: updated bpli, delayed dltx */ | ||
346 | adpcm_enc_upzero( adpcm_enc_dlt, adpcm_enc_delay_dltx, adpcm_enc_delay_bpl ); | ||
347 | |||
348 | /* uppol2- update second predictor coefficient apl2 and delay it as al2 */ | ||
349 | /* calling parameters: al1, al2, plt, plt1, plt2 */ | ||
350 | adpcm_enc_al2 = adpcm_enc_uppol2( adpcm_enc_al1, adpcm_enc_al2, adpcm_enc_plt, adpcm_enc_plt1, adpcm_enc_plt2 ); | ||
351 | |||
352 | /* uppol1 :update first predictor coefficient apl1 and delay it as al1 */ | ||
353 | /* calling parameters: al1, apl2, plt, plt1 */ | ||
354 | adpcm_enc_al1 = adpcm_enc_uppol1( adpcm_enc_al1, adpcm_enc_al2, adpcm_enc_plt, adpcm_enc_plt1); | ||
355 | |||
356 | /* recons : compute recontructed signal for adaptive predictor */ | ||
357 | adpcm_enc_rlt = adpcm_enc_sl + adpcm_enc_dlt; | ||
358 | |||
359 | /* done with lower sub_band encoder; now implement delays for next time*/ | ||
360 | adpcm_enc_rlt2 = adpcm_enc_rlt1; | ||
361 | adpcm_enc_rlt1 = adpcm_enc_rlt; | ||
362 | adpcm_enc_plt2 = adpcm_enc_plt1; | ||
363 | adpcm_enc_plt1 = adpcm_enc_plt; | ||
364 | |||
365 | /* high band encode */ | ||
366 | |||
367 | adpcm_enc_szh = adpcm_enc_filtez( adpcm_enc_delay_bph, adpcm_enc_delay_dhx ); | ||
368 | |||
369 | adpcm_enc_sph = adpcm_enc_filtep( adpcm_enc_rh1, adpcm_enc_ah1, adpcm_enc_rh2, adpcm_enc_ah2 ); | ||
370 | |||
371 | /* predic: sh = sph + szh */ | ||
372 | adpcm_enc_sh = adpcm_enc_sph + adpcm_enc_szh; | ||
373 | /* subtra: eh = xh - sh */ | ||
374 | adpcm_enc_eh = adpcm_enc_xh - adpcm_enc_sh; | ||
375 | |||
376 | /* quanth - quantization of difference signal for higher sub-band */ | ||
377 | /* quanth: in-place for speed params: eh, deth (has init. value) */ | ||
378 | if ( adpcm_enc_eh >= 0 ) | ||
379 | adpcm_enc_ih = 3; /* 2,3 are pos codes */ | ||
380 | else | ||
381 | adpcm_enc_ih = 1; /* 0,1 are neg codes */ | ||
382 | |||
383 | decis = ( 564L * (long)adpcm_enc_deth ) >> 12L; | ||
384 | if ( adpcm_enc_abs( adpcm_enc_eh ) > decis ) | ||
385 | adpcm_enc_ih--; /* mih = 2 case */ | ||
386 | |||
387 | /* invqah: compute the quantized difference signal, higher sub-band*/ | ||
388 | adpcm_enc_dh = ( (long)adpcm_enc_deth * adpcm_enc_qq2_code2_table[adpcm_enc_ih] ) >> 15L ; | ||
389 | |||
390 | /* logsch: update logarithmic quantizer scale factor in hi sub-band*/ | ||
391 | adpcm_enc_nbh = adpcm_enc_logsch( adpcm_enc_ih, adpcm_enc_nbh ); | ||
392 | |||
393 | /* note : scalel and scaleh use same code, different parameters */ | ||
394 | adpcm_enc_deth = adpcm_enc_scalel( adpcm_enc_nbh, 10 ); | ||
395 | |||
396 | /* parrec - add pole predictor output to quantized diff. signal */ | ||
397 | adpcm_enc_ph = adpcm_enc_dh + adpcm_enc_szh; | ||
398 | |||
399 | /* upzero: update zero section predictor coefficients (sixth order) */ | ||
400 | /* calling parameters: dh, dhi, bphi */ | ||
401 | /* return params: updated bphi, delayed dhx */ | ||
402 | adpcm_enc_upzero( adpcm_enc_dh, adpcm_enc_delay_dhx, adpcm_enc_delay_bph ); | ||
403 | |||
404 | /* uppol2: update second predictor coef aph2 and delay as ah2 */ | ||
405 | /* calling params: ah1, ah2, ph, ph1, ph2 */ | ||
406 | adpcm_enc_ah2 = adpcm_enc_uppol2( adpcm_enc_ah1, adpcm_enc_ah2, adpcm_enc_ph, adpcm_enc_ph1, adpcm_enc_ph2 ); | ||
407 | |||
408 | /* uppol1: update first predictor coef. aph2 and delay it as ah1 */ | ||
409 | adpcm_enc_ah1 = adpcm_enc_uppol1( adpcm_enc_ah1, adpcm_enc_ah2, adpcm_enc_ph, adpcm_enc_ph1 ); | ||
410 | |||
411 | /* recons for higher sub-band */ | ||
412 | adpcm_enc_yh = adpcm_enc_sh + adpcm_enc_dh; | ||
413 | |||
414 | /* done with higher sub-band encoder, now Delay for next time */ | ||
415 | adpcm_enc_rh2 = adpcm_enc_rh1; | ||
416 | adpcm_enc_rh1 = adpcm_enc_yh; | ||
417 | adpcm_enc_ph2 = adpcm_enc_ph1; | ||
418 | adpcm_enc_ph1 = adpcm_enc_ph; | ||
419 | |||
420 | /* multiplex ih and il to get signals together */ | ||
421 | return( adpcm_enc_il | (adpcm_enc_ih << 6) ); | ||
422 | } | ||
423 | |||
424 | |||
425 | /* filtez - compute predictor output signal (zero section) */ | ||
426 | /* input: bpl1-6 and dlt1-6, output: szl */ | ||
427 | int adpcm_enc_filtez( int *bpl, int *dlt ) | ||
428 | { | ||
429 | int i; | ||
430 | long int zl; | ||
431 | |||
432 | |||
433 | zl = (long)(*bpl++) * (*dlt++); | ||
434 | |||
435 | /* MAX: 5 */ | ||
436 | _Pragma("loopbound min 5 max 5") | ||
437 | for ( i = 1; i < 6; i++ ) { | ||
438 | zl += (long)(*bpl++) * (*dlt++); | ||
439 | } | ||
440 | |||
441 | return( (int)(zl >> 14) ); /* x2 here */ | ||
442 | } | ||
443 | |||
444 | |||
445 | /* filtep - compute predictor output signal (pole section) */ | ||
446 | /* input rlt1-2 and al1-2, output spl */ | ||
447 | int adpcm_enc_filtep( int rlt1, int al1, int rlt2, int al2 ) | ||
448 | { | ||
449 | long int pl, pl2; | ||
450 | |||
451 | |||
452 | pl = 2 * rlt1; | ||
453 | pl = (long) al1 * pl; | ||
454 | pl2 = 2 * rlt2; | ||
455 | pl += (long) al2 * pl2; | ||
456 | |||
457 | return( (int)(pl >> 15) ); | ||
458 | } | ||
459 | |||
460 | |||
461 | /* quantl - quantize the difference signal in the lower sub-band */ | ||
462 | int adpcm_enc_quantl( int el, int detl ) | ||
463 | { | ||
464 | int ril, mil; | ||
465 | long int wd, decis; | ||
466 | |||
467 | |||
468 | /* abs of difference signal */ | ||
469 | wd = adpcm_enc_abs( el ); | ||
470 | |||
471 | /* determine mil based on decision levels and detl gain */ | ||
472 | /* MAX: 30 */ | ||
473 | _Pragma("loopbound min 1 max 30") | ||
474 | for ( mil = 0; mil < 30; mil++ ) { | ||
475 | decis = (adpcm_enc_decis_levl[mil] * (long)detl) >> 15L; | ||
476 | if ( wd <= decis ) | ||
477 | break; | ||
478 | } | ||
479 | |||
480 | /* if mil=30 then wd is less than all decision levels */ | ||
481 | if ( el >= 0 ) | ||
482 | ril = adpcm_enc_quant26bt_pos[mil]; | ||
483 | else | ||
484 | ril = adpcm_enc_quant26bt_neg[mil]; | ||
485 | |||
486 | return( ril ); | ||
487 | } | ||
488 | |||
489 | |||
490 | /* invqxl is either invqbl or invqal depending on parameters passed */ | ||
491 | /* returns dlt, code table is pre-multiplied by 8 */ | ||
492 | |||
493 | /* int invqxl(int il,int detl,int *code_table,int mode) */ | ||
494 | /* { */ | ||
495 | /* long int dlt; */ | ||
496 | /* dlt = (long)detl*code_table[il >> (mode-1)]; */ | ||
497 | /* return((int)(dlt >> 15)); */ | ||
498 | /* } */ | ||
499 | |||
500 | /* logscl - update log quantizer scale factor in lower sub-band */ | ||
501 | /* note that nbl is passed and returned */ | ||
502 | int adpcm_enc_logscl( int il, int nbl ) | ||
503 | { | ||
504 | long int wd; | ||
505 | |||
506 | |||
507 | wd = ((long)nbl * 127L) >> 7L; /* leak factor 127/128 */ | ||
508 | nbl = (int)wd + adpcm_enc_wl_code_table[il >> 2]; | ||
509 | |||
510 | if ( nbl < 0 ) | ||
511 | nbl = 0; | ||
512 | if ( nbl > 18432 ) | ||
513 | nbl = 18432; | ||
514 | |||
515 | return( nbl ); | ||
516 | } | ||
517 | |||
518 | |||
519 | /* scalel: compute quantizer scale factor in lower or upper sub-band*/ | ||
520 | int adpcm_enc_scalel( int nbl, int shift_constant ) | ||
521 | { | ||
522 | int wd1, wd2, wd3; | ||
523 | |||
524 | |||
525 | wd1 = (nbl >> 6) & 31; | ||
526 | wd2 = nbl >> 11; | ||
527 | wd3 = adpcm_enc_ilb_table[wd1] >> (shift_constant + 1 - wd2); | ||
528 | |||
529 | return( wd3 << 3 ); | ||
530 | } | ||
531 | |||
532 | |||
533 | /* upzero - inputs: dlt, dlti[0-5], bli[0-5], outputs: updated bli[0-5] */ | ||
534 | /* also implements delay of bli and update of dlti from dlt */ | ||
535 | void adpcm_enc_upzero( int dlt, int *dlti, int *bli ) | ||
536 | { | ||
537 | int i, wd2, wd3; | ||
538 | |||
539 | |||
540 | /*if dlt is zero, then no sum into bli */ | ||
541 | if ( dlt == 0 ) { | ||
542 | _Pragma("loopbound min 6 max 6") | ||
543 | for ( i = 0; i < 6; i++ ) { | ||
544 | bli[i] = (int)((255L * bli[i]) >> 8L); /* leak factor of 255/256 */ | ||
545 | } | ||
546 | |||
547 | } else { | ||
548 | _Pragma("loopbound min 6 max 6") | ||
549 | for ( i = 0; i < 6; i++ ) { | ||
550 | if ( (long)dlt * dlti[i] >= 0 ) | ||
551 | wd2 = 128; | ||
552 | else | ||
553 | wd2 = -128; | ||
554 | |||
555 | wd3 = (int)((255L * bli[i]) >> 8L); /* leak factor of 255/256 */ | ||
556 | bli[i] = wd2 + wd3; | ||
557 | } | ||
558 | |||
559 | } | ||
560 | |||
561 | /* implement delay line for dlt */ | ||
562 | dlti[5] = dlti[4]; | ||
563 | dlti[4] = dlti[3]; | ||
564 | dlti[3] = dlti[2]; | ||
565 | dlti[1] = dlti[0]; | ||
566 | dlti[0] = dlt; | ||
567 | |||
568 | return; | ||
569 | } | ||
570 | |||
571 | |||
572 | /* uppol2 - update second predictor coefficient (pole section) */ | ||
573 | /* inputs: al1, al2, plt, plt1, plt2. outputs: apl2 */ | ||
574 | int adpcm_enc_uppol2( int al1, int al2, int plt, int plt1, int plt2 ) | ||
575 | { | ||
576 | long int wd2, wd4; | ||
577 | int apl2; | ||
578 | |||
579 | |||
580 | wd2 = 4L * (long)al1; | ||
581 | if ( (long)plt * plt1 >= 0L ) | ||
582 | wd2 = -wd2; /* check same sign */ | ||
583 | wd2 = wd2 >> 7; /* gain of 1/128 */ | ||
584 | |||
585 | if ( (long)plt * plt2 >= 0L ) { | ||
586 | wd4 = wd2 + 128; /* same sign case */ | ||
587 | } else { | ||
588 | wd4 = wd2 - 128; | ||
589 | } | ||
590 | apl2 = wd4 + (127L*(long)al2 >> 7L); /* leak factor of 127/128 */ | ||
591 | |||
592 | /* apl2 is limited to +-.75 */ | ||
593 | if ( apl2 > 12288 ) | ||
594 | apl2 = 12288; | ||
595 | if ( apl2 < -12288 ) | ||
596 | apl2 = -12288; | ||
597 | |||
598 | return( apl2 ); | ||
599 | } | ||
600 | |||
601 | |||
602 | /* uppol1 - update first predictor coefficient (pole section) */ | ||
603 | /* inputs: al1, apl2, plt, plt1. outputs: apl1 */ | ||
604 | int adpcm_enc_uppol1( int al1, int apl2, int plt, int plt1 ) | ||
605 | { | ||
606 | long int wd2; | ||
607 | int wd3, apl1; | ||
608 | |||
609 | |||
610 | wd2 = ((long)al1 * 255L) >> 8L; /* leak factor of 255/256 */ | ||
611 | if ( (long)plt * plt1 >= 0L ) { | ||
612 | apl1 = (int)wd2 + 192; /* same sign case */ | ||
613 | } else { | ||
614 | apl1 = (int)wd2 - 192; | ||
615 | } | ||
616 | |||
617 | /* note: wd3= .9375-.75 is always positive */ | ||
618 | wd3 = 15360 - apl2; /* limit value */ | ||
619 | if ( apl1 > wd3 ) | ||
620 | apl1 = wd3; | ||
621 | if ( apl1 < -wd3 ) | ||
622 | apl1 = -wd3; | ||
623 | |||
624 | return( apl1 ); | ||
625 | } | ||
626 | |||
627 | |||
628 | /* INVQAH: inverse adaptive quantizer for the higher sub-band */ | ||
629 | /* returns dh, code table is pre-multiplied by 8 */ | ||
630 | /* int invqah(int ih,int deth) */ | ||
631 | /* { */ | ||
632 | /* long int rdh; */ | ||
633 | /* rdh = ((long)deth*qq2_code2_table[ih]) >> 15L ; */ | ||
634 | /* return((int)(rdh )); */ | ||
635 | /* } */ | ||
636 | |||
637 | |||
638 | /* logsch - update log quantizer scale factor in higher sub-band */ | ||
639 | /* note that nbh is passed and returned */ | ||
640 | int adpcm_enc_logsch( int ih, int nbh ) | ||
641 | { | ||
642 | int wd; | ||
643 | |||
644 | |||
645 | wd = ((long)nbh * 127L) >> 7L; /* leak factor 127/128 */ | ||
646 | nbh = wd + adpcm_enc_wh_code_table[ih]; | ||
647 | |||
648 | if ( nbh < 0 ) | ||
649 | nbh = 0; | ||
650 | if ( nbh > 22528 ) | ||
651 | nbh = 22528; | ||
652 | |||
653 | return( nbh ); | ||
654 | } | ||
655 | |||
656 | |||
657 | /* | ||
658 | Initialization- and return-value-related functions | ||
659 | */ | ||
660 | |||
661 | /* clear all storage locations */ | ||
662 | |||
663 | void adpcm_enc_reset(void) | ||
664 | { | ||
665 | int i; | ||
666 | |||
667 | adpcm_enc_detl = 32; /* reset to min scale factor */ | ||
668 | adpcm_enc_deth = 8; | ||
669 | adpcm_enc_nbl = adpcm_enc_al1 = adpcm_enc_al2 = adpcm_enc_plt1 = adpcm_enc_plt2 = adpcm_enc_rlt1 = adpcm_enc_rlt2 = 0; | ||
670 | adpcm_enc_nbh = adpcm_enc_ah1 = adpcm_enc_ah2 = adpcm_enc_ph1 = adpcm_enc_ph2 = adpcm_enc_rh1 = adpcm_enc_rh2 = 0; | ||
671 | |||
672 | _Pragma("loopbound min 6 max 6") | ||
673 | for ( i = 0; i < 6; i++) { | ||
674 | adpcm_enc_delay_dltx[i] = 0; | ||
675 | adpcm_enc_delay_dhx[i] = 0; | ||
676 | } | ||
677 | |||
678 | _Pragma("loopbound min 6 max 6") | ||
679 | for ( i = 0; i < 6; i++ ) { | ||
680 | adpcm_enc_delay_bpl[i] = 0; | ||
681 | adpcm_enc_delay_bph[i] = 0; | ||
682 | } | ||
683 | |||
684 | _Pragma("loopbound min 23 max 23") | ||
685 | for ( i = 0; i < 23; i++ ) { | ||
686 | adpcm_enc_tqmf[i] = 0; | ||
687 | } | ||
688 | |||
689 | return; | ||
690 | } | ||
691 | |||
692 | |||
693 | void adpcm_enc_init(void) | ||
694 | { | ||
695 | int i, j, f; | ||
696 | volatile int x = 0; | ||
697 | |||
698 | /* reset, initialize required memory */ | ||
699 | adpcm_enc_reset(); | ||
700 | |||
701 | /* read in amplitude and frequency for test data */ | ||
702 | j = 10; | ||
703 | f = 2000; | ||
704 | |||
705 | /* 16 KHz sample rate */ | ||
706 | /* XXmain_0, MAX: 2 */ | ||
707 | /* Since the number of times we loop in my_sin depends on the argument we | ||
708 | add the fact: xxmain_0:[]: */ | ||
709 | _Pragma("loopbound min 3 max 3") | ||
710 | for ( i = 0 ; i < SIZE ; i++) { | ||
711 | adpcm_enc_test_data[i] = (int) j * adpcm_enc_cos( f * PI * i ); | ||
712 | |||
713 | /* avoid constant-propagation optimizations */ | ||
714 | adpcm_enc_test_data[i] += x; | ||
715 | } | ||
716 | } | ||
717 | |||
718 | |||
719 | int adpcm_enc_return(void) | ||
720 | { | ||
721 | int i; | ||
722 | int check_sum = 0; | ||
723 | |||
724 | for ( i = 0 ; i < IN_END ; i += 2 ) { | ||
725 | check_sum += adpcm_enc_compressed[i/2]; | ||
726 | } | ||
727 | |||
728 | return check_sum != 385; | ||
729 | } | ||
730 | |||
731 | |||
732 | /* | ||
733 | Main functions | ||
734 | */ | ||
735 | |||
736 | void _Pragma( "entrypoint" ) adpcm_enc_main(void) | ||
737 | { | ||
738 | int i; | ||
739 | /* MAX: 2 */ | ||
740 | _Pragma("loopbound min 2 max 2") | ||
741 | for ( i = 0 ; i < IN_END ; i += 2 ) { | ||
742 | adpcm_enc_compressed[i/2] = adpcm_enc_encode( adpcm_enc_test_data[i], adpcm_enc_test_data[i+1] ); | ||
743 | } | ||
744 | |||
745 | } | ||
746 | |||
747 | int main(int argc, char **argv) | ||
748 | { | ||
749 | SET_UP | ||
750 | for(jobsComplete=-1; jobsComplete<maxJobs; jobsComplete++){ | ||
751 | START_LOOP | ||
752 | adpcm_enc_init(); | ||
753 | adpcm_enc_main(); | ||
754 | STOP_LOOP | ||
755 | } | ||
756 | WRITE_TO_FILE | ||
757 | return adpcm_enc_return(); | ||
758 | } | ||