freebsd-skq/contrib/tcpdump/print-stp.c

/*
 * Copyright (c) 2000 Lennert Buytenhek
 *
 * This software may be distributed either under the terms of the
 * BSD-style license that accompanies tcpdump or the GNU General
 * Public License
 *
 * Format and print IEEE 802.1d spanning tree protocol packets.
 * Contributed by Lennert Buytenhek <buytenh@gnu.org>
 */

#ifndef lint
static const char rcsid[] _U_ =
    "@(#) $Header: /tcpdump/master/tcpdump/print-stp.c,v 1.13.2.1 2005/04/26 07:27:17 guy Exp $";
#endif

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include <tcpdump-stdinc.h>

#include <stdlib.h>
#include <stdio.h>
#include <string.h>

#include "interface.h"
#include "addrtoname.h"
#include "extract.h"

static void
stp_print_bridge_id(const u_char *p)
{
	printf("%.2x%.2x.%.2x:%.2x:%.2x:%.2x:%.2x:%.2x",
	       p[0], p[1], p[2], p[3], p[4], p[5], p[6], p[7]);
}

static void
stp_print_config_bpdu(const u_char *p)
{
	printf("config ");
	if (p[4] & 1)
		printf("TOP_CHANGE ");
	if (p[4] & 0x80)
		printf("TOP_CHANGE_ACK ");

	stp_print_bridge_id(p+17);
	printf(".%.2x%.2x ", p[25], p[26]);

	printf("root ");
	stp_print_bridge_id(p+5);

	printf(" pathcost %i ", (p[13] << 24) | (p[14] << 16) | (p[15] << 8) | p[16]);

	printf("age %i ", p[27]);
	printf("max %i ", p[29]);
	printf("hello %i ", p[31]);
	printf("fdelay %i ", p[33]);
}

static void
stp_print_tcn_bpdu(void)
{
	printf("tcn");
}

/*
 * Print 802.1d packets.
 */
void
stp_print(const u_char *p, u_int length)
{
	if (length < 4)
		goto trunc;

	printf("802.1d ");
	if (p[0] || p[1] || p[2]) {
		printf("unknown version");
		return;
	}

	switch (p[3])
	{
	case 0x00:
		if (length < 10)
			goto trunc;
		stp_print_config_bpdu(p);
		break;

	case 0x80:
		stp_print_tcn_bpdu();
		break;

	default:
		printf("unknown type %i", p[3]);
		break;
	}

	return;
trunc:
	printf("[|stp %d]", length);
}