contrib/tcpdump/print-lwapp.c

   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  */