FreeCalypso > hg > gsm-codec-lib
annotate libgsmefr/pre_proc.c @ 242:f081a6850fb5
libgsmfrp: new refined implementation
The previous implementation exhibited the following defects,
which are now fixed:
1) The last received valid SID was cached forever for the purpose of
handling future invalid SIDs - we could have received some valid
SID ages ago, then lots of speech or NO_DATA, and if we then get
an invalid SID, we would resurrect the last valid SID from ancient
history - a bad design. In our new design, we handle invalid SID
based on the current state, much like BFI.
2) GSM 06.11 spec says clearly that after the second lost SID
(received BFI=1 && TAF=1 in CN state) we need to gradually decrease
the output level, rather than jump directly to emitting silence
frames - we previously failed to implement such logic.
3) Per GSM 06.12 section 5.2, Xmaxc should be the same in all 4 subframes
in a SID frame. What should we do if we receive an otherwise valid
SID frame with different Xmaxc? Our previous approach would
replicate this Xmaxc oddity in every subsequent generated CN frame,
which is rather bad. In our new design, the very first CN frame
(which can be seen as a transformation of the SID frame itself)
retains the original 4 distinct Xmaxc, but all subsequent CN frames
are based on the Xmaxc from the last subframe of the most recent SID.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Tue, 09 May 2023 05:16:31 +0000 |
parents | 3ea19a9aa2a1 |
children |
rev | line source |
---|---|
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1 /************************************************************************* |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2 * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
3 * FUNCTION: Pre_Process() |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
4 * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
5 * PURPOSE: Preprocessing of input speech. |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
6 * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
7 * DESCRIPTION: |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
8 * - 2nd order high pass filtering with cut off frequency at 80 Hz. |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
9 * - Divide input by two. |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
10 * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
11 *************************************************************************/ |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
12 |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
13 #include "gsm_efr.h" |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
14 #include "typedef.h" |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
15 #include "namespace.h" |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
16 #include "basic_op.h" |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
17 #include "oper_32b.h" |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
18 #include "no_count.h" |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
19 #include "sig_proc.h" |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
20 #include "cnst.h" |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
21 #include "enc_state.h" |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
22 |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
23 /*------------------------------------------------------------------------* |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
24 * * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
25 * Algorithm: * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
26 * * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
27 * y[i] = b[0]*x[i]/2 + b[1]*x[i-1]/2 + b[2]*x[i-2]/2 * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
28 * + a[1]*y[i-1] + a[2]*y[i-2]; * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
29 * * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
30 * * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
31 * Input is divided by two in the filtering process. * |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
32 *------------------------------------------------------------------------*/ |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
33 |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
34 /* filter coefficients (fc = 80 Hz, coeff. b[] is divided by 2) */ |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
35 |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
36 static const Word16 b[3] = {1899, -3798, 1899}; |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
37 static const Word16 a[3] = {4096, 7807, -3733}; |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
38 |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
39 /* Initialization of static values */ |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
40 |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
41 void Init_Pre_Process (struct EFR_encoder_state *st) |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
42 { |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
43 struct preproc_state *pps = &st->pre_proc; |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
44 |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
45 pps->y2_hi = 0; |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
46 pps->y2_lo = 0; |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
47 pps->y1_hi = 0; |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
48 pps->y1_lo = 0; |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
49 pps->x0 = 0; |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
50 pps->x1 = 0; |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
51 } |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
52 |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
53 void Pre_Process ( |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
54 struct EFR_encoder_state *st, |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
55 Word16 signal[], /* input/output signal */ |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
56 Word16 lg) /* lenght of signal */ |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
57 { |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
58 struct preproc_state *pps = &st->pre_proc; |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
59 Word16 i, x2; |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
60 Word32 L_tmp; |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
61 |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
62 for (i = 0; i < lg; i++) |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
63 { |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
64 x2 = pps->x1; |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
65 pps->x1 = pps->x0; |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
66 pps->x0 = signal[i]; |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
67 |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
68 /* y[i] = b[0]*x[i]/2 + b[1]*x[i-1]/2 + b140[2]*x[i-2]/2 */ |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
69 /* + a[1]*y[i-1] + a[2] * y[i-2]; */ |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
70 |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
71 L_tmp = Mpy_32_16 (pps->y1_hi, pps->y1_lo, a[1]); |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
72 L_tmp = L_add (L_tmp, Mpy_32_16 (pps->y2_hi, pps->y2_lo, a[2])); |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
73 L_tmp = L_mac (L_tmp, pps->x0, b[0]); |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
74 L_tmp = L_mac (L_tmp, pps->x1, b[1]); |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
75 L_tmp = L_mac (L_tmp, x2, b[2]); |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
76 L_tmp = L_shl (L_tmp, 3); |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
77 signal[i] = round (L_tmp); |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
78 |
84
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
79 pps->y2_hi = pps->y1_hi; |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
80 pps->y2_lo = pps->y1_lo; |
3ea19a9aa2a1
libgsmefr: pre_proc.c compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
53
diff
changeset
|
81 L_Extract (L_tmp, &pps->y1_hi, &pps->y1_lo); |
53
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
82 } |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
83 return; |
49dd1ac8e75b
libgsmefr: import most *.c files from ETSI source
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
84 } |