net_switch.cc 9.28 KB
Newer Older
Antoine Kaufmann's avatar
Antoine Kaufmann committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
/*
 * Copyright 2021 Max Planck Institute for Software Systems, and
 * National University of Singapore
 *
 * Permission is hereby granted, free of charge, to any person obtaining
 * a copy of this software and associated documentation files (the
 * "Software"), to deal in the Software without restriction, including
 * without limitation the rights to use, copy, modify, merge, publish,
 * distribute, sublicense, and/or sell copies of the Software, and to
 * permit persons to whom the Software is furnished to do so, subject to
 * the following conditions:
 *
 * The above copyright notice and this permission notice shall be
 * included in all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
 * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
 * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
 * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 */

25
#include <unistd.h>
Jialin Li's avatar
Jialin Li committed
26
#include <pcap/pcap.h>
27
28
29
#include <linux/ip.h>
#include <linux/if_ether.h>
#include <arpa/inet.h>
30
31
32
33

#include <cassert>
#include <climits>
#include <csignal>
Jialin Li's avatar
Jialin Li committed
34
35
36
37
#include <cstdio>
#include <cstdlib>
#include <cstring>
#include <unordered_map>
38
#include <vector>
Jialin Li's avatar
Jialin Li committed
39
40

extern "C" {
41
#include <simbricks/netif/netif.h>
42
#include <simbricks/proto/base.h>
Jialin Li's avatar
Jialin Li committed
43
44
};

45
//#define NETSWITCH_DEBUG
Hejing Li's avatar
Hejing Li committed
46
#define NETSWITCH_STAT
47

Antoine Kaufmann's avatar
Antoine Kaufmann committed
48
49
static uint64_t sync_period = (500 * 1000ULL);  // 500ns
static uint64_t eth_latency = (500 * 1000ULL);  // 500ns
Jialin Li's avatar
Jialin Li committed
50
static pcap_dumper_t *dumpfile = nullptr;
Jialin Li's avatar
Jialin Li committed
51

Hejing Li's avatar
Hejing Li committed
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
#ifdef NETSWITCH_STAT
#endif

#ifdef NETSWITCH_STAT
static uint64_t d2n_poll_total = 0;
static uint64_t d2n_poll_suc = 0;
static uint64_t d2n_poll_sync = 0;

static uint64_t s_d2n_poll_total = 0;
static uint64_t s_d2n_poll_suc = 0;
static uint64_t s_d2n_poll_sync = 0;

static int stat_flag = 0;
#endif

Jialin Li's avatar
Jialin Li committed
67
68
/* MAC address type */
struct MAC {
69
  const volatile uint8_t *data;
Jialin Li's avatar
Jialin Li committed
70

71
  explicit MAC(const volatile uint8_t *data) : data(data) {
72
  }
Jialin Li's avatar
Jialin Li committed
73

74
75
76
77
78
  bool operator==(const MAC &other) const {
    for (int i = 0; i < 6; i++) {
      if (data[i] != other.data[i]) {
        return false;
      }
Jialin Li's avatar
Jialin Li committed
79
    }
80
81
    return true;
  }
Jialin Li's avatar
Jialin Li committed
82
83
};
namespace std {
Antoine Kaufmann's avatar
Antoine Kaufmann committed
84
template <>
85
86
struct hash<MAC> {
  size_t operator()(const MAC &m) const {
Antoine Kaufmann's avatar
Antoine Kaufmann committed
87
88
    size_t res = 0;
    for (int i = 0; i < 6; i++) {
89
      res = (res << 4) | (res ^ m.data[i]);
Antoine Kaufmann's avatar
Antoine Kaufmann committed
90
91
    }
    return res;
92
  }
Antoine Kaufmann's avatar
Antoine Kaufmann committed
93
94
};
}  // namespace std
Jialin Li's avatar
Jialin Li committed
95
96
97
98
99
100

