diff options
Diffstat (limited to 'print-dsa.c')
| -rw-r--r-- | print-dsa.c | 219 |
1 files changed, 219 insertions, 0 deletions
diff --git a/print-dsa.c b/print-dsa.c new file mode 100644 index 0000000..1ed9acf --- /dev/null +++ b/print-dsa.c @@ -0,0 +1,219 @@ +/* + * 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: Marvell (Ethertype) Distributed Switch Architecture 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" + +/* + * Format of (Ethertyped or not) DSA tagged frames: + * + * 7 6 5 4 3 2 1 0 + * . . . . . . . . . + * 0 +---+---+---+---+---+---+---+---+ + * | Ether Destination Address | + * +6 +---+---+---+---+---+---+---+---+ + * | Ether Source Address | + * +6 +---+---+---+---+---+---+---+---+ +- + * | Prog. DSA Ether Type [15:8] | | (8-byte) EDSA Tag + * +1 +---+---+---+---+---+---+---+---+ | Contains a programmable Ether type, + * | Prog. DSA Ether Type [7:0] | | two reserved bytes (always 0), + * +1 +---+---+---+---+---+---+---+---+ | and a standard DSA tag. + * | Reserved (0x00 0x00) | | + * +2 +---+---+---+---+---+---+---+---+ | +- + * | Mode |b29| Src/Trg Dev | | | (4-byte) DSA Tag + * +1 +---+---+---+---+---+---+---+---+ | | Contains a DSA tag mode, + * |Src/Trg Port/Trunk |b18|b17|b16| | | source or target switch device, + * +1 +---+---+---+---+---+---+---+---+ | | source or target port or trunk, + * | PRI [2:0] |b12| VID [11:8] | | | and misc (IEEE and FPri) bits. + * +1 +---+---+---+---+---+---+---+---+ | | + * | VID [7:0] | | | + * +1 +---+---+---+---+---+---+---+---+ +- +- + * | Ether Length/Type | + * +2 +---+---+---+---+---+---+---+---+ + * . . . . . . . . . + * + * Mode: Forward, To_CPU, From_CPU, To_Sniffer + * b29: (Source or Target) IEEE Tag Mode + * b18: Forward's Src_Is_Trunk, To_CPU's Code[2], To_Sniffer's Rx_Sniff + * b17: To_CPU's Code[1] + * b16: Original frame's CFI + * b12: To_CPU's Code[0] + */ + +#define TOK(tag, byte, mask, shift) ((GET_U_1(&(((const u_char *) tag)[byte])) & (mask)) >> (shift)) + +#define DSA_LEN 4 +#define DSA_MODE(tag) TOK(tag, 0, 0xc0, 6) +#define DSA_MODE_TO_CPU 0x0 +#define DSA_MODE_FROM_CPU 0x1 +#define DSA_MODE_TO_SNIFFER 0x2 +#define DSA_MODE_FORWARD 0x3 +#define DSA_TAGGED(tag) TOK(tag, 0, 0x20, 5) +#define DSA_DEV(tag) TOK(tag, 0, 0x1f, 0) +#define DSA_PORT(tag) TOK(tag, 1, 0xf8, 3) +#define DSA_TRUNK(tag) TOK(tag, 1, 0x04, 2) +#define DSA_RX_SNIFF(tag) TOK(tag, 1, 0x04, 2) +#define DSA_CFI(tag) TOK(tag, 1, 0x01, 0) +#define DSA_PRI(tag) TOK(tag, 2, 0xe0, 5) +#define DSA_VID(tag) ((u_short)((TOK(tag, 2, 0x0f, 0) << 8) | (TOK(tag, 3, 0xff, 0)))) +#define DSA_CODE(tag) ((TOK(tag, 1, 0x06, 1) << 1) | TOK(tag, 2, 0x10, 4)) + +#define EDSA_LEN 8 + +static const struct tok dsa_mode_values[] = { + { DSA_MODE_TO_CPU, "To CPU" }, + { DSA_MODE_FROM_CPU, "From CPU" }, + { DSA_MODE_TO_SNIFFER, "To Sniffer"}, + { DSA_MODE_FORWARD, "Forward" }, + { 0, NULL } +}; + +static const struct tok dsa_code_values[] = { + { 0x0, "BPDU (MGMT) Trap" }, + { 0x1, "Frame2Reg" }, + { 0x2, "IGMP/MLD Trap" }, + { 0x3, "Policy Trap" }, + { 0x4, "ARP Mirror" }, + { 0x5, "Policy Mirror" }, + { 0, NULL } +}; + +static void +tag_common_print(netdissect_options *ndo, const u_char *p) +{ + if (ndo->ndo_eflag) { + ND_PRINT("mode %s, ", tok2str(dsa_mode_values, "unknown", DSA_MODE(p))); + + switch (DSA_MODE(p)) { + case DSA_MODE_FORWARD: + ND_PRINT("dev %u, %s %u, ", DSA_DEV(p), + DSA_TRUNK(p) ? "trunk" : "port", DSA_PORT(p)); + break; + case DSA_MODE_FROM_CPU: + ND_PRINT("target dev %u, port %u, ", + DSA_DEV(p), DSA_PORT(p)); + break; + case DSA_MODE_TO_CPU: + ND_PRINT("source dev %u, port %u, ", + DSA_DEV(p), DSA_PORT(p)); + ND_PRINT("code %s, ", + tok2str(dsa_code_values, "reserved", DSA_CODE(p))); + break; + case DSA_MODE_TO_SNIFFER: + ND_PRINT("source dev %u, port %u, ", + DSA_DEV(p), DSA_PORT(p)); + ND_PRINT("%s sniff, ", + DSA_RX_SNIFF(p) ? "ingress" : "egress"); + break; + default: + break; + } + + ND_PRINT("%s, ", DSA_TAGGED(p) ? "tagged" : "untagged"); + ND_PRINT("%s", DSA_CFI(p) ? "CFI, " : ""); + ND_PRINT("VID %u, ", DSA_VID(p)); + ND_PRINT("FPri %u, ", DSA_PRI(p)); + } else { + switch (DSA_MODE(p)) { + case DSA_MODE_FORWARD: + ND_PRINT("Forward %s %u.%u, ", + DSA_TRUNK(p) ? "trunk" : "port", + DSA_DEV(p), DSA_PORT(p)); + break; + case DSA_MODE_FROM_CPU: + ND_PRINT("CPU > port %u.%u, ", + DSA_DEV(p), DSA_PORT(p)); + break; + case DSA_MODE_TO_CPU: + ND_PRINT("port %u.%u > CPU, ", + DSA_DEV(p), DSA_PORT(p)); + break; + case DSA_MODE_TO_SNIFFER: + ND_PRINT("port %u.%u > %s Sniffer, ", + DSA_DEV(p), DSA_PORT(p), + DSA_RX_SNIFF(p) ? "Rx" : "Tx"); + break; + default: + break; + } + + ND_PRINT("VLAN %u%c, ", DSA_VID(p), DSA_TAGGED(p) ? 't' : 'u'); + } +} + +static void +dsa_tag_print(netdissect_options *ndo, const u_char *bp) +{ + if (ndo->ndo_eflag) + ND_PRINT("Marvell DSA "); + else + ND_PRINT("DSA "); + tag_common_print(ndo, bp); +} + +static void +edsa_tag_print(netdissect_options *ndo, const u_char *bp) +{ + const u_char *p = bp; + uint16_t edsa_etype; + + edsa_etype = GET_BE_U_2(p); + if (ndo->ndo_eflag) { + ND_PRINT("Marvell EDSA ethertype 0x%04x (%s), ", edsa_etype, + tok2str(ethertype_values, "Unknown", edsa_etype)); + ND_PRINT("rsvd %u %u, ", GET_U_1(p + 2), GET_U_1(p + 3)); + } else + ND_PRINT("EDSA 0x%04x, ", edsa_etype); + p += 4; + tag_common_print(ndo, p); +} + +void +dsa_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 = "dsa"; + ndo->ndo_ll_hdr_len += + ether_switch_tag_print(ndo, p, length, caplen, dsa_tag_print, DSA_LEN); +} + +void +edsa_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 = "edsa"; + ndo->ndo_ll_hdr_len += + ether_switch_tag_print(ndo, p, length, caplen, edsa_tag_print, EDSA_LEN); +} |