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