/* Global variables */
static uint64_t cur_ts = 0;
static int exiting = 0;
static const volatile uint8_t bcast[6] = {0xFF};
static const MAC bcast_addr(bcast);
101
static std::vector<struct SimbricksNetIf> nsifs;
Jialin Li's avatar
Jialin Li committed
102
103
static std::unordered_map<MAC, int> mac_table;

104
105
static void sigint_handler(int dummy) {
  exiting = 1;
Jialin Li's avatar
Jialin Li committed
106
107
}

Hejing Li's avatar
Hejing Li committed
108
109
110
111
112
113
114
115
116
117
static void sigusr1_handler(int dummy) {
  fprintf(stderr, "main_time = %lu\n", cur_ts);
}

#ifdef NETSWITCH_STAT
static void sigusr2_handler(int dummy) {
  stat_flag = 1;
}
#endif

118
static void forward_pkt(volatile struct SimbricksProtoNetD2NSend *tx,
119
                        size_t port) {
120
  volatile union SimbricksProtoNetN2D *msg_to;
Jialin Li's avatar
Jialin Li committed
121
122
  struct pcap_pkthdr ph;

123

Jialin Li's avatar
Jialin Li committed
124
125
126
127
128
129
130
131
132
  // log to pcap file if initialized
  if (dumpfile) {
      memset(&ph, 0, sizeof(ph));
      ph.ts.tv_sec = cur_ts / 1000000000000ULL;
      ph.ts.tv_usec = (cur_ts % 1000000000000ULL) / 1000ULL;
      ph.caplen = tx->len;
      ph.len = tx->len;
      pcap_dump((unsigned char *)dumpfile, &ph, (unsigned char *)tx->data);
  }
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
  // print sending tick: [packet type] source_IP -> dest_IP len:
  
#ifdef NETSWITCH_DEBUG
  uint16_t eth_proto;
  struct ethhdr *hdr;
  struct iphdr *iph;
  hdr = (struct ethhdr*)tx->data; 
  eth_proto = ntohs(hdr->h_proto);
  iph = (struct iphdr *)(hdr + 1);
  fprintf(stderr, "%20lu: ", cur_ts);
  if (eth_proto == ETH_P_IP){
    fprintf(stderr, "[ IP] ");
    
  } 
  else if(eth_proto == ETH_P_ARP){
    fprintf(stderr, "[ARP] ");
  } 
  else{
    fprintf(stderr, "unkwon eth type\n");
  }

  fprintf(stderr, "%8X -> %8X len: %lu\n ", iph->saddr, iph->daddr, iph->tot_len + sizeof(struct ethhdr));
#endif

Jialin Li's avatar
Jialin Li committed
157

158
  msg_to = SimbricksNetIfN2DAlloc(&nsifs[port], cur_ts, eth_latency);
159
  if (msg_to != NULL) {
160
    volatile struct SimbricksProtoNetN2DRecv *rx;
161
162
163
164
165
166
    rx = &msg_to->recv;
    rx->len = tx->len;
    rx->port = 0;
    memcpy((void *)rx->data, (void *)tx->data, tx->len);

    // WMB();
167
168
    rx->own_type =
        SIMBRICKS_PROTO_NET_N2D_MSG_RECV | SIMBRICKS_PROTO_NET_N2D_OWN_DEV;
169
170
171
  } else {
    fprintf(stderr, "forward_pkt: dropping packet\n");
  }
Jialin Li's avatar
Jialin Li committed
172
173
}

