]> git.ipfire.org Git - thirdparty/iw.git/blame - scan.c
iw: correction in coalesce condition display message
[thirdparty/iw.git] / scan.c
CommitLineData
3563f4c5
JB
1#include <net/if.h>
2#include <errno.h>
3#include <string.h>
4#include <ctype.h>
764fe753 5#include <stdbool.h>
3563f4c5
JB
6
7#include <netlink/genl/genl.h>
8#include <netlink/genl/family.h>
9#include <netlink/genl/ctrl.h>
10#include <netlink/msg.h>
11#include <netlink/attr.h>
12
13#include "nl80211.h"
14#include "iw.h"
15
92a04ecd
MH
16#define WLAN_CAPABILITY_ESS (1<<0)
17#define WLAN_CAPABILITY_IBSS (1<<1)
18#define WLAN_CAPABILITY_CF_POLLABLE (1<<2)
19#define WLAN_CAPABILITY_CF_POLL_REQUEST (1<<3)
20#define WLAN_CAPABILITY_PRIVACY (1<<4)
21#define WLAN_CAPABILITY_SHORT_PREAMBLE (1<<5)
22#define WLAN_CAPABILITY_PBCC (1<<6)
23#define WLAN_CAPABILITY_CHANNEL_AGILITY (1<<7)
24#define WLAN_CAPABILITY_SPECTRUM_MGMT (1<<8)
25#define WLAN_CAPABILITY_QOS (1<<9)
26#define WLAN_CAPABILITY_SHORT_SLOT_TIME (1<<10)
27#define WLAN_CAPABILITY_APSD (1<<11)
2e8b82c1 28#define WLAN_CAPABILITY_RADIO_MEASURE (1<<12)
92a04ecd 29#define WLAN_CAPABILITY_DSSS_OFDM (1<<13)
2e8b82c1
VK
30#define WLAN_CAPABILITY_DEL_BACK (1<<14)
31#define WLAN_CAPABILITY_IMM_BACK (1<<15)
32/* DMG (60gHz) 802.11ad */
33/* type - bits 0..1 */
34#define WLAN_CAPABILITY_DMG_TYPE_MASK (3<<0)
35
36#define WLAN_CAPABILITY_DMG_TYPE_IBSS (1<<0) /* Tx by: STA */
37#define WLAN_CAPABILITY_DMG_TYPE_PBSS (2<<0) /* Tx by: PCP */
38#define WLAN_CAPABILITY_DMG_TYPE_AP (3<<0) /* Tx by: AP */
39
40#define WLAN_CAPABILITY_DMG_CBAP_ONLY (1<<2)
41#define WLAN_CAPABILITY_DMG_CBAP_SOURCE (1<<3)
42#define WLAN_CAPABILITY_DMG_PRIVACY (1<<4)
43#define WLAN_CAPABILITY_DMG_ECPAC (1<<5)
44
45#define WLAN_CAPABILITY_DMG_SPECTRUM_MGMT (1<<8)
46#define WLAN_CAPABILITY_DMG_RADIO_MEASURE (1<<12)
92a04ecd 47
3bd60ef1
JB
48static unsigned char ms_oui[3] = { 0x00, 0x50, 0xf2 };
49static unsigned char ieee80211_oui[3] = { 0x00, 0x0f, 0xac };
9a22374a 50static unsigned char wfa_oui[3] = { 0x50, 0x6f, 0x9a };
857d966e 51
764fe753
JB
52struct scan_params {
53 bool unknown;
febeb0c0 54 enum print_ie_type type;
575280cc 55 bool show_both_ie_sets;
764fe753
JB
56};
57
2b690f0a
LR
58#define IEEE80211_COUNTRY_EXTENSION_ID 201
59
72725719
JB
60union ieee80211_country_ie_triplet {
61 struct {
62 __u8 first_channel;
63 __u8 num_channels;
64 __s8 max_power;
65 } __attribute__ ((packed)) chans;
66 struct {
67 __u8 reg_extension_id;
68 __u8 reg_class;
69 __u8 coverage_class;
70 } __attribute__ ((packed)) ext;
2b690f0a
LR
71} __attribute__ ((packed));
72
7c37a24d
JB
73static int handle_scan(struct nl80211_state *state,
74 struct nl_cb *cb,
3563f4c5 75 struct nl_msg *msg,
05514f95
JB
76 int argc, char **argv,
77 enum id_input id)
3563f4c5 78{
559a1713
JB
79 struct nl_msg *ssids = NULL, *freqs = NULL;
80 char *eptr;
3563f4c5 81 int err = -ENOBUFS;
559a1713
JB
82 int i;
83 enum {
84 NONE,
85 FREQ,
64797a7f 86 IES,
559a1713 87 SSID,
851d35c2 88 MESHID,
559a1713
JB
89 DONE,
90 } parse = NONE;
91 int freq;
92 bool passive = false, have_ssids = false, have_freqs = false;
851d35c2 93 size_t ies_len = 0, meshid_len = 0;
94 unsigned char *ies = NULL, *meshid = NULL, *tmpies;
fe862239 95 int flags = 0;
3563f4c5
JB
96
97 ssids = nlmsg_alloc();
98 if (!ssids)
99 return -ENOMEM;
559a1713
JB
100
101 freqs = nlmsg_alloc();
102 if (!freqs) {
103 nlmsg_free(ssids);
104 return -ENOMEM;
105 }
106
107 for (i = 0; i < argc; i++) {
559a1713
JB
108 switch (parse) {
109 case NONE:
64797a7f
JB
110 if (strcmp(argv[i], "freq") == 0) {
111 parse = FREQ;
112 have_freqs = true;
113 break;
114 } else if (strcmp(argv[i], "ies") == 0) {
115 parse = IES;
116 break;
fe862239
SL
117 } else if (strcmp(argv[i], "lowpri") == 0) {
118 parse = NONE;
119 flags |= NL80211_SCAN_FLAG_LOW_PRIORITY;
120 break;
121 } else if (strcmp(argv[i], "flush") == 0) {
122 parse = NONE;
123 flags |= NL80211_SCAN_FLAG_FLUSH;
124 break;
ced94d5f
AQ
125 } else if (strcmp(argv[i], "ap-force") == 0) {
126 parse = NONE;
127 flags |= NL80211_SCAN_FLAG_AP;
128 break;
64797a7f
JB
129 } else if (strcmp(argv[i], "ssid") == 0) {
130 parse = SSID;
131 have_ssids = true;
132 break;
133 } else if (strcmp(argv[i], "passive") == 0) {
134 parse = DONE;
135 passive = true;
136 break;
851d35c2 137 } else if (strcmp(argv[i], "meshid") == 0) {
138 parse = MESHID;
139 break;
64797a7f 140 }
559a1713
JB
141 case DONE:
142 return 1;
143 case FREQ:
144 freq = strtoul(argv[i], &eptr, 10);
cc12e895
JB
145 if (eptr != argv[i] + strlen(argv[i])) {
146 /* failed to parse as number -- maybe a tag? */
147 i--;
148 parse = NONE;
149 continue;
150 }
559a1713 151 NLA_PUT_U32(freqs, i, freq);
64797a7f
JB
152 break;
153 case IES:
851d35c2 154 ies = parse_hex(argv[i], &ies_len);
64797a7f
JB
155 if (!ies)
156 goto nla_put_failure;
64797a7f 157 parse = NONE;
559a1713
JB
158 break;
159 case SSID:
160 NLA_PUT(ssids, i, strlen(argv[i]), argv[i]);
161 break;
851d35c2 162 case MESHID:
163 meshid_len = strlen(argv[i]);
164 meshid = (unsigned char *) malloc(meshid_len + 2);
165 if (!meshid)
166 goto nla_put_failure;
167 meshid[0] = 114; /* mesh element id */
168 meshid[1] = meshid_len;
169 memcpy(&meshid[2], argv[i], meshid_len);
170 meshid_len += 2;
171 parse = NONE;
172 break;
173 }
174 }
175
176 if (ies || meshid) {
177 tmpies = (unsigned char *) malloc(ies_len + meshid_len);
178 if (!tmpies)
179 goto nla_put_failure;
180 if (ies) {
181 memcpy(tmpies, ies, ies_len);
182 free(ies);
183 }
184 if (meshid) {
185 memcpy(&tmpies[ies_len], meshid, meshid_len);
186 free(meshid);
559a1713 187 }
851d35c2 188 NLA_PUT(msg, NL80211_ATTR_IE, ies_len + meshid_len, tmpies);
189 free(tmpies);
559a1713
JB
190 }
191
192 if (!have_ssids)
193 NLA_PUT(ssids, 1, 0, "");
194 if (!passive)
195 nla_put_nested(msg, NL80211_ATTR_SCAN_SSIDS, ssids);
196
197 if (have_freqs)
198 nla_put_nested(msg, NL80211_ATTR_SCAN_FREQUENCIES, freqs);
fe862239
SL
199 if (flags)
200 NLA_PUT_U32(msg, NL80211_ATTR_SCAN_FLAGS, flags);
3563f4c5
JB
201
202 err = 0;
203 nla_put_failure:
204 nlmsg_free(ssids);
559a1713 205 nlmsg_free(freqs);
3563f4c5
JB
206 return err;
207}
3563f4c5 208
857d966e
MH
209static void tab_on_first(bool *first)
210{
211 if (!*first)
212 printf("\t");
213 else
214 *first = false;
215}
216
83b4934c 217static void print_ssid(const uint8_t type, uint8_t len, const uint8_t *data)
3563f4c5 218{
83b4934c 219 printf(" ");
748f8489 220 print_ssid_escaped(len, data);
3563f4c5
JB
221 printf("\n");
222}
223
ca159934 224#define BSS_MEMBERSHIP_SELECTOR_VHT_PHY 126
1fd19c39
CL
225#define BSS_MEMBERSHIP_SELECTOR_HT_PHY 127
226
83b4934c 227static void print_supprates(const uint8_t type, uint8_t len, const uint8_t *data)
3563f4c5
JB
228{
229 int i;
230
83b4934c 231 printf(" ");
3563f4c5 232
83b4934c 233 for (i = 0; i < len; i++) {
3563f4c5 234 int r = data[i] & 0x7f;
1fd19c39 235
ca159934
JB
236 if (r == BSS_MEMBERSHIP_SELECTOR_VHT_PHY && data[i] & 0x80)
237 printf("VHT");
238 else if (r == BSS_MEMBERSHIP_SELECTOR_HT_PHY && data[i] & 0x80)
1fd19c39
CL
239 printf("HT");
240 else
241 printf("%d.%d", r/2, 5*(r&1));
242
243 printf("%s ", data[i] & 0x80 ? "*" : "");
3563f4c5
JB
244 }
245 printf("\n");
246}
247
83b4934c 248static void print_ds(const uint8_t type, uint8_t len, const uint8_t *data)
3563f4c5 249{
83b4934c 250 printf(" channel %d\n", data[0]);
3563f4c5
JB
251}
252
2b690f0a 253static const char *country_env_str(char environment)
b7e8fa37 254{
2b690f0a 255 switch (environment) {
b7e8fa37 256 case 'I':
2b690f0a 257 return "Indoor only";
b7e8fa37 258 case 'O':
2b690f0a 259 return "Outdoor only";
b6c0d634 260 case ' ':
2b690f0a 261 return "Indoor/Outdoor";
b6c0d634 262 default:
2b690f0a 263 return "bogus";
b7e8fa37 264 }
2b690f0a
LR
265}
266
267static void print_country(const uint8_t type, uint8_t len, const uint8_t *data)
268{
269 printf(" %.*s", 2, data);
270
271 printf("\tEnvironment: %s\n", country_env_str(data[2]));
272
273 data += 3;
274 len -= 3;
275
276 if (len < 3) {
277 printf("\t\tNo country IE triplets present\n");
278 return;
279 }
280
281 while (len >= 3) {
282 int end_channel;
72725719 283 union ieee80211_country_ie_triplet *triplet = (void *) data;
2b690f0a
LR
284
285 if (triplet->ext.reg_extension_id >= IEEE80211_COUNTRY_EXTENSION_ID) {
286 printf("\t\tExtension ID: %d Regulatory Class: %d Coverage class: %d (up to %dm)\n",
287 triplet->ext.reg_extension_id,
288 triplet->ext.reg_class,
289 triplet->ext.coverage_class,
290 triplet->ext.coverage_class * 450);
291
292 data += 3;
293 len -= 3;
294 continue;
295 }
296
297 /* 2 GHz */
298 if (triplet->chans.first_channel <= 14)
299 end_channel = triplet->chans.first_channel + (triplet->chans.num_channels - 1);
300 else
301 end_channel = triplet->chans.first_channel + (4 * (triplet->chans.num_channels - 1));
302
a9859d30 303 printf("\t\tChannels [%d - %d] @ %d dBm\n", triplet->chans.first_channel, end_channel, triplet->chans.max_power);
2b690f0a
LR
304
305 data += 3;
306 len -= 3;
307 }
308
309 return;
b7e8fa37
MH
310}
311
d1563a1b
MH
312static void print_powerconstraint(const uint8_t type, uint8_t len, const uint8_t *data)
313{
314 printf(" %d dB\n", data[0]);
315}
316
792172b0
JM
317static void print_tpcreport(const uint8_t type, uint8_t len, const uint8_t *data)
318{
319 printf(" TX power: %d dBm\n", data[0]);
320 /* printf(" Link Margin (%d dB) is reserved in Beacons\n", data[1]); */
321}
322
83b4934c 323static void print_erp(const uint8_t type, uint8_t len, const uint8_t *data)
fc4d1484
MH
324{
325 if (data[0] == 0x00)
83b4934c 326 printf(" <no flags>");
fc4d1484
MH
327 if (data[0] & 0x01)
328 printf(" NonERP_Present");
329 if (data[0] & 0x02)
330 printf(" Use_Protection");
331 if (data[0] & 0x04)
332 printf(" Barker_Preamble_Mode");
333 printf("\n");
334}
335
83b4934c 336static void print_cipher(const uint8_t *data)
857d966e 337{
3bd60ef1 338 if (memcmp(data, ms_oui, 3) == 0) {
857d966e 339 switch (data[3]) {
510e0e2f 340 case 0:
857d966e
MH
341 printf("Use group cipher suite");
342 break;
510e0e2f 343 case 1:
857d966e
MH
344 printf("WEP-40");
345 break;
510e0e2f 346 case 2:
857d966e
MH
347 printf("TKIP");
348 break;
510e0e2f 349 case 4:
857d966e
MH
350 printf("CCMP");
351 break;
510e0e2f 352 case 5:
857d966e
MH
353 printf("WEP-104");
354 break;
355 default:
332769c6 356 printf("%.02x-%.02x-%.02x:%d",
5594fd23 357 data[0], data[1] ,data[2], data[3]);
857d966e
MH
358 break;
359 }
360 } else if (memcmp(data, ieee80211_oui, 3) == 0) {
361 switch (data[3]) {
510e0e2f 362 case 0:
857d966e
MH
363 printf("Use group cipher suite");
364 break;
510e0e2f 365 case 1:
857d966e
MH
366 printf("WEP-40");
367 break;
510e0e2f 368 case 2:
857d966e
MH
369 printf("TKIP");
370 break;
510e0e2f 371 case 4:
857d966e
MH
372 printf("CCMP");
373 break;
510e0e2f 374 case 5:
857d966e
MH
375 printf("WEP-104");
376 break;
510e0e2f 377 case 6:
857d966e
MH
378 printf("AES-128-CMAC");
379 break;
a8b3da9d
VK
380 case 8:
381 printf("GCMP");
382 break;
857d966e 383 default:
332769c6 384 printf("%.02x-%.02x-%.02x:%d",
5594fd23 385 data[0], data[1] ,data[2], data[3]);
857d966e
MH
386 break;
387 }
388 } else
332769c6 389 printf("%.02x-%.02x-%.02x:%d",
5594fd23 390 data[0], data[1] ,data[2], data[3]);
857d966e
MH
391}
392
83b4934c 393static void print_auth(const uint8_t *data)
857d966e 394{
3bd60ef1 395 if (memcmp(data, ms_oui, 3) == 0) {
857d966e 396 switch (data[3]) {
510e0e2f 397 case 1:
857d966e
MH
398 printf("IEEE 802.1X");
399 break;
510e0e2f 400 case 2:
857d966e
MH
401 printf("PSK");
402 break;
403 default:
332769c6 404 printf("%.02x-%.02x-%.02x:%d",
5594fd23 405 data[0], data[1] ,data[2], data[3]);
857d966e
MH
406 break;
407 }
408 } else if (memcmp(data, ieee80211_oui, 3) == 0) {
409 switch (data[3]) {
510e0e2f 410 case 1:
857d966e
MH
411 printf("IEEE 802.1X");
412 break;
510e0e2f 413 case 2:
857d966e
MH
414 printf("PSK");
415 break;
0fe1c415
JB
416 case 3:
417 printf("FT/IEEE 802.1X");
418 break;
419 case 4:
420 printf("FT/PSK");
421 break;
422 case 5:
423 printf("IEEE 802.1X/SHA-256");
424 break;
425 case 6:
426 printf("PSK/SHA-256");
427 break;
857d966e 428 default:
332769c6 429 printf("%.02x-%.02x-%.02x:%d",
5594fd23 430 data[0], data[1] ,data[2], data[3]);
857d966e
MH
431 break;
432 }
433 } else
332769c6 434 printf("%.02x-%.02x-%.02x:%d",
5594fd23 435 data[0], data[1] ,data[2], data[3]);
857d966e
MH
436}
437
83b4934c
JB
438static void print_rsn_ie(const char *defcipher, const char *defauth,
439 uint8_t len, const uint8_t *data)
857d966e
MH
440{
441 bool first = true;
442 __u16 version, count, capa;
443 int i;
444
857d966e
MH
445 version = data[0] + (data[1] << 8);
446 tab_on_first(&first);
447 printf("\t * Version: %d\n", version);
448
449 data += 2;
450 len -= 2;
451
452 if (len < 4) {
453 tab_on_first(&first);
454 printf("\t * Group cipher: %s\n", defcipher);
455 printf("\t * Pairwise ciphers: %s\n", defcipher);
456 return;
457 }
458
459 tab_on_first(&first);
460 printf("\t * Group cipher: ");
461 print_cipher(data);
462 printf("\n");
463
464 data += 4;
465 len -= 4;
466
467 if (len < 2) {
468 tab_on_first(&first);
469 printf("\t * Pairwise ciphers: %s\n", defcipher);
470 return;
471 }
472
473 count = data[0] | (data[1] << 8);
31d477fb
MH
474 if (2 + (count * 4) > len)
475 goto invalid;
476
857d966e
MH
477 tab_on_first(&first);
478 printf("\t * Pairwise ciphers:");
31d477fb 479 for (i = 0; i < count; i++) {
857d966e
MH
480 printf(" ");
481 print_cipher(data + 2 + (i * 4));
482 }
483 printf("\n");
484
485 data += 2 + (count * 4);
486 len -= 2 + (count * 4);
487
488 if (len < 2) {
489 tab_on_first(&first);
490 printf("\t * Authentication suites: %s\n", defauth);
491 return;
492 }
493
494 count = data[0] | (data[1] << 8);
31d477fb
MH
495 if (2 + (count * 4) > len)
496 goto invalid;
497
857d966e
MH
498 tab_on_first(&first);
499 printf("\t * Authentication suites:");
83b4934c 500 for (i = 0; i < count; i++) {
857d966e
MH
501 printf(" ");
502 print_auth(data + 2 + (i * 4));
503 }
504 printf("\n");
505
506 data += 2 + (count * 4);
507 len -= 2 + (count * 4);
508
6a4f24e8
JB
509 if (len >= 2) {
510 capa = data[0] | (data[1] << 8);
511 tab_on_first(&first);
cadbe89a
JB
512 printf("\t * Capabilities:");
513 if (capa & 0x0001)
514 printf(" PreAuth");
515 if (capa & 0x0002)
516 printf(" NoPairwise");
517 switch ((capa & 0x000c) >> 2) {
518 case 0:
519 break;
520 case 1:
521 printf(" 2-PTKSA-RC");
522 break;
523 case 2:
524 printf(" 4-PTKSA-RC");
525 break;
526 case 3:
527 printf(" 16-PTKSA-RC");
528 break;
529 }
530 switch ((capa & 0x0030) >> 4) {
531 case 0:
532 break;
533 case 1:
534 printf(" 2-GTKSA-RC");
535 break;
536 case 2:
537 printf(" 4-GTKSA-RC");
538 break;
539 case 3:
540 printf(" 16-GTKSA-RC");
541 break;
542 }
543 if (capa & 0x0040)
544 printf(" MFP-required");
545 if (capa & 0x0080)
546 printf(" MFP-capable");
547 if (capa & 0x0200)
548 printf(" Peerkey-enabled");
549 if (capa & 0x0400)
550 printf(" SPP-AMSDU-capable");
551 if (capa & 0x0800)
552 printf(" SPP-AMSDU-required");
553 printf(" (0x%.4x)\n", capa);
6a4f24e8
JB
554 data += 2;
555 len -= 2;
556 }
31d477fb 557
5ba3f523
JB
558 if (len >= 2) {
559 int pmkid_count = data[0] | (data[1] << 8);
560
561 if (len >= 2 + 16 * pmkid_count) {
562 tab_on_first(&first);
563 printf("\t * %d PMKIDs\n", pmkid_count);
564 /* not printing PMKID values */
565 data += 2 + 16 * pmkid_count;
566 len -= 2 + 16 * pmkid_count;
567 } else
568 goto invalid;
569 }
570
571 if (len >= 4) {
572 tab_on_first(&first);
573 printf("\t * Group mgmt cipher suite: ");
574 print_cipher(data);
575 printf("\n");
576 data += 4;
577 len -= 4;
578 }
579
cadbe89a 580 invalid:
31d477fb
MH
581 if (len != 0) {
582 printf("\t\t * bogus tail data (%d):", len);
583 while (len) {
584 printf(" %.2x", *data);
585 data++;
586 len--;
587 }
588 printf("\n");
589 }
857d966e
MH
590}
591
83b4934c 592static void print_rsn(const uint8_t type, uint8_t len, const uint8_t *data)
857d966e 593{
83b4934c 594 print_rsn_ie("CCMP", "IEEE 802.1X", len, data);
857d966e
MH
595}
596
0c445c24
LR
597static void print_ht_capa(const uint8_t type, uint8_t len, const uint8_t *data)
598{
357c1a5d 599 printf("\n");
7ddfb679
JB
600 print_ht_capability(data[0] | (data[1] << 8));
601 print_ampdu_length(data[2] & 3);
c79c7464 602 print_ampdu_spacing((data[2] >> 2) & 7);
7ddfb679 603 print_ht_mcs(data + 3);
0c445c24
LR
604}
605
29f7579e
JB
606static const char *ht_secondary_offset[4] = {
607 "no secondary",
608 "above",
609 "[reserved!]",
610 "below",
611};
612
be7602fb
JB
613static void print_ht_op(const uint8_t type, uint8_t len, const uint8_t *data)
614{
be7602fb
JB
615 static const char *protection[4] = {
616 "no",
617 "nonmember",
618 "20 MHz",
619 "non-HT mixed",
620 };
621 static const char *sta_chan_width[2] = {
622 "20 MHz",
623 "any",
624 };
625
626 printf("\n");
627 printf("\t\t * primary channel: %d\n", data[0]);
628 printf("\t\t * secondary channel offset: %s\n",
29f7579e 629 ht_secondary_offset[data[1] & 0x3]);
be7602fb
JB
630 printf("\t\t * STA channel width: %s\n", sta_chan_width[(data[1] & 0x4)>>2]);
631 printf("\t\t * RIFS: %d\n", (data[1] & 0x8)>>3);
632 printf("\t\t * HT protection: %s\n", protection[data[2] & 0x3]);
633 printf("\t\t * non-GF present: %d\n", (data[2] & 0x4) >> 2);
634 printf("\t\t * OBSS non-GF present: %d\n", (data[2] & 0x10) >> 4);
635 printf("\t\t * dual beacon: %d\n", (data[4] & 0x40) >> 6);
636 printf("\t\t * dual CTS protection: %d\n", (data[4] & 0x80) >> 7);
637 printf("\t\t * STBC beacon: %d\n", data[5] & 0x1);
638 printf("\t\t * L-SIG TXOP Prot: %d\n", (data[5] & 0x2) >> 1);
639 printf("\t\t * PCO active: %d\n", (data[5] & 0x4) >> 2);
640 printf("\t\t * PCO phase: %d\n", (data[5] & 0x8) >> 3);
641}
642
83b4934c 643static void print_capabilities(const uint8_t type, uint8_t len, const uint8_t *data)
9b880b00 644{
31d2d259
JB
645 int i, base, bit;
646 bool first = true;
647
648
649 for (i = 0; i < len; i++) {
650 base = i * 8;
651
652 for (bit = 0; bit < 8; bit++) {
653 if (!(data[i] & (1 << bit)))
654 continue;
655
656 if (!first)
657 printf(",");
658 else
659 first = false;
660
70c649d2
JB
661#define CAPA(bit, name) case bit: printf(" " name); break
662
31d2d259 663 switch (bit + base) {
70c649d2
JB
664 CAPA(0, "HT Information Exchange Supported");
665 CAPA(1, "reserved (On-demand Beacon)");
666 CAPA(2, "Extended Channel Switching");
667 CAPA(3, "reserved (Wave Indication)");
668 CAPA(4, "PSMP Capability");
669 CAPA(5, "reserved (Service Interval Granularity)");
670 CAPA(6, "S-PSMP Capability");
671 CAPA(7, "Event");
672 CAPA(8, "Diagnostics");
673 CAPA(9, "Multicast Diagnostics");
674 CAPA(10, "Location Tracking");
675 CAPA(11, "FMS");
676 CAPA(12, "Proxy ARP Service");
677 CAPA(13, "Collocated Interference Reporting");
678 CAPA(14, "Civic Location");
679 CAPA(15, "Geospatial Location");
680 CAPA(16, "TFS");
681 CAPA(17, "WNM-Sleep Mode");
682 CAPA(18, "TIM Broadcast");
683 CAPA(19, "BSS Transition");
684 CAPA(20, "QoS Traffic Capability");
685 CAPA(21, "AC Station Count");
686 CAPA(22, "Multiple BSSID");
687 CAPA(23, "Timing Measurement");
688 CAPA(24, "Channel Usage");
689 CAPA(25, "SSID List");
690 CAPA(26, "DMS");
691 CAPA(27, "UTC TSF Offset");
692 CAPA(28, "TDLS Peer U-APSD Buffer STA Support");
693 CAPA(29, "TDLS Peer PSM Support");
694 CAPA(30, "TDLS channel switching");
695 CAPA(31, "Interworking");
696 CAPA(32, "QoS Map");
697 CAPA(33, "EBR");
698 CAPA(34, "SSPN Interface");
699 CAPA(35, "Reserved");
700 CAPA(36, "MSGCF Capability");
701 CAPA(37, "TDLS Support");
702 CAPA(38, "TDLS Prohibited");
703 CAPA(39, "TDLS Channel Switching Prohibited");
704 CAPA(40, "Reject Unadmitted Frame");
705 CAPA(44, "Identifier Location");
706 CAPA(45, "U-APSD Coexistence");
707 CAPA(46, "WNM-Notification");
708 CAPA(47, "Reserved");
709 CAPA(48, "UTF-8 SSID");
31d2d259
JB
710 default:
711 printf(" %d", bit);
712 break;
713 }
70c649d2 714#undef CAPA
31d2d259
JB
715 }
716 }
9b880b00 717
9b880b00
MH
718 printf("\n");
719}
720
575280cc
JM
721static void print_tim(const uint8_t type, uint8_t len, const uint8_t *data)
722{
723 printf(" DTIM Count %u DTIM Period %u Bitmap Control 0x%x "
724 "Bitmap[0] 0x%x",
725 data[0], data[1], data[2], data[3]);
726 if (len - 4)
727 printf(" (+ %u octet%s)", len - 4, len - 4 == 1 ? "" : "s");
728 printf("\n");
729}
730
792172b0
JM
731static void print_ibssatim(const uint8_t type, uint8_t len, const uint8_t *data)
732{
733 printf(" %d TUs", (data[1] << 8) + data[0]);
734}
735
54eb1613
JB
736static void print_vht_capa(const uint8_t type, uint8_t len, const uint8_t *data)
737{
738 printf("\n");
739 print_vht_info(data[0] | (data[1] << 8) |
740 (data[2] << 16) | (data[3] << 24),
741 data + 4);
742}
743
ca159934
JB
744static void print_vht_oper(const uint8_t type, uint8_t len, const uint8_t *data)
745{
746 const char *chandwidths[] = {
747 [0] = "20 or 40 MHz",
748 [1] = "80 MHz",
749 [3] = "80+80 MHz",
750 [2] = "160 MHz",
751 };
752
753 printf("\n");
754 printf("\t\t * channel width: %d (%s)\n", data[0],
755 data[0] < ARRAY_SIZE(chandwidths) ? chandwidths[data[0]] : "unknown");
756 printf("\t\t * center freq segment 1: %d\n", data[1]);
757 printf("\t\t * center freq segment 2: %d\n", data[2]);
758 printf("\t\t * VHT basic MCS set: 0x%.2x%.2x\n", data[4], data[3]);
759}
760
29f7579e
JB
761static void print_obss_scan_params(const uint8_t type, uint8_t len, const uint8_t *data)
762{
763 printf("\n");
764 printf("\t\t * passive dwell: %d TUs\n", (data[1] << 8) | data[0]);
765 printf("\t\t * active dwell: %d TUs\n", (data[3] << 8) | data[2]);
766 printf("\t\t * channel width trigger scan interval: %d s\n", (data[5] << 8) | data[4]);
767 printf("\t\t * scan passive total per channel: %d TUs\n", (data[7] << 8) | data[6]);
768 printf("\t\t * scan active total per channel: %d TUs\n", (data[9] << 8) | data[8]);
769 printf("\t\t * BSS width channel transition delay factor: %d\n", (data[11] << 8) | data[10]);
770 printf("\t\t * OBSS Scan Activity Threshold: %d.%02d %%\n",
771 ((data[13] << 8) | data[12]) / 100, ((data[13] << 8) | data[12]) % 100);
772}
773
774static void print_secchan_offs(const uint8_t type, uint8_t len, const uint8_t *data)
775{
776 if (data[0] < ARRAY_SIZE(ht_secondary_offset))
777 printf(" %s (%d)\n", ht_secondary_offset[data[0]], data[0]);
778 else
779 printf(" %d\n", data[0]);
780}
781
782static void print_bss_load(const uint8_t type, uint8_t len, const uint8_t *data)
783{
784 printf("\n");
785 printf("\t\t * station count: %d\n", (data[1] << 8) | data[0]);
786 printf("\t\t * channel utilisation: %d/255\n", data[2]);
787 printf("\t\t * available admission capacity: %d [*32us]\n", (data[4] << 8) | data[3]);
788}
789
2d86b0f3
CYY
790static void print_mesh_conf(const uint8_t type, uint8_t len, const uint8_t *data)
791{
792 printf("\n");
793 printf("\t\t * Active Path Selection Protocol ID: %d\n", data[0]);
794 printf("\t\t * Active Path Selection Metric ID: %d\n", data[1]);
795 printf("\t\t * Congestion Control Mode ID: %d\n", data[2]);
796 printf("\t\t * Synchronization Method ID: %d\n", data[3]);
797 printf("\t\t * Authentication Protocol ID: %d\n", data[4]);
798 printf("\t\t * Mesh Formation Info:\n");
799 printf("\t\t\t Number of Peerings: %d\n", (data[5] & 0x7E) >> 1);
800 if (data[5] & 0x01)
801 printf("\t\t\t Connected to Mesh Gate\n");
802 if (data[5] & 0x80)
803 printf("\t\t\t Connected to AS\n");
804 printf("\t\t * Mesh Capability\n");
805 if (data[6] & 0x01)
806 printf("\t\t\t Accepting Additional Mesh Peerings\n");
807 if (data[6] & 0x02)
808 printf("\t\t\t MCCA Supported\n");
809 if (data[6] & 0x04)
810 printf("\t\t\t MCCA Enabled\n");
811 if (data[6] & 0x08)
812 printf("\t\t\t Forwarding\n");
813 if (data[6] & 0x10)
814 printf("\t\t\t MBCA Supported\n");
815 if (data[6] & 0x20)
816 printf("\t\t\t TBTT Adjusting\n");
817 if (data[6] & 0x40)
818 printf("\t\t\t Mesh Power Save Level\n");
819}
820
83b4934c
JB
821struct ie_print {
822 const char *name;
823 void (*print)(const uint8_t type, uint8_t len, const uint8_t *data);
824 uint8_t minlen, maxlen;
febeb0c0 825 uint8_t flags;
764fe753
JB
826};
827
83b4934c
JB
828static void print_ie(const struct ie_print *p, const uint8_t type,
829 uint8_t len, const uint8_t *data)
4673a894 830{
83b4934c
JB
831 int i;
832
833 if (!p->print)
834 return;
835
836 printf("\t%s:", p->name);
837 if (len < p->minlen || len > p->maxlen) {
838 if (len > 1) {
839 printf(" <invalid: %d bytes:", len);
840 for (i = 0; i < len; i++)
841 printf(" %.02x", data[i]);
842 printf(">\n");
843 } else if (len)
844 printf(" <invalid: 1 byte: %.02x>\n", data[0]);
845 else
846 printf(" <invalid: no data>\n");
847 return;
848 }
849
850 p->print(type, len, data);
851}
852
853#define PRINT_IGN { \
854 .name = "IGNORE", \
855 .print = NULL, \
856 .minlen = 0, \
857 .maxlen = 255, \
4673a894
JB
858}
859
83b4934c 860static const struct ie_print ieprinters[] = {
febeb0c0
JB
861 [0] = { "SSID", print_ssid, 0, 32, BIT(PRINT_SCAN) | BIT(PRINT_LINK), },
862 [1] = { "Supported rates", print_supprates, 0, 255, BIT(PRINT_SCAN), },
014d581a 863 [3] = { "DS Parameter set", print_ds, 1, 1, BIT(PRINT_SCAN), },
575280cc 864 [5] = { "TIM", print_tim, 4, 255, BIT(PRINT_SCAN), },
792172b0 865 [6] = { "IBSS ATIM window", print_ibssatim, 2, 2, BIT(PRINT_SCAN), },
febeb0c0 866 [7] = { "Country", print_country, 3, 255, BIT(PRINT_SCAN), },
29f7579e 867 [11] = { "BSS Load", print_bss_load, 5, 5, BIT(PRINT_SCAN), },
febeb0c0 868 [32] = { "Power constraint", print_powerconstraint, 1, 1, BIT(PRINT_SCAN), },
792172b0 869 [35] = { "TPC report", print_tpcreport, 2, 2, BIT(PRINT_SCAN), },
febeb0c0 870 [42] = { "ERP", print_erp, 1, 255, BIT(PRINT_SCAN), },
a2e61861 871 [45] = { "HT capabilities", print_ht_capa, 26, 26, BIT(PRINT_SCAN), },
792172b0 872 [47] = { "ERP D4.0", print_erp, 1, 255, BIT(PRINT_SCAN), },
29f7579e 873 [74] = { "Overlapping BSS scan params", print_obss_scan_params, 14, 255, BIT(PRINT_SCAN), },
be7602fb 874 [61] = { "HT operation", print_ht_op, 22, 22, BIT(PRINT_SCAN), },
29f7579e 875 [62] = { "Secondary Channel Offset", print_secchan_offs, 1, 1, BIT(PRINT_SCAN), },
54eb1613 876 [191] = { "VHT capabilities", print_vht_capa, 12, 255, BIT(PRINT_SCAN), },
ca159934 877 [192] = { "VHT operation", print_vht_oper, 5, 255, BIT(PRINT_SCAN), },
febeb0c0
JB
878 [48] = { "RSN", print_rsn, 2, 255, BIT(PRINT_SCAN), },
879 [50] = { "Extended supported rates", print_supprates, 0, 255, BIT(PRINT_SCAN), },
2d86b0f3 880 [113] = { "MESH Configuration", print_mesh_conf, 7, 7, BIT(PRINT_SCAN), },
720583e9 881 [114] = { "MESH ID", print_ssid, 0, 32, BIT(PRINT_SCAN) | BIT(PRINT_LINK), },
febeb0c0 882 [127] = { "Extended capabilities", print_capabilities, 0, 255, BIT(PRINT_SCAN), },
83b4934c
JB
883};
884
885static void print_wifi_wpa(const uint8_t type, uint8_t len, const uint8_t *data)
886{
887 print_rsn_ie("TKIP", "IEEE 802.1X", len, data);
888}
889
1cab57eb
JB
890static bool print_wifi_wmm_param(const uint8_t *data, uint8_t len)
891{
892 int i;
893 static const char *aci_tbl[] = { "BE", "BK", "VI", "VO" };
894
895 if (len < 19)
896 goto invalid;
897
898 if (data[0] != 1) {
cee4fe20 899 printf("Parameter: not version 1: ");
1cab57eb
JB
900 return false;
901 }
902
89ea706f 903 printf("\t * Parameter version 1");
1cab57eb
JB
904
905 data++;
906
907 if (data[0] & 0x80)
89ea706f 908 printf("\n\t\t * u-APSD");
1cab57eb
JB
909
910 data += 2;
911
912 for (i = 0; i < 4; i++) {
89ea706f 913 printf("\n\t\t * %s:", aci_tbl[(data[0] >> 5) & 3]);
87181516 914 if (data[0] & 0x10)
1cab57eb
JB
915 printf(" acm");
916 printf(" CW %d-%d", (1 << (data[1] & 0xf)) - 1,
917 (1 << (data[1] >> 4)) - 1);
a2a4c265 918 printf(", AIFSN %d", data[0] & 0xf);
1cab57eb 919 if (data[2] | data[3])
cee4fe20 920 printf(", TXOP %d usec", (data[2] + (data[3] << 8)) * 32);
1cab57eb
JB
921 data += 4;
922 }
923
924 printf("\n");
925 return true;
926
927 invalid:
928 printf("invalid: ");
929 return false;
930}
931
83b4934c 932static void print_wifi_wmm(const uint8_t type, uint8_t len, const uint8_t *data)
6ff0c93a
MH
933{
934 int i;
935
6ff0c93a
MH
936 switch (data[0]) {
937 case 0x00:
83b4934c 938 printf(" information:");
6ff0c93a
MH
939 break;
940 case 0x01:
1cab57eb
JB
941 if (print_wifi_wmm_param(data + 1, len - 1))
942 return;
6ff0c93a
MH
943 break;
944 default:
83b4934c 945 printf(" type %d:", data[0]);
6ff0c93a
MH
946 break;
947 }
948
1cab57eb
JB
949 for(i = 1; i < len; i++)
950 printf(" %.02x", data[i]);
6ff0c93a
MH
951 printf("\n");
952}
953
a6816965
JM
954static const char * wifi_wps_dev_passwd_id(uint16_t id)
955{
956 switch (id) {
957 case 0:
958 return "Default (PIN)";
959 case 1:
960 return "User-specified";
961 case 2:
962 return "Machine-specified";
963 case 3:
964 return "Rekey";
965 case 4:
966 return "PushButton";
967 case 5:
968 return "Registrar-specified";
969 default:
970 return "??";
971 }
972}
973
83b4934c 974static void print_wifi_wps(const uint8_t type, uint8_t len, const uint8_t *data)
4673a894
JB
975{
976 bool first = true;
977 __u16 subtype, sublen;
978
4673a894
JB
979 while (len >= 4) {
980 subtype = (data[0] << 8) + data[1];
981 sublen = (data[2] << 8) + data[3];
982 if (sublen > len)
983 break;
984
985 switch (subtype) {
986 case 0x104a:
987 tab_on_first(&first);
dffc6750 988 printf("\t * Version: %d.%d\n", data[4] >> 4, data[4] & 0xF);
4673a894
JB
989 break;
990 case 0x1011:
991 tab_on_first(&first);
992 printf("\t * Device name: %.*s\n", sublen, data + 4);
993 break;
a6816965
JM
994 case 0x1012: {
995 uint16_t id;
996 tab_on_first(&first);
997 if (sublen != 2) {
998 printf("\t * Device Password ID: (invalid "
999 "length %d)\n", sublen);
1000 break;
1001 }
1002 id = data[4] << 8 | data[5];
1003 printf("\t * Device Password ID: %u (%s)\n",
1004 id, wifi_wps_dev_passwd_id(id));
1005 break;
1006 }
4673a894
JB
1007 case 0x1021:
1008 tab_on_first(&first);
1009 printf("\t * Manufacturer: %.*s\n", sublen, data + 4);
1010 break;
1011 case 0x1023:
1012 tab_on_first(&first);
1013 printf("\t * Model: %.*s\n", sublen, data + 4);
1014 break;
a6816965
JM
1015 case 0x1024:
1016 tab_on_first(&first);
1017 printf("\t * Model Number: %.*s\n", sublen, data + 4);
1018 break;
1019 case 0x103b: {
1020 __u8 val = data[4];
1021 tab_on_first(&first);
1022 printf("\t * Response Type: %d%s\n",
1023 val, val == 3 ? " (AP)" : "");
1024 break;
1025 }
1026 case 0x103c: {
1027 __u8 val = data[4];
1028 tab_on_first(&first);
1029 printf("\t * RF Bands: 0x%x\n", val);
1030 break;
1031 }
1032 case 0x1041: {
1033 __u8 val = data[4];
1034 tab_on_first(&first);
1035 printf("\t * Selected Registrar: 0x%x\n", val);
1036 break;
1037 }
1038 case 0x1042:
1039 tab_on_first(&first);
1040 printf("\t * Serial Number: %.*s\n", sublen, data + 4);
1041 break;
1042 case 0x1044: {
1043 __u8 val = data[4];
1044 tab_on_first(&first);
1045 printf("\t * Wi-Fi Protected Setup State: %d%s%s\n",
1046 val,
1047 val == 1 ? " (Unconfigured)" : "",
1048 val == 2 ? " (Configured)" : "");
1049 break;
1050 }
09fe09dc
JB
1051 case 0x1047:
1052 tab_on_first(&first);
1053 printf("\t * UUID: ");
1054 if (sublen != 16) {
1055 printf("(invalid, length=%d)\n", sublen);
1056 break;
1057 }
1058 printf("%02x%02x%02x%02x-%02x%02x-%02x%02x-"
1059 "%02x%02x-%02x%02x%02x%02x%02x%02x\n",
1060 data[4], data[5], data[6], data[7],
1061 data[8], data[9], data[10], data[11],
1062 data[12], data[13], data[14], data[15],
1063 data[16], data[17], data[18], data[19]);
1064 break;
a6816965
JM
1065 case 0x1054: {
1066 tab_on_first(&first);
1067 if (sublen != 8) {
1068 printf("\t * Primary Device Type: (invalid "
1069 "length %d)\n", sublen);
1070 break;
1071 }
1072 printf("\t * Primary Device Type: "
1073 "%u-%02x%02x%02x%02x-%u\n",
1074 data[4] << 8 | data[5],
1075 data[6], data[7], data[8], data[9],
1076 data[10] << 8 | data[11]);
1077 break;
1078 }
7ee5a865 1079 case 0x1057: {
fe31a22e 1080 __u8 val = data[4];
7ee5a865 1081 tab_on_first(&first);
fe31a22e 1082 printf("\t * AP setup locked: 0x%.2x\n", val);
7ee5a865
JB
1083 break;
1084 }
a6816965
JM
1085 case 0x1008:
1086 case 0x1053: {
4673a894
JB
1087 __u16 meth = (data[4] << 8) + data[5];
1088 bool comma = false;
1089 tab_on_first(&first);
a6816965
JM
1090 printf("\t * %sConfig methods:",
1091 subtype == 0x1053 ? "Selected Registrar ": "");
4673a894
JB
1092#define T(bit, name) do { \
1093 if (meth & (1<<bit)) { \
1094 if (comma) \
1095 printf(","); \
1096 comma = true; \
1097 printf(" " name); \
1098 } } while (0)
1099 T(0, "USB");
1100 T(1, "Ethernet");
1101 T(2, "Label");
1102 T(3, "Display");
1103 T(4, "Ext. NFC");
1104 T(5, "Int. NFC");
1105 T(6, "NFC Intf.");
1106 T(7, "PBC");
1107 T(8, "Keypad");
1108 printf("\n");
1109 break;
1110#undef T
1111 }
2650d46b
JB
1112 default: {
1113 const __u8 *subdata = data + 4;
1114 __u16 tmplen = sublen;
1115
1116 tab_on_first(&first);
1117 printf("\t * Unknown TLV (%#.4x, %d bytes):",
1118 subtype, tmplen);
1119 while (tmplen) {
1120 printf(" %.2x", *subdata);
1121 subdata++;
1122 tmplen--;
1123 }
1124 printf("\n");
4673a894
JB
1125 break;
1126 }
2650d46b 1127 }
4673a894
JB
1128
1129 data += sublen + 4;
1130 len -= sublen + 4;
1131 }
1132
1133 if (len != 0) {
1134 printf("\t\t * bogus tail data (%d):", len);
1135 while (len) {
1136 printf(" %.2x", *data);
1137 data++;
1138 len--;
1139 }
1140 printf("\n");
1141 }
1142}
1143
83b4934c 1144static const struct ie_print wifiprinters[] = {
febeb0c0
JB
1145 [1] = { "WPA", print_wifi_wpa, 2, 255, BIT(PRINT_SCAN), },
1146 [2] = { "WMM", print_wifi_wmm, 1, 255, BIT(PRINT_SCAN), },
1147 [4] = { "WPS", print_wifi_wps, 0, 255, BIT(PRINT_SCAN), },
4673a894
JB
1148};
1149
9a22374a
JB
1150static inline void print_p2p(const uint8_t type, uint8_t len, const uint8_t *data)
1151{
1152 bool first = true;
1153 __u8 subtype;
1154 __u16 sublen;
1155
1156 while (len >= 3) {
1157 subtype = data[0];
1158 sublen = (data[2] << 8) + data[1];
1159
1160 if (sublen > len - 3)
1161 break;
1162
1163 switch (subtype) {
1164 case 0x02: /* capability */
1165 tab_on_first(&first);
1166 if (sublen < 2) {
1167 printf("\t * malformed capability\n");
1168 break;
1169 }
1170 printf("\t * Group capa: 0x%.2x, Device capa: 0x%.2x\n",
1171 data[3], data[4]);
1172 break;
1173 case 0x0d: /* device info */
1174 if (sublen < 6 + 2 + 8 + 1) {
1175 printf("\t * malformed device info\n");
1176 break;
1177 }
1178 /* fall through for now */
1179 case 0x00: /* status */
1180 case 0x01: /* minor reason */
1181 case 0x03: /* device ID */
1182 case 0x04: /* GO intent */
1183 case 0x05: /* configuration timeout */
1184 case 0x06: /* listen channel */
1185 case 0x07: /* group BSSID */
1186 case 0x08: /* ext listen timing */
1187 case 0x09: /* intended interface address */
1188 case 0x0a: /* manageability */
1189 case 0x0b: /* channel list */
1190 case 0x0c: /* NoA */
1191 case 0x0e: /* group info */
1192 case 0x0f: /* group ID */
1193 case 0x10: /* interface */
1194 case 0x11: /* operating channel */
1195 case 0x12: /* invitation flags */
1196 case 0xdd: /* vendor specific */
1197 default: {
1198 const __u8 *subdata = data + 4;
1199 __u16 tmplen = sublen;
1200
1201 tab_on_first(&first);
1202 printf("\t * Unknown TLV (%#.2x, %d bytes):",
1203 subtype, tmplen);
1204 while (tmplen) {
1205 printf(" %.2x", *subdata);
1206 subdata++;
1207 tmplen--;
1208 }
1209 printf("\n");
1210 break;
1211 }
1212 }
1213
1214 data += sublen + 3;
1215 len -= sublen + 3;
1216 }
1217
1218 if (len != 0) {
1219 tab_on_first(&first);
1220 printf("\t * bogus tail data (%d):", len);
1221 while (len) {
1222 printf(" %.2x", *data);
1223 data++;
1224 len--;
1225 }
1226 printf("\n");
1227 }
1228}
1229
1230static const struct ie_print wfa_printers[] = {
1231 [9] = { "P2P", print_p2p, 2, 255, BIT(PRINT_SCAN), },
1232};
1233
764fe753 1234static void print_vendor(unsigned char len, unsigned char *data,
febeb0c0 1235 bool unknown, enum print_ie_type ptype)
3563f4c5
JB
1236{
1237 int i;
1238
fbf80af5 1239 if (len < 3) {
4673a894 1240 printf("\tVendor specific: <too short> data:");
fbf80af5
JB
1241 for(i = 0; i < len; i++)
1242 printf(" %.02x", data[i]);
1243 printf("\n");
1244 return;
1245 }
1246
3bd60ef1 1247 if (len >= 4 && memcmp(data, ms_oui, 3) == 0) {
febeb0c0
JB
1248 if (data[3] < ARRAY_SIZE(wifiprinters) &&
1249 wifiprinters[data[3]].name &&
1250 wifiprinters[data[3]].flags & BIT(ptype)) {
83b4934c
JB
1251 print_ie(&wifiprinters[data[3]], data[3], len - 4, data + 4);
1252 return;
1253 }
febeb0c0 1254 if (!unknown)
4673a894 1255 return;
3bd60ef1 1256 printf("\tMS/WiFi %#.2x, data:", data[3]);
4673a894
JB
1257 for(i = 0; i < len - 4; i++)
1258 printf(" %.02x", data[i + 4]);
1259 printf("\n");
1260 return;
1261 }
1262
9a22374a
JB
1263 if (len >= 4 && memcmp(data, wfa_oui, 3) == 0) {
1264 if (data[3] < ARRAY_SIZE(wfa_printers) &&
1265 wfa_printers[data[3]].name &&
1266 wfa_printers[data[3]].flags & BIT(ptype)) {
1267 print_ie(&wfa_printers[data[3]], data[3], len - 4, data + 4);
1268 return;
1269 }
1270 if (!unknown)
1271 return;
1272 printf("\tWFA %#.2x, data:", data[3]);
1273 for(i = 0; i < len - 4; i++)
1274 printf(" %.02x", data[i + 4]);
1275 printf("\n");
1276 return;
1277 }
1278
febeb0c0 1279 if (!unknown)
764fe753
JB
1280 return;
1281
fbf80af5 1282 printf("\tVendor specific: OUI %.2x:%.2x:%.2x, data:",
3563f4c5 1283 data[0], data[1], data[2]);
fbf80af5
JB
1284 for (i = 3; i < len; i++)
1285 printf(" %.2x", data[i]);
3563f4c5
JB
1286 printf("\n");
1287}
1288
febeb0c0
JB
1289void print_ies(unsigned char *ie, int ielen, bool unknown,
1290 enum print_ie_type ptype)
3563f4c5
JB
1291{
1292 while (ielen >= 2 && ielen >= ie[1]) {
febeb0c0
JB
1293 if (ie[0] < ARRAY_SIZE(ieprinters) &&
1294 ieprinters[ie[0]].name &&
1295 ieprinters[ie[0]].flags & BIT(ptype)) {
83b4934c 1296 print_ie(&ieprinters[ie[0]], ie[0], ie[1], ie + 2);
764fe753 1297 } else if (ie[0] == 221 /* vendor */) {
febeb0c0
JB
1298 print_vendor(ie[1], ie + 2, unknown, ptype);
1299 } else if (unknown) {
3563f4c5
JB
1300 int i;
1301
8086b700 1302 printf("\tUnknown IE (%d):", ie[0]);
3563f4c5 1303 for (i=0; i<ie[1]; i++)
8086b700 1304 printf(" %.2x", ie[2+i]);
3563f4c5
JB
1305 printf("\n");
1306 }
1307 ielen -= ie[1] + 2;
1308 ie += ie[1] + 2;
1309 }
1310}
1311
2e8b82c1
VK
1312static void print_capa_dmg(__u16 capa)
1313{
1314 switch (capa & WLAN_CAPABILITY_DMG_TYPE_MASK) {
1315 case WLAN_CAPABILITY_DMG_TYPE_AP:
1316 printf(" DMG_ESS");
1317 break;
1318 case WLAN_CAPABILITY_DMG_TYPE_PBSS:
1319 printf(" DMG_PCP");
1320 break;
1321 case WLAN_CAPABILITY_DMG_TYPE_IBSS:
1322 printf(" DMG_IBSS");
1323 break;
1324 }
1325
1326 if (capa & WLAN_CAPABILITY_DMG_CBAP_ONLY)
1327 printf(" CBAP_Only");
1328 if (capa & WLAN_CAPABILITY_DMG_CBAP_SOURCE)
1329 printf(" CBAP_Src");
1330 if (capa & WLAN_CAPABILITY_DMG_PRIVACY)
1331 printf(" Privacy");
1332 if (capa & WLAN_CAPABILITY_DMG_ECPAC)
1333 printf(" ECPAC");
1334 if (capa & WLAN_CAPABILITY_DMG_SPECTRUM_MGMT)
1335 printf(" SpectrumMgmt");
1336 if (capa & WLAN_CAPABILITY_DMG_RADIO_MEASURE)
1337 printf(" RadioMeasure");
1338}
1339
1340static void print_capa_non_dmg(__u16 capa)
1341{
1342 if (capa & WLAN_CAPABILITY_ESS)
1343 printf(" ESS");
1344 if (capa & WLAN_CAPABILITY_IBSS)
1345 printf(" IBSS");
1346 if (capa & WLAN_CAPABILITY_CF_POLLABLE)
1347 printf(" CfPollable");
1348 if (capa & WLAN_CAPABILITY_CF_POLL_REQUEST)
1349 printf(" CfPollReq");
1350 if (capa & WLAN_CAPABILITY_PRIVACY)
1351 printf(" Privacy");
1352 if (capa & WLAN_CAPABILITY_SHORT_PREAMBLE)
1353 printf(" ShortPreamble");
1354 if (capa & WLAN_CAPABILITY_PBCC)
1355 printf(" PBCC");
1356 if (capa & WLAN_CAPABILITY_CHANNEL_AGILITY)
1357 printf(" ChannelAgility");
1358 if (capa & WLAN_CAPABILITY_SPECTRUM_MGMT)
1359 printf(" SpectrumMgmt");
1360 if (capa & WLAN_CAPABILITY_QOS)
1361 printf(" QoS");
1362 if (capa & WLAN_CAPABILITY_SHORT_SLOT_TIME)
1363 printf(" ShortSlotTime");
1364 if (capa & WLAN_CAPABILITY_APSD)
1365 printf(" APSD");
1366 if (capa & WLAN_CAPABILITY_RADIO_MEASURE)
1367 printf(" RadioMeasure");
1368 if (capa & WLAN_CAPABILITY_DSSS_OFDM)
1369 printf(" DSSS-OFDM");
1370 if (capa & WLAN_CAPABILITY_DEL_BACK)
1371 printf(" DelayedBACK");
1372 if (capa & WLAN_CAPABILITY_IMM_BACK)
1373 printf(" ImmediateBACK");
1374}
1375
3563f4c5
JB
1376static int print_bss_handler(struct nl_msg *msg, void *arg)
1377{
1378 struct nlattr *tb[NL80211_ATTR_MAX + 1];
1379 struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
1380 struct nlattr *bss[NL80211_BSS_MAX + 1];
1381 char mac_addr[20], dev[20];
1382 static struct nla_policy bss_policy[NL80211_BSS_MAX + 1] = {
1383 [NL80211_BSS_TSF] = { .type = NLA_U64 },
1384 [NL80211_BSS_FREQUENCY] = { .type = NLA_U32 },
1385 [NL80211_BSS_BSSID] = { },
1386 [NL80211_BSS_BEACON_INTERVAL] = { .type = NLA_U16 },
1387 [NL80211_BSS_CAPABILITY] = { .type = NLA_U16 },
1388 [NL80211_BSS_INFORMATION_ELEMENTS] = { },
f2e17e1f
JB
1389 [NL80211_BSS_SIGNAL_MBM] = { .type = NLA_U32 },
1390 [NL80211_BSS_SIGNAL_UNSPEC] = { .type = NLA_U8 },
a56117a6 1391 [NL80211_BSS_STATUS] = { .type = NLA_U32 },
c04a78df 1392 [NL80211_BSS_SEEN_MS_AGO] = { .type = NLA_U32 },
575280cc 1393 [NL80211_BSS_BEACON_IES] = { },
3563f4c5 1394 };
febeb0c0 1395 struct scan_params *params = arg;
1c5bcd9c 1396 int show = params->show_both_ie_sets ? 2 : 1;
2e8b82c1 1397 bool is_dmg = false;
3563f4c5
JB
1398
1399 nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
1400 genlmsg_attrlen(gnlh, 0), NULL);
1401
1402 if (!tb[NL80211_ATTR_BSS]) {
5fe70c0e 1403 fprintf(stderr, "bss info missing!\n");
3563f4c5
JB
1404 return NL_SKIP;
1405 }
1406 if (nla_parse_nested(bss, NL80211_BSS_MAX,
1407 tb[NL80211_ATTR_BSS],
1408 bss_policy)) {
5fe70c0e 1409 fprintf(stderr, "failed to parse nested attributes!\n");
3563f4c5
JB
1410 return NL_SKIP;
1411 }
1412
1413 if (!bss[NL80211_BSS_BSSID])
1414 return NL_SKIP;
1415
1416 mac_addr_n2a(mac_addr, nla_data(bss[NL80211_BSS_BSSID]));
00889fb2
JB
1417 printf("BSS %s", mac_addr);
1418 if (tb[NL80211_ATTR_IFINDEX]) {
1419 if_indextoname(nla_get_u32(tb[NL80211_ATTR_IFINDEX]), dev);
1420 printf("(on %s)", dev);
1421 }
a56117a6
JB
1422
1423 if (bss[NL80211_BSS_STATUS]) {
1424 switch (nla_get_u32(bss[NL80211_BSS_STATUS])) {
1425 case NL80211_BSS_STATUS_AUTHENTICATED:
1426 printf(" -- authenticated");
1427 break;
1428 case NL80211_BSS_STATUS_ASSOCIATED:
1429 printf(" -- associated");
1430 break;
1431 case NL80211_BSS_STATUS_IBSS_JOINED:
1432 printf(" -- joined");
1433 break;
1434 default:
1435 printf(" -- unknown status: %d",
1436 nla_get_u32(bss[NL80211_BSS_STATUS]));
1437 break;
1438 }
1439 }
1440 printf("\n");
3563f4c5 1441
e7109a8a
JB
1442 if (bss[NL80211_BSS_TSF]) {
1443 unsigned long long tsf;
1444 tsf = (unsigned long long)nla_get_u64(bss[NL80211_BSS_TSF]);
1445 printf("\tTSF: %llu usec (%llud, %.2lld:%.2llu:%.2llu)\n",
1446 tsf, tsf/1000/1000/60/60/24, (tsf/1000/1000/60/60) % 24,
1447 (tsf/1000/1000/60) % 60, (tsf/1000/1000) % 60);
1448 }
2e8b82c1
VK
1449 if (bss[NL80211_BSS_FREQUENCY]) {
1450 int freq = nla_get_u32(bss[NL80211_BSS_FREQUENCY]);
1451 printf("\tfreq: %d\n", freq);
1452 if (freq > 45000)
1453 is_dmg = true;
1454 }
3563f4c5 1455 if (bss[NL80211_BSS_BEACON_INTERVAL])
792172b0 1456 printf("\tbeacon interval: %d TUs\n",
3563f4c5 1457 nla_get_u16(bss[NL80211_BSS_BEACON_INTERVAL]));
92a04ecd
MH
1458 if (bss[NL80211_BSS_CAPABILITY]) {
1459 __u16 capa = nla_get_u16(bss[NL80211_BSS_CAPABILITY]);
1460 printf("\tcapability:");
2e8b82c1
VK
1461 if (is_dmg)
1462 print_capa_dmg(capa);
1463 else
1464 print_capa_non_dmg(capa);
92a04ecd
MH
1465 printf(" (0x%.4x)\n", capa);
1466 }
f2e17e1f
JB
1467 if (bss[NL80211_BSS_SIGNAL_MBM]) {
1468 int s = nla_get_u32(bss[NL80211_BSS_SIGNAL_MBM]);
1469 printf("\tsignal: %d.%.2d dBm\n", s/100, s%100);
1470 }
1471 if (bss[NL80211_BSS_SIGNAL_UNSPEC]) {
1472 unsigned char s = nla_get_u8(bss[NL80211_BSS_SIGNAL_UNSPEC]);
1473 printf("\tsignal: %d/100\n", s);
1474 }
c04a78df
HS
1475 if (bss[NL80211_BSS_SEEN_MS_AGO]) {
1476 int age = nla_get_u32(bss[NL80211_BSS_SEEN_MS_AGO]);
1477 printf("\tlast seen: %d ms ago\n", age);
1478 }
c551449a 1479
1c5bcd9c 1480 if (bss[NL80211_BSS_INFORMATION_ELEMENTS] && show--) {
575280cc
JM
1481 if (bss[NL80211_BSS_BEACON_IES])
1482 printf("\tInformation elements from Probe Response "
1483 "frame:\n");
3563f4c5 1484 print_ies(nla_data(bss[NL80211_BSS_INFORMATION_ELEMENTS]),
764fe753 1485 nla_len(bss[NL80211_BSS_INFORMATION_ELEMENTS]),
febeb0c0 1486 params->unknown, params->type);
575280cc 1487 }
1c5bcd9c 1488 if (bss[NL80211_BSS_BEACON_IES] && show--) {
575280cc
JM
1489 printf("\tInformation elements from Beacon frame:\n");
1490 print_ies(nla_data(bss[NL80211_BSS_BEACON_IES]),
1491 nla_len(bss[NL80211_BSS_BEACON_IES]),
1492 params->unknown, params->type);
1493 }
3563f4c5
JB
1494
1495 return NL_SKIP;
1496}
1497
764fe753 1498static struct scan_params scan_params;
3563f4c5 1499
7c37a24d
JB
1500static int handle_scan_dump(struct nl80211_state *state,
1501 struct nl_cb *cb,
3563f4c5 1502 struct nl_msg *msg,
05514f95
JB
1503 int argc, char **argv,
1504 enum id_input id)
3563f4c5 1505{
764fe753
JB
1506 if (argc > 1)
1507 return 1;
1508
1c5bcd9c
JB
1509 memset(&scan_params, 0, sizeof(scan_params));
1510
764fe753
JB
1511 if (argc == 1 && !strcmp(argv[0], "-u"))
1512 scan_params.unknown = true;
575280cc
JM
1513 else if (argc == 1 && !strcmp(argv[0], "-b"))
1514 scan_params.show_both_ie_sets = true;
764fe753 1515
febeb0c0
JB
1516 scan_params.type = PRINT_SCAN;
1517
764fe753
JB
1518 nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_bss_handler,
1519 &scan_params);
3563f4c5
JB
1520 return 0;
1521}
a5fe4ef2
JB
1522
1523static int handle_scan_combined(struct nl80211_state *state,
1524 struct nl_cb *cb,
1525 struct nl_msg *msg,
05514f95
JB
1526 int argc, char **argv,
1527 enum id_input id)
a5fe4ef2 1528{
559a1713 1529 char **trig_argv;
a5fe4ef2
JB
1530 static char *dump_argv[] = {
1531 NULL,
1532 "scan",
1533 "dump",
92649eab 1534 NULL,
a5fe4ef2
JB
1535 };
1536 static const __u32 cmds[] = {
1537 NL80211_CMD_NEW_SCAN_RESULTS,
1538 NL80211_CMD_SCAN_ABORTED,
1539 };
559a1713 1540 int trig_argc, dump_argc, err;
a5fe4ef2 1541
559a1713
JB
1542 if (argc >= 3 && !strcmp(argv[2], "-u")) {
1543 dump_argc = 4;
1544 dump_argv[3] = "-u";
575280cc
JM
1545 } else if (argc >= 3 && !strcmp(argv[2], "-b")) {
1546 dump_argc = 4;
1547 dump_argv[3] = "-b";
559a1713
JB
1548 } else
1549 dump_argc = 3;
1550
1551 trig_argc = 3 + (argc - 2) + (3 - dump_argc);
1552 trig_argv = calloc(trig_argc, sizeof(*trig_argv));
1553 if (!trig_argv)
1554 return -ENOMEM;
a5fe4ef2 1555 trig_argv[0] = argv[0];
559a1713
JB
1556 trig_argv[1] = "scan";
1557 trig_argv[2] = "trigger";
1558 int i;
1559 for (i = 0; i < argc - 2 - (dump_argc - 3); i++)
1560 trig_argv[i + 3] = argv[i + 2 + (dump_argc - 3)];
75f4204c 1561 err = handle_cmd(state, id, trig_argc, trig_argv);
559a1713 1562 free(trig_argv);
a5fe4ef2
JB
1563 if (err)
1564 return err;
1565
61725dbe
JB
1566 /*
1567 * WARNING: DO NOT COPY THIS CODE INTO YOUR APPLICATION
1568 *
1569 * This code has a bug, which requires creating a separate
1570 * nl80211 socket to fix:
1571 * It is possible for a NL80211_CMD_NEW_SCAN_RESULTS or
1572 * NL80211_CMD_SCAN_ABORTED message to be sent by the kernel
1573 * before (!) we listen to it, because we only start listening
1574 * after we send our scan request.
1575 *
1576 * Doing it the other way around has a race condition as well,
1577 * if you first open the events socket you may get a notification
1578 * for a previous scan.
1579 *
1580 * The only proper way to fix this would be to listen to events
1581 * before sending the command, and for the kernel to send the
1582 * scan request along with the event, so that you can match up
1583 * whether the scan you requested was finished or aborted (this
1584 * may result in processing a scan that another application
1585 * requested, but that doesn't seem to be a problem).
1586 *
1587 * Alas, the kernel doesn't do that (yet).
1588 */
1589
a5fe4ef2
JB
1590 if (listen_events(state, ARRAY_SIZE(cmds), cmds) ==
1591 NL80211_CMD_SCAN_ABORTED) {
1592 printf("scan aborted!\n");
1593 return 0;
1594 }
1595
1596 dump_argv[0] = argv[0];
75f4204c 1597 return handle_cmd(state, id, dump_argc, dump_argv);
a5fe4ef2 1598}
851d35c2 1599TOPLEVEL(scan, "[-u] [freq <freq>*] [ies <hex as 00:11:..>] [meshid <meshid>] [lowpri,flush,ap-force] [ssid <ssid>*|passive]", 0, 0,
6ca98d28
JB
1600 CIB_NETDEV, handle_scan_combined,
1601 "Scan on the given frequencies and probe for the given SSIDs\n"
1602 "(or wildcard if not given) unless passive scanning is requested.\n"
64797a7f
JB
1603 "If -u is specified print unknown data in the scan results.\n"
1604 "Specified (vendor) IEs must be well-formed.");
4698bfc2
JB
1605COMMAND(scan, dump, "[-u]",
1606 NL80211_CMD_GET_SCAN, NLM_F_DUMP, CIB_NETDEV, handle_scan_dump,
1607 "Dump the current scan results. If -u is specified, print unknown\n"
1608 "data in scan results.");
851d35c2 1609COMMAND(scan, trigger, "[freq <freq>*] [ies <hex as 00:11:..>] [meshid <meshid>] [lowpri,flush,ap-force] [ssid <ssid>*|passive]",
4698bfc2
JB
1610 NL80211_CMD_TRIGGER_SCAN, 0, CIB_NETDEV, handle_scan,
1611 "Trigger a scan on the given frequencies with probing for the given\n"
1612 "SSIDs (or wildcard if not given) unless passive scanning is requested.");