external/bsd/tcpdump/dist/print-vqp.c

   1 /*
   2  * Copyright (c) 1998-2006 The TCPDUMP project
   3  *
   4  * Redistribution and use in source and binary forms, with or without
   5  * modification, are permitted provided that: (1) source code
   6  * distributions retain the above copyright notice and this paragraph
   7  * in its entirety, and (2) distributions including binary code include
   8  * the above copyright notice and this paragraph in its entirety in
   9  * the documentation or other materials provided with the distribution.
  10  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND
  11  * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT
  12  * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
  13  * FOR A PARTICULAR PURPOSE.
  14  *
  15  * support for the Cisco prop. VQP Protocol
  16  *
  17  * Original code by Carles Kishimoto <Carles.Kishimoto@bsc.es>
  18  */
  19
  20 #include <sys/cdefs.h>
  21 #ifndef lint
  22 __RCSID("$NetBSD: print-vqp.c,v 1.4 2014/11/20 03:05:03 christos Exp $");
  23 #endif
  24
  25 #define NETDISSECT_REWORKED
  26 #ifdef HAVE_CONFIG_H
  27 #include "config.h"
  28 #endif
  29
  30 #include <tcpdump-stdinc.h>
  31
  32 #include "interface.h"
  33 #include "extract.h"
  34 #include "addrtoname.h"
  35
  36 #define VQP_VERSION                     1
  37 #define VQP_EXTRACT_VERSION(x) ((x)&0xFF)
  38
  39 /*
  40  * VQP common header
  41  *
  42  *  0                   1                   2                   3
  43  *  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
  44  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
  45  * |   Constant    | Packet type   |  Error Code   |    nitems     |
  46  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
  47  * |                Packet Sequence Number (4 bytes)               |
  48  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
  49  */
  50
  51 struct vqp_common_header_t {
  52     uint8_t version;
  53     uint8_t msg_type;
  54     uint8_t error_code;
  55     uint8_t nitems;
  56     uint8_t sequence[4];
  57 };
  58
  59 struct vqp_obj_tlv_t {
  60     uint8_t obj_type[4];
  61     uint8_t obj_length[2];
  62 };
  63
  64 #define VQP_OBJ_REQ_JOIN_PORT  0x01
  65 #define VQP_OBJ_RESP_VLAN      0x02
  66 #define VQP_OBJ_REQ_RECONFIRM  0x03
  67 #define VQP_OBJ_RESP_RECONFIRM 0x04
  68
  69 static const struct tok vqp_msg_type_values[] = {
  70     { VQP_OBJ_REQ_JOIN_PORT, "Request, Join Port"},
  71     { VQP_OBJ_RESP_VLAN, "Response, VLAN"},
  72     { VQP_OBJ_REQ_RECONFIRM, "Request, Reconfirm"},
  73     { VQP_OBJ_RESP_RECONFIRM, "Response, Reconfirm"},
  74     { 0, NULL}
  75 };
  76
  77 static const struct tok vqp_error_code_values[] = {
  78     { 0x00, "No error"},
  79     { 0x03, "Access denied"},
  80     { 0x04, "Shutdown port"},
  81     { 0x05, "Wrong VTP domain"},
  82     { 0, NULL}
  83 };
  84
  85 /* FIXME the heading 0x0c looks ugly - those must be flags etc. */
  86 #define VQP_OBJ_IP_ADDRESS    0x0c01
  87 #define VQP_OBJ_PORT_NAME     0x0c02
  88 #define VQP_OBJ_VLAN_NAME     0x0c03
  89 #define VQP_OBJ_VTP_DOMAIN    0x0c04
  90 #define VQP_OBJ_ETHERNET_PKT  0x0c05
  91 #define VQP_OBJ_MAC_NULL      0x0c06
  92 #define VQP_OBJ_MAC_ADDRESS   0x0c08
  93
  94 static const struct tok vqp_obj_values[] = {
  95     { VQP_OBJ_IP_ADDRESS, "Client IP Address" },
  96     { VQP_OBJ_PORT_NAME, "Port Name" },
  97     { VQP_OBJ_VLAN_NAME, "VLAN Name" },
  98     { VQP_OBJ_VTP_DOMAIN, "VTP Domain" },
  99     { VQP_OBJ_ETHERNET_PKT, "Ethernet Packet" },
 100     { VQP_OBJ_MAC_NULL, "MAC Null" },
 101     { VQP_OBJ_MAC_ADDRESS, "MAC Address" },
 102     { 0, NULL}
 103 };
 104
 105 void
 106 vqp_print(netdissect_options *ndo, register const u_char *pptr, register u_int len)
 107 {
 108     const struct vqp_common_header_t *vqp_common_header;
 109     const struct vqp_obj_tlv_t *vqp_obj_tlv;
 110
 111     const u_char *tptr;
 112     uint16_t vqp_obj_len;
 113     uint32_t vqp_obj_type;
 114     int tlen;
 115     uint8_t nitems;
 116
 117     tptr=pptr;
 118     tlen = len;
 119     vqp_common_header = (const struct vqp_common_header_t *)pptr;
 120     ND_TCHECK(*vqp_common_header);
 121
 122     /*
 123      * Sanity checking of the header.
 124      */
 125     if (VQP_EXTRACT_VERSION(vqp_common_header->version) != VQP_VERSION) {
 126         ND_PRINT((ndo, "VQP version %u packet not supported",
 127                VQP_EXTRACT_VERSION(vqp_common_header->version)));
 128         return;
 129     }
 130
 131     /* in non-verbose mode just lets print the basic Message Type */
 132     if (ndo->ndo_vflag < 1) {
 133         ND_PRINT((ndo, "VQPv%u %s Message, error-code %s (%u), length %u",
 134                VQP_EXTRACT_VERSION(vqp_common_header->version),
 135                tok2str(vqp_msg_type_values, "unknown (%u)",vqp_common_header->msg_type),
 136                tok2str(vqp_error_code_values, "unknown (%u)",vqp_common_header->error_code),
 137                vqp_common_header->error_code,
 138                len));
 139         return;
 140     }
 141
 142     /* ok they seem to want to know everything - lets fully decode it */
 143     nitems = vqp_common_header->nitems;
 144     ND_PRINT((ndo, "\n\tVQPv%u, %s Message, error-code %s (%u), seq 0x%08x, items %u, length %u",
 145            VQP_EXTRACT_VERSION(vqp_common_header->version),
 146            tok2str(vqp_msg_type_values, "unknown (%u)",vqp_common_header->msg_type),
 147            tok2str(vqp_error_code_values, "unknown (%u)",vqp_common_header->error_code),
 148            vqp_common_header->error_code,
 149            EXTRACT_32BITS(&vqp_common_header->sequence),
 150            nitems,
 151            len));
 152
 153     /* skip VQP Common header */
 154     tptr+=sizeof(const struct vqp_common_header_t);
 155     tlen-=sizeof(const struct vqp_common_header_t);
 156
 157     while (nitems > 0 && tlen > 0) {
 158
 159         vqp_obj_tlv = (const struct vqp_obj_tlv_t *)tptr;
 160         vqp_obj_type = EXTRACT_32BITS(vqp_obj_tlv->obj_type);
 161         vqp_obj_len = EXTRACT_16BITS(vqp_obj_tlv->obj_length);
 162         tptr+=sizeof(struct vqp_obj_tlv_t);
 163         tlen-=sizeof(struct vqp_obj_tlv_t);
 164
 165         ND_PRINT((ndo, "\n\t  %s Object (0x%08x), length %u, value: ",
 166                tok2str(vqp_obj_values, "Unknown", vqp_obj_type),
 167                vqp_obj_type, vqp_obj_len));
 168
 169         /* basic sanity check */
 170         if (vqp_obj_type == 0 || vqp_obj_len ==0) {
 171             return;
 172         }
 173
 174         /* did we capture enough for fully decoding the object ? */
 175         ND_TCHECK2(*tptr, vqp_obj_len);
 176
 177         switch(vqp_obj_type) {
 178         case VQP_OBJ_IP_ADDRESS:
 179             ND_PRINT((ndo, "%s (0x%08x)", ipaddr_string(ndo, tptr), EXTRACT_32BITS(tptr)));
 180             break;
 181             /* those objects have similar semantics - fall through */
 182         case VQP_OBJ_PORT_NAME:
 183         case VQP_OBJ_VLAN_NAME:
 184         case VQP_OBJ_VTP_DOMAIN:
 185         case VQP_OBJ_ETHERNET_PKT:
 186             safeputs(ndo, tptr, vqp_obj_len);
 187             break;
 188             /* those objects have similar semantics - fall through */
 189         case VQP_OBJ_MAC_ADDRESS:
 190         case VQP_OBJ_MAC_NULL:
 191               ND_PRINT((ndo, "%s", etheraddr_string(ndo, tptr)));
 192               break;
 193         default:
 194             if (ndo->ndo_vflag <= 1)
 195                 print_unknown_data(ndo,tptr, "\n\t    ", vqp_obj_len);
 196             break;
 197         }
 198         tptr += vqp_obj_len;
 199         tlen -= vqp_obj_len;
 200         nitems--;
 201     }
 202     return;
 203 trunc:
 204     ND_PRINT((ndo, "\n\t[|VQP]"));
 205 }