174
static void switch_pkt(struct SimbricksNetIf *nsif, size_t iport) {
175
  volatile union SimbricksProtoNetD2N *msg_from =
176
      SimbricksNetIfD2NPoll(nsif, cur_ts);
Hejing Li's avatar
Hejing Li committed
177
178
179
180
181
182
183
#ifdef NETSWITCH_STAT
  d2n_poll_total += 1;
  if (stat_flag){
    s_d2n_poll_total += 1;
  }
#endif

184
185
186
187
  if (msg_from == NULL) {
    return;
  }

Hejing Li's avatar
Hejing Li committed
188
189
190
191
192
193
194
#ifdef NETSWITCH_STAT
  d2n_poll_suc += 1;
  if (stat_flag){
    s_d2n_poll_suc += 1;
  }
#endif

195
196
197
  uint8_t type = msg_from->dummy.own_type & SIMBRICKS_PROTO_NET_D2N_MSG_MASK;
  if (type == SIMBRICKS_PROTO_NET_D2N_MSG_SEND) {
    volatile struct SimbricksProtoNetD2NSend *tx;
198
199
200
201
202
203
    tx = &msg_from->send;
    // Get MAC addresses
    MAC dst(tx->data), src(tx->data + 6);
    // MAC learning
    if (!(src == bcast_addr)) {
      mac_table[src] = iport;
Jialin Li's avatar
Jialin Li committed
204
    }
205
206
    // L2 forwarding
    if (mac_table.count(dst) > 0) {
207
      size_t eport = mac_table.at(dst);
208
      forward_pkt(tx, eport);
Jialin Li's avatar
Jialin Li committed
209
    } else {
210
      // Broadcast
211
      for (size_t eport = 0; eport < nsifs.size(); eport++) {
212
213
214
215
216
        if (eport != iport) {
          // Do not forward to ingress port
          forward_pkt(tx, eport);
        }
      }
Jialin Li's avatar
Jialin Li committed
217
    }
218
  } else if (type == SIMBRICKS_PROTO_NET_D2N_MSG_SYNC) {
Hejing Li's avatar
Hejing Li committed
219
220
221
222
223
224
#ifdef NETSWITCH_STAT
    d2n_poll_sync += 1;
    if (stat_flag){
      s_d2n_poll_sync += 1;
    }
#endif
225
226
227
228
  } else {
    fprintf(stderr, "switch_pkt: unsupported type=%u\n", type);
    abort();
  }
229
  SimbricksNetIfD2NDone(nsif, msg_from);
Jialin Li's avatar
Jialin Li committed
230
231
}

