annotate libgsmfr2/full_dec.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 3a617e4e9b27
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
279
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
1 /*
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
2 * This module implements the "full decoder" functionality of libgsmfr2:
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
3 * first the Rx DTX handler, then the regular GSM 06.10 decoder. This full
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
4 * decoder also implements the optional homing feature, resetting both
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
5 * components upon receiving DHF.
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
6 */
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
7
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
8 #include <stdint.h>
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
9 #include <stdlib.h>
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
10 #include <string.h>
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
11 #include "tw_gsmfr.h"
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
12 #include "typedef.h"
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
13 #include "ed_state.h"
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
14 #include "pp_state.h"
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
15
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
16 struct gsmfr_fulldec_state {
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
17 struct gsmfr_0610_state dec_0610;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
18 struct gsmfr_preproc_state rx_dtx;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
19 int is_homed;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
20 };
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
21
533
3a617e4e9b27 libgsmfr2: add const words with struct sizes
Mychaela Falconia <falcon@freecalypso.org>
parents: 527
diff changeset
22 const unsigned gsmfr_fulldec_state_size = sizeof(struct gsmfr_fulldec_state);
3a617e4e9b27 libgsmfr2: add const words with struct sizes
Mychaela Falconia <falcon@freecalypso.org>
parents: 527
diff changeset
23
279
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
24 struct gsmfr_fulldec_state *gsmfr_fulldec_create(void)
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
25 {
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
26 struct gsmfr_fulldec_state *st;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
27
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
28 st = malloc(sizeof(struct gsmfr_fulldec_state));
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
29 if (st)
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
30 gsmfr_fulldec_reset(st);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
31 return st;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
32 }
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
33
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
34 void gsmfr_fulldec_reset(struct gsmfr_fulldec_state *st)
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
35 {
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
36 gsmfr_0610_reset(&st->dec_0610);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
37 gsmfr_preproc_reset(&st->rx_dtx);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
38 st->is_homed = 1;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
39 }
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
40
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
41 static void emit_ehf_output(int16_t *pcm_out)
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
42 {
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
43 unsigned n;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
44
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
45 for (n = 0; n < 160; n++)
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
46 pcm_out[n] = 0x0008;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
47 }
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
48
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
49 void gsmfr_fulldec_good_frame(struct gsmfr_fulldec_state *st,
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
50 const uint8_t *frame_in, int16_t *pcm_out)
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
51 {
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
52 uint8_t frame_mod[GSMFR_RTP_FRAME_LEN];
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
53
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
54 if (st->is_homed && !memcmp(frame_in, gsmfr_decoder_homing_frame, 12)) {
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
55 emit_ehf_output(pcm_out);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
56 return;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
57 }
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
58 memcpy(frame_mod, frame_in, GSMFR_RTP_FRAME_LEN);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
59 gsmfr_preproc_good_frame(&st->rx_dtx, frame_mod);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
60 gsmfr_0610_decode_frame(&st->dec_0610, frame_mod, pcm_out);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
61 if (!memcmp(frame_in, gsmfr_decoder_homing_frame, GSMFR_RTP_FRAME_LEN))
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
62 gsmfr_fulldec_reset(st);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
63 else
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
64 st->is_homed = 0;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
65 }
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
66
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
67 void gsmfr_fulldec_bfi(struct gsmfr_fulldec_state *st, int taf,
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
68 int16_t *pcm_out)
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
69 {
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
70 uint8_t frame_mod[GSMFR_RTP_FRAME_LEN];
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
71
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
72 if (st->is_homed) {
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
73 memset(pcm_out, 0, sizeof(int16_t) * 160);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
74 return;
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
75 }
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
76 gsmfr_preproc_bfi(&st->rx_dtx, taf, frame_mod);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
77 gsmfr_0610_decode_frame(&st->dec_0610, frame_mod, pcm_out);
4db5fc10fd1a libgsmfr2: implement full decoder
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
78 }
527
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
79
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
80 void gsmfr_fulldec_bfi_bits(struct gsmfr_fulldec_state *st,
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
81 const uint8_t *bad_frame, int taf, int16_t *pcm_out)
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
82 {
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
83 uint8_t frame_mod[GSMFR_RTP_FRAME_LEN];
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
84
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
85 if (st->is_homed) {
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
86 memset(pcm_out, 0, sizeof(int16_t) * 160);
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
87 return;
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
88 }
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
89 gsmfr_preproc_bfi_bits(&st->rx_dtx, bad_frame, taf, frame_mod);
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
90 gsmfr_0610_decode_frame(&st->dec_0610, frame_mod, pcm_out);
f3246d109e2d libgsmfr2: add gsmfr_fulldec_bfi_bits()
Mychaela Falconia <falcon@freecalypso.org>
parents: 279
diff changeset
91 }