xref: /minix3/external/bsd/tcpdump/dist/print-stp.c (revision b636d99d91c3d54204248f643c14627405d4afd1)
1*b636d99dSDavid van Moolenbroek /*
2*b636d99dSDavid van Moolenbroek  * Copyright (c) 2000 Lennert Buytenhek
3*b636d99dSDavid van Moolenbroek  *
4*b636d99dSDavid van Moolenbroek  * This software may be distributed either under the terms of the
5*b636d99dSDavid van Moolenbroek  * BSD-style license that accompanies tcpdump or the GNU General
6*b636d99dSDavid van Moolenbroek  * Public License
7*b636d99dSDavid van Moolenbroek  *
8*b636d99dSDavid van Moolenbroek  * Format and print IEEE 802.1d spanning tree protocol packets.
9*b636d99dSDavid van Moolenbroek  * Contributed by Lennert Buytenhek <buytenh@gnu.org>
10*b636d99dSDavid van Moolenbroek  */
11*b636d99dSDavid van Moolenbroek 
12*b636d99dSDavid van Moolenbroek #include <sys/cdefs.h>
13*b636d99dSDavid van Moolenbroek #ifndef lint
14*b636d99dSDavid van Moolenbroek __RCSID("$NetBSD: print-stp.c,v 1.5 2014/11/20 03:05:03 christos Exp $");
15*b636d99dSDavid van Moolenbroek #endif
16*b636d99dSDavid van Moolenbroek 
17*b636d99dSDavid van Moolenbroek #define NETDISSECT_REWORKED
18*b636d99dSDavid van Moolenbroek #ifdef HAVE_CONFIG_H
19*b636d99dSDavid van Moolenbroek #include "config.h"
20*b636d99dSDavid van Moolenbroek #endif
21*b636d99dSDavid van Moolenbroek 
22*b636d99dSDavid van Moolenbroek #include <tcpdump-stdinc.h>
23*b636d99dSDavid van Moolenbroek 
24*b636d99dSDavid van Moolenbroek #include <stdio.h>
25*b636d99dSDavid van Moolenbroek 
26*b636d99dSDavid van Moolenbroek #include "interface.h"
27*b636d99dSDavid van Moolenbroek #include "extract.h"
28*b636d99dSDavid van Moolenbroek 
29*b636d99dSDavid van Moolenbroek #define	RSTP_EXTRACT_PORT_ROLE(x) (((x)&0x0C)>>2)
30*b636d99dSDavid van Moolenbroek /* STP timers are expressed in multiples of 1/256th second */
31*b636d99dSDavid van Moolenbroek #define STP_TIME_BASE 256
32*b636d99dSDavid van Moolenbroek #define STP_BPDU_MSTP_MIN_LEN 102
33*b636d99dSDavid van Moolenbroek 
34*b636d99dSDavid van Moolenbroek struct stp_bpdu_ {
35*b636d99dSDavid van Moolenbroek     uint8_t protocol_id[2];
36*b636d99dSDavid van Moolenbroek     uint8_t protocol_version;
37*b636d99dSDavid van Moolenbroek     uint8_t bpdu_type;
38*b636d99dSDavid van Moolenbroek     uint8_t flags;
39*b636d99dSDavid van Moolenbroek     uint8_t root_id[8];
40*b636d99dSDavid van Moolenbroek     uint8_t root_path_cost[4];
41*b636d99dSDavid van Moolenbroek     uint8_t bridge_id[8];
42*b636d99dSDavid van Moolenbroek     uint8_t port_id[2];
43*b636d99dSDavid van Moolenbroek     uint8_t message_age[2];
44*b636d99dSDavid van Moolenbroek     uint8_t max_age[2];
45*b636d99dSDavid van Moolenbroek     uint8_t hello_time[2];
46*b636d99dSDavid van Moolenbroek     uint8_t forward_delay[2];
47*b636d99dSDavid van Moolenbroek     uint8_t v1_length;
48*b636d99dSDavid van Moolenbroek };
49*b636d99dSDavid van Moolenbroek 
50*b636d99dSDavid van Moolenbroek #define STP_PROTO_REGULAR 0x00
51*b636d99dSDavid van Moolenbroek #define STP_PROTO_RAPID   0x02
52*b636d99dSDavid van Moolenbroek #define STP_PROTO_MSTP    0x03
53*b636d99dSDavid van Moolenbroek #define STP_PROTO_SPB     0x04
54*b636d99dSDavid van Moolenbroek 
55*b636d99dSDavid van Moolenbroek static const struct tok stp_proto_values[] = {
56*b636d99dSDavid van Moolenbroek     { STP_PROTO_REGULAR, "802.1d" },
57*b636d99dSDavid van Moolenbroek     { STP_PROTO_RAPID, "802.1w" },
58*b636d99dSDavid van Moolenbroek     { STP_PROTO_MSTP, "802.1s" },
59*b636d99dSDavid van Moolenbroek     { STP_PROTO_SPB, "802.1aq" },
60*b636d99dSDavid van Moolenbroek     { 0, NULL}
61*b636d99dSDavid van Moolenbroek };
62*b636d99dSDavid van Moolenbroek 
63*b636d99dSDavid van Moolenbroek #define STP_BPDU_TYPE_CONFIG      0x00
64*b636d99dSDavid van Moolenbroek #define STP_BPDU_TYPE_RSTP        0x02
65*b636d99dSDavid van Moolenbroek #define STP_BPDU_TYPE_TOPO_CHANGE 0x80
66*b636d99dSDavid van Moolenbroek 
67*b636d99dSDavid van Moolenbroek static const struct tok stp_bpdu_flag_values[] = {
68*b636d99dSDavid van Moolenbroek     { 0x01, "Topology change" },
69*b636d99dSDavid van Moolenbroek     { 0x02, "Proposal" },
70*b636d99dSDavid van Moolenbroek     { 0x10, "Learn" },
71*b636d99dSDavid van Moolenbroek     { 0x20, "Forward" },
72*b636d99dSDavid van Moolenbroek     { 0x40, "Agreement" },
73*b636d99dSDavid van Moolenbroek     { 0x80, "Topology change ACK" },
74*b636d99dSDavid van Moolenbroek     { 0, NULL}
75*b636d99dSDavid van Moolenbroek };
76*b636d99dSDavid van Moolenbroek 
77*b636d99dSDavid van Moolenbroek static const struct tok stp_bpdu_type_values[] = {
78*b636d99dSDavid van Moolenbroek     { STP_BPDU_TYPE_CONFIG, "Config" },
79*b636d99dSDavid van Moolenbroek     { STP_BPDU_TYPE_RSTP, "Rapid STP" },
80*b636d99dSDavid van Moolenbroek     { STP_BPDU_TYPE_TOPO_CHANGE, "Topology Change" },
81*b636d99dSDavid van Moolenbroek     { 0, NULL}
82*b636d99dSDavid van Moolenbroek };
83*b636d99dSDavid van Moolenbroek 
84*b636d99dSDavid van Moolenbroek static const struct tok rstp_obj_port_role_values[] = {
85*b636d99dSDavid van Moolenbroek     { 0x00, "Unknown" },
86*b636d99dSDavid van Moolenbroek     { 0x01, "Alternate" },
87*b636d99dSDavid van Moolenbroek     { 0x02, "Root" },
88*b636d99dSDavid van Moolenbroek     { 0x03, "Designated" },
89*b636d99dSDavid van Moolenbroek     { 0, NULL}
90*b636d99dSDavid van Moolenbroek };
91*b636d99dSDavid van Moolenbroek 
92*b636d99dSDavid van Moolenbroek static char *
stp_print_bridge_id(const u_char * p)93*b636d99dSDavid van Moolenbroek stp_print_bridge_id(const u_char *p)
94*b636d99dSDavid van Moolenbroek {
95*b636d99dSDavid van Moolenbroek     static char bridge_id_str[sizeof("pppp.aa:bb:cc:dd:ee:ff")];
96*b636d99dSDavid van Moolenbroek 
97*b636d99dSDavid van Moolenbroek     snprintf(bridge_id_str, sizeof(bridge_id_str),
98*b636d99dSDavid van Moolenbroek              "%.2x%.2x.%.2x:%.2x:%.2x:%.2x:%.2x:%.2x",
99*b636d99dSDavid van Moolenbroek              p[0], p[1], p[2], p[3], p[4], p[5], p[6], p[7]);
100*b636d99dSDavid van Moolenbroek 
101*b636d99dSDavid van Moolenbroek     return bridge_id_str;
102*b636d99dSDavid van Moolenbroek }
103*b636d99dSDavid van Moolenbroek 
104*b636d99dSDavid van Moolenbroek static void
stp_print_config_bpdu(netdissect_options * ndo,const struct stp_bpdu_ * stp_bpdu,u_int length)105*b636d99dSDavid van Moolenbroek stp_print_config_bpdu(netdissect_options *ndo, const struct stp_bpdu_ *stp_bpdu,
106*b636d99dSDavid van Moolenbroek                       u_int length)
107*b636d99dSDavid van Moolenbroek {
108*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, ", Flags [%s]",
109*b636d99dSDavid van Moolenbroek            bittok2str(stp_bpdu_flag_values, "none", stp_bpdu->flags)));
110*b636d99dSDavid van Moolenbroek 
111*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, ", bridge-id %s.%04x, length %u",
112*b636d99dSDavid van Moolenbroek            stp_print_bridge_id((const u_char *)&stp_bpdu->bridge_id),
113*b636d99dSDavid van Moolenbroek            EXTRACT_16BITS(&stp_bpdu->port_id), length));
114*b636d99dSDavid van Moolenbroek 
115*b636d99dSDavid van Moolenbroek     /* in non-verbose mode just print the bridge-id */
116*b636d99dSDavid van Moolenbroek     if (!ndo->ndo_vflag) {
117*b636d99dSDavid van Moolenbroek         return;
118*b636d99dSDavid van Moolenbroek     }
119*b636d99dSDavid van Moolenbroek 
120*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "\n\tmessage-age %.2fs, max-age %.2fs"
121*b636d99dSDavid van Moolenbroek            ", hello-time %.2fs, forwarding-delay %.2fs",
122*b636d99dSDavid van Moolenbroek            (float)EXTRACT_16BITS(&stp_bpdu->message_age) / STP_TIME_BASE,
123*b636d99dSDavid van Moolenbroek            (float)EXTRACT_16BITS(&stp_bpdu->max_age) / STP_TIME_BASE,
124*b636d99dSDavid van Moolenbroek            (float)EXTRACT_16BITS(&stp_bpdu->hello_time) / STP_TIME_BASE,
125*b636d99dSDavid van Moolenbroek            (float)EXTRACT_16BITS(&stp_bpdu->forward_delay) / STP_TIME_BASE));
126*b636d99dSDavid van Moolenbroek 
127*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "\n\troot-id %s, root-pathcost %u",
128*b636d99dSDavid van Moolenbroek            stp_print_bridge_id((const u_char *)&stp_bpdu->root_id),
129*b636d99dSDavid van Moolenbroek            EXTRACT_32BITS(&stp_bpdu->root_path_cost)));
130*b636d99dSDavid van Moolenbroek 
131*b636d99dSDavid van Moolenbroek     /* Port role is only valid for 802.1w */
132*b636d99dSDavid van Moolenbroek     if (stp_bpdu->protocol_version == STP_PROTO_RAPID) {
133*b636d99dSDavid van Moolenbroek         ND_PRINT((ndo, ", port-role %s",
134*b636d99dSDavid van Moolenbroek                tok2str(rstp_obj_port_role_values, "Unknown",
135*b636d99dSDavid van Moolenbroek                        RSTP_EXTRACT_PORT_ROLE(stp_bpdu->flags))));
136*b636d99dSDavid van Moolenbroek     }
137*b636d99dSDavid van Moolenbroek }
138*b636d99dSDavid van Moolenbroek 
139*b636d99dSDavid van Moolenbroek /*
140*b636d99dSDavid van Moolenbroek  * MSTP packet format
141*b636d99dSDavid van Moolenbroek  * Ref. IEEE 802.1Q 2003 Ed. Section 14
142*b636d99dSDavid van Moolenbroek  *
143*b636d99dSDavid van Moolenbroek  * MSTP BPDU
144*b636d99dSDavid van Moolenbroek  *
145*b636d99dSDavid van Moolenbroek  * 2 -  bytes Protocol Id
146*b636d99dSDavid van Moolenbroek  * 1 -  byte  Protocol Ver.
147*b636d99dSDavid van Moolenbroek  * 1 -  byte  BPDU tye
148*b636d99dSDavid van Moolenbroek  * 1 -  byte  Flags
149*b636d99dSDavid van Moolenbroek  * 8 -  bytes CIST Root Identifier
150*b636d99dSDavid van Moolenbroek  * 4 -  bytes CIST External Path Cost
151*b636d99dSDavid van Moolenbroek  * 8 -  bytes CIST Regional Root Identifier
152*b636d99dSDavid van Moolenbroek  * 2 -  bytes CIST Port Identifier
153*b636d99dSDavid van Moolenbroek  * 2 -  bytes Message Age
154*b636d99dSDavid van Moolenbroek  * 2 -  bytes Max age
155*b636d99dSDavid van Moolenbroek  * 2 -  bytes Hello Time
156*b636d99dSDavid van Moolenbroek  * 2 -  bytes Forward delay
157*b636d99dSDavid van Moolenbroek  * 1 -  byte  Version 1 length. Must be 0
158*b636d99dSDavid van Moolenbroek  * 2 -  bytes Version 3 length
159*b636d99dSDavid van Moolenbroek  * 1 -  byte  Config Identifier
160*b636d99dSDavid van Moolenbroek  * 32 - bytes Config Name
161*b636d99dSDavid van Moolenbroek  * 2 -  bytes Revision level
162*b636d99dSDavid van Moolenbroek  * 16 - bytes Config Digest [MD5]
163*b636d99dSDavid van Moolenbroek  * 4 -  bytes CIST Internal Root Path Cost
164*b636d99dSDavid van Moolenbroek  * 8 -  bytes CIST Bridge Identifier
165*b636d99dSDavid van Moolenbroek  * 1 -  byte  CIST Remaining Hops
166*b636d99dSDavid van Moolenbroek  * 16 - bytes MSTI information [Max 64 MSTI, each 16 bytes]
167*b636d99dSDavid van Moolenbroek  *
168*b636d99dSDavid van Moolenbroek  *
169*b636d99dSDavid van Moolenbroek  * SPB BPDU
170*b636d99dSDavid van Moolenbroek  * Ref. IEEE 802.1aq. Section 14
171*b636d99dSDavid van Moolenbroek  *
172*b636d99dSDavid van Moolenbroek  * 2 -  bytes Version 4 length
173*b636d99dSDavid van Moolenbroek  * 1 -  byte  Aux Config Identifier
174*b636d99dSDavid van Moolenbroek  * 32 - bytes Aux Config Name
175*b636d99dSDavid van Moolenbroek  * 2 -  bytes Aux Revision level
176*b636d99dSDavid van Moolenbroek  * 16 - bytes Aux Config Digest [MD5]
177*b636d99dSDavid van Moolenbroek  * 1 -  byte  (1 - 2) Agreement Number
178*b636d99dSDavid van Moolenbroek  *            (3 - 4) Discarded Agreement Number
179*b636d99dSDavid van Moolenbroek  *            (5) Agreement Valid Flag
180*b636d99dSDavid van Moolenbroek  *            (6) Restricted Role Flag
181*b636d99dSDavid van Moolenbroek  *            (7 - 8) Unused sent zero
182*b636d99dSDavid van Moolenbroek  * 1 -  byte Unused
183*b636d99dSDavid van Moolenbroek  * 1 -  byte (1 - 4) Agreement Digest Format Identifier
184*b636d99dSDavid van Moolenbroek  *           (5 - 8) Agreement Digest Format Capabilities
185*b636d99dSDavid van Moolenbroek  * 1 -  byte (1 - 4) Agreement Digest Convention Identifier
186*b636d99dSDavid van Moolenbroek  *           (5 - 8) Agreement Digest Convention Capabilities
187*b636d99dSDavid van Moolenbroek  * 2 -  bytes Agreement Digest Edge Count
188*b636d99dSDavid van Moolenbroek  * 8 -  byte Reserved Set
189*b636d99dSDavid van Moolenbroek  * 20 - bytes Computed Topology Digest
190*b636d99dSDavid van Moolenbroek  *
191*b636d99dSDavid van Moolenbroek  *
192*b636d99dSDavid van Moolenbroek  * MSTI Payload
193*b636d99dSDavid van Moolenbroek  *
194*b636d99dSDavid van Moolenbroek  * 1 - byte  MSTI flag
195*b636d99dSDavid van Moolenbroek  * 8 - bytes MSTI Regional Root Identifier
196*b636d99dSDavid van Moolenbroek  * 4 - bytes MSTI Regional Path Cost
197*b636d99dSDavid van Moolenbroek  * 1 - byte  MSTI Bridge Priority
198*b636d99dSDavid van Moolenbroek  * 1 - byte  MSTI Port Priority
199*b636d99dSDavid van Moolenbroek  * 1 - byte  MSTI Remaining Hops
200*b636d99dSDavid van Moolenbroek  *
201*b636d99dSDavid van Moolenbroek  */
202*b636d99dSDavid van Moolenbroek 
203*b636d99dSDavid van Moolenbroek #define MST_BPDU_MSTI_LENGTH		    16
204*b636d99dSDavid van Moolenbroek #define MST_BPDU_CONFIG_INFO_LENGTH	    64
205*b636d99dSDavid van Moolenbroek 
206*b636d99dSDavid van Moolenbroek /* Offsets of fields from the begginning for the packet */
207*b636d99dSDavid van Moolenbroek #define MST_BPDU_VER3_LEN_OFFSET	    36
208*b636d99dSDavid van Moolenbroek #define MST_BPDU_CONFIG_NAME_OFFSET	    39
209*b636d99dSDavid van Moolenbroek #define MST_BPDU_CONFIG_DIGEST_OFFSET	    73
210*b636d99dSDavid van Moolenbroek #define MST_BPDU_CIST_INT_PATH_COST_OFFSET  89
211*b636d99dSDavid van Moolenbroek #define MST_BPDU_CIST_BRIDGE_ID_OFFSET	    93
212*b636d99dSDavid van Moolenbroek #define MST_BPDU_CIST_REMAIN_HOPS_OFFSET    101
213*b636d99dSDavid van Moolenbroek #define MST_BPDU_MSTI_OFFSET		    102
214*b636d99dSDavid van Moolenbroek /* Offsets within  an MSTI */
215*b636d99dSDavid van Moolenbroek #define MST_BPDU_MSTI_ROOT_PRIO_OFFSET	    1
216*b636d99dSDavid van Moolenbroek #define MST_BPDU_MSTI_ROOT_PATH_COST_OFFSET 9
217*b636d99dSDavid van Moolenbroek #define MST_BPDU_MSTI_BRIDGE_PRIO_OFFSET    13
218*b636d99dSDavid van Moolenbroek #define MST_BPDU_MSTI_PORT_PRIO_OFFSET	    14
219*b636d99dSDavid van Moolenbroek #define MST_BPDU_MSTI_REMAIN_HOPS_OFFSET    15
220*b636d99dSDavid van Moolenbroek 
221*b636d99dSDavid van Moolenbroek #define SPB_BPDU_MIN_LEN                  87
222*b636d99dSDavid van Moolenbroek #define SPB_BPDU_CONFIG_NAME_OFFSET       3
223*b636d99dSDavid van Moolenbroek #define SPB_BPDU_CONFIG_REV_OFFSET        SPB_BPDU_CONFIG_NAME_OFFSET + 32
224*b636d99dSDavid van Moolenbroek #define SPB_BPDU_CONFIG_DIGEST_OFFSET     SPB_BPDU_CONFIG_REV_OFFSET + 2
225*b636d99dSDavid van Moolenbroek #define SPB_BPDU_AGREEMENT_OFFSET         SPB_BPDU_CONFIG_DIGEST_OFFSET + 16
226*b636d99dSDavid van Moolenbroek #define SPB_BPDU_AGREEMENT_UNUSED_OFFSET  SPB_BPDU_AGREEMENT_OFFSET + 1
227*b636d99dSDavid van Moolenbroek #define SPB_BPDU_AGREEMENT_FORMAT_OFFSET  SPB_BPDU_AGREEMENT_UNUSED_OFFSET + 1
228*b636d99dSDavid van Moolenbroek #define SPB_BPDU_AGREEMENT_CON_OFFSET     SPB_BPDU_AGREEMENT_FORMAT_OFFSET + 1
229*b636d99dSDavid van Moolenbroek #define SPB_BPDU_AGREEMENT_EDGE_OFFSET    SPB_BPDU_AGREEMENT_CON_OFFSET + 1
230*b636d99dSDavid van Moolenbroek #define SPB_BPDU_AGREEMENT_RES1_OFFSET    SPB_BPDU_AGREEMENT_EDGE_OFFSET + 2
231*b636d99dSDavid van Moolenbroek #define SPB_BPDU_AGREEMENT_RES2_OFFSET    SPB_BPDU_AGREEMENT_RES1_OFFSET + 4
232*b636d99dSDavid van Moolenbroek #define SPB_BPDU_AGREEMENT_DIGEST_OFFSET  SPB_BPDU_AGREEMENT_RES2_OFFSET + 4
233*b636d99dSDavid van Moolenbroek 
234*b636d99dSDavid van Moolenbroek 
235*b636d99dSDavid van Moolenbroek static void
stp_print_mstp_bpdu(netdissect_options * ndo,const struct stp_bpdu_ * stp_bpdu,u_int length)236*b636d99dSDavid van Moolenbroek stp_print_mstp_bpdu(netdissect_options *ndo, const struct stp_bpdu_ *stp_bpdu,
237*b636d99dSDavid van Moolenbroek                     u_int length)
238*b636d99dSDavid van Moolenbroek {
239*b636d99dSDavid van Moolenbroek     const u_char *ptr;
240*b636d99dSDavid van Moolenbroek     uint16_t	    v3len;
241*b636d99dSDavid van Moolenbroek     uint16_t	    len;
242*b636d99dSDavid van Moolenbroek     uint16_t	    msti;
243*b636d99dSDavid van Moolenbroek     u_int	    offset;
244*b636d99dSDavid van Moolenbroek 
245*b636d99dSDavid van Moolenbroek     ptr = (const u_char *)stp_bpdu;
246*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, ", CIST Flags [%s], length %u",
247*b636d99dSDavid van Moolenbroek            bittok2str(stp_bpdu_flag_values, "none", stp_bpdu->flags), length));
248*b636d99dSDavid van Moolenbroek 
249*b636d99dSDavid van Moolenbroek     /*
250*b636d99dSDavid van Moolenbroek      * in non-verbose mode just print the flags.
251*b636d99dSDavid van Moolenbroek      */
252*b636d99dSDavid van Moolenbroek     if (!ndo->ndo_vflag) {
253*b636d99dSDavid van Moolenbroek         return;
254*b636d99dSDavid van Moolenbroek     }
255*b636d99dSDavid van Moolenbroek 
256*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "\n\tport-role %s, ",
257*b636d99dSDavid van Moolenbroek            tok2str(rstp_obj_port_role_values, "Unknown",
258*b636d99dSDavid van Moolenbroek                    RSTP_EXTRACT_PORT_ROLE(stp_bpdu->flags))));
259*b636d99dSDavid van Moolenbroek 
260*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "CIST root-id %s, CIST ext-pathcost %u ",
261*b636d99dSDavid van Moolenbroek            stp_print_bridge_id((const u_char *)&stp_bpdu->root_id),
262*b636d99dSDavid van Moolenbroek            EXTRACT_32BITS(&stp_bpdu->root_path_cost)));
263*b636d99dSDavid van Moolenbroek 
264*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "\n\tCIST regional-root-id %s, ",
265*b636d99dSDavid van Moolenbroek            stp_print_bridge_id((const u_char *)&stp_bpdu->bridge_id)));
266*b636d99dSDavid van Moolenbroek 
267*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "CIST port-id %04x, ", EXTRACT_16BITS(&stp_bpdu->port_id)));
268*b636d99dSDavid van Moolenbroek 
269*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "\n\tmessage-age %.2fs, max-age %.2fs"
270*b636d99dSDavid van Moolenbroek            ", hello-time %.2fs, forwarding-delay %.2fs",
271*b636d99dSDavid van Moolenbroek            (float)EXTRACT_16BITS(&stp_bpdu->message_age) / STP_TIME_BASE,
272*b636d99dSDavid van Moolenbroek            (float)EXTRACT_16BITS(&stp_bpdu->max_age) / STP_TIME_BASE,
273*b636d99dSDavid van Moolenbroek            (float)EXTRACT_16BITS(&stp_bpdu->hello_time) / STP_TIME_BASE,
274*b636d99dSDavid van Moolenbroek            (float)EXTRACT_16BITS(&stp_bpdu->forward_delay) / STP_TIME_BASE));
275*b636d99dSDavid van Moolenbroek 
276*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "\n\tv3len %d, ", EXTRACT_16BITS(ptr + MST_BPDU_VER3_LEN_OFFSET)));
277*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "MCID Name %s, rev %u, "
278*b636d99dSDavid van Moolenbroek             "\n\t\tdigest %08x%08x%08x%08x, ",
279*b636d99dSDavid van Moolenbroek             ptr + MST_BPDU_CONFIG_NAME_OFFSET,
280*b636d99dSDavid van Moolenbroek 	          EXTRACT_16BITS(ptr + MST_BPDU_CONFIG_NAME_OFFSET + 32),
281*b636d99dSDavid van Moolenbroek       	    EXTRACT_32BITS(ptr + MST_BPDU_CONFIG_DIGEST_OFFSET),
282*b636d99dSDavid van Moolenbroek         	  EXTRACT_32BITS(ptr + MST_BPDU_CONFIG_DIGEST_OFFSET + 4),
283*b636d99dSDavid van Moolenbroek 	          EXTRACT_32BITS(ptr + MST_BPDU_CONFIG_DIGEST_OFFSET + 8),
284*b636d99dSDavid van Moolenbroek 	          EXTRACT_32BITS(ptr + MST_BPDU_CONFIG_DIGEST_OFFSET + 12)));
285*b636d99dSDavid van Moolenbroek 
286*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "CIST int-root-pathcost %u, ",
287*b636d99dSDavid van Moolenbroek             EXTRACT_32BITS(ptr + MST_BPDU_CIST_INT_PATH_COST_OFFSET)));
288*b636d99dSDavid van Moolenbroek 
289*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "\n\tCIST bridge-id %s, ",
290*b636d99dSDavid van Moolenbroek            stp_print_bridge_id(ptr + MST_BPDU_CIST_BRIDGE_ID_OFFSET)));
291*b636d99dSDavid van Moolenbroek 
292*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "CIST remaining-hops %d", ptr[MST_BPDU_CIST_REMAIN_HOPS_OFFSET]));
293*b636d99dSDavid van Moolenbroek 
294*b636d99dSDavid van Moolenbroek     /* Dump all MSTI's */
295*b636d99dSDavid van Moolenbroek     v3len = EXTRACT_16BITS(ptr + MST_BPDU_VER3_LEN_OFFSET);
296*b636d99dSDavid van Moolenbroek     if (v3len > MST_BPDU_CONFIG_INFO_LENGTH) {
297*b636d99dSDavid van Moolenbroek         len = v3len - MST_BPDU_CONFIG_INFO_LENGTH;
298*b636d99dSDavid van Moolenbroek         offset = MST_BPDU_MSTI_OFFSET;
299*b636d99dSDavid van Moolenbroek         while (len >= MST_BPDU_MSTI_LENGTH) {
300*b636d99dSDavid van Moolenbroek             msti = EXTRACT_16BITS(ptr + offset +
301*b636d99dSDavid van Moolenbroek                                   MST_BPDU_MSTI_ROOT_PRIO_OFFSET);
302*b636d99dSDavid van Moolenbroek             msti = msti & 0x0FFF;
303*b636d99dSDavid van Moolenbroek 
304*b636d99dSDavid van Moolenbroek             ND_PRINT((ndo, "\n\tMSTI %d, Flags [%s], port-role %s",
305*b636d99dSDavid van Moolenbroek                    msti, bittok2str(stp_bpdu_flag_values, "none", ptr[offset]),
306*b636d99dSDavid van Moolenbroek                    tok2str(rstp_obj_port_role_values, "Unknown",
307*b636d99dSDavid van Moolenbroek                            RSTP_EXTRACT_PORT_ROLE(ptr[offset]))));
308*b636d99dSDavid van Moolenbroek             ND_PRINT((ndo, "\n\t\tMSTI regional-root-id %s, pathcost %u",
309*b636d99dSDavid van Moolenbroek                    stp_print_bridge_id(ptr + offset +
310*b636d99dSDavid van Moolenbroek                                        MST_BPDU_MSTI_ROOT_PRIO_OFFSET),
311*b636d99dSDavid van Moolenbroek                    EXTRACT_32BITS(ptr + offset +
312*b636d99dSDavid van Moolenbroek                                   MST_BPDU_MSTI_ROOT_PATH_COST_OFFSET)));
313*b636d99dSDavid van Moolenbroek             ND_PRINT((ndo, "\n\t\tMSTI bridge-prio %d, port-prio %d, hops %d",
314*b636d99dSDavid van Moolenbroek                    ptr[offset + MST_BPDU_MSTI_BRIDGE_PRIO_OFFSET] >> 4,
315*b636d99dSDavid van Moolenbroek                    ptr[offset + MST_BPDU_MSTI_PORT_PRIO_OFFSET] >> 4,
316*b636d99dSDavid van Moolenbroek                    ptr[offset + MST_BPDU_MSTI_REMAIN_HOPS_OFFSET]));
317*b636d99dSDavid van Moolenbroek 
318*b636d99dSDavid van Moolenbroek             len -= MST_BPDU_MSTI_LENGTH;
319*b636d99dSDavid van Moolenbroek             offset += MST_BPDU_MSTI_LENGTH;
320*b636d99dSDavid van Moolenbroek         }
321*b636d99dSDavid van Moolenbroek     }
322*b636d99dSDavid van Moolenbroek }
323*b636d99dSDavid van Moolenbroek 
324*b636d99dSDavid van Moolenbroek static void
stp_print_spb_bpdu(netdissect_options * ndo,const struct stp_bpdu_ * stp_bpdu,u_int offset)325*b636d99dSDavid van Moolenbroek stp_print_spb_bpdu(netdissect_options *ndo, const struct stp_bpdu_ *stp_bpdu,
326*b636d99dSDavid van Moolenbroek                    u_int offset)
327*b636d99dSDavid van Moolenbroek {
328*b636d99dSDavid van Moolenbroek     const u_char *ptr;
329*b636d99dSDavid van Moolenbroek 
330*b636d99dSDavid van Moolenbroek     /*
331*b636d99dSDavid van Moolenbroek      * in non-verbose mode don't print anything.
332*b636d99dSDavid van Moolenbroek      */
333*b636d99dSDavid van Moolenbroek     if (!ndo->ndo_vflag) {
334*b636d99dSDavid van Moolenbroek         return;
335*b636d99dSDavid van Moolenbroek     }
336*b636d99dSDavid van Moolenbroek 
337*b636d99dSDavid van Moolenbroek     ptr = (const u_char *)stp_bpdu;
338*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "\n\tv4len %d AUXMCID Name %s, Rev %u, \n\t\tdigest %08x%08x%08x%08x",
339*b636d99dSDavid van Moolenbroek             EXTRACT_16BITS (ptr + offset),
340*b636d99dSDavid van Moolenbroek             ptr + offset + SPB_BPDU_CONFIG_NAME_OFFSET,
341*b636d99dSDavid van Moolenbroek             EXTRACT_16BITS(ptr + offset + SPB_BPDU_CONFIG_REV_OFFSET),
342*b636d99dSDavid van Moolenbroek             EXTRACT_32BITS(ptr + offset + SPB_BPDU_CONFIG_DIGEST_OFFSET),
343*b636d99dSDavid van Moolenbroek             EXTRACT_32BITS(ptr + offset + SPB_BPDU_CONFIG_DIGEST_OFFSET + 4),
344*b636d99dSDavid van Moolenbroek             EXTRACT_32BITS(ptr + offset + SPB_BPDU_CONFIG_DIGEST_OFFSET + 8),
345*b636d99dSDavid van Moolenbroek             EXTRACT_32BITS(ptr + offset + SPB_BPDU_CONFIG_DIGEST_OFFSET + 12)));
346*b636d99dSDavid van Moolenbroek 
347*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "\n\tAgreement num %d, Discarded Agreement num %d, Agreement valid-"
348*b636d99dSDavid van Moolenbroek             "flag %d, \n\tRestricted role-flag: %d, Format id %d cap %d, "
349*b636d99dSDavid van Moolenbroek             "Convention id %d cap %d, \n\tEdge count %d, "
350*b636d99dSDavid van Moolenbroek             "Agreement digest %08x%08x%08x%08x%08x\n",
351*b636d99dSDavid van Moolenbroek             ptr[offset + SPB_BPDU_AGREEMENT_OFFSET]>>6,
352*b636d99dSDavid van Moolenbroek             ptr[offset + SPB_BPDU_AGREEMENT_OFFSET]>>4 & 0x3,
353*b636d99dSDavid van Moolenbroek             ptr[offset + SPB_BPDU_AGREEMENT_OFFSET]>>3 & 0x1,
354*b636d99dSDavid van Moolenbroek             ptr[offset + SPB_BPDU_AGREEMENT_OFFSET]>>2 & 0x1,
355*b636d99dSDavid van Moolenbroek             ptr[offset + SPB_BPDU_AGREEMENT_FORMAT_OFFSET]>>4,
356*b636d99dSDavid van Moolenbroek             ptr[offset + SPB_BPDU_AGREEMENT_FORMAT_OFFSET]&0x00ff,
357*b636d99dSDavid van Moolenbroek             ptr[offset + SPB_BPDU_AGREEMENT_CON_OFFSET]>>4,
358*b636d99dSDavid van Moolenbroek             ptr[offset + SPB_BPDU_AGREEMENT_CON_OFFSET]&0x00ff,
359*b636d99dSDavid van Moolenbroek             EXTRACT_16BITS(ptr + offset + SPB_BPDU_AGREEMENT_EDGE_OFFSET),
360*b636d99dSDavid van Moolenbroek             EXTRACT_32BITS(ptr + offset + SPB_BPDU_AGREEMENT_DIGEST_OFFSET),
361*b636d99dSDavid van Moolenbroek             EXTRACT_32BITS(ptr + offset + SPB_BPDU_AGREEMENT_DIGEST_OFFSET)+4,
362*b636d99dSDavid van Moolenbroek             EXTRACT_32BITS(ptr + offset + SPB_BPDU_AGREEMENT_DIGEST_OFFSET)+8,
363*b636d99dSDavid van Moolenbroek             EXTRACT_32BITS(ptr + offset + SPB_BPDU_AGREEMENT_DIGEST_OFFSET)+12,
364*b636d99dSDavid van Moolenbroek             EXTRACT_32BITS(ptr + offset + SPB_BPDU_AGREEMENT_DIGEST_OFFSET)+16));
365*b636d99dSDavid van Moolenbroek }
366*b636d99dSDavid van Moolenbroek 
367*b636d99dSDavid van Moolenbroek /*
368*b636d99dSDavid van Moolenbroek  * Print 802.1d / 802.1w / 802.1q (mstp) / 802.1aq (spb) packets.
369*b636d99dSDavid van Moolenbroek  */
370*b636d99dSDavid van Moolenbroek void
stp_print(netdissect_options * ndo,const u_char * p,u_int length)371*b636d99dSDavid van Moolenbroek stp_print(netdissect_options *ndo, const u_char *p, u_int length)
372*b636d99dSDavid van Moolenbroek {
373*b636d99dSDavid van Moolenbroek     const struct stp_bpdu_ *stp_bpdu;
374*b636d99dSDavid van Moolenbroek     u_int                  mstp_len;
375*b636d99dSDavid van Moolenbroek     u_int                  spb_len;
376*b636d99dSDavid van Moolenbroek 
377*b636d99dSDavid van Moolenbroek     stp_bpdu = (struct stp_bpdu_*)p;
378*b636d99dSDavid van Moolenbroek 
379*b636d99dSDavid van Moolenbroek     /* Minimum STP Frame size. */
380*b636d99dSDavid van Moolenbroek     if (length < 4)
381*b636d99dSDavid van Moolenbroek         goto trunc;
382*b636d99dSDavid van Moolenbroek 
383*b636d99dSDavid van Moolenbroek     if (EXTRACT_16BITS(&stp_bpdu->protocol_id)) {
384*b636d99dSDavid van Moolenbroek         ND_PRINT((ndo, "unknown STP version, length %u", length));
385*b636d99dSDavid van Moolenbroek         return;
386*b636d99dSDavid van Moolenbroek     }
387*b636d99dSDavid van Moolenbroek 
388*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "STP %s", tok2str(stp_proto_values, "Unknown STP protocol (0x%02x)",
389*b636d99dSDavid van Moolenbroek                          stp_bpdu->protocol_version)));
390*b636d99dSDavid van Moolenbroek 
391*b636d99dSDavid van Moolenbroek     switch (stp_bpdu->protocol_version) {
392*b636d99dSDavid van Moolenbroek     case STP_PROTO_REGULAR:
393*b636d99dSDavid van Moolenbroek     case STP_PROTO_RAPID:
394*b636d99dSDavid van Moolenbroek     case STP_PROTO_MSTP:
395*b636d99dSDavid van Moolenbroek     case STP_PROTO_SPB:
396*b636d99dSDavid van Moolenbroek         break;
397*b636d99dSDavid van Moolenbroek     default:
398*b636d99dSDavid van Moolenbroek         return;
399*b636d99dSDavid van Moolenbroek     }
400*b636d99dSDavid van Moolenbroek 
401*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, ", %s", tok2str(stp_bpdu_type_values, "Unknown BPDU Type (0x%02x)",
402*b636d99dSDavid van Moolenbroek                            stp_bpdu->bpdu_type)));
403*b636d99dSDavid van Moolenbroek 
404*b636d99dSDavid van Moolenbroek     switch (stp_bpdu->bpdu_type) {
405*b636d99dSDavid van Moolenbroek     case STP_BPDU_TYPE_CONFIG:
406*b636d99dSDavid van Moolenbroek         if (length < sizeof(struct stp_bpdu_) - 1) {
407*b636d99dSDavid van Moolenbroek             goto trunc;
408*b636d99dSDavid van Moolenbroek         }
409*b636d99dSDavid van Moolenbroek         stp_print_config_bpdu(ndo, stp_bpdu, length);
410*b636d99dSDavid van Moolenbroek         break;
411*b636d99dSDavid van Moolenbroek 
412*b636d99dSDavid van Moolenbroek     case STP_BPDU_TYPE_RSTP:
413*b636d99dSDavid van Moolenbroek         if (stp_bpdu->protocol_version == STP_PROTO_RAPID) {
414*b636d99dSDavid van Moolenbroek             if (length < sizeof(struct stp_bpdu_)) {
415*b636d99dSDavid van Moolenbroek                 goto trunc;
416*b636d99dSDavid van Moolenbroek             }
417*b636d99dSDavid van Moolenbroek             stp_print_config_bpdu(ndo, stp_bpdu, length);
418*b636d99dSDavid van Moolenbroek         } else if (stp_bpdu->protocol_version == STP_PROTO_MSTP ||
419*b636d99dSDavid van Moolenbroek                    stp_bpdu->protocol_version == STP_PROTO_SPB) {
420*b636d99dSDavid van Moolenbroek             if (length < STP_BPDU_MSTP_MIN_LEN) {
421*b636d99dSDavid van Moolenbroek                 goto trunc;
422*b636d99dSDavid van Moolenbroek             }
423*b636d99dSDavid van Moolenbroek 
424*b636d99dSDavid van Moolenbroek             if (stp_bpdu->v1_length != 0) {
425*b636d99dSDavid van Moolenbroek                 /* FIX ME: Emit a message here ? */
426*b636d99dSDavid van Moolenbroek                 goto trunc;
427*b636d99dSDavid van Moolenbroek             }
428*b636d99dSDavid van Moolenbroek 
429*b636d99dSDavid van Moolenbroek             /* Validate v3 length */
430*b636d99dSDavid van Moolenbroek             mstp_len = EXTRACT_16BITS(p + MST_BPDU_VER3_LEN_OFFSET);
431*b636d99dSDavid van Moolenbroek             mstp_len += 2;  /* length encoding itself is 2 bytes */
432*b636d99dSDavid van Moolenbroek             if (length < (sizeof(struct stp_bpdu_) + mstp_len)) {
433*b636d99dSDavid van Moolenbroek                 goto trunc;
434*b636d99dSDavid van Moolenbroek             }
435*b636d99dSDavid van Moolenbroek             stp_print_mstp_bpdu(ndo, stp_bpdu, length);
436*b636d99dSDavid van Moolenbroek 
437*b636d99dSDavid van Moolenbroek             if (stp_bpdu->protocol_version == STP_PROTO_SPB)
438*b636d99dSDavid van Moolenbroek             {
439*b636d99dSDavid van Moolenbroek               /* Validate v4 length */
440*b636d99dSDavid van Moolenbroek               spb_len = EXTRACT_16BITS (p + MST_BPDU_VER3_LEN_OFFSET + mstp_len);
441*b636d99dSDavid van Moolenbroek               spb_len += 2;
442*b636d99dSDavid van Moolenbroek               if (length < (sizeof(struct stp_bpdu_) + mstp_len + spb_len) ||
443*b636d99dSDavid van Moolenbroek                   spb_len < SPB_BPDU_MIN_LEN) {
444*b636d99dSDavid van Moolenbroek                 goto trunc;
445*b636d99dSDavid van Moolenbroek               }
446*b636d99dSDavid van Moolenbroek               stp_print_spb_bpdu(ndo, stp_bpdu, (sizeof(struct stp_bpdu_) + mstp_len));
447*b636d99dSDavid van Moolenbroek             }
448*b636d99dSDavid van Moolenbroek         }
449*b636d99dSDavid van Moolenbroek         break;
450*b636d99dSDavid van Moolenbroek 
451*b636d99dSDavid van Moolenbroek     case STP_BPDU_TYPE_TOPO_CHANGE:
452*b636d99dSDavid van Moolenbroek         /* always empty message - just break out */
453*b636d99dSDavid van Moolenbroek         break;
454*b636d99dSDavid van Moolenbroek 
455*b636d99dSDavid van Moolenbroek     default:
456*b636d99dSDavid van Moolenbroek         break;
457*b636d99dSDavid van Moolenbroek     }
458*b636d99dSDavid van Moolenbroek 
459*b636d99dSDavid van Moolenbroek     return;
460*b636d99dSDavid van Moolenbroek  trunc:
461*b636d99dSDavid van Moolenbroek     ND_PRINT((ndo, "[|stp %d]", length));
462*b636d99dSDavid van Moolenbroek }
463*b636d99dSDavid van Moolenbroek 
464*b636d99dSDavid van Moolenbroek /*
465*b636d99dSDavid van Moolenbroek  * Local Variables:
466*b636d99dSDavid van Moolenbroek  * c-style: whitesmith
467*b636d99dSDavid van Moolenbroek  * c-basic-offset: 4
468*b636d99dSDavid van Moolenbroek  * End:
469*b636d99dSDavid van Moolenbroek  */
470