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 (at) 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 } 210