232
233
234
int main(int argc, char *argv[]) {
  int c;
  int bad_option = 0;
235
  int sync_mode = SIMBRICKS_PROTO_SYNC_SIMBRICKS;
Jialin Li's avatar
Jialin Li committed
236
  pcap_t *pc = nullptr;
237
238

  // Parse command line argument
Jialin Li's avatar
Jialin Li committed
239
  while ((c = getopt(argc, argv, "s:S:E:m:p:")) != -1 && !bad_option) {
240
241
    switch (c) {
      case 's': {
242
        struct SimbricksNetIf nsif;
243
        int sync = 1;
244
        if (SimbricksNetIfInit(&nsif, optarg, &sync) != 0) {
245
246
          fprintf(stderr, "connecting to %s failed\n", optarg);
          return EXIT_FAILURE;
Jialin Li's avatar
Jialin Li committed
247
        }
248
249
250
251
252
253
254
255
256
257
258
259
260
261
        nsifs.push_back(nsif);
        break;
      }

      case 'S':
        sync_period = strtoull(optarg, NULL, 0) * 1000ULL;
        break;

      case 'E':
        eth_latency = strtoull(optarg, NULL, 0) * 1000ULL;
        break;

      case 'm':
        sync_mode = strtol(optarg, NULL, 0);
262
        assert(sync_mode == SIMBRICKS_PROTO_SYNC_SIMBRICKS ||
263
               sync_mode == SIMBRICKS_PROTO_SYNC_BARRIER);
264
265
        break;

Jialin Li's avatar
Jialin Li committed
266
267
268
269
270
271
272
273
274
275
276
      case 'p':
        pc = pcap_open_dead_with_tstamp_precision(DLT_EN10MB, 65535,
                                                  PCAP_TSTAMP_PRECISION_NANO);
        if (pc == nullptr) {
            perror("pcap_open_dead failed");
            return EXIT_FAILURE;
        }

        dumpfile = pcap_dump_open(pc, optarg);
        break;

277
278
279
280
      default:
        fprintf(stderr, "unknown option %c\n", c);
        bad_option = 1;
        break;
Jialin Li's avatar
Jialin Li committed
281
    }
282
283
284
285
286
287
288
289
290
291
292
  }

  if (nsifs.empty() || bad_option) {
    fprintf(stderr,
            "Usage: net_switch [-S SYNC-PERIOD] [-E ETH-LATENCY] "
            "-s SOCKET-A [-s SOCKET-B ...]\n");
    return EXIT_FAILURE;
  }

  signal(SIGINT, sigint_handler);
  signal(SIGTERM, sigint_handler);
Hejing Li's avatar
Hejing Li committed
293
294
295
296
297
298
  signal(SIGUSR1, sigusr1_handler);

#ifdef NETSWITCH_STAT
  signal(SIGUSR2, sigusr2_handler);
#endif

299
300
301
302
303

  printf("start polling\n");
  while (!exiting) {
    // Sync all interfaces
    for (auto &nsif : nsifs) {
304
      if (SimbricksNetIfN2DSync(&nsif, cur_ts, eth_latency, sync_period,
305
                                sync_mode) != 0) {
306
        fprintf(stderr, "SimbricksNetIfN2DSync failed\n");
307
308
        abort();
      }
Jialin Li's avatar
Jialin Li committed
309
    }
310
    SimbricksNetIfAdvanceEpoch(cur_ts, sync_period, sync_mode);
311
312
313
314
315

    // Switch packets
    uint64_t min_ts;
    do {
      min_ts = ULLONG_MAX;
316
      for (size_t port = 0; port < nsifs.size(); port++) {
317
318
319
        auto &nsif = nsifs.at(port);
        switch_pkt(&nsif, port);
        if (nsif.sync) {
320
          uint64_t ts = SimbricksNetIfD2NTimestamp(&nsif);
321
          min_ts = ts < min_ts ? ts : min_ts;
Jialin Li's avatar
Jialin Li committed
322
        }
323
324
325
326
327
      }
    } while (!exiting && (min_ts <= cur_ts));

    // Update cur_ts
    if (min_ts < ULLONG_MAX) {
328
      cur_ts = SimbricksNetIfAdvanceTime(min_ts, sync_period, sync_mode);
Jialin Li's avatar
Jialin Li committed
329
    }
330
  }
Jialin Li's avatar
Jialin Li committed
331

Hejing Li's avatar
Hejing Li committed
332
333
334
335
336
337
338
339
340
341
342
343
344
345
#ifdef NETSWITCH_STAT
  fprintf(stderr, "%20s: %22lu %20s: %22lu  poll_suc_rate: %f\n",
          "d2n_poll_total", d2n_poll_total, "d2n_poll_suc", d2n_poll_suc,
          (double)d2n_poll_suc / d2n_poll_total);
  fprintf(stderr, "%65s: %22lu  sync_rate: %f\n", "d2n_poll_sync",
          d2n_poll_sync, (double)d2n_poll_sync / d2n_poll_suc);

  fprintf(stderr, "%20s: %22lu %20s: %22lu  poll_suc_rate: %f\n",
          "s_d2n_poll_total", s_d2n_poll_total, "s_d2n_poll_suc", s_d2n_poll_suc,
          (double)s_d2n_poll_suc / s_d2n_poll_total);
  fprintf(stderr, "%65s: %22lu  sync_rate: %f\n", "s_d2n_poll_sync",
          s_d2n_poll_sync, (double)s_d2n_poll_sync / s_d2n_poll_suc);
#endif

346
  return 0;
Jialin Li's avatar
Jialin Li committed
347
}