/* 	$OpenBSD: print-slow.c,v 1.4 2015/11/16 00:16:39 mmcc 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/time.h>
#include <sys/socket.h>
#include <sys/file.h>
#include <sys/ioctl.h>

#include <net/if.h>

#include <netinet/in.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(const u_char *pptr, 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]");
}