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