FreeCalypso > hg > gsm-codec-lib
annotate libtwamr/ec_gains.c @ 581:e2d5cad04cbf
libgsmhr1 RxFE: store CN R0+LPC separately from speech
In the original GSM 06.06 code the ECU for speech mode is entirely
separate from the CN generator, maintaining separate state. (The
main intertie between them is the speech vs CN state variable,
distinguishing between speech and CN BFIs, in addition to the
CN-specific function of distinguishing between initial and update
SIDs.)
In the present RxFE implementation I initially thought that we could
use the same saved_frame buffer for both ECU and CN, overwriting
just the first 4 params (R0 and LPC) when a valid SID comes in.
However, I now realize it was a bad idea: the original code has a
corner case (long sequence of speech-mode BFIs to put the ECU in
state 6, then SID and CN-mode BFIs, then a good speech frame) that
would be broken by that buffer reuse approach. We could eliminate
this corner case by resetting the ECU state when passing through
a CN insertion period, but doing so would needlessly increase
the behavioral diffs between GSM 06.06 and our version.
Solution: use a separate CN-specific buffer for CN R0+LPC parameters,
and match the behavior of GSM 06.06 code in this regard.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 13 Feb 2025 10:02:45 +0000 |
parents | 9cbd1b5d061f |
children |
rev | line source |
---|---|
362
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1 /* |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2 ******************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
3 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
4 * GSM AMR-NB speech codec R98 Version 7.6.0 December 12, 2001 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
5 * R99 Version 3.3.0 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
6 * REL-4 Version 4.1.0 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
7 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
8 ******************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
9 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
10 * File : ec_gains.c |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
11 * Purpose: : Error concealment for pitch and codebook gains |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
12 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
13 ******************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
14 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
15 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
16 /* |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
17 ******************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
18 * MODULE INCLUDE FILE AND VERSION ID |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
19 ******************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
20 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
21 #include "namespace.h" |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
22 #include "ec_gains.h" |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
23 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
24 /* |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
25 ******************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
26 * INCLUDE FILES |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
27 ******************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
28 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
29 #include "typedef.h" |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
30 #include "basic_op.h" |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
31 #include "oper_32b.h" |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
32 #include "no_count.h" |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
33 #include "cnst.h" |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
34 #include "gmed_n.h" |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
35 #include "gc_pred.h" |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
36 #include "gains_tab.h" |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
37 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
38 /* |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
39 ******************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
40 * PUBLIC PROGRAM CODE |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
41 ******************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
42 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
43 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
44 /* |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
45 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
46 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
47 * Function : ec_gain_code_reset |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
48 * Purpose : Resets state memory |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
49 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
50 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
51 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
52 void ec_gain_code_reset (ec_gain_codeState *state) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
53 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
54 Word16 i; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
55 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
56 for ( i = 0; i < 5; i++) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
57 state->gbuf[i] = 1; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
58 state->past_gain_code = 0; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
59 state->prev_gc = 1; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
60 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
61 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
62 /* |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
63 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
64 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
65 * Function : ec_gain_code |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
66 * Purpose : conceal the codebook gain |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
67 * Call this function only in BFI (instead of normal gain |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
68 * decoding function) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
69 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
70 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
71 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
72 void ec_gain_code ( |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
73 ec_gain_codeState *st, /* i/o : State struct */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
74 gc_predState *pred_state, /* i/o : MA predictor state */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
75 Word16 state, /* i : state of the state machine */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
76 Word16 *gain_code /* o : decoded innovation gain */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
77 ) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
78 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
79 static const Word16 cdown[7] = |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
80 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
81 32767, 32112, 32112, 32112, |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
82 32112, 32112, 22937 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
83 }; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
84 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
85 Word16 tmp; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
86 Word16 qua_ener_MR122; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
87 Word16 qua_ener; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
88 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
89 /* calculate median of last five gain values */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
90 tmp = gmed_n (st->gbuf,5); move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
91 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
92 /* new gain = minimum(median, past_gain) * cdown[state] */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
93 test (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
94 if (sub (tmp, st->past_gain_code) > 0) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
95 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
96 tmp = st->past_gain_code; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
97 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
98 tmp = mult (tmp, cdown[state]); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
99 *gain_code = tmp; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
100 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
101 /* update table of past quantized energies with average of |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
102 * current values |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
103 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
104 gc_pred_average_limited(pred_state, &qua_ener_MR122, &qua_ener); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
105 gc_pred_update(pred_state, qua_ener_MR122, qua_ener); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
106 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
107 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
108 /* |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
109 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
110 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
111 * Function : ec_gain_code_update |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
112 * Purpose : update the codebook gain concealment state; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
113 * limit gain_code if the previous frame was bad |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
114 * Call this function always after decoding (or concealing) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
115 * the gain |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
116 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
117 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
118 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
119 void ec_gain_code_update ( |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
120 ec_gain_codeState *st, /* i/o : State struct */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
121 Word16 bfi, /* i : flag: frame is bad */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
122 Word16 prev_bf, /* i : flag: previous frame was bad */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
123 Word16 *gain_code /* i/o : decoded innovation gain */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
124 ) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
125 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
126 Word16 i; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
127 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
128 /* limit gain_code by previous good gain if previous frame was bad */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
129 test (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
130 if (bfi == 0) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
131 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
132 test (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
133 if (prev_bf != 0) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
134 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
135 test (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
136 if (sub (*gain_code, st->prev_gc) > 0) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
137 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
138 *gain_code = st->prev_gc; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
139 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
140 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
141 st->prev_gc = *gain_code; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
142 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
143 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
144 /* update EC states: previous gain, gain buffer */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
145 st->past_gain_code = *gain_code; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
146 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
147 for (i = 1; i < 5; i++) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
148 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
149 st->gbuf[i - 1] = st->gbuf[i]; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
150 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
151 st->gbuf[4] = *gain_code; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
152 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
153 return; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
154 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
155 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
156 /* |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
157 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
158 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
159 * Function: ec_gain_pitch_reset |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
160 * Purpose: Resets state memory |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
161 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
162 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
163 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
164 void ec_gain_pitch_reset (ec_gain_pitchState *state) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
165 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
166 Word16 i; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
167 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
168 for(i = 0; i < 5; i++) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
169 state->pbuf[i] = 1640; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
170 state->past_gain_pit = 0; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
171 state->prev_gp = 16384; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
172 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
173 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
174 /* |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
175 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
176 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
177 * Function : ec_gain_pitch |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
178 * Purpose : conceal the pitch gain |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
179 * Call this function only in BFI (instead of normal gain |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
180 * decoding function) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
181 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
182 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
183 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
184 void ec_gain_pitch ( |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
185 ec_gain_pitchState *st, /* i/o : state variables */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
186 Word16 state, /* i : state of the state machine */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
187 Word16 *gain_pitch /* o : pitch gain (Q14) */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
188 ) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
189 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
190 static const Word16 pdown[7] = |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
191 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
192 32767, 32112, 32112, 26214, |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
193 9830, 6553, 6553 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
194 }; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
195 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
196 Word16 tmp; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
197 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
198 /* calculate median of last five gains */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
199 tmp = gmed_n (st->pbuf, 5); move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
200 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
201 /* new gain = minimum(median, past_gain) * pdown[state] */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
202 test (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
203 if (sub (tmp, st->past_gain_pit) > 0) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
204 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
205 tmp = st->past_gain_pit; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
206 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
207 *gain_pitch = mult (tmp, pdown[state]); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
208 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
209 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
210 /* |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
211 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
212 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
213 * Function : ec_gain_pitch_update |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
214 * Purpose : update the pitch gain concealment state; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
215 * limit gain_pitch if the previous frame was bad |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
216 * Call this function always after decoding (or concealing) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
217 * the gain |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
218 * |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
219 ************************************************************************** |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
220 */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
221 void ec_gain_pitch_update ( |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
222 ec_gain_pitchState *st, /* i/o : state variables */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
223 Word16 bfi, /* i : flag: frame is bad */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
224 Word16 prev_bf, /* i : flag: previous frame was bad */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
225 Word16 *gain_pitch /* i/o : pitch gain */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
226 ) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
227 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
228 Word16 i; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
229 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
230 test (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
231 if (bfi == 0) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
232 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
233 test (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
234 if (prev_bf != 0) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
235 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
236 test (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
237 if (sub (*gain_pitch, st->prev_gp) > 0) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
238 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
239 *gain_pitch = st->prev_gp; |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
240 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
241 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
242 st->prev_gp = *gain_pitch; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
243 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
244 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
245 st->past_gain_pit = *gain_pitch; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
246 |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
247 test (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
248 if (sub (st->past_gain_pit, 16384) > 0) /* if (st->past_gain_pit > 1.0) */ |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
249 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
250 st->past_gain_pit = 16384; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
251 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
252 for (i = 1; i < 5; i++) |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
253 { |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
254 st->pbuf[i - 1] = st->pbuf[i]; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
255 } |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
256 st->pbuf[4] = st->past_gain_pit; move16 (); |
9cbd1b5d061f
libtwamr: integrate ec_gains.c
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
257 } |