1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
|
/* $OpenBSD: packet.c,v 1.4 2016/09/26 08:55:43 rzalamena Exp $ */
/*
* Copyright (c) 2013-2016 Reyk Floeter <reyk@openbsd.org>
*
* Permission to use, copy, modify, and distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/
#include <sys/types.h>
#include <sys/socket.h>
#include <net/if.h>
#include <net/if_arp.h>
#include <netinet/in.h>
#include <netinet/if_ether.h>
#include <netinet/tcp.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <fcntl.h>
#include <err.h>
#include <pwd.h>
#include <event.h>
#include "switchd.h"
const uint8_t etherbroadcastaddr[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
const uint8_t etherzeroaddr[] = { 0, 0, 0, 0, 0, 0 };
int packet_ether_unicast(uint8_t *);
int
packet_ether_unicast(uint8_t *ea)
{
if (memcmp(ea, etherbroadcastaddr, ETHER_ADDR_LEN) == 0 ||
memcmp(ea, etherzeroaddr, ETHER_ADDR_LEN) == 0 ||
ETHER_IS_MULTICAST(ea))
return (-1);
return (0);
}
int
packet_input(struct switchd *sc, struct switch_control *sw, uint32_t srcport,
uint32_t *dstport, struct ibuf *ibuf, size_t len, struct packet *pkt)
{
struct ether_header *eh;
struct macaddr *src, *dst;
if (sw == NULL)
return (-1);
if (len < sizeof(*eh))
return (-1);
pkt->pkt_len = ibuf_dataleft(ibuf);
if ((eh = ibuf_getdata(ibuf, sizeof(*eh))) == NULL) {
log_debug("short packet");
return (-1);
}
len -= sizeof(*eh);
if ((packet_ether_unicast(eh->ether_shost) == -1) ||
(src = switch_learn(sc, sw, eh->ether_shost, srcport)) == NULL)
return (-1);
if (packet_ether_unicast(eh->ether_dhost) == -1)
dst = NULL;
else
dst = switch_cached(sw, eh->ether_dhost);
log_debug("%s: %s -> %s, port %u -> %u", __func__,
print_ether(eh->ether_shost),
print_ether(eh->ether_dhost),
src->mac_port,
dst == NULL ? OFP_PORT_ANY : dst->mac_port);
if (dstport)
*dstport = dst == NULL ? OFP_PORT_ANY : dst->mac_port;
pkt->pkt_eh = eh;
pkt->pkt_buf = (uint8_t *)eh;
return (0);
}
|
