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