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