--- /dev/null
+/*
+ * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994, 1995, 1996, 1997
+ * The Regents of the University of California. All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that: (1) source code distributions
+ * retain the above copyright notice and this paragraph in its entirety, (2)
+ * distributions including binary code include the above copyright notice and
+ * this paragraph in its entirety in the documentation or other materials
+ * provided with the distribution, and (3) all advertising materials mentioning
+ * features or use of this software display the following acknowledgement:
+ * ``This product includes software developed by the University of California,
+ * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
+ * the University nor the names of its contributors may be used to endorse
+ * or promote products derived from this software without specific prior
+ * written permission.
+ * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
+ */
+
+/* \summary: Broadcom Ethernet switches tag (4 bytes) printer */
+
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+
+#include "netdissect-stdinc.h"
+
+#include "netdissect.h"
+#include "ethertype.h"
+#include "addrtoname.h"
+#include "extract.h"
+
+struct ether_header {
+ nd_mac_addr ether_dhost;
+ nd_mac_addr ether_shost;
+ nd_uint16_t ether_length_type;
+};
+
+#define ETHER_SA_OFFSET 12
+#define ETHER_TYPE_LEN 2
+
+#define BRCM_TAG_LEN 4
+#define BRCM_OPCODE_SHIFT 5
+#define BRCM_OPCODE_MASK 0x7
+
+/* Ingress fields */
+#define BRCM_IG_TC_SHIFT 2
+#define BRCM_IG_TC_MASK 0x7
+#define BRCM_IG_TE_MASK 0x3
+#define BRCM_IG_TS_SHIFT 7
+#define BRCM_IG_DSTMAP_MASK 0x1ff
+
+/* Egress fields */
+#define BRCM_EG_CID_MASK 0xff
+#define BRCM_EG_RC_MASK 0xff
+#define BRCM_EG_RC_RSVD (3 << 6)
+#define BRCM_EG_RC_EXCEPTION (1 << 5)
+#define BRCM_EG_RC_PROT_SNOOP (1 << 4)
+#define BRCM_EG_RC_PROT_TERM (1 << 3)
+#define BRCM_EG_RC_SWITCH (1 << 2)
+#define BRCM_EG_RC_MAC_LEARN (1 << 1)
+#define BRCM_EG_RC_MIRROR (1 << 0)
+#define BRCM_EG_TC_SHIFT 5
+#define BRCM_EG_TC_MASK 0x7
+#define BRCM_EG_PID_MASK 0x1f
+
+const struct tok brcm_tag_te_values[] = {
+ { 0, "None" },
+ { 1, "Untag" },
+ { 2, "Header"},
+ { 3, "Reserved" },
+};
+
+const struct tok brcm_tag_rc_values[] = {
+ { 1, "mirror" },
+ { 2, "MAC learning" },
+ { 4, "switching" },
+ { 8, "prot term" },
+ { 16, "prot snoop" },
+ { 32, "exception" },
+};
+
+static int brcm_tag_print_full(netdissect_options *ndo, const u_char *bp,
+ u_int length)
+{
+ uint8_t tag[BRCM_TAG_LEN];
+ uint16_t dst_map;
+ unsigned int i;
+
+ if (length < BRCM_TAG_LEN)
+ return (1);
+
+ for (i = 0; i < BRCM_TAG_LEN; i++)
+ tag[i] = EXTRACT_U_1(bp + i);
+
+ ND_PRINT("BRCM tag OP: %s", tag[0] ? "IG" : "EG");
+ if (tag[0] & (1 << BRCM_OPCODE_SHIFT)) {
+ /* Ingress Broadcom tag */
+ ND_PRINT(", TC: %d", (tag[1] >> BRCM_IG_TC_SHIFT) &
+ BRCM_IG_TC_MASK);
+ ND_PRINT(", TE: %s",
+ tok2str(brcm_tag_te_values, "unknown",
+ (tag[1] & BRCM_IG_TE_MASK)));
+ ND_PRINT(", TS: %d", tag[1] >> BRCM_IG_TS_SHIFT);
+ dst_map = (uint16_t)tag[2] << 8 | tag[3];
+ ND_PRINT(", DST map: 0x%04x", dst_map & BRCM_IG_DSTMAP_MASK);
+ } else {
+ /* Egress Broadcom tag */
+ ND_PRINT(", CID: %d", tag[1]);
+ ND_PRINT(", RC: %s", tok2str(brcm_tag_rc_values,
+ "reserved", tag[2]));
+ ND_PRINT(", TC: %d", (tag[3] >> BRCM_EG_TC_SHIFT) &
+ BRCM_EG_TC_MASK);
+ ND_PRINT(", port: %d", tag[3] & BRCM_EG_PID_MASK);
+ }
+ ND_PRINT(", ");
+
+ return (0);
+}
+
+u_int
+brcm_tag_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h,
+ const u_char *p)
+{
+ const struct ether_header *ehp;
+ int old_eflag = ndo->ndo_eflag;
+ u_int caplen = h->caplen;
+ u_int length = h->len;
+ int ret;
+
+ ndo->ndo_protocol = "brcm-tag";
+ if (caplen < ETHER_SA_OFFSET + BRCM_TAG_LEN) {
+ nd_print_trunc(ndo);
+ return (caplen);
+ }
+
+ if (length < ETHER_SA_OFFSET + BRCM_TAG_LEN) {
+ nd_print_trunc(ndo);
+ return (length);
+ }
+
+ ehp = (const struct ether_header *)p;
+ if (ndo->ndo_eflag)
+ ND_PRINT("%s > %s, ",
+ etheraddr_string(ndo, ehp->ether_shost),
+ etheraddr_string(ndo, ehp->ether_dhost));
+
+ if (brcm_tag_print_full(ndo, p + ETHER_SA_OFFSET,
+ caplen - ETHER_SA_OFFSET))
+ return (1);
+
+ /* We printed the Ethernet header already */
+ ndo->ndo_eflag = 0;
+
+ /* Parse the Ethernet frame regularly telling how big the non
+ * standard Ethernet header is.
+ *
+ * +-----------++-----------++----------------++--------------+
+ * | MAC DA (6)|| MAC SA (6)||Broadcom tag (4)||Type/Length(2)|
+ * +-----------++-----------++----------------++--------------+
+ */
+ ret = ether_print_hdr_len(ndo, p, length, caplen, NULL, NULL,
+ ETHER_SA_OFFSET + BRCM_TAG_LEN + 2);
+ ndo->ndo_eflag = old_eflag;
+ return ret;
+}
+
+static void brcm_tag_print_encap(netdissect_options *ndo,
+ const u_char *p)
+{
+ brcm_tag_print_full(ndo, p, BRCM_TAG_LEN);
+}
+
+u_int
+brcm_tag_prepend_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h,
+ const u_char *p)
+{
+ u_int caplen = h->caplen;
+ u_int length = h->len;
+
+ ndo->ndo_protocol = "brcm-tag-prepend";
+ if (caplen < BRCM_TAG_LEN) {
+ nd_print_trunc(ndo);
+ return (caplen);
+ }
+
+ if (length < BRCM_TAG_LEN) {
+ nd_print_trunc(ndo);
+ return (length);
+ }
+
+ /* Parse the Ethernet frame regularly and utilize the encapsulation
+ * header printing facility to pring the pre-pended Broadcom tag.
+ *
+ * +-----------------++-----------++-----------++--------------+
+ * | Broadcom tag (4)|| MAC DA (6)|| MAC SA (6)||Type/Length(2)|
+ * +-----------------++-----------++-----------++--------------+
+ */
+ return ether_print(ndo, p + BRCM_TAG_LEN,
+ length - BRCM_TAG_LEN,
+ caplen - BRCM_TAG_LEN, brcm_tag_print_encap, p);
+}