add VLAN Query Protocol (VQP) dissector; ok canacar@ markus@

1 files changed, 240 insertions, 0 deletions

diff --git a/usr.sbin/tcpdump/print-vqp.c b/usr.sbin/tcpdump/print-vqp.c
new file mode 100644
index 00000000000..13cedec4d2c
--- /dev/null
+++ b/usr.sbin/tcpdump/print-vqp.c
@@ -0,0 +1,240 @@
+/*
+ * Copyright (c) 2006 Kevin Steves <stevesk@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.
+ */
+
+/*
+ * VLAN Query Protocol (VQP)
+ *
+ *    0                   1                   2                   3
+ *    0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *   |    Version    |    Opcode     | Response Code |  Data Count   |
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *   |                         Transaction ID                        |
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *   |                            Type (1)                           |
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *   |             Length            |            Data               /
+ *   /                                                               /
+ *   /                                                               /
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *   |                            Type (n)                           |
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *   |             Length            |            Data               /
+ *   /                                                               /
+ *   /                                                               /
+ *   +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
+ *
+ * VQP is layered over UDP.  The default destination port is 1589.
+ *
+ */
+
+#include <sys/types.h>
+#include <sys/socket.h>
+
+#include <netinet/in.h>
+#include <arpa/inet.h>
+
+#include <stdio.h>
+#include <string.h>
+
+#include "interface.h"
+#include "addrtoname.h"
+#include "extract.h"
+
+struct vqp_hdr {
+	u_char version;
+	u_char opcode;
+	u_char rcode;
+	u_char dcount;
+	u_int32_t xid;
+};
+
+#define VQP_JOIN			0x01
+#define VQP_JOIN_RESPONSE		0x02
+#define VQP_RECONFIRM			0x03
+#define VQP_RECONFIRM_RESPONSE		0x04
+
+#define VQP_NO_ERROR			0x00
+#define VQP_WRONG_VERSION		0x01
+#define VQP_INSUFFICIENT_RESOURCES	0x02
+#define VQP_DENY			0x03
+#define VQP_SHUTDOWN			0x04
+#define VQP_WRONG_MGMT_DOMAIN		0x05
+
+/* 4 bytes struct in_addr; IP address of VQP client */
+#define VQP_CLIENT_ADDR			0x00000c01
+/* string */
+#define VQP_PORT_NAME			0x00000c02
+/* string */
+#define VQP_VLAN_NAME			0x00000c03
+/* string; VTP domain if set */
+#define VQP_DOMAIN_NAME			0x00000c04
+/* 2 bytes? */
+#define VQP_UNKNOWN1			0x00000c05
+/* 6 bytes, mac address */
+#define VQP_MAC				0x00000c06
+/* unknown */
+#define VQP_UNKNOWN2			0x00000c07
+/* 6 bytes, mac address */
+#define VQP_COOKIE			0x00000c08
+
+static void
+vqp_print_opcode(u_int val)
+{
+	switch (val) {
+	case VQP_JOIN:
+		printf("Join");
+		break;
+	case VQP_JOIN_RESPONSE:
+		printf("JoinResp");
+		break;
+	case VQP_RECONFIRM:
+		printf("Reconfirm");
+		break;
+	case VQP_RECONFIRM_RESPONSE:
+		printf("ReconfirmResp");
+		break;
+	default:
+		printf("unknown(%x)", val);
+		break;
+	}
+}
+
+static void
+vqp_print_rcode(u_int val)
+{
+	switch (val) {
+	case VQP_NO_ERROR:
+		printf("NoError");
+		break;
+	case VQP_WRONG_VERSION:
+		printf("WrongVersion");
+		break;
+	case VQP_INSUFFICIENT_RESOURCES:
+		printf("InsufficientResources");
+		break;
+	case VQP_DENY:
+		printf("Deny");
+		break;
+	case VQP_SHUTDOWN:
+		printf("Shutdown");
+		break;
+	case VQP_WRONG_MGMT_DOMAIN:
+		printf("WrongMgmtDomain");
+		break;
+	default:
+		printf("unknown(%x)", val);
+		break;
+	}
+}
+
+static void
+print_hex(const u_char *p, u_int len)
+{
+	while (len--)
+		printf("%02x", *p--);
+}
+
+static void
+vqp_print_type(u_int type, u_int len, const u_char *p)
+{
+	switch (type) {
+	case VQP_CLIENT_ADDR:
+		printf(" client:");
+		if (len == 4) {
+			struct in_addr in;
+			memcpy(&in, p, sizeof in);
+			printf("%s", inet_ntoa(in));
+		} else
+			print_hex(p, len);
+		break;
+	case VQP_PORT_NAME:
+		printf(" port:");
+		fn_printn(p, len, NULL);
+		break;
+	case VQP_VLAN_NAME:
+		printf(" vlan:");
+		fn_printn(p, len, NULL);
+		break;
+	case VQP_DOMAIN_NAME:
+		printf(" domain:");
+		fn_printn(p, len, NULL);
+		break;
+	case VQP_UNKNOWN1:
+		printf(" unknown1:");
+		print_hex(p, len);
+		break;
+	case VQP_MAC:
+		printf(" mac:");
+		if (len == 6)
+			printf("%s", etheraddr_string(p));
+		else
+			print_hex(p, len);
+		break;
+	case VQP_UNKNOWN2:
+		printf(" unknown2:");
+		print_hex(p, len);
+		break;
+	case VQP_COOKIE:
+		printf(" cookie:");
+		if (len == 6)
+			printf("%s", etheraddr_string(p));
+		else
+			print_hex(p, len);
+		break;
+	default:
+		printf(" unknown(%x/%u)", type, len);
+	}
+}
+
+void
+vqp_print(const u_char *bp, u_int len)
+{
+	struct vqp_hdr *p = (struct vqp_hdr *)bp;
+	u_int dcount;
+
+	TCHECK(p->version);
+	printf("VQPv%u", p->version);
+	if (p->version != 1)
+		return;
+	TCHECK(p->opcode);
+	printf("-");
+	vqp_print_opcode(p->opcode);
+	TCHECK(p->rcode);
+	printf(" rcode:");
+	vqp_print_rcode(p->rcode);
+	TCHECK(p->xid);
+	printf(" xid:0x%08x", ntohl(p->xid));
+	printf(" dcount:%u", p->dcount);
+	bp += sizeof(struct vqp_hdr);
+
+	dcount = p->dcount;
+	while (vflag && dcount > 0) {
+		TCHECK2(bp[0], 6);
+		u_int type = EXTRACT_32BITS(bp);
+		bp += 4;
+		u_int length = EXTRACT_16BITS(bp);
+		bp += 2;
+		TCHECK2(bp[0], length);
+		vqp_print_type(type, length, bp);
+		bp += length;
+		dcount--;
+	}
+
+	return;
+trunc:
+	printf("[|vqp]");
+}