]> git.ipfire.org Git - thirdparty/hostap.git/blob - wpa_supplicant/ctrl_iface.c
projects / thirdparty / hostap.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
P2P: Add VHT parameter to P2P operations
[thirdparty/hostap.git] / wpa_supplicant / ctrl_iface.c
1 /*
2 * WPA Supplicant / Control interface (shared code for all backends)
3 * Copyright (c) 2004-2013, Jouni Malinen <j@w1.fi>
4 *
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
7 */
8
9 #include "utils/includes.h"
10
11 #include "utils/common.h"
12 #include "utils/eloop.h"
13 #include "common/version.h"
14 #include "common/ieee802_11_defs.h"
15 #include "common/ieee802_11_common.h"
16 #include "common/wpa_ctrl.h"
17 #include "eap_peer/eap.h"
18 #include "eapol_supp/eapol_supp_sm.h"
19 #include "rsn_supp/wpa.h"
20 #include "rsn_supp/preauth.h"
21 #include "rsn_supp/pmksa_cache.h"
22 #include "l2_packet/l2_packet.h"
23 #include "wps/wps.h"
24 #include "config.h"
25 #include "wpa_supplicant_i.h"
26 #include "driver_i.h"
27 #include "wps_supplicant.h"
28 #include "ibss_rsn.h"
29 #include "ap.h"
30 #include "p2p_supplicant.h"
31 #include "p2p/p2p.h"
32 #include "hs20_supplicant.h"
33 #include "wifi_display.h"
34 #include "notify.h"
35 #include "bss.h"
36 #include "scan.h"
37 #include "ctrl_iface.h"
38 #include "interworking.h"
39 #include "blacklist.h"
40 #include "autoscan.h"
41 #include "wnm_sta.h"
42
43 extern struct wpa_driver_ops *wpa_drivers[];
44
45 static int wpa_supplicant_global_iface_list(struct wpa_global *global,
46 char *buf, int len);
47 static int wpa_supplicant_global_iface_interfaces(struct wpa_global *global,
48 char *buf, int len);
49
50
51 static int pno_start(struct wpa_supplicant *wpa_s)
52 {
53 int ret, interval;
54 size_t i, num_ssid;
55 struct wpa_ssid *ssid;
56 struct wpa_driver_scan_params params;
57
58 if (wpa_s->pno)
59 return 0;
60
61 if (wpa_s->wpa_state == WPA_SCANNING) {
62 wpa_supplicant_cancel_sched_scan(wpa_s);
63 wpa_supplicant_cancel_scan(wpa_s);
64 }
65
66 os_memset(&params, 0, sizeof(params));
67
68 num_ssid = 0;
69 ssid = wpa_s->conf->ssid;
70 while (ssid) {
71 if (!wpas_network_disabled(wpa_s, ssid))
72 num_ssid++;
73 ssid = ssid->next;
74 }
75 if (num_ssid > WPAS_MAX_SCAN_SSIDS) {
76 wpa_printf(MSG_DEBUG, "PNO: Use only the first %u SSIDs from "
77 "%u", WPAS_MAX_SCAN_SSIDS, (unsigned int) num_ssid);
78 num_ssid = WPAS_MAX_SCAN_SSIDS;
79 }
80
81 if (num_ssid == 0) {
82 wpa_printf(MSG_DEBUG, "PNO: No configured SSIDs");
83 return -1;
84 }
85
86 params.filter_ssids = os_malloc(sizeof(struct wpa_driver_scan_filter) *
87 num_ssid);
88 if (params.filter_ssids == NULL)
89 return -1;
90 i = 0;
91 ssid = wpa_s->conf->ssid;
92 while (ssid) {
93 if (!wpas_network_disabled(wpa_s, ssid)) {
94 params.ssids[i].ssid = ssid->ssid;
95 params.ssids[i].ssid_len = ssid->ssid_len;
96 params.num_ssids++;
97 os_memcpy(params.filter_ssids[i].ssid, ssid->ssid,
98 ssid->ssid_len);
99 params.filter_ssids[i].ssid_len = ssid->ssid_len;
100 params.num_filter_ssids++;
101 i++;
102 if (i == num_ssid)
103 break;
104 }
105 ssid = ssid->next;
106 }
107
108 if (wpa_s->conf->filter_rssi)
109 params.filter_rssi = wpa_s->conf->filter_rssi;
110
111 interval = wpa_s->conf->sched_scan_interval ?
112 wpa_s->conf->sched_scan_interval : 10;
113
114 ret = wpa_drv_sched_scan(wpa_s, &params, interval * 1000);
115 os_free(params.filter_ssids);
116 if (ret == 0)
117 wpa_s->pno = 1;
118 return ret;
119 }
120
121
122 static int pno_stop(struct wpa_supplicant *wpa_s)
123 {
124 int ret = 0;
125
126 if (wpa_s->pno) {
127 wpa_s->pno = 0;
128 ret = wpa_drv_stop_sched_scan(wpa_s);
129 }
130
131 if (wpa_s->wpa_state == WPA_SCANNING)
132 wpa_supplicant_req_scan(wpa_s, 0, 0);
133
134 return ret;
135 }
136
137
138 static int set_bssid_filter(struct wpa_supplicant *wpa_s, char *val)
139 {
140 char *pos;
141 u8 addr[ETH_ALEN], *filter = NULL, *n;
142 size_t count = 0;
143
144 pos = val;
145 while (pos) {
146 if (*pos == '\0')
147 break;
148 if (hwaddr_aton(pos, addr)) {
149 os_free(filter);
150 return -1;
151 }
152 n = os_realloc_array(filter, count + 1, ETH_ALEN);
153 if (n == NULL) {
154 os_free(filter);
155 return -1;
156 }
157 filter = n;
158 os_memcpy(filter + count * ETH_ALEN, addr, ETH_ALEN);
159 count++;
160
161 pos = os_strchr(pos, ' ');
162 if (pos)
163 pos++;
164 }
165
166 wpa_hexdump(MSG_DEBUG, "bssid_filter", filter, count * ETH_ALEN);
167 os_free(wpa_s->bssid_filter);
168 wpa_s->bssid_filter = filter;
169 wpa_s->bssid_filter_count = count;
170
171 return 0;
172 }
173
174
175 static int set_disallow_aps(struct wpa_supplicant *wpa_s, char *val)
176 {
177 char *pos;
178 u8 addr[ETH_ALEN], *bssid = NULL, *n;
179 struct wpa_ssid_value *ssid = NULL, *ns;
180 size_t count = 0, ssid_count = 0;
181 struct wpa_ssid *c;
182
183 /*
184 * disallow_list ::= <ssid_spec> | <bssid_spec> | <disallow_list> | “”
185 * SSID_SPEC ::= ssid <SSID_HEX>
186 * BSSID_SPEC ::= bssid <BSSID_HEX>
187 */
188
189 pos = val;
190 while (pos) {
191 if (*pos == '\0')
192 break;
193 if (os_strncmp(pos, "bssid ", 6) == 0) {
194 int res;
195 pos += 6;
196 res = hwaddr_aton2(pos, addr);
197 if (res < 0) {
198 os_free(ssid);
199 os_free(bssid);
200 wpa_printf(MSG_DEBUG, "Invalid disallow_aps "
201 "BSSID value '%s'", pos);
202 return -1;
203 }
204 pos += res;
205 n = os_realloc_array(bssid, count + 1, ETH_ALEN);
206 if (n == NULL) {
207 os_free(ssid);
208 os_free(bssid);
209 return -1;
210 }
211 bssid = n;
212 os_memcpy(bssid + count * ETH_ALEN, addr, ETH_ALEN);
213 count++;
214 } else if (os_strncmp(pos, "ssid ", 5) == 0) {
215 char *end;
216 pos += 5;
217
218 end = pos;
219 while (*end) {
220 if (*end == '\0' || *end == ' ')
221 break;
222 end++;
223 }
224
225 ns = os_realloc_array(ssid, ssid_count + 1,
226 sizeof(struct wpa_ssid_value));
227 if (ns == NULL) {
228 os_free(ssid);
229 os_free(bssid);
230 return -1;
231 }
232 ssid = ns;
233
234 if ((end - pos) & 0x01 || end - pos > 2 * 32 ||
235 hexstr2bin(pos, ssid[ssid_count].ssid,
236 (end - pos) / 2) < 0) {
237 os_free(ssid);
238 os_free(bssid);
239 wpa_printf(MSG_DEBUG, "Invalid disallow_aps "
240 "SSID value '%s'", pos);
241 return -1;
242 }
243 ssid[ssid_count].ssid_len = (end - pos) / 2;
244 wpa_hexdump_ascii(MSG_DEBUG, "disallow_aps SSID",
245 ssid[ssid_count].ssid,
246 ssid[ssid_count].ssid_len);
247 ssid_count++;
248 pos = end;
249 } else {
250 wpa_printf(MSG_DEBUG, "Unexpected disallow_aps value "
251 "'%s'", pos);
252 os_free(ssid);
253 os_free(bssid);
254 return -1;
255 }
256
257 pos = os_strchr(pos, ' ');
258 if (pos)
259 pos++;
260 }
261
262 wpa_hexdump(MSG_DEBUG, "disallow_aps_bssid", bssid, count * ETH_ALEN);
263 os_free(wpa_s->disallow_aps_bssid);
264 wpa_s->disallow_aps_bssid = bssid;
265 wpa_s->disallow_aps_bssid_count = count;
266
267 wpa_printf(MSG_DEBUG, "disallow_aps_ssid_count %d", (int) ssid_count);
268 os_free(wpa_s->disallow_aps_ssid);
269 wpa_s->disallow_aps_ssid = ssid;
270 wpa_s->disallow_aps_ssid_count = ssid_count;
271
272 if (!wpa_s->current_ssid || wpa_s->wpa_state < WPA_AUTHENTICATING)
273 return 0;
274
275 c = wpa_s->current_ssid;
276 if (c->mode != WPAS_MODE_INFRA && c->mode != WPAS_MODE_IBSS)
277 return 0;
278
279 if (!disallowed_bssid(wpa_s, wpa_s->bssid) &&
280 !disallowed_ssid(wpa_s, c->ssid, c->ssid_len))
281 return 0;
282
283 wpa_printf(MSG_DEBUG, "Disconnect and try to find another network "
284 "because current AP was marked disallowed");
285
286 #ifdef CONFIG_SME
287 wpa_s->sme.prev_bssid_set = 0;
288 #endif /* CONFIG_SME */
289 wpa_s->reassociate = 1;
290 wpa_supplicant_deauthenticate(wpa_s, WLAN_REASON_DEAUTH_LEAVING);
291 wpa_supplicant_req_scan(wpa_s, 0, 0);
292
293 return 0;
294 }
295
296
297 static int wpa_supplicant_ctrl_iface_set(struct wpa_supplicant *wpa_s,
298 char *cmd)
299 {
300 char *value;
301 int ret = 0;
302
303 value = os_strchr(cmd, ' ');
304 if (value == NULL)
305 return -1;
306 *value++ = '\0';
307
308 wpa_printf(MSG_DEBUG, "CTRL_IFACE SET '%s'='%s'", cmd, value);
309 if (os_strcasecmp(cmd, "EAPOL::heldPeriod") == 0) {
310 eapol_sm_configure(wpa_s->eapol,
311 atoi(value), -1, -1, -1);
312 } else if (os_strcasecmp(cmd, "EAPOL::authPeriod") == 0) {
313 eapol_sm_configure(wpa_s->eapol,
314 -1, atoi(value), -1, -1);
315 } else if (os_strcasecmp(cmd, "EAPOL::startPeriod") == 0) {
316 eapol_sm_configure(wpa_s->eapol,
317 -1, -1, atoi(value), -1);
318 } else if (os_strcasecmp(cmd, "EAPOL::maxStart") == 0) {
319 eapol_sm_configure(wpa_s->eapol,
320 -1, -1, -1, atoi(value));
321 } else if (os_strcasecmp(cmd, "dot11RSNAConfigPMKLifetime") == 0) {
322 if (wpa_sm_set_param(wpa_s->wpa, RSNA_PMK_LIFETIME,
323 atoi(value)))
324 ret = -1;
325 } else if (os_strcasecmp(cmd, "dot11RSNAConfigPMKReauthThreshold") ==
326 0) {
327 if (wpa_sm_set_param(wpa_s->wpa, RSNA_PMK_REAUTH_THRESHOLD,
328 atoi(value)))
329 ret = -1;
330 } else if (os_strcasecmp(cmd, "dot11RSNAConfigSATimeout") == 0) {
331 if (wpa_sm_set_param(wpa_s->wpa, RSNA_SA_TIMEOUT, atoi(value)))
332 ret = -1;
333 } else if (os_strcasecmp(cmd, "wps_fragment_size") == 0) {
334 wpa_s->wps_fragment_size = atoi(value);
335 #ifdef CONFIG_WPS_TESTING
336 } else if (os_strcasecmp(cmd, "wps_version_number") == 0) {
337 long int val;
338 val = strtol(value, NULL, 0);
339 if (val < 0 || val > 0xff) {
340 ret = -1;
341 wpa_printf(MSG_DEBUG, "WPS: Invalid "
342 "wps_version_number %ld", val);
343 } else {
344 wps_version_number = val;
345 wpa_printf(MSG_DEBUG, "WPS: Testing - force WPS "
346 "version %u.%u",
347 (wps_version_number & 0xf0) >> 4,
348 wps_version_number & 0x0f);
349 }
350 } else if (os_strcasecmp(cmd, "wps_testing_dummy_cred") == 0) {
351 wps_testing_dummy_cred = atoi(value);
352 wpa_printf(MSG_DEBUG, "WPS: Testing - dummy_cred=%d",
353 wps_testing_dummy_cred);
354 #endif /* CONFIG_WPS_TESTING */
355 } else if (os_strcasecmp(cmd, "ampdu") == 0) {
356 if (wpa_drv_ampdu(wpa_s, atoi(value)) < 0)
357 ret = -1;
358 #ifdef CONFIG_TDLS_TESTING
359 } else if (os_strcasecmp(cmd, "tdls_testing") == 0) {
360 extern unsigned int tdls_testing;
361 tdls_testing = strtol(value, NULL, 0);
362 wpa_printf(MSG_DEBUG, "TDLS: tdls_testing=0x%x", tdls_testing);
363 #endif /* CONFIG_TDLS_TESTING */
364 #ifdef CONFIG_TDLS
365 } else if (os_strcasecmp(cmd, "tdls_disabled") == 0) {
366 int disabled = atoi(value);
367 wpa_printf(MSG_DEBUG, "TDLS: tdls_disabled=%d", disabled);
368 if (disabled) {
369 if (wpa_drv_tdls_oper(wpa_s, TDLS_DISABLE, NULL) < 0)
370 ret = -1;
371 } else if (wpa_drv_tdls_oper(wpa_s, TDLS_ENABLE, NULL) < 0)
372 ret = -1;
373 wpa_tdls_enable(wpa_s->wpa, !disabled);
374 #endif /* CONFIG_TDLS */
375 } else if (os_strcasecmp(cmd, "pno") == 0) {
376 if (atoi(value))
377 ret = pno_start(wpa_s);
378 else
379 ret = pno_stop(wpa_s);
380 } else if (os_strcasecmp(cmd, "radio_disabled") == 0) {
381 int disabled = atoi(value);
382 if (wpa_drv_radio_disable(wpa_s, disabled) < 0)
383 ret = -1;
384 else if (disabled)
385 wpa_supplicant_set_state(wpa_s, WPA_INACTIVE);
386 } else if (os_strcasecmp(cmd, "uapsd") == 0) {
387 if (os_strcmp(value, "disable") == 0)
388 wpa_s->set_sta_uapsd = 0;
389 else {
390 int be, bk, vi, vo;
391 char *pos;
392 /* format: BE,BK,VI,VO;max SP Length */
393 be = atoi(value);
394 pos = os_strchr(value, ',');
395 if (pos == NULL)
396 return -1;
397 pos++;
398 bk = atoi(pos);
399 pos = os_strchr(pos, ',');
400 if (pos == NULL)
401 return -1;
402 pos++;
403 vi = atoi(pos);
404 pos = os_strchr(pos, ',');
405 if (pos == NULL)
406 return -1;
407 pos++;
408 vo = atoi(pos);
409 /* ignore max SP Length for now */
410
411 wpa_s->set_sta_uapsd = 1;
412 wpa_s->sta_uapsd = 0;
413 if (be)
414 wpa_s->sta_uapsd |= BIT(0);
415 if (bk)
416 wpa_s->sta_uapsd |= BIT(1);
417 if (vi)
418 wpa_s->sta_uapsd |= BIT(2);
419 if (vo)
420 wpa_s->sta_uapsd |= BIT(3);
421 }
422 } else if (os_strcasecmp(cmd, "ps") == 0) {
423 ret = wpa_drv_set_p2p_powersave(wpa_s, atoi(value), -1, -1);
424 #ifdef CONFIG_WIFI_DISPLAY
425 } else if (os_strcasecmp(cmd, "wifi_display") == 0) {
426 wifi_display_enable(wpa_s->global, !!atoi(value));
427 #endif /* CONFIG_WIFI_DISPLAY */
428 } else if (os_strcasecmp(cmd, "bssid_filter") == 0) {
429 ret = set_bssid_filter(wpa_s, value);
430 } else if (os_strcasecmp(cmd, "disallow_aps") == 0) {
431 ret = set_disallow_aps(wpa_s, value);
432 } else if (os_strcasecmp(cmd, "no_keep_alive") == 0) {
433 wpa_s->no_keep_alive = !!atoi(value);
434 } else {
435 value[-1] = '=';
436 ret = wpa_config_process_global(wpa_s->conf, cmd, -1);
437 if (ret == 0)
438 wpa_supplicant_update_config(wpa_s);
439 }
440
441 return ret;
442 }
443
444
445 static int wpa_supplicant_ctrl_iface_get(struct wpa_supplicant *wpa_s,
446 char *cmd, char *buf, size_t buflen)
447 {
448 int res = -1;
449
450 wpa_printf(MSG_DEBUG, "CTRL_IFACE GET '%s'", cmd);
451
452 if (os_strcmp(cmd, "version") == 0) {
453 res = os_snprintf(buf, buflen, "%s", VERSION_STR);
454 } else if (os_strcasecmp(cmd, "country") == 0) {
455 if (wpa_s->conf->country[0] && wpa_s->conf->country[1])
456 res = os_snprintf(buf, buflen, "%c%c",
457 wpa_s->conf->country[0],
458 wpa_s->conf->country[1]);
459 #ifdef CONFIG_WIFI_DISPLAY
460 } else if (os_strcasecmp(cmd, "wifi_display") == 0) {
461 res = os_snprintf(buf, buflen, "%d",
462 wpa_s->global->wifi_display);
463 if (res < 0 || (unsigned int) res >= buflen)
464 return -1;
465 return res;
466 #endif /* CONFIG_WIFI_DISPLAY */
467 #ifdef CONFIG_TESTING_GET_GTK
468 } else if (os_strcmp(cmd, "gtk") == 0) {
469 if (wpa_s->last_gtk_len == 0)
470 return -1;
471 res = wpa_snprintf_hex(buf, buflen, wpa_s->last_gtk,
472 wpa_s->last_gtk_len);
473 return res;
474 #endif /* CONFIG_TESTING_GET_GTK */
475 }
476
477 if (res < 0 || (unsigned int) res >= buflen)
478 return -1;
479 return res;
480 }
481
482
483 #ifdef IEEE8021X_EAPOL
484 static int wpa_supplicant_ctrl_iface_preauth(struct wpa_supplicant *wpa_s,
485 char *addr)
486 {
487 u8 bssid[ETH_ALEN];
488 struct wpa_ssid *ssid = wpa_s->current_ssid;
489
490 if (hwaddr_aton(addr, bssid)) {
491 wpa_printf(MSG_DEBUG, "CTRL_IFACE PREAUTH: invalid address "
492 "'%s'", addr);
493 return -1;
494 }
495
496 wpa_printf(MSG_DEBUG, "CTRL_IFACE PREAUTH " MACSTR, MAC2STR(bssid));
497 rsn_preauth_deinit(wpa_s->wpa);
498 if (rsn_preauth_init(wpa_s->wpa, bssid, ssid ? &ssid->eap : NULL))
499 return -1;
500
501 return 0;
502 }
503 #endif /* IEEE8021X_EAPOL */
504
505
506 #ifdef CONFIG_PEERKEY
507 /* MLME-STKSTART.request(peer) */
508 static int wpa_supplicant_ctrl_iface_stkstart(
509 struct wpa_supplicant *wpa_s, char *addr)
510 {
511 u8 peer[ETH_ALEN];
512
513 if (hwaddr_aton(addr, peer)) {
514 wpa_printf(MSG_DEBUG, "CTRL_IFACE STKSTART: invalid "
515 "address '%s'", addr);
516 return -1;
517 }
518
519 wpa_printf(MSG_DEBUG, "CTRL_IFACE STKSTART " MACSTR,
520 MAC2STR(peer));
521
522 return wpa_sm_stkstart(wpa_s->wpa, peer);
523 }
524 #endif /* CONFIG_PEERKEY */
525
526
527 #ifdef CONFIG_TDLS
528
529 static int wpa_supplicant_ctrl_iface_tdls_discover(
530 struct wpa_supplicant *wpa_s, char *addr)
531 {
532 u8 peer[ETH_ALEN];
533 int ret;
534
535 if (hwaddr_aton(addr, peer)) {
536 wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_DISCOVER: invalid "
537 "address '%s'", addr);
538 return -1;
539 }
540
541 wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_DISCOVER " MACSTR,
542 MAC2STR(peer));
543
544 if (wpa_tdls_is_external_setup(wpa_s->wpa))
545 ret = wpa_tdls_send_discovery_request(wpa_s->wpa, peer);
546 else
547 ret = wpa_drv_tdls_oper(wpa_s, TDLS_DISCOVERY_REQ, peer);
548
549 return ret;
550 }
551
552
553 static int wpa_supplicant_ctrl_iface_tdls_setup(
554 struct wpa_supplicant *wpa_s, char *addr)
555 {
556 u8 peer[ETH_ALEN];
557 int ret;
558
559 if (hwaddr_aton(addr, peer)) {
560 wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_SETUP: invalid "
561 "address '%s'", addr);
562 return -1;
563 }
564
565 wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_SETUP " MACSTR,
566 MAC2STR(peer));
567
568 wpa_tdls_remove(wpa_s->wpa, peer);
569
570 if (wpa_tdls_is_external_setup(wpa_s->wpa))
571 ret = wpa_tdls_start(wpa_s->wpa, peer);
572 else
573 ret = wpa_drv_tdls_oper(wpa_s, TDLS_SETUP, peer);
574
575 return ret;
576 }
577
578
579 static int wpa_supplicant_ctrl_iface_tdls_teardown(
580 struct wpa_supplicant *wpa_s, char *addr)
581 {
582 u8 peer[ETH_ALEN];
583 int ret;
584
585 if (hwaddr_aton(addr, peer)) {
586 wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_TEARDOWN: invalid "
587 "address '%s'", addr);
588 return -1;
589 }
590
591 wpa_printf(MSG_DEBUG, "CTRL_IFACE TDLS_TEARDOWN " MACSTR,
592 MAC2STR(peer));
593
594 if (wpa_tdls_is_external_setup(wpa_s->wpa))
595 ret = wpa_tdls_teardown_link(
596 wpa_s->wpa, peer,
597 WLAN_REASON_TDLS_TEARDOWN_UNSPECIFIED);
598 else
599 ret = wpa_drv_tdls_oper(wpa_s, TDLS_TEARDOWN, peer);
600
601 return ret;
602 }
603
604 #endif /* CONFIG_TDLS */
605
606
607 #ifdef CONFIG_IEEE80211R
608 static int wpa_supplicant_ctrl_iface_ft_ds(
609 struct wpa_supplicant *wpa_s, char *addr)
610 {
611 u8 target_ap[ETH_ALEN];
612 struct wpa_bss *bss;
613 const u8 *mdie;
614
615 if (hwaddr_aton(addr, target_ap)) {
616 wpa_printf(MSG_DEBUG, "CTRL_IFACE FT_DS: invalid "
617 "address '%s'", addr);
618 return -1;
619 }
620
621 wpa_printf(MSG_DEBUG, "CTRL_IFACE FT_DS " MACSTR, MAC2STR(target_ap));
622
623 bss = wpa_bss_get_bssid(wpa_s, target_ap);
624 if (bss)
625 mdie = wpa_bss_get_ie(bss, WLAN_EID_MOBILITY_DOMAIN);
626 else
627 mdie = NULL;
628
629 return wpa_ft_start_over_ds(wpa_s->wpa, target_ap, mdie);
630 }
631 #endif /* CONFIG_IEEE80211R */
632
633
634 #ifdef CONFIG_WPS
635 static int wpa_supplicant_ctrl_iface_wps_pbc(struct wpa_supplicant *wpa_s,
636 char *cmd)
637 {
638 u8 bssid[ETH_ALEN], *_bssid = bssid;
639 #ifdef CONFIG_P2P
640 u8 p2p_dev_addr[ETH_ALEN];
641 #endif /* CONFIG_P2P */
642 #ifdef CONFIG_AP
643 u8 *_p2p_dev_addr = NULL;
644 #endif /* CONFIG_AP */
645
646 if (cmd == NULL || os_strcmp(cmd, "any") == 0) {
647 _bssid = NULL;
648 #ifdef CONFIG_P2P
649 } else if (os_strncmp(cmd, "p2p_dev_addr=", 13) == 0) {
650 if (hwaddr_aton(cmd + 13, p2p_dev_addr)) {
651 wpa_printf(MSG_DEBUG, "CTRL_IFACE WPS_PBC: invalid "
652 "P2P Device Address '%s'",
653 cmd + 13);
654 return -1;
655 }
656 _p2p_dev_addr = p2p_dev_addr;
657 #endif /* CONFIG_P2P */
658 } else if (hwaddr_aton(cmd, bssid)) {
659 wpa_printf(MSG_DEBUG, "CTRL_IFACE WPS_PBC: invalid BSSID '%s'",
660 cmd);
661 return -1;
662 }
663
664 #ifdef CONFIG_AP
665 if (wpa_s->ap_iface)
666 return wpa_supplicant_ap_wps_pbc(wpa_s, _bssid, _p2p_dev_addr);
667 #endif /* CONFIG_AP */
668
669 return wpas_wps_start_pbc(wpa_s, _bssid, 0);
670 }
671
672
673 static int wpa_supplicant_ctrl_iface_wps_pin(struct wpa_supplicant *wpa_s,
674 char *cmd, char *buf,
675 size_t buflen)
676 {
677 u8 bssid[ETH_ALEN], *_bssid = bssid;
678 char *pin;
679 int ret;
680
681 pin = os_strchr(cmd, ' ');
682 if (pin)
683 *pin++ = '\0';
684
685 if (os_strcmp(cmd, "any") == 0)
686 _bssid = NULL;
687 else if (os_strcmp(cmd, "get") == 0) {
688 ret = wps_generate_pin();
689 goto done;
690 } else if (hwaddr_aton(cmd, bssid)) {
691 wpa_printf(MSG_DEBUG, "CTRL_IFACE WPS_PIN: invalid BSSID '%s'",
692 cmd);
693 return -1;
694 }
695
696 #ifdef CONFIG_AP
697 if (wpa_s->ap_iface) {
698 int timeout = 0;
699 char *pos;
700
701 if (pin) {
702 pos = os_strchr(pin, ' ');
703 if (pos) {
704 *pos++ = '\0';
705 timeout = atoi(pos);
706 }
707 }
708
709 return wpa_supplicant_ap_wps_pin(wpa_s, _bssid, pin,
710 buf, buflen, timeout);
711 }
712 #endif /* CONFIG_AP */
713
714 if (pin) {
715 ret = wpas_wps_start_pin(wpa_s, _bssid, pin, 0,
716 DEV_PW_DEFAULT);
717 if (ret < 0)
718 return -1;
719 ret = os_snprintf(buf, buflen, "%s", pin);
720 if (ret < 0 || (size_t) ret >= buflen)
721 return -1;
722 return ret;
723 }
724
725 ret = wpas_wps_start_pin(wpa_s, _bssid, NULL, 0, DEV_PW_DEFAULT);
726 if (ret < 0)
727 return -1;
728
729 done:
730 /* Return the generated PIN */
731 ret = os_snprintf(buf, buflen, "%08d", ret);
732 if (ret < 0 || (size_t) ret >= buflen)
733 return -1;
734 return ret;
735 }
736
737
738 static int wpa_supplicant_ctrl_iface_wps_check_pin(
739 struct wpa_supplicant *wpa_s, char *cmd, char *buf, size_t buflen)
740 {
741 char pin[9];
742 size_t len;
743 char *pos;
744 int ret;
745
746 wpa_hexdump_ascii_key(MSG_DEBUG, "WPS_CHECK_PIN",
747 (u8 *) cmd, os_strlen(cmd));
748 for (pos = cmd, len = 0; *pos != '\0'; pos++) {
749 if (*pos < '0' || *pos > '9')
750 continue;
751 pin[len++] = *pos;
752 if (len == 9) {
753 wpa_printf(MSG_DEBUG, "WPS: Too long PIN");
754 return -1;
755 }
756 }
757 if (len != 4 && len != 8) {
758 wpa_printf(MSG_DEBUG, "WPS: Invalid PIN length %d", (int) len);
759 return -1;
760 }
761 pin[len] = '\0';
762
763 if (len == 8) {
764 unsigned int pin_val;
765 pin_val = atoi(pin);
766 if (!wps_pin_valid(pin_val)) {
767 wpa_printf(MSG_DEBUG, "WPS: Invalid checksum digit");
768 ret = os_snprintf(buf, buflen, "FAIL-CHECKSUM\n");
769 if (ret < 0 || (size_t) ret >= buflen)
770 return -1;
771 return ret;
772 }
773 }
774
775 ret = os_snprintf(buf, buflen, "%s", pin);
776 if (ret < 0 || (size_t) ret >= buflen)
777 return -1;
778
779 return ret;
780 }
781
782
783 #ifdef CONFIG_WPS_NFC
784
785 static int wpa_supplicant_ctrl_iface_wps_nfc(struct wpa_supplicant *wpa_s,
786 char *cmd)
787 {
788 u8 bssid[ETH_ALEN], *_bssid = bssid;
789
790 if (cmd == NULL || cmd[0] == '\0')
791 _bssid = NULL;
792 else if (hwaddr_aton(cmd, bssid))
793 return -1;
794
795 return wpas_wps_start_nfc(wpa_s, _bssid);
796 }
797
798
799 static int wpa_supplicant_ctrl_iface_wps_nfc_config_token(
800 struct wpa_supplicant *wpa_s, char *cmd, char *reply, size_t max_len)
801 {
802 int ndef;
803 struct wpabuf *buf;
804 int res;
805 char *pos;
806
807 pos = os_strchr(cmd, ' ');
808 if (pos)
809 *pos++ = '\0';
810 if (os_strcmp(cmd, "WPS") == 0)
811 ndef = 0;
812 else if (os_strcmp(cmd, "NDEF") == 0)
813 ndef = 1;
814 else
815 return -1;
816
817 buf = wpas_wps_nfc_config_token(wpa_s, ndef, pos);
818 if (buf == NULL)
819 return -1;
820
821 res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
822 wpabuf_len(buf));
823 reply[res++] = '\n';
824 reply[res] = '\0';
825
826 wpabuf_free(buf);
827
828 return res;
829 }
830
831
832 static int wpa_supplicant_ctrl_iface_wps_nfc_token(
833 struct wpa_supplicant *wpa_s, char *cmd, char *reply, size_t max_len)
834 {
835 int ndef;
836 struct wpabuf *buf;
837 int res;
838
839 if (os_strcmp(cmd, "WPS") == 0)
840 ndef = 0;
841 else if (os_strcmp(cmd, "NDEF") == 0)
842 ndef = 1;
843 else
844 return -1;
845
846 buf = wpas_wps_nfc_token(wpa_s, ndef);
847 if (buf == NULL)
848 return -1;
849
850 res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
851 wpabuf_len(buf));
852 reply[res++] = '\n';
853 reply[res] = '\0';
854
855 wpabuf_free(buf);
856
857 return res;
858 }
859
860
861 static int wpa_supplicant_ctrl_iface_wps_nfc_tag_read(
862 struct wpa_supplicant *wpa_s, char *pos)
863 {
864 size_t len;
865 struct wpabuf *buf;
866 int ret;
867
868 len = os_strlen(pos);
869 if (len & 0x01)
870 return -1;
871 len /= 2;
872
873 buf = wpabuf_alloc(len);
874 if (buf == NULL)
875 return -1;
876 if (hexstr2bin(pos, wpabuf_put(buf, len), len) < 0) {
877 wpabuf_free(buf);
878 return -1;
879 }
880
881 ret = wpas_wps_nfc_tag_read(wpa_s, buf);
882 wpabuf_free(buf);
883
884 return ret;
885 }
886
887
888 static int wpas_ctrl_nfc_get_handover_req_wps(struct wpa_supplicant *wpa_s,
889 char *reply, size_t max_len,
890 int cr)
891 {
892 struct wpabuf *buf;
893 int res;
894
895 buf = wpas_wps_nfc_handover_req(wpa_s, cr);
896 if (buf == NULL)
897 return -1;
898
899 res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
900 wpabuf_len(buf));
901 reply[res++] = '\n';
902 reply[res] = '\0';
903
904 wpabuf_free(buf);
905
906 return res;
907 }
908
909
910 static int wpas_ctrl_nfc_get_handover_req(struct wpa_supplicant *wpa_s,
911 char *cmd, char *reply,
912 size_t max_len)
913 {
914 char *pos;
915
916 pos = os_strchr(cmd, ' ');
917 if (pos == NULL)
918 return -1;
919 *pos++ = '\0';
920
921 if (os_strcmp(cmd, "NDEF") != 0)
922 return -1;
923
924 if (os_strcmp(pos, "WPS") == 0 || os_strcmp(pos, "WPS-CR") == 0) {
925 return wpas_ctrl_nfc_get_handover_req_wps(
926 wpa_s, reply, max_len, os_strcmp(pos, "WPS-CR") == 0);
927 }
928
929 return -1;
930 }
931
932
933 static int wpas_ctrl_nfc_get_handover_sel_wps(struct wpa_supplicant *wpa_s,
934 char *reply, size_t max_len,
935 int ndef, int cr, char *uuid)
936 {
937 struct wpabuf *buf;
938 int res;
939
940 buf = wpas_wps_nfc_handover_sel(wpa_s, ndef, cr, uuid);
941 if (buf == NULL)
942 return -1;
943
944 res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
945 wpabuf_len(buf));
946 reply[res++] = '\n';
947 reply[res] = '\0';
948
949 wpabuf_free(buf);
950
951 return res;
952 }
953
954
955 static int wpas_ctrl_nfc_get_handover_sel(struct wpa_supplicant *wpa_s,
956 char *cmd, char *reply,
957 size_t max_len)
958 {
959 char *pos, *pos2;
960 int ndef;
961
962 pos = os_strchr(cmd, ' ');
963 if (pos == NULL)
964 return -1;
965 *pos++ = '\0';
966
967 if (os_strcmp(cmd, "WPS") == 0)
968 ndef = 0;
969 else if (os_strcmp(cmd, "NDEF") == 0)
970 ndef = 1;
971 else
972 return -1;
973
974 pos2 = os_strchr(pos, ' ');
975 if (pos2)
976 *pos2++ = '\0';
977 if (os_strcmp(pos, "WPS") == 0 || os_strcmp(pos, "WPS-CR") == 0) {
978 return wpas_ctrl_nfc_get_handover_sel_wps(
979 wpa_s, reply, max_len, ndef,
980 os_strcmp(pos, "WPS-CR") == 0, pos2);
981 }
982
983 return -1;
984 }
985
986
987 static int wpas_ctrl_nfc_rx_handover_req(struct wpa_supplicant *wpa_s,
988 char *cmd, char *reply,
989 size_t max_len)
990 {
991 size_t len;
992 struct wpabuf *buf;
993 int ret;
994
995 len = os_strlen(cmd);
996 if (len & 0x01)
997 return -1;
998 len /= 2;
999
1000 buf = wpabuf_alloc(len);
1001 if (buf == NULL)
1002 return -1;
1003 if (hexstr2bin(cmd, wpabuf_put(buf, len), len) < 0) {
1004 wpabuf_free(buf);
1005 return -1;
1006 }
1007
1008 ret = wpas_wps_nfc_rx_handover_req(wpa_s, buf);
1009 wpabuf_free(buf);
1010
1011 return ret;
1012 }
1013
1014
1015 static int wpas_ctrl_nfc_rx_handover_sel(struct wpa_supplicant *wpa_s,
1016 char *cmd)
1017 {
1018 size_t len;
1019 struct wpabuf *buf;
1020 int ret;
1021
1022 len = os_strlen(cmd);
1023 if (len & 0x01)
1024 return -1;
1025 len /= 2;
1026
1027 buf = wpabuf_alloc(len);
1028 if (buf == NULL)
1029 return -1;
1030 if (hexstr2bin(cmd, wpabuf_put(buf, len), len) < 0) {
1031 wpabuf_free(buf);
1032 return -1;
1033 }
1034
1035 ret = wpas_wps_nfc_rx_handover_sel(wpa_s, buf);
1036 wpabuf_free(buf);
1037
1038 return ret;
1039 }
1040
1041
1042 static int wpas_ctrl_nfc_report_handover(struct wpa_supplicant *wpa_s,
1043 char *cmd)
1044 {
1045 size_t len;
1046 struct wpabuf *req, *sel;
1047 int ret;
1048 char *pos, *role, *type, *pos2;
1049
1050 role = cmd;
1051 pos = os_strchr(role, ' ');
1052 if (pos == NULL)
1053 return -1;
1054 *pos++ = '\0';
1055
1056 type = pos;
1057 pos = os_strchr(type, ' ');
1058 if (pos == NULL)
1059 return -1;
1060 *pos++ = '\0';
1061
1062 pos2 = os_strchr(pos, ' ');
1063 if (pos2 == NULL)
1064 return -1;
1065 *pos2++ = '\0';
1066
1067 len = os_strlen(pos);
1068 if (len & 0x01)
1069 return -1;
1070 len /= 2;
1071
1072 req = wpabuf_alloc(len);
1073 if (req == NULL)
1074 return -1;
1075 if (hexstr2bin(pos, wpabuf_put(req, len), len) < 0) {
1076 wpabuf_free(req);
1077 return -1;
1078 }
1079
1080 len = os_strlen(pos2);
1081 if (len & 0x01) {
1082 wpabuf_free(req);
1083 return -1;
1084 }
1085 len /= 2;
1086
1087 sel = wpabuf_alloc(len);
1088 if (sel == NULL) {
1089 wpabuf_free(req);
1090 return -1;
1091 }
1092 if (hexstr2bin(pos2, wpabuf_put(sel, len), len) < 0) {
1093 wpabuf_free(req);
1094 wpabuf_free(sel);
1095 return -1;
1096 }
1097
1098 if (os_strcmp(role, "INIT") == 0 && os_strcmp(type, "WPS") == 0) {
1099 ret = wpas_wps_nfc_report_handover(wpa_s, req, sel);
1100 } else {
1101 wpa_printf(MSG_DEBUG, "NFC: Unsupported connection handover "
1102 "reported: role=%s type=%s", role, type);
1103 ret = -1;
1104 }
1105 wpabuf_free(req);
1106 wpabuf_free(sel);
1107
1108 return ret;
1109 }
1110
1111 #endif /* CONFIG_WPS_NFC */
1112
1113
1114 static int wpa_supplicant_ctrl_iface_wps_reg(struct wpa_supplicant *wpa_s,
1115 char *cmd)
1116 {
1117 u8 bssid[ETH_ALEN];
1118 char *pin;
1119 char *new_ssid;
1120 char *new_auth;
1121 char *new_encr;
1122 char *new_key;
1123 struct wps_new_ap_settings ap;
1124
1125 pin = os_strchr(cmd, ' ');
1126 if (pin == NULL)
1127 return -1;
1128 *pin++ = '\0';
1129
1130 if (hwaddr_aton(cmd, bssid)) {
1131 wpa_printf(MSG_DEBUG, "CTRL_IFACE WPS_REG: invalid BSSID '%s'",
1132 cmd);
1133 return -1;
1134 }
1135
1136 new_ssid = os_strchr(pin, ' ');
1137 if (new_ssid == NULL)
1138 return wpas_wps_start_reg(wpa_s, bssid, pin, NULL);
1139 *new_ssid++ = '\0';
1140
1141 new_auth = os_strchr(new_ssid, ' ');
1142 if (new_auth == NULL)
1143 return -1;
1144 *new_auth++ = '\0';
1145
1146 new_encr = os_strchr(new_auth, ' ');
1147 if (new_encr == NULL)
1148 return -1;
1149 *new_encr++ = '\0';
1150
1151 new_key = os_strchr(new_encr, ' ');
1152 if (new_key == NULL)
1153 return -1;
1154 *new_key++ = '\0';
1155
1156 os_memset(&ap, 0, sizeof(ap));
1157 ap.ssid_hex = new_ssid;
1158 ap.auth = new_auth;
1159 ap.encr = new_encr;
1160 ap.key_hex = new_key;
1161 return wpas_wps_start_reg(wpa_s, bssid, pin, &ap);
1162 }
1163
1164
1165 #ifdef CONFIG_AP
1166 static int wpa_supplicant_ctrl_iface_wps_ap_pin(struct wpa_supplicant *wpa_s,
1167 char *cmd, char *buf,
1168 size_t buflen)
1169 {
1170 int timeout = 300;
1171 char *pos;
1172 const char *pin_txt;
1173
1174 if (!wpa_s->ap_iface)
1175 return -1;
1176
1177 pos = os_strchr(cmd, ' ');
1178 if (pos)
1179 *pos++ = '\0';
1180
1181 if (os_strcmp(cmd, "disable") == 0) {
1182 wpas_wps_ap_pin_disable(wpa_s);
1183 return os_snprintf(buf, buflen, "OK\n");
1184 }
1185
1186 if (os_strcmp(cmd, "random") == 0) {
1187 if (pos)
1188 timeout = atoi(pos);
1189 pin_txt = wpas_wps_ap_pin_random(wpa_s, timeout);
1190 if (pin_txt == NULL)
1191 return -1;
1192 return os_snprintf(buf, buflen, "%s", pin_txt);
1193 }
1194
1195 if (os_strcmp(cmd, "get") == 0) {
1196 pin_txt = wpas_wps_ap_pin_get(wpa_s);
1197 if (pin_txt == NULL)
1198 return -1;
1199 return os_snprintf(buf, buflen, "%s", pin_txt);
1200 }
1201
1202 if (os_strcmp(cmd, "set") == 0) {
1203 char *pin;
1204 if (pos == NULL)
1205 return -1;
1206 pin = pos;
1207 pos = os_strchr(pos, ' ');
1208 if (pos) {
1209 *pos++ = '\0';
1210 timeout = atoi(pos);
1211 }
1212 if (os_strlen(pin) > buflen)
1213 return -1;
1214 if (wpas_wps_ap_pin_set(wpa_s, pin, timeout) < 0)
1215 return -1;
1216 return os_snprintf(buf, buflen, "%s", pin);
1217 }
1218
1219 return -1;
1220 }
1221 #endif /* CONFIG_AP */
1222
1223
1224 #ifdef CONFIG_WPS_ER
1225 static int wpa_supplicant_ctrl_iface_wps_er_pin(struct wpa_supplicant *wpa_s,
1226 char *cmd)
1227 {
1228 char *uuid = cmd, *pin, *pos;
1229 u8 addr_buf[ETH_ALEN], *addr = NULL;
1230 pin = os_strchr(uuid, ' ');
1231 if (pin == NULL)
1232 return -1;
1233 *pin++ = '\0';
1234 pos = os_strchr(pin, ' ');
1235 if (pos) {
1236 *pos++ = '\0';
1237 if (hwaddr_aton(pos, addr_buf) == 0)
1238 addr = addr_buf;
1239 }
1240 return wpas_wps_er_add_pin(wpa_s, addr, uuid, pin);
1241 }
1242
1243
1244 static int wpa_supplicant_ctrl_iface_wps_er_learn(struct wpa_supplicant *wpa_s,
1245 char *cmd)
1246 {
1247 char *uuid = cmd, *pin;
1248 pin = os_strchr(uuid, ' ');
1249 if (pin == NULL)
1250 return -1;
1251 *pin++ = '\0';
1252 return wpas_wps_er_learn(wpa_s, uuid, pin);
1253 }
1254
1255
1256 static int wpa_supplicant_ctrl_iface_wps_er_set_config(
1257 struct wpa_supplicant *wpa_s, char *cmd)
1258 {
1259 char *uuid = cmd, *id;
1260 id = os_strchr(uuid, ' ');
1261 if (id == NULL)
1262 return -1;
1263 *id++ = '\0';
1264 return wpas_wps_er_set_config(wpa_s, uuid, atoi(id));
1265 }
1266
1267
1268 static int wpa_supplicant_ctrl_iface_wps_er_config(
1269 struct wpa_supplicant *wpa_s, char *cmd)
1270 {
1271 char *pin;
1272 char *new_ssid;
1273 char *new_auth;
1274 char *new_encr;
1275 char *new_key;
1276 struct wps_new_ap_settings ap;
1277
1278 pin = os_strchr(cmd, ' ');
1279 if (pin == NULL)
1280 return -1;
1281 *pin++ = '\0';
1282
1283 new_ssid = os_strchr(pin, ' ');
1284 if (new_ssid == NULL)
1285 return -1;
1286 *new_ssid++ = '\0';
1287
1288 new_auth = os_strchr(new_ssid, ' ');
1289 if (new_auth == NULL)
1290 return -1;
1291 *new_auth++ = '\0';
1292
1293 new_encr = os_strchr(new_auth, ' ');
1294 if (new_encr == NULL)
1295 return -1;
1296 *new_encr++ = '\0';
1297
1298 new_key = os_strchr(new_encr, ' ');
1299 if (new_key == NULL)
1300 return -1;
1301 *new_key++ = '\0';
1302
1303 os_memset(&ap, 0, sizeof(ap));
1304 ap.ssid_hex = new_ssid;
1305 ap.auth = new_auth;
1306 ap.encr = new_encr;
1307 ap.key_hex = new_key;
1308 return wpas_wps_er_config(wpa_s, cmd, pin, &ap);
1309 }
1310
1311
1312 #ifdef CONFIG_WPS_NFC
1313 static int wpa_supplicant_ctrl_iface_wps_er_nfc_config_token(
1314 struct wpa_supplicant *wpa_s, char *cmd, char *reply, size_t max_len)
1315 {
1316 int ndef;
1317 struct wpabuf *buf;
1318 int res;
1319 char *uuid;
1320
1321 uuid = os_strchr(cmd, ' ');
1322 if (uuid == NULL)
1323 return -1;
1324 *uuid++ = '\0';
1325
1326 if (os_strcmp(cmd, "WPS") == 0)
1327 ndef = 0;
1328 else if (os_strcmp(cmd, "NDEF") == 0)
1329 ndef = 1;
1330 else
1331 return -1;
1332
1333 buf = wpas_wps_er_nfc_config_token(wpa_s, ndef, uuid);
1334 if (buf == NULL)
1335 return -1;
1336
1337 res = wpa_snprintf_hex_uppercase(reply, max_len, wpabuf_head(buf),
1338 wpabuf_len(buf));
1339 reply[res++] = '\n';
1340 reply[res] = '\0';
1341
1342 wpabuf_free(buf);
1343
1344 return res;
1345 }
1346 #endif /* CONFIG_WPS_NFC */
1347 #endif /* CONFIG_WPS_ER */
1348
1349 #endif /* CONFIG_WPS */
1350
1351
1352 #ifdef CONFIG_IBSS_RSN
1353 static int wpa_supplicant_ctrl_iface_ibss_rsn(
1354 struct wpa_supplicant *wpa_s, char *addr)
1355 {
1356 u8 peer[ETH_ALEN];
1357
1358 if (hwaddr_aton(addr, peer)) {
1359 wpa_printf(MSG_DEBUG, "CTRL_IFACE IBSS_RSN: invalid "
1360 "address '%s'", addr);
1361 return -1;
1362 }
1363
1364 wpa_printf(MSG_DEBUG, "CTRL_IFACE IBSS_RSN " MACSTR,
1365 MAC2STR(peer));
1366
1367 return ibss_rsn_start(wpa_s->ibss_rsn, peer);
1368 }
1369 #endif /* CONFIG_IBSS_RSN */
1370
1371
1372 static int wpa_supplicant_ctrl_iface_ctrl_rsp(struct wpa_supplicant *wpa_s,
1373 char *rsp)
1374 {
1375 #ifdef IEEE8021X_EAPOL
1376 char *pos, *id_pos;
1377 int id;
1378 struct wpa_ssid *ssid;
1379
1380 pos = os_strchr(rsp, '-');
1381 if (pos == NULL)
1382 return -1;
1383 *pos++ = '\0';
1384 id_pos = pos;
1385 pos = os_strchr(pos, ':');
1386 if (pos == NULL)
1387 return -1;
1388 *pos++ = '\0';
1389 id = atoi(id_pos);
1390 wpa_printf(MSG_DEBUG, "CTRL_IFACE: field=%s id=%d", rsp, id);
1391 wpa_hexdump_ascii_key(MSG_DEBUG, "CTRL_IFACE: value",
1392 (u8 *) pos, os_strlen(pos));
1393
1394 ssid = wpa_config_get_network(wpa_s->conf, id);
1395 if (ssid == NULL) {
1396 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find SSID id=%d "
1397 "to update", id);
1398 return -1;
1399 }
1400
1401 return wpa_supplicant_ctrl_iface_ctrl_rsp_handle(wpa_s, ssid, rsp,
1402 pos);
1403 #else /* IEEE8021X_EAPOL */
1404 wpa_printf(MSG_DEBUG, "CTRL_IFACE: 802.1X not included");
1405 return -1;
1406 #endif /* IEEE8021X_EAPOL */
1407 }
1408
1409
1410 static int wpa_supplicant_ctrl_iface_status(struct wpa_supplicant *wpa_s,
1411 const char *params,
1412 char *buf, size_t buflen)
1413 {
1414 char *pos, *end, tmp[30];
1415 int res, verbose, wps, ret;
1416
1417 if (os_strcmp(params, "-DRIVER") == 0)
1418 return wpa_drv_status(wpa_s, buf, buflen);
1419 verbose = os_strcmp(params, "-VERBOSE") == 0;
1420 wps = os_strcmp(params, "-WPS") == 0;
1421 pos = buf;
1422 end = buf + buflen;
1423 if (wpa_s->wpa_state >= WPA_ASSOCIATED) {
1424 struct wpa_ssid *ssid = wpa_s->current_ssid;
1425 ret = os_snprintf(pos, end - pos, "bssid=" MACSTR "\n",
1426 MAC2STR(wpa_s->bssid));
1427 if (ret < 0 || ret >= end - pos)
1428 return pos - buf;
1429 pos += ret;
1430 if (ssid) {
1431 u8 *_ssid = ssid->ssid;
1432 size_t ssid_len = ssid->ssid_len;
1433 u8 ssid_buf[MAX_SSID_LEN];
1434 if (ssid_len == 0) {
1435 int _res = wpa_drv_get_ssid(wpa_s, ssid_buf);
1436 if (_res < 0)
1437 ssid_len = 0;
1438 else
1439 ssid_len = _res;
1440 _ssid = ssid_buf;
1441 }
1442 ret = os_snprintf(pos, end - pos, "ssid=%s\nid=%d\n",
1443 wpa_ssid_txt(_ssid, ssid_len),
1444 ssid->id);
1445 if (ret < 0 || ret >= end - pos)
1446 return pos - buf;
1447 pos += ret;
1448
1449 if (wps && ssid->passphrase &&
1450 wpa_key_mgmt_wpa_psk(ssid->key_mgmt) &&
1451 (ssid->mode == WPAS_MODE_AP ||
1452 ssid->mode == WPAS_MODE_P2P_GO)) {
1453 ret = os_snprintf(pos, end - pos,
1454 "passphrase=%s\n",
1455 ssid->passphrase);
1456 if (ret < 0 || ret >= end - pos)
1457 return pos - buf;
1458 pos += ret;
1459 }
1460 if (ssid->id_str) {
1461 ret = os_snprintf(pos, end - pos,
1462 "id_str=%s\n",
1463 ssid->id_str);
1464 if (ret < 0 || ret >= end - pos)
1465 return pos - buf;
1466 pos += ret;
1467 }
1468
1469 switch (ssid->mode) {
1470 case WPAS_MODE_INFRA:
1471 ret = os_snprintf(pos, end - pos,
1472 "mode=station\n");
1473 break;
1474 case WPAS_MODE_IBSS:
1475 ret = os_snprintf(pos, end - pos,
1476 "mode=IBSS\n");
1477 break;
1478 case WPAS_MODE_AP:
1479 ret = os_snprintf(pos, end - pos,
1480 "mode=AP\n");
1481 break;
1482 case WPAS_MODE_P2P_GO:
1483 ret = os_snprintf(pos, end - pos,
1484 "mode=P2P GO\n");
1485 break;
1486 case WPAS_MODE_P2P_GROUP_FORMATION:
1487 ret = os_snprintf(pos, end - pos,
1488 "mode=P2P GO - group "
1489 "formation\n");
1490 break;
1491 default:
1492 ret = 0;
1493 break;
1494 }
1495 if (ret < 0 || ret >= end - pos)
1496 return pos - buf;
1497 pos += ret;
1498 }
1499
1500 #ifdef CONFIG_AP
1501 if (wpa_s->ap_iface) {
1502 pos += ap_ctrl_iface_wpa_get_status(wpa_s, pos,
1503 end - pos,
1504 verbose);
1505 } else
1506 #endif /* CONFIG_AP */
1507 pos += wpa_sm_get_status(wpa_s->wpa, pos, end - pos, verbose);
1508 }
1509 #ifdef CONFIG_SAE
1510 if (wpa_s->wpa_state >= WPA_ASSOCIATED &&
1511 #ifdef CONFIG_AP
1512 !wpa_s->ap_iface &&
1513 #endif /* CONFIG_AP */
1514 wpa_s->sme.sae.state == SAE_ACCEPTED) {
1515 ret = os_snprintf(pos, end - pos, "sae_group=%d\n",
1516 wpa_s->sme.sae.group);
1517 if (ret < 0 || ret >= end - pos)
1518 return pos - buf;
1519 pos += ret;
1520 }
1521 #endif /* CONFIG_SAE */
1522 ret = os_snprintf(pos, end - pos, "wpa_state=%s\n",
1523 wpa_supplicant_state_txt(wpa_s->wpa_state));
1524 if (ret < 0 || ret >= end - pos)
1525 return pos - buf;
1526 pos += ret;
1527
1528 if (wpa_s->l2 &&
1529 l2_packet_get_ip_addr(wpa_s->l2, tmp, sizeof(tmp)) >= 0) {
1530 ret = os_snprintf(pos, end - pos, "ip_address=%s\n", tmp);
1531 if (ret < 0 || ret >= end - pos)
1532 return pos - buf;
1533 pos += ret;
1534 }
1535
1536 #ifdef CONFIG_P2P
1537 if (wpa_s->global->p2p) {
1538 ret = os_snprintf(pos, end - pos, "p2p_device_address=" MACSTR
1539 "\n", MAC2STR(wpa_s->global->p2p_dev_addr));
1540 if (ret < 0 || ret >= end - pos)
1541 return pos - buf;
1542 pos += ret;
1543 }
1544 #endif /* CONFIG_P2P */
1545
1546 ret = os_snprintf(pos, end - pos, "address=" MACSTR "\n",
1547 MAC2STR(wpa_s->own_addr));
1548 if (ret < 0 || ret >= end - pos)
1549 return pos - buf;
1550 pos += ret;
1551
1552 #ifdef CONFIG_HS20
1553 if (wpa_s->current_bss &&
1554 wpa_bss_get_vendor_ie(wpa_s->current_bss, HS20_IE_VENDOR_TYPE) &&
1555 wpa_s->wpa_proto == WPA_PROTO_RSN &&
1556 wpa_key_mgmt_wpa_ieee8021x(wpa_s->key_mgmt)) {
1557 ret = os_snprintf(pos, end - pos, "hs20=1\n");
1558 if (ret < 0 || ret >= end - pos)
1559 return pos - buf;
1560 pos += ret;
1561 }
1562
1563 if (wpa_s->current_ssid) {
1564 struct wpa_cred *cred;
1565 char *type;
1566
1567 for (cred = wpa_s->conf->cred; cred; cred = cred->next) {
1568 size_t i;
1569
1570 if (wpa_s->current_ssid->parent_cred != cred)
1571 continue;
1572 if (!cred->domain)
1573 continue;
1574
1575 for (i = 0; i < cred->num_domain; i++) {
1576 ret = os_snprintf(pos, end - pos,
1577 "home_sp=%s\n",
1578 cred->domain[i]);
1579 if (ret < 0 || ret >= end - pos)
1580 return pos - buf;
1581 pos += ret;
1582 }
1583
1584 if (wpa_s->current_bss == NULL ||
1585 wpa_s->current_bss->anqp == NULL)
1586 res = -1;
1587 else
1588 res = interworking_home_sp_cred(
1589 wpa_s, cred,
1590 wpa_s->current_bss->anqp->domain_name);
1591 if (res > 0)
1592 type = "home";
1593 else if (res == 0)
1594 type = "roaming";
1595 else
1596 type = "unknown";
1597
1598 ret = os_snprintf(pos, end - pos, "sp_type=%s\n", type);
1599 if (ret < 0 || ret >= end - pos)
1600 return pos - buf;
1601 pos += ret;
1602
1603 break;
1604 }
1605 }
1606 #endif /* CONFIG_HS20 */
1607
1608 if (wpa_key_mgmt_wpa_ieee8021x(wpa_s->key_mgmt) ||
1609 wpa_s->key_mgmt == WPA_KEY_MGMT_IEEE8021X_NO_WPA) {
1610 res = eapol_sm_get_status(wpa_s->eapol, pos, end - pos,
1611 verbose);
1612 if (res >= 0)
1613 pos += res;
1614 }
1615
1616 res = rsn_preauth_get_status(wpa_s->wpa, pos, end - pos, verbose);
1617 if (res >= 0)
1618 pos += res;
1619
1620 return pos - buf;
1621 }
1622
1623
1624 static int wpa_supplicant_ctrl_iface_bssid(struct wpa_supplicant *wpa_s,
1625 char *cmd)
1626 {
1627 char *pos;
1628 int id;
1629 struct wpa_ssid *ssid;
1630 u8 bssid[ETH_ALEN];
1631
1632 /* cmd: "<network id> <BSSID>" */
1633 pos = os_strchr(cmd, ' ');
1634 if (pos == NULL)
1635 return -1;
1636 *pos++ = '\0';
1637 id = atoi(cmd);
1638 wpa_printf(MSG_DEBUG, "CTRL_IFACE: id=%d bssid='%s'", id, pos);
1639 if (hwaddr_aton(pos, bssid)) {
1640 wpa_printf(MSG_DEBUG ,"CTRL_IFACE: invalid BSSID '%s'", pos);
1641 return -1;
1642 }
1643
1644 ssid = wpa_config_get_network(wpa_s->conf, id);
1645 if (ssid == NULL) {
1646 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find SSID id=%d "
1647 "to update", id);
1648 return -1;
1649 }
1650
1651 os_memcpy(ssid->bssid, bssid, ETH_ALEN);
1652 ssid->bssid_set = !is_zero_ether_addr(bssid);
1653
1654 return 0;
1655 }
1656
1657
1658 static int wpa_supplicant_ctrl_iface_blacklist(struct wpa_supplicant *wpa_s,
1659 char *cmd, char *buf,
1660 size_t buflen)
1661 {
1662 u8 bssid[ETH_ALEN];
1663 struct wpa_blacklist *e;
1664 char *pos, *end;
1665 int ret;
1666
1667 /* cmd: "BLACKLIST [<BSSID>]" */
1668 if (*cmd == '\0') {
1669 pos = buf;
1670 end = buf + buflen;
1671 e = wpa_s->blacklist;
1672 while (e) {
1673 ret = os_snprintf(pos, end - pos, MACSTR "\n",
1674 MAC2STR(e->bssid));
1675 if (ret < 0 || ret >= end - pos)
1676 return pos - buf;
1677 pos += ret;
1678 e = e->next;
1679 }
1680 return pos - buf;
1681 }
1682
1683 cmd++;
1684 if (os_strncmp(cmd, "clear", 5) == 0) {
1685 wpa_blacklist_clear(wpa_s);
1686 os_memcpy(buf, "OK\n", 3);
1687 return 3;
1688 }
1689
1690 wpa_printf(MSG_DEBUG, "CTRL_IFACE: BLACKLIST bssid='%s'", cmd);
1691 if (hwaddr_aton(cmd, bssid)) {
1692 wpa_printf(MSG_DEBUG, "CTRL_IFACE: invalid BSSID '%s'", cmd);
1693 return -1;
1694 }
1695
1696 /*
1697 * Add the BSSID twice, so its count will be 2, causing it to be
1698 * skipped when processing scan results.
1699 */
1700 ret = wpa_blacklist_add(wpa_s, bssid);
1701 if (ret != 0)
1702 return -1;
1703 ret = wpa_blacklist_add(wpa_s, bssid);
1704 if (ret != 0)
1705 return -1;
1706 os_memcpy(buf, "OK\n", 3);
1707 return 3;
1708 }
1709
1710
1711 extern int wpa_debug_level;
1712 extern int wpa_debug_timestamp;
1713
1714 static const char * debug_level_str(int level)
1715 {
1716 switch (level) {
1717 case MSG_EXCESSIVE:
1718 return "EXCESSIVE";
1719 case MSG_MSGDUMP:
1720 return "MSGDUMP";
1721 case MSG_DEBUG:
1722 return "DEBUG";
1723 case MSG_INFO:
1724 return "INFO";
1725 case MSG_WARNING:
1726 return "WARNING";
1727 case MSG_ERROR:
1728 return "ERROR";
1729 default:
1730 return "?";
1731 }
1732 }
1733
1734
1735 static int str_to_debug_level(const char *s)
1736 {
1737 if (os_strcasecmp(s, "EXCESSIVE") == 0)
1738 return MSG_EXCESSIVE;
1739 if (os_strcasecmp(s, "MSGDUMP") == 0)
1740 return MSG_MSGDUMP;
1741 if (os_strcasecmp(s, "DEBUG") == 0)
1742 return MSG_DEBUG;
1743 if (os_strcasecmp(s, "INFO") == 0)
1744 return MSG_INFO;
1745 if (os_strcasecmp(s, "WARNING") == 0)
1746 return MSG_WARNING;
1747 if (os_strcasecmp(s, "ERROR") == 0)
1748 return MSG_ERROR;
1749 return -1;
1750 }
1751
1752
1753 static int wpa_supplicant_ctrl_iface_log_level(struct wpa_supplicant *wpa_s,
1754 char *cmd, char *buf,
1755 size_t buflen)
1756 {
1757 char *pos, *end, *stamp;
1758 int ret;
1759
1760 if (cmd == NULL) {
1761 return -1;
1762 }
1763
1764 /* cmd: "LOG_LEVEL [<level>]" */
1765 if (*cmd == '\0') {
1766 pos = buf;
1767 end = buf + buflen;
1768 ret = os_snprintf(pos, end - pos, "Current level: %s\n"
1769 "Timestamp: %d\n",
1770 debug_level_str(wpa_debug_level),
1771 wpa_debug_timestamp);
1772 if (ret < 0 || ret >= end - pos)
1773 ret = 0;
1774
1775 return ret;
1776 }
1777
1778 while (*cmd == ' ')
1779 cmd++;
1780
1781 stamp = os_strchr(cmd, ' ');
1782 if (stamp) {
1783 *stamp++ = '\0';
1784 while (*stamp == ' ') {
1785 stamp++;
1786 }
1787 }
1788
1789 if (cmd && os_strlen(cmd)) {
1790 int level = str_to_debug_level(cmd);
1791 if (level < 0)
1792 return -1;
1793 wpa_debug_level = level;
1794 }
1795
1796 if (stamp && os_strlen(stamp))
1797 wpa_debug_timestamp = atoi(stamp);
1798
1799 os_memcpy(buf, "OK\n", 3);
1800 return 3;
1801 }
1802
1803
1804 static int wpa_supplicant_ctrl_iface_list_networks(
1805 struct wpa_supplicant *wpa_s, char *buf, size_t buflen)
1806 {
1807 char *pos, *end;
1808 struct wpa_ssid *ssid;
1809 int ret;
1810
1811 pos = buf;
1812 end = buf + buflen;
1813 ret = os_snprintf(pos, end - pos,
1814 "network id / ssid / bssid / flags\n");
1815 if (ret < 0 || ret >= end - pos)
1816 return pos - buf;
1817 pos += ret;
1818
1819 ssid = wpa_s->conf->ssid;
1820 while (ssid) {
1821 ret = os_snprintf(pos, end - pos, "%d\t%s",
1822 ssid->id,
1823 wpa_ssid_txt(ssid->ssid, ssid->ssid_len));
1824 if (ret < 0 || ret >= end - pos)
1825 return pos - buf;
1826 pos += ret;
1827 if (ssid->bssid_set) {
1828 ret = os_snprintf(pos, end - pos, "\t" MACSTR,
1829 MAC2STR(ssid->bssid));
1830 } else {
1831 ret = os_snprintf(pos, end - pos, "\tany");
1832 }
1833 if (ret < 0 || ret >= end - pos)
1834 return pos - buf;
1835 pos += ret;
1836 ret = os_snprintf(pos, end - pos, "\t%s%s%s%s",
1837 ssid == wpa_s->current_ssid ?
1838 "[CURRENT]" : "",
1839 ssid->disabled ? "[DISABLED]" : "",
1840 ssid->disabled_until.sec ?
1841 "[TEMP-DISABLED]" : "",
1842 ssid->disabled == 2 ? "[P2P-PERSISTENT]" :
1843 "");
1844 if (ret < 0 || ret >= end - pos)
1845 return pos - buf;
1846 pos += ret;
1847 ret = os_snprintf(pos, end - pos, "\n");
1848 if (ret < 0 || ret >= end - pos)
1849 return pos - buf;
1850 pos += ret;
1851
1852 ssid = ssid->next;
1853 }
1854
1855 return pos - buf;
1856 }
1857
1858
1859 static char * wpa_supplicant_cipher_txt(char *pos, char *end, int cipher)
1860 {
1861 int ret;
1862 ret = os_snprintf(pos, end - pos, "-");
1863 if (ret < 0 || ret >= end - pos)
1864 return pos;
1865 pos += ret;
1866 ret = wpa_write_ciphers(pos, end, cipher, "+");
1867 if (ret < 0)
1868 return pos;
1869 pos += ret;
1870 return pos;
1871 }
1872
1873
1874 static char * wpa_supplicant_ie_txt(char *pos, char *end, const char *proto,
1875 const u8 *ie, size_t ie_len)
1876 {
1877 struct wpa_ie_data data;
1878 int first, ret;
1879
1880 ret = os_snprintf(pos, end - pos, "[%s-", proto);
1881 if (ret < 0 || ret >= end - pos)
1882 return pos;
1883 pos += ret;
1884
1885 if (wpa_parse_wpa_ie(ie, ie_len, &data) < 0) {
1886 ret = os_snprintf(pos, end - pos, "?]");
1887 if (ret < 0 || ret >= end - pos)
1888 return pos;
1889 pos += ret;
1890 return pos;
1891 }
1892
1893 first = 1;
1894 if (data.key_mgmt & WPA_KEY_MGMT_IEEE8021X) {
1895 ret = os_snprintf(pos, end - pos, "%sEAP", first ? "" : "+");
1896 if (ret < 0 || ret >= end - pos)
1897 return pos;
1898 pos += ret;
1899 first = 0;
1900 }
1901 if (data.key_mgmt & WPA_KEY_MGMT_PSK) {
1902 ret = os_snprintf(pos, end - pos, "%sPSK", first ? "" : "+");
1903 if (ret < 0 || ret >= end - pos)
1904 return pos;
1905 pos += ret;
1906 first = 0;
1907 }
1908 if (data.key_mgmt & WPA_KEY_MGMT_WPA_NONE) {
1909 ret = os_snprintf(pos, end - pos, "%sNone", first ? "" : "+");
1910 if (ret < 0 || ret >= end - pos)
1911 return pos;
1912 pos += ret;
1913 first = 0;
1914 }
1915 #ifdef CONFIG_IEEE80211R
1916 if (data.key_mgmt & WPA_KEY_MGMT_FT_IEEE8021X) {
1917 ret = os_snprintf(pos, end - pos, "%sFT/EAP",
1918 first ? "" : "+");
1919 if (ret < 0 || ret >= end - pos)
1920 return pos;
1921 pos += ret;
1922 first = 0;
1923 }
1924 if (data.key_mgmt & WPA_KEY_MGMT_FT_PSK) {
1925 ret = os_snprintf(pos, end - pos, "%sFT/PSK",
1926 first ? "" : "+");
1927 if (ret < 0 || ret >= end - pos)
1928 return pos;
1929 pos += ret;
1930 first = 0;
1931 }
1932 #endif /* CONFIG_IEEE80211R */
1933 #ifdef CONFIG_IEEE80211W
1934 if (data.key_mgmt & WPA_KEY_MGMT_IEEE8021X_SHA256) {
1935 ret = os_snprintf(pos, end - pos, "%sEAP-SHA256",
1936 first ? "" : "+");
1937 if (ret < 0 || ret >= end - pos)
1938 return pos;
1939 pos += ret;
1940 first = 0;
1941 }
1942 if (data.key_mgmt & WPA_KEY_MGMT_PSK_SHA256) {
1943 ret = os_snprintf(pos, end - pos, "%sPSK-SHA256",
1944 first ? "" : "+");
1945 if (ret < 0 || ret >= end - pos)
1946 return pos;
1947 pos += ret;
1948 first = 0;
1949 }
1950 #endif /* CONFIG_IEEE80211W */
1951
1952 pos = wpa_supplicant_cipher_txt(pos, end, data.pairwise_cipher);
1953
1954 if (data.capabilities & WPA_CAPABILITY_PREAUTH) {
1955 ret = os_snprintf(pos, end - pos, "-preauth");
1956 if (ret < 0 || ret >= end - pos)
1957 return pos;
1958 pos += ret;
1959 }
1960
1961 ret = os_snprintf(pos, end - pos, "]");
1962 if (ret < 0 || ret >= end - pos)
1963 return pos;
1964 pos += ret;
1965
1966 return pos;
1967 }
1968
1969
1970 #ifdef CONFIG_WPS
1971 static char * wpa_supplicant_wps_ie_txt_buf(struct wpa_supplicant *wpa_s,
1972 char *pos, char *end,
1973 struct wpabuf *wps_ie)
1974 {
1975 int ret;
1976 const char *txt;
1977
1978 if (wps_ie == NULL)
1979 return pos;
1980 if (wps_is_selected_pbc_registrar(wps_ie))
1981 txt = "[WPS-PBC]";
1982 #ifdef CONFIG_WPS2
1983 else if (wps_is_addr_authorized(wps_ie, wpa_s->own_addr, 0))
1984 txt = "[WPS-AUTH]";
1985 #endif /* CONFIG_WPS2 */
1986 else if (wps_is_selected_pin_registrar(wps_ie))
1987 txt = "[WPS-PIN]";
1988 else
1989 txt = "[WPS]";
1990
1991 ret = os_snprintf(pos, end - pos, "%s", txt);
1992 if (ret >= 0 && ret < end - pos)
1993 pos += ret;
1994 wpabuf_free(wps_ie);
1995 return pos;
1996 }
1997 #endif /* CONFIG_WPS */
1998
1999
2000 static char * wpa_supplicant_wps_ie_txt(struct wpa_supplicant *wpa_s,
2001 char *pos, char *end,
2002 const struct wpa_bss *bss)
2003 {
2004 #ifdef CONFIG_WPS
2005 struct wpabuf *wps_ie;
2006 wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
2007 return wpa_supplicant_wps_ie_txt_buf(wpa_s, pos, end, wps_ie);
2008 #else /* CONFIG_WPS */
2009 return pos;
2010 #endif /* CONFIG_WPS */
2011 }
2012
2013
2014 /* Format one result on one text line into a buffer. */
2015 static int wpa_supplicant_ctrl_iface_scan_result(
2016 struct wpa_supplicant *wpa_s,
2017 const struct wpa_bss *bss, char *buf, size_t buflen)
2018 {
2019 char *pos, *end;
2020 int ret;
2021 const u8 *ie, *ie2, *p2p;
2022
2023 p2p = wpa_bss_get_vendor_ie(bss, P2P_IE_VENDOR_TYPE);
2024 if (!p2p)
2025 p2p = wpa_bss_get_vendor_ie_beacon(bss, P2P_IE_VENDOR_TYPE);
2026 if (p2p && bss->ssid_len == P2P_WILDCARD_SSID_LEN &&
2027 os_memcmp(bss->ssid, P2P_WILDCARD_SSID, P2P_WILDCARD_SSID_LEN) ==
2028 0)
2029 return 0; /* Do not show P2P listen discovery results here */
2030
2031 pos = buf;
2032 end = buf + buflen;
2033
2034 ret = os_snprintf(pos, end - pos, MACSTR "\t%d\t%d\t",
2035 MAC2STR(bss->bssid), bss->freq, bss->level);
2036 if (ret < 0 || ret >= end - pos)
2037 return -1;
2038 pos += ret;
2039 ie = wpa_bss_get_vendor_ie(bss, WPA_IE_VENDOR_TYPE);
2040 if (ie)
2041 pos = wpa_supplicant_ie_txt(pos, end, "WPA", ie, 2 + ie[1]);
2042 ie2 = wpa_bss_get_ie(bss, WLAN_EID_RSN);
2043 if (ie2)
2044 pos = wpa_supplicant_ie_txt(pos, end, "WPA2", ie2, 2 + ie2[1]);
2045 pos = wpa_supplicant_wps_ie_txt(wpa_s, pos, end, bss);
2046 if (!ie && !ie2 && bss->caps & IEEE80211_CAP_PRIVACY) {
2047 ret = os_snprintf(pos, end - pos, "[WEP]");
2048 if (ret < 0 || ret >= end - pos)
2049 return -1;
2050 pos += ret;
2051 }
2052 if (bss->caps & IEEE80211_CAP_IBSS) {
2053 ret = os_snprintf(pos, end - pos, "[IBSS]");
2054 if (ret < 0 || ret >= end - pos)
2055 return -1;
2056 pos += ret;
2057 }
2058 if (bss->caps & IEEE80211_CAP_ESS) {
2059 ret = os_snprintf(pos, end - pos, "[ESS]");
2060 if (ret < 0 || ret >= end - pos)
2061 return -1;
2062 pos += ret;
2063 }
2064 if (p2p) {
2065 ret = os_snprintf(pos, end - pos, "[P2P]");
2066 if (ret < 0 || ret >= end - pos)
2067 return -1;
2068 pos += ret;
2069 }
2070 #ifdef CONFIG_HS20
2071 if (wpa_bss_get_vendor_ie(bss, HS20_IE_VENDOR_TYPE) && ie2) {
2072 ret = os_snprintf(pos, end - pos, "[HS20]");
2073 if (ret < 0 || ret >= end - pos)
2074 return -1;
2075 pos += ret;
2076 }
2077 #endif /* CONFIG_HS20 */
2078
2079 ret = os_snprintf(pos, end - pos, "\t%s",
2080 wpa_ssid_txt(bss->ssid, bss->ssid_len));
2081 if (ret < 0 || ret >= end - pos)
2082 return -1;
2083 pos += ret;
2084
2085 ret = os_snprintf(pos, end - pos, "\n");
2086 if (ret < 0 || ret >= end - pos)
2087 return -1;
2088 pos += ret;
2089
2090 return pos - buf;
2091 }
2092
2093
2094 static int wpa_supplicant_ctrl_iface_scan_results(
2095 struct wpa_supplicant *wpa_s, char *buf, size_t buflen)
2096 {
2097 char *pos, *end;
2098 struct wpa_bss *bss;
2099 int ret;
2100
2101 pos = buf;
2102 end = buf + buflen;
2103 ret = os_snprintf(pos, end - pos, "bssid / frequency / signal level / "
2104 "flags / ssid\n");
2105 if (ret < 0 || ret >= end - pos)
2106 return pos - buf;
2107 pos += ret;
2108
2109 dl_list_for_each(bss, &wpa_s->bss_id, struct wpa_bss, list_id) {
2110 ret = wpa_supplicant_ctrl_iface_scan_result(wpa_s, bss, pos,
2111 end - pos);
2112 if (ret < 0 || ret >= end - pos)
2113 return pos - buf;
2114 pos += ret;
2115 }
2116
2117 return pos - buf;
2118 }
2119
2120
2121 static int wpa_supplicant_ctrl_iface_select_network(
2122 struct wpa_supplicant *wpa_s, char *cmd)
2123 {
2124 int id;
2125 struct wpa_ssid *ssid;
2126
2127 /* cmd: "<network id>" or "any" */
2128 if (os_strcmp(cmd, "any") == 0) {
2129 wpa_printf(MSG_DEBUG, "CTRL_IFACE: SELECT_NETWORK any");
2130 ssid = NULL;
2131 } else {
2132 id = atoi(cmd);
2133 wpa_printf(MSG_DEBUG, "CTRL_IFACE: SELECT_NETWORK id=%d", id);
2134
2135 ssid = wpa_config_get_network(wpa_s->conf, id);
2136 if (ssid == NULL) {
2137 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
2138 "network id=%d", id);
2139 return -1;
2140 }
2141 if (ssid->disabled == 2) {
2142 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Cannot use "
2143 "SELECT_NETWORK with persistent P2P group");
2144 return -1;
2145 }
2146 }
2147
2148 wpa_supplicant_select_network(wpa_s, ssid);
2149
2150 return 0;
2151 }
2152
2153
2154 static int wpa_supplicant_ctrl_iface_enable_network(
2155 struct wpa_supplicant *wpa_s, char *cmd)
2156 {
2157 int id;
2158 struct wpa_ssid *ssid;
2159
2160 /* cmd: "<network id>" or "all" */
2161 if (os_strcmp(cmd, "all") == 0) {
2162 wpa_printf(MSG_DEBUG, "CTRL_IFACE: ENABLE_NETWORK all");
2163 ssid = NULL;
2164 } else {
2165 id = atoi(cmd);
2166 wpa_printf(MSG_DEBUG, "CTRL_IFACE: ENABLE_NETWORK id=%d", id);
2167
2168 ssid = wpa_config_get_network(wpa_s->conf, id);
2169 if (ssid == NULL) {
2170 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
2171 "network id=%d", id);
2172 return -1;
2173 }
2174 if (ssid->disabled == 2) {
2175 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Cannot use "
2176 "ENABLE_NETWORK with persistent P2P group");
2177 return -1;
2178 }
2179
2180 if (os_strstr(cmd, " no-connect")) {
2181 ssid->disabled = 0;
2182 return 0;
2183 }
2184 }
2185 wpa_supplicant_enable_network(wpa_s, ssid);
2186
2187 return 0;
2188 }
2189
2190
2191 static int wpa_supplicant_ctrl_iface_disable_network(
2192 struct wpa_supplicant *wpa_s, char *cmd)
2193 {
2194 int id;
2195 struct wpa_ssid *ssid;
2196
2197 /* cmd: "<network id>" or "all" */
2198 if (os_strcmp(cmd, "all") == 0) {
2199 wpa_printf(MSG_DEBUG, "CTRL_IFACE: DISABLE_NETWORK all");
2200 ssid = NULL;
2201 } else {
2202 id = atoi(cmd);
2203 wpa_printf(MSG_DEBUG, "CTRL_IFACE: DISABLE_NETWORK id=%d", id);
2204
2205 ssid = wpa_config_get_network(wpa_s->conf, id);
2206 if (ssid == NULL) {
2207 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
2208 "network id=%d", id);
2209 return -1;
2210 }
2211 if (ssid->disabled == 2) {
2212 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Cannot use "
2213 "DISABLE_NETWORK with persistent P2P "
2214 "group");
2215 return -1;
2216 }
2217 }
2218 wpa_supplicant_disable_network(wpa_s, ssid);
2219
2220 return 0;
2221 }
2222
2223
2224 static int wpa_supplicant_ctrl_iface_add_network(
2225 struct wpa_supplicant *wpa_s, char *buf, size_t buflen)
2226 {
2227 struct wpa_ssid *ssid;
2228 int ret;
2229
2230 wpa_printf(MSG_DEBUG, "CTRL_IFACE: ADD_NETWORK");
2231
2232 ssid = wpa_config_add_network(wpa_s->conf);
2233 if (ssid == NULL)
2234 return -1;
2235
2236 wpas_notify_network_added(wpa_s, ssid);
2237
2238 ssid->disabled = 1;
2239 wpa_config_set_network_defaults(ssid);
2240
2241 ret = os_snprintf(buf, buflen, "%d\n", ssid->id);
2242 if (ret < 0 || (size_t) ret >= buflen)
2243 return -1;
2244 return ret;
2245 }
2246
2247
2248 static int wpa_supplicant_ctrl_iface_remove_network(
2249 struct wpa_supplicant *wpa_s, char *cmd)
2250 {
2251 int id;
2252 struct wpa_ssid *ssid;
2253 int was_disabled;
2254
2255 /* cmd: "<network id>" or "all" */
2256 if (os_strcmp(cmd, "all") == 0) {
2257 wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_NETWORK all");
2258 if (wpa_s->sched_scanning)
2259 wpa_supplicant_cancel_sched_scan(wpa_s);
2260
2261 eapol_sm_invalidate_cached_session(wpa_s->eapol);
2262 if (wpa_s->current_ssid) {
2263 #ifdef CONFIG_SME
2264 wpa_s->sme.prev_bssid_set = 0;
2265 #endif /* CONFIG_SME */
2266 wpa_sm_set_config(wpa_s->wpa, NULL);
2267 eapol_sm_notify_config(wpa_s->eapol, NULL, NULL);
2268 wpa_supplicant_deauthenticate(
2269 wpa_s, WLAN_REASON_DEAUTH_LEAVING);
2270 }
2271 ssid = wpa_s->conf->ssid;
2272 while (ssid) {
2273 struct wpa_ssid *remove_ssid = ssid;
2274 id = ssid->id;
2275 ssid = ssid->next;
2276 wpas_notify_network_removed(wpa_s, remove_ssid);
2277 wpa_config_remove_network(wpa_s->conf, id);
2278 }
2279 return 0;
2280 }
2281
2282 id = atoi(cmd);
2283 wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_NETWORK id=%d", id);
2284
2285 ssid = wpa_config_get_network(wpa_s->conf, id);
2286 if (ssid)
2287 wpas_notify_network_removed(wpa_s, ssid);
2288 if (ssid == NULL) {
2289 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find network "
2290 "id=%d", id);
2291 return -1;
2292 }
2293
2294 if (ssid == wpa_s->current_ssid || wpa_s->current_ssid == NULL) {
2295 #ifdef CONFIG_SME
2296 wpa_s->sme.prev_bssid_set = 0;
2297 #endif /* CONFIG_SME */
2298 /*
2299 * Invalidate the EAP session cache if the current or
2300 * previously used network is removed.
2301 */
2302 eapol_sm_invalidate_cached_session(wpa_s->eapol);
2303 }
2304
2305 if (ssid == wpa_s->current_ssid) {
2306 wpa_sm_set_config(wpa_s->wpa, NULL);
2307 eapol_sm_notify_config(wpa_s->eapol, NULL, NULL);
2308
2309 wpa_supplicant_deauthenticate(wpa_s,
2310 WLAN_REASON_DEAUTH_LEAVING);
2311 }
2312
2313 was_disabled = ssid->disabled;
2314
2315 if (wpa_config_remove_network(wpa_s->conf, id) < 0) {
2316 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Not able to remove the "
2317 "network id=%d", id);
2318 return -1;
2319 }
2320
2321 if (!was_disabled && wpa_s->sched_scanning) {
2322 wpa_printf(MSG_DEBUG, "Stop ongoing sched_scan to remove "
2323 "network from filters");
2324 wpa_supplicant_cancel_sched_scan(wpa_s);
2325 wpa_supplicant_req_scan(wpa_s, 0, 0);
2326 }
2327
2328 return 0;
2329 }
2330
2331
2332 static int wpa_supplicant_ctrl_iface_set_network(
2333 struct wpa_supplicant *wpa_s, char *cmd)
2334 {
2335 int id;
2336 struct wpa_ssid *ssid;
2337 char *name, *value;
2338
2339 /* cmd: "<network id> <variable name> <value>" */
2340 name = os_strchr(cmd, ' ');
2341 if (name == NULL)
2342 return -1;
2343 *name++ = '\0';
2344
2345 value = os_strchr(name, ' ');
2346 if (value == NULL)
2347 return -1;
2348 *value++ = '\0';
2349
2350 id = atoi(cmd);
2351 wpa_printf(MSG_DEBUG, "CTRL_IFACE: SET_NETWORK id=%d name='%s'",
2352 id, name);
2353 wpa_hexdump_ascii_key(MSG_DEBUG, "CTRL_IFACE: value",
2354 (u8 *) value, os_strlen(value));
2355
2356 ssid = wpa_config_get_network(wpa_s->conf, id);
2357 if (ssid == NULL) {
2358 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find network "
2359 "id=%d", id);
2360 return -1;
2361 }
2362
2363 if (wpa_config_set(ssid, name, value, 0) < 0) {
2364 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Failed to set network "
2365 "variable '%s'", name);
2366 return -1;
2367 }
2368
2369 if (os_strcmp(name, "bssid") != 0 &&
2370 os_strcmp(name, "priority") != 0)
2371 wpa_sm_pmksa_cache_flush(wpa_s->wpa, ssid);
2372
2373 if (wpa_s->current_ssid == ssid || wpa_s->current_ssid == NULL) {
2374 /*
2375 * Invalidate the EAP session cache if anything in the current
2376 * or previously used configuration changes.
2377 */
2378 eapol_sm_invalidate_cached_session(wpa_s->eapol);
2379 }
2380
2381 if ((os_strcmp(name, "psk") == 0 &&
2382 value[0] == '"' && ssid->ssid_len) ||
2383 (os_strcmp(name, "ssid") == 0 && ssid->passphrase))
2384 wpa_config_update_psk(ssid);
2385 else if (os_strcmp(name, "priority") == 0)
2386 wpa_config_update_prio_list(wpa_s->conf);
2387
2388 return 0;
2389 }
2390
2391
2392 static int wpa_supplicant_ctrl_iface_get_network(
2393 struct wpa_supplicant *wpa_s, char *cmd, char *buf, size_t buflen)
2394 {
2395 int id;
2396 size_t res;
2397 struct wpa_ssid *ssid;
2398 char *name, *value;
2399
2400 /* cmd: "<network id> <variable name>" */
2401 name = os_strchr(cmd, ' ');
2402 if (name == NULL || buflen == 0)
2403 return -1;
2404 *name++ = '\0';
2405
2406 id = atoi(cmd);
2407 wpa_printf(MSG_DEBUG, "CTRL_IFACE: GET_NETWORK id=%d name='%s'",
2408 id, name);
2409
2410 ssid = wpa_config_get_network(wpa_s->conf, id);
2411 if (ssid == NULL) {
2412 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find network "
2413 "id=%d", id);
2414 return -1;
2415 }
2416
2417 value = wpa_config_get_no_key(ssid, name);
2418 if (value == NULL) {
2419 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Failed to get network "
2420 "variable '%s'", name);
2421 return -1;
2422 }
2423
2424 res = os_strlcpy(buf, value, buflen);
2425 if (res >= buflen) {
2426 os_free(value);
2427 return -1;
2428 }
2429
2430 os_free(value);
2431
2432 return res;
2433 }
2434
2435
2436 static int wpa_supplicant_ctrl_iface_list_creds(struct wpa_supplicant *wpa_s,
2437 char *buf, size_t buflen)
2438 {
2439 char *pos, *end;
2440 struct wpa_cred *cred;
2441 int ret;
2442
2443 pos = buf;
2444 end = buf + buflen;
2445 ret = os_snprintf(pos, end - pos,
2446 "cred id / realm / username / domain / imsi\n");
2447 if (ret < 0 || ret >= end - pos)
2448 return pos - buf;
2449 pos += ret;
2450
2451 cred = wpa_s->conf->cred;
2452 while (cred) {
2453 ret = os_snprintf(pos, end - pos, "%d\t%s\t%s\t%s\t%s\n",
2454 cred->id, cred->realm ? cred->realm : "",
2455 cred->username ? cred->username : "",
2456 cred->domain ? cred->domain[0] : "",
2457 cred->imsi ? cred->imsi : "");
2458 if (ret < 0 || ret >= end - pos)
2459 return pos - buf;
2460 pos += ret;
2461
2462 cred = cred->next;
2463 }
2464
2465 return pos - buf;
2466 }
2467
2468
2469 static int wpa_supplicant_ctrl_iface_add_cred(struct wpa_supplicant *wpa_s,
2470 char *buf, size_t buflen)
2471 {
2472 struct wpa_cred *cred;
2473 int ret;
2474
2475 wpa_printf(MSG_DEBUG, "CTRL_IFACE: ADD_CRED");
2476
2477 cred = wpa_config_add_cred(wpa_s->conf);
2478 if (cred == NULL)
2479 return -1;
2480
2481 ret = os_snprintf(buf, buflen, "%d\n", cred->id);
2482 if (ret < 0 || (size_t) ret >= buflen)
2483 return -1;
2484 return ret;
2485 }
2486
2487
2488 static int wpas_ctrl_remove_cred(struct wpa_supplicant *wpa_s,
2489 struct wpa_cred *cred)
2490 {
2491 struct wpa_ssid *ssid;
2492 char str[20];
2493
2494 if (cred == NULL || wpa_config_remove_cred(wpa_s->conf, cred->id) < 0) {
2495 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find cred");
2496 return -1;
2497 }
2498
2499 /* Remove any network entry created based on the removed credential */
2500 ssid = wpa_s->conf->ssid;
2501 while (ssid) {
2502 if (ssid->parent_cred == cred) {
2503 wpa_printf(MSG_DEBUG, "Remove network id %d since it "
2504 "used the removed credential", ssid->id);
2505 os_snprintf(str, sizeof(str), "%d", ssid->id);
2506 ssid = ssid->next;
2507 wpa_supplicant_ctrl_iface_remove_network(wpa_s, str);
2508 } else
2509 ssid = ssid->next;
2510 }
2511
2512 return 0;
2513 }
2514
2515
2516 static int wpa_supplicant_ctrl_iface_remove_cred(struct wpa_supplicant *wpa_s,
2517 char *cmd)
2518 {
2519 int id;
2520 struct wpa_cred *cred, *prev;
2521
2522 /* cmd: "<cred id>", "all", or "sp_fqdn=<FQDN>" */
2523 if (os_strcmp(cmd, "all") == 0) {
2524 wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_CRED all");
2525 cred = wpa_s->conf->cred;
2526 while (cred) {
2527 prev = cred;
2528 cred = cred->next;
2529 wpas_ctrl_remove_cred(wpa_s, prev);
2530 }
2531 return 0;
2532 }
2533
2534 if (os_strncmp(cmd, "sp_fqdn=", 8) == 0) {
2535 wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_CRED SP FQDN '%s'",
2536 cmd + 8);
2537 cred = wpa_s->conf->cred;
2538 while (cred) {
2539 prev = cred;
2540 cred = cred->next;
2541 if (prev->domain) {
2542 size_t i;
2543 for (i = 0; i < prev->num_domain; i++) {
2544 if (os_strcmp(prev->domain[i], cmd + 8)
2545 != 0)
2546 continue;
2547 wpas_ctrl_remove_cred(wpa_s, prev);
2548 break;
2549 }
2550 }
2551 }
2552 return 0;
2553 }
2554
2555 id = atoi(cmd);
2556 wpa_printf(MSG_DEBUG, "CTRL_IFACE: REMOVE_CRED id=%d", id);
2557
2558 cred = wpa_config_get_cred(wpa_s->conf, id);
2559 return wpas_ctrl_remove_cred(wpa_s, cred);
2560 }
2561
2562
2563 static int wpa_supplicant_ctrl_iface_set_cred(struct wpa_supplicant *wpa_s,
2564 char *cmd)
2565 {
2566 int id;
2567 struct wpa_cred *cred;
2568 char *name, *value;
2569
2570 /* cmd: "<cred id> <variable name> <value>" */
2571 name = os_strchr(cmd, ' ');
2572 if (name == NULL)
2573 return -1;
2574 *name++ = '\0';
2575
2576 value = os_strchr(name, ' ');
2577 if (value == NULL)
2578 return -1;
2579 *value++ = '\0';
2580
2581 id = atoi(cmd);
2582 wpa_printf(MSG_DEBUG, "CTRL_IFACE: SET_CRED id=%d name='%s'",
2583 id, name);
2584 wpa_hexdump_ascii_key(MSG_DEBUG, "CTRL_IFACE: value",
2585 (u8 *) value, os_strlen(value));
2586
2587 cred = wpa_config_get_cred(wpa_s->conf, id);
2588 if (cred == NULL) {
2589 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find cred id=%d",
2590 id);
2591 return -1;
2592 }
2593
2594 if (wpa_config_set_cred(cred, name, value, 0) < 0) {
2595 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Failed to set cred "
2596 "variable '%s'", name);
2597 return -1;
2598 }
2599
2600 return 0;
2601 }
2602
2603
2604 #ifndef CONFIG_NO_CONFIG_WRITE
2605 static int wpa_supplicant_ctrl_iface_save_config(struct wpa_supplicant *wpa_s)
2606 {
2607 int ret;
2608
2609 if (!wpa_s->conf->update_config) {
2610 wpa_printf(MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Not allowed "
2611 "to update configuration (update_config=0)");
2612 return -1;
2613 }
2614
2615 ret = wpa_config_write(wpa_s->confname, wpa_s->conf);
2616 if (ret) {
2617 wpa_printf(MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Failed to "
2618 "update configuration");
2619 } else {
2620 wpa_printf(MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Configuration"
2621 " updated");
2622 }
2623
2624 return ret;
2625 }
2626 #endif /* CONFIG_NO_CONFIG_WRITE */
2627
2628
2629 static int ctrl_iface_get_capability_pairwise(int res, char *strict,
2630 struct wpa_driver_capa *capa,
2631 char *buf, size_t buflen)
2632 {
2633 int ret, first = 1;
2634 char *pos, *end;
2635 size_t len;
2636
2637 pos = buf;
2638 end = pos + buflen;
2639
2640 if (res < 0) {
2641 if (strict)
2642 return 0;
2643 len = os_strlcpy(buf, "CCMP TKIP NONE", buflen);
2644 if (len >= buflen)
2645 return -1;
2646 return len;
2647 }
2648
2649 if (capa->enc & WPA_DRIVER_CAPA_ENC_CCMP) {
2650 ret = os_snprintf(pos, end - pos, "%sCCMP", first ? "" : " ");
2651 if (ret < 0 || ret >= end - pos)
2652 return pos - buf;
2653 pos += ret;
2654 first = 0;
2655 }
2656
2657 if (capa->enc & WPA_DRIVER_CAPA_ENC_GCMP) {
2658 ret = os_snprintf(pos, end - pos, "%sGCMP", first ? "" : " ");
2659 if (ret < 0 || ret >= end - pos)
2660 return pos - buf;
2661 pos += ret;
2662 first = 0;
2663 }
2664
2665 if (capa->enc & WPA_DRIVER_CAPA_ENC_TKIP) {
2666 ret = os_snprintf(pos, end - pos, "%sTKIP", first ? "" : " ");
2667 if (ret < 0 || ret >= end - pos)
2668 return pos - buf;
2669 pos += ret;
2670 first = 0;
2671 }
2672
2673 if (capa->key_mgmt & WPA_DRIVER_CAPA_KEY_MGMT_WPA_NONE) {
2674 ret = os_snprintf(pos, end - pos, "%sNONE", first ? "" : " ");
2675 if (ret < 0 || ret >= end - pos)
2676 return pos - buf;
2677 pos += ret;
2678 first = 0;
2679 }
2680
2681 return pos - buf;
2682 }
2683
2684
2685 static int ctrl_iface_get_capability_group(int res, char *strict,
2686 struct wpa_driver_capa *capa,
2687 char *buf, size_t buflen)
2688 {
2689 int ret, first = 1;
2690 char *pos, *end;
2691 size_t len;
2692
2693 pos = buf;
2694 end = pos + buflen;
2695
2696 if (res < 0) {
2697 if (strict)
2698 return 0;
2699 len = os_strlcpy(buf, "CCMP TKIP WEP104 WEP40", buflen);
2700 if (len >= buflen)
2701 return -1;
2702 return len;
2703 }
2704
2705 if (capa->enc & WPA_DRIVER_CAPA_ENC_CCMP) {
2706 ret = os_snprintf(pos, end - pos, "%sCCMP", first ? "" : " ");
2707 if (ret < 0 || ret >= end - pos)
2708 return pos - buf;
2709 pos += ret;
2710 first = 0;
2711 }
2712
2713 if (capa->enc & WPA_DRIVER_CAPA_ENC_GCMP) {
2714 ret = os_snprintf(pos, end - pos, "%sGCMP", first ? "" : " ");
2715 if (ret < 0 || ret >= end - pos)
2716 return pos - buf;
2717 pos += ret;
2718 first = 0;
2719 }
2720
2721 if (capa->enc & WPA_DRIVER_CAPA_ENC_TKIP) {
2722 ret = os_snprintf(pos, end - pos, "%sTKIP", first ? "" : " ");
2723 if (ret < 0 || ret >= end - pos)
2724 return pos - buf;
2725 pos += ret;
2726 first = 0;
2727 }
2728
2729 if (capa->enc & WPA_DRIVER_CAPA_ENC_WEP104) {
2730 ret = os_snprintf(pos, end - pos, "%sWEP104",
2731 first ? "" : " ");
2732 if (ret < 0 || ret >= end - pos)
2733 return pos - buf;
2734 pos += ret;
2735 first = 0;
2736 }
2737
2738 if (capa->enc & WPA_DRIVER_CAPA_ENC_WEP40) {
2739 ret = os_snprintf(pos, end - pos, "%sWEP40", first ? "" : " ");
2740 if (ret < 0 || ret >= end - pos)
2741 return pos - buf;
2742 pos += ret;
2743 first = 0;
2744 }
2745
2746 return pos - buf;
2747 }
2748
2749
2750 static int ctrl_iface_get_capability_key_mgmt(int res, char *strict,
2751 struct wpa_driver_capa *capa,
2752 char *buf, size_t buflen)
2753 {
2754 int ret;
2755 char *pos, *end;
2756 size_t len;
2757
2758 pos = buf;
2759 end = pos + buflen;
2760
2761 if (res < 0) {
2762 if (strict)
2763 return 0;
2764 len = os_strlcpy(buf, "WPA-PSK WPA-EAP IEEE8021X WPA-NONE "
2765 "NONE", buflen);
2766 if (len >= buflen)
2767 return -1;
2768 return len;
2769 }
2770
2771 ret = os_snprintf(pos, end - pos, "NONE IEEE8021X");
2772 if (ret < 0 || ret >= end - pos)
2773 return pos - buf;
2774 pos += ret;
2775
2776 if (capa->key_mgmt & (WPA_DRIVER_CAPA_KEY_MGMT_WPA |
2777 WPA_DRIVER_CAPA_KEY_MGMT_WPA2)) {
2778 ret = os_snprintf(pos, end - pos, " WPA-EAP");
2779 if (ret < 0 || ret >= end - pos)
2780 return pos - buf;
2781 pos += ret;
2782 }
2783
2784 if (capa->key_mgmt & (WPA_DRIVER_CAPA_KEY_MGMT_WPA_PSK |
2785 WPA_DRIVER_CAPA_KEY_MGMT_WPA2_PSK)) {
2786 ret = os_snprintf(pos, end - pos, " WPA-PSK");
2787 if (ret < 0 || ret >= end - pos)
2788 return pos - buf;
2789 pos += ret;
2790 }
2791
2792 if (capa->key_mgmt & WPA_DRIVER_CAPA_KEY_MGMT_WPA_NONE) {
2793 ret = os_snprintf(pos, end - pos, " WPA-NONE");
2794 if (ret < 0 || ret >= end - pos)
2795 return pos - buf;
2796 pos += ret;
2797 }
2798
2799 return pos - buf;
2800 }
2801
2802
2803 static int ctrl_iface_get_capability_proto(int res, char *strict,
2804 struct wpa_driver_capa *capa,
2805 char *buf, size_t buflen)
2806 {
2807 int ret, first = 1;
2808 char *pos, *end;
2809 size_t len;
2810
2811 pos = buf;
2812 end = pos + buflen;
2813
2814 if (res < 0) {
2815 if (strict)
2816 return 0;
2817 len = os_strlcpy(buf, "RSN WPA", buflen);
2818 if (len >= buflen)
2819 return -1;
2820 return len;
2821 }
2822
2823 if (capa->key_mgmt & (WPA_DRIVER_CAPA_KEY_MGMT_WPA2 |
2824 WPA_DRIVER_CAPA_KEY_MGMT_WPA2_PSK)) {
2825 ret = os_snprintf(pos, end - pos, "%sRSN", first ? "" : " ");
2826 if (ret < 0 || ret >= end - pos)
2827 return pos - buf;
2828 pos += ret;
2829 first = 0;
2830 }
2831
2832 if (capa->key_mgmt & (WPA_DRIVER_CAPA_KEY_MGMT_WPA |
2833 WPA_DRIVER_CAPA_KEY_MGMT_WPA_PSK)) {
2834 ret = os_snprintf(pos, end - pos, "%sWPA", first ? "" : " ");
2835 if (ret < 0 || ret >= end - pos)
2836 return pos - buf;
2837 pos += ret;
2838 first = 0;
2839 }
2840
2841 return pos - buf;
2842 }
2843
2844
2845 static int ctrl_iface_get_capability_auth_alg(int res, char *strict,
2846 struct wpa_driver_capa *capa,
2847 char *buf, size_t buflen)
2848 {
2849 int ret, first = 1;
2850 char *pos, *end;
2851 size_t len;
2852
2853 pos = buf;
2854 end = pos + buflen;
2855
2856 if (res < 0) {
2857 if (strict)
2858 return 0;
2859 len = os_strlcpy(buf, "OPEN SHARED LEAP", buflen);
2860 if (len >= buflen)
2861 return -1;
2862 return len;
2863 }
2864
2865 if (capa->auth & (WPA_DRIVER_AUTH_OPEN)) {
2866 ret = os_snprintf(pos, end - pos, "%sOPEN", first ? "" : " ");
2867 if (ret < 0 || ret >= end - pos)
2868 return pos - buf;
2869 pos += ret;
2870 first = 0;
2871 }
2872
2873 if (capa->auth & (WPA_DRIVER_AUTH_SHARED)) {
2874 ret = os_snprintf(pos, end - pos, "%sSHARED",
2875 first ? "" : " ");
2876 if (ret < 0 || ret >= end - pos)
2877 return pos - buf;
2878 pos += ret;
2879 first = 0;
2880 }
2881
2882 if (capa->auth & (WPA_DRIVER_AUTH_LEAP)) {
2883 ret = os_snprintf(pos, end - pos, "%sLEAP", first ? "" : " ");
2884 if (ret < 0 || ret >= end - pos)
2885 return pos - buf;
2886 pos += ret;
2887 first = 0;
2888 }
2889
2890 return pos - buf;
2891 }
2892
2893
2894 static int ctrl_iface_get_capability_modes(int res, char *strict,
2895 struct wpa_driver_capa *capa,
2896 char *buf, size_t buflen)
2897 {
2898 int ret, first = 1;
2899 char *pos, *end;
2900 size_t len;
2901
2902 pos = buf;
2903 end = pos + buflen;
2904
2905 if (res < 0) {
2906 if (strict)
2907 return 0;
2908 len = os_strlcpy(buf, "IBSS AP", buflen);
2909 if (len >= buflen)
2910 return -1;
2911 return len;
2912 }
2913
2914 if (capa->flags & WPA_DRIVER_FLAGS_IBSS) {
2915 ret = os_snprintf(pos, end - pos, "%sIBSS", first ? "" : " ");
2916 if (ret < 0 || ret >= end - pos)
2917 return pos - buf;
2918 pos += ret;
2919 first = 0;
2920 }
2921
2922 if (capa->flags & WPA_DRIVER_FLAGS_AP) {
2923 ret = os_snprintf(pos, end - pos, "%sAP", first ? "" : " ");
2924 if (ret < 0 || ret >= end - pos)
2925 return pos - buf;
2926 pos += ret;
2927 first = 0;
2928 }
2929
2930 return pos - buf;
2931 }
2932
2933
2934 static int ctrl_iface_get_capability_channels(struct wpa_supplicant *wpa_s,
2935 char *buf, size_t buflen)
2936 {
2937 struct hostapd_channel_data *chnl;
2938 int ret, i, j;
2939 char *pos, *end, *hmode;
2940
2941 pos = buf;
2942 end = pos + buflen;
2943
2944 for (j = 0; j < wpa_s->hw.num_modes; j++) {
2945 switch (wpa_s->hw.modes[j].mode) {
2946 case HOSTAPD_MODE_IEEE80211B:
2947 hmode = "B";
2948 break;
2949 case HOSTAPD_MODE_IEEE80211G:
2950 hmode = "G";
2951 break;
2952 case HOSTAPD_MODE_IEEE80211A:
2953 hmode = "A";
2954 break;
2955 case HOSTAPD_MODE_IEEE80211AD:
2956 hmode = "AD";
2957 break;
2958 default:
2959 continue;
2960 }
2961 ret = os_snprintf(pos, end - pos, "Mode[%s] Channels:", hmode);
2962 if (ret < 0 || ret >= end - pos)
2963 return pos - buf;
2964 pos += ret;
2965 chnl = wpa_s->hw.modes[j].channels;
2966 for (i = 0; i < wpa_s->hw.modes[j].num_channels; i++) {
2967 if (chnl[i].flag & HOSTAPD_CHAN_DISABLED)
2968 continue;
2969 ret = os_snprintf(pos, end - pos, " %d", chnl[i].chan);
2970 if (ret < 0 || ret >= end - pos)
2971 return pos - buf;
2972 pos += ret;
2973 }
2974 ret = os_snprintf(pos, end - pos, "\n");
2975 if (ret < 0 || ret >= end - pos)
2976 return pos - buf;
2977 pos += ret;
2978 }
2979
2980 return pos - buf;
2981 }
2982
2983
2984 static int ctrl_iface_get_capability_freq(struct wpa_supplicant *wpa_s,
2985 char *buf, size_t buflen)
2986 {
2987 struct hostapd_channel_data *chnl;
2988 int ret, i, j;
2989 char *pos, *end, *hmode;
2990
2991 pos = buf;
2992 end = pos + buflen;
2993
2994 for (j = 0; j < wpa_s->hw.num_modes; j++) {
2995 switch (wpa_s->hw.modes[j].mode) {
2996 case HOSTAPD_MODE_IEEE80211B:
2997 hmode = "B";
2998 break;
2999 case HOSTAPD_MODE_IEEE80211G:
3000 hmode = "G";
3001 break;
3002 case HOSTAPD_MODE_IEEE80211A:
3003 hmode = "A";
3004 break;
3005 case HOSTAPD_MODE_IEEE80211AD:
3006 hmode = "AD";
3007 break;
3008 default:
3009 continue;
3010 }
3011 ret = os_snprintf(pos, end - pos, "Mode[%s] Channels:\n",
3012 hmode);
3013 if (ret < 0 || ret >= end - pos)
3014 return pos - buf;
3015 pos += ret;
3016 chnl = wpa_s->hw.modes[j].channels;
3017 for (i = 0; i < wpa_s->hw.modes[j].num_channels; i++) {
3018 if (chnl[i].flag & HOSTAPD_CHAN_DISABLED)
3019 continue;
3020 ret = os_snprintf(pos, end - pos, " %d = %d MHz%s\n",
3021 chnl[i].chan, chnl[i].freq,
3022 chnl[i].flag & HOSTAPD_CHAN_NO_IBSS ?
3023 " (NO_IBSS)" : "");
3024 if (ret < 0 || ret >= end - pos)
3025 return pos - buf;
3026 pos += ret;
3027 }
3028 ret = os_snprintf(pos, end - pos, "\n");
3029 if (ret < 0 || ret >= end - pos)
3030 return pos - buf;
3031 pos += ret;
3032 }
3033
3034 return pos - buf;
3035 }
3036
3037
3038 static int wpa_supplicant_ctrl_iface_get_capability(
3039 struct wpa_supplicant *wpa_s, const char *_field, char *buf,
3040 size_t buflen)
3041 {
3042 struct wpa_driver_capa capa;
3043 int res;
3044 char *strict;
3045 char field[30];
3046 size_t len;
3047
3048 /* Determine whether or not strict checking was requested */
3049 len = os_strlcpy(field, _field, sizeof(field));
3050 if (len >= sizeof(field))
3051 return -1;
3052 strict = os_strchr(field, ' ');
3053 if (strict != NULL) {
3054 *strict++ = '\0';
3055 if (os_strcmp(strict, "strict") != 0)
3056 return -1;
3057 }
3058
3059 wpa_printf(MSG_DEBUG, "CTRL_IFACE: GET_CAPABILITY '%s' %s",
3060 field, strict ? strict : "");
3061
3062 if (os_strcmp(field, "eap") == 0) {
3063 return eap_get_names(buf, buflen);
3064 }
3065
3066 res = wpa_drv_get_capa(wpa_s, &capa);
3067
3068 if (os_strcmp(field, "pairwise") == 0)
3069 return ctrl_iface_get_capability_pairwise(res, strict, &capa,
3070 buf, buflen);
3071
3072 if (os_strcmp(field, "group") == 0)
3073 return ctrl_iface_get_capability_group(res, strict, &capa,
3074 buf, buflen);
3075
3076 if (os_strcmp(field, "key_mgmt") == 0)
3077 return ctrl_iface_get_capability_key_mgmt(res, strict, &capa,
3078 buf, buflen);
3079
3080 if (os_strcmp(field, "proto") == 0)
3081 return ctrl_iface_get_capability_proto(res, strict, &capa,
3082 buf, buflen);
3083
3084 if (os_strcmp(field, "auth_alg") == 0)
3085 return ctrl_iface_get_capability_auth_alg(res, strict, &capa,
3086 buf, buflen);
3087
3088 if (os_strcmp(field, "modes") == 0)
3089 return ctrl_iface_get_capability_modes(res, strict, &capa,
3090 buf, buflen);
3091
3092 if (os_strcmp(field, "channels") == 0)
3093 return ctrl_iface_get_capability_channels(wpa_s, buf, buflen);
3094
3095 if (os_strcmp(field, "freq") == 0)
3096 return ctrl_iface_get_capability_freq(wpa_s, buf, buflen);
3097
3098 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Unknown GET_CAPABILITY field '%s'",
3099 field);
3100
3101 return -1;
3102 }
3103
3104
3105 #ifdef CONFIG_INTERWORKING
3106 static char * anqp_add_hex(char *pos, char *end, const char *title,
3107 struct wpabuf *data)
3108 {
3109 char *start = pos;
3110 size_t i;
3111 int ret;
3112 const u8 *d;
3113
3114 if (data == NULL)
3115 return start;
3116
3117 ret = os_snprintf(pos, end - pos, "%s=", title);
3118 if (ret < 0 || ret >= end - pos)
3119 return start;
3120 pos += ret;
3121
3122 d = wpabuf_head_u8(data);
3123 for (i = 0; i < wpabuf_len(data); i++) {
3124 ret = os_snprintf(pos, end - pos, "%02x", *d++);
3125 if (ret < 0 || ret >= end - pos)
3126 return start;
3127 pos += ret;
3128 }
3129
3130 ret = os_snprintf(pos, end - pos, "\n");
3131 if (ret < 0 || ret >= end - pos)
3132 return start;
3133 pos += ret;
3134
3135 return pos;
3136 }
3137 #endif /* CONFIG_INTERWORKING */
3138
3139
3140 static int print_bss_info(struct wpa_supplicant *wpa_s, struct wpa_bss *bss,
3141 unsigned long mask, char *buf, size_t buflen)
3142 {
3143 size_t i;
3144 int ret;
3145 char *pos, *end;
3146 const u8 *ie, *ie2;
3147
3148 pos = buf;
3149 end = buf + buflen;
3150
3151 if (mask & WPA_BSS_MASK_ID) {
3152 ret = os_snprintf(pos, end - pos, "id=%u\n", bss->id);
3153 if (ret < 0 || ret >= end - pos)
3154 return 0;
3155 pos += ret;
3156 }
3157
3158 if (mask & WPA_BSS_MASK_BSSID) {
3159 ret = os_snprintf(pos, end - pos, "bssid=" MACSTR "\n",
3160 MAC2STR(bss->bssid));
3161 if (ret < 0 || ret >= end - pos)
3162 return 0;
3163 pos += ret;
3164 }
3165
3166 if (mask & WPA_BSS_MASK_FREQ) {
3167 ret = os_snprintf(pos, end - pos, "freq=%d\n", bss->freq);
3168 if (ret < 0 || ret >= end - pos)
3169 return 0;
3170 pos += ret;
3171 }
3172
3173 if (mask & WPA_BSS_MASK_BEACON_INT) {
3174 ret = os_snprintf(pos, end - pos, "beacon_int=%d\n",
3175 bss->beacon_int);
3176 if (ret < 0 || ret >= end - pos)
3177 return 0;
3178 pos += ret;
3179 }
3180
3181 if (mask & WPA_BSS_MASK_CAPABILITIES) {
3182 ret = os_snprintf(pos, end - pos, "capabilities=0x%04x\n",
3183 bss->caps);
3184 if (ret < 0 || ret >= end - pos)
3185 return 0;
3186 pos += ret;
3187 }
3188
3189 if (mask & WPA_BSS_MASK_QUAL) {
3190 ret = os_snprintf(pos, end - pos, "qual=%d\n", bss->qual);
3191 if (ret < 0 || ret >= end - pos)
3192 return 0;
3193 pos += ret;
3194 }
3195
3196 if (mask & WPA_BSS_MASK_NOISE) {
3197 ret = os_snprintf(pos, end - pos, "noise=%d\n", bss->noise);
3198 if (ret < 0 || ret >= end - pos)
3199 return 0;
3200 pos += ret;
3201 }
3202
3203 if (mask & WPA_BSS_MASK_LEVEL) {
3204 ret = os_snprintf(pos, end - pos, "level=%d\n", bss->level);
3205 if (ret < 0 || ret >= end - pos)
3206 return 0;
3207 pos += ret;
3208 }
3209
3210 if (mask & WPA_BSS_MASK_TSF) {
3211 ret = os_snprintf(pos, end - pos, "tsf=%016llu\n",
3212 (unsigned long long) bss->tsf);
3213 if (ret < 0 || ret >= end - pos)
3214 return 0;
3215 pos += ret;
3216 }
3217
3218 if (mask & WPA_BSS_MASK_AGE) {
3219 struct os_time now;
3220
3221 os_get_time(&now);
3222 ret = os_snprintf(pos, end - pos, "age=%d\n",
3223 (int) (now.sec - bss->last_update.sec));
3224 if (ret < 0 || ret >= end - pos)
3225 return 0;
3226 pos += ret;
3227 }
3228
3229 if (mask & WPA_BSS_MASK_IE) {
3230 ret = os_snprintf(pos, end - pos, "ie=");
3231 if (ret < 0 || ret >= end - pos)
3232 return 0;
3233 pos += ret;
3234
3235 ie = (const u8 *) (bss + 1);
3236 for (i = 0; i < bss->ie_len; i++) {
3237 ret = os_snprintf(pos, end - pos, "%02x", *ie++);
3238 if (ret < 0 || ret >= end - pos)
3239 return 0;
3240 pos += ret;
3241 }
3242
3243 ret = os_snprintf(pos, end - pos, "\n");
3244 if (ret < 0 || ret >= end - pos)
3245 return 0;
3246 pos += ret;
3247 }
3248
3249 if (mask & WPA_BSS_MASK_FLAGS) {
3250 ret = os_snprintf(pos, end - pos, "flags=");
3251 if (ret < 0 || ret >= end - pos)
3252 return 0;
3253 pos += ret;
3254
3255 ie = wpa_bss_get_vendor_ie(bss, WPA_IE_VENDOR_TYPE);
3256 if (ie)
3257 pos = wpa_supplicant_ie_txt(pos, end, "WPA", ie,
3258 2 + ie[1]);
3259 ie2 = wpa_bss_get_ie(bss, WLAN_EID_RSN);
3260 if (ie2)
3261 pos = wpa_supplicant_ie_txt(pos, end, "WPA2", ie2,
3262 2 + ie2[1]);
3263 pos = wpa_supplicant_wps_ie_txt(wpa_s, pos, end, bss);
3264 if (!ie && !ie2 && bss->caps & IEEE80211_CAP_PRIVACY) {
3265 ret = os_snprintf(pos, end - pos, "[WEP]");
3266 if (ret < 0 || ret >= end - pos)
3267 return 0;
3268 pos += ret;
3269 }
3270 if (bss->caps & IEEE80211_CAP_IBSS) {
3271 ret = os_snprintf(pos, end - pos, "[IBSS]");
3272 if (ret < 0 || ret >= end - pos)
3273 return 0;
3274 pos += ret;
3275 }
3276 if (bss->caps & IEEE80211_CAP_ESS) {
3277 ret = os_snprintf(pos, end - pos, "[ESS]");
3278 if (ret < 0 || ret >= end - pos)
3279 return 0;
3280 pos += ret;
3281 }
3282 if (wpa_bss_get_vendor_ie(bss, P2P_IE_VENDOR_TYPE) ||
3283 wpa_bss_get_vendor_ie_beacon(bss, P2P_IE_VENDOR_TYPE)) {
3284 ret = os_snprintf(pos, end - pos, "[P2P]");
3285 if (ret < 0 || ret >= end - pos)
3286 return 0;
3287 pos += ret;
3288 }
3289 #ifdef CONFIG_HS20
3290 if (wpa_bss_get_vendor_ie(bss, HS20_IE_VENDOR_TYPE)) {
3291 ret = os_snprintf(pos, end - pos, "[HS20]");
3292 if (ret < 0 || ret >= end - pos)
3293 return 0;
3294 pos += ret;
3295 }
3296 #endif /* CONFIG_HS20 */
3297
3298 ret = os_snprintf(pos, end - pos, "\n");
3299 if (ret < 0 || ret >= end - pos)
3300 return 0;
3301 pos += ret;
3302 }
3303
3304 if (mask & WPA_BSS_MASK_SSID) {
3305 ret = os_snprintf(pos, end - pos, "ssid=%s\n",
3306 wpa_ssid_txt(bss->ssid, bss->ssid_len));
3307 if (ret < 0 || ret >= end - pos)
3308 return 0;
3309 pos += ret;
3310 }
3311
3312 #ifdef CONFIG_WPS
3313 if (mask & WPA_BSS_MASK_WPS_SCAN) {
3314 ie = (const u8 *) (bss + 1);
3315 ret = wpas_wps_scan_result_text(ie, bss->ie_len, pos, end);
3316 if (ret < 0 || ret >= end - pos)
3317 return 0;
3318 pos += ret;
3319 }
3320 #endif /* CONFIG_WPS */
3321
3322 #ifdef CONFIG_P2P
3323 if (mask & WPA_BSS_MASK_P2P_SCAN) {
3324 ie = (const u8 *) (bss + 1);
3325 ret = wpas_p2p_scan_result_text(ie, bss->ie_len, pos, end);
3326 if (ret < 0 || ret >= end - pos)
3327 return 0;
3328 pos += ret;
3329 }
3330 #endif /* CONFIG_P2P */
3331
3332 #ifdef CONFIG_WIFI_DISPLAY
3333 if (mask & WPA_BSS_MASK_WIFI_DISPLAY) {
3334 struct wpabuf *wfd;
3335 ie = (const u8 *) (bss + 1);
3336 wfd = ieee802_11_vendor_ie_concat(ie, bss->ie_len,
3337 WFD_IE_VENDOR_TYPE);
3338 if (wfd) {
3339 ret = os_snprintf(pos, end - pos, "wfd_subelems=");
3340 if (ret < 0 || ret >= end - pos)
3341 return 0;
3342 pos += ret;
3343
3344 pos += wpa_snprintf_hex(pos, end - pos,
3345 wpabuf_head(wfd),
3346 wpabuf_len(wfd));
3347 wpabuf_free(wfd);
3348
3349 ret = os_snprintf(pos, end - pos, "\n");
3350 if (ret < 0 || ret >= end - pos)
3351 return 0;
3352 pos += ret;
3353 }
3354 }
3355 #endif /* CONFIG_WIFI_DISPLAY */
3356
3357 #ifdef CONFIG_INTERWORKING
3358 if ((mask & WPA_BSS_MASK_INTERNETW) && bss->anqp) {
3359 struct wpa_bss_anqp *anqp = bss->anqp;
3360 pos = anqp_add_hex(pos, end, "anqp_venue_name",
3361 anqp->venue_name);
3362 pos = anqp_add_hex(pos, end, "anqp_network_auth_type",
3363 anqp->network_auth_type);
3364 pos = anqp_add_hex(pos, end, "anqp_roaming_consortium",
3365 anqp->roaming_consortium);
3366 pos = anqp_add_hex(pos, end, "anqp_ip_addr_type_availability",
3367 anqp->ip_addr_type_availability);
3368 pos = anqp_add_hex(pos, end, "anqp_nai_realm",
3369 anqp->nai_realm);
3370 pos = anqp_add_hex(pos, end, "anqp_3gpp", anqp->anqp_3gpp);
3371 pos = anqp_add_hex(pos, end, "anqp_domain_name",
3372 anqp->domain_name);
3373 #ifdef CONFIG_HS20
3374 pos = anqp_add_hex(pos, end, "hs20_operator_friendly_name",
3375 anqp->hs20_operator_friendly_name);
3376 pos = anqp_add_hex(pos, end, "hs20_wan_metrics",
3377 anqp->hs20_wan_metrics);
3378 pos = anqp_add_hex(pos, end, "hs20_connection_capability",
3379 anqp->hs20_connection_capability);
3380 #endif /* CONFIG_HS20 */
3381 }
3382 #endif /* CONFIG_INTERWORKING */
3383
3384 if (mask & WPA_BSS_MASK_DELIM) {
3385 ret = os_snprintf(pos, end - pos, "====\n");
3386 if (ret < 0 || ret >= end - pos)
3387 return 0;
3388 pos += ret;
3389 }
3390
3391 return pos - buf;
3392 }
3393
3394
3395 static int wpa_supplicant_ctrl_iface_bss(struct wpa_supplicant *wpa_s,
3396 const char *cmd, char *buf,
3397 size_t buflen)
3398 {
3399 u8 bssid[ETH_ALEN];
3400 size_t i;
3401 struct wpa_bss *bss;
3402 struct wpa_bss *bsslast = NULL;
3403 struct dl_list *next;
3404 int ret = 0;
3405 int len;
3406 char *ctmp;
3407 unsigned long mask = WPA_BSS_MASK_ALL;
3408
3409 if (os_strncmp(cmd, "RANGE=", 6) == 0) {
3410 if (os_strncmp(cmd + 6, "ALL", 3) == 0) {
3411 bss = dl_list_first(&wpa_s->bss_id, struct wpa_bss,
3412 list_id);
3413 bsslast = dl_list_last(&wpa_s->bss_id, struct wpa_bss,
3414 list_id);
3415 } else { /* N1-N2 */
3416 unsigned int id1, id2;
3417
3418 if ((ctmp = os_strchr(cmd + 6, '-')) == NULL) {
3419 wpa_printf(MSG_INFO, "Wrong BSS range "
3420 "format");
3421 return 0;
3422 }
3423
3424 if (*(cmd + 6) == '-')
3425 id1 = 0;
3426 else
3427 id1 = atoi(cmd + 6);
3428 ctmp++;
3429 if (*ctmp >= '0' && *ctmp <= '9')
3430 id2 = atoi(ctmp);
3431 else
3432 id2 = (unsigned int) -1;
3433 bss = wpa_bss_get_id_range(wpa_s, id1, id2);
3434 if (id2 == (unsigned int) -1)
3435 bsslast = dl_list_last(&wpa_s->bss_id,
3436 struct wpa_bss,
3437 list_id);
3438 else {
3439 bsslast = wpa_bss_get_id(wpa_s, id2);
3440 if (bsslast == NULL && bss && id2 > id1) {
3441 struct wpa_bss *tmp = bss;
3442 for (;;) {
3443 next = tmp->list_id.next;
3444 if (next == &wpa_s->bss_id)
3445 break;
3446 tmp = dl_list_entry(
3447 next, struct wpa_bss,
3448 list_id);
3449 if (tmp->id > id2)
3450 break;
3451 bsslast = tmp;
3452 }
3453 }
3454 }
3455 }
3456 } else if (os_strncmp(cmd, "FIRST", 5) == 0)
3457 bss = dl_list_first(&wpa_s->bss_id, struct wpa_bss, list_id);
3458 else if (os_strncmp(cmd, "LAST", 4) == 0)
3459 bss = dl_list_last(&wpa_s->bss_id, struct wpa_bss, list_id);
3460 else if (os_strncmp(cmd, "ID-", 3) == 0) {
3461 i = atoi(cmd + 3);
3462 bss = wpa_bss_get_id(wpa_s, i);
3463 } else if (os_strncmp(cmd, "NEXT-", 5) == 0) {
3464 i = atoi(cmd + 5);
3465 bss = wpa_bss_get_id(wpa_s, i);
3466 if (bss) {
3467 next = bss->list_id.next;
3468 if (next == &wpa_s->bss_id)
3469 bss = NULL;
3470 else
3471 bss = dl_list_entry(next, struct wpa_bss,
3472 list_id);
3473 }
3474 #ifdef CONFIG_P2P
3475 } else if (os_strncmp(cmd, "p2p_dev_addr=", 13) == 0) {
3476 if (hwaddr_aton(cmd + 13, bssid) == 0)
3477 bss = wpa_bss_get_p2p_dev_addr(wpa_s, bssid);
3478 else
3479 bss = NULL;
3480 #endif /* CONFIG_P2P */
3481 } else if (hwaddr_aton(cmd, bssid) == 0)
3482 bss = wpa_bss_get_bssid(wpa_s, bssid);
3483 else {
3484 struct wpa_bss *tmp;
3485 i = atoi(cmd);
3486 bss = NULL;
3487 dl_list_for_each(tmp, &wpa_s->bss_id, struct wpa_bss, list_id)
3488 {
3489 if (i-- == 0) {
3490 bss = tmp;
3491 break;
3492 }
3493 }
3494 }
3495
3496 if ((ctmp = os_strstr(cmd, "MASK=")) != NULL) {
3497 mask = strtoul(ctmp + 5, NULL, 0x10);
3498 if (mask == 0)
3499 mask = WPA_BSS_MASK_ALL;
3500 }
3501
3502 if (bss == NULL)
3503 return 0;
3504
3505 if (bsslast == NULL)
3506 bsslast = bss;
3507 do {
3508 len = print_bss_info(wpa_s, bss, mask, buf, buflen);
3509 ret += len;
3510 buf += len;
3511 buflen -= len;
3512 if (bss == bsslast) {
3513 if ((mask & WPA_BSS_MASK_DELIM) && len &&
3514 (bss == dl_list_last(&wpa_s->bss_id,
3515 struct wpa_bss, list_id)))
3516 os_snprintf(buf - 5, 5, "####\n");
3517 break;
3518 }
3519 next = bss->list_id.next;
3520 if (next == &wpa_s->bss_id)
3521 break;
3522 bss = dl_list_entry(next, struct wpa_bss, list_id);
3523 } while (bss && len);
3524
3525 return ret;
3526 }
3527
3528
3529 static int wpa_supplicant_ctrl_iface_ap_scan(
3530 struct wpa_supplicant *wpa_s, char *cmd)
3531 {
3532 int ap_scan = atoi(cmd);
3533 return wpa_supplicant_set_ap_scan(wpa_s, ap_scan);
3534 }
3535
3536
3537 static int wpa_supplicant_ctrl_iface_scan_interval(
3538 struct wpa_supplicant *wpa_s, char *cmd)
3539 {
3540 int scan_int = atoi(cmd);
3541 return wpa_supplicant_set_scan_interval(wpa_s, scan_int);
3542 }
3543
3544
3545 static int wpa_supplicant_ctrl_iface_bss_expire_age(
3546 struct wpa_supplicant *wpa_s, char *cmd)
3547 {
3548 int expire_age = atoi(cmd);
3549 return wpa_supplicant_set_bss_expiration_age(wpa_s, expire_age);
3550 }
3551
3552
3553 static int wpa_supplicant_ctrl_iface_bss_expire_count(
3554 struct wpa_supplicant *wpa_s, char *cmd)
3555 {
3556 int expire_count = atoi(cmd);
3557 return wpa_supplicant_set_bss_expiration_count(wpa_s, expire_count);
3558 }
3559
3560
3561 static int wpa_supplicant_ctrl_iface_bss_flush(
3562 struct wpa_supplicant *wpa_s, char *cmd)
3563 {
3564 int flush_age = atoi(cmd);
3565
3566 if (flush_age == 0)
3567 wpa_bss_flush(wpa_s);
3568 else
3569 wpa_bss_flush_by_age(wpa_s, flush_age);
3570 return 0;
3571 }
3572
3573
3574 static void wpa_supplicant_ctrl_iface_drop_sa(struct wpa_supplicant *wpa_s)
3575 {
3576 wpa_printf(MSG_DEBUG, "Dropping SA without deauthentication");
3577 /* MLME-DELETEKEYS.request */
3578 wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 0, 0, NULL, 0, NULL, 0);
3579 wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 1, 0, NULL, 0, NULL, 0);
3580 wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 2, 0, NULL, 0, NULL, 0);
3581 wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 3, 0, NULL, 0, NULL, 0);
3582 #ifdef CONFIG_IEEE80211W
3583 wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 4, 0, NULL, 0, NULL, 0);
3584 wpa_drv_set_key(wpa_s, WPA_ALG_NONE, NULL, 5, 0, NULL, 0, NULL, 0);
3585 #endif /* CONFIG_IEEE80211W */
3586
3587 wpa_drv_set_key(wpa_s, WPA_ALG_NONE, wpa_s->bssid, 0, 0, NULL, 0, NULL,
3588 0);
3589 /* MLME-SETPROTECTION.request(None) */
3590 wpa_drv_mlme_setprotection(wpa_s, wpa_s->bssid,
3591 MLME_SETPROTECTION_PROTECT_TYPE_NONE,
3592 MLME_SETPROTECTION_KEY_TYPE_PAIRWISE);
3593 wpa_sm_drop_sa(wpa_s->wpa);
3594 }
3595
3596
3597 static int wpa_supplicant_ctrl_iface_roam(struct wpa_supplicant *wpa_s,
3598 char *addr)
3599 {
3600 #ifdef CONFIG_NO_SCAN_PROCESSING
3601 return -1;
3602 #else /* CONFIG_NO_SCAN_PROCESSING */
3603 u8 bssid[ETH_ALEN];
3604 struct wpa_bss *bss;
3605 struct wpa_ssid *ssid = wpa_s->current_ssid;
3606
3607 if (hwaddr_aton(addr, bssid)) {
3608 wpa_printf(MSG_DEBUG, "CTRL_IFACE ROAM: invalid "
3609 "address '%s'", addr);
3610 return -1;
3611 }
3612
3613 wpa_printf(MSG_DEBUG, "CTRL_IFACE ROAM " MACSTR, MAC2STR(bssid));
3614
3615 if (!ssid) {
3616 wpa_printf(MSG_DEBUG, "CTRL_IFACE ROAM: No network "
3617 "configuration known for the target AP");
3618 return -1;
3619 }
3620
3621 bss = wpa_bss_get(wpa_s, bssid, ssid->ssid, ssid->ssid_len);
3622 if (!bss) {
3623 wpa_printf(MSG_DEBUG, "CTRL_IFACE ROAM: Target AP not found "
3624 "from BSS table");
3625 return -1;
3626 }
3627
3628 /*
3629 * TODO: Find best network configuration block from configuration to
3630 * allow roaming to other networks
3631 */
3632
3633 wpa_s->reassociate = 1;
3634 wpa_supplicant_connect(wpa_s, bss, ssid);
3635
3636 return 0;
3637 #endif /* CONFIG_NO_SCAN_PROCESSING */
3638 }
3639
3640
3641 #ifdef CONFIG_P2P
3642 static int p2p_ctrl_find(struct wpa_supplicant *wpa_s, char *cmd)
3643 {
3644 unsigned int timeout = atoi(cmd);
3645 enum p2p_discovery_type type = P2P_FIND_START_WITH_FULL;
3646 u8 dev_id[ETH_ALEN], *_dev_id = NULL;
3647 char *pos;
3648 unsigned int search_delay;
3649
3650 if (os_strstr(cmd, "type=social"))
3651 type = P2P_FIND_ONLY_SOCIAL;
3652 else if (os_strstr(cmd, "type=progressive"))
3653 type = P2P_FIND_PROGRESSIVE;
3654
3655 pos = os_strstr(cmd, "dev_id=");
3656 if (pos) {
3657 pos += 7;
3658 if (hwaddr_aton(pos, dev_id))
3659 return -1;
3660 _dev_id = dev_id;
3661 }
3662
3663 pos = os_strstr(cmd, "delay=");
3664 if (pos) {
3665 pos += 6;
3666 search_delay = atoi(pos);
3667 } else
3668 search_delay = wpas_p2p_search_delay(wpa_s);
3669
3670 return wpas_p2p_find(wpa_s, timeout, type, 0, NULL, _dev_id,
3671 search_delay);
3672 }
3673
3674
3675 static int p2p_ctrl_connect(struct wpa_supplicant *wpa_s, char *cmd,
3676 char *buf, size_t buflen)
3677 {
3678 u8 addr[ETH_ALEN];
3679 char *pos, *pos2;
3680 char *pin = NULL;
3681 enum p2p_wps_method wps_method;
3682 int new_pin;
3683 int ret;
3684 int persistent_group, persistent_id = -1;
3685 int join;
3686 int auth;
3687 int automatic;
3688 int go_intent = -1;
3689 int freq = 0;
3690 int pd;
3691 int ht40, vht;
3692
3693 /* <addr> <"pbc" | "pin" | PIN> [label|display|keypad]
3694 * [persistent|persistent=<network id>]
3695 * [join] [auth] [go_intent=<0..15>] [freq=<in MHz>] [provdisc]
3696 * [ht40] [vht] */
3697
3698 if (hwaddr_aton(cmd, addr))
3699 return -1;
3700
3701 pos = cmd + 17;
3702 if (*pos != ' ')
3703 return -1;
3704 pos++;
3705
3706 persistent_group = os_strstr(pos, " persistent") != NULL;
3707 pos2 = os_strstr(pos, " persistent=");
3708 if (pos2) {
3709 struct wpa_ssid *ssid;
3710 persistent_id = atoi(pos2 + 12);
3711 ssid = wpa_config_get_network(wpa_s->conf, persistent_id);
3712 if (ssid == NULL || ssid->disabled != 2 ||
3713 ssid->mode != WPAS_MODE_P2P_GO) {
3714 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
3715 "SSID id=%d for persistent P2P group (GO)",
3716 persistent_id);
3717 return -1;
3718 }
3719 }
3720 join = os_strstr(pos, " join") != NULL;
3721 auth = os_strstr(pos, " auth") != NULL;
3722 automatic = os_strstr(pos, " auto") != NULL;
3723 pd = os_strstr(pos, " provdisc") != NULL;
3724 vht = (os_strstr(cmd, " vht") != NULL) || wpa_s->conf->p2p_go_vht;
3725 ht40 = (os_strstr(cmd, " ht40") != NULL) || wpa_s->conf->p2p_go_ht40 ||
3726 vht;
3727
3728 pos2 = os_strstr(pos, " go_intent=");
3729 if (pos2) {
3730 pos2 += 11;
3731 go_intent = atoi(pos2);
3732 if (go_intent < 0 || go_intent > 15)
3733 return -1;
3734 }
3735
3736 pos2 = os_strstr(pos, " freq=");
3737 if (pos2) {
3738 pos2 += 6;
3739 freq = atoi(pos2);
3740 if (freq <= 0)
3741 return -1;
3742 }
3743
3744 if (os_strncmp(pos, "pin", 3) == 0) {
3745 /* Request random PIN (to be displayed) and enable the PIN */
3746 wps_method = WPS_PIN_DISPLAY;
3747 } else if (os_strncmp(pos, "pbc", 3) == 0) {
3748 wps_method = WPS_PBC;
3749 } else {
3750 pin = pos;
3751 pos = os_strchr(pin, ' ');
3752 wps_method = WPS_PIN_KEYPAD;
3753 if (pos) {
3754 *pos++ = '\0';
3755 if (os_strncmp(pos, "display", 7) == 0)
3756 wps_method = WPS_PIN_DISPLAY;
3757 }
3758 if (!wps_pin_str_valid(pin)) {
3759 os_memcpy(buf, "FAIL-INVALID-PIN\n", 17);
3760 return 17;
3761 }
3762 }
3763
3764 new_pin = wpas_p2p_connect(wpa_s, addr, pin, wps_method,
3765 persistent_group, automatic, join,
3766 auth, go_intent, freq, persistent_id, pd,
3767 ht40, vht);
3768 if (new_pin == -2) {
3769 os_memcpy(buf, "FAIL-CHANNEL-UNAVAILABLE\n", 25);
3770 return 25;
3771 }
3772 if (new_pin == -3) {
3773 os_memcpy(buf, "FAIL-CHANNEL-UNSUPPORTED\n", 25);
3774 return 25;
3775 }
3776 if (new_pin < 0)
3777 return -1;
3778 if (wps_method == WPS_PIN_DISPLAY && pin == NULL) {
3779 ret = os_snprintf(buf, buflen, "%08d", new_pin);
3780 if (ret < 0 || (size_t) ret >= buflen)
3781 return -1;
3782 return ret;
3783 }
3784
3785 os_memcpy(buf, "OK\n", 3);
3786 return 3;
3787 }
3788
3789
3790 static int p2p_ctrl_listen(struct wpa_supplicant *wpa_s, char *cmd)
3791 {
3792 unsigned int timeout = atoi(cmd);
3793 return wpas_p2p_listen(wpa_s, timeout);
3794 }
3795
3796
3797 static int p2p_ctrl_prov_disc(struct wpa_supplicant *wpa_s, char *cmd)
3798 {
3799 u8 addr[ETH_ALEN];
3800 char *pos;
3801 enum wpas_p2p_prov_disc_use use = WPAS_P2P_PD_FOR_GO_NEG;
3802
3803 /* <addr> <config method> [join|auto] */
3804
3805 if (hwaddr_aton(cmd, addr))
3806 return -1;
3807
3808 pos = cmd + 17;
3809 if (*pos != ' ')
3810 return -1;
3811 pos++;
3812
3813 if (os_strstr(pos, " join") != NULL)
3814 use = WPAS_P2P_PD_FOR_JOIN;
3815 else if (os_strstr(pos, " auto") != NULL)
3816 use = WPAS_P2P_PD_AUTO;
3817
3818 return wpas_p2p_prov_disc(wpa_s, addr, pos, use);
3819 }
3820
3821
3822 static int p2p_get_passphrase(struct wpa_supplicant *wpa_s, char *buf,
3823 size_t buflen)
3824 {
3825 struct wpa_ssid *ssid = wpa_s->current_ssid;
3826
3827 if (ssid == NULL || ssid->mode != WPAS_MODE_P2P_GO ||
3828 ssid->passphrase == NULL)
3829 return -1;
3830
3831 os_strlcpy(buf, ssid->passphrase, buflen);
3832 return os_strlen(buf);
3833 }
3834
3835
3836 static int p2p_ctrl_serv_disc_req(struct wpa_supplicant *wpa_s, char *cmd,
3837 char *buf, size_t buflen)
3838 {
3839 u64 ref;
3840 int res;
3841 u8 dst_buf[ETH_ALEN], *dst;
3842 struct wpabuf *tlvs;
3843 char *pos;
3844 size_t len;
3845
3846 if (hwaddr_aton(cmd, dst_buf))
3847 return -1;
3848 dst = dst_buf;
3849 if (dst[0] == 0 && dst[1] == 0 && dst[2] == 0 &&
3850 dst[3] == 0 && dst[4] == 0 && dst[5] == 0)
3851 dst = NULL;
3852 pos = cmd + 17;
3853 if (*pos != ' ')
3854 return -1;
3855 pos++;
3856
3857 if (os_strncmp(pos, "upnp ", 5) == 0) {
3858 u8 version;
3859 pos += 5;
3860 if (hexstr2bin(pos, &version, 1) < 0)
3861 return -1;
3862 pos += 2;
3863 if (*pos != ' ')
3864 return -1;
3865 pos++;
3866 ref = wpas_p2p_sd_request_upnp(wpa_s, dst, version, pos);
3867 #ifdef CONFIG_WIFI_DISPLAY
3868 } else if (os_strncmp(pos, "wifi-display ", 13) == 0) {
3869 ref = wpas_p2p_sd_request_wifi_display(wpa_s, dst, pos + 13);
3870 #endif /* CONFIG_WIFI_DISPLAY */
3871 } else {
3872 len = os_strlen(pos);
3873 if (len & 1)
3874 return -1;
3875 len /= 2;
3876 tlvs = wpabuf_alloc(len);
3877 if (tlvs == NULL)
3878 return -1;
3879 if (hexstr2bin(pos, wpabuf_put(tlvs, len), len) < 0) {
3880 wpabuf_free(tlvs);
3881 return -1;
3882 }
3883
3884 ref = wpas_p2p_sd_request(wpa_s, dst, tlvs);
3885 wpabuf_free(tlvs);
3886 }
3887 if (ref == 0)
3888 return -1;
3889 res = os_snprintf(buf, buflen, "%llx", (long long unsigned) ref);
3890 if (res < 0 || (unsigned) res >= buflen)
3891 return -1;
3892 return res;
3893 }
3894
3895
3896 static int p2p_ctrl_serv_disc_cancel_req(struct wpa_supplicant *wpa_s,
3897 char *cmd)
3898 {
3899 long long unsigned val;
3900 u64 req;
3901 if (sscanf(cmd, "%llx", &val) != 1)
3902 return -1;
3903 req = val;
3904 return wpas_p2p_sd_cancel_request(wpa_s, req);
3905 }
3906
3907
3908 static int p2p_ctrl_serv_disc_resp(struct wpa_supplicant *wpa_s, char *cmd)
3909 {
3910 int freq;
3911 u8 dst[ETH_ALEN];
3912 u8 dialog_token;
3913 struct wpabuf *resp_tlvs;
3914 char *pos, *pos2;
3915 size_t len;
3916
3917 pos = os_strchr(cmd, ' ');
3918 if (pos == NULL)
3919 return -1;
3920 *pos++ = '\0';
3921 freq = atoi(cmd);
3922 if (freq == 0)
3923 return -1;
3924
3925 if (hwaddr_aton(pos, dst))
3926 return -1;
3927 pos += 17;
3928 if (*pos != ' ')
3929 return -1;
3930 pos++;
3931
3932 pos2 = os_strchr(pos, ' ');
3933 if (pos2 == NULL)
3934 return -1;
3935 *pos2++ = '\0';
3936 dialog_token = atoi(pos);
3937
3938 len = os_strlen(pos2);
3939 if (len & 1)
3940 return -1;
3941 len /= 2;
3942 resp_tlvs = wpabuf_alloc(len);
3943 if (resp_tlvs == NULL)
3944 return -1;
3945 if (hexstr2bin(pos2, wpabuf_put(resp_tlvs, len), len) < 0) {
3946 wpabuf_free(resp_tlvs);
3947 return -1;
3948 }
3949
3950 wpas_p2p_sd_response(wpa_s, freq, dst, dialog_token, resp_tlvs);
3951 wpabuf_free(resp_tlvs);
3952 return 0;
3953 }
3954
3955
3956 static int p2p_ctrl_serv_disc_external(struct wpa_supplicant *wpa_s,
3957 char *cmd)
3958 {
3959 if (os_strcmp(cmd, "0") && os_strcmp(cmd, "1"))
3960 return -1;
3961 wpa_s->p2p_sd_over_ctrl_iface = atoi(cmd);
3962 return 0;
3963 }
3964
3965
3966 static int p2p_ctrl_service_add_bonjour(struct wpa_supplicant *wpa_s,
3967 char *cmd)
3968 {
3969 char *pos;
3970 size_t len;
3971 struct wpabuf *query, *resp;
3972
3973 pos = os_strchr(cmd, ' ');
3974 if (pos == NULL)
3975 return -1;
3976 *pos++ = '\0';
3977
3978 len = os_strlen(cmd);
3979 if (len & 1)
3980 return -1;
3981 len /= 2;
3982 query = wpabuf_alloc(len);
3983 if (query == NULL)
3984 return -1;
3985 if (hexstr2bin(cmd, wpabuf_put(query, len), len) < 0) {
3986 wpabuf_free(query);
3987 return -1;
3988 }
3989
3990 len = os_strlen(pos);
3991 if (len & 1) {
3992 wpabuf_free(query);
3993 return -1;
3994 }
3995 len /= 2;
3996 resp = wpabuf_alloc(len);
3997 if (resp == NULL) {
3998 wpabuf_free(query);
3999 return -1;
4000 }
4001 if (hexstr2bin(pos, wpabuf_put(resp, len), len) < 0) {
4002 wpabuf_free(query);
4003 wpabuf_free(resp);
4004 return -1;
4005 }
4006
4007 if (wpas_p2p_service_add_bonjour(wpa_s, query, resp) < 0) {
4008 wpabuf_free(query);
4009 wpabuf_free(resp);
4010 return -1;
4011 }
4012 return 0;
4013 }
4014
4015
4016 static int p2p_ctrl_service_add_upnp(struct wpa_supplicant *wpa_s, char *cmd)
4017 {
4018 char *pos;
4019 u8 version;
4020
4021 pos = os_strchr(cmd, ' ');
4022 if (pos == NULL)
4023 return -1;
4024 *pos++ = '\0';
4025
4026 if (hexstr2bin(cmd, &version, 1) < 0)
4027 return -1;
4028
4029 return wpas_p2p_service_add_upnp(wpa_s, version, pos);
4030 }
4031
4032
4033 static int p2p_ctrl_service_add(struct wpa_supplicant *wpa_s, char *cmd)
4034 {
4035 char *pos;
4036
4037 pos = os_strchr(cmd, ' ');
4038 if (pos == NULL)
4039 return -1;
4040 *pos++ = '\0';
4041
4042 if (os_strcmp(cmd, "bonjour") == 0)
4043 return p2p_ctrl_service_add_bonjour(wpa_s, pos);
4044 if (os_strcmp(cmd, "upnp") == 0)
4045 return p2p_ctrl_service_add_upnp(wpa_s, pos);
4046 wpa_printf(MSG_DEBUG, "Unknown service '%s'", cmd);
4047 return -1;
4048 }
4049
4050
4051 static int p2p_ctrl_service_del_bonjour(struct wpa_supplicant *wpa_s,
4052 char *cmd)
4053 {
4054 size_t len;
4055 struct wpabuf *query;
4056 int ret;
4057
4058 len = os_strlen(cmd);
4059 if (len & 1)
4060 return -1;
4061 len /= 2;
4062 query = wpabuf_alloc(len);
4063 if (query == NULL)
4064 return -1;
4065 if (hexstr2bin(cmd, wpabuf_put(query, len), len) < 0) {
4066 wpabuf_free(query);
4067 return -1;
4068 }
4069
4070 ret = wpas_p2p_service_del_bonjour(wpa_s, query);
4071 wpabuf_free(query);
4072 return ret;
4073 }
4074
4075
4076 static int p2p_ctrl_service_del_upnp(struct wpa_supplicant *wpa_s, char *cmd)
4077 {
4078 char *pos;
4079 u8 version;
4080
4081 pos = os_strchr(cmd, ' ');
4082 if (pos == NULL)
4083 return -1;
4084 *pos++ = '\0';
4085
4086 if (hexstr2bin(cmd, &version, 1) < 0)
4087 return -1;
4088
4089 return wpas_p2p_service_del_upnp(wpa_s, version, pos);
4090 }
4091
4092
4093 static int p2p_ctrl_service_del(struct wpa_supplicant *wpa_s, char *cmd)
4094 {
4095 char *pos;
4096
4097 pos = os_strchr(cmd, ' ');
4098 if (pos == NULL)
4099 return -1;
4100 *pos++ = '\0';
4101
4102 if (os_strcmp(cmd, "bonjour") == 0)
4103 return p2p_ctrl_service_del_bonjour(wpa_s, pos);
4104 if (os_strcmp(cmd, "upnp") == 0)
4105 return p2p_ctrl_service_del_upnp(wpa_s, pos);
4106 wpa_printf(MSG_DEBUG, "Unknown service '%s'", cmd);
4107 return -1;
4108 }
4109
4110
4111 static int p2p_ctrl_reject(struct wpa_supplicant *wpa_s, char *cmd)
4112 {
4113 u8 addr[ETH_ALEN];
4114
4115 /* <addr> */
4116
4117 if (hwaddr_aton(cmd, addr))
4118 return -1;
4119
4120 return wpas_p2p_reject(wpa_s, addr);
4121 }
4122
4123
4124 static int p2p_ctrl_invite_persistent(struct wpa_supplicant *wpa_s, char *cmd)
4125 {
4126 char *pos;
4127 int id;
4128 struct wpa_ssid *ssid;
4129 u8 *_peer = NULL, peer[ETH_ALEN];
4130 int freq = 0, pref_freq = 0;
4131 int ht40, vht;
4132
4133 id = atoi(cmd);
4134 pos = os_strstr(cmd, " peer=");
4135 if (pos) {
4136 pos += 6;
4137 if (hwaddr_aton(pos, peer))
4138 return -1;
4139 _peer = peer;
4140 }
4141 ssid = wpa_config_get_network(wpa_s->conf, id);
4142 if (ssid == NULL || ssid->disabled != 2) {
4143 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find SSID id=%d "
4144 "for persistent P2P group",
4145 id);
4146 return -1;
4147 }
4148
4149 pos = os_strstr(cmd, " freq=");
4150 if (pos) {
4151 pos += 6;
4152 freq = atoi(pos);
4153 if (freq <= 0)
4154 return -1;
4155 }
4156
4157 pos = os_strstr(cmd, " pref=");
4158 if (pos) {
4159 pos += 6;
4160 pref_freq = atoi(pos);
4161 if (pref_freq <= 0)
4162 return -1;
4163 }
4164
4165 vht = (os_strstr(cmd, " vht") != NULL) || wpa_s->conf->p2p_go_vht;
4166 ht40 = (os_strstr(cmd, " ht40") != NULL) || wpa_s->conf->p2p_go_ht40 ||
4167 vht;
4168
4169 return wpas_p2p_invite(wpa_s, _peer, ssid, NULL, freq, ht40, vht,
4170 pref_freq);
4171 }
4172
4173
4174 static int p2p_ctrl_invite_group(struct wpa_supplicant *wpa_s, char *cmd)
4175 {
4176 char *pos;
4177 u8 peer[ETH_ALEN], go_dev_addr[ETH_ALEN], *go_dev = NULL;
4178
4179 pos = os_strstr(cmd, " peer=");
4180 if (!pos)
4181 return -1;
4182
4183 *pos = '\0';
4184 pos += 6;
4185 if (hwaddr_aton(pos, peer)) {
4186 wpa_printf(MSG_DEBUG, "P2P: Invalid MAC address '%s'", pos);
4187 return -1;
4188 }
4189
4190 pos = os_strstr(pos, " go_dev_addr=");
4191 if (pos) {
4192 pos += 13;
4193 if (hwaddr_aton(pos, go_dev_addr)) {
4194 wpa_printf(MSG_DEBUG, "P2P: Invalid MAC address '%s'",
4195 pos);
4196 return -1;
4197 }
4198 go_dev = go_dev_addr;
4199 }
4200
4201 return wpas_p2p_invite_group(wpa_s, cmd, peer, go_dev);
4202 }
4203
4204
4205 static int p2p_ctrl_invite(struct wpa_supplicant *wpa_s, char *cmd)
4206 {
4207 if (os_strncmp(cmd, "persistent=", 11) == 0)
4208 return p2p_ctrl_invite_persistent(wpa_s, cmd + 11);
4209 if (os_strncmp(cmd, "group=", 6) == 0)
4210 return p2p_ctrl_invite_group(wpa_s, cmd + 6);
4211
4212 return -1;
4213 }
4214
4215
4216 static int p2p_ctrl_group_add_persistent(struct wpa_supplicant *wpa_s,
4217 char *cmd, int freq, int ht40,
4218 int vht)
4219 {
4220 int id;
4221 struct wpa_ssid *ssid;
4222
4223 id = atoi(cmd);
4224 ssid = wpa_config_get_network(wpa_s->conf, id);
4225 if (ssid == NULL || ssid->disabled != 2) {
4226 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find SSID id=%d "
4227 "for persistent P2P group",
4228 id);
4229 return -1;
4230 }
4231
4232 return wpas_p2p_group_add_persistent(wpa_s, ssid, 0, freq, ht40, vht,
4233 NULL, 0);
4234 }
4235
4236
4237 static int p2p_ctrl_group_add(struct wpa_supplicant *wpa_s, char *cmd)
4238 {
4239 int freq = 0, ht40, vht;
4240 char *pos;
4241
4242 pos = os_strstr(cmd, "freq=");
4243 if (pos)
4244 freq = atoi(pos + 5);
4245
4246 vht = (os_strstr(cmd, "vht") != NULL) || wpa_s->conf->p2p_go_vht;
4247 ht40 = (os_strstr(cmd, "ht40") != NULL) || wpa_s->conf->p2p_go_ht40 ||
4248 vht;
4249
4250 if (os_strncmp(cmd, "persistent=", 11) == 0)
4251 return p2p_ctrl_group_add_persistent(wpa_s, cmd + 11, freq,
4252 ht40, vht);
4253 if (os_strcmp(cmd, "persistent") == 0 ||
4254 os_strncmp(cmd, "persistent ", 11) == 0)
4255 return wpas_p2p_group_add(wpa_s, 1, freq, ht40, vht);
4256 if (os_strncmp(cmd, "freq=", 5) == 0)
4257 return wpas_p2p_group_add(wpa_s, 0, freq, ht40, vht);
4258 if (ht40)
4259 return wpas_p2p_group_add(wpa_s, 0, freq, ht40, vht);
4260
4261 wpa_printf(MSG_DEBUG, "CTRL: Invalid P2P_GROUP_ADD parameters '%s'",
4262 cmd);
4263 return -1;
4264 }
4265
4266
4267 static int p2p_ctrl_peer(struct wpa_supplicant *wpa_s, char *cmd,
4268 char *buf, size_t buflen)
4269 {
4270 u8 addr[ETH_ALEN], *addr_ptr;
4271 int next, res;
4272 const struct p2p_peer_info *info;
4273 char *pos, *end;
4274 char devtype[WPS_DEV_TYPE_BUFSIZE];
4275 struct wpa_ssid *ssid;
4276 size_t i;
4277
4278 if (!wpa_s->global->p2p)
4279 return -1;
4280
4281 if (os_strcmp(cmd, "FIRST") == 0) {
4282 addr_ptr = NULL;
4283 next = 0;
4284 } else if (os_strncmp(cmd, "NEXT-", 5) == 0) {
4285 if (hwaddr_aton(cmd + 5, addr) < 0)
4286 return -1;
4287 addr_ptr = addr;
4288 next = 1;
4289 } else {
4290 if (hwaddr_aton(cmd, addr) < 0)
4291 return -1;
4292 addr_ptr = addr;
4293 next = 0;
4294 }
4295
4296 info = p2p_get_peer_info(wpa_s->global->p2p, addr_ptr, next);
4297 if (info == NULL)
4298 return -1;
4299
4300 pos = buf;
4301 end = buf + buflen;
4302
4303 res = os_snprintf(pos, end - pos, MACSTR "\n"
4304 "pri_dev_type=%s\n"
4305 "device_name=%s\n"
4306 "manufacturer=%s\n"
4307 "model_name=%s\n"
4308 "model_number=%s\n"
4309 "serial_number=%s\n"
4310 "config_methods=0x%x\n"
4311 "dev_capab=0x%x\n"
4312 "group_capab=0x%x\n"
4313 "level=%d\n",
4314 MAC2STR(info->p2p_device_addr),
4315 wps_dev_type_bin2str(info->pri_dev_type,
4316 devtype, sizeof(devtype)),
4317 info->device_name,
4318 info->manufacturer,
4319 info->model_name,
4320 info->model_number,
4321 info->serial_number,
4322 info->config_methods,
4323 info->dev_capab,
4324 info->group_capab,
4325 info->level);
4326 if (res < 0 || res >= end - pos)
4327 return pos - buf;
4328 pos += res;
4329
4330 for (i = 0; i < info->wps_sec_dev_type_list_len / WPS_DEV_TYPE_LEN; i++)
4331 {
4332 const u8 *t;
4333 t = &info->wps_sec_dev_type_list[i * WPS_DEV_TYPE_LEN];
4334 res = os_snprintf(pos, end - pos, "sec_dev_type=%s\n",
4335 wps_dev_type_bin2str(t, devtype,
4336 sizeof(devtype)));
4337 if (res < 0 || res >= end - pos)
4338 return pos - buf;
4339 pos += res;
4340 }
4341
4342 ssid = wpas_p2p_get_persistent(wpa_s, info->p2p_device_addr, NULL, 0);
4343 if (ssid) {
4344 res = os_snprintf(pos, end - pos, "persistent=%d\n", ssid->id);
4345 if (res < 0 || res >= end - pos)
4346 return pos - buf;
4347 pos += res;
4348 }
4349
4350 res = p2p_get_peer_info_txt(info, pos, end - pos);
4351 if (res < 0)
4352 return pos - buf;
4353 pos += res;
4354
4355 return pos - buf;
4356 }
4357
4358
4359 static int p2p_ctrl_disallow_freq(struct wpa_supplicant *wpa_s,
4360 const char *param)
4361 {
4362 unsigned int i;
4363
4364 if (wpa_s->global->p2p == NULL)
4365 return -1;
4366
4367 if (freq_range_list_parse(&wpa_s->global->p2p_disallow_freq, param) < 0)
4368 return -1;
4369
4370 for (i = 0; i < wpa_s->global->p2p_disallow_freq.num; i++) {
4371 struct wpa_freq_range *freq;
4372 freq = &wpa_s->global->p2p_disallow_freq.range[i];
4373 wpa_printf(MSG_DEBUG, "P2P: Disallowed frequency range %u-%u",
4374 freq->min, freq->max);
4375 }
4376
4377 wpas_p2p_update_channel_list(wpa_s);
4378 return 0;
4379 }
4380
4381
4382 static int p2p_ctrl_set(struct wpa_supplicant *wpa_s, char *cmd)
4383 {
4384 char *param;
4385
4386 if (wpa_s->global->p2p == NULL)
4387 return -1;
4388
4389 param = os_strchr(cmd, ' ');
4390 if (param == NULL)
4391 return -1;
4392 *param++ = '\0';
4393
4394 if (os_strcmp(cmd, "discoverability") == 0) {
4395 p2p_set_client_discoverability(wpa_s->global->p2p,
4396 atoi(param));
4397 return 0;
4398 }
4399
4400 if (os_strcmp(cmd, "managed") == 0) {
4401 p2p_set_managed_oper(wpa_s->global->p2p, atoi(param));
4402 return 0;
4403 }
4404
4405 if (os_strcmp(cmd, "listen_channel") == 0) {
4406 return p2p_set_listen_channel(wpa_s->global->p2p, 81,
4407 atoi(param));
4408 }
4409
4410 if (os_strcmp(cmd, "ssid_postfix") == 0) {
4411 return p2p_set_ssid_postfix(wpa_s->global->p2p, (u8 *) param,
4412 os_strlen(param));
4413 }
4414
4415 if (os_strcmp(cmd, "noa") == 0) {
4416 char *pos;
4417 int count, start, duration;
4418 /* GO NoA parameters: count,start_offset(ms),duration(ms) */
4419 count = atoi(param);
4420 pos = os_strchr(param, ',');
4421 if (pos == NULL)
4422 return -1;
4423 pos++;
4424 start = atoi(pos);
4425 pos = os_strchr(pos, ',');
4426 if (pos == NULL)
4427 return -1;
4428 pos++;
4429 duration = atoi(pos);
4430 if (count < 0 || count > 255 || start < 0 || duration < 0)
4431 return -1;
4432 if (count == 0 && duration > 0)
4433 return -1;
4434 wpa_printf(MSG_DEBUG, "CTRL_IFACE: P2P_SET GO NoA: count=%d "
4435 "start=%d duration=%d", count, start, duration);
4436 return wpas_p2p_set_noa(wpa_s, count, start, duration);
4437 }
4438
4439 if (os_strcmp(cmd, "ps") == 0)
4440 return wpa_drv_set_p2p_powersave(wpa_s, atoi(param), -1, -1);
4441
4442 if (os_strcmp(cmd, "oppps") == 0)
4443 return wpa_drv_set_p2p_powersave(wpa_s, -1, atoi(param), -1);
4444
4445 if (os_strcmp(cmd, "ctwindow") == 0)
4446 return wpa_drv_set_p2p_powersave(wpa_s, -1, -1, atoi(param));
4447
4448 if (os_strcmp(cmd, "disabled") == 0) {
4449 wpa_s->global->p2p_disabled = atoi(param);
4450 wpa_printf(MSG_DEBUG, "P2P functionality %s",
4451 wpa_s->global->p2p_disabled ?
4452 "disabled" : "enabled");
4453 if (wpa_s->global->p2p_disabled) {
4454 wpas_p2p_stop_find(wpa_s);
4455 os_memset(wpa_s->p2p_auth_invite, 0, ETH_ALEN);
4456 p2p_flush(wpa_s->global->p2p);
4457 }
4458 return 0;
4459 }
4460
4461 if (os_strcmp(cmd, "conc_pref") == 0) {
4462 if (os_strcmp(param, "sta") == 0)
4463 wpa_s->global->conc_pref = WPA_CONC_PREF_STA;
4464 else if (os_strcmp(param, "p2p") == 0)
4465 wpa_s->global->conc_pref = WPA_CONC_PREF_P2P;
4466 else {
4467 wpa_printf(MSG_INFO, "Invalid conc_pref value");
4468 return -1;
4469 }
4470 wpa_printf(MSG_DEBUG, "Single channel concurrency preference: "
4471 "%s", param);
4472 return 0;
4473 }
4474
4475 if (os_strcmp(cmd, "force_long_sd") == 0) {
4476 wpa_s->force_long_sd = atoi(param);
4477 return 0;
4478 }
4479
4480 if (os_strcmp(cmd, "peer_filter") == 0) {
4481 u8 addr[ETH_ALEN];
4482 if (hwaddr_aton(param, addr))
4483 return -1;
4484 p2p_set_peer_filter(wpa_s->global->p2p, addr);
4485 return 0;
4486 }
4487
4488 if (os_strcmp(cmd, "cross_connect") == 0)
4489 return wpas_p2p_set_cross_connect(wpa_s, atoi(param));
4490
4491 if (os_strcmp(cmd, "go_apsd") == 0) {
4492 if (os_strcmp(param, "disable") == 0)
4493 wpa_s->set_ap_uapsd = 0;
4494 else {
4495 wpa_s->set_ap_uapsd = 1;
4496 wpa_s->ap_uapsd = atoi(param);
4497 }
4498 return 0;
4499 }
4500
4501 if (os_strcmp(cmd, "client_apsd") == 0) {
4502 if (os_strcmp(param, "disable") == 0)
4503 wpa_s->set_sta_uapsd = 0;
4504 else {
4505 int be, bk, vi, vo;
4506 char *pos;
4507 /* format: BE,BK,VI,VO;max SP Length */
4508 be = atoi(param);
4509 pos = os_strchr(param, ',');
4510 if (pos == NULL)
4511 return -1;
4512 pos++;
4513 bk = atoi(pos);
4514 pos = os_strchr(pos, ',');
4515 if (pos == NULL)
4516 return -1;
4517 pos++;
4518 vi = atoi(pos);
4519 pos = os_strchr(pos, ',');
4520 if (pos == NULL)
4521 return -1;
4522 pos++;
4523 vo = atoi(pos);
4524 /* ignore max SP Length for now */
4525
4526 wpa_s->set_sta_uapsd = 1;
4527 wpa_s->sta_uapsd = 0;
4528 if (be)
4529 wpa_s->sta_uapsd |= BIT(0);
4530 if (bk)
4531 wpa_s->sta_uapsd |= BIT(1);
4532 if (vi)
4533 wpa_s->sta_uapsd |= BIT(2);
4534 if (vo)
4535 wpa_s->sta_uapsd |= BIT(3);
4536 }
4537 return 0;
4538 }
4539
4540 if (os_strcmp(cmd, "disallow_freq") == 0)
4541 return p2p_ctrl_disallow_freq(wpa_s, param);
4542
4543 if (os_strcmp(cmd, "disc_int") == 0) {
4544 int min_disc_int, max_disc_int, max_disc_tu;
4545 char *pos;
4546
4547 pos = param;
4548
4549 min_disc_int = atoi(pos);
4550 pos = os_strchr(pos, ' ');
4551 if (pos == NULL)
4552 return -1;
4553 *pos++ = '\0';
4554
4555 max_disc_int = atoi(pos);
4556 pos = os_strchr(pos, ' ');
4557 if (pos == NULL)
4558 return -1;
4559 *pos++ = '\0';
4560
4561 max_disc_tu = atoi(pos);
4562
4563 return p2p_set_disc_int(wpa_s->global->p2p, min_disc_int,
4564 max_disc_int, max_disc_tu);
4565 }
4566
4567 if (os_strcmp(cmd, "per_sta_psk") == 0) {
4568 wpa_s->global->p2p_per_sta_psk = !!atoi(param);
4569 return 0;
4570 }
4571
4572 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Unknown P2P_SET field value '%s'",
4573 cmd);
4574
4575 return -1;
4576 }
4577
4578
4579 static void p2p_ctrl_flush(struct wpa_supplicant *wpa_s)
4580 {
4581 os_memset(wpa_s->p2p_auth_invite, 0, ETH_ALEN);
4582 wpa_s->force_long_sd = 0;
4583 if (wpa_s->global->p2p)
4584 p2p_flush(wpa_s->global->p2p);
4585 }
4586
4587
4588 static int p2p_ctrl_presence_req(struct wpa_supplicant *wpa_s, char *cmd)
4589 {
4590 char *pos, *pos2;
4591 unsigned int dur1 = 0, int1 = 0, dur2 = 0, int2 = 0;
4592
4593 if (cmd[0]) {
4594 pos = os_strchr(cmd, ' ');
4595 if (pos == NULL)
4596 return -1;
4597 *pos++ = '\0';
4598 dur1 = atoi(cmd);
4599
4600 pos2 = os_strchr(pos, ' ');
4601 if (pos2)
4602 *pos2++ = '\0';
4603 int1 = atoi(pos);
4604 } else
4605 pos2 = NULL;
4606
4607 if (pos2) {
4608 pos = os_strchr(pos2, ' ');
4609 if (pos == NULL)
4610 return -1;
4611 *pos++ = '\0';
4612 dur2 = atoi(pos2);
4613 int2 = atoi(pos);
4614 }
4615
4616 return wpas_p2p_presence_req(wpa_s, dur1, int1, dur2, int2);
4617 }
4618
4619
4620 static int p2p_ctrl_ext_listen(struct wpa_supplicant *wpa_s, char *cmd)
4621 {
4622 char *pos;
4623 unsigned int period = 0, interval = 0;
4624
4625 if (cmd[0]) {
4626 pos = os_strchr(cmd, ' ');
4627 if (pos == NULL)
4628 return -1;
4629 *pos++ = '\0';
4630 period = atoi(cmd);
4631 interval = atoi(pos);
4632 }
4633
4634 return wpas_p2p_ext_listen(wpa_s, period, interval);
4635 }
4636
4637
4638 static int p2p_ctrl_remove_client(struct wpa_supplicant *wpa_s, const char *cmd)
4639 {
4640 const char *pos;
4641 u8 peer[ETH_ALEN];
4642 int iface_addr = 0;
4643
4644 pos = cmd;
4645 if (os_strncmp(pos, "iface=", 6) == 0) {
4646 iface_addr = 1;
4647 pos += 6;
4648 }
4649 if (hwaddr_aton(pos, peer))
4650 return -1;
4651
4652 wpas_p2p_remove_client(wpa_s, peer, iface_addr);
4653 return 0;
4654 }
4655
4656 #endif /* CONFIG_P2P */
4657
4658
4659 #ifdef CONFIG_INTERWORKING
4660 static int ctrl_interworking_connect(struct wpa_supplicant *wpa_s, char *dst)
4661 {
4662 u8 bssid[ETH_ALEN];
4663 struct wpa_bss *bss;
4664
4665 if (hwaddr_aton(dst, bssid)) {
4666 wpa_printf(MSG_DEBUG, "Invalid BSSID '%s'", dst);
4667 return -1;
4668 }
4669
4670 bss = wpa_bss_get_bssid(wpa_s, bssid);
4671 if (bss == NULL) {
4672 wpa_printf(MSG_DEBUG, "Could not find BSS " MACSTR,
4673 MAC2STR(bssid));
4674 return -1;
4675 }
4676
4677 return interworking_connect(wpa_s, bss);
4678 }
4679
4680
4681 static int get_anqp(struct wpa_supplicant *wpa_s, char *dst)
4682 {
4683 u8 dst_addr[ETH_ALEN];
4684 int used;
4685 char *pos;
4686 #define MAX_ANQP_INFO_ID 100
4687 u16 id[MAX_ANQP_INFO_ID];
4688 size_t num_id = 0;
4689
4690 used = hwaddr_aton2(dst, dst_addr);
4691 if (used < 0)
4692 return -1;
4693 pos = dst + used;
4694 while (num_id < MAX_ANQP_INFO_ID) {
4695 id[num_id] = atoi(pos);
4696 if (id[num_id])
4697 num_id++;
4698 pos = os_strchr(pos + 1, ',');
4699 if (pos == NULL)
4700 break;
4701 pos++;
4702 }
4703
4704 if (num_id == 0)
4705 return -1;
4706
4707 return anqp_send_req(wpa_s, dst_addr, id, num_id);
4708 }
4709
4710
4711 static int gas_request(struct wpa_supplicant *wpa_s, char *cmd)
4712 {
4713 u8 dst_addr[ETH_ALEN];
4714 struct wpabuf *advproto, *query = NULL;
4715 int used, ret = -1;
4716 char *pos, *end;
4717 size_t len;
4718
4719 used = hwaddr_aton2(cmd, dst_addr);
4720 if (used < 0)
4721 return -1;
4722
4723 pos = cmd + used;
4724 while (*pos == ' ')
4725 pos++;
4726
4727 /* Advertisement Protocol ID */
4728 end = os_strchr(pos, ' ');
4729 if (end)
4730 len = end - pos;
4731 else
4732 len = os_strlen(pos);
4733 if (len & 0x01)
4734 return -1;
4735 len /= 2;
4736 if (len == 0)
4737 return -1;
4738 advproto = wpabuf_alloc(len);
4739 if (advproto == NULL)
4740 return -1;
4741 if (hexstr2bin(pos, wpabuf_put(advproto, len), len) < 0)
4742 goto fail;
4743
4744 if (end) {
4745 /* Optional Query Request */
4746 pos = end + 1;
4747 while (*pos == ' ')
4748 pos++;
4749
4750 len = os_strlen(pos);
4751 if (len) {
4752 if (len & 0x01)
4753 goto fail;
4754 len /= 2;
4755 if (len == 0)
4756 goto fail;
4757 query = wpabuf_alloc(len);
4758 if (query == NULL)
4759 goto fail;
4760 if (hexstr2bin(pos, wpabuf_put(query, len), len) < 0)
4761 goto fail;
4762 }
4763 }
4764
4765 ret = gas_send_request(wpa_s, dst_addr, advproto, query);
4766
4767 fail:
4768 wpabuf_free(advproto);
4769 wpabuf_free(query);
4770
4771 return ret;
4772 }
4773
4774
4775 static int gas_response_get(struct wpa_supplicant *wpa_s, char *cmd, char *buf,
4776 size_t buflen)
4777 {
4778 u8 addr[ETH_ALEN];
4779 int dialog_token;
4780 int used;
4781 char *pos;
4782 size_t resp_len, start, requested_len;
4783
4784 if (!wpa_s->last_gas_resp)
4785 return -1;
4786
4787 used = hwaddr_aton2(cmd, addr);
4788 if (used < 0)
4789 return -1;
4790
4791 pos = cmd + used;
4792 while (*pos == ' ')
4793 pos++;
4794 dialog_token = atoi(pos);
4795
4796 if (os_memcmp(addr, wpa_s->last_gas_addr, ETH_ALEN) != 0 ||
4797 dialog_token != wpa_s->last_gas_dialog_token)
4798 return -1;
4799
4800 resp_len = wpabuf_len(wpa_s->last_gas_resp);
4801 start = 0;
4802 requested_len = resp_len;
4803
4804 pos = os_strchr(pos, ' ');
4805 if (pos) {
4806 start = atoi(pos);
4807 if (start > resp_len)
4808 return os_snprintf(buf, buflen, "FAIL-Invalid range");
4809 pos = os_strchr(pos, ',');
4810 if (pos == NULL)
4811 return -1;
4812 pos++;
4813 requested_len = atoi(pos);
4814 if (start + requested_len > resp_len)
4815 return os_snprintf(buf, buflen, "FAIL-Invalid range");
4816 }
4817
4818 if (requested_len * 2 + 1 > buflen)
4819 return os_snprintf(buf, buflen, "FAIL-Too long response");
4820
4821 return wpa_snprintf_hex(buf, buflen,
4822 wpabuf_head_u8(wpa_s->last_gas_resp) + start,
4823 requested_len);
4824 }
4825 #endif /* CONFIG_INTERWORKING */
4826
4827
4828 #ifdef CONFIG_HS20
4829
4830 static int get_hs20_anqp(struct wpa_supplicant *wpa_s, char *dst)
4831 {
4832 u8 dst_addr[ETH_ALEN];
4833 int used;
4834 char *pos;
4835 u32 subtypes = 0;
4836
4837 used = hwaddr_aton2(dst, dst_addr);
4838 if (used < 0)
4839 return -1;
4840 pos = dst + used;
4841 for (;;) {
4842 int num = atoi(pos);
4843 if (num <= 0 || num > 31)
4844 return -1;
4845 subtypes |= BIT(num);
4846 pos = os_strchr(pos + 1, ',');
4847 if (pos == NULL)
4848 break;
4849 pos++;
4850 }
4851
4852 if (subtypes == 0)
4853 return -1;
4854
4855 return hs20_anqp_send_req(wpa_s, dst_addr, subtypes, NULL, 0);
4856 }
4857
4858
4859 static int hs20_nai_home_realm_list(struct wpa_supplicant *wpa_s,
4860 const u8 *addr, const char *realm)
4861 {
4862 u8 *buf;
4863 size_t rlen, len;
4864 int ret;
4865
4866 rlen = os_strlen(realm);
4867 len = 3 + rlen;
4868 buf = os_malloc(len);
4869 if (buf == NULL)
4870 return -1;
4871 buf[0] = 1; /* NAI Home Realm Count */
4872 buf[1] = 0; /* Formatted in accordance with RFC 4282 */
4873 buf[2] = rlen;
4874 os_memcpy(buf + 3, realm, rlen);
4875
4876 ret = hs20_anqp_send_req(wpa_s, addr,
4877 BIT(HS20_STYPE_NAI_HOME_REALM_QUERY),
4878 buf, len);
4879
4880 os_free(buf);
4881
4882 return ret;
4883 }
4884
4885
4886 static int hs20_get_nai_home_realm_list(struct wpa_supplicant *wpa_s,
4887 char *dst)
4888 {
4889 struct wpa_cred *cred = wpa_s->conf->cred;
4890 u8 dst_addr[ETH_ALEN];
4891 int used;
4892 u8 *buf;
4893 size_t len;
4894 int ret;
4895
4896 used = hwaddr_aton2(dst, dst_addr);
4897 if (used < 0)
4898 return -1;
4899
4900 while (dst[used] == ' ')
4901 used++;
4902 if (os_strncmp(dst + used, "realm=", 6) == 0)
4903 return hs20_nai_home_realm_list(wpa_s, dst_addr,
4904 dst + used + 6);
4905
4906 len = os_strlen(dst + used);
4907
4908 if (len == 0 && cred && cred->realm)
4909 return hs20_nai_home_realm_list(wpa_s, dst_addr, cred->realm);
4910
4911 if (len % 1)
4912 return -1;
4913 len /= 2;
4914 buf = os_malloc(len);
4915 if (buf == NULL)
4916 return -1;
4917 if (hexstr2bin(dst + used, buf, len) < 0) {
4918 os_free(buf);
4919 return -1;
4920 }
4921
4922 ret = hs20_anqp_send_req(wpa_s, dst_addr,
4923 BIT(HS20_STYPE_NAI_HOME_REALM_QUERY),
4924 buf, len);
4925 os_free(buf);
4926
4927 return ret;
4928 }
4929
4930 #endif /* CONFIG_HS20 */
4931
4932
4933 static int wpa_supplicant_ctrl_iface_sta_autoconnect(
4934 struct wpa_supplicant *wpa_s, char *cmd)
4935 {
4936 wpa_s->auto_reconnect_disabled = atoi(cmd) == 0 ? 1 : 0;
4937 return 0;
4938 }
4939
4940
4941 #ifdef CONFIG_AUTOSCAN
4942
4943 static int wpa_supplicant_ctrl_iface_autoscan(struct wpa_supplicant *wpa_s,
4944 char *cmd)
4945 {
4946 enum wpa_states state = wpa_s->wpa_state;
4947 char *new_params = NULL;
4948
4949 if (os_strlen(cmd) > 0) {
4950 new_params = os_strdup(cmd);
4951 if (new_params == NULL)
4952 return -1;
4953 }
4954
4955 os_free(wpa_s->conf->autoscan);
4956 wpa_s->conf->autoscan = new_params;
4957
4958 if (wpa_s->conf->autoscan == NULL)
4959 autoscan_deinit(wpa_s);
4960 else if (state == WPA_DISCONNECTED || state == WPA_INACTIVE)
4961 autoscan_init(wpa_s, 1);
4962 else if (state == WPA_SCANNING)
4963 wpa_supplicant_reinit_autoscan(wpa_s);
4964
4965 return 0;
4966 }
4967
4968 #endif /* CONFIG_AUTOSCAN */
4969
4970
4971 #ifdef CONFIG_WNM
4972
4973 static int wpas_ctrl_iface_wnm_sleep(struct wpa_supplicant *wpa_s, char *cmd)
4974 {
4975 int enter;
4976 int intval = 0;
4977 char *pos;
4978 int ret;
4979 struct wpabuf *tfs_req = NULL;
4980
4981 if (os_strncmp(cmd, "enter", 5) == 0)
4982 enter = 1;
4983 else if (os_strncmp(cmd, "exit", 4) == 0)
4984 enter = 0;
4985 else
4986 return -1;
4987
4988 pos = os_strstr(cmd, " interval=");
4989 if (pos)
4990 intval = atoi(pos + 10);
4991
4992 pos = os_strstr(cmd, " tfs_req=");
4993 if (pos) {
4994 char *end;
4995 size_t len;
4996 pos += 9;
4997 end = os_strchr(pos, ' ');
4998 if (end)
4999 len = end - pos;
5000 else
5001 len = os_strlen(pos);
5002 if (len & 1)
5003 return -1;
5004 len /= 2;
5005 tfs_req = wpabuf_alloc(len);
5006 if (tfs_req == NULL)
5007 return -1;
5008 if (hexstr2bin(pos, wpabuf_put(tfs_req, len), len) < 0) {
5009 wpabuf_free(tfs_req);
5010 return -1;
5011 }
5012 }
5013
5014 ret = ieee802_11_send_wnmsleep_req(wpa_s, enter ? WNM_SLEEP_MODE_ENTER :
5015 WNM_SLEEP_MODE_EXIT, intval,
5016 tfs_req);
5017 wpabuf_free(tfs_req);
5018
5019 return ret;
5020 }
5021
5022
5023 static int wpas_ctrl_iface_wnm_bss_query(struct wpa_supplicant *wpa_s, char *cmd)
5024 {
5025 int query_reason;
5026
5027 query_reason = atoi(cmd);
5028
5029 wpa_printf(MSG_DEBUG, "CTRL_IFACE: WNM_BSS_QUERY query_reason=%d",
5030 query_reason);
5031
5032 return wnm_send_bss_transition_mgmt_query(wpa_s, query_reason);
5033 }
5034
5035 #endif /* CONFIG_WNM */
5036
5037
5038 /* Get string representation of channel width */
5039 static const char * channel_width_name(enum chan_width width)
5040 {
5041 switch (width) {
5042 case CHAN_WIDTH_20_NOHT:
5043 return "20 MHz (no HT)";
5044 case CHAN_WIDTH_20:
5045 return "20 MHz";
5046 case CHAN_WIDTH_40:
5047 return "40 MHz";
5048 case CHAN_WIDTH_80:
5049 return "80 MHz";
5050 case CHAN_WIDTH_80P80:
5051 return "80+80 MHz";
5052 case CHAN_WIDTH_160:
5053 return "160 MHz";
5054 default:
5055 return "unknown";
5056 }
5057 }
5058
5059
5060 static int wpa_supplicant_signal_poll(struct wpa_supplicant *wpa_s, char *buf,
5061 size_t buflen)
5062 {
5063 struct wpa_signal_info si;
5064 int ret;
5065 char *pos, *end;
5066
5067 ret = wpa_drv_signal_poll(wpa_s, &si);
5068 if (ret)
5069 return -1;
5070
5071 pos = buf;
5072 end = buf + buflen;
5073
5074 ret = os_snprintf(pos, end - pos, "RSSI=%d\nLINKSPEED=%d\n"
5075 "NOISE=%d\nFREQUENCY=%u\n",
5076 si.current_signal, si.current_txrate / 1000,
5077 si.current_noise, si.frequency);
5078 if (ret < 0 || ret > end - pos)
5079 return -1;
5080 pos += ret;
5081
5082 if (si.chanwidth != CHAN_WIDTH_UNKNOWN) {
5083 ret = os_snprintf(pos, end - pos, "WIDTH=%s\n",
5084 channel_width_name(si.chanwidth));
5085 if (ret < 0 || ret > end - pos)
5086 return -1;
5087 pos += ret;
5088 }
5089
5090 if (si.center_frq1 > 0 && si.center_frq2 > 0) {
5091 ret = os_snprintf(pos, end - pos,
5092 "CENTER_FRQ1=%d\nCENTER_FRQ2=%d\n",
5093 si.center_frq1, si.center_frq2);
5094 if (ret < 0 || ret > end - pos)
5095 return -1;
5096 pos += ret;
5097 }
5098
5099 if (si.avg_signal) {
5100 ret = os_snprintf(pos, end - pos,
5101 "AVG_RSSI=%d\n", si.avg_signal);
5102 if (ret < 0 || ret >= end - pos)
5103 return -1;
5104 pos += ret;
5105 }
5106
5107 return pos - buf;
5108 }
5109
5110
5111 static int wpa_supplicant_pktcnt_poll(struct wpa_supplicant *wpa_s, char *buf,
5112 size_t buflen)
5113 {
5114 struct hostap_sta_driver_data sta;
5115 int ret;
5116
5117 ret = wpa_drv_pktcnt_poll(wpa_s, &sta);
5118 if (ret)
5119 return -1;
5120
5121 ret = os_snprintf(buf, buflen, "TXGOOD=%lu\nTXBAD=%lu\nRXGOOD=%lu\n",
5122 sta.tx_packets, sta.tx_retry_failed, sta.rx_packets);
5123 if (ret < 0 || (size_t) ret > buflen)
5124 return -1;
5125 return ret;
5126 }
5127
5128
5129 static void wpa_supplicant_ctrl_iface_flush(struct wpa_supplicant *wpa_s)
5130 {
5131 wpa_dbg(wpa_s, MSG_DEBUG, "Flush all wpa_supplicant state");
5132
5133 #ifdef CONFIG_P2P
5134 wpas_p2p_stop_find(wpa_s);
5135 p2p_ctrl_flush(wpa_s);
5136 wpas_p2p_group_remove(wpa_s, "*");
5137 #endif /* CONFIG_P2P */
5138
5139 #ifdef CONFIG_WPS_TESTING
5140 wps_version_number = 0x20;
5141 wps_testing_dummy_cred = 0;
5142 #endif /* CONFIG_WPS_TESTING */
5143 #ifdef CONFIG_WPS
5144 wpas_wps_cancel(wpa_s);
5145 #endif /* CONFIG_WPS */
5146 wpa_s->after_wps = 0;
5147 wpa_s->known_wps_freq = 0;
5148
5149 #ifdef CONFIG_TDLS_TESTING
5150 extern unsigned int tdls_testing;
5151 tdls_testing = 0;
5152 #endif /* CONFIG_TDLS_TESTING */
5153 #ifdef CONFIG_TDLS
5154 wpa_drv_tdls_oper(wpa_s, TDLS_ENABLE, NULL);
5155 wpa_tdls_enable(wpa_s->wpa, 1);
5156 #endif /* CONFIG_TDLS */
5157
5158 eloop_cancel_timeout(wpa_supplicant_stop_countermeasures, wpa_s, NULL);
5159 wpa_supplicant_stop_countermeasures(wpa_s, NULL);
5160
5161 wpa_s->no_keep_alive = 0;
5162
5163 os_free(wpa_s->disallow_aps_bssid);
5164 wpa_s->disallow_aps_bssid = NULL;
5165 wpa_s->disallow_aps_bssid_count = 0;
5166 os_free(wpa_s->disallow_aps_ssid);
5167 wpa_s->disallow_aps_ssid = NULL;
5168 wpa_s->disallow_aps_ssid_count = 0;
5169
5170 wpa_s->set_sta_uapsd = 0;
5171 wpa_s->sta_uapsd = 0;
5172
5173 wpa_drv_radio_disable(wpa_s, 0);
5174
5175 wpa_bss_flush(wpa_s);
5176 wpa_blacklist_clear(wpa_s);
5177 wpa_s->extra_blacklist_count = 0;
5178 wpa_supplicant_ctrl_iface_remove_network(wpa_s, "all");
5179 wpa_supplicant_ctrl_iface_remove_cred(wpa_s, "all");
5180 }
5181
5182
5183 static void wpas_ctrl_eapol_response(void *eloop_ctx, void *timeout_ctx)
5184 {
5185 struct wpa_supplicant *wpa_s = eloop_ctx;
5186 eapol_sm_notify_ctrl_response(wpa_s->eapol);
5187 }
5188
5189
5190 char * wpa_supplicant_ctrl_iface_process(struct wpa_supplicant *wpa_s,
5191 char *buf, size_t *resp_len)
5192 {
5193 char *reply;
5194 const int reply_size = 4096;
5195 int reply_len;
5196
5197 if (os_strncmp(buf, WPA_CTRL_RSP, os_strlen(WPA_CTRL_RSP)) == 0 ||
5198 os_strncmp(buf, "SET_NETWORK ", 12) == 0 ||
5199 os_strncmp(buf, "WPS_NFC_TAG_READ", 16) == 0 ||
5200 os_strncmp(buf, "NFC_REPORT_HANDOVER", 19) == 0 ||
5201 os_strncmp(buf, "NFC_RX_HANDOVER_SEL", 19) == 0) {
5202 wpa_hexdump_ascii_key(MSG_DEBUG, "RX ctrl_iface",
5203 (const u8 *) buf, os_strlen(buf));
5204 } else {
5205 int level = MSG_DEBUG;
5206 if (os_strcmp(buf, "PING") == 0)
5207 level = MSG_EXCESSIVE;
5208 wpa_hexdump_ascii(level, "RX ctrl_iface",
5209 (const u8 *) buf, os_strlen(buf));
5210 wpa_dbg(wpa_s, level, "Control interface command '%s'", buf);
5211 }
5212
5213 reply = os_malloc(reply_size);
5214 if (reply == NULL) {
5215 *resp_len = 1;
5216 return NULL;
5217 }
5218
5219 os_memcpy(reply, "OK\n", 3);
5220 reply_len = 3;
5221
5222 if (os_strcmp(buf, "PING") == 0) {
5223 os_memcpy(reply, "PONG\n", 5);
5224 reply_len = 5;
5225 } else if (os_strcmp(buf, "IFNAME") == 0) {
5226 reply_len = os_strlen(wpa_s->ifname);
5227 os_memcpy(reply, wpa_s->ifname, reply_len);
5228 } else if (os_strncmp(buf, "RELOG", 5) == 0) {
5229 if (wpa_debug_reopen_file() < 0)
5230 reply_len = -1;
5231 } else if (os_strncmp(buf, "NOTE ", 5) == 0) {
5232 wpa_printf(MSG_INFO, "NOTE: %s", buf + 5);
5233 } else if (os_strcmp(buf, "MIB") == 0) {
5234 reply_len = wpa_sm_get_mib(wpa_s->wpa, reply, reply_size);
5235 if (reply_len >= 0) {
5236 int res;
5237 res = eapol_sm_get_mib(wpa_s->eapol, reply + reply_len,
5238 reply_size - reply_len);
5239 if (res < 0)
5240 reply_len = -1;
5241 else
5242 reply_len += res;
5243 }
5244 } else if (os_strncmp(buf, "STATUS", 6) == 0) {
5245 reply_len = wpa_supplicant_ctrl_iface_status(
5246 wpa_s, buf + 6, reply, reply_size);
5247 } else if (os_strcmp(buf, "PMKSA") == 0) {
5248 reply_len = wpa_sm_pmksa_cache_list(wpa_s->wpa, reply,
5249 reply_size);
5250 } else if (os_strncmp(buf, "SET ", 4) == 0) {
5251 if (wpa_supplicant_ctrl_iface_set(wpa_s, buf + 4))
5252 reply_len = -1;
5253 } else if (os_strncmp(buf, "GET ", 4) == 0) {
5254 reply_len = wpa_supplicant_ctrl_iface_get(wpa_s, buf + 4,
5255 reply, reply_size);
5256 } else if (os_strcmp(buf, "LOGON") == 0) {
5257 eapol_sm_notify_logoff(wpa_s->eapol, FALSE);
5258 } else if (os_strcmp(buf, "LOGOFF") == 0) {
5259 eapol_sm_notify_logoff(wpa_s->eapol, TRUE);
5260 } else if (os_strcmp(buf, "REASSOCIATE") == 0) {
5261 if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
5262 reply_len = -1;
5263 else
5264 wpas_request_connection(wpa_s);
5265 } else if (os_strcmp(buf, "RECONNECT") == 0) {
5266 if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
5267 reply_len = -1;
5268 else if (wpa_s->disconnected)
5269 wpas_request_connection(wpa_s);
5270 #ifdef IEEE8021X_EAPOL
5271 } else if (os_strncmp(buf, "PREAUTH ", 8) == 0) {
5272 if (wpa_supplicant_ctrl_iface_preauth(wpa_s, buf + 8))
5273 reply_len = -1;
5274 #endif /* IEEE8021X_EAPOL */
5275 #ifdef CONFIG_PEERKEY
5276 } else if (os_strncmp(buf, "STKSTART ", 9) == 0) {
5277 if (wpa_supplicant_ctrl_iface_stkstart(wpa_s, buf + 9))
5278 reply_len = -1;
5279 #endif /* CONFIG_PEERKEY */
5280 #ifdef CONFIG_IEEE80211R
5281 } else if (os_strncmp(buf, "FT_DS ", 6) == 0) {
5282 if (wpa_supplicant_ctrl_iface_ft_ds(wpa_s, buf + 6))
5283 reply_len = -1;
5284 #endif /* CONFIG_IEEE80211R */
5285 #ifdef CONFIG_WPS
5286 } else if (os_strcmp(buf, "WPS_PBC") == 0) {
5287 int res = wpa_supplicant_ctrl_iface_wps_pbc(wpa_s, NULL);
5288 if (res == -2) {
5289 os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
5290 reply_len = 17;
5291 } else if (res)
5292 reply_len = -1;
5293 } else if (os_strncmp(buf, "WPS_PBC ", 8) == 0) {
5294 int res = wpa_supplicant_ctrl_iface_wps_pbc(wpa_s, buf + 8);
5295 if (res == -2) {
5296 os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
5297 reply_len = 17;
5298 } else if (res)
5299 reply_len = -1;
5300 } else if (os_strncmp(buf, "WPS_PIN ", 8) == 0) {
5301 reply_len = wpa_supplicant_ctrl_iface_wps_pin(wpa_s, buf + 8,
5302 reply,
5303 reply_size);
5304 } else if (os_strncmp(buf, "WPS_CHECK_PIN ", 14) == 0) {
5305 reply_len = wpa_supplicant_ctrl_iface_wps_check_pin(
5306 wpa_s, buf + 14, reply, reply_size);
5307 } else if (os_strcmp(buf, "WPS_CANCEL") == 0) {
5308 if (wpas_wps_cancel(wpa_s))
5309 reply_len = -1;
5310 #ifdef CONFIG_WPS_NFC
5311 } else if (os_strcmp(buf, "WPS_NFC") == 0) {
5312 if (wpa_supplicant_ctrl_iface_wps_nfc(wpa_s, NULL))
5313 reply_len = -1;
5314 } else if (os_strncmp(buf, "WPS_NFC ", 8) == 0) {
5315 if (wpa_supplicant_ctrl_iface_wps_nfc(wpa_s, buf + 8))
5316 reply_len = -1;
5317 } else if (os_strncmp(buf, "WPS_NFC_CONFIG_TOKEN ", 21) == 0) {
5318 reply_len = wpa_supplicant_ctrl_iface_wps_nfc_config_token(
5319 wpa_s, buf + 21, reply, reply_size);
5320 } else if (os_strncmp(buf, "WPS_NFC_TOKEN ", 14) == 0) {
5321 reply_len = wpa_supplicant_ctrl_iface_wps_nfc_token(
5322 wpa_s, buf + 14, reply, reply_size);
5323 } else if (os_strncmp(buf, "WPS_NFC_TAG_READ ", 17) == 0) {
5324 if (wpa_supplicant_ctrl_iface_wps_nfc_tag_read(wpa_s,
5325 buf + 17))
5326 reply_len = -1;
5327 } else if (os_strncmp(buf, "NFC_GET_HANDOVER_REQ ", 21) == 0) {
5328 reply_len = wpas_ctrl_nfc_get_handover_req(
5329 wpa_s, buf + 21, reply, reply_size);
5330 } else if (os_strncmp(buf, "NFC_GET_HANDOVER_SEL ", 21) == 0) {
5331 reply_len = wpas_ctrl_nfc_get_handover_sel(
5332 wpa_s, buf + 21, reply, reply_size);
5333 } else if (os_strncmp(buf, "NFC_RX_HANDOVER_REQ ", 20) == 0) {
5334 reply_len = wpas_ctrl_nfc_rx_handover_req(
5335 wpa_s, buf + 20, reply, reply_size);
5336 } else if (os_strncmp(buf, "NFC_RX_HANDOVER_SEL ", 20) == 0) {
5337 if (wpas_ctrl_nfc_rx_handover_sel(wpa_s, buf + 20))
5338 reply_len = -1;
5339 } else if (os_strncmp(buf, "NFC_REPORT_HANDOVER ", 20) == 0) {
5340 if (wpas_ctrl_nfc_report_handover(wpa_s, buf + 20))
5341 reply_len = -1;
5342 #endif /* CONFIG_WPS_NFC */
5343 } else if (os_strncmp(buf, "WPS_REG ", 8) == 0) {
5344 if (wpa_supplicant_ctrl_iface_wps_reg(wpa_s, buf + 8))
5345 reply_len = -1;
5346 #ifdef CONFIG_AP
5347 } else if (os_strncmp(buf, "WPS_AP_PIN ", 11) == 0) {
5348 reply_len = wpa_supplicant_ctrl_iface_wps_ap_pin(
5349 wpa_s, buf + 11, reply, reply_size);
5350 #endif /* CONFIG_AP */
5351 #ifdef CONFIG_WPS_ER
5352 } else if (os_strcmp(buf, "WPS_ER_START") == 0) {
5353 if (wpas_wps_er_start(wpa_s, NULL))
5354 reply_len = -1;
5355 } else if (os_strncmp(buf, "WPS_ER_START ", 13) == 0) {
5356 if (wpas_wps_er_start(wpa_s, buf + 13))
5357 reply_len = -1;
5358 } else if (os_strcmp(buf, "WPS_ER_STOP") == 0) {
5359 if (wpas_wps_er_stop(wpa_s))
5360 reply_len = -1;
5361 } else if (os_strncmp(buf, "WPS_ER_PIN ", 11) == 0) {
5362 if (wpa_supplicant_ctrl_iface_wps_er_pin(wpa_s, buf + 11))
5363 reply_len = -1;
5364 } else if (os_strncmp(buf, "WPS_ER_PBC ", 11) == 0) {
5365 int ret = wpas_wps_er_pbc(wpa_s, buf + 11);
5366 if (ret == -2) {
5367 os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
5368 reply_len = 17;
5369 } else if (ret == -3) {
5370 os_memcpy(reply, "FAIL-UNKNOWN-UUID\n", 18);
5371 reply_len = 18;
5372 } else if (ret == -4) {
5373 os_memcpy(reply, "FAIL-NO-AP-SETTINGS\n", 20);
5374 reply_len = 20;
5375 } else if (ret)
5376 reply_len = -1;
5377 } else if (os_strncmp(buf, "WPS_ER_LEARN ", 13) == 0) {
5378 if (wpa_supplicant_ctrl_iface_wps_er_learn(wpa_s, buf + 13))
5379 reply_len = -1;
5380 } else if (os_strncmp(buf, "WPS_ER_SET_CONFIG ", 18) == 0) {
5381 if (wpa_supplicant_ctrl_iface_wps_er_set_config(wpa_s,
5382 buf + 18))
5383 reply_len = -1;
5384 } else if (os_strncmp(buf, "WPS_ER_CONFIG ", 14) == 0) {
5385 if (wpa_supplicant_ctrl_iface_wps_er_config(wpa_s, buf + 14))
5386 reply_len = -1;
5387 #ifdef CONFIG_WPS_NFC
5388 } else if (os_strncmp(buf, "WPS_ER_NFC_CONFIG_TOKEN ", 24) == 0) {
5389 reply_len = wpa_supplicant_ctrl_iface_wps_er_nfc_config_token(
5390 wpa_s, buf + 24, reply, reply_size);
5391 #endif /* CONFIG_WPS_NFC */
5392 #endif /* CONFIG_WPS_ER */
5393 #endif /* CONFIG_WPS */
5394 #ifdef CONFIG_IBSS_RSN
5395 } else if (os_strncmp(buf, "IBSS_RSN ", 9) == 0) {
5396 if (wpa_supplicant_ctrl_iface_ibss_rsn(wpa_s, buf + 9))
5397 reply_len = -1;
5398 #endif /* CONFIG_IBSS_RSN */
5399 #ifdef CONFIG_P2P
5400 } else if (os_strncmp(buf, "P2P_FIND ", 9) == 0) {
5401 if (p2p_ctrl_find(wpa_s, buf + 9))
5402 reply_len = -1;
5403 } else if (os_strcmp(buf, "P2P_FIND") == 0) {
5404 if (p2p_ctrl_find(wpa_s, ""))
5405 reply_len = -1;
5406 } else if (os_strcmp(buf, "P2P_STOP_FIND") == 0) {
5407 wpas_p2p_stop_find(wpa_s);
5408 } else if (os_strncmp(buf, "P2P_CONNECT ", 12) == 0) {
5409 reply_len = p2p_ctrl_connect(wpa_s, buf + 12, reply,
5410 reply_size);
5411 } else if (os_strncmp(buf, "P2P_LISTEN ", 11) == 0) {
5412 if (p2p_ctrl_listen(wpa_s, buf + 11))
5413 reply_len = -1;
5414 } else if (os_strcmp(buf, "P2P_LISTEN") == 0) {
5415 if (p2p_ctrl_listen(wpa_s, ""))
5416 reply_len = -1;
5417 } else if (os_strncmp(buf, "P2P_GROUP_REMOVE ", 17) == 0) {
5418 if (wpas_p2p_group_remove(wpa_s, buf + 17))
5419 reply_len = -1;
5420 } else if (os_strcmp(buf, "P2P_GROUP_ADD") == 0) {
5421 if (wpas_p2p_group_add(wpa_s, 0, 0, 0, 0))
5422 reply_len = -1;
5423 } else if (os_strncmp(buf, "P2P_GROUP_ADD ", 14) == 0) {
5424 if (p2p_ctrl_group_add(wpa_s, buf + 14))
5425 reply_len = -1;
5426 } else if (os_strncmp(buf, "P2P_PROV_DISC ", 14) == 0) {
5427 if (p2p_ctrl_prov_disc(wpa_s, buf + 14))
5428 reply_len = -1;
5429 } else if (os_strcmp(buf, "P2P_GET_PASSPHRASE") == 0) {
5430 reply_len = p2p_get_passphrase(wpa_s, reply, reply_size);
5431 } else if (os_strncmp(buf, "P2P_SERV_DISC_REQ ", 18) == 0) {
5432 reply_len = p2p_ctrl_serv_disc_req(wpa_s, buf + 18, reply,
5433 reply_size);
5434 } else if (os_strncmp(buf, "P2P_SERV_DISC_CANCEL_REQ ", 25) == 0) {
5435 if (p2p_ctrl_serv_disc_cancel_req(wpa_s, buf + 25) < 0)
5436 reply_len = -1;
5437 } else if (os_strncmp(buf, "P2P_SERV_DISC_RESP ", 19) == 0) {
5438 if (p2p_ctrl_serv_disc_resp(wpa_s, buf + 19) < 0)
5439 reply_len = -1;
5440 } else if (os_strcmp(buf, "P2P_SERVICE_UPDATE") == 0) {
5441 wpas_p2p_sd_service_update(wpa_s);
5442 } else if (os_strncmp(buf, "P2P_SERV_DISC_EXTERNAL ", 23) == 0) {
5443 if (p2p_ctrl_serv_disc_external(wpa_s, buf + 23) < 0)
5444 reply_len = -1;
5445 } else if (os_strcmp(buf, "P2P_SERVICE_FLUSH") == 0) {
5446 wpas_p2p_service_flush(wpa_s);
5447 } else if (os_strncmp(buf, "P2P_SERVICE_ADD ", 16) == 0) {
5448 if (p2p_ctrl_service_add(wpa_s, buf + 16) < 0)
5449 reply_len = -1;
5450 } else if (os_strncmp(buf, "P2P_SERVICE_DEL ", 16) == 0) {
5451 if (p2p_ctrl_service_del(wpa_s, buf + 16) < 0)
5452 reply_len = -1;
5453 } else if (os_strncmp(buf, "P2P_REJECT ", 11) == 0) {
5454 if (p2p_ctrl_reject(wpa_s, buf + 11) < 0)
5455 reply_len = -1;
5456 } else if (os_strncmp(buf, "P2P_INVITE ", 11) == 0) {
5457 if (p2p_ctrl_invite(wpa_s, buf + 11) < 0)
5458 reply_len = -1;
5459 } else if (os_strncmp(buf, "P2P_PEER ", 9) == 0) {
5460 reply_len = p2p_ctrl_peer(wpa_s, buf + 9, reply,
5461 reply_size);
5462 } else if (os_strncmp(buf, "P2P_SET ", 8) == 0) {
5463 if (p2p_ctrl_set(wpa_s, buf + 8) < 0)
5464 reply_len = -1;
5465 } else if (os_strcmp(buf, "P2P_FLUSH") == 0) {
5466 p2p_ctrl_flush(wpa_s);
5467 } else if (os_strncmp(buf, "P2P_UNAUTHORIZE ", 16) == 0) {
5468 if (wpas_p2p_unauthorize(wpa_s, buf + 16) < 0)
5469 reply_len = -1;
5470 } else if (os_strcmp(buf, "P2P_CANCEL") == 0) {
5471 if (wpas_p2p_cancel(wpa_s))
5472 reply_len = -1;
5473 } else if (os_strncmp(buf, "P2P_PRESENCE_REQ ", 17) == 0) {
5474 if (p2p_ctrl_presence_req(wpa_s, buf + 17) < 0)
5475 reply_len = -1;
5476 } else if (os_strcmp(buf, "P2P_PRESENCE_REQ") == 0) {
5477 if (p2p_ctrl_presence_req(wpa_s, "") < 0)
5478 reply_len = -1;
5479 } else if (os_strncmp(buf, "P2P_EXT_LISTEN ", 15) == 0) {
5480 if (p2p_ctrl_ext_listen(wpa_s, buf + 15) < 0)
5481 reply_len = -1;
5482 } else if (os_strcmp(buf, "P2P_EXT_LISTEN") == 0) {
5483 if (p2p_ctrl_ext_listen(wpa_s, "") < 0)
5484 reply_len = -1;
5485 } else if (os_strncmp(buf, "P2P_REMOVE_CLIENT ", 18) == 0) {
5486 if (p2p_ctrl_remove_client(wpa_s, buf + 18) < 0)
5487 reply_len = -1;
5488 #endif /* CONFIG_P2P */
5489 #ifdef CONFIG_WIFI_DISPLAY
5490 } else if (os_strncmp(buf, "WFD_SUBELEM_SET ", 16) == 0) {
5491 if (wifi_display_subelem_set(wpa_s->global, buf + 16) < 0)
5492 reply_len = -1;
5493 } else if (os_strncmp(buf, "WFD_SUBELEM_GET ", 16) == 0) {
5494 reply_len = wifi_display_subelem_get(wpa_s->global, buf + 16,
5495 reply, reply_size);
5496 #endif /* CONFIG_WIFI_DISPLAY */
5497 #ifdef CONFIG_INTERWORKING
5498 } else if (os_strcmp(buf, "FETCH_ANQP") == 0) {
5499 if (interworking_fetch_anqp(wpa_s) < 0)
5500 reply_len = -1;
5501 } else if (os_strcmp(buf, "STOP_FETCH_ANQP") == 0) {
5502 interworking_stop_fetch_anqp(wpa_s);
5503 } else if (os_strncmp(buf, "INTERWORKING_SELECT", 19) == 0) {
5504 if (interworking_select(wpa_s, os_strstr(buf + 19, "auto") !=
5505 NULL) < 0)
5506 reply_len = -1;
5507 } else if (os_strncmp(buf, "INTERWORKING_CONNECT ", 21) == 0) {
5508 if (ctrl_interworking_connect(wpa_s, buf + 21) < 0)
5509 reply_len = -1;
5510 } else if (os_strncmp(buf, "ANQP_GET ", 9) == 0) {
5511 if (get_anqp(wpa_s, buf + 9) < 0)
5512 reply_len = -1;
5513 } else if (os_strncmp(buf, "GAS_REQUEST ", 12) == 0) {
5514 if (gas_request(wpa_s, buf + 12) < 0)
5515 reply_len = -1;
5516 } else if (os_strncmp(buf, "GAS_RESPONSE_GET ", 17) == 0) {
5517 reply_len = gas_response_get(wpa_s, buf + 17, reply,
5518 reply_size);
5519 #endif /* CONFIG_INTERWORKING */
5520 #ifdef CONFIG_HS20
5521 } else if (os_strncmp(buf, "HS20_ANQP_GET ", 14) == 0) {
5522 if (get_hs20_anqp(wpa_s, buf + 14) < 0)
5523 reply_len = -1;
5524 } else if (os_strncmp(buf, "HS20_GET_NAI_HOME_REALM_LIST ", 29) == 0) {
5525 if (hs20_get_nai_home_realm_list(wpa_s, buf + 29) < 0)
5526 reply_len = -1;
5527 #endif /* CONFIG_HS20 */
5528 } else if (os_strncmp(buf, WPA_CTRL_RSP, os_strlen(WPA_CTRL_RSP)) == 0)
5529 {
5530 if (wpa_supplicant_ctrl_iface_ctrl_rsp(
5531 wpa_s, buf + os_strlen(WPA_CTRL_RSP)))
5532 reply_len = -1;
5533 else {
5534 /*
5535 * Notify response from timeout to allow the control
5536 * interface response to be sent first.
5537 */
5538 eloop_register_timeout(0, 0, wpas_ctrl_eapol_response,
5539 wpa_s, NULL);
5540 }
5541 } else if (os_strcmp(buf, "RECONFIGURE") == 0) {
5542 if (wpa_supplicant_reload_configuration(wpa_s))
5543 reply_len = -1;
5544 } else if (os_strcmp(buf, "TERMINATE") == 0) {
5545 wpa_supplicant_terminate_proc(wpa_s->global);
5546 } else if (os_strncmp(buf, "BSSID ", 6) == 0) {
5547 if (wpa_supplicant_ctrl_iface_bssid(wpa_s, buf + 6))
5548 reply_len = -1;
5549 } else if (os_strncmp(buf, "BLACKLIST", 9) == 0) {
5550 reply_len = wpa_supplicant_ctrl_iface_blacklist(
5551 wpa_s, buf + 9, reply, reply_size);
5552 } else if (os_strncmp(buf, "LOG_LEVEL", 9) == 0) {
5553 reply_len = wpa_supplicant_ctrl_iface_log_level(
5554 wpa_s, buf + 9, reply, reply_size);
5555 } else if (os_strcmp(buf, "LIST_NETWORKS") == 0) {
5556 reply_len = wpa_supplicant_ctrl_iface_list_networks(
5557 wpa_s, reply, reply_size);
5558 } else if (os_strcmp(buf, "DISCONNECT") == 0) {
5559 #ifdef CONFIG_SME
5560 wpa_s->sme.prev_bssid_set = 0;
5561 #endif /* CONFIG_SME */
5562 wpa_s->reassociate = 0;
5563 wpa_s->disconnected = 1;
5564 wpa_supplicant_cancel_sched_scan(wpa_s);
5565 wpa_supplicant_cancel_scan(wpa_s);
5566 wpa_supplicant_deauthenticate(wpa_s,
5567 WLAN_REASON_DEAUTH_LEAVING);
5568 } else if (os_strcmp(buf, "SCAN") == 0 ||
5569 os_strncmp(buf, "SCAN ", 5) == 0) {
5570 if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
5571 reply_len = -1;
5572 else {
5573 if (os_strlen(buf) > 4 &&
5574 os_strncasecmp(buf + 5, "TYPE=ONLY", 9) == 0)
5575 wpa_s->scan_res_handler = scan_only_handler;
5576 if (!wpa_s->sched_scanning && !wpa_s->scanning &&
5577 ((wpa_s->wpa_state <= WPA_SCANNING) ||
5578 (wpa_s->wpa_state == WPA_COMPLETED))) {
5579 wpa_s->normal_scans = 0;
5580 wpa_s->scan_req = MANUAL_SCAN_REQ;
5581 wpa_s->after_wps = 0;
5582 wpa_s->known_wps_freq = 0;
5583 wpa_supplicant_req_scan(wpa_s, 0, 0);
5584 } else if (wpa_s->sched_scanning) {
5585 wpa_printf(MSG_DEBUG, "Stop ongoing "
5586 "sched_scan to allow requested "
5587 "full scan to proceed");
5588 wpa_supplicant_cancel_sched_scan(wpa_s);
5589 wpa_s->scan_req = MANUAL_SCAN_REQ;
5590 wpa_supplicant_req_scan(wpa_s, 0, 0);
5591 } else {
5592 wpa_printf(MSG_DEBUG, "Ongoing scan action - "
5593 "reject new request");
5594 reply_len = os_snprintf(reply, reply_size,
5595 "FAIL-BUSY\n");
5596 }
5597 }
5598 } else if (os_strcmp(buf, "SCAN_RESULTS") == 0) {
5599 reply_len = wpa_supplicant_ctrl_iface_scan_results(
5600 wpa_s, reply, reply_size);
5601 } else if (os_strncmp(buf, "SELECT_NETWORK ", 15) == 0) {
5602 if (wpa_supplicant_ctrl_iface_select_network(wpa_s, buf + 15))
5603 reply_len = -1;
5604 } else if (os_strncmp(buf, "ENABLE_NETWORK ", 15) == 0) {
5605 if (wpa_supplicant_ctrl_iface_enable_network(wpa_s, buf + 15))
5606 reply_len = -1;
5607 } else if (os_strncmp(buf, "DISABLE_NETWORK ", 16) == 0) {
5608 if (wpa_supplicant_ctrl_iface_disable_network(wpa_s, buf + 16))
5609 reply_len = -1;
5610 } else if (os_strcmp(buf, "ADD_NETWORK") == 0) {
5611 reply_len = wpa_supplicant_ctrl_iface_add_network(
5612 wpa_s, reply, reply_size);
5613 } else if (os_strncmp(buf, "REMOVE_NETWORK ", 15) == 0) {
5614 if (wpa_supplicant_ctrl_iface_remove_network(wpa_s, buf + 15))
5615 reply_len = -1;
5616 } else if (os_strncmp(buf, "SET_NETWORK ", 12) == 0) {
5617 if (wpa_supplicant_ctrl_iface_set_network(wpa_s, buf + 12))
5618 reply_len = -1;
5619 } else if (os_strncmp(buf, "GET_NETWORK ", 12) == 0) {
5620 reply_len = wpa_supplicant_ctrl_iface_get_network(
5621 wpa_s, buf + 12, reply, reply_size);
5622 } else if (os_strcmp(buf, "LIST_CREDS") == 0) {
5623 reply_len = wpa_supplicant_ctrl_iface_list_creds(
5624 wpa_s, reply, reply_size);
5625 } else if (os_strcmp(buf, "ADD_CRED") == 0) {
5626 reply_len = wpa_supplicant_ctrl_iface_add_cred(
5627 wpa_s, reply, reply_size);
5628 } else if (os_strncmp(buf, "REMOVE_CRED ", 12) == 0) {
5629 if (wpa_supplicant_ctrl_iface_remove_cred(wpa_s, buf + 12))
5630 reply_len = -1;
5631 } else if (os_strncmp(buf, "SET_CRED ", 9) == 0) {
5632 if (wpa_supplicant_ctrl_iface_set_cred(wpa_s, buf + 9))
5633 reply_len = -1;
5634 #ifndef CONFIG_NO_CONFIG_WRITE
5635 } else if (os_strcmp(buf, "SAVE_CONFIG") == 0) {
5636 if (wpa_supplicant_ctrl_iface_save_config(wpa_s))
5637 reply_len = -1;
5638 #endif /* CONFIG_NO_CONFIG_WRITE */
5639 } else if (os_strncmp(buf, "GET_CAPABILITY ", 15) == 0) {
5640 reply_len = wpa_supplicant_ctrl_iface_get_capability(
5641 wpa_s, buf + 15, reply, reply_size);
5642 } else if (os_strncmp(buf, "AP_SCAN ", 8) == 0) {
5643 if (wpa_supplicant_ctrl_iface_ap_scan(wpa_s, buf + 8))
5644 reply_len = -1;
5645 } else if (os_strncmp(buf, "SCAN_INTERVAL ", 14) == 0) {
5646 if (wpa_supplicant_ctrl_iface_scan_interval(wpa_s, buf + 14))
5647 reply_len = -1;
5648 } else if (os_strcmp(buf, "INTERFACE_LIST") == 0) {
5649 reply_len = wpa_supplicant_global_iface_list(
5650 wpa_s->global, reply, reply_size);
5651 } else if (os_strcmp(buf, "INTERFACES") == 0) {
5652 reply_len = wpa_supplicant_global_iface_interfaces(
5653 wpa_s->global, reply, reply_size);
5654 } else if (os_strncmp(buf, "BSS ", 4) == 0) {
5655 reply_len = wpa_supplicant_ctrl_iface_bss(
5656 wpa_s, buf + 4, reply, reply_size);
5657 #ifdef CONFIG_AP
5658 } else if (os_strcmp(buf, "STA-FIRST") == 0) {
5659 reply_len = ap_ctrl_iface_sta_first(wpa_s, reply, reply_size);
5660 } else if (os_strncmp(buf, "STA ", 4) == 0) {
5661 reply_len = ap_ctrl_iface_sta(wpa_s, buf + 4, reply,
5662 reply_size);
5663 } else if (os_strncmp(buf, "STA-NEXT ", 9) == 0) {
5664 reply_len = ap_ctrl_iface_sta_next(wpa_s, buf + 9, reply,
5665 reply_size);
5666 } else if (os_strncmp(buf, "DEAUTHENTICATE ", 15) == 0) {
5667 if (ap_ctrl_iface_sta_deauthenticate(wpa_s, buf + 15))
5668 reply_len = -1;
5669 } else if (os_strncmp(buf, "DISASSOCIATE ", 13) == 0) {
5670 if (ap_ctrl_iface_sta_disassociate(wpa_s, buf + 13))
5671 reply_len = -1;
5672 #endif /* CONFIG_AP */
5673 } else if (os_strcmp(buf, "SUSPEND") == 0) {
5674 wpas_notify_suspend(wpa_s->global);
5675 } else if (os_strcmp(buf, "RESUME") == 0) {
5676 wpas_notify_resume(wpa_s->global);
5677 } else if (os_strcmp(buf, "DROP_SA") == 0) {
5678 wpa_supplicant_ctrl_iface_drop_sa(wpa_s);
5679 } else if (os_strncmp(buf, "ROAM ", 5) == 0) {
5680 if (wpa_supplicant_ctrl_iface_roam(wpa_s, buf + 5))
5681 reply_len = -1;
5682 } else if (os_strncmp(buf, "STA_AUTOCONNECT ", 16) == 0) {
5683 if (wpa_supplicant_ctrl_iface_sta_autoconnect(wpa_s, buf + 16))
5684 reply_len = -1;
5685 } else if (os_strncmp(buf, "BSS_EXPIRE_AGE ", 15) == 0) {
5686 if (wpa_supplicant_ctrl_iface_bss_expire_age(wpa_s, buf + 15))
5687 reply_len = -1;
5688 } else if (os_strncmp(buf, "BSS_EXPIRE_COUNT ", 17) == 0) {
5689 if (wpa_supplicant_ctrl_iface_bss_expire_count(wpa_s,
5690 buf + 17))
5691 reply_len = -1;
5692 } else if (os_strncmp(buf, "BSS_FLUSH ", 10) == 0) {
5693 if (wpa_supplicant_ctrl_iface_bss_flush(wpa_s, buf + 10))
5694 reply_len = -1;
5695 #ifdef CONFIG_TDLS
5696 } else if (os_strncmp(buf, "TDLS_DISCOVER ", 14) == 0) {
5697 if (wpa_supplicant_ctrl_iface_tdls_discover(wpa_s, buf + 14))
5698 reply_len = -1;
5699 } else if (os_strncmp(buf, "TDLS_SETUP ", 11) == 0) {
5700 if (wpa_supplicant_ctrl_iface_tdls_setup(wpa_s, buf + 11))
5701 reply_len = -1;
5702 } else if (os_strncmp(buf, "TDLS_TEARDOWN ", 14) == 0) {
5703 if (wpa_supplicant_ctrl_iface_tdls_teardown(wpa_s, buf + 14))
5704 reply_len = -1;
5705 #endif /* CONFIG_TDLS */
5706 } else if (os_strncmp(buf, "SIGNAL_POLL", 11) == 0) {
5707 reply_len = wpa_supplicant_signal_poll(wpa_s, reply,
5708 reply_size);
5709 } else if (os_strncmp(buf, "PKTCNT_POLL", 11) == 0) {
5710 reply_len = wpa_supplicant_pktcnt_poll(wpa_s, reply,
5711 reply_size);
5712 #ifdef CONFIG_AUTOSCAN
5713 } else if (os_strncmp(buf, "AUTOSCAN ", 9) == 0) {
5714 if (wpa_supplicant_ctrl_iface_autoscan(wpa_s, buf + 9))
5715 reply_len = -1;
5716 #endif /* CONFIG_AUTOSCAN */
5717 } else if (os_strcmp(buf, "REAUTHENTICATE") == 0) {
5718 pmksa_cache_clear_current(wpa_s->wpa);
5719 eapol_sm_request_reauth(wpa_s->eapol);
5720 #ifdef CONFIG_WNM
5721 } else if (os_strncmp(buf, "WNM_SLEEP ", 10) == 0) {
5722 if (wpas_ctrl_iface_wnm_sleep(wpa_s, buf + 10))
5723 reply_len = -1;
5724 } else if (os_strncmp(buf, "WNM_BSS_QUERY ", 10) == 0) {
5725 if (wpas_ctrl_iface_wnm_bss_query(wpa_s, buf + 10))
5726 reply_len = -1;
5727 #endif /* CONFIG_WNM */
5728 } else if (os_strcmp(buf, "FLUSH") == 0) {
5729 wpa_supplicant_ctrl_iface_flush(wpa_s);
5730 } else {
5731 os_memcpy(reply, "UNKNOWN COMMAND\n", 16);
5732 reply_len = 16;
5733 }
5734
5735 if (reply_len < 0) {
5736 os_memcpy(reply, "FAIL\n", 5);
5737 reply_len = 5;
5738 }
5739
5740 *resp_len = reply_len;
5741 return reply;
5742 }
5743
5744
5745 static int wpa_supplicant_global_iface_add(struct wpa_global *global,
5746 char *cmd)
5747 {
5748 struct wpa_interface iface;
5749 char *pos;
5750
5751 /*
5752 * <ifname>TAB<confname>TAB<driver>TAB<ctrl_interface>TAB<driver_param>
5753 * TAB<bridge_ifname>
5754 */
5755 wpa_printf(MSG_DEBUG, "CTRL_IFACE GLOBAL INTERFACE_ADD '%s'", cmd);
5756
5757 os_memset(&iface, 0, sizeof(iface));
5758
5759 do {
5760 iface.ifname = pos = cmd;
5761 pos = os_strchr(pos, '\t');
5762 if (pos)
5763 *pos++ = '\0';
5764 if (iface.ifname[0] == '\0')
5765 return -1;
5766 if (pos == NULL)
5767 break;
5768
5769 iface.confname = pos;
5770 pos = os_strchr(pos, '\t');
5771 if (pos)
5772 *pos++ = '\0';
5773 if (iface.confname[0] == '\0')
5774 iface.confname = NULL;
5775 if (pos == NULL)
5776 break;
5777
5778 iface.driver = pos;
5779 pos = os_strchr(pos, '\t');
5780 if (pos)
5781 *pos++ = '\0';
5782 if (iface.driver[0] == '\0')
5783 iface.driver = NULL;
5784 if (pos == NULL)
5785 break;
5786
5787 iface.ctrl_interface = pos;
5788 pos = os_strchr(pos, '\t');
5789 if (pos)
5790 *pos++ = '\0';
5791 if (iface.ctrl_interface[0] == '\0')
5792 iface.ctrl_interface = NULL;
5793 if (pos == NULL)
5794 break;
5795
5796 iface.driver_param = pos;
5797 pos = os_strchr(pos, '\t');
5798 if (pos)
5799 *pos++ = '\0';
5800 if (iface.driver_param[0] == '\0')
5801 iface.driver_param = NULL;
5802 if (pos == NULL)
5803 break;
5804
5805 iface.bridge_ifname = pos;
5806 pos = os_strchr(pos, '\t');
5807 if (pos)
5808 *pos++ = '\0';
5809 if (iface.bridge_ifname[0] == '\0')
5810 iface.bridge_ifname = NULL;
5811 if (pos == NULL)
5812 break;
5813 } while (0);
5814
5815 if (wpa_supplicant_get_iface(global, iface.ifname))
5816 return -1;
5817
5818 return wpa_supplicant_add_iface(global, &iface) ? 0 : -1;
5819 }
5820
5821
5822 static int wpa_supplicant_global_iface_remove(struct wpa_global *global,
5823 char *cmd)
5824 {
5825 struct wpa_supplicant *wpa_s;
5826
5827 wpa_printf(MSG_DEBUG, "CTRL_IFACE GLOBAL INTERFACE_REMOVE '%s'", cmd);
5828
5829 wpa_s = wpa_supplicant_get_iface(global, cmd);
5830 if (wpa_s == NULL)
5831 return -1;
5832 return wpa_supplicant_remove_iface(global, wpa_s, 0);
5833 }
5834
5835
5836 static void wpa_free_iface_info(struct wpa_interface_info *iface)
5837 {
5838 struct wpa_interface_info *prev;
5839
5840 while (iface) {
5841 prev = iface;
5842 iface = iface->next;
5843
5844 os_free(prev->ifname);
5845 os_free(prev->desc);
5846 os_free(prev);
5847 }
5848 }
5849
5850
5851 static int wpa_supplicant_global_iface_list(struct wpa_global *global,
5852 char *buf, int len)
5853 {
5854 int i, res;
5855 struct wpa_interface_info *iface = NULL, *last = NULL, *tmp;
5856 char *pos, *end;
5857
5858 for (i = 0; wpa_drivers[i]; i++) {
5859 struct wpa_driver_ops *drv = wpa_drivers[i];
5860 if (drv->get_interfaces == NULL)
5861 continue;
5862 tmp = drv->get_interfaces(global->drv_priv[i]);
5863 if (tmp == NULL)
5864 continue;
5865
5866 if (last == NULL)
5867 iface = last = tmp;
5868 else
5869 last->next = tmp;
5870 while (last->next)
5871 last = last->next;
5872 }
5873
5874 pos = buf;
5875 end = buf + len;
5876 for (tmp = iface; tmp; tmp = tmp->next) {
5877 res = os_snprintf(pos, end - pos, "%s\t%s\t%s\n",
5878 tmp->drv_name, tmp->ifname,
5879 tmp->desc ? tmp->desc : "");
5880 if (res < 0 || res >= end - pos) {
5881 *pos = '\0';
5882 break;
5883 }
5884 pos += res;
5885 }
5886
5887 wpa_free_iface_info(iface);
5888
5889 return pos - buf;
5890 }
5891
5892
5893 static int wpa_supplicant_global_iface_interfaces(struct wpa_global *global,
5894 char *buf, int len)
5895 {
5896 int res;
5897 char *pos, *end;
5898 struct wpa_supplicant *wpa_s;
5899
5900 wpa_s = global->ifaces;
5901 pos = buf;
5902 end = buf + len;
5903
5904 while (wpa_s) {
5905 res = os_snprintf(pos, end - pos, "%s\n", wpa_s->ifname);
5906 if (res < 0 || res >= end - pos) {
5907 *pos = '\0';
5908 break;
5909 }
5910 pos += res;
5911 wpa_s = wpa_s->next;
5912 }
5913 return pos - buf;
5914 }
5915
5916
5917 static char * wpas_global_ctrl_iface_ifname(struct wpa_global *global,
5918 const char *ifname,
5919 char *cmd, size_t *resp_len)
5920 {
5921 struct wpa_supplicant *wpa_s;
5922
5923 for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
5924 if (os_strcmp(ifname, wpa_s->ifname) == 0)
5925 break;
5926 }
5927
5928 if (wpa_s == NULL) {
5929 char *resp = os_strdup("FAIL-NO-IFNAME-MATCH\n");
5930 if (resp)
5931 *resp_len = os_strlen(resp);
5932 else
5933 *resp_len = 1;
5934 return resp;
5935 }
5936
5937 return wpa_supplicant_ctrl_iface_process(wpa_s, cmd, resp_len);
5938 }
5939
5940
5941 static char * wpas_global_ctrl_iface_redir_p2p(struct wpa_global *global,
5942 char *buf, size_t *resp_len)
5943 {
5944 #ifdef CONFIG_P2P
5945 static const char * cmd[] = {
5946 "P2P_FIND",
5947 "P2P_STOP_FIND",
5948 "P2P_LISTEN",
5949 "P2P_GROUP_ADD",
5950 "P2P_GET_PASSPHRASE",
5951 "P2P_SERVICE_UPDATE",
5952 "P2P_SERVICE_FLUSH",
5953 "P2P_FLUSH",
5954 "P2P_CANCEL",
5955 "P2P_PRESENCE_REQ",
5956 "P2P_EXT_LISTEN",
5957 NULL
5958 };
5959 static const char * prefix[] = {
5960 "P2P_FIND ",
5961 "P2P_CONNECT ",
5962 "P2P_LISTEN ",
5963 "P2P_GROUP_REMOVE ",
5964 "P2P_GROUP_ADD ",
5965 "P2P_PROV_DISC ",
5966 "P2P_SERV_DISC_REQ ",
5967 "P2P_SERV_DISC_CANCEL_REQ ",
5968 "P2P_SERV_DISC_RESP ",
5969 "P2P_SERV_DISC_EXTERNAL ",
5970 "P2P_SERVICE_ADD ",
5971 "P2P_SERVICE_DEL ",
5972 "P2P_REJECT ",
5973 "P2P_INVITE ",
5974 "P2P_PEER ",
5975 "P2P_SET ",
5976 "P2P_UNAUTHORIZE ",
5977 "P2P_PRESENCE_REQ ",
5978 "P2P_EXT_LISTEN ",
5979 "P2P_REMOVE_CLIENT ",
5980 NULL
5981 };
5982 int found = 0;
5983 int i;
5984
5985 if (global->p2p_init_wpa_s == NULL)
5986 return NULL;
5987
5988 for (i = 0; !found && cmd[i]; i++) {
5989 if (os_strcmp(buf, cmd[i]) == 0)
5990 found = 1;
5991 }
5992
5993 for (i = 0; !found && prefix[i]; i++) {
5994 if (os_strncmp(buf, prefix[i], os_strlen(prefix[i])) == 0)
5995 found = 1;
5996 }
5997
5998 if (found)
5999 return wpa_supplicant_ctrl_iface_process(global->p2p_init_wpa_s,
6000 buf, resp_len);
6001 #endif /* CONFIG_P2P */
6002 return NULL;
6003 }
6004
6005
6006 static char * wpas_global_ctrl_iface_redir_wfd(struct wpa_global *global,
6007 char *buf, size_t *resp_len)
6008 {
6009 #ifdef CONFIG_WIFI_DISPLAY
6010 if (global->p2p_init_wpa_s == NULL)
6011 return NULL;
6012 if (os_strncmp(buf, "WFD_SUBELEM_SET ", 16) == 0 ||
6013 os_strncmp(buf, "WFD_SUBELEM_GET ", 16) == 0)
6014 return wpa_supplicant_ctrl_iface_process(global->p2p_init_wpa_s,
6015 buf, resp_len);
6016 #endif /* CONFIG_WIFI_DISPLAY */
6017 return NULL;
6018 }
6019
6020
6021 static char * wpas_global_ctrl_iface_redir(struct wpa_global *global,
6022 char *buf, size_t *resp_len)
6023 {
6024 char *ret;
6025
6026 ret = wpas_global_ctrl_iface_redir_p2p(global, buf, resp_len);
6027 if (ret)
6028 return ret;
6029
6030 ret = wpas_global_ctrl_iface_redir_wfd(global, buf, resp_len);
6031 if (ret)
6032 return ret;
6033
6034 return NULL;
6035 }
6036
6037
6038 static int wpas_global_ctrl_iface_set(struct wpa_global *global, char *cmd)
6039 {
6040 char *value;
6041
6042 value = os_strchr(cmd, ' ');
6043 if (value == NULL)
6044 return -1;
6045 *value++ = '\0';
6046
6047 wpa_printf(MSG_DEBUG, "GLOBAL_CTRL_IFACE SET '%s'='%s'", cmd, value);
6048
6049 #ifdef CONFIG_WIFI_DISPLAY
6050 if (os_strcasecmp(cmd, "wifi_display") == 0) {
6051 wifi_display_enable(global, !!atoi(value));
6052 return 0;
6053 }
6054 #endif /* CONFIG_WIFI_DISPLAY */
6055
6056 return -1;
6057 }
6058
6059
6060 #ifndef CONFIG_NO_CONFIG_WRITE
6061 static int wpas_global_ctrl_iface_save_config(struct wpa_global *global)
6062 {
6063 int ret = 0;
6064 struct wpa_supplicant *wpa_s;
6065
6066 for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
6067 if (!wpa_s->conf->update_config) {
6068 wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Not allowed to update configuration (update_config=0)");
6069 continue;
6070 }
6071
6072 if (wpa_config_write(wpa_s->confname, wpa_s->conf)) {
6073 wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Failed to update configuration");
6074 ret = 1;
6075 } else {
6076 wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Configuration updated");
6077 }
6078 }
6079
6080 return ret;
6081 }
6082 #endif /* CONFIG_NO_CONFIG_WRITE */
6083
6084
6085 static int wpas_global_ctrl_iface_status(struct wpa_global *global,
6086 char *buf, size_t buflen)
6087 {
6088 char *pos, *end;
6089 int ret;
6090 struct wpa_supplicant *wpa_s;
6091
6092 pos = buf;
6093 end = buf + buflen;
6094
6095 #ifdef CONFIG_P2P
6096 if (global->p2p && !global->p2p_disabled) {
6097 ret = os_snprintf(pos, end - pos, "p2p_device_address=" MACSTR
6098 "\n"
6099 "p2p_state=%s\n",
6100 MAC2STR(global->p2p_dev_addr),
6101 p2p_get_state_txt(global->p2p));
6102 if (ret < 0 || ret >= end - pos)
6103 return pos - buf;
6104 pos += ret;
6105 } else if (global->p2p) {
6106 ret = os_snprintf(pos, end - pos, "p2p_state=DISABLED\n");
6107 if (ret < 0 || ret >= end - pos)
6108 return pos - buf;
6109 pos += ret;
6110 }
6111 #endif /* CONFIG_P2P */
6112
6113 #ifdef CONFIG_WIFI_DISPLAY
6114 ret = os_snprintf(pos, end - pos, "wifi_display=%d\n",
6115 !!global->wifi_display);
6116 if (ret < 0 || ret >= end - pos)
6117 return pos - buf;
6118 pos += ret;
6119 #endif /* CONFIG_WIFI_DISPLAY */
6120
6121 for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
6122 ret = os_snprintf(pos, end - pos, "ifname=%s\n"
6123 "address=" MACSTR "\n",
6124 wpa_s->ifname, MAC2STR(wpa_s->own_addr));
6125 if (ret < 0 || ret >= end - pos)
6126 return pos - buf;
6127 pos += ret;
6128 }
6129
6130 return pos - buf;
6131 }
6132
6133
6134 char * wpa_supplicant_global_ctrl_iface_process(struct wpa_global *global,
6135 char *buf, size_t *resp_len)
6136 {
6137 char *reply;
6138 const int reply_size = 2048;
6139 int reply_len;
6140 int level = MSG_DEBUG;
6141
6142 if (os_strncmp(buf, "IFNAME=", 7) == 0) {
6143 char *pos = os_strchr(buf + 7, ' ');
6144 if (pos) {
6145 *pos++ = '\0';
6146 return wpas_global_ctrl_iface_ifname(global,
6147 buf + 7, pos,
6148 resp_len);
6149 }
6150 }
6151
6152 reply = wpas_global_ctrl_iface_redir(global, buf, resp_len);
6153 if (reply)
6154 return reply;
6155
6156 if (os_strcmp(buf, "PING") == 0)
6157 level = MSG_EXCESSIVE;
6158 wpa_hexdump_ascii(level, "RX global ctrl_iface",
6159 (const u8 *) buf, os_strlen(buf));
6160
6161 reply = os_malloc(reply_size);
6162 if (reply == NULL) {
6163 *resp_len = 1;
6164 return NULL;
6165 }
6166
6167 os_memcpy(reply, "OK\n", 3);
6168 reply_len = 3;
6169
6170 if (os_strcmp(buf, "PING") == 0) {
6171 os_memcpy(reply, "PONG\n", 5);
6172 reply_len = 5;
6173 } else if (os_strncmp(buf, "INTERFACE_ADD ", 14) == 0) {
6174 if (wpa_supplicant_global_iface_add(global, buf + 14))
6175 reply_len = -1;
6176 } else if (os_strncmp(buf, "INTERFACE_REMOVE ", 17) == 0) {
6177 if (wpa_supplicant_global_iface_remove(global, buf + 17))
6178 reply_len = -1;
6179 } else if (os_strcmp(buf, "INTERFACE_LIST") == 0) {
6180 reply_len = wpa_supplicant_global_iface_list(
6181 global, reply, reply_size);
6182 } else if (os_strcmp(buf, "INTERFACES") == 0) {
6183 reply_len = wpa_supplicant_global_iface_interfaces(
6184 global, reply, reply_size);
6185 } else if (os_strcmp(buf, "TERMINATE") == 0) {
6186 wpa_supplicant_terminate_proc(global);
6187 } else if (os_strcmp(buf, "SUSPEND") == 0) {
6188 wpas_notify_suspend(global);
6189 } else if (os_strcmp(buf, "RESUME") == 0) {
6190 wpas_notify_resume(global);
6191 } else if (os_strncmp(buf, "SET ", 4) == 0) {
6192 if (wpas_global_ctrl_iface_set(global, buf + 4))
6193 reply_len = -1;
6194 #ifndef CONFIG_NO_CONFIG_WRITE
6195 } else if (os_strcmp(buf, "SAVE_CONFIG") == 0) {
6196 if (wpas_global_ctrl_iface_save_config(global))
6197 reply_len = -1;
6198 #endif /* CONFIG_NO_CONFIG_WRITE */
6199 } else if (os_strcmp(buf, "STATUS") == 0) {
6200 reply_len = wpas_global_ctrl_iface_status(global, reply,
6201 reply_size);
6202 } else {
6203 os_memcpy(reply, "UNKNOWN COMMAND\n", 16);
6204 reply_len = 16;
6205 }
6206
6207 if (reply_len < 0) {
6208 os_memcpy(reply, "FAIL\n", 5);
6209 reply_len = 5;
6210 }
6211
6212 *resp_len = reply_len;
6213 return reply;
6214 }
Unnamed repository; edit this file 'description' to name the repository.