etherip printing code... handles draft (v2) and current (v3)

1 files changed, 139 insertions, 0 deletions

diff --git a/usr.sbin/tcpdump/print-etherip.c b/usr.sbin/tcpdump/print-etherip.c
new file mode 100644
index 00000000000..460c8d733c6
--- /dev/null
+++ b/usr.sbin/tcpdump/print-etherip.c
@@ -0,0 +1,139 @@
+/*	$OpenBSD: print-etherip.c,v 1.1 2001/02/05 15:18:47 jason Exp $	*/
+
+/*
+ * Copyright (c) 2001 Jason L. Wright (jason@thought.net)
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ * 3. All advertising materials mentioning features or use of this software
+ *    must display the following acknowledgement:
+ *	This product includes software developed by Jason L. Wright
+ * 4. The name of the author may not be used to endorse or promote products
+ *    derived from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
+ * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
+ * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
+ * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
+ * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
+ * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ */
+
+/*
+ * Format and print etherip packets
+ */
+
+#ifndef lint
+static const char rcsid[] =
+    "@(#) $Header: /cvs/OpenBSD/src/usr.sbin/tcpdump/print-etherip.c,v 1.1 2001/02/05 15:18:47 jason Exp $";
+#endif
+
+#include <sys/param.h>
+#include <sys/time.h>
+#include <sys/socket.h>
+
+#include <net/if.h>
+#include <netinet/in.h>
+#include <netinet/in_systm.h>
+#include <netinet/ip.h>
+#include <netinet/ip_var.h>
+#include <netinet/udp.h>
+#include <netinet/udp_var.h>
+#include <netinet/tcp.h>
+#include <netinet/tcpip.h>
+#include <netinet/if_ether.h>
+#include <netinet/ip_ether.h>
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+#include <stddef.h>
+
+#include "addrtoname.h"
+#include "interface.h"
+#include "extract.h"		    /* must come after interface.h */
+
+extern u_short extracted_ethertype;
+
+void 
+etherip_print(bp, len, bp2)
+	register const u_char *bp, *bp2;
+	register u_int len;
+{
+	const struct ip *ip = (const struct ip *)bp2;
+	struct ether_header *eh;
+	const u_char *pbuf = bp;
+	u_int plen = len, hlen;
+	u_int16_t etype;
+
+	if (plen < sizeof(struct etherip_header)) {
+		printf("[|etherip]");
+		return;
+	}
+
+	printf("etherip %s > %s ver ", ipaddr_string(&ip->ip_src),
+	    ipaddr_string(&ip->ip_dst));
+
+	switch ((*pbuf) & 0xf) {
+	case 2:
+		hlen = 1;
+		printf("%d", 2);
+		break;
+	case 3:
+		hlen = 2;
+		printf("%d", 3);
+		break;
+	default:
+		hlen = 0;
+		printf("unknown");
+		break;
+	}
+	printf(" len %d", len);
+	if (hlen == 0)
+		return;
+
+	printf(": ");
+		
+	pbuf += hlen;
+	plen -= hlen;
+
+	if (eflag)
+		ether_print(pbuf, plen);
+	eh = (struct ether_header *)pbuf;
+	etype = EXTRACT_16BITS(pbuf + offsetof(struct ether_header, ether_type));
+	pbuf += sizeof(struct ether_header);
+	plen -= sizeof(struct ether_header);
+
+	/* XXX LLC? */
+	extracted_ethertype = 0;
+	if (etype <= ETHERMTU) {
+		if (llc_print(pbuf, plen, plen, ESRC(eh), EDST(eh)) == 0) {
+			if (!eflag)
+				ether_print((u_char *)eh, plen);
+			if (extracted_ethertype) {
+				printf("LLC %s",
+				    etherproto_string(htons(extracted_ethertype)));
+			}
+			if (!xflag && !qflag)
+				default_print(pbuf, plen);
+		}
+	} else if (ether_encap_print(etype, pbuf, plen, plen) == 0) {
+		if (!eflag)
+			ether_print((u_char *)eh, plen + sizeof(*eh));
+		if (!xflag && !qflag)
+			default_print(pbuf, plen);
+	}
+}