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> |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 7 | #include <sys/types.h> |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 8 | |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 9 | #include <osmocom/core/bits.h> |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 10 | #include <osmocom/core/signal.h> |
| 11 | #include <osmocom/core/logging.h> |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 12 | #include <osmocom/core/msgb.h> |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 13 | #include <osmocom/core/application.h> |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 14 | #include <osmocom/abis/subchan_demux.h> |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 15 | #include <osmocom/abis/lapd_pcap.h> |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 16 | |
| 17 | #include "storage.h" |
| 18 | #include "recorder.h" |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 19 | #include "flip_bits.h" |
| 20 | #include "hdlc.h" |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 21 | |
| 22 | struct e1_recorder g_recorder; |
| 23 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 24 | enum mode { |
| 25 | MODE_PRINT, |
| 26 | MODE_BIN, |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 27 | MODE_SC, |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 28 | }; |
| 29 | |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 30 | #define MAX_TS 32 |
| 31 | #define CHUNK_BYTES 160 |
| 32 | |
| 33 | /* Ericsson super-channel */ |
| 34 | struct sc_state { |
| 35 | uint8_t ts_data[MAX_TS][CHUNK_BYTES]; |
| 36 | uint8_t num_ts; |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 37 | uint32_t ts_mask; |
| 38 | struct hdlc_proc hdlc; |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 39 | }; |
| 40 | |
| 41 | static struct sc_state g_sc_state[2]; |
| 42 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 43 | static enum mode g_mode = MODE_PRINT; |
| 44 | static int g_filter_line = -1; |
| 45 | static int g_filter_slot = -1; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 46 | static int g_filter_subslot = -1; |
| 47 | static struct osmo_e1cap_pkthdr *g_last_pkthdr; |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 48 | static int g_pcap_fd = -1; |
| 49 | struct msgb *g_pcap_msg = NULL; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 50 | |
Harald Welte | 74d1e34 | 2016-10-19 00:06:22 +0200 | [diff] [blame] | 51 | static char *timeval2str(struct timeval *tv) |
| 52 | { |
| 53 | time_t nowtime; |
| 54 | struct tm *nowtm; |
| 55 | char tmbuf[64]; |
| 56 | static char buf[64]; |
| 57 | |
| 58 | nowtime = tv->tv_sec; |
| 59 | nowtm = localtime(&nowtime); |
| 60 | strftime(tmbuf, sizeof tmbuf, "%Y-%m-%d %H:%M:%S", nowtm); |
| 61 | snprintf(buf, sizeof buf, "%s.%06ld", tmbuf, tv->tv_usec); |
| 62 | return buf; |
| 63 | } |
| 64 | |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 65 | static int all_bytes_are(unsigned char ch, const uint8_t *data, int len) |
| 66 | { |
| 67 | int i; |
| 68 | |
| 69 | for (i = 0; i < len; i++) { |
| 70 | if (data[i] != ch) |
| 71 | return 0; |
| 72 | } |
| 73 | return 1; |
| 74 | } |
| 75 | |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 76 | static void handle_hdlc_frame_content(const uint8_t *data, unsigned int len, |
| 77 | void *priv) |
| 78 | { |
| 79 | if (g_pcap_fd && len >= 4) { |
| 80 | uint8_t *cur = msgb_put(g_pcap_msg, len-2); |
| 81 | memcpy(cur, data, len-2); |
| 82 | printf("==> %s\n", msgb_hexdump(g_pcap_msg)); |
| 83 | OSMO_ASSERT(g_pcap_msg->len >= 2); |
| 84 | /* FIXME: timestamp! */ |
| 85 | osmo_pcap_lapd_write(g_pcap_fd, OSMO_LAPD_PCAP_OUTPUT, g_pcap_msg); |
| 86 | msgb_reset(g_pcap_msg); |
| 87 | } |
| 88 | } |
| 89 | |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 90 | static void handle_sc_out(struct sc_state *scs) |
| 91 | { |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 92 | unsigned int num_bytes = scs->num_ts * CHUNK_BYTES; |
| 93 | unsigned int num_bits = num_bytes * 8; |
| 94 | uint8_t out[32*CHUNK_BYTES]; |
| 95 | ubit_t out_bits[32*CHUNK_BYTES*8]; |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 96 | int i, j, k = 0; |
| 97 | |
| 98 | /* re-shuffle the data from columns to lines */ |
| 99 | for (i = 0; i < CHUNK_BYTES; i++) { |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 100 | for (j = 0; j < scs->num_ts; j++) |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 101 | out[k++] = scs->ts_data[j][i]; |
| 102 | } |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 103 | //printf("num_bytes=%u %s\n", num_bytes, osmo_hexdump_nospc(out, num_bytes)); |
| 104 | osmo_pbit2ubit_ext(out_bits, 0, out, 0, num_bits, 1); |
| 105 | //for (i = 0; i < num_bits; i++) fputc(out_bits[i] ? '1' : '.', stdout); fputc('\n', stdout); |
| 106 | process_raw_hdlc(&scs->hdlc, out_bits, num_bits); |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 107 | } |
| 108 | |
| 109 | static void handle_sc_in(struct osmo_e1cap_pkthdr *pkt, const uint8_t *data, unsigned int len) |
| 110 | { |
| 111 | struct sc_state *scs; |
| 112 | |
| 113 | if (pkt->line_nr >= ARRAY_SIZE(g_sc_state)) { |
| 114 | fprintf(stderr, "Line number out of range\n"); |
| 115 | exit(1); |
| 116 | } |
| 117 | |
| 118 | scs = &g_sc_state[pkt->line_nr]; |
| 119 | if (pkt->ts_nr >= ARRAY_SIZE(scs->ts_data)) { |
| 120 | fprintf(stderr, "Timeslot number out of range\n"); |
| 121 | exit(1); |
| 122 | } |
| 123 | |
| 124 | if (len != sizeof(scs->ts_data[pkt->ts_nr])) { |
| 125 | fprintf(stderr, "Insufficient data\n"); |
| 126 | exit(1); |
| 127 | } |
| 128 | |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 129 | if (pkt->ts_nr == 1) { |
| 130 | scs->ts_mask = 0; |
| 131 | memset(scs->ts_data, 0, sizeof(scs->ts_data)); |
| 132 | } |
| 133 | |
| 134 | /* copy over the data */ |
| 135 | memcpy(scs->ts_data[pkt->ts_nr-1], data, len); |
| 136 | /* note that we have valid data for the given timeslot */ |
| 137 | scs->ts_mask |= (1 << (pkt->ts_nr-1)); |
| 138 | |
| 139 | /* make sure we know what's the maximum timeslot number */ |
| 140 | if (pkt->ts_nr > scs->num_ts) |
| 141 | scs->num_ts = pkt->ts_nr; |
| 142 | |
| 143 | /* check if we have data for all needed timeslots */ |
| 144 | uint32_t ts_mask = (1 << scs->num_ts) -1; |
| 145 | //printf("num_ts=%u, ts_mask=0x%x, scs_ts_mask=0x%x\n", scs->num_ts, ts_mask, scs->ts_mask); |
| 146 | if (scs->ts_mask == ts_mask) { |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 147 | handle_sc_out(scs); |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 148 | } |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 149 | } |
| 150 | |
| 151 | |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 152 | static void handle_data(struct osmo_e1cap_pkthdr *pkt, uint8_t *data, int len) |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 153 | { |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 154 | flip_buf_bits(data, len); |
| 155 | #if 0 |
| 156 | /* filter out all-ff/all-fe/all-7f */ |
| 157 | if (all_bytes_are(0xff, data, len) || |
| 158 | all_bytes_are(0x7f, data, len) || |
| 159 | all_bytes_are(0x7e, data, len) || |
| 160 | all_bytes_are(0xe7, data, len) || |
| 161 | all_bytes_are(0x3f, data, len) || |
| 162 | all_bytes_are(0xf3, data, len) || |
| 163 | all_bytes_are(0x9f, data, len) || |
| 164 | all_bytes_are(0xf9, data, len) || |
| 165 | all_bytes_are(0xcf, data, len) || |
| 166 | all_bytes_are(0xfc, data, len) || |
| 167 | all_bytes_are(0xfe, data, len)) |
| 168 | return; |
| 169 | #endif |
| 170 | |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 171 | switch (g_mode) { |
| 172 | case MODE_PRINT: |
| 173 | printf("%s %02u/%02u %u (%u): %s\n", |
| 174 | timeval2str(&pkt->ts), |
| 175 | pkt->line_nr, pkt->ts_nr, pkt->capture_mode, |
| 176 | pkt->len, |
| 177 | osmo_hexdump_nospc(data, len)); |
| 178 | break; |
| 179 | case MODE_BIN: |
| 180 | write(1, data, len); |
| 181 | break; |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 182 | case MODE_SC: |
| 183 | handle_sc_in(pkt, data, len); |
| 184 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 185 | } |
| 186 | } |
| 187 | |
| 188 | static int subch_demux_out_cb(struct subch_demux *dmx, int ch, uint8_t *data, |
| 189 | int len, void *c) |
| 190 | { |
| 191 | OSMO_ASSERT(ch == g_filter_subslot); |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 192 | |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 193 | handle_data(g_last_pkthdr, data, len); |
| 194 | |
| 195 | return 0; |
| 196 | } |
| 197 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 198 | static int handle_options(int argc, char **argv) |
| 199 | { |
| 200 | int opt; |
| 201 | |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 202 | while ((opt = getopt(argc, argv, "l:s:bSu:p:")) != -1) { |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 203 | switch (opt) { |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 204 | case 'l': /* Filter on E1 Line Number */ |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 205 | g_filter_line = atoi(optarg); |
| 206 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 207 | case 's': /* Filter on E1 Slot Number */ |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 208 | g_filter_slot = atoi(optarg); |
| 209 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 210 | case 'b': /* Raw binary output mode (for piping) */ |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 211 | g_mode = MODE_BIN; |
| 212 | break; |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 213 | case 'S': /* Super Channel Mode */ |
| 214 | g_mode = MODE_SC; |
| 215 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 216 | case 'u': /* 16k Sub-channel demux + filter */ |
| 217 | g_filter_subslot = atoi(optarg); |
| 218 | if (g_filter_subslot < 0 || g_filter_subslot > 3) |
| 219 | exit(2); |
| 220 | break; |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 221 | case 'p': /* PCAP writing */ |
| 222 | g_pcap_fd = osmo_pcap_lapd_open(optarg, 0640); |
| 223 | if (g_pcap_fd < 0) { |
| 224 | perror("opening pcap file"); |
| 225 | exit(1); |
| 226 | } |
| 227 | g_pcap_msg = msgb_alloc(1024, "pcap"); |
| 228 | break; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 229 | default: |
| 230 | fprintf(stderr, "Unknown option '%c'\n", opt); |
| 231 | exit(EXIT_FAILURE); |
| 232 | break; |
| 233 | } |
| 234 | } |
| 235 | |
| 236 | return 0; |
| 237 | } |
| 238 | |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 239 | static struct log_info_cat log_categories[] = { |
| 240 | }; |
| 241 | |
| 242 | static struct log_info log_info = { |
| 243 | .cat = log_categories, |
| 244 | .num_cat = ARRAY_SIZE(log_categories), |
| 245 | }; |
| 246 | |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 247 | int main(int argc, char **argv) |
| 248 | { |
| 249 | struct osmo_e1cap_file *f; |
| 250 | struct osmo_e1cap_pkthdr *pkt; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 251 | unsigned long num_pkt = 0; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 252 | struct subch_demux smux; |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 253 | int i; |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 254 | |
| 255 | printf("sizeof(timeval) = %zu\n", sizeof(struct timeval)); |
| 256 | printf("sizeof(osmo_e1cap_pkthdr) = %zu\n", sizeof(*pkt)); |
| 257 | |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 258 | memset(g_sc_state, 0, sizeof(g_sc_state)); |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 259 | for (i = 0; i < ARRAY_SIZE(g_sc_state); i++) |
| 260 | g_sc_state[i].hdlc.out_cb = handle_hdlc_frame_content; |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 261 | init_flip_bits(); |
| 262 | |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 263 | osmo_init_logging(&log_info); |
| 264 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 265 | handle_options(argc, argv); |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 266 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 267 | if (optind >= argc) { |
| 268 | fprintf(stderr, "Missing input file name\n"); |
| 269 | exit(2); |
| 270 | } |
| 271 | |
| 272 | f = osmo_e1cap_open(NULL, argv[optind++]); |
| 273 | if (!f) { |
| 274 | fprintf(stderr, "Unable to open input file\n"); |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 275 | exit(1); |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 276 | } |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 277 | |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 278 | if (g_filter_subslot >= 0) { |
| 279 | smux.out_cb = subch_demux_out_cb; |
| 280 | subch_demux_init(&smux); |
| 281 | subch_demux_activate(&smux, g_filter_subslot); |
| 282 | } |
| 283 | |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 284 | // printf("hdlc=%s\n", osmo_hexdump(&g_sc_state[0].hdlc, sizeof(g_sc_state[0].hdlc))); |
| 285 | |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 286 | while ((pkt = osmo_e1cap_read_next(f))) { |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 287 | num_pkt++; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 288 | g_last_pkthdr = pkt; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 289 | |
| 290 | if (g_filter_line >= 0 && pkt->line_nr != g_filter_line) |
| 291 | continue; |
| 292 | if (g_filter_slot >= 0 && pkt->ts_nr != g_filter_slot) |
| 293 | continue; |
| 294 | |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 295 | if (g_filter_subslot >= 0) { |
| 296 | subch_demux_in(&smux, pkt->data, pkt->len); |
| 297 | continue; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 298 | } |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 299 | |
| 300 | handle_data(pkt, pkt->data, pkt->len); |
| 301 | |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 302 | talloc_free(pkt); |
| 303 | } |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 304 | |
| 305 | fprintf(stderr, "Processed a total of %lu packets\n", num_pkt); |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 306 | } |