wpa_supplicant/ctrl_iface.c

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