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 | 4edbb35 | 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 | 4edbb35 | 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 | 4edbb35 | 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 | 4edbb35 | 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 | 4edbb35 | 2019-11-06 16:21:55 +0100 | [diff] [blame^] | 177 | tv = pkt->ts; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 178 | printf("%s %02u/%02u %u (%u): %s\n", |
Harald Welte | 4edbb35 | 2019-11-06 16:21:55 +0100 | [diff] [blame^] | 179 | timeval2str(&tv), |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 180 | pkt->line_nr, pkt->ts_nr, pkt->capture_mode, |
| 181 | pkt->len, |
| 182 | osmo_hexdump_nospc(data, len)); |
| 183 | break; |
| 184 | case MODE_BIN: |
| 185 | write(1, data, len); |
| 186 | break; |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 187 | case MODE_SC: |
| 188 | handle_sc_in(pkt, data, len); |
| 189 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 190 | } |
| 191 | } |
| 192 | |
| 193 | static int subch_demux_out_cb(struct subch_demux *dmx, int ch, uint8_t *data, |
| 194 | int len, void *c) |
| 195 | { |
| 196 | OSMO_ASSERT(ch == g_filter_subslot); |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 197 | |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 198 | handle_data(g_last_pkthdr, data, len); |
| 199 | |
| 200 | return 0; |
| 201 | } |
| 202 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 203 | static int handle_options(int argc, char **argv) |
| 204 | { |
| 205 | int opt; |
| 206 | |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 207 | while ((opt = getopt(argc, argv, "l:s:bSu:p:")) != -1) { |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 208 | switch (opt) { |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 209 | case 'l': /* Filter on E1 Line Number */ |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 210 | g_filter_line = atoi(optarg); |
| 211 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 212 | case 's': /* Filter on E1 Slot Number */ |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 213 | g_filter_slot = atoi(optarg); |
| 214 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 215 | case 'b': /* Raw binary output mode (for piping) */ |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 216 | g_mode = MODE_BIN; |
| 217 | break; |
Harald Welte | c1b9cab | 2016-10-23 19:36:14 +0200 | [diff] [blame] | 218 | case 'S': /* Super Channel Mode */ |
| 219 | g_mode = MODE_SC; |
| 220 | break; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 221 | case 'u': /* 16k Sub-channel demux + filter */ |
| 222 | g_filter_subslot = atoi(optarg); |
| 223 | if (g_filter_subslot < 0 || g_filter_subslot > 3) |
| 224 | exit(2); |
| 225 | break; |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 226 | case 'p': /* PCAP writing */ |
| 227 | g_pcap_fd = osmo_pcap_lapd_open(optarg, 0640); |
| 228 | if (g_pcap_fd < 0) { |
| 229 | perror("opening pcap file"); |
| 230 | exit(1); |
| 231 | } |
| 232 | g_pcap_msg = msgb_alloc(1024, "pcap"); |
| 233 | break; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 234 | default: |
| 235 | fprintf(stderr, "Unknown option '%c'\n", opt); |
| 236 | exit(EXIT_FAILURE); |
| 237 | break; |
| 238 | } |
| 239 | } |
| 240 | |
| 241 | return 0; |
| 242 | } |
| 243 | |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 244 | static struct log_info_cat log_categories[] = { |
| 245 | }; |
| 246 | |
| 247 | static struct log_info log_info = { |
| 248 | .cat = log_categories, |
| 249 | .num_cat = ARRAY_SIZE(log_categories), |
| 250 | }; |
| 251 | |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 252 | int main(int argc, char **argv) |
| 253 | { |
| 254 | struct osmo_e1cap_file *f; |
| 255 | struct osmo_e1cap_pkthdr *pkt; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 256 | unsigned long num_pkt = 0; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 257 | struct subch_demux smux; |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 258 | int i; |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 259 | |
| 260 | printf("sizeof(timeval) = %zu\n", sizeof(struct timeval)); |
| 261 | printf("sizeof(osmo_e1cap_pkthdr) = %zu\n", sizeof(*pkt)); |
| 262 | |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 263 | memset(g_sc_state, 0, sizeof(g_sc_state)); |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 264 | for (i = 0; i < ARRAY_SIZE(g_sc_state); i++) |
| 265 | g_sc_state[i].hdlc.out_cb = handle_hdlc_frame_content; |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 266 | init_flip_bits(); |
| 267 | |
Harald Welte | 41a5300 | 2016-11-14 23:22:49 +0100 | [diff] [blame] | 268 | osmo_init_logging(&log_info); |
| 269 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 270 | handle_options(argc, argv); |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 271 | |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 272 | if (optind >= argc) { |
| 273 | fprintf(stderr, "Missing input file name\n"); |
| 274 | exit(2); |
| 275 | } |
| 276 | |
| 277 | f = osmo_e1cap_open(NULL, argv[optind++]); |
| 278 | if (!f) { |
| 279 | fprintf(stderr, "Unable to open input file\n"); |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 280 | exit(1); |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 281 | } |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 282 | |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 283 | if (g_filter_subslot >= 0) { |
| 284 | smux.out_cb = subch_demux_out_cb; |
| 285 | subch_demux_init(&smux); |
| 286 | subch_demux_activate(&smux, g_filter_subslot); |
| 287 | } |
| 288 | |
Harald Welte | 1df5cf4 | 2016-11-14 21:29:01 +0100 | [diff] [blame] | 289 | // printf("hdlc=%s\n", osmo_hexdump(&g_sc_state[0].hdlc, sizeof(g_sc_state[0].hdlc))); |
| 290 | |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 291 | while ((pkt = osmo_e1cap_read_next(f))) { |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 292 | num_pkt++; |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 293 | g_last_pkthdr = pkt; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 294 | |
| 295 | if (g_filter_line >= 0 && pkt->line_nr != g_filter_line) |
| 296 | continue; |
| 297 | if (g_filter_slot >= 0 && pkt->ts_nr != g_filter_slot) |
| 298 | continue; |
| 299 | |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 300 | if (g_filter_subslot >= 0) { |
| 301 | subch_demux_in(&smux, pkt->data, pkt->len); |
| 302 | continue; |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 303 | } |
Harald Welte | 525af18 | 2016-10-19 00:38:46 +0200 | [diff] [blame] | 304 | |
| 305 | handle_data(pkt, pkt->data, pkt->len); |
| 306 | |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 307 | talloc_free(pkt); |
| 308 | } |
Harald Welte | f403232 | 2016-10-19 00:23:10 +0200 | [diff] [blame] | 309 | |
| 310 | fprintf(stderr, "Processed a total of %lu packets\n", num_pkt); |
Harald Welte | dbb0f5a | 2016-10-18 23:51:54 +0200 | [diff] [blame] | 311 | } |