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