Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 1 | #include <stdio.h> |
Harald Welte | 74d1e34 | 2016-10-19 00:06:22 +0200 | [diff] [blame] | 2 | #include <time.h> |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 3 | #include <unistd.h> |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 4 | #include <string.h> |
Harald Welte | 74d1e34 | 2016-10-19 00:06:22 +0200 | [diff] [blame] | 5 | |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 6 | #include <sys/time.h> |
| 7 | |
| 8 | #include <osmocom/core/signal.h> |
| 9 | #include <osmocom/core/logging.h> |
| 10 | #include <osmocom/core/application.h> |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 11 | #include <osmocom/abis/subchan_demux.h> |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 12 | |
| 13 | #include "storage.h" |
| 14 | #include "recorder.h" |
| 15 | |
| 16 | struct e1_recorder g_recorder; |
| 17 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 18 | enum mode { |
| 19 | MODE_PRINT, |
| 20 | MODE_BIN, |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 21 | MODE_SC, |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 22 | }; |
| 23 | |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 24 | #define MAX_TS 32 |
| 25 | #define CHUNK_BYTES 160 |
| 26 | |
| 27 | /* Ericsson super-channel */ |
| 28 | struct sc_state { |
| 29 | uint8_t ts_data[MAX_TS][CHUNK_BYTES]; |
| 30 | uint8_t num_ts; |
| 31 | }; |
| 32 | |
| 33 | static struct sc_state g_sc_state[2]; |
| 34 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 35 | static enum mode g_mode = MODE_PRINT; |
| 36 | static int g_filter_line = -1; |
| 37 | static int g_filter_slot = -1; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 38 | static int g_filter_subslot = -1; |
| 39 | static struct osmo_e1cap_pkthdr *g_last_pkthdr; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 40 | |
Harald Welte | 74d1e34 | 2016-10-19 00:06:22 +0200 | [diff] [blame] | 41 | static char *timeval2str(struct timeval *tv) |
| 42 | { |
| 43 | time_t nowtime; |
| 44 | struct tm *nowtm; |
| 45 | char tmbuf[64]; |
| 46 | static char buf[64]; |
| 47 | |
| 48 | nowtime = tv->tv_sec; |
| 49 | nowtm = localtime(&nowtime); |
| 50 | strftime(tmbuf, sizeof tmbuf, "%Y-%m-%d %H:%M:%S", nowtm); |
| 51 | snprintf(buf, sizeof buf, "%s.%06ld", tmbuf, tv->tv_usec); |
| 52 | return buf; |
| 53 | } |
| 54 | |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 55 | static int all_bytes_are(unsigned char ch, const uint8_t *data, int len) |
| 56 | { |
| 57 | int i; |
| 58 | |
| 59 | for (i = 0; i < len; i++) { |
| 60 | if (data[i] != ch) |
| 61 | return 0; |
| 62 | } |
| 63 | return 1; |
| 64 | } |
| 65 | |
| 66 | static void handle_sc_out(struct sc_state *scs) |
| 67 | { |
| 68 | uint8_t out[scs->num_ts * CHUNK_BYTES]; |
| 69 | int i, j, k = 0; |
| 70 | |
| 71 | /* re-shuffle the data from columns to lines */ |
| 72 | for (i = 0; i < CHUNK_BYTES; i++) { |
| 73 | for (j = 1; j < scs->num_ts; j++) |
| 74 | out[k++] = scs->ts_data[j][i]; |
| 75 | } |
| 76 | printf("%s\n", osmo_hexdump_nospc(out, scs->num_ts * CHUNK_BYTES)); |
| 77 | } |
| 78 | |
| 79 | static void handle_sc_in(struct osmo_e1cap_pkthdr *pkt, const uint8_t *data, unsigned int len) |
| 80 | { |
| 81 | struct sc_state *scs; |
| 82 | |
| 83 | if (pkt->line_nr >= ARRAY_SIZE(g_sc_state)) { |
| 84 | fprintf(stderr, "Line number out of range\n"); |
| 85 | exit(1); |
| 86 | } |
| 87 | |
| 88 | scs = &g_sc_state[pkt->line_nr]; |
| 89 | if (pkt->ts_nr >= ARRAY_SIZE(scs->ts_data)) { |
| 90 | fprintf(stderr, "Timeslot number out of range\n"); |
| 91 | exit(1); |
| 92 | } |
| 93 | |
| 94 | if (len != sizeof(scs->ts_data[pkt->ts_nr])) { |
| 95 | fprintf(stderr, "Insufficient data\n"); |
| 96 | exit(1); |
| 97 | } |
| 98 | |
| 99 | memcpy(scs->ts_data[pkt->ts_nr], data, len); |
| 100 | if (pkt->ts_nr-1 > scs->num_ts) |
| 101 | scs->num_ts = pkt->ts_nr-1; |
| 102 | if (pkt->ts_nr == scs->num_ts) |
| 103 | handle_sc_out(scs); |
| 104 | } |
| 105 | |
| 106 | |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 107 | static void handle_data(struct osmo_e1cap_pkthdr *pkt, const uint8_t *data, int len) |
| 108 | { |
| 109 | switch (g_mode) { |
| 110 | case MODE_PRINT: |
| 111 | printf("%s %02u/%02u %u (%u): %s\n", |
| 112 | timeval2str(&pkt->ts), |
| 113 | pkt->line_nr, pkt->ts_nr, pkt->capture_mode, |
| 114 | pkt->len, |
| 115 | osmo_hexdump_nospc(data, len)); |
| 116 | break; |
| 117 | case MODE_BIN: |
| 118 | write(1, data, len); |
| 119 | break; |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 120 | case MODE_SC: |
| 121 | handle_sc_in(pkt, data, len); |
| 122 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 123 | } |
| 124 | } |
| 125 | |
| 126 | static int subch_demux_out_cb(struct subch_demux *dmx, int ch, uint8_t *data, |
| 127 | int len, void *c) |
| 128 | { |
| 129 | OSMO_ASSERT(ch == g_filter_subslot); |
| 130 | handle_data(g_last_pkthdr, data, len); |
| 131 | |
| 132 | return 0; |
| 133 | } |
| 134 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 135 | static int handle_options(int argc, char **argv) |
| 136 | { |
| 137 | int opt; |
| 138 | |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 139 | while ((opt = getopt(argc, argv, "l:s:bSu:")) != -1) { |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 140 | switch (opt) { |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 141 | case 'l': /* Filter on E1 Line Number */ |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 142 | g_filter_line = atoi(optarg); |
| 143 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 144 | case 's': /* Filter on E1 Slot Number */ |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 145 | g_filter_slot = atoi(optarg); |
| 146 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 147 | case 'b': /* Raw binary output mode (for piping) */ |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 148 | g_mode = MODE_BIN; |
| 149 | break; |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 150 | case 'S': /* Super Channel Mode */ |
| 151 | g_mode = MODE_SC; |
| 152 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 153 | case 'u': /* 16k Sub-channel demux + filter */ |
| 154 | g_filter_subslot = atoi(optarg); |
| 155 | if (g_filter_subslot < 0 || g_filter_subslot > 3) |
| 156 | exit(2); |
| 157 | break; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 158 | default: |
| 159 | fprintf(stderr, "Unknown option '%c'\n", opt); |
| 160 | exit(EXIT_FAILURE); |
| 161 | break; |
| 162 | } |
| 163 | } |
| 164 | |
| 165 | return 0; |
| 166 | } |
| 167 | |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 168 | int main(int argc, char **argv) |
| 169 | { |
| 170 | struct osmo_e1cap_file *f; |
| 171 | struct osmo_e1cap_pkthdr *pkt; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 172 | unsigned long num_pkt = 0; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 173 | struct subch_demux smux; |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 174 | |
| 175 | printf("sizeof(timeval) = %zu\n", sizeof(struct timeval)); |
| 176 | printf("sizeof(osmo_e1cap_pkthdr) = %zu\n", sizeof(*pkt)); |
| 177 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 178 | handle_options(argc, argv); |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 179 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 180 | if (optind >= argc) { |
| 181 | fprintf(stderr, "Missing input file name\n"); |
| 182 | exit(2); |
| 183 | } |
| 184 | |
| 185 | f = osmo_e1cap_open(NULL, argv[optind++]); |
| 186 | if (!f) { |
| 187 | fprintf(stderr, "Unable to open input file\n"); |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 188 | exit(1); |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 189 | } |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 190 | |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 191 | if (g_filter_subslot >= 0) { |
| 192 | smux.out_cb = subch_demux_out_cb; |
| 193 | subch_demux_init(&smux); |
| 194 | subch_demux_activate(&smux, g_filter_subslot); |
| 195 | } |
| 196 | |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 197 | while ((pkt = osmo_e1cap_read_next(f))) { |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 198 | num_pkt++; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 199 | g_last_pkthdr = pkt; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 200 | |
| 201 | if (g_filter_line >= 0 && pkt->line_nr != g_filter_line) |
| 202 | continue; |
| 203 | if (g_filter_slot >= 0 && pkt->ts_nr != g_filter_slot) |
| 204 | continue; |
| 205 | |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 206 | if (g_filter_subslot >= 0) { |
| 207 | subch_demux_in(&smux, pkt->data, pkt->len); |
| 208 | continue; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 209 | } |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 210 | |
| 211 | handle_data(pkt, pkt->data, pkt->len); |
| 212 | |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 213 | talloc_free(pkt); |
| 214 | } |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 215 | |
| 216 | fprintf(stderr, "Processed a total of %lu packets\n", num_pkt); |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 217 | } |