1 /* 2 * Copyright (c) 1998-2007 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 Light Weight Access Point Protocol as per draft-ohara-capwap-lwapp-04 16 * 17 * Original code by Carles Kishimoto <carles.kishimoto@gmail.com> 18 */ 19 20 #include <sys/cdefs.h> 21 #ifndef lint 22 #if 0 23 static const char rcsid[] _U_ = 24 "@(#) Header: /tcpdump/master/tcpdump/print-lwapp.c,v 1.1 2007-07-24 16:07:30 hannes Exp "; 25 #else 26 __RCSID("$NetBSD: print-lwapp.c,v 1.3 2013/04/06 19:33:08 christos Exp $"); 27 #endif 28 #endif 29 30 #ifdef HAVE_CONFIG_H 31 #include "config.h" 32 #endif 33 34 #include <tcpdump-stdinc.h> 35 36 #include <stdio.h> 37 #include <stdlib.h> 38 #include <string.h> 39 40 #include "interface.h" 41 #include "extract.h" 42 #include "addrtoname.h" 43 44 /* 45 * LWAPP transport (common) header 46 * 0 1 2 3 47 * 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 48 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 49 * |VER| RID |C|F|L| Frag ID | Length | 50 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 51 * | Status/WLANs | Payload... | 52 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 53 * 54 */ 55 56 struct lwapp_transport_header { 57 u_int8_t version; 58 u_int8_t frag_id; 59 u_int8_t length[2]; 60 u_int16_t status; 61 }; 62 63 /* 64 * LWAPP control header 65 * 0 1 2 3 66 * 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 67 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 68 * | Message Type | Seq Num | Msg Element Length | 69 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 70 * | Session ID | 71 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 72 * | Msg Element [0..N] | 73 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 74 */ 75 76 struct lwapp_control_header { 77 u_int8_t msg_type; 78 u_int8_t seq_num; 79 u_int8_t len[2]; 80 u_int8_t session_id[4]; 81 }; 82 83 #define LWAPP_VERSION 0 84 #define LWAPP_EXTRACT_VERSION(x) (((x)&0xC0)>>6) 85 #define LWAPP_EXTRACT_RID(x) (((x)&0x38)>>3) 86 #define LWAPP_EXTRACT_CONTROL_BIT(x) (((x)&0x04)>>2) 87 88 static const struct tok lwapp_header_bits_values[] = { 89 { 0x01, "Last Fragment Bit"}, 90 { 0x02, "Fragment Bit"}, 91 { 0x04, "Control Bit"}, 92 { 0, NULL} 93 }; 94 95 #define LWAPP_MSGTYPE_DISCOVERY_REQUEST 1 96 #define LWAPP_MSGTYPE_DISCOVERY_RESPONSE 2 97 #define LWAPP_MSGTYPE_JOIN_REQUEST 3 98 #define LWAPP_MSGTYPE_JOIN_RESPONSE 4 99 #define LWAPP_MSGTYPE_JOIN_ACK 5 100 #define LWAPP_MSGTYPE_JOIN_CONFIRM 6 101 #define LWAPP_MSGTYPE_CONFIGURE_REQUEST 10 102 #define LWAPP_MSGTYPE_CONFIGURE_RESPONSE 11 103 #define LWAPP_MSGTYPE_CONF_UPDATE_REQUEST 12 104 #define LWAPP_MSGTYPE_CONF_UPDATE_RESPONSE 13 105 #define LWAPP_MSGTYPE_WTP_EVENT_REQUEST 14 106 #define LWAPP_MSGTYPE_WTP_EVENT_RESPONSE 15 107 #define LWAPP_MSGTYPE_CHANGE_STATE_EVENT_REQUEST 16 108 #define LWAPP_MSGTYPE_CHANGE_STATE_EVENT_RESPONSE 17 109 #define LWAPP_MSGTYPE_ECHO_REQUEST 22 110 #define LWAPP_MSGTYPE_ECHO_RESPONSE 23 111 #define LWAPP_MSGTYPE_IMAGE_DATA_REQUEST 24 112 #define LWAPP_MSGTYPE_IMAGE_DATA_RESPONSE 25 113 #define LWAPP_MSGTYPE_RESET_REQUEST 26 114 #define LWAPP_MSGTYPE_RESET_RESPONSE 27 115 #define LWAPP_MSGTYPE_KEY_UPDATE_REQUEST 30 116 #define LWAPP_MSGTYPE_KEY_UPDATE_RESPONSE 31 117 #define LWAPP_MSGTYPE_PRIMARY_DISCOVERY_REQUEST 32 118 #define LWAPP_MSGTYPE_PRIMARY_DISCOVERY_RESPONSE 33 119 #define LWAPP_MSGTYPE_DATA_TRANSFER_REQUEST 34 120 #define LWAPP_MSGTYPE_DATA_TRANSFER_RESPONSE 35 121 #define LWAPP_MSGTYPE_CLEAR_CONFIG_INDICATION 36 122 #define LWAPP_MSGTYPE_WLAN_CONFIG_REQUEST 37 123 #define LWAPP_MSGTYPE_WLAN_CONFIG_RESPONSE 38 124 #define LWAPP_MSGTYPE_MOBILE_CONFIG_REQUEST 39 125 #define LWAPP_MSGTYPE_MOBILE_CONFIG_RESPONSE 40 126 127 static const struct tok lwapp_msg_type_values[] = { 128 { LWAPP_MSGTYPE_DISCOVERY_REQUEST, "Discovery req"}, 129 { LWAPP_MSGTYPE_DISCOVERY_RESPONSE, "Discovery resp"}, 130 { LWAPP_MSGTYPE_JOIN_REQUEST, "Join req"}, 131 { LWAPP_MSGTYPE_JOIN_RESPONSE, "Join resp"}, 132 { LWAPP_MSGTYPE_JOIN_ACK, "Join ack"}, 133 { LWAPP_MSGTYPE_JOIN_CONFIRM, "Join confirm"}, 134 { LWAPP_MSGTYPE_CONFIGURE_REQUEST, "Configure req"}, 135 { LWAPP_MSGTYPE_CONFIGURE_RESPONSE, "Configure resp"}, 136 { LWAPP_MSGTYPE_CONF_UPDATE_REQUEST, "Update req"}, 137 { LWAPP_MSGTYPE_CONF_UPDATE_RESPONSE, "Update resp"}, 138 { LWAPP_MSGTYPE_WTP_EVENT_REQUEST, "WTP event req"}, 139 { LWAPP_MSGTYPE_WTP_EVENT_RESPONSE, "WTP event resp"}, 140 { LWAPP_MSGTYPE_CHANGE_STATE_EVENT_REQUEST, "Change state event req"}, 141 { LWAPP_MSGTYPE_CHANGE_STATE_EVENT_RESPONSE, "Change state event resp"}, 142 { LWAPP_MSGTYPE_ECHO_REQUEST, "Echo req"}, 143 { LWAPP_MSGTYPE_ECHO_RESPONSE, "Echo resp"}, 144 { LWAPP_MSGTYPE_IMAGE_DATA_REQUEST, "Image data req"}, 145 { LWAPP_MSGTYPE_IMAGE_DATA_RESPONSE, "Image data resp"}, 146 { LWAPP_MSGTYPE_RESET_REQUEST, "Channel status req"}, 147 { LWAPP_MSGTYPE_RESET_RESPONSE, "Channel status resp"}, 148 { LWAPP_MSGTYPE_KEY_UPDATE_REQUEST, "Key update req"}, 149 { LWAPP_MSGTYPE_KEY_UPDATE_RESPONSE, "Key update resp"}, 150 { LWAPP_MSGTYPE_PRIMARY_DISCOVERY_REQUEST, "Primary discovery req"}, 151 { LWAPP_MSGTYPE_PRIMARY_DISCOVERY_RESPONSE, "Primary discovery resp"}, 152 { LWAPP_MSGTYPE_DATA_TRANSFER_REQUEST, "Data transfer req"}, 153 { LWAPP_MSGTYPE_DATA_TRANSFER_RESPONSE, "Data transfer resp"}, 154 { LWAPP_MSGTYPE_CLEAR_CONFIG_INDICATION, "Clear config ind"}, 155 { LWAPP_MSGTYPE_WLAN_CONFIG_REQUEST, "Wlan config req"}, 156 { LWAPP_MSGTYPE_WLAN_CONFIG_RESPONSE, "Wlan config resp"}, 157 { LWAPP_MSGTYPE_MOBILE_CONFIG_REQUEST, "Mobile config req"}, 158 { LWAPP_MSGTYPE_MOBILE_CONFIG_RESPONSE, "Mobile config resp"}, 159 { 0, NULL} 160 }; 161 162 /* 163 * LWAPP message elements 164 * 165 * 0 1 2 3 166 * 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 167 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 168 * | Type | Length | Value ... | 169 * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 170 */ 171 struct lwapp_message_header { 172 u_int8_t type; 173 u_int8_t length[2]; 174 }; 175 176 void 177 lwapp_control_print(const u_char *pptr, u_int len, int has_ap_ident) { 178 179 const struct lwapp_transport_header *lwapp_trans_header; 180 const struct lwapp_control_header *lwapp_control_header; 181 const u_char *tptr; 182 int tlen; 183 int msg_tlen; 184 185 tptr=pptr; 186 187 if (has_ap_ident) { 188 /* check if enough bytes for AP identity */ 189 if (!TTEST2(*tptr, 6)) 190 goto trunc; 191 lwapp_trans_header = (const struct lwapp_transport_header *)(pptr+6); 192 } else { 193 lwapp_trans_header = (const struct lwapp_transport_header *)pptr; 194 } 195 TCHECK(*lwapp_trans_header); 196 197 /* 198 * Sanity checking of the header. 199 */ 200 if (LWAPP_EXTRACT_VERSION(lwapp_trans_header->version) != LWAPP_VERSION) { 201 printf("LWAPP version %u packet not supported", 202 LWAPP_EXTRACT_VERSION(lwapp_trans_header->version)); 203 return; 204 } 205 206 /* non-verbose */ 207 if (vflag < 1) { 208 printf("LWAPPv%u, %s frame, Flags [%s], length %u", 209 LWAPP_EXTRACT_VERSION(lwapp_trans_header->version), 210 LWAPP_EXTRACT_CONTROL_BIT(lwapp_trans_header->version) ? "Control" : "Data", 211 bittok2str(lwapp_header_bits_values,"none",(lwapp_trans_header->version)&0x07), 212 len); 213 return; 214 } 215 216 /* ok they seem to want to know everything - lets fully decode it */ 217 tlen=EXTRACT_16BITS(lwapp_trans_header->length); 218 219 printf("LWAPPv%u, %s frame, Radio-id %u, Flags [%s], Frag-id %u, length %u", 220 LWAPP_EXTRACT_VERSION(lwapp_trans_header->version), 221 LWAPP_EXTRACT_CONTROL_BIT(lwapp_trans_header->version) ? "Control" : "Data", 222 LWAPP_EXTRACT_RID(lwapp_trans_header->version), 223 bittok2str(lwapp_header_bits_values,"none",(lwapp_trans_header->version)&0x07), 224 lwapp_trans_header->frag_id, 225 tlen); 226 227 if (has_ap_ident) { 228 printf("\n\tAP identity: %s", 229 etheraddr_string(tptr)); 230 tptr+=sizeof(const struct lwapp_transport_header)+6; 231 } else { 232 tptr+=sizeof(const struct lwapp_transport_header); 233 } 234 235 while(tlen>0) { 236 237 /* did we capture enough for fully decoding the object header ? */ 238 if (!TTEST2(*tptr, sizeof(struct lwapp_control_header))) 239 goto trunc; 240 241 lwapp_control_header = (const struct lwapp_control_header *)tptr; 242 msg_tlen = EXTRACT_16BITS(lwapp_control_header->len); 243 244 /* print message header */ 245 printf("\n\t Msg type: %s (%u), Seqnum: %u, Msg len: %d, Session: 0x%08x", 246 tok2str(lwapp_msg_type_values,"Unknown",lwapp_control_header->msg_type), 247 lwapp_control_header->msg_type, 248 lwapp_control_header->seq_num, 249 msg_tlen, 250 EXTRACT_32BITS(lwapp_control_header->session_id)); 251 252 /* did we capture enough for fully decoding the message */ 253 if (!TTEST2(*tptr, msg_tlen)) 254 goto trunc; 255 256 /* XXX - Decode sub messages for each message */ 257 switch(lwapp_control_header->msg_type) { 258 case LWAPP_MSGTYPE_DISCOVERY_REQUEST: 259 case LWAPP_MSGTYPE_DISCOVERY_RESPONSE: 260 case LWAPP_MSGTYPE_JOIN_REQUEST: 261 case LWAPP_MSGTYPE_JOIN_RESPONSE: 262 case LWAPP_MSGTYPE_JOIN_ACK: 263 case LWAPP_MSGTYPE_JOIN_CONFIRM: 264 case LWAPP_MSGTYPE_CONFIGURE_REQUEST: 265 case LWAPP_MSGTYPE_CONFIGURE_RESPONSE: 266 case LWAPP_MSGTYPE_CONF_UPDATE_REQUEST: 267 case LWAPP_MSGTYPE_CONF_UPDATE_RESPONSE: 268 case LWAPP_MSGTYPE_WTP_EVENT_REQUEST: 269 case LWAPP_MSGTYPE_WTP_EVENT_RESPONSE: 270 case LWAPP_MSGTYPE_CHANGE_STATE_EVENT_REQUEST: 271 case LWAPP_MSGTYPE_CHANGE_STATE_EVENT_RESPONSE: 272 case LWAPP_MSGTYPE_ECHO_REQUEST: 273 case LWAPP_MSGTYPE_ECHO_RESPONSE: 274 case LWAPP_MSGTYPE_IMAGE_DATA_REQUEST: 275 case LWAPP_MSGTYPE_IMAGE_DATA_RESPONSE: 276 case LWAPP_MSGTYPE_RESET_REQUEST: 277 case LWAPP_MSGTYPE_RESET_RESPONSE: 278 case LWAPP_MSGTYPE_KEY_UPDATE_REQUEST: 279 case LWAPP_MSGTYPE_KEY_UPDATE_RESPONSE: 280 case LWAPP_MSGTYPE_PRIMARY_DISCOVERY_REQUEST: 281 case LWAPP_MSGTYPE_PRIMARY_DISCOVERY_RESPONSE: 282 case LWAPP_MSGTYPE_DATA_TRANSFER_REQUEST: 283 case LWAPP_MSGTYPE_DATA_TRANSFER_RESPONSE: 284 case LWAPP_MSGTYPE_CLEAR_CONFIG_INDICATION: 285 case LWAPP_MSGTYPE_WLAN_CONFIG_REQUEST: 286 case LWAPP_MSGTYPE_WLAN_CONFIG_RESPONSE: 287 case LWAPP_MSGTYPE_MOBILE_CONFIG_REQUEST: 288 case LWAPP_MSGTYPE_MOBILE_CONFIG_RESPONSE: 289 default: 290 break; 291 } 292 293 tptr += sizeof(struct lwapp_control_header) + msg_tlen; 294 tlen -= sizeof(struct lwapp_control_header) + msg_tlen; 295 } 296 return; 297 298 trunc: 299 printf("\n\t\t packet exceeded snapshot"); 300 } 301 302 void 303 lwapp_data_print(const u_char *pptr, u_int len) { 304 305 const struct lwapp_transport_header *lwapp_trans_header; 306 const u_char *tptr; 307 int tlen; 308 309 tptr=pptr; 310 311 /* check if enough bytes for AP identity */ 312 if (!TTEST2(*tptr, 6)) 313 goto trunc; 314 lwapp_trans_header = (const struct lwapp_transport_header *)pptr; 315 TCHECK(*lwapp_trans_header); 316 317 /* 318 * Sanity checking of the header. 319 */ 320 if (LWAPP_EXTRACT_VERSION(lwapp_trans_header->version) != LWAPP_VERSION) { 321 printf("LWAPP version %u packet not supported", 322 LWAPP_EXTRACT_VERSION(lwapp_trans_header->version)); 323 return; 324 } 325 326 /* non-verbose */ 327 if (vflag < 1) { 328 printf("LWAPPv%u, %s frame, Flags [%s], length %u", 329 LWAPP_EXTRACT_VERSION(lwapp_trans_header->version), 330 LWAPP_EXTRACT_CONTROL_BIT(lwapp_trans_header->version) ? "Control" : "Data", 331 bittok2str(lwapp_header_bits_values,"none",(lwapp_trans_header->version)&0x07), 332 len); 333 return; 334 } 335 336 /* ok they seem to want to know everything - lets fully decode it */ 337 tlen=EXTRACT_16BITS(lwapp_trans_header->length); 338 339 printf("LWAPPv%u, %s frame, Radio-id %u, Flags [%s], Frag-id %u, length %u", 340 LWAPP_EXTRACT_VERSION(lwapp_trans_header->version), 341 LWAPP_EXTRACT_CONTROL_BIT(lwapp_trans_header->version) ? "Control" : "Data", 342 LWAPP_EXTRACT_RID(lwapp_trans_header->version), 343 bittok2str(lwapp_header_bits_values,"none",(lwapp_trans_header->version)&0x07), 344 lwapp_trans_header->frag_id, 345 tlen); 346 347 tptr+=sizeof(const struct lwapp_transport_header); 348 tlen-=sizeof(const struct lwapp_transport_header); 349 350 /* FIX - An IEEE 802.11 frame follows - hexdump for now */ 351 print_unknown_data(tptr, "\n\t", tlen); 352 353 return; 354 355 trunc: 356 printf("\n\t\t packet exceeded snapshot"); 357 } 358 359 /* 360 * Local Variables: 361 * c-style: whitesmith 362 * c-basic-offset: 8 363 * End: 364 */ 365