FreeCalypso > hg > gsm-codec-lib

annotate libtwamr/qua_gain.c @ 513:03a40ac2e931

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
libgsmhr1: implement validation for *.cod frames
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 25 Aug 2024 19:00:03 +0000
parents b02e043dcba0
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
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 }