• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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
lwapp_control_print(const u_char * pptr,u_int len,int has_ap_ident)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
lwapp_data_print(const u_char * pptr,u_int len)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  */
360