JP Abgrall | 53f17a9 | 2014-02-12 14:02:41 -0800 | [diff] [blame] | 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 | #ifndef lint |
| 21 | static const char rcsid[] _U_ = |
| 22 | "@(#) $Header: /tcpdump/master/tcpdump/print-vqp.c,v 1.3 2006-08-19 06:51:13 guy Exp $"; |
| 23 | #endif |
| 24 | |
| 25 | #ifdef HAVE_CONFIG_H |
| 26 | #include "config.h" |
| 27 | #endif |
| 28 | |
| 29 | #include <tcpdump-stdinc.h> |
| 30 | |
| 31 | #include <stdio.h> |
| 32 | #include <stdlib.h> |
| 33 | #include <string.h> |
| 34 | |
| 35 | #include "interface.h" |
| 36 | #include "extract.h" |
| 37 | #include "addrtoname.h" |
| 38 | |
| 39 | #define VQP_VERSION 1 |
| 40 | #define VQP_EXTRACT_VERSION(x) ((x)&0xFF) |
| 41 | |
| 42 | /* |
| 43 | * VQP common header |
| 44 | * |
| 45 | * 0 1 2 3 |
| 46 | * 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 |
| 47 | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ |
| 48 | * | Constant | Packet type | Error Code | nitems | |
| 49 | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ |
| 50 | * | Packet Sequence Number (4 bytes) | |
| 51 | * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ |
| 52 | */ |
| 53 | |
| 54 | struct vqp_common_header_t { |
| 55 | u_int8_t version; |
| 56 | u_int8_t msg_type; |
| 57 | u_int8_t error_code; |
| 58 | u_int8_t nitems; |
| 59 | u_int8_t sequence[4]; |
| 60 | }; |
| 61 | |
| 62 | struct vqp_obj_tlv_t { |
| 63 | u_int8_t obj_type[4]; |
| 64 | u_int8_t obj_length[2]; |
| 65 | }; |
| 66 | |
| 67 | #define VQP_OBJ_REQ_JOIN_PORT 0x01 |
| 68 | #define VQP_OBJ_RESP_VLAN 0x02 |
| 69 | #define VQP_OBJ_REQ_RECONFIRM 0x03 |
| 70 | #define VQP_OBJ_RESP_RECONFIRM 0x04 |
| 71 | |
| 72 | static const struct tok vqp_msg_type_values[] = { |
| 73 | { VQP_OBJ_REQ_JOIN_PORT, "Request, Join Port"}, |
| 74 | { VQP_OBJ_RESP_VLAN, "Response, VLAN"}, |
| 75 | { VQP_OBJ_REQ_RECONFIRM, "Request, Reconfirm"}, |
| 76 | { VQP_OBJ_RESP_RECONFIRM, "Response, Reconfirm"}, |
| 77 | { 0, NULL} |
| 78 | }; |
| 79 | |
| 80 | static const struct tok vqp_error_code_values[] = { |
| 81 | { 0x00, "No error"}, |
| 82 | { 0x03, "Access denied"}, |
| 83 | { 0x04, "Shutdown port"}, |
| 84 | { 0x05, "Wrong VTP domain"}, |
| 85 | { 0, NULL} |
| 86 | }; |
| 87 | |
| 88 | /* FIXME the heading 0x0c looks ugly - those must be flags etc. */ |
| 89 | #define VQP_OBJ_IP_ADDRESS 0x0c01 |
| 90 | #define VQP_OBJ_PORT_NAME 0x0c02 |
| 91 | #define VQP_OBJ_VLAN_NAME 0x0c03 |
| 92 | #define VQP_OBJ_VTP_DOMAIN 0x0c04 |
| 93 | #define VQP_OBJ_ETHERNET_PKT 0x0c05 |
| 94 | #define VQP_OBJ_MAC_NULL 0x0c06 |
| 95 | #define VQP_OBJ_MAC_ADDRESS 0x0c08 |
| 96 | |
| 97 | static const struct tok vqp_obj_values[] = { |
| 98 | { VQP_OBJ_IP_ADDRESS, "Client IP Address" }, |
| 99 | { VQP_OBJ_PORT_NAME, "Port Name" }, |
| 100 | { VQP_OBJ_VLAN_NAME, "VLAN Name" }, |
| 101 | { VQP_OBJ_VTP_DOMAIN, "VTP Domain" }, |
| 102 | { VQP_OBJ_ETHERNET_PKT, "Ethernet Packet" }, |
| 103 | { VQP_OBJ_MAC_NULL, "MAC Null" }, |
| 104 | { VQP_OBJ_MAC_ADDRESS, "MAC Address" }, |
| 105 | { 0, NULL} |
| 106 | }; |
| 107 | |
| 108 | void |
| 109 | vqp_print(register const u_char *pptr, register u_int len) |
| 110 | { |
| 111 | const struct vqp_common_header_t *vqp_common_header; |
| 112 | const struct vqp_obj_tlv_t *vqp_obj_tlv; |
| 113 | |
| 114 | const u_char *tptr; |
| 115 | u_int16_t vqp_obj_len; |
| 116 | u_int32_t vqp_obj_type; |
| 117 | int tlen; |
| 118 | u_int8_t nitems; |
| 119 | |
| 120 | tptr=pptr; |
| 121 | tlen = len; |
| 122 | vqp_common_header = (const struct vqp_common_header_t *)pptr; |
| 123 | TCHECK(*vqp_common_header); |
| 124 | |
| 125 | /* |
| 126 | * Sanity checking of the header. |
| 127 | */ |
| 128 | if (VQP_EXTRACT_VERSION(vqp_common_header->version) != VQP_VERSION) { |
| 129 | printf("VQP version %u packet not supported", |
| 130 | VQP_EXTRACT_VERSION(vqp_common_header->version)); |
| 131 | return; |
| 132 | } |
| 133 | |
| 134 | /* in non-verbose mode just lets print the basic Message Type */ |
| 135 | if (vflag < 1) { |
| 136 | printf("VQPv%u %s Message, error-code %s (%u), length %u", |
| 137 | VQP_EXTRACT_VERSION(vqp_common_header->version), |
| 138 | tok2str(vqp_msg_type_values, "unknown (%u)",vqp_common_header->msg_type), |
| 139 | tok2str(vqp_error_code_values, "unknown (%u)",vqp_common_header->error_code), |
| 140 | vqp_common_header->error_code, |
| 141 | len); |
| 142 | return; |
| 143 | } |
| 144 | |
| 145 | /* ok they seem to want to know everything - lets fully decode it */ |
| 146 | nitems = vqp_common_header->nitems; |
| 147 | printf("\n\tVQPv%u, %s Message, error-code %s (%u), seq 0x%08x, items %u, length %u", |
| 148 | VQP_EXTRACT_VERSION(vqp_common_header->version), |
| 149 | tok2str(vqp_msg_type_values, "unknown (%u)",vqp_common_header->msg_type), |
| 150 | tok2str(vqp_error_code_values, "unknown (%u)",vqp_common_header->error_code), |
| 151 | vqp_common_header->error_code, |
| 152 | EXTRACT_32BITS(&vqp_common_header->sequence), |
| 153 | nitems, |
| 154 | len); |
| 155 | |
| 156 | /* skip VQP Common header */ |
| 157 | tptr+=sizeof(const struct vqp_common_header_t); |
| 158 | tlen-=sizeof(const struct vqp_common_header_t); |
| 159 | |
| 160 | while (nitems > 0 && tlen > 0) { |
| 161 | |
| 162 | vqp_obj_tlv = (const struct vqp_obj_tlv_t *)tptr; |
| 163 | vqp_obj_type = EXTRACT_32BITS(vqp_obj_tlv->obj_type); |
| 164 | vqp_obj_len = EXTRACT_16BITS(vqp_obj_tlv->obj_length); |
| 165 | tptr+=sizeof(struct vqp_obj_tlv_t); |
| 166 | tlen-=sizeof(struct vqp_obj_tlv_t); |
| 167 | |
| 168 | printf("\n\t %s Object (0x%08x), length %u, value: ", |
| 169 | tok2str(vqp_obj_values, "Unknown", vqp_obj_type), |
| 170 | vqp_obj_type, vqp_obj_len); |
| 171 | |
| 172 | /* basic sanity check */ |
| 173 | if (vqp_obj_type == 0 || vqp_obj_len ==0) { |
| 174 | return; |
| 175 | } |
| 176 | |
| 177 | /* did we capture enough for fully decoding the object ? */ |
| 178 | if (!TTEST2(*tptr, vqp_obj_len)) |
| 179 | goto trunc; |
| 180 | |
| 181 | switch(vqp_obj_type) { |
| 182 | case VQP_OBJ_IP_ADDRESS: |
| 183 | printf("%s (0x%08x)", ipaddr_string(tptr), EXTRACT_32BITS(tptr)); |
| 184 | break; |
| 185 | /* those objects have similar semantics - fall through */ |
| 186 | case VQP_OBJ_PORT_NAME: |
| 187 | case VQP_OBJ_VLAN_NAME: |
| 188 | case VQP_OBJ_VTP_DOMAIN: |
| 189 | case VQP_OBJ_ETHERNET_PKT: |
| 190 | safeputs((const char *)tptr, vqp_obj_len); |
| 191 | break; |
| 192 | /* those objects have similar semantics - fall through */ |
| 193 | case VQP_OBJ_MAC_ADDRESS: |
| 194 | case VQP_OBJ_MAC_NULL: |
| 195 | printf("%s", etheraddr_string(tptr)); |
| 196 | break; |
| 197 | default: |
| 198 | if (vflag <= 1) |
| 199 | print_unknown_data(tptr, "\n\t ", vqp_obj_len); |
| 200 | break; |
| 201 | } |
| 202 | tptr += vqp_obj_len; |
| 203 | tlen -= vqp_obj_len; |
| 204 | nitems--; |
| 205 | } |
| 206 | return; |
| 207 | trunc: |
| 208 | printf("\n\t[|VQP]"); |
| 209 | } |