FreeCalypso > hg > gsm-codec-lib
comparison efrtest/cod-parse.c @ 147:90b9c7c3fa3b
gsmefr-cod-parse: use factored-out ETSI bit reader
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Wed, 14 Dec 2022 08:09:52 +0000 |
parents | a5ffec18e4cd |
children | bbe5669f0f29 |
comparison
equal
deleted
inserted
replaced
146:0fa0cd251a31 | 147:90b9c7c3fa3b |
---|---|
9 #include <stdint.h> | 9 #include <stdint.h> |
10 #include <stdlib.h> | 10 #include <stdlib.h> |
11 #include <string.h> | 11 #include <string.h> |
12 #include <strings.h> | 12 #include <strings.h> |
13 #include "../libgsmefr/gsm_efr.h" | 13 #include "../libgsmefr/gsm_efr.h" |
14 | 14 #include "etsi.h" |
15 #define ETSI_ENC_NWORDS 246 | |
16 | |
17 static int | |
18 read_input(inf, bitvec, filename_for_errs) | |
19 FILE *inf; | |
20 uint8_t *bitvec; | |
21 char *filename_for_errs; | |
22 { | |
23 uint8_t file_bytes[ETSI_ENC_NWORDS * 2], *sp; | |
24 int cc; | |
25 unsigned n; | |
26 | |
27 cc = fread(file_bytes, 2, ETSI_ENC_NWORDS, inf); | |
28 if (cc == 0) | |
29 return 0; | |
30 if (cc != ETSI_ENC_NWORDS) { | |
31 fprintf(stderr, "error: short read from %s\n", | |
32 filename_for_errs); | |
33 exit(1); | |
34 } | |
35 sp = file_bytes; | |
36 for (n = 0; n < ETSI_ENC_NWORDS; n++) { | |
37 if (sp[1]) { | |
38 fprintf(stderr, | |
39 "error in %s: non-zero in what should be LE upper byte\n", | |
40 filename_for_errs); | |
41 exit(1); | |
42 } | |
43 bitvec[n] = sp[0]; | |
44 sp += 2; | |
45 } | |
46 return 1; | |
47 } | |
48 | |
49 static void | |
50 bits2frame(input_bits, frame, filename_for_errs, frame_no) | |
51 uint8_t *input_bits, *frame; | |
52 char *filename_for_errs; | |
53 unsigned frame_no; | |
54 { | |
55 uint8_t bits[248], *sp, *dp; | |
56 unsigned nb, byte, mask; | |
57 | |
58 bits[0] = 1; | |
59 bits[1] = 1; | |
60 bits[2] = 0; | |
61 bits[3] = 0; | |
62 bcopy(input_bits, bits + 4, 244); | |
63 sp = bits; | |
64 dp = frame; | |
65 for (nb = 0; nb < EFR_RTP_FRAME_LEN; nb++) { | |
66 byte = 0; | |
67 for (mask = 0x80; mask; mask >>= 1) { | |
68 if (*sp > 1) { | |
69 fprintf(stderr, | |
70 "error in %s frame #%u: data bit > 1\n", | |
71 filename_for_errs, frame_no); | |
72 exit(1); | |
73 } | |
74 if (*sp) | |
75 byte |= mask; | |
76 sp++; | |
77 } | |
78 *dp++ = byte; | |
79 } | |
80 } | |
81 | 15 |
82 main(argc, argv) | 16 main(argc, argv) |
83 char **argv; | 17 char **argv; |
84 { | 18 { |
85 FILE *inf; | 19 FILE *inf; |
96 if (!inf) { | 30 if (!inf) { |
97 perror(argv[1]); | 31 perror(argv[1]); |
98 exit(1); | 32 exit(1); |
99 } | 33 } |
100 for (frame_no = 0; ; frame_no++) { | 34 for (frame_no = 0; ; frame_no++) { |
101 rc = read_input(inf, input_bits, argv[1]); | 35 rc = read_etsi_bits(inf, 0, input_bits, ETSI_ENC_NWORDS, |
36 argv[1]); | |
102 if (!rc) | 37 if (!rc) |
103 break; | 38 break; |
104 bits2frame(input_bits, frame, argv[1], frame_no); | 39 bits2frame(input_bits, frame, argv[1], frame_no); |
105 printf("#%u: VAD=%u SP=%u SID=%d LPC", frame_no, | 40 printf("#%u: VAD=%u SP=%u SID=%d LPC", frame_no, |
106 input_bits[244], input_bits[245], | 41 input_bits[244], input_bits[245], |