1 files changed, 88 insertions, 0 deletions
diff --git a/usr.sbin/switchd/packet.c b/usr.sbin/switchd/packet.c
new file mode 100644
index 00000000000..39df7a9af2b
--- /dev/null
+++ b/usr.sbin/switchd/packet.c
@@ -0,0 +1,88 @@
+/*	$OpenBSD: packet.c,v 1.1 2016/07/19 16:54:26 reyk 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);
+}
+
+long
+packet_input(struct switchd *sc, struct switch_control *sw, long port,
+    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 ((pkt->pkt_eh = 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, port)) == 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 %ld -> %ld", __func__,
+	    print_ether(eh->ether_shost),
+	    print_ether(eh->ether_dhost),
+	    src->mac_port,
+	    dst == NULL ? -1 : dst->mac_port);
+
+	return (dst == NULL ? -1 : dst->mac_port);
+}