]> 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
nl80211: Mark VHT 80 MHz channels
[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{
af8a827b 4354 unsigned int i;
6f3bc72b
JM		 4355
4356 if (wpa_s->global->p2p == NULL)
4357 return -1;
4358
af8a827b
JM		 4359 if (freq_range_list_parse(&wpa_s->global->p2p_disallow_freq, param) < 0)
4360 return -1;
6f3bc72b 4361
af8a827b
JM		 4362 for (i = 0; i < wpa_s->global->p2p_disallow_freq.num; i++) {
4363 struct wpa_freq_range *freq;
4364 freq = &wpa_s->global->p2p_disallow_freq.range[i];
6f3bc72b 4365 wpa_printf(MSG_DEBUG, "P2P: Disallowed frequency range %u-%u",
af8a827b 4366 freq->min, freq->max);
6f3bc72b
JM		 4367 }
4368
6f3bc72b
JM		 4369 wpas_p2p_update_channel_list(wpa_s);
4370 return 0;
4371}
4372
4373
b563b388
JM		 4374static int p2p_ctrl_set(struct wpa_supplicant *wpa_s, char *cmd)
4375{
4376 char *param;
4377
4378 if (wpa_s->global->p2p == NULL)
4379 return -1;
4380
4381 param = os_strchr(cmd, ' ');
4382 if (param == NULL)
4383 return -1;
4384 *param++ = '\0';
4385
4386 if (os_strcmp(cmd, "discoverability") == 0) {
4387 p2p_set_client_discoverability(wpa_s->global->p2p,
4388 atoi(param));
4389 return 0;
4390 }
4391
4392 if (os_strcmp(cmd, "managed") == 0) {
4393 p2p_set_managed_oper(wpa_s->global->p2p, atoi(param));
4394 return 0;
4395 }
4396
4397 if (os_strcmp(cmd, "listen_channel") == 0) {
4398 return p2p_set_listen_channel(wpa_s->global->p2p, 81,
4399 atoi(param));
4400 }
4401
4402 if (os_strcmp(cmd, "ssid_postfix") == 0) {
4403 return p2p_set_ssid_postfix(wpa_s->global->p2p, (u8 *) param,
4404 os_strlen(param));
4405 }
4406
4407 if (os_strcmp(cmd, "noa") == 0) {
4408 char *pos;
4409 int count, start, duration;
4410 /* GO NoA parameters: count,start_offset(ms),duration(ms) */
4411 count = atoi(param);
4412 pos = os_strchr(param, ',');
4413 if (pos == NULL)
4414 return -1;
4415 pos++;
4416 start = atoi(pos);
4417 pos = os_strchr(pos, ',');
4418 if (pos == NULL)
4419 return -1;
4420 pos++;
4421 duration = atoi(pos);
4422 if (count < 0 || count > 255 || start < 0 || duration < 0)
4423 return -1;
4424 if (count == 0 && duration > 0)
4425 return -1;
4426 wpa_printf(MSG_DEBUG, "CTRL_IFACE: P2P_SET GO NoA: count=%d "
4427 "start=%d duration=%d", count, start, duration);
aefb53bd 4428 return wpas_p2p_set_noa(wpa_s, count, start, duration);
b563b388
JM		 4429 }
4430
c381508d
JM		 4431 if (os_strcmp(cmd, "ps") == 0)
4432 return wpa_drv_set_p2p_powersave(wpa_s, atoi(param), -1, -1);
4433
4434 if (os_strcmp(cmd, "oppps") == 0)
4435 return wpa_drv_set_p2p_powersave(wpa_s, -1, atoi(param), -1);
4436
4437 if (os_strcmp(cmd, "ctwindow") == 0)
4438 return wpa_drv_set_p2p_powersave(wpa_s, -1, -1, atoi(param));
4439
b563b388
JM		 4440 if (os_strcmp(cmd, "disabled") == 0) {
4441 wpa_s->global->p2p_disabled = atoi(param);
4442 wpa_printf(MSG_DEBUG, "P2P functionality %s",
4443 wpa_s->global->p2p_disabled ?
4444 "disabled" : "enabled");
4445 if (wpa_s->global->p2p_disabled) {
4446 wpas_p2p_stop_find(wpa_s);
108def93 4447 os_memset(wpa_s->p2p_auth_invite, 0, ETH_ALEN);
b563b388
JM		 4448 p2p_flush(wpa_s->global->p2p);
4449 }
4450 return 0;
4451 }
4452
b9cfc09a
JJ		 4453 if (os_strcmp(cmd, "conc_pref") == 0) {
4454 if (os_strcmp(param, "sta") == 0)
4455 wpa_s->global->conc_pref = WPA_CONC_PREF_STA;
4456 else if (os_strcmp(param, "p2p") == 0)
4457 wpa_s->global->conc_pref = WPA_CONC_PREF_P2P;
4458 else {
4459 wpa_printf(MSG_INFO, "Invalid conc_pref value");
4460 return -1;
4461 }
4462 wpa_printf(MSG_DEBUG, "Single channel concurrency preference: "
4463 "%s", param);
4464 return 0;
4465 }
4466
6e6963ea
JM		 4467 if (os_strcmp(cmd, "force_long_sd") == 0) {
4468 wpa_s->force_long_sd = atoi(param);
4469 return 0;
4470 }
4471
80c9582a
JM		 4472 if (os_strcmp(cmd, "peer_filter") == 0) {
4473 u8 addr[ETH_ALEN];
4474 if (hwaddr_aton(param, addr))
4475 return -1;
4476 p2p_set_peer_filter(wpa_s->global->p2p, addr);
4477 return 0;
4478 }
4479
72044390
JM		 4480 if (os_strcmp(cmd, "cross_connect") == 0)
4481 return wpas_p2p_set_cross_connect(wpa_s, atoi(param));
4482
eea2fd9e
JM		 4483 if (os_strcmp(cmd, "go_apsd") == 0) {
4484 if (os_strcmp(param, "disable") == 0)
4485 wpa_s->set_ap_uapsd = 0;
4486 else {
4487 wpa_s->set_ap_uapsd = 1;
4488 wpa_s->ap_uapsd = atoi(param);
4489 }
4490 return 0;
4491 }
4492
4493 if (os_strcmp(cmd, "client_apsd") == 0) {
4494 if (os_strcmp(param, "disable") == 0)
4495 wpa_s->set_sta_uapsd = 0;
4496 else {
4497 int be, bk, vi, vo;
4498 char *pos;
4499 /* format: BE,BK,VI,VO;max SP Length */
4500 be = atoi(param);
4501 pos = os_strchr(param, ',');
4502 if (pos == NULL)
4503 return -1;
4504 pos++;
4505 bk = atoi(pos);
4506 pos = os_strchr(pos, ',');
4507 if (pos == NULL)
4508 return -1;
4509 pos++;
4510 vi = atoi(pos);
4511 pos = os_strchr(pos, ',');
4512 if (pos == NULL)
4513 return -1;
4514 pos++;
4515 vo = atoi(pos);
4516 /* ignore max SP Length for now */
4517
4518 wpa_s->set_sta_uapsd = 1;
4519 wpa_s->sta_uapsd = 0;
4520 if (be)
4521 wpa_s->sta_uapsd |= BIT(0);
4522 if (bk)
4523 wpa_s->sta_uapsd |= BIT(1);
4524 if (vi)
4525 wpa_s->sta_uapsd |= BIT(2);
4526 if (vo)
4527 wpa_s->sta_uapsd |= BIT(3);
4528 }
4529 return 0;
4530 }
4531
6f3bc72b
JM		 4532 if (os_strcmp(cmd, "disallow_freq") == 0)
4533 return p2p_ctrl_disallow_freq(wpa_s, param);
4534
96beff11
JM		 4535 if (os_strcmp(cmd, "disc_int") == 0) {
4536 int min_disc_int, max_disc_int, max_disc_tu;
4537 char *pos;
4538
4539 pos = param;
4540
4541 min_disc_int = atoi(pos);
4542 pos = os_strchr(pos, ' ');
4543 if (pos == NULL)
4544 return -1;
4545 *pos++ = '\0';
4546
4547 max_disc_int = atoi(pos);
4548 pos = os_strchr(pos, ' ');
4549 if (pos == NULL)
4550 return -1;
4551 *pos++ = '\0';
4552
4553 max_disc_tu = atoi(pos);
4554
4555 return p2p_set_disc_int(wpa_s->global->p2p, min_disc_int,
4556 max_disc_int, max_disc_tu);
4557 }
4558
05766ed8
JM		 4559 if (os_strcmp(cmd, "per_sta_psk") == 0) {
4560 wpa_s->global->p2p_per_sta_psk = !!atoi(param);
4561 return 0;
4562 }
4563
b563b388
JM		 4564 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Unknown P2P_SET field value '%s'",
4565 cmd);
4566
4567 return -1;
4568}
4569
4570
acb54643
JM		 4571static void p2p_ctrl_flush(struct wpa_supplicant *wpa_s)
4572{
4573 os_memset(wpa_s->p2p_auth_invite, 0, ETH_ALEN);
4574 wpa_s->force_long_sd = 0;
4575 if (wpa_s->global->p2p)
4576 p2p_flush(wpa_s->global->p2p);
4577}
4578
4579
b563b388
JM		 4580static int p2p_ctrl_presence_req(struct wpa_supplicant *wpa_s, char *cmd)
4581{
4582 char *pos, *pos2;
4583 unsigned int dur1 = 0, int1 = 0, dur2 = 0, int2 = 0;
4584
4585 if (cmd[0]) {
4586 pos = os_strchr(cmd, ' ');
4587 if (pos == NULL)
4588 return -1;
4589 *pos++ = '\0';
4590 dur1 = atoi(cmd);
4591
4592 pos2 = os_strchr(pos, ' ');
4593 if (pos2)
4594 *pos2++ = '\0';
4595 int1 = atoi(pos);
4596 } else
4597 pos2 = NULL;
4598
4599 if (pos2) {
4600 pos = os_strchr(pos2, ' ');
4601 if (pos == NULL)
4602 return -1;
4603 *pos++ = '\0';
4604 dur2 = atoi(pos2);
4605 int2 = atoi(pos);
4606 }
4607
4608 return wpas_p2p_presence_req(wpa_s, dur1, int1, dur2, int2);
4609}
4610
4611
4612static int p2p_ctrl_ext_listen(struct wpa_supplicant *wpa_s, char *cmd)
4613{
4614 char *pos;
4615 unsigned int period = 0, interval = 0;
4616
4617 if (cmd[0]) {
4618 pos = os_strchr(cmd, ' ');
4619 if (pos == NULL)
4620 return -1;
4621 *pos++ = '\0';
4622 period = atoi(cmd);
4623 interval = atoi(pos);
4624 }
4625
4626 return wpas_p2p_ext_listen(wpa_s, period, interval);
4627}
4628
f2c56602
JM		 4629
4630static int p2p_ctrl_remove_client(struct wpa_supplicant *wpa_s, const char *cmd)
4631{
4632 const char *pos;
4633 u8 peer[ETH_ALEN];
4634 int iface_addr = 0;
4635
4636 pos = cmd;
4637 if (os_strncmp(pos, "iface=", 6) == 0) {
4638 iface_addr = 1;
4639 pos += 6;
4640 }
4641 if (hwaddr_aton(pos, peer))
4642 return -1;
4643
4644 wpas_p2p_remove_client(wpa_s, peer, iface_addr);
4645 return 0;
4646}
4647
b563b388
JM		 4648#endif /* CONFIG_P2P */
4649
4650
afc064fe 4651#ifdef CONFIG_INTERWORKING
b02fe7ff
JM		 4652static int ctrl_interworking_connect(struct wpa_supplicant *wpa_s, char *dst)
4653{
4654 u8 bssid[ETH_ALEN];
4655 struct wpa_bss *bss;
4656
4657 if (hwaddr_aton(dst, bssid)) {
4658 wpa_printf(MSG_DEBUG, "Invalid BSSID '%s'", dst);
4659 return -1;
4660 }
4661
4662 bss = wpa_bss_get_bssid(wpa_s, bssid);
4663 if (bss == NULL) {
4664 wpa_printf(MSG_DEBUG, "Could not find BSS " MACSTR,
4665 MAC2STR(bssid));
4666 return -1;
4667 }
4668
4669 return interworking_connect(wpa_s, bss);
4670}
4671
4672
afc064fe
JM		 4673static int get_anqp(struct wpa_supplicant *wpa_s, char *dst)
4674{
4675 u8 dst_addr[ETH_ALEN];
4676 int used;
4677 char *pos;
4678#define MAX_ANQP_INFO_ID 100
4679 u16 id[MAX_ANQP_INFO_ID];
4680 size_t num_id = 0;
4681
4682 used = hwaddr_aton2(dst, dst_addr);
4683 if (used < 0)
4684 return -1;
4685 pos = dst + used;
4686 while (num_id < MAX_ANQP_INFO_ID) {
4687 id[num_id] = atoi(pos);
4688 if (id[num_id])
4689 num_id++;
4690 pos = os_strchr(pos + 1, ',');
4691 if (pos == NULL)
4692 break;
4693 pos++;
4694 }
4695
4696 if (num_id == 0)
4697 return -1;
4698
4699 return anqp_send_req(wpa_s, dst_addr, id, num_id);
4700}
b1f12296
JM		 4701
4702
4703static int gas_request(struct wpa_supplicant *wpa_s, char *cmd)
4704{
4705 u8 dst_addr[ETH_ALEN];
4706 struct wpabuf *advproto, *query = NULL;
4707 int used, ret = -1;
4708 char *pos, *end;
4709 size_t len;
4710
4711 used = hwaddr_aton2(cmd, dst_addr);
4712 if (used < 0)
4713 return -1;
4714
4715 pos = cmd + used;
4716 while (*pos == ' ')
4717 pos++;
4718
4719 /* Advertisement Protocol ID */
4720 end = os_strchr(pos, ' ');
4721 if (end)
4722 len = end - pos;
4723 else
4724 len = os_strlen(pos);
4725 if (len & 0x01)
4726 return -1;
4727 len /= 2;
4728 if (len == 0)
4729 return -1;
4730 advproto = wpabuf_alloc(len);
4731 if (advproto == NULL)
4732 return -1;
4733 if (hexstr2bin(pos, wpabuf_put(advproto, len), len) < 0)
4734 goto fail;
4735
4736 if (end) {
4737 /* Optional Query Request */
4738 pos = end + 1;
4739 while (*pos == ' ')
4740 pos++;
4741
4742 len = os_strlen(pos);
4743 if (len) {
4744 if (len & 0x01)
4745 goto fail;
4746 len /= 2;
4747 if (len == 0)
4748 goto fail;
4749 query = wpabuf_alloc(len);
4750 if (query == NULL)
4751 goto fail;
4752 if (hexstr2bin(pos, wpabuf_put(query, len), len) < 0)
4753 goto fail;
4754 }
4755 }
4756
4757 ret = gas_send_request(wpa_s, dst_addr, advproto, query);
4758
4759fail:
4760 wpabuf_free(advproto);
4761 wpabuf_free(query);
4762
4763 return ret;
4764}
4765
4766
4767static int gas_response_get(struct wpa_supplicant *wpa_s, char *cmd, char *buf,
4768 size_t buflen)
4769{
4770 u8 addr[ETH_ALEN];
4771 int dialog_token;
4772 int used;
4773 char *pos;
4774 size_t resp_len, start, requested_len;
4775
4776 if (!wpa_s->last_gas_resp)
4777 return -1;
4778
4779 used = hwaddr_aton2(cmd, addr);
4780 if (used < 0)
4781 return -1;
4782
4783 pos = cmd + used;
4784 while (*pos == ' ')
4785 pos++;
4786 dialog_token = atoi(pos);
4787
4788 if (os_memcmp(addr, wpa_s->last_gas_addr, ETH_ALEN) != 0 ||
4789 dialog_token != wpa_s->last_gas_dialog_token)
4790 return -1;
4791
4792 resp_len = wpabuf_len(wpa_s->last_gas_resp);
4793 start = 0;
4794 requested_len = resp_len;
4795
4796 pos = os_strchr(pos, ' ');
4797 if (pos) {
4798 start = atoi(pos);
4799 if (start > resp_len)
4800 return os_snprintf(buf, buflen, "FAIL-Invalid range");
4801 pos = os_strchr(pos, ',');
4802 if (pos == NULL)
4803 return -1;
4804 pos++;
4805 requested_len = atoi(pos);
4806 if (start + requested_len > resp_len)
4807 return os_snprintf(buf, buflen, "FAIL-Invalid range");
4808 }
4809
4810 if (requested_len * 2 + 1 > buflen)
4811 return os_snprintf(buf, buflen, "FAIL-Too long response");
4812
4813 return wpa_snprintf_hex(buf, buflen,
4814 wpabuf_head_u8(wpa_s->last_gas_resp) + start,
4815 requested_len);
4816}
afc064fe
JM		 4817#endif /* CONFIG_INTERWORKING */
4818
4819
a8918e86
JK		 4820#ifdef CONFIG_HS20
4821
4822static int get_hs20_anqp(struct wpa_supplicant *wpa_s, char *dst)
4823{
4824 u8 dst_addr[ETH_ALEN];
4825 int used;
4826 char *pos;
4827 u32 subtypes = 0;
4828
4829 used = hwaddr_aton2(dst, dst_addr);
4830 if (used < 0)
4831 return -1;
4832 pos = dst + used;
4833 for (;;) {
4834 int num = atoi(pos);
4835 if (num <= 0 || num > 31)
4836 return -1;
4837 subtypes |= BIT(num);
4838 pos = os_strchr(pos + 1, ',');
4839 if (pos == NULL)
4840 break;
4841 pos++;
4842 }
4843
4844 if (subtypes == 0)
4845 return -1;
4846
4847 return hs20_anqp_send_req(wpa_s, dst_addr, subtypes, NULL, 0);
4848}
4849
4850
4851static int hs20_nai_home_realm_list(struct wpa_supplicant *wpa_s,
4852 const u8 *addr, const char *realm)
4853{
4854 u8 *buf;
4855 size_t rlen, len;
4856 int ret;
4857
4858 rlen = os_strlen(realm);
4859 len = 3 + rlen;
4860 buf = os_malloc(len);
4861 if (buf == NULL)
4862 return -1;
4863 buf[0] = 1; /* NAI Home Realm Count */
4864 buf[1] = 0; /* Formatted in accordance with RFC 4282 */
4865 buf[2] = rlen;
4866 os_memcpy(buf + 3, realm, rlen);
4867
4868 ret = hs20_anqp_send_req(wpa_s, addr,
4869 BIT(HS20_STYPE_NAI_HOME_REALM_QUERY),
4870 buf, len);
4871
4872 os_free(buf);
4873
4874 return ret;
4875}
4876
4877
4878static int hs20_get_nai_home_realm_list(struct wpa_supplicant *wpa_s,
4879 char *dst)
4880{
4881 struct wpa_cred *cred = wpa_s->conf->cred;
4882 u8 dst_addr[ETH_ALEN];
4883 int used;
4884 u8 *buf;
4885 size_t len;
4886 int ret;
4887
4888 used = hwaddr_aton2(dst, dst_addr);
4889 if (used < 0)
4890 return -1;
4891
4892 while (dst[used] == ' ')
4893 used++;
4894 if (os_strncmp(dst + used, "realm=", 6) == 0)
4895 return hs20_nai_home_realm_list(wpa_s, dst_addr,
4896 dst + used + 6);
4897
4898 len = os_strlen(dst + used);
4899
4900 if (len == 0 && cred && cred->realm)
4901 return hs20_nai_home_realm_list(wpa_s, dst_addr, cred->realm);
4902
4903 if (len % 1)
4904 return -1;
4905 len /= 2;
4906 buf = os_malloc(len);
4907 if (buf == NULL)
4908 return -1;
4909 if (hexstr2bin(dst + used, buf, len) < 0) {
4910 os_free(buf);
4911 return -1;
4912 }
4913
4914 ret = hs20_anqp_send_req(wpa_s, dst_addr,
4915 BIT(HS20_STYPE_NAI_HOME_REALM_QUERY),
4916 buf, len);
4917 os_free(buf);
4918
4919 return ret;
4920}
4921
4922#endif /* CONFIG_HS20 */
4923
4924
0d0a8ca1
AC		 4925static int wpa_supplicant_ctrl_iface_sta_autoconnect(
4926 struct wpa_supplicant *wpa_s, char *cmd)
4927{
4928 wpa_s->auto_reconnect_disabled = atoi(cmd) == 0 ? 1 : 0;
4929 return 0;
4930}
4931
4932
bc5d330a
TB		 4933#ifdef CONFIG_AUTOSCAN
4934
4935static int wpa_supplicant_ctrl_iface_autoscan(struct wpa_supplicant *wpa_s,
4936 char *cmd)
4937{
4938 enum wpa_states state = wpa_s->wpa_state;
4939 char *new_params = NULL;
4940
4941 if (os_strlen(cmd) > 0) {
4942 new_params = os_strdup(cmd);
4943 if (new_params == NULL)
4944 return -1;
4945 }
4946
4947 os_free(wpa_s->conf->autoscan);
4948 wpa_s->conf->autoscan = new_params;
4949
4950 if (wpa_s->conf->autoscan == NULL)
4951 autoscan_deinit(wpa_s);
4952 else if (state == WPA_DISCONNECTED || state == WPA_INACTIVE)
99218999 4953 autoscan_init(wpa_s, 1);
99f00324
JM		 4954 else if (state == WPA_SCANNING)
4955 wpa_supplicant_reinit_autoscan(wpa_s);
bc5d330a
TB		 4956
4957 return 0;
4958}
4959
4960#endif /* CONFIG_AUTOSCAN */
4961
4962
e9199e31
JM		 4963#ifdef CONFIG_WNM
4964
4965static int wpas_ctrl_iface_wnm_sleep(struct wpa_supplicant *wpa_s, char *cmd)
4966{
4967 int enter;
4968 int intval = 0;
4969 char *pos;
cd0ef657
JM		 4970 int ret;
4971 struct wpabuf *tfs_req = NULL;
e9199e31
JM		 4972
4973 if (os_strncmp(cmd, "enter", 5) == 0)
4974 enter = 1;
4975 else if (os_strncmp(cmd, "exit", 4) == 0)
4976 enter = 0;
4977 else
4978 return -1;
4979
4980 pos = os_strstr(cmd, " interval=");
4981 if (pos)
4982 intval = atoi(pos + 10);
4983
cd0ef657
JM		 4984 pos = os_strstr(cmd, " tfs_req=");
4985 if (pos) {
4986 char *end;
4987 size_t len;
4988 pos += 9;
4989 end = os_strchr(pos, ' ');
4990 if (end)
4991 len = end - pos;
4992 else
4993 len = os_strlen(pos);
4994 if (len & 1)
4995 return -1;
4996 len /= 2;
4997 tfs_req = wpabuf_alloc(len);
4998 if (tfs_req == NULL)
4999 return -1;
5000 if (hexstr2bin(pos, wpabuf_put(tfs_req, len), len) < 0) {
5001 wpabuf_free(tfs_req);
5002 return -1;
5003 }
5004 }
5005
df80a0cc
JM		 5006 ret = ieee802_11_send_wnmsleep_req(wpa_s, enter ? WNM_SLEEP_MODE_ENTER :
5007 WNM_SLEEP_MODE_EXIT, intval,
cd0ef657
JM		 5008 tfs_req);
5009 wpabuf_free(tfs_req);
5010
5011 return ret;
e9199e31
JM		 5012}
5013
65bcd0a9
VK		 5014
5015static int wpas_ctrl_iface_wnm_bss_query(struct wpa_supplicant *wpa_s, char *cmd)
5016{
5017 int query_reason;
5018
5019 query_reason = atoi(cmd);
5020
5021 wpa_printf(MSG_DEBUG, "CTRL_IFACE: WNM_BSS_QUERY query_reason=%d",
5022 query_reason);
5023
5024 return wnm_send_bss_transition_mgmt_query(wpa_s, query_reason);
5025}
5026
e9199e31
JM		 5027#endif /* CONFIG_WNM */
5028
5029
2cc8d8f4
AO		 5030/* Get string representation of channel width */
5031static const char * channel_width_name(enum chan_width width)
5032{
5033 switch (width) {
5034 case CHAN_WIDTH_20_NOHT:
5035 return "20 MHz (no HT)";
5036 case CHAN_WIDTH_20:
5037 return "20 MHz";
5038 case CHAN_WIDTH_40:
5039 return "40 MHz";
5040 case CHAN_WIDTH_80:
5041 return "80 MHz";
5042 case CHAN_WIDTH_80P80:
5043 return "80+80 MHz";
5044 case CHAN_WIDTH_160:
5045 return "160 MHz";
5046 default:
5047 return "unknown";
5048 }
5049}
5050
5051
60b24b0d
DS		 5052static int wpa_supplicant_signal_poll(struct wpa_supplicant *wpa_s, char *buf,
5053 size_t buflen)
5054{
5055 struct wpa_signal_info si;
5056 int ret;
2cc8d8f4 5057 char *pos, *end;
60b24b0d
DS		 5058
5059 ret = wpa_drv_signal_poll(wpa_s, &si);
5060 if (ret)
5061 return -1;
5062
2cc8d8f4
AO		 5063 pos = buf;
5064 end = buf + buflen;
5065
5066 ret = os_snprintf(pos, end - pos, "RSSI=%d\nLINKSPEED=%d\n"
60b24b0d
DS		 5067 "NOISE=%d\nFREQUENCY=%u\n",
5068 si.current_signal, si.current_txrate / 1000,
5069 si.current_noise, si.frequency);
2cc8d8f4 5070 if (ret < 0 || ret > end - pos)
60b24b0d 5071 return -1;
2cc8d8f4
AO		 5072 pos += ret;
5073
5074 if (si.chanwidth != CHAN_WIDTH_UNKNOWN) {
5075 ret = os_snprintf(pos, end - pos, "WIDTH=%s\n",
5076 channel_width_name(si.chanwidth));
5077 if (ret < 0 || ret > end - pos)
5078 return -1;
5079 pos += ret;
5080 }
5081
5082 if (si.center_frq1 > 0 && si.center_frq2 > 0) {
5083 ret = os_snprintf(pos, end - pos,
5084 "CENTER_FRQ1=%d\nCENTER_FRQ2=%d\n",
5085 si.center_frq1, si.center_frq2);
5086 if (ret < 0 || ret > end - pos)
5087 return -1;
5088 pos += ret;
5089 }
5090
95783298
AO		 5091 if (si.avg_signal) {
5092 ret = os_snprintf(pos, end - pos,
5093 "AVG_RSSI=%d\n", si.avg_signal);
5094 if (ret < 0 || ret >= end - pos)
5095 return -1;
5096 pos += ret;
5097 }
5098
2cc8d8f4 5099 return pos - buf;
60b24b0d
DS		 5100}
5101
5102
dc7785f8
YZ		 5103static int wpa_supplicant_pktcnt_poll(struct wpa_supplicant *wpa_s, char *buf,
5104 size_t buflen)
5105{
5106 struct hostap_sta_driver_data sta;
5107 int ret;
5108
5109 ret = wpa_drv_pktcnt_poll(wpa_s, &sta);
5110 if (ret)
5111 return -1;
5112
5113 ret = os_snprintf(buf, buflen, "TXGOOD=%lu\nTXBAD=%lu\nRXGOOD=%lu\n",
5114 sta.tx_packets, sta.tx_retry_failed, sta.rx_packets);
5115 if (ret < 0 || (size_t) ret > buflen)
5116 return -1;
5117 return ret;
5118}
5119
5120
acb54643
JM		 5121static void wpa_supplicant_ctrl_iface_flush(struct wpa_supplicant *wpa_s)
5122{
5123 wpa_dbg(wpa_s, MSG_DEBUG, "Flush all wpa_supplicant state");
5124
5125#ifdef CONFIG_P2P
5126 wpas_p2p_stop_find(wpa_s);
5127 p2p_ctrl_flush(wpa_s);
5128 wpas_p2p_group_remove(wpa_s, "*");
5129#endif /* CONFIG_P2P */
5130
5131#ifdef CONFIG_WPS_TESTING
5132 wps_version_number = 0x20;
5133 wps_testing_dummy_cred = 0;
5134#endif /* CONFIG_WPS_TESTING */
5135#ifdef CONFIG_WPS
5136 wpas_wps_cancel(wpa_s);
5137#endif /* CONFIG_WPS */
7255983b 5138 wpa_s->after_wps = 0;
4d9fb08d 5139 wpa_s->known_wps_freq = 0;
acb54643
JM		 5140
5141#ifdef CONFIG_TDLS_TESTING
5142 extern unsigned int tdls_testing;
5143 tdls_testing = 0;
5144#endif /* CONFIG_TDLS_TESTING */
5145#ifdef CONFIG_TDLS
5146 wpa_drv_tdls_oper(wpa_s, TDLS_ENABLE, NULL);
5147 wpa_tdls_enable(wpa_s->wpa, 1);
5148#endif /* CONFIG_TDLS */
5149
e78aaca0
JM		 5150 eloop_cancel_timeout(wpa_supplicant_stop_countermeasures, wpa_s, NULL);
5151 wpa_supplicant_stop_countermeasures(wpa_s, NULL);
5152
acb54643
JM		 5153 wpa_s->no_keep_alive = 0;
5154
5155 os_free(wpa_s->disallow_aps_bssid);
5156 wpa_s->disallow_aps_bssid = NULL;
5157 wpa_s->disallow_aps_bssid_count = 0;
5158 os_free(wpa_s->disallow_aps_ssid);
5159 wpa_s->disallow_aps_ssid = NULL;
5160 wpa_s->disallow_aps_ssid_count = 0;
5161
5162 wpa_s->set_sta_uapsd = 0;
5163 wpa_s->sta_uapsd = 0;
5164
5165 wpa_drv_radio_disable(wpa_s, 0);
5166
5167 wpa_bss_flush(wpa_s);
5168 wpa_blacklist_clear(wpa_s);
a8a7890d 5169 wpa_s->extra_blacklist_count = 0;
acb54643
JM		 5170 wpa_supplicant_ctrl_iface_remove_network(wpa_s, "all");
5171 wpa_supplicant_ctrl_iface_remove_cred(wpa_s, "all");
5172}
5173
5174
bceb8431
JM		 5175static void wpas_ctrl_eapol_response(void *eloop_ctx, void *timeout_ctx)
5176{
5177 struct wpa_supplicant *wpa_s = eloop_ctx;
5178 eapol_sm_notify_ctrl_response(wpa_s->eapol);
5179}
5180
5181
6fc6879b
JM		 5182char * wpa_supplicant_ctrl_iface_process(struct wpa_supplicant *wpa_s,
5183 char *buf, size_t *resp_len)
5184{
5185 char *reply;
b563b388 5186 const int reply_size = 4096;
6fc6879b
JM		 5187 int reply_len;
5188
5189 if (os_strncmp(buf, WPA_CTRL_RSP, os_strlen(WPA_CTRL_RSP)) == 0 ||
e65552dd
JM		 5190 os_strncmp(buf, "SET_NETWORK ", 12) == 0 ||
5191 os_strncmp(buf, "WPS_NFC_TAG_READ", 16) == 0 ||
e4758827 5192 os_strncmp(buf, "NFC_REPORT_HANDOVER", 19) == 0 ||
e65552dd 5193 os_strncmp(buf, "NFC_RX_HANDOVER_SEL", 19) == 0) {
6fc6879b
JM		 5194 wpa_hexdump_ascii_key(MSG_DEBUG, "RX ctrl_iface",
5195 (const u8 *) buf, os_strlen(buf));
5196 } else {
235f69fc
JM		 5197 int level = MSG_DEBUG;
5198 if (os_strcmp(buf, "PING") == 0)
5199 level = MSG_EXCESSIVE;
5200 wpa_hexdump_ascii(level, "RX ctrl_iface",
6fc6879b 5201 (const u8 *) buf, os_strlen(buf));
b470b2bf 5202 wpa_dbg(wpa_s, level, "Control interface command '%s'", buf);
6fc6879b
JM		 5203 }
5204
5205 reply = os_malloc(reply_size);
5206 if (reply == NULL) {
5207 *resp_len = 1;
5208 return NULL;
5209 }
5210
5211 os_memcpy(reply, "OK\n", 3);
5212 reply_len = 3;
5213
5214 if (os_strcmp(buf, "PING") == 0) {
5215 os_memcpy(reply, "PONG\n", 5);
5216 reply_len = 5;
0eed2a8d
JD		 5217 } else if (os_strcmp(buf, "IFNAME") == 0) {
5218 reply_len = os_strlen(wpa_s->ifname);
5219 os_memcpy(reply, wpa_s->ifname, reply_len);
ac6912b5
BG		 5220 } else if (os_strncmp(buf, "RELOG", 5) == 0) {
5221 if (wpa_debug_reopen_file() < 0)
5222 reply_len = -1;
77895cd9
JM		 5223 } else if (os_strncmp(buf, "NOTE ", 5) == 0) {
5224 wpa_printf(MSG_INFO, "NOTE: %s", buf + 5);
6fc6879b
JM		 5225 } else if (os_strcmp(buf, "MIB") == 0) {
5226 reply_len = wpa_sm_get_mib(wpa_s->wpa, reply, reply_size);
5227 if (reply_len >= 0) {
5228 int res;
5229 res = eapol_sm_get_mib(wpa_s->eapol, reply + reply_len,
5230 reply_size - reply_len);
5231 if (res < 0)
5232 reply_len = -1;
5233 else
5234 reply_len += res;
5235 }
5236 } else if (os_strncmp(buf, "STATUS", 6) == 0) {
5237 reply_len = wpa_supplicant_ctrl_iface_status(
5238 wpa_s, buf + 6, reply, reply_size);
5239 } else if (os_strcmp(buf, "PMKSA") == 0) {
540264a7
JM		 5240 reply_len = wpa_sm_pmksa_cache_list(wpa_s->wpa, reply,
5241 reply_size);
6fc6879b
JM		 5242 } else if (os_strncmp(buf, "SET ", 4) == 0) {
5243 if (wpa_supplicant_ctrl_iface_set(wpa_s, buf + 4))
5244 reply_len = -1;
acec8d32
JM		 5245 } else if (os_strncmp(buf, "GET ", 4) == 0) {
5246 reply_len = wpa_supplicant_ctrl_iface_get(wpa_s, buf + 4,
5247 reply, reply_size);
6fc6879b
JM		 5248 } else if (os_strcmp(buf, "LOGON") == 0) {
5249 eapol_sm_notify_logoff(wpa_s->eapol, FALSE);
5250 } else if (os_strcmp(buf, "LOGOFF") == 0) {
5251 eapol_sm_notify_logoff(wpa_s->eapol, TRUE);
5252 } else if (os_strcmp(buf, "REASSOCIATE") == 0) {
8401a6b0
JM		 5253 if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
5254 reply_len = -1;
9796a86c
JM		 5255 else
5256 wpas_request_connection(wpa_s);
6fc6879b 5257 } else if (os_strcmp(buf, "RECONNECT") == 0) {
8401a6b0
JM		 5258 if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
5259 reply_len = -1;
9796a86c
JM		 5260 else if (wpa_s->disconnected)
5261 wpas_request_connection(wpa_s);
ec717917 5262#ifdef IEEE8021X_EAPOL
6fc6879b
JM		 5263 } else if (os_strncmp(buf, "PREAUTH ", 8) == 0) {
5264 if (wpa_supplicant_ctrl_iface_preauth(wpa_s, buf + 8))
5265 reply_len = -1;
ec717917 5266#endif /* IEEE8021X_EAPOL */
6fc6879b
JM		 5267#ifdef CONFIG_PEERKEY
5268 } else if (os_strncmp(buf, "STKSTART ", 9) == 0) {
5269 if (wpa_supplicant_ctrl_iface_stkstart(wpa_s, buf + 9))
5270 reply_len = -1;
5271#endif /* CONFIG_PEERKEY */
5272#ifdef CONFIG_IEEE80211R
5273 } else if (os_strncmp(buf, "FT_DS ", 6) == 0) {
5274 if (wpa_supplicant_ctrl_iface_ft_ds(wpa_s, buf + 6))
5275 reply_len = -1;
5276#endif /* CONFIG_IEEE80211R */
fcc60db4
JM		 5277#ifdef CONFIG_WPS
5278 } else if (os_strcmp(buf, "WPS_PBC") == 0) {
3152ff42
CWY		 5279 int res = wpa_supplicant_ctrl_iface_wps_pbc(wpa_s, NULL);
5280 if (res == -2) {
5281 os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
5282 reply_len = 17;
5283 } else if (res)
fcc60db4
JM		 5284 reply_len = -1;
5285 } else if (os_strncmp(buf, "WPS_PBC ", 8) == 0) {
3152ff42
CWY		 5286 int res = wpa_supplicant_ctrl_iface_wps_pbc(wpa_s, buf + 8);
5287 if (res == -2) {
5288 os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
5289 reply_len = 17;
5290 } else if (res)
fcc60db4
JM		 5291 reply_len = -1;
5292 } else if (os_strncmp(buf, "WPS_PIN ", 8) == 0) {
5293 reply_len = wpa_supplicant_ctrl_iface_wps_pin(wpa_s, buf + 8,
5294 reply,
5295 reply_size);
3981cb3c
JM		 5296 } else if (os_strncmp(buf, "WPS_CHECK_PIN ", 14) == 0) {
5297 reply_len = wpa_supplicant_ctrl_iface_wps_check_pin(
5298 wpa_s, buf + 14, reply, reply_size);
2f9929ff
AC		 5299 } else if (os_strcmp(buf, "WPS_CANCEL") == 0) {
5300 if (wpas_wps_cancel(wpa_s))
5301 reply_len = -1;
71892384 5302#ifdef CONFIG_WPS_NFC
3f2c8ba6
JM		 5303 } else if (os_strcmp(buf, "WPS_NFC") == 0) {
5304 if (wpa_supplicant_ctrl_iface_wps_nfc(wpa_s, NULL))
5305 reply_len = -1;
5306 } else if (os_strncmp(buf, "WPS_NFC ", 8) == 0) {
5307 if (wpa_supplicant_ctrl_iface_wps_nfc(wpa_s, buf + 8))
5308 reply_len = -1;
bbf41865
JM		 5309 } else if (os_strncmp(buf, "WPS_NFC_CONFIG_TOKEN ", 21) == 0) {
5310 reply_len = wpa_supplicant_ctrl_iface_wps_nfc_config_token(
5311 wpa_s, buf + 21, reply, reply_size);
3f2c8ba6
JM		 5312 } else if (os_strncmp(buf, "WPS_NFC_TOKEN ", 14) == 0) {
5313 reply_len = wpa_supplicant_ctrl_iface_wps_nfc_token(
5314 wpa_s, buf + 14, reply, reply_size);
d7645d23
JM		 5315 } else if (os_strncmp(buf, "WPS_NFC_TAG_READ ", 17) == 0) {
5316 if (wpa_supplicant_ctrl_iface_wps_nfc_tag_read(wpa_s,
5317 buf + 17))
5318 reply_len = -1;
e65552dd
JM		 5319 } else if (os_strncmp(buf, "NFC_GET_HANDOVER_REQ ", 21) == 0) {
5320 reply_len = wpas_ctrl_nfc_get_handover_req(
5321 wpa_s, buf + 21, reply, reply_size);
5322 } else if (os_strncmp(buf, "NFC_GET_HANDOVER_SEL ", 21) == 0) {
5323 reply_len = wpas_ctrl_nfc_get_handover_sel(
5324 wpa_s, buf + 21, reply, reply_size);
5325 } else if (os_strncmp(buf, "NFC_RX_HANDOVER_REQ ", 20) == 0) {
5326 reply_len = wpas_ctrl_nfc_rx_handover_req(
5327 wpa_s, buf + 20, reply, reply_size);
5328 } else if (os_strncmp(buf, "NFC_RX_HANDOVER_SEL ", 20) == 0) {
5329 if (wpas_ctrl_nfc_rx_handover_sel(wpa_s, buf + 20))
5330 reply_len = -1;
e4758827
JM		 5331 } else if (os_strncmp(buf, "NFC_REPORT_HANDOVER ", 20) == 0) {
5332 if (wpas_ctrl_nfc_report_handover(wpa_s, buf + 20))
5333 reply_len = -1;
71892384 5334#endif /* CONFIG_WPS_NFC */
fcc60db4
JM		 5335 } else if (os_strncmp(buf, "WPS_REG ", 8) == 0) {
5336 if (wpa_supplicant_ctrl_iface_wps_reg(wpa_s, buf + 8))
5337 reply_len = -1;
70d84f11
JM		 5338#ifdef CONFIG_AP
5339 } else if (os_strncmp(buf, "WPS_AP_PIN ", 11) == 0) {
5340 reply_len = wpa_supplicant_ctrl_iface_wps_ap_pin(
5341 wpa_s, buf + 11, reply, reply_size);
5342#endif /* CONFIG_AP */
72df2f5f 5343#ifdef CONFIG_WPS_ER
e9bcfebf 5344 } else if (os_strcmp(buf, "WPS_ER_START") == 0) {
08486685
JM		 5345 if (wpas_wps_er_start(wpa_s, NULL))
5346 reply_len = -1;
5347 } else if (os_strncmp(buf, "WPS_ER_START ", 13) == 0) {
5348 if (wpas_wps_er_start(wpa_s, buf + 13))
e9bcfebf
JM		 5349 reply_len = -1;
5350 } else if (os_strcmp(buf, "WPS_ER_STOP") == 0) {
5351 if (wpas_wps_er_stop(wpa_s))
5352 reply_len = -1;
72df2f5f
JM		 5353 } else if (os_strncmp(buf, "WPS_ER_PIN ", 11) == 0) {
5354 if (wpa_supplicant_ctrl_iface_wps_er_pin(wpa_s, buf + 11))
5355 reply_len = -1;
564cd7fa 5356 } else if (os_strncmp(buf, "WPS_ER_PBC ", 11) == 0) {
ed159ad4
JM		 5357 int ret = wpas_wps_er_pbc(wpa_s, buf + 11);
5358 if (ret == -2) {
5359 os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
5360 reply_len = 17;
5361 } else if (ret == -3) {
5362 os_memcpy(reply, "FAIL-UNKNOWN-UUID\n", 18);
5363 reply_len = 18;
5364 } else if (ret == -4) {
5365 os_memcpy(reply, "FAIL-NO-AP-SETTINGS\n", 20);
5366 reply_len = 20;
5367 } else if (ret)
564cd7fa 5368 reply_len = -1;
e64dcfd5
JM		 5369 } else if (os_strncmp(buf, "WPS_ER_LEARN ", 13) == 0) {
5370 if (wpa_supplicant_ctrl_iface_wps_er_learn(wpa_s, buf + 13))
5371 reply_len = -1;
ef10f473
JM		 5372 } else if (os_strncmp(buf, "WPS_ER_SET_CONFIG ", 18) == 0) {
5373 if (wpa_supplicant_ctrl_iface_wps_er_set_config(wpa_s,
5374 buf + 18))
5375 reply_len = -1;
7d6640a6
JM		 5376 } else if (os_strncmp(buf, "WPS_ER_CONFIG ", 14) == 0) {
5377 if (wpa_supplicant_ctrl_iface_wps_er_config(wpa_s, buf + 14))
5378 reply_len = -1;
1cea09a9
JM		 5379#ifdef CONFIG_WPS_NFC
5380 } else if (os_strncmp(buf, "WPS_ER_NFC_CONFIG_TOKEN ", 24) == 0) {
5381 reply_len = wpa_supplicant_ctrl_iface_wps_er_nfc_config_token(
5382 wpa_s, buf + 24, reply, reply_size);
5383#endif /* CONFIG_WPS_NFC */
72df2f5f 5384#endif /* CONFIG_WPS_ER */
fcc60db4 5385#endif /* CONFIG_WPS */
11ef8d35
JM		 5386#ifdef CONFIG_IBSS_RSN
5387 } else if (os_strncmp(buf, "IBSS_RSN ", 9) == 0) {
5388 if (wpa_supplicant_ctrl_iface_ibss_rsn(wpa_s, buf + 9))
5389 reply_len = -1;
5390#endif /* CONFIG_IBSS_RSN */
b563b388
JM		 5391#ifdef CONFIG_P2P
5392 } else if (os_strncmp(buf, "P2P_FIND ", 9) == 0) {
5393 if (p2p_ctrl_find(wpa_s, buf + 9))
5394 reply_len = -1;
5395 } else if (os_strcmp(buf, "P2P_FIND") == 0) {
5396 if (p2p_ctrl_find(wpa_s, ""))
5397 reply_len = -1;
5398 } else if (os_strcmp(buf, "P2P_STOP_FIND") == 0) {
5399 wpas_p2p_stop_find(wpa_s);
5400 } else if (os_strncmp(buf, "P2P_CONNECT ", 12) == 0) {
5401 reply_len = p2p_ctrl_connect(wpa_s, buf + 12, reply,
5402 reply_size);
5403 } else if (os_strncmp(buf, "P2P_LISTEN ", 11) == 0) {
5404 if (p2p_ctrl_listen(wpa_s, buf + 11))
5405 reply_len = -1;
5406 } else if (os_strcmp(buf, "P2P_LISTEN") == 0) {
5407 if (p2p_ctrl_listen(wpa_s, ""))
5408 reply_len = -1;
5409 } else if (os_strncmp(buf, "P2P_GROUP_REMOVE ", 17) == 0) {
5410 if (wpas_p2p_group_remove(wpa_s, buf + 17))
5411 reply_len = -1;
5412 } else if (os_strcmp(buf, "P2P_GROUP_ADD") == 0) {
7aeac985 5413 if (wpas_p2p_group_add(wpa_s, 0, 0, 0))
b563b388
JM		 5414 reply_len = -1;
5415 } else if (os_strncmp(buf, "P2P_GROUP_ADD ", 14) == 0) {
5416 if (p2p_ctrl_group_add(wpa_s, buf + 14))
5417 reply_len = -1;
5418 } else if (os_strncmp(buf, "P2P_PROV_DISC ", 14) == 0) {
5419 if (p2p_ctrl_prov_disc(wpa_s, buf + 14))
5420 reply_len = -1;
5421 } else if (os_strcmp(buf, "P2P_GET_PASSPHRASE") == 0) {
5422 reply_len = p2p_get_passphrase(wpa_s, reply, reply_size);
5423 } else if (os_strncmp(buf, "P2P_SERV_DISC_REQ ", 18) == 0) {
5424 reply_len = p2p_ctrl_serv_disc_req(wpa_s, buf + 18, reply,
5425 reply_size);
5426 } else if (os_strncmp(buf, "P2P_SERV_DISC_CANCEL_REQ ", 25) == 0) {
5427 if (p2p_ctrl_serv_disc_cancel_req(wpa_s, buf + 25) < 0)
5428 reply_len = -1;
5429 } else if (os_strncmp(buf, "P2P_SERV_DISC_RESP ", 19) == 0) {
5430 if (p2p_ctrl_serv_disc_resp(wpa_s, buf + 19) < 0)
5431 reply_len = -1;
5432 } else if (os_strcmp(buf, "P2P_SERVICE_UPDATE") == 0) {
5433 wpas_p2p_sd_service_update(wpa_s);
5434 } else if (os_strncmp(buf, "P2P_SERV_DISC_EXTERNAL ", 23) == 0) {
5435 if (p2p_ctrl_serv_disc_external(wpa_s, buf + 23) < 0)
5436 reply_len = -1;
5437 } else if (os_strcmp(buf, "P2P_SERVICE_FLUSH") == 0) {
5438 wpas_p2p_service_flush(wpa_s);
5439 } else if (os_strncmp(buf, "P2P_SERVICE_ADD ", 16) == 0) {
5440 if (p2p_ctrl_service_add(wpa_s, buf + 16) < 0)
5441 reply_len = -1;
5442 } else if (os_strncmp(buf, "P2P_SERVICE_DEL ", 16) == 0) {
5443 if (p2p_ctrl_service_del(wpa_s, buf + 16) < 0)
5444 reply_len = -1;
5445 } else if (os_strncmp(buf, "P2P_REJECT ", 11) == 0) {
5446 if (p2p_ctrl_reject(wpa_s, buf + 11) < 0)
5447 reply_len = -1;
5448 } else if (os_strncmp(buf, "P2P_INVITE ", 11) == 0) {
5449 if (p2p_ctrl_invite(wpa_s, buf + 11) < 0)
5450 reply_len = -1;
5451 } else if (os_strncmp(buf, "P2P_PEER ", 9) == 0) {
5452 reply_len = p2p_ctrl_peer(wpa_s, buf + 9, reply,
5453 reply_size);
5454 } else if (os_strncmp(buf, "P2P_SET ", 8) == 0) {
5455 if (p2p_ctrl_set(wpa_s, buf + 8) < 0)
5456 reply_len = -1;
5457 } else if (os_strcmp(buf, "P2P_FLUSH") == 0) {
acb54643 5458 p2p_ctrl_flush(wpa_s);
9d562b79
SS		 5459 } else if (os_strncmp(buf, "P2P_UNAUTHORIZE ", 16) == 0) {
5460 if (wpas_p2p_unauthorize(wpa_s, buf + 16) < 0)
5461 reply_len = -1;
59eba7a2
JM		 5462 } else if (os_strcmp(buf, "P2P_CANCEL") == 0) {
5463 if (wpas_p2p_cancel(wpa_s))
5464 reply_len = -1;
b563b388
JM		 5465 } else if (os_strncmp(buf, "P2P_PRESENCE_REQ ", 17) == 0) {
5466 if (p2p_ctrl_presence_req(wpa_s, buf + 17) < 0)
5467 reply_len = -1;
5468 } else if (os_strcmp(buf, "P2P_PRESENCE_REQ") == 0) {
5469 if (p2p_ctrl_presence_req(wpa_s, "") < 0)
5470 reply_len = -1;
5471 } else if (os_strncmp(buf, "P2P_EXT_LISTEN ", 15) == 0) {
5472 if (p2p_ctrl_ext_listen(wpa_s, buf + 15) < 0)
5473 reply_len = -1;
5474 } else if (os_strcmp(buf, "P2P_EXT_LISTEN") == 0) {
5475 if (p2p_ctrl_ext_listen(wpa_s, "") < 0)
5476 reply_len = -1;
f2c56602
JM		 5477 } else if (os_strncmp(buf, "P2P_REMOVE_CLIENT ", 18) == 0) {
5478 if (p2p_ctrl_remove_client(wpa_s, buf + 18) < 0)
5479 reply_len = -1;
b563b388 5480#endif /* CONFIG_P2P */
9675ce35
JM		 5481#ifdef CONFIG_WIFI_DISPLAY
5482 } else if (os_strncmp(buf, "WFD_SUBELEM_SET ", 16) == 0) {
5483 if (wifi_display_subelem_set(wpa_s->global, buf + 16) < 0)
5484 reply_len = -1;
5485 } else if (os_strncmp(buf, "WFD_SUBELEM_GET ", 16) == 0) {
5486 reply_len = wifi_display_subelem_get(wpa_s->global, buf + 16,
5487 reply, reply_size);
5488#endif /* CONFIG_WIFI_DISPLAY */
afc064fe
JM		 5489#ifdef CONFIG_INTERWORKING
5490 } else if (os_strcmp(buf, "FETCH_ANQP") == 0) {
5491 if (interworking_fetch_anqp(wpa_s) < 0)
5492 reply_len = -1;
5493 } else if (os_strcmp(buf, "STOP_FETCH_ANQP") == 0) {
5494 interworking_stop_fetch_anqp(wpa_s);
b02fe7ff
JM		 5495 } else if (os_strncmp(buf, "INTERWORKING_SELECT", 19) == 0) {
5496 if (interworking_select(wpa_s, os_strstr(buf + 19, "auto") !=
5497 NULL) < 0)
5498 reply_len = -1;
5499 } else if (os_strncmp(buf, "INTERWORKING_CONNECT ", 21) == 0) {
5500 if (ctrl_interworking_connect(wpa_s, buf + 21) < 0)
5501 reply_len = -1;
afc064fe
JM		 5502 } else if (os_strncmp(buf, "ANQP_GET ", 9) == 0) {
5503 if (get_anqp(wpa_s, buf + 9) < 0)
5504 reply_len = -1;
b1f12296
JM		 5505 } else if (os_strncmp(buf, "GAS_REQUEST ", 12) == 0) {
5506 if (gas_request(wpa_s, buf + 12) < 0)
5507 reply_len = -1;
5508 } else if (os_strncmp(buf, "GAS_RESPONSE_GET ", 17) == 0) {
5509 reply_len = gas_response_get(wpa_s, buf + 17, reply,
5510 reply_size);
afc064fe 5511#endif /* CONFIG_INTERWORKING */
a8918e86
JK		 5512#ifdef CONFIG_HS20
5513 } else if (os_strncmp(buf, "HS20_ANQP_GET ", 14) == 0) {
5514 if (get_hs20_anqp(wpa_s, buf + 14) < 0)
5515 reply_len = -1;
5516 } else if (os_strncmp(buf, "HS20_GET_NAI_HOME_REALM_LIST ", 29) == 0) {
5517 if (hs20_get_nai_home_realm_list(wpa_s, buf + 29) < 0)
5518 reply_len = -1;
5519#endif /* CONFIG_HS20 */
6fc6879b
JM		 5520 } else if (os_strncmp(buf, WPA_CTRL_RSP, os_strlen(WPA_CTRL_RSP)) == 0)
5521 {
5522 if (wpa_supplicant_ctrl_iface_ctrl_rsp(
5523 wpa_s, buf + os_strlen(WPA_CTRL_RSP)))
5524 reply_len = -1;
bceb8431
JM		 5525 else {
5526 /*
5527 * Notify response from timeout to allow the control
5528 * interface response to be sent first.
5529 */
5530 eloop_register_timeout(0, 0, wpas_ctrl_eapol_response,
5531 wpa_s, NULL);
5532 }
6fc6879b
JM		 5533 } else if (os_strcmp(buf, "RECONFIGURE") == 0) {
5534 if (wpa_supplicant_reload_configuration(wpa_s))
5535 reply_len = -1;
5536 } else if (os_strcmp(buf, "TERMINATE") == 0) {
1a1bf008 5537 wpa_supplicant_terminate_proc(wpa_s->global);
6fc6879b
JM		 5538 } else if (os_strncmp(buf, "BSSID ", 6) == 0) {
5539 if (wpa_supplicant_ctrl_iface_bssid(wpa_s, buf + 6))
5540 reply_len = -1;
9aa10e2b
DS		 5541 } else if (os_strncmp(buf, "BLACKLIST", 9) == 0) {
5542 reply_len = wpa_supplicant_ctrl_iface_blacklist(
5543 wpa_s, buf + 9, reply, reply_size);
0597a5b5
DS		 5544 } else if (os_strncmp(buf, "LOG_LEVEL", 9) == 0) {
5545 reply_len = wpa_supplicant_ctrl_iface_log_level(
5546 wpa_s, buf + 9, reply, reply_size);
6fc6879b
JM		 5547 } else if (os_strcmp(buf, "LIST_NETWORKS") == 0) {
5548 reply_len = wpa_supplicant_ctrl_iface_list_networks(
5549 wpa_s, reply, reply_size);
5550 } else if (os_strcmp(buf, "DISCONNECT") == 0) {
83df8149
JM		 5551#ifdef CONFIG_SME
5552 wpa_s->sme.prev_bssid_set = 0;
5553#endif /* CONFIG_SME */
6fc6879b
JM		 5554 wpa_s->reassociate = 0;
5555 wpa_s->disconnected = 1;
6ad9c911 5556 wpa_supplicant_cancel_sched_scan(wpa_s);
d7ded758 5557 wpa_supplicant_cancel_scan(wpa_s);
cf4783e3
JM		 5558 wpa_supplicant_deauthenticate(wpa_s,
5559 WLAN_REASON_DEAUTH_LEAVING);
66fe0f70
DS		 5560 } else if (os_strcmp(buf, "SCAN") == 0 ||
5561 os_strncmp(buf, "SCAN ", 5) == 0) {
8401a6b0
JM		 5562 if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
5563 reply_len = -1;
5564 else {
66fe0f70
DS		 5565 if (os_strlen(buf) > 4 &&
5566 os_strncasecmp(buf + 5, "TYPE=ONLY", 9) == 0)
5567 wpa_s->scan_res_handler = scan_only_handler;
d125df25 5568 if (!wpa_s->sched_scanning && !wpa_s->scanning &&
746bba1a
DS		 5569 ((wpa_s->wpa_state <= WPA_SCANNING) ||
5570 (wpa_s->wpa_state == WPA_COMPLETED))) {
564865e1 5571 wpa_s->normal_scans = 0;
4115303b 5572 wpa_s->scan_req = MANUAL_SCAN_REQ;
7255983b 5573 wpa_s->after_wps = 0;
4d9fb08d 5574 wpa_s->known_wps_freq = 0;
564865e1
JM		 5575 wpa_supplicant_req_scan(wpa_s, 0, 0);
5576 } else if (wpa_s->sched_scanning) {
5577 wpa_printf(MSG_DEBUG, "Stop ongoing "
5578 "sched_scan to allow requested "
5579 "full scan to proceed");
5580 wpa_supplicant_cancel_sched_scan(wpa_s);
4115303b 5581 wpa_s->scan_req = MANUAL_SCAN_REQ;
746bba1a
DS		 5582 wpa_supplicant_req_scan(wpa_s, 0, 0);
5583 } else {
5584 wpa_printf(MSG_DEBUG, "Ongoing scan action - "
5585 "reject new request");
5586 reply_len = os_snprintf(reply, reply_size,
5587 "FAIL-BUSY\n");
5588 }
8401a6b0 5589 }
6fc6879b
JM		 5590 } else if (os_strcmp(buf, "SCAN_RESULTS") == 0) {
5591 reply_len = wpa_supplicant_ctrl_iface_scan_results(
5592 wpa_s, reply, reply_size);
5593 } else if (os_strncmp(buf, "SELECT_NETWORK ", 15) == 0) {
5594 if (wpa_supplicant_ctrl_iface_select_network(wpa_s, buf + 15))
5595 reply_len = -1;
5596 } else if (os_strncmp(buf, "ENABLE_NETWORK ", 15) == 0) {
5597 if (wpa_supplicant_ctrl_iface_enable_network(wpa_s, buf + 15))
5598 reply_len = -1;
5599 } else if (os_strncmp(buf, "DISABLE_NETWORK ", 16) == 0) {
5600 if (wpa_supplicant_ctrl_iface_disable_network(wpa_s, buf + 16))
5601 reply_len = -1;
5602 } else if (os_strcmp(buf, "ADD_NETWORK") == 0) {
5603 reply_len = wpa_supplicant_ctrl_iface_add_network(
5604 wpa_s, reply, reply_size);
5605 } else if (os_strncmp(buf, "REMOVE_NETWORK ", 15) == 0) {
5606 if (wpa_supplicant_ctrl_iface_remove_network(wpa_s, buf + 15))
5607 reply_len = -1;
5608 } else if (os_strncmp(buf, "SET_NETWORK ", 12) == 0) {
5609 if (wpa_supplicant_ctrl_iface_set_network(wpa_s, buf + 12))
5610 reply_len = -1;
5611 } else if (os_strncmp(buf, "GET_NETWORK ", 12) == 0) {
5612 reply_len = wpa_supplicant_ctrl_iface_get_network(
5613 wpa_s, buf + 12, reply, reply_size);
d94c9ee6
JM		 5614 } else if (os_strcmp(buf, "LIST_CREDS") == 0) {
5615 reply_len = wpa_supplicant_ctrl_iface_list_creds(
5616 wpa_s, reply, reply_size);
5617 } else if (os_strcmp(buf, "ADD_CRED") == 0) {
5618 reply_len = wpa_supplicant_ctrl_iface_add_cred(
5619 wpa_s, reply, reply_size);
5620 } else if (os_strncmp(buf, "REMOVE_CRED ", 12) == 0) {
5621 if (wpa_supplicant_ctrl_iface_remove_cred(wpa_s, buf + 12))
5622 reply_len = -1;
5623 } else if (os_strncmp(buf, "SET_CRED ", 9) == 0) {
5624 if (wpa_supplicant_ctrl_iface_set_cred(wpa_s, buf + 9))
5625 reply_len = -1;
6fc6879b
JM		 5626#ifndef CONFIG_NO_CONFIG_WRITE
5627 } else if (os_strcmp(buf, "SAVE_CONFIG") == 0) {
5628 if (wpa_supplicant_ctrl_iface_save_config(wpa_s))
5629 reply_len = -1;
5630#endif /* CONFIG_NO_CONFIG_WRITE */
5631 } else if (os_strncmp(buf, "GET_CAPABILITY ", 15) == 0) {
5632 reply_len = wpa_supplicant_ctrl_iface_get_capability(
5633 wpa_s, buf + 15, reply, reply_size);
5634 } else if (os_strncmp(buf, "AP_SCAN ", 8) == 0) {
5635 if (wpa_supplicant_ctrl_iface_ap_scan(wpa_s, buf + 8))
5636 reply_len = -1;
67b9bd08
DS		 5637 } else if (os_strncmp(buf, "SCAN_INTERVAL ", 14) == 0) {
5638 if (wpa_supplicant_ctrl_iface_scan_interval(wpa_s, buf + 14))
5639 reply_len = -1;
4b4a8ae5
JM		 5640 } else if (os_strcmp(buf, "INTERFACE_LIST") == 0) {
5641 reply_len = wpa_supplicant_global_iface_list(
5642 wpa_s->global, reply, reply_size);
6fc6879b
JM		 5643 } else if (os_strcmp(buf, "INTERFACES") == 0) {
5644 reply_len = wpa_supplicant_global_iface_interfaces(
5645 wpa_s->global, reply, reply_size);
5646 } else if (os_strncmp(buf, "BSS ", 4) == 0) {
5647 reply_len = wpa_supplicant_ctrl_iface_bss(
5648 wpa_s, buf + 4, reply, reply_size);
e653b622
JM		 5649#ifdef CONFIG_AP
5650 } else if (os_strcmp(buf, "STA-FIRST") == 0) {
5651 reply_len = ap_ctrl_iface_sta_first(wpa_s, reply, reply_size);
5652 } else if (os_strncmp(buf, "STA ", 4) == 0) {
5653 reply_len = ap_ctrl_iface_sta(wpa_s, buf + 4, reply,
5654 reply_size);
5655 } else if (os_strncmp(buf, "STA-NEXT ", 9) == 0) {
5656 reply_len = ap_ctrl_iface_sta_next(wpa_s, buf + 9, reply,
5657 reply_size);
e60b2951
JJ		 5658 } else if (os_strncmp(buf, "DEAUTHENTICATE ", 15) == 0) {
5659 if (ap_ctrl_iface_sta_deauthenticate(wpa_s, buf + 15))
5660 reply_len = -1;
5661 } else if (os_strncmp(buf, "DISASSOCIATE ", 13) == 0) {
5662 if (ap_ctrl_iface_sta_disassociate(wpa_s, buf + 13))
5663 reply_len = -1;
e653b622 5664#endif /* CONFIG_AP */
207ef3fb
JM		 5665 } else if (os_strcmp(buf, "SUSPEND") == 0) {
5666 wpas_notify_suspend(wpa_s->global);
5667 } else if (os_strcmp(buf, "RESUME") == 0) {
5668 wpas_notify_resume(wpa_s->global);
32d5295f
JM		 5669 } else if (os_strcmp(buf, "DROP_SA") == 0) {
5670 wpa_supplicant_ctrl_iface_drop_sa(wpa_s);
86d4f806
JM		 5671 } else if (os_strncmp(buf, "ROAM ", 5) == 0) {
5672 if (wpa_supplicant_ctrl_iface_roam(wpa_s, buf + 5))
5673 reply_len = -1;
0d0a8ca1
AC		 5674 } else if (os_strncmp(buf, "STA_AUTOCONNECT ", 16) == 0) {
5675 if (wpa_supplicant_ctrl_iface_sta_autoconnect(wpa_s, buf + 16))
5676 reply_len = -1;
78633c37
SL		 5677 } else if (os_strncmp(buf, "BSS_EXPIRE_AGE ", 15) == 0) {
5678 if (wpa_supplicant_ctrl_iface_bss_expire_age(wpa_s, buf + 15))
5679 reply_len = -1;
5680 } else if (os_strncmp(buf, "BSS_EXPIRE_COUNT ", 17) == 0) {
5681 if (wpa_supplicant_ctrl_iface_bss_expire_count(wpa_s,
5682 buf + 17))
5683 reply_len = -1;
39ee845f
DS		 5684 } else if (os_strncmp(buf, "BSS_FLUSH ", 10) == 0) {
5685 if (wpa_supplicant_ctrl_iface_bss_flush(wpa_s, buf + 10))
5686 reply_len = -1;
281ff0aa
GP		 5687#ifdef CONFIG_TDLS
5688 } else if (os_strncmp(buf, "TDLS_DISCOVER ", 14) == 0) {
5689 if (wpa_supplicant_ctrl_iface_tdls_discover(wpa_s, buf + 14))
5690 reply_len = -1;
5691 } else if (os_strncmp(buf, "TDLS_SETUP ", 11) == 0) {
5692 if (wpa_supplicant_ctrl_iface_tdls_setup(wpa_s, buf + 11))
5693 reply_len = -1;
5694 } else if (os_strncmp(buf, "TDLS_TEARDOWN ", 14) == 0) {
5695 if (wpa_supplicant_ctrl_iface_tdls_teardown(wpa_s, buf + 14))
5696 reply_len = -1;
5697#endif /* CONFIG_TDLS */
60b24b0d
DS		 5698 } else if (os_strncmp(buf, "SIGNAL_POLL", 11) == 0) {
5699 reply_len = wpa_supplicant_signal_poll(wpa_s, reply,
5700 reply_size);
dc7785f8
YZ		 5701 } else if (os_strncmp(buf, "PKTCNT_POLL", 11) == 0) {
5702 reply_len = wpa_supplicant_pktcnt_poll(wpa_s, reply,
5703 reply_size);
bc5d330a
TB		 5704#ifdef CONFIG_AUTOSCAN
5705 } else if (os_strncmp(buf, "AUTOSCAN ", 9) == 0) {
5706 if (wpa_supplicant_ctrl_iface_autoscan(wpa_s, buf + 9))
5707 reply_len = -1;
5708#endif /* CONFIG_AUTOSCAN */
9482426e 5709 } else if (os_strcmp(buf, "REAUTHENTICATE") == 0) {
f5f37d3a 5710 pmksa_cache_clear_current(wpa_s->wpa);
9482426e 5711 eapol_sm_request_reauth(wpa_s->eapol);
e9199e31
JM		 5712#ifdef CONFIG_WNM
5713 } else if (os_strncmp(buf, "WNM_SLEEP ", 10) == 0) {
5714 if (wpas_ctrl_iface_wnm_sleep(wpa_s, buf + 10))
5715 reply_len = -1;
65bcd0a9
VK		 5716 } else if (os_strncmp(buf, "WNM_BSS_QUERY ", 10) == 0) {
5717 if (wpas_ctrl_iface_wnm_bss_query(wpa_s, buf + 10))
5718 reply_len = -1;
e9199e31 5719#endif /* CONFIG_WNM */
acb54643
JM		 5720 } else if (os_strcmp(buf, "FLUSH") == 0) {
5721 wpa_supplicant_ctrl_iface_flush(wpa_s);
6fc6879b
JM		 5722 } else {
5723 os_memcpy(reply, "UNKNOWN COMMAND\n", 16);
5724 reply_len = 16;
5725 }
5726
5727 if (reply_len < 0) {
5728 os_memcpy(reply, "FAIL\n", 5);
5729 reply_len = 5;
5730 }
5731
6fc6879b
JM		 5732 *resp_len = reply_len;
5733 return reply;
5734}
5735
5736
5737static int wpa_supplicant_global_iface_add(struct wpa_global *global,
5738 char *cmd)
5739{
5740 struct wpa_interface iface;
5741 char *pos;
5742
5743 /*
5744 * <ifname>TAB<confname>TAB<driver>TAB<ctrl_interface>TAB<driver_param>
5745 * TAB<bridge_ifname>
5746 */
5747 wpa_printf(MSG_DEBUG, "CTRL_IFACE GLOBAL INTERFACE_ADD '%s'", cmd);
5748
5749 os_memset(&iface, 0, sizeof(iface));
5750
5751 do {
5752 iface.ifname = pos = cmd;
5753 pos = os_strchr(pos, '\t');
5754 if (pos)
5755 *pos++ = '\0';
5756 if (iface.ifname[0] == '\0')
5757 return -1;
5758 if (pos == NULL)
5759 break;
5760
5761 iface.confname = pos;
5762 pos = os_strchr(pos, '\t');
5763 if (pos)
5764 *pos++ = '\0';
5765 if (iface.confname[0] == '\0')
5766 iface.confname = NULL;
5767 if (pos == NULL)
5768 break;
5769
5770 iface.driver = pos;
5771 pos = os_strchr(pos, '\t');
5772 if (pos)
5773 *pos++ = '\0';
5774 if (iface.driver[0] == '\0')
5775 iface.driver = NULL;
5776 if (pos == NULL)
5777 break;
5778
5779 iface.ctrl_interface = pos;
5780 pos = os_strchr(pos, '\t');
5781 if (pos)
5782 *pos++ = '\0';
5783 if (iface.ctrl_interface[0] == '\0')
5784 iface.ctrl_interface = NULL;
5785 if (pos == NULL)
5786 break;
5787
5788 iface.driver_param = pos;
5789 pos = os_strchr(pos, '\t');
5790 if (pos)
5791 *pos++ = '\0';
5792 if (iface.driver_param[0] == '\0')
5793 iface.driver_param = NULL;
5794 if (pos == NULL)
5795 break;
5796
5797 iface.bridge_ifname = pos;
5798 pos = os_strchr(pos, '\t');
5799 if (pos)
5800 *pos++ = '\0';
5801 if (iface.bridge_ifname[0] == '\0')
5802 iface.bridge_ifname = NULL;
5803 if (pos == NULL)
5804 break;
5805 } while (0);
5806
5807 if (wpa_supplicant_get_iface(global, iface.ifname))
5808 return -1;
5809
5810 return wpa_supplicant_add_iface(global, &iface) ? 0 : -1;
5811}
5812
5813
5814static int wpa_supplicant_global_iface_remove(struct wpa_global *global,
5815 char *cmd)
5816{
5817 struct wpa_supplicant *wpa_s;
5818
5819 wpa_printf(MSG_DEBUG, "CTRL_IFACE GLOBAL INTERFACE_REMOVE '%s'", cmd);
5820
5821 wpa_s = wpa_supplicant_get_iface(global, cmd);
5822 if (wpa_s == NULL)
5823 return -1;
df509539 5824 return wpa_supplicant_remove_iface(global, wpa_s, 0);
6fc6879b
JM		 5825}
5826
5827
4b4a8ae5
JM		 5828static void wpa_free_iface_info(struct wpa_interface_info *iface)
5829{
5830 struct wpa_interface_info *prev;
5831
5832 while (iface) {
5833 prev = iface;
5834 iface = iface->next;
5835
5836 os_free(prev->ifname);
5837 os_free(prev->desc);
5838 os_free(prev);
5839 }
5840}
5841
5842
5843static int wpa_supplicant_global_iface_list(struct wpa_global *global,
5844 char *buf, int len)
5845{
5846 int i, res;
5847 struct wpa_interface_info *iface = NULL, *last = NULL, *tmp;
5848 char *pos, *end;
5849
c5121837
JM		 5850 for (i = 0; wpa_drivers[i]; i++) {
5851 struct wpa_driver_ops *drv = wpa_drivers[i];
4b4a8ae5
JM		 5852 if (drv->get_interfaces == NULL)
5853 continue;
5fbc1f27 5854 tmp = drv->get_interfaces(global->drv_priv[i]);
4b4a8ae5
JM		 5855 if (tmp == NULL)
5856 continue;
5857
5858 if (last == NULL)
5859 iface = last = tmp;
5860 else
5861 last->next = tmp;
5862 while (last->next)
5863 last = last->next;
5864 }
5865
5866 pos = buf;
5867 end = buf + len;
5868 for (tmp = iface; tmp; tmp = tmp->next) {
5869 res = os_snprintf(pos, end - pos, "%s\t%s\t%s\n",
5870 tmp->drv_name, tmp->ifname,
5871 tmp->desc ? tmp->desc : "");
5872 if (res < 0 || res >= end - pos) {
5873 *pos = '\0';
5874 break;
5875 }
5876 pos += res;
5877 }
5878
5879 wpa_free_iface_info(iface);
5880
5881 return pos - buf;
5882}
5883
5884
6fc6879b
JM		 5885static int wpa_supplicant_global_iface_interfaces(struct wpa_global *global,
5886 char *buf, int len)
5887{
5888 int res;
5889 char *pos, *end;
5890 struct wpa_supplicant *wpa_s;
5891
5892 wpa_s = global->ifaces;
5893 pos = buf;
5894 end = buf + len;
5895
5896 while (wpa_s) {
5897 res = os_snprintf(pos, end - pos, "%s\n", wpa_s->ifname);
5898 if (res < 0 || res >= end - pos) {
5899 *pos = '\0';
5900 break;
5901 }
5902 pos += res;
5903 wpa_s = wpa_s->next;
5904 }
5905 return pos - buf;
5906}
5907
5908
cf3bebf2
JM		 5909static char * wpas_global_ctrl_iface_ifname(struct wpa_global *global,
5910 const char *ifname,
5911 char *cmd, size_t *resp_len)
5912{
5913 struct wpa_supplicant *wpa_s;
5914
5915 for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
5916 if (os_strcmp(ifname, wpa_s->ifname) == 0)
5917 break;
5918 }
5919
5920 if (wpa_s == NULL) {
5921 char *resp = os_strdup("FAIL-NO-IFNAME-MATCH\n");
5922 if (resp)
5923 *resp_len = os_strlen(resp);
5924 else
5925 *resp_len = 1;
5926 return resp;
5927 }
5928
5929 return wpa_supplicant_ctrl_iface_process(wpa_s, cmd, resp_len);
5930}
5931
5932
576bce9c
JM		 5933static char * wpas_global_ctrl_iface_redir_p2p(struct wpa_global *global,
5934 char *buf, size_t *resp_len)
5935{
5936#ifdef CONFIG_P2P
5937 static const char * cmd[] = {
5938 "P2P_FIND",
5939 "P2P_STOP_FIND",
5940 "P2P_LISTEN",
5941 "P2P_GROUP_ADD",
5942 "P2P_GET_PASSPHRASE",
5943 "P2P_SERVICE_UPDATE",
5944 "P2P_SERVICE_FLUSH",
5945 "P2P_FLUSH",
5946 "P2P_CANCEL",
5947 "P2P_PRESENCE_REQ",
5948 "P2P_EXT_LISTEN",
5949 NULL
5950 };
5951 static const char * prefix[] = {
5952 "P2P_FIND ",
5953 "P2P_CONNECT ",
5954 "P2P_LISTEN ",
5955 "P2P_GROUP_REMOVE ",
5956 "P2P_GROUP_ADD ",
5957 "P2P_PROV_DISC ",
5958 "P2P_SERV_DISC_REQ ",
5959 "P2P_SERV_DISC_CANCEL_REQ ",
5960 "P2P_SERV_DISC_RESP ",
5961 "P2P_SERV_DISC_EXTERNAL ",
5962 "P2P_SERVICE_ADD ",
5963 "P2P_SERVICE_DEL ",
5964 "P2P_REJECT ",
5965 "P2P_INVITE ",
5966 "P2P_PEER ",
5967 "P2P_SET ",
5968 "P2P_UNAUTHORIZE ",
5969 "P2P_PRESENCE_REQ ",
5970 "P2P_EXT_LISTEN ",
f2c56602 5971 "P2P_REMOVE_CLIENT ",
576bce9c
JM		 5972 NULL
5973 };
5974 int found = 0;
5975 int i;
5976
5977 if (global->p2p_init_wpa_s == NULL)
5978 return NULL;
5979
5980 for (i = 0; !found && cmd[i]; i++) {
5981 if (os_strcmp(buf, cmd[i]) == 0)
5982 found = 1;
5983 }
5984
5985 for (i = 0; !found && prefix[i]; i++) {
5986 if (os_strncmp(buf, prefix[i], os_strlen(prefix[i])) == 0)
5987 found = 1;
5988 }
5989
5990 if (found)
5991 return wpa_supplicant_ctrl_iface_process(global->p2p_init_wpa_s,
5992 buf, resp_len);
5993#endif /* CONFIG_P2P */
5994 return NULL;
5995}
5996
5997
5998static char * wpas_global_ctrl_iface_redir_wfd(struct wpa_global *global,
5999 char *buf, size_t *resp_len)
6000{
6001#ifdef CONFIG_WIFI_DISPLAY
6002 if (global->p2p_init_wpa_s == NULL)
6003 return NULL;
6004 if (os_strncmp(buf, "WFD_SUBELEM_SET ", 16) == 0 ||
6005 os_strncmp(buf, "WFD_SUBELEM_GET ", 16) == 0)
6006 return wpa_supplicant_ctrl_iface_process(global->p2p_init_wpa_s,
6007 buf, resp_len);
6008#endif /* CONFIG_WIFI_DISPLAY */
6009 return NULL;
6010}
6011
6012
6013static char * wpas_global_ctrl_iface_redir(struct wpa_global *global,
6014 char *buf, size_t *resp_len)
6015{
6016 char *ret;
6017
6018 ret = wpas_global_ctrl_iface_redir_p2p(global, buf, resp_len);
6019 if (ret)
6020 return ret;
6021
6022 ret = wpas_global_ctrl_iface_redir_wfd(global, buf, resp_len);
6023 if (ret)
6024 return ret;
6025
6026 return NULL;
6027}
6028
6029
1b9b31c1
JM		 6030static int wpas_global_ctrl_iface_set(struct wpa_global *global, char *cmd)
6031{
6032 char *value;
6033
6034 value = os_strchr(cmd, ' ');
6035 if (value == NULL)
6036 return -1;
6037 *value++ = '\0';
6038
6039 wpa_printf(MSG_DEBUG, "GLOBAL_CTRL_IFACE SET '%s'='%s'", cmd, value);
6040
6041#ifdef CONFIG_WIFI_DISPLAY
6042 if (os_strcasecmp(cmd, "wifi_display") == 0) {
6043 wifi_display_enable(global, !!atoi(value));
6044 return 0;
6045 }
6046#endif /* CONFIG_WIFI_DISPLAY */
6047
6048 return -1;
6049}
6050
6051
42868f14
JM		 6052#ifndef CONFIG_NO_CONFIG_WRITE
6053static int wpas_global_ctrl_iface_save_config(struct wpa_global *global)
6054{
6055 int ret = 0;
6056 struct wpa_supplicant *wpa_s;
6057
6058 for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
6059 if (!wpa_s->conf->update_config) {
6060 wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Not allowed to update configuration (update_config=0)");
6061 continue;
6062 }
6063
6064 if (wpa_config_write(wpa_s->confname, wpa_s->conf)) {
6065 wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Failed to update configuration");
6066 ret = 1;
6067 } else {
6068 wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Configuration updated");
6069 }
6070 }
6071
6072 return ret;
6073}
6074#endif /* CONFIG_NO_CONFIG_WRITE */
6075
6076
ae8c27f7
JM		 6077static int wpas_global_ctrl_iface_status(struct wpa_global *global,
6078 char *buf, size_t buflen)
6079{
6080 char *pos, *end;
6081 int ret;
6082 struct wpa_supplicant *wpa_s;
6083
6084 pos = buf;
6085 end = buf + buflen;
6086
6087#ifdef CONFIG_P2P
4c559019 6088 if (global->p2p && !global->p2p_disabled) {
ae8c27f7 6089 ret = os_snprintf(pos, end - pos, "p2p_device_address=" MACSTR
4c559019
JM		 6090 "\n"
6091 "p2p_state=%s\n",
6092 MAC2STR(global->p2p_dev_addr),
6093 p2p_get_state_txt(global->p2p));
6094 if (ret < 0 || ret >= end - pos)
6095 return pos - buf;
6096 pos += ret;
6097 } else if (global->p2p) {
6098 ret = os_snprintf(pos, end - pos, "p2p_state=DISABLED\n");
ae8c27f7
JM		 6099 if (ret < 0 || ret >= end - pos)
6100 return pos - buf;
6101 pos += ret;
6102 }
6103#endif /* CONFIG_P2P */
6104
6105#ifdef CONFIG_WIFI_DISPLAY
6106 ret = os_snprintf(pos, end - pos, "wifi_display=%d\n",
6107 !!global->wifi_display);
6108 if (ret < 0 || ret >= end - pos)
6109 return pos - buf;
6110 pos += ret;
6111#endif /* CONFIG_WIFI_DISPLAY */
6112
6113 for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
6114 ret = os_snprintf(pos, end - pos, "ifname=%s\n"
6115 "address=" MACSTR "\n",
6116 wpa_s->ifname, MAC2STR(wpa_s->own_addr));
6117 if (ret < 0 || ret >= end - pos)
6118 return pos - buf;
6119 pos += ret;
6120 }
6121
6122 return pos - buf;
6123}
6124
6125
6fc6879b
JM		 6126char * wpa_supplicant_global_ctrl_iface_process(struct wpa_global *global,
6127 char *buf, size_t *resp_len)
6128{
6129 char *reply;
6130 const int reply_size = 2048;
6131 int reply_len;
f4a0a82c 6132 int level = MSG_DEBUG;
6fc6879b 6133
cf3bebf2
JM		 6134 if (os_strncmp(buf, "IFNAME=", 7) == 0) {
6135 char *pos = os_strchr(buf + 7, ' ');
6136 if (pos) {
6137 *pos++ = '\0';
6138 return wpas_global_ctrl_iface_ifname(global,
6139 buf + 7, pos,
6140 resp_len);
6141 }
6142 }
6143
576bce9c
JM		 6144 reply = wpas_global_ctrl_iface_redir(global, buf, resp_len);
6145 if (reply)
6146 return reply;
6147
f4a0a82c
JM		 6148 if (os_strcmp(buf, "PING") == 0)
6149 level = MSG_EXCESSIVE;
6150 wpa_hexdump_ascii(level, "RX global ctrl_iface",
6fc6879b
JM		 6151 (const u8 *) buf, os_strlen(buf));
6152
6153 reply = os_malloc(reply_size);
6154 if (reply == NULL) {
6155 *resp_len = 1;
6156 return NULL;
6157 }
6158
6159 os_memcpy(reply, "OK\n", 3);
6160 reply_len = 3;
6161
6162 if (os_strcmp(buf, "PING") == 0) {
6163 os_memcpy(reply, "PONG\n", 5);
6164 reply_len = 5;
6165 } else if (os_strncmp(buf, "INTERFACE_ADD ", 14) == 0) {
6166 if (wpa_supplicant_global_iface_add(global, buf + 14))
6167 reply_len = -1;
6168 } else if (os_strncmp(buf, "INTERFACE_REMOVE ", 17) == 0) {
6169 if (wpa_supplicant_global_iface_remove(global, buf + 17))
6170 reply_len = -1;
4b4a8ae5
JM		 6171 } else if (os_strcmp(buf, "INTERFACE_LIST") == 0) {
6172 reply_len = wpa_supplicant_global_iface_list(
6173 global, reply, reply_size);
6fc6879b
JM		 6174 } else if (os_strcmp(buf, "INTERFACES") == 0) {
6175 reply_len = wpa_supplicant_global_iface_interfaces(
6176 global, reply, reply_size);
6177 } else if (os_strcmp(buf, "TERMINATE") == 0) {
1a1bf008 6178 wpa_supplicant_terminate_proc(global);
207ef3fb
JM		 6179 } else if (os_strcmp(buf, "SUSPEND") == 0) {
6180 wpas_notify_suspend(global);
6181 } else if (os_strcmp(buf, "RESUME") == 0) {
6182 wpas_notify_resume(global);
1b9b31c1
JM		 6183 } else if (os_strncmp(buf, "SET ", 4) == 0) {
6184 if (wpas_global_ctrl_iface_set(global, buf + 4))
6185 reply_len = -1;
42868f14
JM		 6186#ifndef CONFIG_NO_CONFIG_WRITE
6187 } else if (os_strcmp(buf, "SAVE_CONFIG") == 0) {
6188 if (wpas_global_ctrl_iface_save_config(global))
6189 reply_len = -1;
6190#endif /* CONFIG_NO_CONFIG_WRITE */
ae8c27f7
JM		 6191 } else if (os_strcmp(buf, "STATUS") == 0) {
6192 reply_len = wpas_global_ctrl_iface_status(global, reply,
6193 reply_size);
6fc6879b
JM		 6194 } else {
6195 os_memcpy(reply, "UNKNOWN COMMAND\n", 16);
6196 reply_len = 16;
6197 }
6198
6199 if (reply_len < 0) {
6200 os_memcpy(reply, "FAIL\n", 5);
6201 reply_len = 5;
6202 }
6203
6204 *resp_len = reply_len;
6205 return reply;
6206}
Unnamed repository; edit this file 'description' to name the repository.