OpenBSD-4.6/usr.sbin/tcpdump/print-slow.c
/* $OpenBSD: print-slow.c,v 1.1 2008/10/16 12:57:01 mpf Exp $ */
/*
* Copyright (c) 1998-2005 The TCPDUMP project
*
* 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, and (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.
* 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.
*
* support for the IEEE "slow protocols" LACP, MARKER as per 802.3ad
*
* Original code by Hannes Gredler (hannes@juniper.net)
*/
#include <sys/param.h>
#include <sys/time.h>
#include <sys/socket.h>
#include <sys/file.h>
#include <sys/ioctl.h>
#include <net/if.h>
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <netinet/ip.h>
#include <netinet/if_ether.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include "interface.h"
#include "extract.h"
#include "addrtoname.h"
struct slow_common_header {
u_int8_t proto_subtype;
u_int8_t version;
};
#define SLOW_PROTO_LACP 1
#define SLOW_PROTO_MARKER 2
#define LACP_VERSION 1
#define MARKER_VERSION 1
static const struct tok slow_proto_values[] = {
{ SLOW_PROTO_LACP, "LACP" },
{ SLOW_PROTO_MARKER, "MARKER" },
{ 0, NULL}
};
struct tlv_header_t {
u_int8_t type;
u_int8_t length;
};
#define LACP_TLV_TERMINATOR 0x00
#define LACP_TLV_ACTOR_INFO 0x01
#define LACP_TLV_PARTNER_INFO 0x02
#define LACP_TLV_COLLECTOR_INFO 0x03
#define MARKER_TLV_TERMINATOR 0x00
#define MARKER_TLV_MARKER_INFO 0x01
#define MARKER_TLV_MARKER_RESP 0x02
static const struct tok slow_tlv_values[] = {
{ (SLOW_PROTO_LACP << 8) + LACP_TLV_TERMINATOR, "Terminator"},
{ (SLOW_PROTO_LACP << 8) + LACP_TLV_ACTOR_INFO, "Actor Information"},
{ (SLOW_PROTO_LACP << 8) + LACP_TLV_PARTNER_INFO,
"Partner Information"},
{ (SLOW_PROTO_LACP << 8) + LACP_TLV_COLLECTOR_INFO,
"Collector Information"},
{ (SLOW_PROTO_MARKER << 8) + MARKER_TLV_TERMINATOR, "Terminator"},
{ (SLOW_PROTO_MARKER << 8) + MARKER_TLV_MARKER_INFO,
"Marker Information"},
{ (SLOW_PROTO_MARKER << 8) + MARKER_TLV_MARKER_RESP,
"Marker Response Information"},
{ 0, NULL}
};
struct lacp_tlv_actor_partner_info_t {
u_int8_t sys_pri[2];
u_int8_t sys[ETHER_ADDR_LEN];
u_int8_t key[2];
u_int8_t port_pri[2];
u_int8_t port[2];
u_int8_t state;
u_int8_t pad[3];
};
#define ACTOR_PARTNER_BITS \
"\020\1Activity\2Timeout\3Aggregation\4Synchronization\5Collecting\
\6Distributing\7Default\10Expired"
struct lacp_tlv_collector_info_t {
u_int8_t max_delay[2];
u_int8_t pad[12];
};
struct marker_tlv_marker_info_t {
u_int8_t req_port[2];
u_int8_t req_sys[ETHER_ADDR_LEN];
u_int8_t req_trans_id[4];
u_int8_t pad[2];
};
struct lacp_marker_tlv_terminator_t {
u_int8_t pad[50];
};
void
slow_print(register const u_char *pptr, register u_int len)
{
const struct slow_common_header *slow_com_header;
const struct tlv_header_t *tlv_header;
const u_char *tptr, *tlv_tptr;
u_int tlv_len, tlen, tlv_tlen;
union {
struct lacp_marker_tlv_terminator_t *marker_terminator;
struct lacp_tlv_actor_partner_info_t *actor_partner_info;
struct lacp_tlv_collector_info_t *collector_info;
struct marker_tlv_marker_info_t *marker_tlv_marker_info;
} tlv_ptr;
tptr = pptr;
slow_com_header = (const struct slow_common_header *)pptr;
TCHECK(*slow_com_header);
/*
* Sanity checking of the header.
*/
if (slow_com_header->proto_subtype == SLOW_PROTO_LACP &&
slow_com_header->version != LACP_VERSION) {
printf("LACP version %u packet not supported",
slow_com_header->version);
return;
}
if (slow_com_header->proto_subtype == SLOW_PROTO_MARKER &&
slow_com_header->version != MARKER_VERSION) {
printf("MARKER version %u packet not supported",
slow_com_header->version);
return;
}
printf("%sv%u, length: %u",
tok2str(slow_proto_values, "unknown (%u)",
slow_com_header->proto_subtype), slow_com_header->version, len);
if (!vflag)
return;
/* ok they seem to want to know everything - lets fully decode it */
tlen = len - sizeof(struct slow_common_header);
tptr += sizeof(const struct slow_common_header);
while (tlen > 0) {
/* did we capture enough for fully decoding the tlv header ? */
TCHECK2(*tptr, sizeof(struct tlv_header_t));
tlv_header = (const struct tlv_header_t *)tptr;
tlv_len = tlv_header->length;
/* End of message */
if (tlv_header->type == LACP_TLV_TERMINATOR ||
tlv_header->type == MARKER_TLV_TERMINATOR)
return;
printf("\n\t%s TLV (0x%02x), length: %u",
tok2str(slow_tlv_values, "Unknown",
(slow_com_header->proto_subtype << 8) + tlv_header->type),
tlv_header->type, tlv_len);
if (tlv_len < sizeof(struct tlv_header_t) || tlv_len > tlen) {
printf("\n\tInvalid TLV length: %u", tlv_len);
return;
}
tlv_tptr = tptr + sizeof(struct tlv_header_t);
tlv_tlen = tlv_len - sizeof(struct tlv_header_t);
/* did we capture enough for fully decoding the tlv ? */
TCHECK2(*tptr, tlv_len);
switch((slow_com_header->proto_subtype << 8) +
tlv_header->type) {
/* those two TLVs have the same structure -> fall through */
case ((SLOW_PROTO_LACP << 8) + LACP_TLV_ACTOR_INFO):
case ((SLOW_PROTO_LACP << 8) + LACP_TLV_PARTNER_INFO):
tlv_ptr.actor_partner_info =
(struct lacp_tlv_actor_partner_info_t *)tlv_tptr;
if (tlv_tlen != sizeof(*tlv_ptr.actor_partner_info)) {
printf("\n\tInvalid partner/actor info length %u",
tlv_tlen);
break;
}
printf("\n\t System %s, System Priority %u, Key %u"
", Port %u, Port Priority %u\n\t ",
etheraddr_string(tlv_ptr.actor_partner_info->sys),
EXTRACT_16BITS(tlv_ptr.actor_partner_info->sys_pri),
EXTRACT_16BITS(tlv_ptr.actor_partner_info->key),
EXTRACT_16BITS(tlv_ptr.actor_partner_info->port),
EXTRACT_16BITS(tlv_ptr.actor_partner_info->
port_pri));
printb("State", tlv_ptr.actor_partner_info->state,
ACTOR_PARTNER_BITS);
break;
case ((SLOW_PROTO_LACP << 8) + LACP_TLV_COLLECTOR_INFO):
tlv_ptr.collector_info =
(struct lacp_tlv_collector_info_t *)tlv_tptr;
if (tlv_tlen != sizeof(*tlv_ptr.collector_info)) {
printf("\n\tInvalid collector info length %u",
tlv_tlen);
break;
}
printf("\n\t Max Delay %u",
EXTRACT_16BITS(tlv_ptr.collector_info->max_delay));
break;
case ((SLOW_PROTO_MARKER << 8) + MARKER_TLV_MARKER_INFO):
case ((SLOW_PROTO_MARKER << 8) + MARKER_TLV_MARKER_RESP):
tlv_ptr.marker_tlv_marker_info =
(struct marker_tlv_marker_info_t *)tlv_tptr;
if (tlv_tlen !=
sizeof(*tlv_ptr.marker_tlv_marker_info)) {
printf("\n\tInvalid marker info/resp length %u",
tlv_tlen);
break;
}
printf("\n\t Request System %s, Request Port %u,"
" Request Transaction ID 0x%08x",
etheraddr_string(tlv_ptr.marker_tlv_marker_info->
req_sys),
EXTRACT_16BITS(tlv_ptr.marker_tlv_marker_info->
req_port),
EXTRACT_32BITS(tlv_ptr.marker_tlv_marker_info->
req_trans_id));
break;
default:
if (vflag > 1)
printf("\n\t Unknown TLV type: 0x%x \n",
(slow_com_header->proto_subtype << 8) +
tlv_header->type);
break;
}
tptr += tlv_len;
tlen -= tlv_len;
}
return;
trunc:
printf("\n\t[|slow]");
}