FreeCalypso > hg > gsm-codec-lib
annotate libtwamr/qua_gain.c @ 381:32bc48faec4b
libtwamr: integrate int_lpc.c
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Mon, 06 May 2024 05:35:21 +0000 |
parents | b02e043dcba0 |
children |
rev | line source |
---|---|
377
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1 /* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2 ******************************************************************************** |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
3 * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
4 * GSM AMR-NB speech codec R98 Version 7.6.0 December 12, 2001 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
5 * R99 Version 3.3.0 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
6 * REL-4 Version 4.1.0 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
7 * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
8 ******************************************************************************** |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
9 * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
10 * File : qua_gain.c |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
11 * Purpose : Quantization of pitch and codebook gains. |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
12 * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
13 ******************************************************************************** |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
14 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
15 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
16 /* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
17 ******************************************************************************** |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
18 * MODULE INCLUDE FILE AND VERSION ID |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
19 ******************************************************************************** |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
20 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
21 #include "namespace.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
22 #include "qua_gain.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
23 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
24 /* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
25 ******************************************************************************** |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
26 * INCLUDE FILES |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
27 ******************************************************************************** |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
28 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
29 #include "tw_amr.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
30 #include "typedef.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
31 #include "basic_op.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
32 #include "oper_32b.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
33 #include "no_count.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
34 #include "cnst.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
35 #include "pow2.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
36 #include "gc_pred.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
37 #include "qua_gain_tab.h" |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
38 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
39 /* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
40 ******************************************************************************** |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
41 * PUBLIC PROGRAM CODE |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
42 ******************************************************************************** |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
43 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
44 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
45 /************************************************************************* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
46 * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
47 * FUNCTION: Qua_gain() |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
48 * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
49 * PURPOSE: Quantization of pitch and codebook gains. |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
50 * (using predicted codebook gain) |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
51 * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
52 *************************************************************************/ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
53 Word16 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
54 Qua_gain( /* o : index of quantization. */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
55 enum Mode mode, /* i : AMR mode */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
56 Word16 exp_gcode0, /* i : predicted CB gain (exponent), Q0 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
57 Word16 frac_gcode0, /* i : predicted CB gain (fraction), Q15 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
58 Word16 frac_coeff[], /* i : energy coeff. (5), fraction part, Q15 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
59 Word16 exp_coeff[], /* i : energy coeff. (5), exponent part, Q0 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
60 /* (frac_coeff and exp_coeff computed in */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
61 /* calc_filt_energies()) */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
62 Word16 gp_limit, /* i : pitch gain limit */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
63 Word16 *gain_pit, /* o : Pitch gain, Q14 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
64 Word16 *gain_cod, /* o : Code gain, Q1 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
65 Word16 *qua_ener_MR122, /* o : quantized energy error, Q10 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
66 /* (for MR122 MA predictor update) */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
67 Word16 *qua_ener /* o : quantized energy error, Q10 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
68 /* (for other MA predictor update) */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
69 ) |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
70 { |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
71 const Word16 *p; |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
72 Word16 i, j, index = 0; |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
73 Word16 gcode0, e_max, exp_code; |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
74 Word16 g_pitch, g2_pitch, g_code, g2_code, g_pit_cod; |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
75 Word16 coeff[5], coeff_lo[5]; |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
76 Word16 exp_max[5]; |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
77 Word32 L_tmp, dist_min; |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
78 const Word16 *table_gain; |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
79 Word16 table_len; |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
80 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
81 test(); test(); test(); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
82 if ( sub (mode, MR102) == 0 || sub (mode, MR74) == 0 || sub (mode, MR67) == 0) |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
83 { |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
84 table_len = VQ_SIZE_HIGHRATES; move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
85 table_gain = table_gain_highrates; move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
86 } |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
87 else |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
88 { |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
89 table_len = VQ_SIZE_LOWRATES; move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
90 table_gain = table_gain_lowrates; move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
91 } |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
92 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
93 /*-------------------------------------------------------------------* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
94 * predicted codebook gain * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
95 * ~~~~~~~~~~~~~~~~~~~~~~~ * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
96 * gc0 = 2^exp_gcode0 + 2^frac_gcode0 * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
97 * * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
98 * gcode0 (Q14) = 2^14*2^frac_gcode0 = gc0 * 2^(14-exp_gcode0) * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
99 *-------------------------------------------------------------------*/ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
100 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
101 gcode0 = extract_l(Pow2(14, frac_gcode0)); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
102 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
103 /*-------------------------------------------------------------------* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
104 * Scaling considerations: * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
105 * ~~~~~~~~~~~~~~~~~~~~~~~ * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
106 *-------------------------------------------------------------------*/ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
107 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
108 /* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
109 * The error energy (sum) to be minimized consists of five terms, t[0..4]. |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
110 * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
111 * t[0] = gp^2 * <y1 y1> |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
112 * t[1] = -2*gp * <xn y1> |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
113 * t[2] = gc^2 * <y2 y2> |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
114 * t[3] = -2*gc * <xn y2> |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
115 * t[4] = 2*gp*gc * <y1 y2> |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
116 * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
117 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
118 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
119 /* determine the scaling exponent for g_code: ec = ec0 - 11 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
120 exp_code = sub(exp_gcode0, 11); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
121 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
122 /* calculate exp_max[i] = s[i]-1 */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
123 exp_max[0] = sub(exp_coeff[0], 13); move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
124 exp_max[1] = sub(exp_coeff[1], 14); move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
125 exp_max[2] = add(exp_coeff[2], add(15, shl(exp_code, 1))); move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
126 exp_max[3] = add(exp_coeff[3], exp_code); move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
127 exp_max[4] = add(exp_coeff[4], add(1, exp_code)); move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
128 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
129 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
130 /*-------------------------------------------------------------------* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
131 * Find maximum exponent: * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
132 * ~~~~~~~~~~~~~~~~~~~~~~ * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
133 * * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
134 * For the sum operation, all terms must have the same scaling; * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
135 * that scaling should be low enough to prevent overflow. There- * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
136 * fore, the maximum scale is determined and all coefficients are * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
137 * re-scaled: * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
138 * * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
139 * e_max = max(exp_max[i]) + 1; * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
140 * e = exp_max[i]-e_max; e <= 0! * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
141 * c[i] = c[i]*2^e * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
142 *-------------------------------------------------------------------*/ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
143 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
144 e_max = exp_max[0]; move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
145 for (i = 1; i < 5; i++) |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
146 { |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
147 move16(); test(); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
148 if (sub(exp_max[i], e_max) > 0) |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
149 { |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
150 e_max = exp_max[i]; move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
151 } |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
152 } |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
153 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
154 e_max = add(e_max, 1); /* To avoid overflow */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
155 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
156 for (i = 0; i < 5; i++) { |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
157 j = sub(e_max, exp_max[i]); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
158 L_tmp = L_deposit_h(frac_coeff[i]); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
159 L_tmp = L_shr(L_tmp, j); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
160 L_Extract(L_tmp, &coeff[i], &coeff_lo[i]); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
161 } |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
162 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
163 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
164 /*-------------------------------------------------------------------* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
165 * Codebook search: * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
166 * ~~~~~~~~~~~~~~~~ * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
167 * * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
168 * For each pair (g_pitch, g_fac) in the table calculate the * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
169 * terms t[0..4] and sum them up; the result is the mean squared * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
170 * error for the quantized gains from the table. The index for the * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
171 * minimum MSE is stored and finally used to retrieve the quantized * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
172 * gains * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
173 *-------------------------------------------------------------------*/ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
174 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
175 /* start with "infinite" MSE */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
176 dist_min = MAX_32; move32(); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
177 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
178 p = &table_gain[0]; move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
179 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
180 for (i = 0; i < table_len; i++) |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
181 { |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
182 g_pitch = *p++; move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
183 g_code = *p++; move16 (); /* this is g_fac */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
184 p++; /* skip log2(g_fac) */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
185 p++; /* skip 20*log10(g_fac) */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
186 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
187 test (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
188 if (sub(g_pitch, gp_limit) <= 0) |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
189 { |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
190 g_code = mult(g_code, gcode0); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
191 g2_pitch = mult(g_pitch, g_pitch); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
192 g2_code = mult(g_code, g_code); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
193 g_pit_cod = mult(g_code, g_pitch); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
194 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
195 L_tmp = Mpy_32_16(coeff[0], coeff_lo[0], g2_pitch); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
196 L_tmp = L_add(L_tmp, Mpy_32_16(coeff[1], coeff_lo[1], g_pitch)); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
197 L_tmp = L_add(L_tmp, Mpy_32_16(coeff[2], coeff_lo[2], g2_code)); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
198 L_tmp = L_add(L_tmp, Mpy_32_16(coeff[3], coeff_lo[3], g_code)); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
199 L_tmp = L_add(L_tmp, Mpy_32_16(coeff[4], coeff_lo[4], g_pit_cod)); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
200 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
201 /* store table index if MSE for this index is lower |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
202 than the minimum MSE seen so far */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
203 test (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
204 if (L_sub(L_tmp, dist_min) < (Word32) 0) |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
205 { |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
206 dist_min = L_tmp; move32 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
207 index = i; move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
208 } |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
209 } |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
210 } |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
211 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
212 /*------------------------------------------------------------------* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
213 * read quantized gains and new values for MA predictor memories * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
214 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
215 *------------------------------------------------------------------*/ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
216 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
217 /* Read the quantized gains */ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
218 p = &table_gain[shl (index, 2)]; move16 (); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
219 *gain_pit = *p++; move16(); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
220 g_code = *p++; move16(); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
221 *qua_ener_MR122 = *p++; move16(); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
222 *qua_ener = *p; move16(); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
223 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
224 /*------------------------------------------------------------------* |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
225 * calculate final fixed codebook gain: * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
226 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
227 * * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
228 * gc = gc0 * g * |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
229 *------------------------------------------------------------------*/ |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
230 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
231 L_tmp = L_mult(g_code, gcode0); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
232 L_tmp = L_shr(L_tmp, sub(10, exp_gcode0)); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
233 *gain_cod = extract_h(L_tmp); |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
234 |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
235 return index; |
b02e043dcba0
libtwamr: integrate qua_gain.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
236 } |