comparison efrtest/dec-parse.c @ 146:0fa0cd251a31

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