diff options
Diffstat (limited to 'print-vqp.c')
| -rw-r--r-- | print-vqp.c | 214 |
1 files changed, 214 insertions, 0 deletions
diff --git a/print-vqp.c b/print-vqp.c new file mode 100644 index 0000000..1b2f6bf --- /dev/null +++ b/print-vqp.c @@ -0,0 +1,214 @@ +/* + * Copyright (c) 1998-2006 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. + * + * Original code by Carles Kishimoto <Carles.Kishimoto@bsc.es> + */ + +/* \summary: Cisco VLAN Query Protocol (VQP) printer */ + +#ifdef HAVE_CONFIG_H +#include <config.h> +#endif + +#include "netdissect-stdinc.h" + +#define ND_LONGJMP_FROM_TCHECK +#include "netdissect.h" +#include "extract.h" +#include "addrtoname.h" + +#define VQP_VERSION 1 + +/* + * VQP common header + * + * 0 1 2 3 + * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 + * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + * | Constant | Packet type | Error Code | nitems | + * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + * | Packet Sequence Number (4 bytes) | + * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ + */ + +struct vqp_common_header_t { + nd_uint8_t version; + nd_uint8_t msg_type; + nd_uint8_t error_code; + nd_uint8_t nitems; + nd_uint32_t sequence; +}; + +struct vqp_obj_tlv_t { + nd_uint32_t obj_type; + nd_uint16_t obj_length; +}; + +#define VQP_OBJ_REQ_JOIN_PORT 0x01 +#define VQP_OBJ_RESP_VLAN 0x02 +#define VQP_OBJ_REQ_RECONFIRM 0x03 +#define VQP_OBJ_RESP_RECONFIRM 0x04 + +static const struct tok vqp_msg_type_values[] = { + { VQP_OBJ_REQ_JOIN_PORT, "Request, Join Port"}, + { VQP_OBJ_RESP_VLAN, "Response, VLAN"}, + { VQP_OBJ_REQ_RECONFIRM, "Request, Reconfirm"}, + { VQP_OBJ_RESP_RECONFIRM, "Response, Reconfirm"}, + { 0, NULL} +}; + +static const struct tok vqp_error_code_values[] = { + { 0x00, "No error"}, + { 0x03, "Access denied"}, + { 0x04, "Shutdown port"}, + { 0x05, "Wrong VTP domain"}, + { 0, NULL} +}; + +/* FIXME the heading 0x0c looks ugly - those must be flags etc. */ +#define VQP_OBJ_IP_ADDRESS 0x0c01 +#define VQP_OBJ_PORT_NAME 0x0c02 +#define VQP_OBJ_VLAN_NAME 0x0c03 +#define VQP_OBJ_VTP_DOMAIN 0x0c04 +#define VQP_OBJ_ETHERNET_PKT 0x0c05 +#define VQP_OBJ_MAC_NULL 0x0c06 +#define VQP_OBJ_MAC_ADDRESS 0x0c08 + +static const struct tok vqp_obj_values[] = { + { VQP_OBJ_IP_ADDRESS, "Client IP Address" }, + { VQP_OBJ_PORT_NAME, "Port Name" }, + { VQP_OBJ_VLAN_NAME, "VLAN Name" }, + { VQP_OBJ_VTP_DOMAIN, "VTP Domain" }, + { VQP_OBJ_ETHERNET_PKT, "Ethernet Packet" }, + { VQP_OBJ_MAC_NULL, "MAC Null" }, + { VQP_OBJ_MAC_ADDRESS, "MAC Address" }, + { 0, NULL} +}; + +void +vqp_print(netdissect_options *ndo, const u_char *pptr, u_int len) +{ + const struct vqp_common_header_t *vqp_common_header; + const struct vqp_obj_tlv_t *vqp_obj_tlv; + + const u_char *tptr; + uint8_t version; + uint16_t vqp_obj_len; + uint32_t vqp_obj_type; + u_int tlen; + uint8_t nitems; + + ndo->ndo_protocol = "vqp"; + tptr=pptr; + tlen = len; + vqp_common_header = (const struct vqp_common_header_t *)pptr; + ND_TCHECK_SIZE(vqp_common_header); + if (sizeof(struct vqp_common_header_t) > tlen) + goto invalid; + version = GET_U_1(vqp_common_header->version); + + /* + * Sanity checking of the header. + */ + if (version != VQP_VERSION) { + ND_PRINT("VQP version %u packet not supported", + version); + return; + } + + /* in non-verbose mode just lets print the basic Message Type */ + if (ndo->ndo_vflag < 1) { + ND_PRINT("VQPv%u %s Message, error-code %s (%u), length %u", + version, + tok2str(vqp_msg_type_values, "unknown (%u)",GET_U_1(vqp_common_header->msg_type)), + tok2str(vqp_error_code_values, "unknown", GET_U_1(vqp_common_header->error_code)), + GET_U_1(vqp_common_header->error_code), + len); + return; + } + + /* ok they seem to want to know everything - lets fully decode it */ + nitems = GET_U_1(vqp_common_header->nitems); + ND_PRINT("\n\tVQPv%u, %s Message, error-code %s (%u), seq 0x%08x, items %u, length %u", + version, + tok2str(vqp_msg_type_values, "unknown (%u)",GET_U_1(vqp_common_header->msg_type)), + tok2str(vqp_error_code_values, "unknown", GET_U_1(vqp_common_header->error_code)), + GET_U_1(vqp_common_header->error_code), + GET_BE_U_4(vqp_common_header->sequence), + nitems, + len); + + /* skip VQP Common header */ + tptr+=sizeof(struct vqp_common_header_t); + tlen-=sizeof(struct vqp_common_header_t); + + while (nitems != 0 && tlen != 0) { + + vqp_obj_tlv = (const struct vqp_obj_tlv_t *)tptr; + ND_TCHECK_SIZE(vqp_obj_tlv); + if (sizeof(struct vqp_obj_tlv_t) > tlen) + goto invalid; + vqp_obj_type = GET_BE_U_4(vqp_obj_tlv->obj_type); + vqp_obj_len = GET_BE_U_2(vqp_obj_tlv->obj_length); + tptr+=sizeof(struct vqp_obj_tlv_t); + tlen-=sizeof(struct vqp_obj_tlv_t); + + ND_PRINT("\n\t %s Object (0x%08x), length %u, value: ", + tok2str(vqp_obj_values, "Unknown", vqp_obj_type), + vqp_obj_type, vqp_obj_len); + + /* basic sanity check */ + if (vqp_obj_type == 0 || vqp_obj_len ==0) { + return; + } + + /* did we capture enough for fully decoding the object ? */ + ND_TCHECK_LEN(tptr, vqp_obj_len); + if (vqp_obj_len > tlen) + goto invalid; + + switch(vqp_obj_type) { + case VQP_OBJ_IP_ADDRESS: + if (vqp_obj_len != 4) + goto invalid; + ND_PRINT("%s (0x%08x)", GET_IPADDR_STRING(tptr), + GET_BE_U_4(tptr)); + break; + /* those objects have similar semantics - fall through */ + case VQP_OBJ_PORT_NAME: + case VQP_OBJ_VLAN_NAME: + case VQP_OBJ_VTP_DOMAIN: + case VQP_OBJ_ETHERNET_PKT: + nd_printjnp(ndo, tptr, vqp_obj_len); + break; + /* those objects have similar semantics - fall through */ + case VQP_OBJ_MAC_ADDRESS: + case VQP_OBJ_MAC_NULL: + if (vqp_obj_len != MAC_ADDR_LEN) + goto invalid; + ND_PRINT("%s", GET_ETHERADDR_STRING(tptr)); + break; + default: + if (ndo->ndo_vflag <= 1) + print_unknown_data(ndo,tptr, "\n\t ", vqp_obj_len); + break; + } + tptr += vqp_obj_len; + tlen -= vqp_obj_len; + nitems--; + } + return; +invalid: + nd_print_invalid(ndo); +} |