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