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