]> The Tcpdump Group git mirrors - tcpdump/blob - print-dsa.c
Merge pull request #744 from vivien/dsa
[tcpdump] / print-dsa.c
1 /*
2 * Copyright (c) 1988, 1989, 1990, 1991, 1992, 1993, 1994, 1995, 1996, 1997
3 * The Regents of the University of California. All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that: (1) source code distributions
7 * retain the above copyright notice and this paragraph in its entirety, (2)
8 * distributions including binary code include the above copyright notice and
9 * this paragraph in its entirety in the documentation or other materials
10 * provided with the distribution, and (3) all advertising materials mentioning
11 * features or use of this software display the following acknowledgement:
12 * ``This product includes software developed by the University of California,
13 * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
14 * the University nor the names of its contributors may be used to endorse
15 * or promote products derived from this software without specific prior
16 * written permission.
17 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
18 * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
19 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
20 */
21
22 /* \summary: Marvell (Ethertype) Distributed Switch Architecture printer */
23
24 #ifdef HAVE_CONFIG_H
25 #include <config.h>
26 #endif
27
28 #include "netdissect-stdinc.h"
29
30 #include "netdissect.h"
31 #include "ethertype.h"
32 #include "addrtoname.h"
33 #include "extract.h"
34
35 /*
36 * Format of (Ethertyped or not) DSA tagged frames:
37 *
38 * 7 6 5 4 3 2 1 0
39 * . . . . . . . . .
40 * 0 +---+---+---+---+---+---+---+---+
41 * | Ether Destination Address |
42 * +6 +---+---+---+---+---+---+---+---+
43 * | Ether Source Address |
44 * +6 +---+---+---+---+---+---+---+---+ +-
45 * | Prog. DSA Ether Type [15:8] | | (8-byte) EDSA Tag
46 * +1 +---+---+---+---+---+---+---+---+ | Contains a programmable Ether type,
47 * | Prog. DSA Ether Type [7:0] | | two reserved bytes (always 0),
48 * +1 +---+---+---+---+---+---+---+---+ | and a standard DSA tag.
49 * | Reserved (0x00 0x00) | |
50 * +2 +---+---+---+---+---+---+---+---+ | +-
51 * | Mode |b29| Src/Trg Dev | | | (4-byte) DSA Tag
52 * +1 +---+---+---+---+---+---+---+---+ | | Contains a DSA tag mode,
53 * |Src/Trg Port/Trunk |b18|b17|b16| | | source or target switch device,
54 * +1 +---+---+---+---+---+---+---+---+ | | source or target port or trunk,
55 * | PRI [2:0] |b12| VID [11:8] | | | and misc (IEEE and FPri) bits.
56 * +1 +---+---+---+---+---+---+---+---+ | |
57 * | VID [7:0] | | |
58 * +1 +---+---+---+---+---+---+---+---+ +- +-
59 * | Ether Length/Type |
60 * +2 +---+---+---+---+---+---+---+---+
61 * . . . . . . . . .
62 *
63 * Mode: Forward, To_CPU, From_CPU, To_Sniffer
64 * b29: (Source or Target) IEEE Tag Mode
65 * b18: Forward's Src_Is_Trunk, To_CPU's Code[2], To_Sniffer's Rx_Sniff
66 * b17: To_CPU's Code[1]
67 * b16: Original frame's CFI
68 * b12: To_CPU's Code[0]
69 */
70
71 #define TOK(tag, byte, mask, shift) ((((const u_char *) tag)[byte] & (mask)) >> (shift))
72
73 #define DSA_LEN 4
74 #define DSA_MODE(tag) TOK(tag, 0, 0xc0, 6)
75 #define DSA_MODE_TO_CPU 0x0
76 #define DSA_MODE_FROM_CPU 0x1
77 #define DSA_MODE_TO_SNIFFER 0x2
78 #define DSA_MODE_FORWARD 0x3
79 #define DSA_TAGGED(tag) TOK(tag, 0, 0x20, 5)
80 #define DSA_DEV(tag) TOK(tag, 0, 0x1f, 0)
81 #define DSA_PORT(tag) TOK(tag, 1, 0xf8, 3)
82 #define DSA_TRUNK(tag) TOK(tag, 1, 0x04, 2)
83 #define DSA_RX_SNIFF(tag) TOK(tag, 1, 0x04, 2)
84 #define DSA_CFI(tag) TOK(tag, 1, 0x01, 0)
85 #define DSA_PRI(tag) TOK(tag, 2, 0xe0, 5)
86 #define DSA_VID(tag) ((u_short)((TOK(tag, 2, 0xe0, 5) << 8) | (TOK(tag, 3, 0xff, 0))))
87 #define DSA_CODE(tag) ((TOK(tag, 1, 0x06, 1) << 1) | TOK(tag, 2, 0x10, 4))
88
89 #define EDSA_LEN 8
90 #define EDSA_ETYPE(tag) ((u_short)((TOK(tag, 0, 0xff, 0) << 8) | (TOK(tag, 1, 0xff, 0))))
91
92 static const struct tok dsa_mode_values[] = {
93 { DSA_MODE_TO_CPU, "To CPU" },
94 { DSA_MODE_FROM_CPU, "From CPU" },
95 { DSA_MODE_TO_SNIFFER, "To Sniffer"},
96 { DSA_MODE_FORWARD, "Forward" },
97 { 0, NULL }
98 };
99
100 static const struct tok dsa_code_values[] = {
101 { 0x0, "BPDU (MGMT) Trap" },
102 { 0x1, "Frame2Reg" },
103 { 0x2, "IGMP/MLD Trap" },
104 { 0x3, "Policy Trap" },
105 { 0x4, "ARP Mirror" },
106 { 0x5, "Policy Mirror" },
107 { 0, NULL }
108 };
109
110 static u_int
111 dsa_if_print_full(netdissect_options *ndo, const struct pcap_pkthdr *h,
112 const u_char *p, u_int taglen)
113 {
114 const u_char *edsa, *dsa;
115 int eflag, ret;
116
117 if (h->caplen < 12 + taglen) {
118 nd_print_trunc(ndo);
119 return (h->caplen);
120 }
121
122 if (h->len < 12 + taglen) {
123 nd_print_trunc(ndo);
124 return (h->len);
125 }
126
127 if (taglen == EDSA_LEN) {
128 edsa = p + 12;
129 dsa = edsa + 4;
130 } else {
131 edsa = NULL;
132 dsa = p + 12;
133 }
134
135 if (ndo->ndo_eflag) {
136 ND_PRINT("%s > %s, ",
137 etheraddr_string(ndo, p + 6),
138 etheraddr_string(ndo, p));
139
140 if (edsa) {
141 ND_PRINT("Marvell EDSA ethertype 0x%04x (%s), ", EDSA_ETYPE(edsa),
142 tok2str(ethertype_values, "unregistered", EDSA_ETYPE(edsa)));
143 ND_PRINT("rsvd %u %u, ", edsa[2], edsa[3]);
144 } else {
145 ND_PRINT("Marvell DSA ");
146 }
147
148 ND_PRINT("mode %s, ", tok2str(dsa_mode_values, "unknown", DSA_MODE(dsa)));
149
150 switch (DSA_MODE(dsa)) {
151 case DSA_MODE_FORWARD:
152 ND_PRINT("dev %u, %s %u, ", DSA_DEV(dsa),
153 DSA_TRUNK(dsa) ? "trunk" : "port", DSA_PORT(dsa));
154 break;
155 case DSA_MODE_FROM_CPU:
156 ND_PRINT("target dev %u, port %u, ",
157 DSA_DEV(dsa), DSA_PORT(dsa));
158 break;
159 case DSA_MODE_TO_CPU:
160 ND_PRINT("source dev %u, port %u, ",
161 DSA_DEV(dsa), DSA_PORT(dsa));
162 ND_PRINT("code %s, ",
163 tok2str(dsa_code_values, "reserved", DSA_CODE(dsa)));
164 break;
165 case DSA_MODE_TO_SNIFFER:
166 ND_PRINT("source dev %u, port %u, ",
167 DSA_DEV(dsa), DSA_PORT(dsa));
168 ND_PRINT("%s sniff, ",
169 DSA_RX_SNIFF(dsa) ? "ingress" : "egress");
170 break;
171 default:
172 break;
173 }
174
175 ND_PRINT("%s, ", DSA_TAGGED(dsa) ? "tagged" : "untagged");
176 ND_PRINT("%s", DSA_CFI(dsa) ? "CFI, " : "");
177 ND_PRINT("VID %u, ", DSA_VID(dsa));
178 ND_PRINT("FPri %u, ", DSA_PRI(dsa));
179 } else {
180 if (edsa) {
181 ND_PRINT("EDSA 0x%04x, ", EDSA_ETYPE(edsa));
182 } else {
183 ND_PRINT("DSA ");
184 }
185
186 switch (DSA_MODE(dsa)) {
187 case DSA_MODE_FORWARD:
188 ND_PRINT("Forward %s %u.%u, ",
189 DSA_TRUNK(dsa) ? "trunk" : "port",
190 DSA_DEV(dsa), DSA_PORT(dsa));
191 break;
192 case DSA_MODE_FROM_CPU:
193 ND_PRINT("CPU > port %u.%u, ",
194 DSA_DEV(dsa), DSA_PORT(dsa));
195 break;
196 case DSA_MODE_TO_CPU:
197 ND_PRINT("port %u.%u > CPU, ",
198 DSA_DEV(dsa), DSA_PORT(dsa));
199 break;
200 case DSA_MODE_TO_SNIFFER:
201 ND_PRINT("port %u.%u > %s Sniffer, ",
202 DSA_DEV(dsa), DSA_PORT(dsa),
203 DSA_RX_SNIFF(dsa) ? "Rx" : "Tx");
204 break;
205 default:
206 break;
207 }
208
209 ND_PRINT("VLAN %u%c, ", DSA_VID(dsa), DSA_TAGGED(dsa) ? 't' : 'u');
210 }
211
212 eflag = ndo->ndo_eflag;
213 ndo->ndo_eflag = 0;
214 ret = ether_hdr_len_print(ndo, p, h->len, h->caplen, NULL, NULL,
215 12 + taglen + 2);
216 ndo->ndo_eflag = eflag;
217
218 return ret;
219 }
220
221 u_int
222 dsa_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)
223 {
224 ndo->ndo_protocol = "dsa";
225
226 return dsa_if_print_full(ndo, h, p, DSA_LEN);
227 }
228
229 u_int
230 edsa_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)
231 {
232 ndo->ndo_protocol = "edsa";
233
234 return dsa_if_print_full(ndo, h, p, EDSA_LEN);
235 }