wpa_supplicant/ctrl_iface.c

   1 /*
   2  * WPA Supplicant / Control interface (shared code for all backends)
   3  * Copyright (c) 2004-2014, Jouni Malinen <j@w1.fi>
   4  *
   5  * This software may be distributed under the terms of the BSD license.
   6  * See README for more details.
   7  */
   8
   9 #include "utils/includes.h"
  10
  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         u8 dev_type[WPS_DEV_TYPE_LEN], *_dev_type = NULL;
3656         char *pos;
3657         unsigned int search_delay;
3658
3659         if (os_strstr(cmd, "type=social"))
3660                 type = P2P_FIND_ONLY_SOCIAL;
3661         else if (os_strstr(cmd, "type=progressive"))
3662                 type = P2P_FIND_PROGRESSIVE;
3663
3664         pos = os_strstr(cmd, "dev_id=");
3665         if (pos) {
3666                 pos += 7;
3667                 if (hwaddr_aton(pos, dev_id))
3668                         return -1;
3669                 _dev_id = dev_id;
3670         }
3671
3672         pos = os_strstr(cmd, "dev_type=");
3673         if (pos) {
3674                 pos += 9;
3675                 if (wps_dev_type_str2bin(pos, dev_type) < 0)
3676                         return -1;
3677                 _dev_type = dev_type;
3678         }
3679
3680         pos = os_strstr(cmd, "delay=");
3681         if (pos) {
3682                 pos += 6;
3683                 search_delay = atoi(pos);
3684         } else
3685                 search_delay = wpas_p2p_search_delay(wpa_s);
3686
3687         return wpas_p2p_find(wpa_s, timeout, type, _dev_type != NULL, _dev_type,
3688                              _dev_id, search_delay);
3689 }
3690
3691
3692 static int p2p_ctrl_connect(struct wpa_supplicant *wpa_s, char *cmd,
3693                             char *buf, size_t buflen)
3694 {
3695         u8 addr[ETH_ALEN];
3696         char *pos, *pos2;
3697         char *pin = NULL;
3698         enum p2p_wps_method wps_method;
3699         int new_pin;
3700         int ret;
3701         int persistent_group, persistent_id = -1;
3702         int join;
3703         int auth;
3704         int automatic;
3705         int go_intent = -1;
3706         int freq = 0;
3707         int pd;
3708         int ht40, vht;
3709
3710         /* <addr> <"pbc" | "pin" | PIN> [label|display|keypad]
3711          * [persistent|persistent=<network id>]
3712          * [join] [auth] [go_intent=<0..15>] [freq=<in MHz>] [provdisc]
3713          * [ht40] [vht] */
3714
3715         if (hwaddr_aton(cmd, addr))
3716                 return -1;
3717
3718         pos = cmd + 17;
3719         if (*pos != ' ')
3720                 return -1;
3721         pos++;
3722
3723         persistent_group = os_strstr(pos, " persistent") != NULL;
3724         pos2 = os_strstr(pos, " persistent=");
3725         if (pos2) {
3726                 struct wpa_ssid *ssid;
3727                 persistent_id = atoi(pos2 + 12);
3728                 ssid = wpa_config_get_network(wpa_s->conf, persistent_id);
3729                 if (ssid == NULL || ssid->disabled != 2 ||
3730                     ssid->mode != WPAS_MODE_P2P_GO) {
3731                         wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find "
3732                                    "SSID id=%d for persistent P2P group (GO)",
3733                                    persistent_id);
3734                         return -1;
3735                 }
3736         }
3737         join = os_strstr(pos, " join") != NULL;
3738         auth = os_strstr(pos, " auth") != NULL;
3739         automatic = os_strstr(pos, " auto") != NULL;
3740         pd = os_strstr(pos, " provdisc") != NULL;
3741         vht = (os_strstr(cmd, " vht") != NULL) || wpa_s->conf->p2p_go_vht;
3742         ht40 = (os_strstr(cmd, " ht40") != NULL) || wpa_s->conf->p2p_go_ht40 ||
3743                 vht;
3744
3745         pos2 = os_strstr(pos, " go_intent=");
3746         if (pos2) {
3747                 pos2 += 11;
3748                 go_intent = atoi(pos2);
3749                 if (go_intent < 0 || go_intent > 15)
3750                         return -1;
3751         }
3752
3753         pos2 = os_strstr(pos, " freq=");
3754         if (pos2) {
3755                 pos2 += 6;
3756                 freq = atoi(pos2);
3757                 if (freq <= 0)
3758                         return -1;
3759         }
3760
3761         if (os_strncmp(pos, "pin", 3) == 0) {
3762                 /* Request random PIN (to be displayed) and enable the PIN */
3763                 wps_method = WPS_PIN_DISPLAY;
3764         } else if (os_strncmp(pos, "pbc", 3) == 0) {
3765                 wps_method = WPS_PBC;
3766         } else {
3767                 pin = pos;
3768                 pos = os_strchr(pin, ' ');
3769                 wps_method = WPS_PIN_KEYPAD;
3770                 if (pos) {
3771                         *pos++ = '\0';
3772                         if (os_strncmp(pos, "display", 7) == 0)
3773                                 wps_method = WPS_PIN_DISPLAY;
3774                 }
3775                 if (!wps_pin_str_valid(pin)) {
3776                         os_memcpy(buf, "FAIL-INVALID-PIN\n", 17);
3777                         return 17;
3778                 }
3779         }
3780
3781         new_pin = wpas_p2p_connect(wpa_s, addr, pin, wps_method,
3782                                    persistent_group, automatic, join,
3783                                    auth, go_intent, freq, persistent_id, pd,
3784                                    ht40, vht);
3785         if (new_pin == -2) {
3786                 os_memcpy(buf, "FAIL-CHANNEL-UNAVAILABLE\n", 25);
3787                 return 25;
3788         }
3789         if (new_pin == -3) {
3790                 os_memcpy(buf, "FAIL-CHANNEL-UNSUPPORTED\n", 25);
3791                 return 25;
3792         }
3793         if (new_pin < 0)
3794                 return -1;
3795         if (wps_method == WPS_PIN_DISPLAY && pin == NULL) {
3796                 ret = os_snprintf(buf, buflen, "%08d", new_pin);
3797                 if (ret < 0 || (size_t) ret >= buflen)
3798                         return -1;
3799                 return ret;
3800         }
3801
3802         os_memcpy(buf, "OK\n", 3);
3803         return 3;
3804 }
3805
3806
3807 static int p2p_ctrl_listen(struct wpa_supplicant *wpa_s, char *cmd)
3808 {
3809         unsigned int timeout = atoi(cmd);
3810         return wpas_p2p_listen(wpa_s, timeout);
3811 }
3812
3813
3814 static int p2p_ctrl_prov_disc(struct wpa_supplicant *wpa_s, char *cmd)
3815 {
3816         u8 addr[ETH_ALEN];
3817         char *pos;
3818         enum wpas_p2p_prov_disc_use use = WPAS_P2P_PD_FOR_GO_NEG;
3819
3820         /* <addr> <config method> [join|auto] */
3821
3822         if (hwaddr_aton(cmd, addr))
3823                 return -1;
3824
3825         pos = cmd + 17;
3826         if (*pos != ' ')
3827                 return -1;
3828         pos++;
3829
3830         if (os_strstr(pos, " join") != NULL)
3831                 use = WPAS_P2P_PD_FOR_JOIN;
3832         else if (os_strstr(pos, " auto") != NULL)
3833                 use = WPAS_P2P_PD_AUTO;
3834
3835         return wpas_p2p_prov_disc(wpa_s, addr, pos, use);
3836 }
3837
3838
3839 static int p2p_get_passphrase(struct wpa_supplicant *wpa_s, char *buf,
3840                               size_t buflen)
3841 {
3842         struct wpa_ssid *ssid = wpa_s->current_ssid;
3843
3844         if (ssid == NULL || ssid->mode != WPAS_MODE_P2P_GO ||
3845             ssid->passphrase == NULL)
3846                 return -1;
3847
3848         os_strlcpy(buf, ssid->passphrase, buflen);
3849         return os_strlen(buf);
3850 }
3851
3852
3853 static int p2p_ctrl_serv_disc_req(struct wpa_supplicant *wpa_s, char *cmd,
3854                                   char *buf, size_t buflen)
3855 {
3856         u64 ref;
3857         int res;
3858         u8 dst_buf[ETH_ALEN], *dst;
3859         struct wpabuf *tlvs;
3860         char *pos;
3861         size_t len;
3862
3863         if (hwaddr_aton(cmd, dst_buf))
3864                 return -1;
3865         dst = dst_buf;
3866         if (dst[0] == 0 && dst[1] == 0 && dst[2] == 0 &&
3867             dst[3] == 0 && dst[4] == 0 && dst[5] == 0)
3868                 dst = NULL;
3869         pos = cmd + 17;
3870         if (*pos != ' ')
3871                 return -1;
3872         pos++;
3873
3874         if (os_strncmp(pos, "upnp ", 5) == 0) {
3875                 u8 version;
3876                 pos += 5;
3877                 if (hexstr2bin(pos, &version, 1) < 0)
3878                         return -1;
3879                 pos += 2;
3880                 if (*pos != ' ')
3881                         return -1;
3882                 pos++;
3883                 ref = wpas_p2p_sd_request_upnp(wpa_s, dst, version, pos);
3884 #ifdef CONFIG_WIFI_DISPLAY
3885         } else if (os_strncmp(pos, "wifi-display ", 13) == 0) {
3886                 ref = wpas_p2p_sd_request_wifi_display(wpa_s, dst, pos + 13);
3887 #endif /* CONFIG_WIFI_DISPLAY */
3888         } else {
3889                 len = os_strlen(pos);
3890                 if (len & 1)
3891                         return -1;
3892                 len /= 2;
3893                 tlvs = wpabuf_alloc(len);
3894                 if (tlvs == NULL)
3895                         return -1;
3896                 if (hexstr2bin(pos, wpabuf_put(tlvs, len), len) < 0) {
3897                         wpabuf_free(tlvs);
3898                         return -1;
3899                 }
3900
3901                 ref = wpas_p2p_sd_request(wpa_s, dst, tlvs);
3902                 wpabuf_free(tlvs);
3903         }
3904         if (ref == 0)
3905                 return -1;
3906         res = os_snprintf(buf, buflen, "%llx", (long long unsigned) ref);
3907         if (res < 0 || (unsigned) res >= buflen)
3908                 return -1;
3909         return res;
3910 }
3911
3912
3913 static int p2p_ctrl_serv_disc_cancel_req(struct wpa_supplicant *wpa_s,
3914                                          char *cmd)
3915 {
3916         long long unsigned val;
3917         u64 req;
3918         if (sscanf(cmd, "%llx", &val) != 1)
3919                 return -1;
3920         req = val;
3921         return wpas_p2p_sd_cancel_request(wpa_s, req);
3922 }
3923
3924
3925 static int p2p_ctrl_serv_disc_resp(struct wpa_supplicant *wpa_s, char *cmd)
3926 {
3927         int freq;
3928         u8 dst[ETH_ALEN];
3929         u8 dialog_token;
3930         struct wpabuf *resp_tlvs;
3931         char *pos, *pos2;
3932         size_t len;
3933
3934         pos = os_strchr(cmd, ' ');
3935         if (pos == NULL)
3936                 return -1;
3937         *pos++ = '\0';
3938         freq = atoi(cmd);
3939         if (freq == 0)
3940                 return -1;
3941
3942         if (hwaddr_aton(pos, dst))
3943                 return -1;
3944         pos += 17;
3945         if (*pos != ' ')
3946                 return -1;
3947         pos++;
3948
3949         pos2 = os_strchr(pos, ' ');
3950         if (pos2 == NULL)
3951                 return -1;
3952         *pos2++ = '\0';
3953         dialog_token = atoi(pos);
3954
3955         len = os_strlen(pos2);
3956         if (len & 1)
3957                 return -1;
3958         len /= 2;
3959         resp_tlvs = wpabuf_alloc(len);
3960         if (resp_tlvs == NULL)
3961                 return -1;
3962         if (hexstr2bin(pos2, wpabuf_put(resp_tlvs, len), len) < 0) {
3963                 wpabuf_free(resp_tlvs);
3964                 return -1;
3965         }
3966
3967         wpas_p2p_sd_response(wpa_s, freq, dst, dialog_token, resp_tlvs);
3968         wpabuf_free(resp_tlvs);
3969         return 0;
3970 }
3971
3972
3973 static int p2p_ctrl_serv_disc_external(struct wpa_supplicant *wpa_s,
3974                                        char *cmd)
3975 {
3976         if (os_strcmp(cmd, "0") && os_strcmp(cmd, "1"))
3977                 return -1;
3978         wpa_s->p2p_sd_over_ctrl_iface = atoi(cmd);
3979         return 0;
3980 }
3981
3982
3983 static int p2p_ctrl_service_add_bonjour(struct wpa_supplicant *wpa_s,
3984                                         char *cmd)
3985 {
3986         char *pos;
3987         size_t len;
3988         struct wpabuf *query, *resp;
3989
3990         pos = os_strchr(cmd, ' ');
3991         if (pos == NULL)
3992                 return -1;
3993         *pos++ = '\0';
3994
3995         len = os_strlen(cmd);
3996         if (len & 1)
3997                 return -1;
3998         len /= 2;
3999         query = wpabuf_alloc(len);
4000         if (query == NULL)
4001                 return -1;
4002         if (hexstr2bin(cmd, wpabuf_put(query, len), len) < 0) {
4003                 wpabuf_free(query);
4004                 return -1;
4005         }
4006
4007         len = os_strlen(pos);
4008         if (len & 1) {
4009                 wpabuf_free(query);
4010                 return -1;
4011         }
4012         len /= 2;
4013         resp = wpabuf_alloc(len);
4014         if (resp == NULL) {
4015                 wpabuf_free(query);
4016                 return -1;
4017         }
4018         if (hexstr2bin(pos, wpabuf_put(resp, len), len) < 0) {
4019                 wpabuf_free(query);
4020                 wpabuf_free(resp);
4021                 return -1;
4022         }
4023
4024         if (wpas_p2p_service_add_bonjour(wpa_s, query, resp) < 0) {
4025                 wpabuf_free(query);
4026                 wpabuf_free(resp);
4027                 return -1;
4028         }
4029         return 0;
4030 }
4031
4032
4033 static int p2p_ctrl_service_add_upnp(struct wpa_supplicant *wpa_s, char *cmd)
4034 {
4035         char *pos;
4036         u8 version;
4037
4038         pos = os_strchr(cmd, ' ');
4039         if (pos == NULL)
4040                 return -1;
4041         *pos++ = '\0';
4042
4043         if (hexstr2bin(cmd, &version, 1) < 0)
4044                 return -1;
4045
4046         return wpas_p2p_service_add_upnp(wpa_s, version, pos);
4047 }
4048
4049
4050 static int p2p_ctrl_service_add(struct wpa_supplicant *wpa_s, char *cmd)
4051 {
4052         char *pos;
4053
4054         pos = os_strchr(cmd, ' ');
4055         if (pos == NULL)
4056                 return -1;
4057         *pos++ = '\0';
4058
4059         if (os_strcmp(cmd, "bonjour") == 0)
4060                 return p2p_ctrl_service_add_bonjour(wpa_s, pos);
4061         if (os_strcmp(cmd, "upnp") == 0)
4062                 return p2p_ctrl_service_add_upnp(wpa_s, pos);
4063         wpa_printf(MSG_DEBUG, "Unknown service '%s'", cmd);
4064         return -1;
4065 }
4066
4067
4068 static int p2p_ctrl_service_del_bonjour(struct wpa_supplicant *wpa_s,
4069                                         char *cmd)
4070 {
4071         size_t len;
4072         struct wpabuf *query;
4073         int ret;
4074
4075         len = os_strlen(cmd);
4076         if (len & 1)
4077                 return -1;
4078         len /= 2;
4079         query = wpabuf_alloc(len);
4080         if (query == NULL)
4081                 return -1;
4082         if (hexstr2bin(cmd, wpabuf_put(query, len), len) < 0) {
4083                 wpabuf_free(query);
4084                 return -1;
4085         }
4086
4087         ret = wpas_p2p_service_del_bonjour(wpa_s, query);
4088         wpabuf_free(query);
4089         return ret;
4090 }
4091
4092
4093 static int p2p_ctrl_service_del_upnp(struct wpa_supplicant *wpa_s, char *cmd)
4094 {
4095         char *pos;
4096         u8 version;
4097
4098         pos = os_strchr(cmd, ' ');
4099         if (pos == NULL)
4100                 return -1;
4101         *pos++ = '\0';
4102
4103         if (hexstr2bin(cmd, &version, 1) < 0)
4104                 return -1;
4105
4106         return wpas_p2p_service_del_upnp(wpa_s, version, pos);
4107 }
4108
4109
4110 static int p2p_ctrl_service_del(struct wpa_supplicant *wpa_s, char *cmd)
4111 {
4112         char *pos;
4113
4114         pos = os_strchr(cmd, ' ');
4115         if (pos == NULL)
4116                 return -1;
4117         *pos++ = '\0';
4118
4119         if (os_strcmp(cmd, "bonjour") == 0)
4120                 return p2p_ctrl_service_del_bonjour(wpa_s, pos);
4121         if (os_strcmp(cmd, "upnp") == 0)
4122                 return p2p_ctrl_service_del_upnp(wpa_s, pos);
4123         wpa_printf(MSG_DEBUG, "Unknown service '%s'", cmd);
4124         return -1;
4125 }
4126
4127
4128 static int p2p_ctrl_reject(struct wpa_supplicant *wpa_s, char *cmd)
4129 {
4130         u8 addr[ETH_ALEN];
4131
4132         /* <addr> */
4133
4134         if (hwaddr_aton(cmd, addr))
4135                 return -1;
4136
4137         return wpas_p2p_reject(wpa_s, addr);
4138 }
4139
4140
4141 static int p2p_ctrl_invite_persistent(struct wpa_supplicant *wpa_s, char *cmd)
4142 {
4143         char *pos;
4144         int id;
4145         struct wpa_ssid *ssid;
4146         u8 *_peer = NULL, peer[ETH_ALEN];
4147         int freq = 0, pref_freq = 0;
4148         int ht40, vht;
4149
4150         id = atoi(cmd);
4151         pos = os_strstr(cmd, " peer=");
4152         if (pos) {
4153                 pos += 6;
4154                 if (hwaddr_aton(pos, peer))
4155                         return -1;
4156                 _peer = peer;
4157         }
4158         ssid = wpa_config_get_network(wpa_s->conf, id);
4159         if (ssid == NULL || ssid->disabled != 2) {
4160                 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find SSID id=%d "
4161                            "for persistent P2P group",
4162                            id);
4163                 return -1;
4164         }
4165
4166         pos = os_strstr(cmd, " freq=");
4167         if (pos) {
4168                 pos += 6;
4169                 freq = atoi(pos);
4170                 if (freq <= 0)
4171                         return -1;
4172         }
4173
4174         pos = os_strstr(cmd, " pref=");
4175         if (pos) {
4176                 pos += 6;
4177                 pref_freq = atoi(pos);
4178                 if (pref_freq <= 0)
4179                         return -1;
4180         }
4181
4182         vht = (os_strstr(cmd, " vht") != NULL) || wpa_s->conf->p2p_go_vht;
4183         ht40 = (os_strstr(cmd, " ht40") != NULL) || wpa_s->conf->p2p_go_ht40 ||
4184                 vht;
4185
4186         return wpas_p2p_invite(wpa_s, _peer, ssid, NULL, freq, ht40, vht,
4187                                pref_freq);
4188 }
4189
4190
4191 static int p2p_ctrl_invite_group(struct wpa_supplicant *wpa_s, char *cmd)
4192 {
4193         char *pos;
4194         u8 peer[ETH_ALEN], go_dev_addr[ETH_ALEN], *go_dev = NULL;
4195
4196         pos = os_strstr(cmd, " peer=");
4197         if (!pos)
4198                 return -1;
4199
4200         *pos = '\0';
4201         pos += 6;
4202         if (hwaddr_aton(pos, peer)) {
4203                 wpa_printf(MSG_DEBUG, "P2P: Invalid MAC address '%s'", pos);
4204                 return -1;
4205         }
4206
4207         pos = os_strstr(pos, " go_dev_addr=");
4208         if (pos) {
4209                 pos += 13;
4210                 if (hwaddr_aton(pos, go_dev_addr)) {
4211                         wpa_printf(MSG_DEBUG, "P2P: Invalid MAC address '%s'",
4212                                    pos);
4213                         return -1;
4214                 }
4215                 go_dev = go_dev_addr;
4216         }
4217
4218         return wpas_p2p_invite_group(wpa_s, cmd, peer, go_dev);
4219 }
4220
4221
4222 static int p2p_ctrl_invite(struct wpa_supplicant *wpa_s, char *cmd)
4223 {
4224         if (os_strncmp(cmd, "persistent=", 11) == 0)
4225                 return p2p_ctrl_invite_persistent(wpa_s, cmd + 11);
4226         if (os_strncmp(cmd, "group=", 6) == 0)
4227                 return p2p_ctrl_invite_group(wpa_s, cmd + 6);
4228
4229         return -1;
4230 }
4231
4232
4233 static int p2p_ctrl_group_add_persistent(struct wpa_supplicant *wpa_s,
4234                                          char *cmd, int freq, int ht40,
4235                                          int vht)
4236 {
4237         int id;
4238         struct wpa_ssid *ssid;
4239
4240         id = atoi(cmd);
4241         ssid = wpa_config_get_network(wpa_s->conf, id);
4242         if (ssid == NULL || ssid->disabled != 2) {
4243                 wpa_printf(MSG_DEBUG, "CTRL_IFACE: Could not find SSID id=%d "
4244                            "for persistent P2P group",
4245                            id);
4246                 return -1;
4247         }
4248
4249         return wpas_p2p_group_add_persistent(wpa_s, ssid, 0, freq, ht40, vht,
4250                                              NULL, 0);
4251 }
4252
4253
4254 static int p2p_ctrl_group_add(struct wpa_supplicant *wpa_s, char *cmd)
4255 {
4256         int freq = 0, ht40, vht;
4257         char *pos;
4258
4259         pos = os_strstr(cmd, "freq=");
4260         if (pos)
4261                 freq = atoi(pos + 5);
4262
4263         vht = (os_strstr(cmd, "vht") != NULL) || wpa_s->conf->p2p_go_vht;
4264         ht40 = (os_strstr(cmd, "ht40") != NULL) || wpa_s->conf->p2p_go_ht40 ||
4265                 vht;
4266
4267         if (os_strncmp(cmd, "persistent=", 11) == 0)
4268                 return p2p_ctrl_group_add_persistent(wpa_s, cmd + 11, freq,
4269                                                      ht40, vht);
4270         if (os_strcmp(cmd, "persistent") == 0 ||
4271             os_strncmp(cmd, "persistent ", 11) == 0)
4272                 return wpas_p2p_group_add(wpa_s, 1, freq, ht40, vht);
4273         if (os_strncmp(cmd, "freq=", 5) == 0)
4274                 return wpas_p2p_group_add(wpa_s, 0, freq, ht40, vht);
4275         if (ht40)
4276                 return wpas_p2p_group_add(wpa_s, 0, freq, ht40, vht);
4277
4278         wpa_printf(MSG_DEBUG, "CTRL: Invalid P2P_GROUP_ADD parameters '%s'",
4279                    cmd);
4280         return -1;
4281 }
4282
4283
4284 static int p2p_ctrl_peer(struct wpa_supplicant *wpa_s, char *cmd,
4285                          char *buf, size_t buflen)
4286 {
4287         u8 addr[ETH_ALEN], *addr_ptr;
4288         int next, res;
4289         const struct p2p_peer_info *info;
4290         char *pos, *end;
4291         char devtype[WPS_DEV_TYPE_BUFSIZE];
4292         struct wpa_ssid *ssid;
4293         size_t i;
4294
4295         if (!wpa_s->global->p2p)
4296                 return -1;
4297
4298         if (os_strcmp(cmd, "FIRST") == 0) {
4299                 addr_ptr = NULL;
4300                 next = 0;
4301         } else if (os_strncmp(cmd, "NEXT-", 5) == 0) {
4302                 if (hwaddr_aton(cmd + 5, addr) < 0)
4303                         return -1;
4304                 addr_ptr = addr;
4305                 next = 1;
4306         } else {
4307                 if (hwaddr_aton(cmd, addr) < 0)
4308                         return -1;
4309                 addr_ptr = addr;
4310                 next = 0;
4311         }
4312
4313         info = p2p_get_peer_info(wpa_s->global->p2p, addr_ptr, next);
4314         if (info == NULL)
4315                 return -1;
4316
4317         pos = buf;
4318         end = buf + buflen;
4319
4320         res = os_snprintf(pos, end - pos, MACSTR "\n"
4321                           "pri_dev_type=%s\n"
4322                           "device_name=%s\n"
4323                           "manufacturer=%s\n"
4324                           "model_name=%s\n"
4325                           "model_number=%s\n"
4326                           "serial_number=%s\n"
4327                           "config_methods=0x%x\n"
4328                           "dev_capab=0x%x\n"
4329                           "group_capab=0x%x\n"
4330                           "level=%d\n",
4331                           MAC2STR(info->p2p_device_addr),
4332                           wps_dev_type_bin2str(info->pri_dev_type,
4333                                                devtype, sizeof(devtype)),
4334                           info->device_name,
4335                           info->manufacturer,
4336                           info->model_name,
4337                           info->model_number,
4338                           info->serial_number,
4339                           info->config_methods,
4340                           info->dev_capab,
4341                           info->group_capab,
4342                           info->level);
4343         if (res < 0 || res >= end - pos)
4344                 return pos - buf;
4345         pos += res;
4346
4347         for (i = 0; i < info->wps_sec_dev_type_list_len / WPS_DEV_TYPE_LEN; i++)
4348         {
4349                 const u8 *t;
4350                 t = &info->wps_sec_dev_type_list[i * WPS_DEV_TYPE_LEN];
4351                 res = os_snprintf(pos, end - pos, "sec_dev_type=%s\n",
4352                                   wps_dev_type_bin2str(t, devtype,
4353                                                        sizeof(devtype)));
4354                 if (res < 0 || res >= end - pos)
4355                         return pos - buf;
4356                 pos += res;
4357         }
4358
4359         ssid = wpas_p2p_get_persistent(wpa_s, info->p2p_device_addr, NULL, 0);
4360         if (ssid) {
4361                 res = os_snprintf(pos, end - pos, "persistent=%d\n", ssid->id);
4362                 if (res < 0 || res >= end - pos)
4363                         return pos - buf;
4364                 pos += res;
4365         }
4366
4367         res = p2p_get_peer_info_txt(info, pos, end - pos);
4368         if (res < 0)
4369                 return pos - buf;
4370         pos += res;
4371
4372         return pos - buf;
4373 }
4374
4375
4376 static int p2p_ctrl_disallow_freq(struct wpa_supplicant *wpa_s,
4377                                   const char *param)
4378 {
4379         unsigned int i;
4380
4381         if (wpa_s->global->p2p == NULL)
4382                 return -1;
4383
4384         if (freq_range_list_parse(&wpa_s->global->p2p_disallow_freq, param) < 0)
4385                 return -1;
4386
4387         for (i = 0; i < wpa_s->global->p2p_disallow_freq.num; i++) {
4388                 struct wpa_freq_range *freq;
4389                 freq = &wpa_s->global->p2p_disallow_freq.range[i];
4390                 wpa_printf(MSG_DEBUG, "P2P: Disallowed frequency range %u-%u",
4391                            freq->min, freq->max);
4392         }
4393
4394         wpas_p2p_update_channel_list(wpa_s);
4395         return 0;
4396 }
4397
4398
4399 static int p2p_ctrl_set(struct wpa_supplicant *wpa_s, char *cmd)
4400 {
4401         char *param;
4402
4403         if (wpa_s->global->p2p == NULL)
4404                 return -1;
4405
4406         param = os_strchr(cmd, ' ');
4407         if (param == NULL)
4408                 return -1;
4409         *param++ = '\0';
4410
4411         if (os_strcmp(cmd, "discoverability") == 0) {
4412                 p2p_set_client_discoverability(wpa_s->global->p2p,
4413                                                atoi(param));
4414                 return 0;
4415         }
4416
4417         if (os_strcmp(cmd, "managed") == 0) {
4418                 p2p_set_managed_oper(wpa_s->global->p2p, atoi(param));
4419                 return 0;
4420         }
4421
4422         if (os_strcmp(cmd, "listen_channel") == 0) {
4423                 return p2p_set_listen_channel(wpa_s->global->p2p, 81,
4424                                               atoi(param));
4425         }
4426
4427         if (os_strcmp(cmd, "ssid_postfix") == 0) {
4428                 return p2p_set_ssid_postfix(wpa_s->global->p2p, (u8 *) param,
4429                                             os_strlen(param));
4430         }
4431
4432         if (os_strcmp(cmd, "noa") == 0) {
4433                 char *pos;
4434                 int count, start, duration;
4435                 /* GO NoA parameters: count,start_offset(ms),duration(ms) */
4436                 count = atoi(param);
4437                 pos = os_strchr(param, ',');
4438                 if (pos == NULL)
4439                         return -1;
4440                 pos++;
4441                 start = atoi(pos);
4442                 pos = os_strchr(pos, ',');
4443                 if (pos == NULL)
4444                         return -1;
4445                 pos++;
4446                 duration = atoi(pos);
4447                 if (count < 0 || count > 255 || start < 0 || duration < 0)
4448                         return -1;
4449                 if (count == 0 && duration > 0)
4450                         return -1;
4451                 wpa_printf(MSG_DEBUG, "CTRL_IFACE: P2P_SET GO NoA: count=%d "
4452                            "start=%d duration=%d", count, start, duration);
4453                 return wpas_p2p_set_noa(wpa_s, count, start, duration);
4454         }
4455
4456         if (os_strcmp(cmd, "ps") == 0)
4457                 return wpa_drv_set_p2p_powersave(wpa_s, atoi(param), -1, -1);
4458
4459         if (os_strcmp(cmd, "oppps") == 0)
4460                 return wpa_drv_set_p2p_powersave(wpa_s, -1, atoi(param), -1);
4461
4462         if (os_strcmp(cmd, "ctwindow") == 0)
4463                 return wpa_drv_set_p2p_powersave(wpa_s, -1, -1, atoi(param));
4464
4465         if (os_strcmp(cmd, "disabled") == 0) {
4466                 wpa_s->global->p2p_disabled = atoi(param);
4467                 wpa_printf(MSG_DEBUG, "P2P functionality %s",
4468                            wpa_s->global->p2p_disabled ?
4469                            "disabled" : "enabled");
4470                 if (wpa_s->global->p2p_disabled) {
4471                         wpas_p2p_stop_find(wpa_s);
4472                         os_memset(wpa_s->p2p_auth_invite, 0, ETH_ALEN);
4473                         p2p_flush(wpa_s->global->p2p);
4474                 }
4475                 return 0;
4476         }
4477
4478         if (os_strcmp(cmd, "conc_pref") == 0) {
4479                 if (os_strcmp(param, "sta") == 0)
4480                         wpa_s->global->conc_pref = WPA_CONC_PREF_STA;
4481                 else if (os_strcmp(param, "p2p") == 0)
4482                         wpa_s->global->conc_pref = WPA_CONC_PREF_P2P;
4483                 else {
4484                         wpa_printf(MSG_INFO, "Invalid conc_pref value");
4485                         return -1;
4486                 }
4487                 wpa_printf(MSG_DEBUG, "Single channel concurrency preference: "
4488                            "%s", param);
4489                 return 0;
4490         }
4491
4492         if (os_strcmp(cmd, "force_long_sd") == 0) {
4493                 wpa_s->force_long_sd = atoi(param);
4494                 return 0;
4495         }
4496
4497         if (os_strcmp(cmd, "peer_filter") == 0) {
4498                 u8 addr[ETH_ALEN];
4499                 if (hwaddr_aton(param, addr))
4500                         return -1;
4501                 p2p_set_peer_filter(wpa_s->global->p2p, addr);
4502                 return 0;
4503         }
4504
4505         if (os_strcmp(cmd, "cross_connect") == 0)
4506                 return wpas_p2p_set_cross_connect(wpa_s, atoi(param));
4507
4508         if (os_strcmp(cmd, "go_apsd") == 0) {
4509                 if (os_strcmp(param, "disable") == 0)
4510                         wpa_s->set_ap_uapsd = 0;
4511                 else {
4512                         wpa_s->set_ap_uapsd = 1;
4513                         wpa_s->ap_uapsd = atoi(param);
4514                 }
4515                 return 0;
4516         }
4517
4518         if (os_strcmp(cmd, "client_apsd") == 0) {
4519                 if (os_strcmp(param, "disable") == 0)
4520                         wpa_s->set_sta_uapsd = 0;
4521                 else {
4522                         int be, bk, vi, vo;
4523                         char *pos;
4524                         /* format: BE,BK,VI,VO;max SP Length */
4525                         be = atoi(param);
4526                         pos = os_strchr(param, ',');
4527                         if (pos == NULL)
4528                                 return -1;
4529                         pos++;
4530                         bk = atoi(pos);
4531                         pos = os_strchr(pos, ',');
4532                         if (pos == NULL)
4533                                 return -1;
4534                         pos++;
4535                         vi = atoi(pos);
4536                         pos = os_strchr(pos, ',');
4537                         if (pos == NULL)
4538                                 return -1;
4539                         pos++;
4540                         vo = atoi(pos);
4541                         /* ignore max SP Length for now */
4542
4543                         wpa_s->set_sta_uapsd = 1;
4544                         wpa_s->sta_uapsd = 0;
4545                         if (be)
4546                                 wpa_s->sta_uapsd |= BIT(0);
4547                         if (bk)
4548                                 wpa_s->sta_uapsd |= BIT(1);
4549                         if (vi)
4550                                 wpa_s->sta_uapsd |= BIT(2);
4551                         if (vo)
4552                                 wpa_s->sta_uapsd |= BIT(3);
4553                 }
4554                 return 0;
4555         }
4556
4557         if (os_strcmp(cmd, "disallow_freq") == 0)
4558                 return p2p_ctrl_disallow_freq(wpa_s, param);
4559
4560         if (os_strcmp(cmd, "disc_int") == 0) {
4561                 int min_disc_int, max_disc_int, max_disc_tu;
4562                 char *pos;
4563
4564                 pos = param;
4565
4566                 min_disc_int = atoi(pos);
4567                 pos = os_strchr(pos, ' ');
4568                 if (pos == NULL)
4569                         return -1;
4570                 *pos++ = '\0';
4571
4572                 max_disc_int = atoi(pos);
4573                 pos = os_strchr(pos, ' ');
4574                 if (pos == NULL)
4575                         return -1;
4576                 *pos++ = '\0';
4577
4578                 max_disc_tu = atoi(pos);
4579
4580                 return p2p_set_disc_int(wpa_s->global->p2p, min_disc_int,
4581                                         max_disc_int, max_disc_tu);
4582         }
4583
4584         if (os_strcmp(cmd, "per_sta_psk") == 0) {
4585                 wpa_s->global->p2p_per_sta_psk = !!atoi(param);
4586                 return 0;
4587         }
4588
4589         wpa_printf(MSG_DEBUG, "CTRL_IFACE: Unknown P2P_SET field value '%s'",
4590                    cmd);
4591
4592         return -1;
4593 }
4594
4595
4596 static void p2p_ctrl_flush(struct wpa_supplicant *wpa_s)
4597 {
4598         os_memset(wpa_s->p2p_auth_invite, 0, ETH_ALEN);
4599         wpa_s->force_long_sd = 0;
4600         if (wpa_s->global->p2p)
4601                 p2p_flush(wpa_s->global->p2p);
4602 }
4603
4604
4605 static int p2p_ctrl_presence_req(struct wpa_supplicant *wpa_s, char *cmd)
4606 {
4607         char *pos, *pos2;
4608         unsigned int dur1 = 0, int1 = 0, dur2 = 0, int2 = 0;
4609
4610         if (cmd[0]) {
4611                 pos = os_strchr(cmd, ' ');
4612                 if (pos == NULL)
4613                         return -1;
4614                 *pos++ = '\0';
4615                 dur1 = atoi(cmd);
4616
4617                 pos2 = os_strchr(pos, ' ');
4618                 if (pos2)
4619                         *pos2++ = '\0';
4620                 int1 = atoi(pos);
4621         } else
4622                 pos2 = NULL;
4623
4624         if (pos2) {
4625                 pos = os_strchr(pos2, ' ');
4626                 if (pos == NULL)
4627                         return -1;
4628                 *pos++ = '\0';
4629                 dur2 = atoi(pos2);
4630                 int2 = atoi(pos);
4631         }
4632
4633         return wpas_p2p_presence_req(wpa_s, dur1, int1, dur2, int2);
4634 }
4635
4636
4637 static int p2p_ctrl_ext_listen(struct wpa_supplicant *wpa_s, char *cmd)
4638 {
4639         char *pos;
4640         unsigned int period = 0, interval = 0;
4641
4642         if (cmd[0]) {
4643                 pos = os_strchr(cmd, ' ');
4644                 if (pos == NULL)
4645                         return -1;
4646                 *pos++ = '\0';
4647                 period = atoi(cmd);
4648                 interval = atoi(pos);
4649         }
4650
4651         return wpas_p2p_ext_listen(wpa_s, period, interval);
4652 }
4653
4654
4655 static int p2p_ctrl_remove_client(struct wpa_supplicant *wpa_s, const char *cmd)
4656 {
4657         const char *pos;
4658         u8 peer[ETH_ALEN];
4659         int iface_addr = 0;
4660
4661         pos = cmd;
4662         if (os_strncmp(pos, "iface=", 6) == 0) {
4663                 iface_addr = 1;
4664                 pos += 6;
4665         }
4666         if (hwaddr_aton(pos, peer))
4667                 return -1;
4668
4669         wpas_p2p_remove_client(wpa_s, peer, iface_addr);
4670         return 0;
4671 }
4672
4673 #endif /* CONFIG_P2P */
4674
4675
4676 static int * freq_range_to_channel_list(struct wpa_supplicant *wpa_s, char *val)
4677 {
4678         struct wpa_freq_range_list ranges;
4679         int *freqs = NULL;
4680         struct hostapd_hw_modes *mode;
4681         u16 i;
4682
4683         if (wpa_s->hw.modes == NULL)
4684                 return NULL;
4685
4686         os_memset(&ranges, 0, sizeof(ranges));
4687         if (freq_range_list_parse(&ranges, val) < 0)
4688                 return NULL;
4689
4690         for (i = 0; i < wpa_s->hw.num_modes; i++) {
4691                 int j;
4692
4693                 mode = &wpa_s->hw.modes[i];
4694                 for (j = 0; j < mode->num_channels; j++) {
4695                         unsigned int freq;
4696
4697                         if (mode->channels[j].flag & HOSTAPD_CHAN_DISABLED)
4698                                 continue;
4699
4700                         freq = mode->channels[j].freq;
4701                         if (!freq_range_list_includes(&ranges, freq))
4702                                 continue;
4703
4704                         int_array_add_unique(&freqs, freq);
4705                 }
4706         }
4707
4708         os_free(ranges.range);
4709         return freqs;
4710 }
4711
4712
4713 #ifdef CONFIG_INTERWORKING
4714
4715 static int ctrl_interworking_select(struct wpa_supplicant *wpa_s, char *param)
4716 {
4717         int auto_sel = 0;
4718         int *freqs = NULL;
4719
4720         if (param) {
4721                 char *pos;
4722
4723                 auto_sel = os_strstr(param, "auto") != NULL;
4724
4725                 pos = os_strstr(param, "freq=");
4726                 if (pos) {
4727                         freqs = freq_range_to_channel_list(wpa_s, pos + 5);
4728                         if (freqs == NULL)
4729                                 return -1;
4730                 }
4731
4732         }
4733
4734         return interworking_select(wpa_s, auto_sel, freqs);
4735 }
4736
4737
4738 static int ctrl_interworking_connect(struct wpa_supplicant *wpa_s, char *dst)
4739 {
4740         u8 bssid[ETH_ALEN];
4741         struct wpa_bss *bss;
4742
4743         if (hwaddr_aton(dst, bssid)) {
4744                 wpa_printf(MSG_DEBUG, "Invalid BSSID '%s'", dst);
4745                 return -1;
4746         }
4747
4748         bss = wpa_bss_get_bssid(wpa_s, bssid);
4749         if (bss == NULL) {
4750                 wpa_printf(MSG_DEBUG, "Could not find BSS " MACSTR,
4751                            MAC2STR(bssid));
4752                 return -1;
4753         }
4754
4755         return interworking_connect(wpa_s, bss);
4756 }
4757
4758
4759 static int get_anqp(struct wpa_supplicant *wpa_s, char *dst)
4760 {
4761         u8 dst_addr[ETH_ALEN];
4762         int used;
4763         char *pos;
4764 #define MAX_ANQP_INFO_ID 100
4765         u16 id[MAX_ANQP_INFO_ID];
4766         size_t num_id = 0;
4767
4768         used = hwaddr_aton2(dst, dst_addr);
4769         if (used < 0)
4770                 return -1;
4771         pos = dst + used;
4772         while (num_id < MAX_ANQP_INFO_ID) {
4773                 id[num_id] = atoi(pos);
4774                 if (id[num_id])
4775                         num_id++;
4776                 pos = os_strchr(pos + 1, ',');
4777                 if (pos == NULL)
4778                         break;
4779                 pos++;
4780         }
4781
4782         if (num_id == 0)
4783                 return -1;
4784
4785         return anqp_send_req(wpa_s, dst_addr, id, num_id);
4786 }
4787
4788
4789 static int gas_request(struct wpa_supplicant *wpa_s, char *cmd)
4790 {
4791         u8 dst_addr[ETH_ALEN];
4792         struct wpabuf *advproto, *query = NULL;
4793         int used, ret = -1;
4794         char *pos, *end;
4795         size_t len;
4796
4797         used = hwaddr_aton2(cmd, dst_addr);
4798         if (used < 0)
4799                 return -1;
4800
4801         pos = cmd + used;
4802         while (*pos == ' ')
4803                 pos++;
4804
4805         /* Advertisement Protocol ID */
4806         end = os_strchr(pos, ' ');
4807         if (end)
4808                 len = end - pos;
4809         else
4810                 len = os_strlen(pos);
4811         if (len & 0x01)
4812                 return -1;
4813         len /= 2;
4814         if (len == 0)
4815                 return -1;
4816         advproto = wpabuf_alloc(len);
4817         if (advproto == NULL)
4818                 return -1;
4819         if (hexstr2bin(pos, wpabuf_put(advproto, len), len) < 0)
4820                 goto fail;
4821
4822         if (end) {
4823                 /* Optional Query Request */
4824                 pos = end + 1;
4825                 while (*pos == ' ')
4826                         pos++;
4827
4828                 len = os_strlen(pos);
4829                 if (len) {
4830                         if (len & 0x01)
4831                                 goto fail;
4832                         len /= 2;
4833                         if (len == 0)
4834                                 goto fail;
4835                         query = wpabuf_alloc(len);
4836                         if (query == NULL)
4837                                 goto fail;
4838                         if (hexstr2bin(pos, wpabuf_put(query, len), len) < 0)
4839                                 goto fail;
4840                 }
4841         }
4842
4843         ret = gas_send_request(wpa_s, dst_addr, advproto, query);
4844
4845 fail:
4846         wpabuf_free(advproto);
4847         wpabuf_free(query);
4848
4849         return ret;
4850 }
4851
4852
4853 static int gas_response_get(struct wpa_supplicant *wpa_s, char *cmd, char *buf,
4854                             size_t buflen)
4855 {
4856         u8 addr[ETH_ALEN];
4857         int dialog_token;
4858         int used;
4859         char *pos;
4860         size_t resp_len, start, requested_len;
4861         struct wpabuf *resp;
4862         int ret;
4863
4864         used = hwaddr_aton2(cmd, addr);
4865         if (used < 0)
4866                 return -1;
4867
4868         pos = cmd + used;
4869         while (*pos == ' ')
4870                 pos++;
4871         dialog_token = atoi(pos);
4872
4873         if (wpa_s->last_gas_resp &&
4874             os_memcmp(addr, wpa_s->last_gas_addr, ETH_ALEN) == 0 &&
4875             dialog_token == wpa_s->last_gas_dialog_token)
4876                 resp = wpa_s->last_gas_resp;
4877         else if (wpa_s->prev_gas_resp &&
4878                  os_memcmp(addr, wpa_s->prev_gas_addr, ETH_ALEN) == 0 &&
4879                  dialog_token == wpa_s->prev_gas_dialog_token)
4880                 resp = wpa_s->prev_gas_resp;
4881         else
4882                 return -1;
4883
4884         resp_len = wpabuf_len(resp);
4885         start = 0;
4886         requested_len = resp_len;
4887
4888         pos = os_strchr(pos, ' ');
4889         if (pos) {
4890                 start = atoi(pos);
4891                 if (start > resp_len)
4892                         return os_snprintf(buf, buflen, "FAIL-Invalid range");
4893                 pos = os_strchr(pos, ',');
4894                 if (pos == NULL)
4895                         return -1;
4896                 pos++;
4897                 requested_len = atoi(pos);
4898                 if (start + requested_len > resp_len)
4899                         return os_snprintf(buf, buflen, "FAIL-Invalid range");
4900         }
4901
4902         if (requested_len * 2 + 1 > buflen)
4903                 return os_snprintf(buf, buflen, "FAIL-Too long response");
4904
4905         ret = wpa_snprintf_hex(buf, buflen, wpabuf_head_u8(resp) + start,
4906                                requested_len);
4907
4908         if (start + requested_len == resp_len) {
4909                 /*
4910                  * Free memory by dropping the response after it has been
4911                  * fetched.
4912                  */
4913                 if (resp == wpa_s->prev_gas_resp) {
4914                         wpabuf_free(wpa_s->prev_gas_resp);
4915                         wpa_s->prev_gas_resp = NULL;
4916                 } else {
4917                         wpabuf_free(wpa_s->last_gas_resp);
4918                         wpa_s->last_gas_resp = NULL;
4919                 }
4920         }
4921
4922         return ret;
4923 }
4924 #endif /* CONFIG_INTERWORKING */
4925
4926
4927 #ifdef CONFIG_HS20
4928
4929 static int get_hs20_anqp(struct wpa_supplicant *wpa_s, char *dst)
4930 {
4931         u8 dst_addr[ETH_ALEN];
4932         int used;
4933         char *pos;
4934         u32 subtypes = 0;
4935
4936         used = hwaddr_aton2(dst, dst_addr);
4937         if (used < 0)
4938                 return -1;
4939         pos = dst + used;
4940         for (;;) {
4941                 int num = atoi(pos);
4942                 if (num <= 0 || num > 31)
4943                         return -1;
4944                 subtypes |= BIT(num);
4945                 pos = os_strchr(pos + 1, ',');
4946                 if (pos == NULL)
4947                         break;
4948                 pos++;
4949         }
4950
4951         if (subtypes == 0)
4952                 return -1;
4953
4954         return hs20_anqp_send_req(wpa_s, dst_addr, subtypes, NULL, 0);
4955 }
4956
4957
4958 static int hs20_nai_home_realm_list(struct wpa_supplicant *wpa_s,
4959                                     const u8 *addr, const char *realm)
4960 {
4961         u8 *buf;
4962         size_t rlen, len;
4963         int ret;
4964
4965         rlen = os_strlen(realm);
4966         len = 3 + rlen;
4967         buf = os_malloc(len);
4968         if (buf == NULL)
4969                 return -1;
4970         buf[0] = 1; /* NAI Home Realm Count */
4971         buf[1] = 0; /* Formatted in accordance with RFC 4282 */
4972         buf[2] = rlen;
4973         os_memcpy(buf + 3, realm, rlen);
4974
4975         ret = hs20_anqp_send_req(wpa_s, addr,
4976                                  BIT(HS20_STYPE_NAI_HOME_REALM_QUERY),
4977                                  buf, len);
4978
4979         os_free(buf);
4980
4981         return ret;
4982 }
4983
4984
4985 static int hs20_get_nai_home_realm_list(struct wpa_supplicant *wpa_s,
4986                                         char *dst)
4987 {
4988         struct wpa_cred *cred = wpa_s->conf->cred;
4989         u8 dst_addr[ETH_ALEN];
4990         int used;
4991         u8 *buf;
4992         size_t len;
4993         int ret;
4994
4995         used = hwaddr_aton2(dst, dst_addr);
4996         if (used < 0)
4997                 return -1;
4998
4999         while (dst[used] == ' ')
5000                 used++;
5001         if (os_strncmp(dst + used, "realm=", 6) == 0)
5002                 return hs20_nai_home_realm_list(wpa_s, dst_addr,
5003                                                 dst + used + 6);
5004
5005         len = os_strlen(dst + used);
5006
5007         if (len == 0 && cred && cred->realm)
5008                 return hs20_nai_home_realm_list(wpa_s, dst_addr, cred->realm);
5009
5010         if (len % 1)
5011                 return -1;
5012         len /= 2;
5013         buf = os_malloc(len);
5014         if (buf == NULL)
5015                 return -1;
5016         if (hexstr2bin(dst + used, buf, len) < 0) {
5017                 os_free(buf);
5018                 return -1;
5019         }
5020
5021         ret = hs20_anqp_send_req(wpa_s, dst_addr,
5022                                  BIT(HS20_STYPE_NAI_HOME_REALM_QUERY),
5023                                  buf, len);
5024         os_free(buf);
5025
5026         return ret;
5027 }
5028
5029 #endif /* CONFIG_HS20 */
5030
5031
5032 static int wpa_supplicant_ctrl_iface_sta_autoconnect(
5033         struct wpa_supplicant *wpa_s, char *cmd)
5034 {
5035         wpa_s->auto_reconnect_disabled = atoi(cmd) == 0 ? 1 : 0;
5036         return 0;
5037 }
5038
5039
5040 #ifdef CONFIG_AUTOSCAN
5041
5042 static int wpa_supplicant_ctrl_iface_autoscan(struct wpa_supplicant *wpa_s,
5043                                               char *cmd)
5044 {
5045         enum wpa_states state = wpa_s->wpa_state;
5046         char *new_params = NULL;
5047
5048         if (os_strlen(cmd) > 0) {
5049                 new_params = os_strdup(cmd);
5050                 if (new_params == NULL)
5051                         return -1;
5052         }
5053
5054         os_free(wpa_s->conf->autoscan);
5055         wpa_s->conf->autoscan = new_params;
5056
5057         if (wpa_s->conf->autoscan == NULL)
5058                 autoscan_deinit(wpa_s);
5059         else if (state == WPA_DISCONNECTED || state == WPA_INACTIVE)
5060                 autoscan_init(wpa_s, 1);
5061         else if (state == WPA_SCANNING)
5062                 wpa_supplicant_reinit_autoscan(wpa_s);
5063
5064         return 0;
5065 }
5066
5067 #endif /* CONFIG_AUTOSCAN */
5068
5069
5070 #ifdef CONFIG_WNM
5071
5072 static int wpas_ctrl_iface_wnm_sleep(struct wpa_supplicant *wpa_s, char *cmd)
5073 {
5074         int enter;
5075         int intval = 0;
5076         char *pos;
5077         int ret;
5078         struct wpabuf *tfs_req = NULL;
5079
5080         if (os_strncmp(cmd, "enter", 5) == 0)
5081                 enter = 1;
5082         else if (os_strncmp(cmd, "exit", 4) == 0)
5083                 enter = 0;
5084         else
5085                 return -1;
5086
5087         pos = os_strstr(cmd, " interval=");
5088         if (pos)
5089                 intval = atoi(pos + 10);
5090
5091         pos = os_strstr(cmd, " tfs_req=");
5092         if (pos) {
5093                 char *end;
5094                 size_t len;
5095                 pos += 9;
5096                 end = os_strchr(pos, ' ');
5097                 if (end)
5098                         len = end - pos;
5099                 else
5100                         len = os_strlen(pos);
5101                 if (len & 1)
5102                         return -1;
5103                 len /= 2;
5104                 tfs_req = wpabuf_alloc(len);
5105                 if (tfs_req == NULL)
5106                         return -1;
5107                 if (hexstr2bin(pos, wpabuf_put(tfs_req, len), len) < 0) {
5108                         wpabuf_free(tfs_req);
5109                         return -1;
5110                 }
5111         }
5112
5113         ret = ieee802_11_send_wnmsleep_req(wpa_s, enter ? WNM_SLEEP_MODE_ENTER :
5114                                            WNM_SLEEP_MODE_EXIT, intval,
5115                                            tfs_req);
5116         wpabuf_free(tfs_req);
5117
5118         return ret;
5119 }
5120
5121
5122 static int wpas_ctrl_iface_wnm_bss_query(struct wpa_supplicant *wpa_s, char *cmd)
5123 {
5124         int query_reason;
5125
5126         query_reason = atoi(cmd);
5127
5128         wpa_printf(MSG_DEBUG, "CTRL_IFACE: WNM_BSS_QUERY query_reason=%d",
5129                    query_reason);
5130
5131         return wnm_send_bss_transition_mgmt_query(wpa_s, query_reason);
5132 }
5133
5134 #endif /* CONFIG_WNM */
5135
5136
5137 /* Get string representation of channel width */
5138 static const char * channel_width_name(enum chan_width width)
5139 {
5140         switch (width) {
5141         case CHAN_WIDTH_20_NOHT:
5142                 return "20 MHz (no HT)";
5143         case CHAN_WIDTH_20:
5144                 return "20 MHz";
5145         case CHAN_WIDTH_40:
5146                 return "40 MHz";
5147         case CHAN_WIDTH_80:
5148                 return "80 MHz";
5149         case CHAN_WIDTH_80P80:
5150                 return "80+80 MHz";
5151         case CHAN_WIDTH_160:
5152                 return "160 MHz";
5153         default:
5154                 return "unknown";
5155         }
5156 }
5157
5158
5159 static int wpa_supplicant_signal_poll(struct wpa_supplicant *wpa_s, char *buf,
5160                                       size_t buflen)
5161 {
5162         struct wpa_signal_info si;
5163         int ret;
5164         char *pos, *end;
5165
5166         ret = wpa_drv_signal_poll(wpa_s, &si);
5167         if (ret)
5168                 return -1;
5169
5170         pos = buf;
5171         end = buf + buflen;
5172
5173         ret = os_snprintf(pos, end - pos, "RSSI=%d\nLINKSPEED=%d\n"
5174                           "NOISE=%d\nFREQUENCY=%u\n",
5175                           si.current_signal, si.current_txrate / 1000,
5176                           si.current_noise, si.frequency);
5177         if (ret < 0 || ret > end - pos)
5178                 return -1;
5179         pos += ret;
5180
5181         if (si.chanwidth != CHAN_WIDTH_UNKNOWN) {
5182                 ret = os_snprintf(pos, end - pos, "WIDTH=%s\n",
5183                                   channel_width_name(si.chanwidth));
5184                 if (ret < 0 || ret > end - pos)
5185                         return -1;
5186                 pos += ret;
5187         }
5188
5189         if (si.center_frq1 > 0 && si.center_frq2 > 0) {
5190                 ret = os_snprintf(pos, end - pos,
5191                                   "CENTER_FRQ1=%d\nCENTER_FRQ2=%d\n",
5192                                   si.center_frq1, si.center_frq2);
5193                 if (ret < 0 || ret > end - pos)
5194                         return -1;
5195                 pos += ret;
5196         }
5197
5198         if (si.avg_signal) {
5199                 ret = os_snprintf(pos, end - pos,
5200                                   "AVG_RSSI=%d\n", si.avg_signal);
5201                 if (ret < 0 || ret >= end - pos)
5202                         return -1;
5203                 pos += ret;
5204         }
5205
5206         return pos - buf;
5207 }
5208
5209
5210 static int wpa_supplicant_pktcnt_poll(struct wpa_supplicant *wpa_s, char *buf,
5211                                       size_t buflen)
5212 {
5213         struct hostap_sta_driver_data sta;
5214         int ret;
5215
5216         ret = wpa_drv_pktcnt_poll(wpa_s, &sta);
5217         if (ret)
5218                 return -1;
5219
5220         ret = os_snprintf(buf, buflen, "TXGOOD=%lu\nTXBAD=%lu\nRXGOOD=%lu\n",
5221                           sta.tx_packets, sta.tx_retry_failed, sta.rx_packets);
5222         if (ret < 0 || (size_t) ret > buflen)
5223                 return -1;
5224         return ret;
5225 }
5226
5227
5228 #ifdef ANDROID
5229 static int wpa_supplicant_driver_cmd(struct wpa_supplicant *wpa_s, char *cmd,
5230                                      char *buf, size_t buflen)
5231 {
5232         int ret;
5233
5234         ret = wpa_drv_driver_cmd(wpa_s, cmd, buf, buflen);
5235         if (ret == 0) {
5236                 if (os_strncasecmp(cmd, "COUNTRY", 7) == 0) {
5237                         struct p2p_data *p2p = wpa_s->global->p2p;
5238                         if (p2p) {
5239                                 char country[3];
5240                                 country[0] = cmd[8];
5241                                 country[1] = cmd[9];
5242                                 country[2] = 0x04;
5243                                 p2p_set_country(p2p, country);
5244                         }
5245                 }
5246                 ret = os_snprintf(buf, buflen, "%s\n", "OK");
5247         }
5248         return ret;
5249 }
5250 #endif /* ANDROID */
5251
5252
5253 static void wpa_supplicant_ctrl_iface_flush(struct wpa_supplicant *wpa_s)
5254 {
5255         wpa_dbg(wpa_s, MSG_DEBUG, "Flush all wpa_supplicant state");
5256
5257 #ifdef CONFIG_P2P
5258         wpas_p2p_stop_find(wpa_s);
5259         p2p_ctrl_flush(wpa_s);
5260         wpas_p2p_group_remove(wpa_s, "*");
5261         wpas_p2p_service_flush(wpa_s);
5262         wpa_s->global->p2p_disabled = 0;
5263         wpa_s->global->p2p_per_sta_psk = 0;
5264         wpa_s->conf->num_sec_device_types = 0;
5265 #endif /* CONFIG_P2P */
5266
5267 #ifdef CONFIG_WPS_TESTING
5268         wps_version_number = 0x20;
5269         wps_testing_dummy_cred = 0;
5270 #endif /* CONFIG_WPS_TESTING */
5271 #ifdef CONFIG_WPS
5272         wpa_s->wps_fragment_size = 0;
5273         wpas_wps_cancel(wpa_s);
5274 #endif /* CONFIG_WPS */
5275         wpa_s->after_wps = 0;
5276         wpa_s->known_wps_freq = 0;
5277
5278 #ifdef CONFIG_TDLS
5279 #ifdef CONFIG_TDLS_TESTING
5280         extern unsigned int tdls_testing;
5281         tdls_testing = 0;
5282 #endif /* CONFIG_TDLS_TESTING */
5283         wpa_drv_tdls_oper(wpa_s, TDLS_ENABLE, NULL);
5284         wpa_tdls_enable(wpa_s->wpa, 1);
5285 #endif /* CONFIG_TDLS */
5286
5287         eloop_cancel_timeout(wpa_supplicant_stop_countermeasures, wpa_s, NULL);
5288         wpa_supplicant_stop_countermeasures(wpa_s, NULL);
5289
5290         wpa_s->no_keep_alive = 0;
5291
5292         os_free(wpa_s->disallow_aps_bssid);
5293         wpa_s->disallow_aps_bssid = NULL;
5294         wpa_s->disallow_aps_bssid_count = 0;
5295         os_free(wpa_s->disallow_aps_ssid);
5296         wpa_s->disallow_aps_ssid = NULL;
5297         wpa_s->disallow_aps_ssid_count = 0;
5298
5299         wpa_s->set_sta_uapsd = 0;
5300         wpa_s->sta_uapsd = 0;
5301
5302         wpa_drv_radio_disable(wpa_s, 0);
5303
5304         wpa_bss_flush(wpa_s);
5305         wpa_blacklist_clear(wpa_s);
5306         wpa_s->extra_blacklist_count = 0;
5307         wpa_supplicant_ctrl_iface_remove_network(wpa_s, "all");
5308         wpa_supplicant_ctrl_iface_remove_cred(wpa_s, "all");
5309         wpa_config_flush_blobs(wpa_s->conf);
5310
5311         wpa_sm_set_param(wpa_s->wpa, RSNA_PMK_LIFETIME, 43200);
5312         wpa_sm_set_param(wpa_s->wpa, RSNA_PMK_REAUTH_THRESHOLD, 70);
5313         wpa_sm_set_param(wpa_s->wpa, RSNA_SA_TIMEOUT, 60);
5314         eapol_sm_notify_logoff(wpa_s->eapol, FALSE);
5315
5316         radio_remove_unstarted_work(wpa_s, NULL);
5317 }
5318
5319
5320 static int wpas_ctrl_radio_work_show(struct wpa_supplicant *wpa_s,
5321                                      char *buf, size_t buflen)
5322 {
5323         struct wpa_radio_work *work;
5324         char *pos, *end;
5325         struct os_reltime now, diff;
5326
5327         pos = buf;
5328         end = buf + buflen;
5329
5330         os_get_reltime(&now);
5331
5332         dl_list_for_each(work, &wpa_s->radio->work, struct wpa_radio_work, list)
5333         {
5334                 int ret;
5335
5336                 os_reltime_sub(&now, &work->time, &diff);
5337                 ret = os_snprintf(pos, end - pos, "%s@%s:%u:%u:%ld.%06ld\n",
5338                                   work->type, work->wpa_s->ifname, work->freq,
5339                                   work->started, diff.sec, diff.usec);
5340                 if (ret < 0 || ret >= end - pos)
5341                         break;
5342                 pos += ret;
5343         }
5344
5345         return pos - buf;
5346 }
5347
5348
5349 static void wpas_ctrl_radio_work_timeout(void *eloop_ctx, void *timeout_ctx)
5350 {
5351         struct wpa_radio_work *work = eloop_ctx;
5352         struct wpa_external_work *ework = work->ctx;
5353
5354         wpa_dbg(work->wpa_s, MSG_DEBUG,
5355                 "Timing out external radio work %u (%s)",
5356                 ework->id, work->type);
5357         wpa_msg(work->wpa_s, MSG_INFO, EXT_RADIO_WORK_TIMEOUT "%u", ework->id);
5358         os_free(ework);
5359         radio_work_done(work);
5360 }
5361
5362
5363 static void wpas_ctrl_radio_work_cb(struct wpa_radio_work *work, int deinit)
5364 {
5365         struct wpa_external_work *ework = work->ctx;
5366
5367         if (deinit) {
5368                 os_free(ework);
5369                 return;
5370         }
5371
5372         wpa_dbg(work->wpa_s, MSG_DEBUG, "Starting external radio work %u (%s)",
5373                 ework->id, ework->type);
5374         wpa_msg(work->wpa_s, MSG_INFO, EXT_RADIO_WORK_START "%u", ework->id);
5375         if (!ework->timeout)
5376                 ework->timeout = 10;
5377         eloop_register_timeout(ework->timeout, 0, wpas_ctrl_radio_work_timeout,
5378                                work, NULL);
5379 }
5380
5381
5382 static int wpas_ctrl_radio_work_add(struct wpa_supplicant *wpa_s, char *cmd,
5383                                     char *buf, size_t buflen)
5384 {
5385         struct wpa_external_work *ework;
5386         char *pos, *pos2;
5387         size_t type_len;
5388         int ret;
5389         unsigned int freq = 0;
5390
5391         /* format: <name> [freq=<MHz>] [timeout=<seconds>] */
5392
5393         ework = os_zalloc(sizeof(*ework));
5394         if (ework == NULL)
5395                 return -1;
5396
5397         pos = os_strchr(cmd, ' ');
5398         if (pos) {
5399                 type_len = pos - cmd;
5400                 pos++;
5401
5402                 pos2 = os_strstr(pos, "freq=");
5403                 if (pos2)
5404                         freq = atoi(pos2 + 5);
5405
5406                 pos2 = os_strstr(pos, "timeout=");
5407                 if (pos2)
5408                         ework->timeout = atoi(pos2 + 8);
5409         } else {
5410                 type_len = os_strlen(cmd);
5411         }
5412         if (4 + type_len >= sizeof(ework->type))
5413                 type_len = sizeof(ework->type) - 4 - 1;
5414         os_strlcpy(ework->type, "ext:", sizeof(ework->type));
5415         os_memcpy(ework->type + 4, cmd, type_len);
5416         ework->type[4 + type_len] = '\0';
5417
5418         wpa_s->ext_work_id++;
5419         if (wpa_s->ext_work_id == 0)
5420                 wpa_s->ext_work_id++;
5421         ework->id = wpa_s->ext_work_id;
5422
5423         if (radio_add_work(wpa_s, freq, ework->type, 0, wpas_ctrl_radio_work_cb,
5424                            ework) < 0) {
5425                 os_free(ework);
5426                 return -1;
5427         }
5428
5429         ret = os_snprintf(buf, buflen, "%u", ework->id);
5430         if (ret < 0 || (size_t) ret >= buflen)
5431                 return -1;
5432         return ret;
5433 }
5434
5435
5436 static int wpas_ctrl_radio_work_done(struct wpa_supplicant *wpa_s, char *cmd)
5437 {
5438         struct wpa_radio_work *work;
5439         unsigned int id = atoi(cmd);
5440
5441         dl_list_for_each(work, &wpa_s->radio->work, struct wpa_radio_work, list)
5442         {
5443                 struct wpa_external_work *ework;
5444
5445                 if (os_strncmp(work->type, "ext:", 4) != 0)
5446                         continue;
5447                 ework = work->ctx;
5448                 if (id && ework->id != id)
5449                         continue;
5450                 wpa_dbg(wpa_s, MSG_DEBUG,
5451                         "Completed external radio work %u (%s)",
5452                         ework->id, ework->type);
5453                 eloop_cancel_timeout(wpas_ctrl_radio_work_timeout, work, NULL);
5454                 os_free(ework);
5455                 radio_work_done(work);
5456                 return 3; /* "OK\n" */
5457         }
5458
5459         return -1;
5460 }
5461
5462
5463 static int wpas_ctrl_radio_work(struct wpa_supplicant *wpa_s, char *cmd,
5464                                 char *buf, size_t buflen)
5465 {
5466         if (os_strcmp(cmd, "show") == 0)
5467                 return wpas_ctrl_radio_work_show(wpa_s, buf, buflen);
5468         if (os_strncmp(cmd, "add ", 4) == 0)
5469                 return wpas_ctrl_radio_work_add(wpa_s, cmd + 4, buf, buflen);
5470         if (os_strncmp(cmd, "done ", 5) == 0)
5471                 return wpas_ctrl_radio_work_done(wpa_s, cmd + 4);
5472         return -1;
5473 }
5474
5475
5476 void wpas_ctrl_radio_work_flush(struct wpa_supplicant *wpa_s)
5477 {
5478         struct wpa_radio_work *work, *tmp;
5479
5480         if (!wpa_s || !wpa_s->radio)
5481                 return;
5482
5483         dl_list_for_each_safe(work, tmp, &wpa_s->radio->work,
5484                               struct wpa_radio_work, list) {
5485                 struct wpa_external_work *ework;
5486
5487                 if (os_strncmp(work->type, "ext:", 4) != 0)
5488                         continue;
5489                 ework = work->ctx;
5490                 wpa_dbg(wpa_s, MSG_DEBUG,
5491                         "Flushing %sexternal radio work %u (%s)",
5492                         work->started ? " started" : "", ework->id,
5493                         ework->type);
5494                 if (work->started)
5495                         eloop_cancel_timeout(wpas_ctrl_radio_work_timeout,
5496                                              work, NULL);
5497                 os_free(ework);
5498                 radio_work_done(work);
5499         }
5500 }
5501
5502
5503 static void wpas_ctrl_eapol_response(void *eloop_ctx, void *timeout_ctx)
5504 {
5505         struct wpa_supplicant *wpa_s = eloop_ctx;
5506         eapol_sm_notify_ctrl_response(wpa_s->eapol);
5507 }
5508
5509
5510 static int set_scan_freqs(struct wpa_supplicant *wpa_s, char *val)
5511 {
5512         int *freqs = NULL;
5513
5514         freqs = freq_range_to_channel_list(wpa_s, val);
5515         if (freqs == NULL)
5516                 return -1;
5517
5518         os_free(wpa_s->manual_scan_freqs);
5519         wpa_s->manual_scan_freqs = freqs;
5520
5521         return 0;
5522 }
5523
5524
5525 static void wpas_ctrl_scan(struct wpa_supplicant *wpa_s, char *params,
5526                            char *reply, int reply_size, int *reply_len)
5527 {
5528         char *pos;
5529
5530         if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED) {
5531                 *reply_len = -1;
5532                 return;
5533         }
5534
5535         wpa_s->manual_scan_passive = 0;
5536         wpa_s->manual_scan_use_id = 0;
5537         wpa_s->manual_scan_only_new = 0;
5538
5539         if (params) {
5540                 if (os_strncasecmp(params, "TYPE=ONLY", 9) == 0)
5541                         wpa_s->scan_res_handler = scan_only_handler;
5542
5543                 pos = os_strstr(params, "freq=");
5544                 if (pos && set_scan_freqs(wpa_s, pos + 5) < 0) {
5545                         *reply_len = -1;
5546                         return;
5547                 }
5548
5549                 pos = os_strstr(params, "passive=");
5550                 if (pos)
5551                         wpa_s->manual_scan_passive = !!atoi(pos + 8);
5552
5553                 pos = os_strstr(params, "use_id=");
5554                 if (pos)
5555                         wpa_s->manual_scan_use_id = atoi(pos + 7);
5556
5557                 pos = os_strstr(params, "only_new=1");
5558                 if (pos)
5559                         wpa_s->manual_scan_only_new = 1;
5560         } else {
5561                 os_free(wpa_s->manual_scan_freqs);
5562                 wpa_s->manual_scan_freqs = NULL;
5563                 if (wpa_s->scan_res_handler == scan_only_handler)
5564                         wpa_s->scan_res_handler = NULL;
5565         }
5566
5567         if (!wpa_s->sched_scanning && !wpa_s->scanning &&
5568             ((wpa_s->wpa_state <= WPA_SCANNING) ||
5569              (wpa_s->wpa_state == WPA_COMPLETED))) {
5570                 wpa_s->normal_scans = 0;
5571                 wpa_s->scan_req = MANUAL_SCAN_REQ;
5572                 wpa_s->after_wps = 0;
5573                 wpa_s->known_wps_freq = 0;
5574                 wpa_supplicant_req_scan(wpa_s, 0, 0);
5575                 if (wpa_s->manual_scan_use_id) {
5576                         wpa_s->manual_scan_id++;
5577                         wpa_dbg(wpa_s, MSG_DEBUG, "Assigned scan id %u",
5578                                 wpa_s->manual_scan_id);
5579                         *reply_len = os_snprintf(reply, reply_size, "%u\n",
5580                                                  wpa_s->manual_scan_id);
5581                 }
5582         } else if (wpa_s->sched_scanning) {
5583                 wpa_printf(MSG_DEBUG, "Stop ongoing sched_scan to allow requested full scan to proceed");
5584                 wpa_supplicant_cancel_sched_scan(wpa_s);
5585                 wpa_s->scan_req = MANUAL_SCAN_REQ;
5586                 wpa_supplicant_req_scan(wpa_s, 0, 0);
5587                 if (wpa_s->manual_scan_use_id) {
5588                         wpa_s->manual_scan_id++;
5589                         *reply_len = os_snprintf(reply, reply_size, "%u\n",
5590                                                  wpa_s->manual_scan_id);
5591                         wpa_dbg(wpa_s, MSG_DEBUG, "Assigned scan id %u",
5592                                 wpa_s->manual_scan_id);
5593                 }
5594         } else {
5595                 wpa_printf(MSG_DEBUG, "Ongoing scan action - reject new request");
5596                 *reply_len = os_snprintf(reply, reply_size, "FAIL-BUSY\n");
5597         }
5598 }
5599
5600
5601 char * wpa_supplicant_ctrl_iface_process(struct wpa_supplicant *wpa_s,
5602                                          char *buf, size_t *resp_len)
5603 {
5604         char *reply;
5605         const int reply_size = 4096;
5606         int reply_len;
5607
5608         if (os_strncmp(buf, WPA_CTRL_RSP, os_strlen(WPA_CTRL_RSP)) == 0 ||
5609             os_strncmp(buf, "SET_NETWORK ", 12) == 0) {
5610                 if (wpa_debug_show_keys)
5611                         wpa_dbg(wpa_s, MSG_DEBUG,
5612                                 "Control interface command '%s'", buf);
5613                 else
5614                         wpa_dbg(wpa_s, MSG_DEBUG,
5615                                 "Control interface command '%s [REMOVED]'",
5616                                 os_strncmp(buf, WPA_CTRL_RSP,
5617                                            os_strlen(WPA_CTRL_RSP)) == 0 ?
5618                                 WPA_CTRL_RSP : "SET_NETWORK");
5619         } else if (os_strncmp(buf, "WPS_NFC_TAG_READ", 16) == 0 ||
5620                    os_strncmp(buf, "NFC_REPORT_HANDOVER", 19) == 0 ||
5621                    os_strncmp(buf, "NFC_RX_HANDOVER_SEL", 19) == 0) {
5622                 wpa_hexdump_ascii_key(MSG_DEBUG, "RX ctrl_iface",
5623                                       (const u8 *) buf, os_strlen(buf));
5624         } else {
5625                 int level = MSG_DEBUG;
5626                 if (os_strcmp(buf, "PING") == 0)
5627                         level = MSG_EXCESSIVE;
5628                 wpa_dbg(wpa_s, level, "Control interface command '%s'", buf);
5629         }
5630
5631         reply = os_malloc(reply_size);
5632         if (reply == NULL) {
5633                 *resp_len = 1;
5634                 return NULL;
5635         }
5636
5637         os_memcpy(reply, "OK\n", 3);
5638         reply_len = 3;
5639
5640         if (os_strcmp(buf, "PING") == 0) {
5641                 os_memcpy(reply, "PONG\n", 5);
5642                 reply_len = 5;
5643         } else if (os_strcmp(buf, "IFNAME") == 0) {
5644                 reply_len = os_strlen(wpa_s->ifname);
5645                 os_memcpy(reply, wpa_s->ifname, reply_len);
5646         } else if (os_strncmp(buf, "RELOG", 5) == 0) {
5647                 if (wpa_debug_reopen_file() < 0)
5648                         reply_len = -1;
5649         } else if (os_strncmp(buf, "NOTE ", 5) == 0) {
5650                 wpa_printf(MSG_INFO, "NOTE: %s", buf + 5);
5651         } else if (os_strcmp(buf, "MIB") == 0) {
5652                 reply_len = wpa_sm_get_mib(wpa_s->wpa, reply, reply_size);
5653                 if (reply_len >= 0) {
5654                         int res;
5655                         res = eapol_sm_get_mib(wpa_s->eapol, reply + reply_len,
5656                                                reply_size - reply_len);
5657                         if (res < 0)
5658                                 reply_len = -1;
5659                         else
5660                                 reply_len += res;
5661                 }
5662         } else if (os_strncmp(buf, "STATUS", 6) == 0) {
5663                 reply_len = wpa_supplicant_ctrl_iface_status(
5664                         wpa_s, buf + 6, reply, reply_size);
5665         } else if (os_strcmp(buf, "PMKSA") == 0) {
5666                 reply_len = wpa_sm_pmksa_cache_list(wpa_s->wpa, reply,
5667                                                     reply_size);
5668         } else if (os_strncmp(buf, "SET ", 4) == 0) {
5669                 if (wpa_supplicant_ctrl_iface_set(wpa_s, buf + 4))
5670                         reply_len = -1;
5671         } else if (os_strncmp(buf, "GET ", 4) == 0) {
5672                 reply_len = wpa_supplicant_ctrl_iface_get(wpa_s, buf + 4,
5673                                                           reply, reply_size);
5674         } else if (os_strcmp(buf, "LOGON") == 0) {
5675                 eapol_sm_notify_logoff(wpa_s->eapol, FALSE);
5676         } else if (os_strcmp(buf, "LOGOFF") == 0) {
5677                 eapol_sm_notify_logoff(wpa_s->eapol, TRUE);
5678         } else if (os_strcmp(buf, "REASSOCIATE") == 0) {
5679                 if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
5680                         reply_len = -1;
5681                 else
5682                         wpas_request_connection(wpa_s);
5683         } else if (os_strcmp(buf, "RECONNECT") == 0) {
5684                 if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
5685                         reply_len = -1;
5686                 else if (wpa_s->disconnected)
5687                         wpas_request_connection(wpa_s);
5688 #ifdef IEEE8021X_EAPOL
5689         } else if (os_strncmp(buf, "PREAUTH ", 8) == 0) {
5690                 if (wpa_supplicant_ctrl_iface_preauth(wpa_s, buf + 8))
5691                         reply_len = -1;
5692 #endif /* IEEE8021X_EAPOL */
5693 #ifdef CONFIG_PEERKEY
5694         } else if (os_strncmp(buf, "STKSTART ", 9) == 0) {
5695                 if (wpa_supplicant_ctrl_iface_stkstart(wpa_s, buf + 9))
5696                         reply_len = -1;
5697 #endif /* CONFIG_PEERKEY */
5698 #ifdef CONFIG_IEEE80211R
5699         } else if (os_strncmp(buf, "FT_DS ", 6) == 0) {
5700                 if (wpa_supplicant_ctrl_iface_ft_ds(wpa_s, buf + 6))
5701                         reply_len = -1;
5702 #endif /* CONFIG_IEEE80211R */
5703 #ifdef CONFIG_WPS
5704         } else if (os_strcmp(buf, "WPS_PBC") == 0) {
5705                 int res = wpa_supplicant_ctrl_iface_wps_pbc(wpa_s, NULL);
5706                 if (res == -2) {
5707                         os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
5708                         reply_len = 17;
5709                 } else if (res)
5710                         reply_len = -1;
5711         } else if (os_strncmp(buf, "WPS_PBC ", 8) == 0) {
5712                 int res = wpa_supplicant_ctrl_iface_wps_pbc(wpa_s, buf + 8);
5713                 if (res == -2) {
5714                         os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
5715                         reply_len = 17;
5716                 } else if (res)
5717                         reply_len = -1;
5718         } else if (os_strncmp(buf, "WPS_PIN ", 8) == 0) {
5719                 reply_len = wpa_supplicant_ctrl_iface_wps_pin(wpa_s, buf + 8,
5720                                                               reply,
5721                                                               reply_size);
5722         } else if (os_strncmp(buf, "WPS_CHECK_PIN ", 14) == 0) {
5723                 reply_len = wpa_supplicant_ctrl_iface_wps_check_pin(
5724                         wpa_s, buf + 14, reply, reply_size);
5725         } else if (os_strcmp(buf, "WPS_CANCEL") == 0) {
5726                 if (wpas_wps_cancel(wpa_s))
5727                         reply_len = -1;
5728 #ifdef CONFIG_WPS_NFC
5729         } else if (os_strcmp(buf, "WPS_NFC") == 0) {
5730                 if (wpa_supplicant_ctrl_iface_wps_nfc(wpa_s, NULL))
5731                         reply_len = -1;
5732         } else if (os_strncmp(buf, "WPS_NFC ", 8) == 0) {
5733                 if (wpa_supplicant_ctrl_iface_wps_nfc(wpa_s, buf + 8))
5734                         reply_len = -1;
5735         } else if (os_strncmp(buf, "WPS_NFC_CONFIG_TOKEN ", 21) == 0) {
5736                 reply_len = wpa_supplicant_ctrl_iface_wps_nfc_config_token(
5737                         wpa_s, buf + 21, reply, reply_size);
5738         } else if (os_strncmp(buf, "WPS_NFC_TOKEN ", 14) == 0) {
5739                 reply_len = wpa_supplicant_ctrl_iface_wps_nfc_token(
5740                         wpa_s, buf + 14, reply, reply_size);
5741         } else if (os_strncmp(buf, "WPS_NFC_TAG_READ ", 17) == 0) {
5742                 if (wpa_supplicant_ctrl_iface_wps_nfc_tag_read(wpa_s,
5743                                                                buf + 17))
5744                         reply_len = -1;
5745         } else if (os_strncmp(buf, "NFC_GET_HANDOVER_REQ ", 21) == 0) {
5746                 reply_len = wpas_ctrl_nfc_get_handover_req(
5747                         wpa_s, buf + 21, reply, reply_size);
5748         } else if (os_strncmp(buf, "NFC_GET_HANDOVER_SEL ", 21) == 0) {
5749                 reply_len = wpas_ctrl_nfc_get_handover_sel(
5750                         wpa_s, buf + 21, reply, reply_size);
5751         } else if (os_strncmp(buf, "NFC_RX_HANDOVER_REQ ", 20) == 0) {
5752                 reply_len = wpas_ctrl_nfc_rx_handover_req(
5753                         wpa_s, buf + 20, reply, reply_size);
5754         } else if (os_strncmp(buf, "NFC_RX_HANDOVER_SEL ", 20) == 0) {
5755                 if (wpas_ctrl_nfc_rx_handover_sel(wpa_s, buf + 20))
5756                         reply_len = -1;
5757         } else if (os_strncmp(buf, "NFC_REPORT_HANDOVER ", 20) == 0) {
5758                 if (wpas_ctrl_nfc_report_handover(wpa_s, buf + 20))
5759                         reply_len = -1;
5760 #endif /* CONFIG_WPS_NFC */
5761         } else if (os_strncmp(buf, "WPS_REG ", 8) == 0) {
5762                 if (wpa_supplicant_ctrl_iface_wps_reg(wpa_s, buf + 8))
5763                         reply_len = -1;
5764 #ifdef CONFIG_AP
5765         } else if (os_strncmp(buf, "WPS_AP_PIN ", 11) == 0) {
5766                 reply_len = wpa_supplicant_ctrl_iface_wps_ap_pin(
5767                         wpa_s, buf + 11, reply, reply_size);
5768 #endif /* CONFIG_AP */
5769 #ifdef CONFIG_WPS_ER
5770         } else if (os_strcmp(buf, "WPS_ER_START") == 0) {
5771                 if (wpas_wps_er_start(wpa_s, NULL))
5772                         reply_len = -1;
5773         } else if (os_strncmp(buf, "WPS_ER_START ", 13) == 0) {
5774                 if (wpas_wps_er_start(wpa_s, buf + 13))
5775                         reply_len = -1;
5776         } else if (os_strcmp(buf, "WPS_ER_STOP") == 0) {
5777                 if (wpas_wps_er_stop(wpa_s))
5778                         reply_len = -1;
5779         } else if (os_strncmp(buf, "WPS_ER_PIN ", 11) == 0) {
5780                 if (wpa_supplicant_ctrl_iface_wps_er_pin(wpa_s, buf + 11))
5781                         reply_len = -1;
5782         } else if (os_strncmp(buf, "WPS_ER_PBC ", 11) == 0) {
5783                 int ret = wpas_wps_er_pbc(wpa_s, buf + 11);
5784                 if (ret == -2) {
5785                         os_memcpy(reply, "FAIL-PBC-OVERLAP\n", 17);
5786                         reply_len = 17;
5787                 } else if (ret == -3) {
5788                         os_memcpy(reply, "FAIL-UNKNOWN-UUID\n", 18);
5789                         reply_len = 18;
5790                 } else if (ret == -4) {
5791                         os_memcpy(reply, "FAIL-NO-AP-SETTINGS\n", 20);
5792                         reply_len = 20;
5793                 } else if (ret)
5794                         reply_len = -1;
5795         } else if (os_strncmp(buf, "WPS_ER_LEARN ", 13) == 0) {
5796                 if (wpa_supplicant_ctrl_iface_wps_er_learn(wpa_s, buf + 13))
5797                         reply_len = -1;
5798         } else if (os_strncmp(buf, "WPS_ER_SET_CONFIG ", 18) == 0) {
5799                 if (wpa_supplicant_ctrl_iface_wps_er_set_config(wpa_s,
5800                                                                 buf + 18))
5801                         reply_len = -1;
5802         } else if (os_strncmp(buf, "WPS_ER_CONFIG ", 14) == 0) {
5803                 if (wpa_supplicant_ctrl_iface_wps_er_config(wpa_s, buf + 14))
5804                         reply_len = -1;
5805 #ifdef CONFIG_WPS_NFC
5806         } else if (os_strncmp(buf, "WPS_ER_NFC_CONFIG_TOKEN ", 24) == 0) {
5807                 reply_len = wpa_supplicant_ctrl_iface_wps_er_nfc_config_token(
5808                         wpa_s, buf + 24, reply, reply_size);
5809 #endif /* CONFIG_WPS_NFC */
5810 #endif /* CONFIG_WPS_ER */
5811 #endif /* CONFIG_WPS */
5812 #ifdef CONFIG_IBSS_RSN
5813         } else if (os_strncmp(buf, "IBSS_RSN ", 9) == 0) {
5814                 if (wpa_supplicant_ctrl_iface_ibss_rsn(wpa_s, buf + 9))
5815                         reply_len = -1;
5816 #endif /* CONFIG_IBSS_RSN */
5817 #ifdef CONFIG_P2P
5818         } else if (os_strncmp(buf, "P2P_FIND ", 9) == 0) {
5819                 if (p2p_ctrl_find(wpa_s, buf + 9))
5820                         reply_len = -1;
5821         } else if (os_strcmp(buf, "P2P_FIND") == 0) {
5822                 if (p2p_ctrl_find(wpa_s, ""))
5823                         reply_len = -1;
5824         } else if (os_strcmp(buf, "P2P_STOP_FIND") == 0) {
5825                 wpas_p2p_stop_find(wpa_s);
5826         } else if (os_strncmp(buf, "P2P_CONNECT ", 12) == 0) {
5827                 reply_len = p2p_ctrl_connect(wpa_s, buf + 12, reply,
5828                                              reply_size);
5829         } else if (os_strncmp(buf, "P2P_LISTEN ", 11) == 0) {
5830                 if (p2p_ctrl_listen(wpa_s, buf + 11))
5831                         reply_len = -1;
5832         } else if (os_strcmp(buf, "P2P_LISTEN") == 0) {
5833                 if (p2p_ctrl_listen(wpa_s, ""))
5834                         reply_len = -1;
5835         } else if (os_strncmp(buf, "P2P_GROUP_REMOVE ", 17) == 0) {
5836                 if (wpas_p2p_group_remove(wpa_s, buf + 17))
5837                         reply_len = -1;
5838         } else if (os_strcmp(buf, "P2P_GROUP_ADD") == 0) {
5839                 if (wpas_p2p_group_add(wpa_s, 0, 0, 0, 0))
5840                         reply_len = -1;
5841         } else if (os_strncmp(buf, "P2P_GROUP_ADD ", 14) == 0) {
5842                 if (p2p_ctrl_group_add(wpa_s, buf + 14))
5843                         reply_len = -1;
5844         } else if (os_strncmp(buf, "P2P_PROV_DISC ", 14) == 0) {
5845                 if (p2p_ctrl_prov_disc(wpa_s, buf + 14))
5846                         reply_len = -1;
5847         } else if (os_strcmp(buf, "P2P_GET_PASSPHRASE") == 0) {
5848                 reply_len = p2p_get_passphrase(wpa_s, reply, reply_size);
5849         } else if (os_strncmp(buf, "P2P_SERV_DISC_REQ ", 18) == 0) {
5850                 reply_len = p2p_ctrl_serv_disc_req(wpa_s, buf + 18, reply,
5851                                                    reply_size);
5852         } else if (os_strncmp(buf, "P2P_SERV_DISC_CANCEL_REQ ", 25) == 0) {
5853                 if (p2p_ctrl_serv_disc_cancel_req(wpa_s, buf + 25) < 0)
5854                         reply_len = -1;
5855         } else if (os_strncmp(buf, "P2P_SERV_DISC_RESP ", 19) == 0) {
5856                 if (p2p_ctrl_serv_disc_resp(wpa_s, buf + 19) < 0)
5857                         reply_len = -1;
5858         } else if (os_strcmp(buf, "P2P_SERVICE_UPDATE") == 0) {
5859                 wpas_p2p_sd_service_update(wpa_s);
5860         } else if (os_strncmp(buf, "P2P_SERV_DISC_EXTERNAL ", 23) == 0) {
5861                 if (p2p_ctrl_serv_disc_external(wpa_s, buf + 23) < 0)
5862                         reply_len = -1;
5863         } else if (os_strcmp(buf, "P2P_SERVICE_FLUSH") == 0) {
5864                 wpas_p2p_service_flush(wpa_s);
5865         } else if (os_strncmp(buf, "P2P_SERVICE_ADD ", 16) == 0) {
5866                 if (p2p_ctrl_service_add(wpa_s, buf + 16) < 0)
5867                         reply_len = -1;
5868         } else if (os_strncmp(buf, "P2P_SERVICE_DEL ", 16) == 0) {
5869                 if (p2p_ctrl_service_del(wpa_s, buf + 16) < 0)
5870                         reply_len = -1;
5871         } else if (os_strncmp(buf, "P2P_REJECT ", 11) == 0) {
5872                 if (p2p_ctrl_reject(wpa_s, buf + 11) < 0)
5873                         reply_len = -1;
5874         } else if (os_strncmp(buf, "P2P_INVITE ", 11) == 0) {
5875                 if (p2p_ctrl_invite(wpa_s, buf + 11) < 0)
5876                         reply_len = -1;
5877         } else if (os_strncmp(buf, "P2P_PEER ", 9) == 0) {
5878                 reply_len = p2p_ctrl_peer(wpa_s, buf + 9, reply,
5879                                               reply_size);
5880         } else if (os_strncmp(buf, "P2P_SET ", 8) == 0) {
5881                 if (p2p_ctrl_set(wpa_s, buf + 8) < 0)
5882                         reply_len = -1;
5883         } else if (os_strcmp(buf, "P2P_FLUSH") == 0) {
5884                 p2p_ctrl_flush(wpa_s);
5885         } else if (os_strncmp(buf, "P2P_UNAUTHORIZE ", 16) == 0) {
5886                 if (wpas_p2p_unauthorize(wpa_s, buf + 16) < 0)
5887                         reply_len = -1;
5888         } else if (os_strcmp(buf, "P2P_CANCEL") == 0) {
5889                 if (wpas_p2p_cancel(wpa_s))
5890                         reply_len = -1;
5891         } else if (os_strncmp(buf, "P2P_PRESENCE_REQ ", 17) == 0) {
5892                 if (p2p_ctrl_presence_req(wpa_s, buf + 17) < 0)
5893                         reply_len = -1;
5894         } else if (os_strcmp(buf, "P2P_PRESENCE_REQ") == 0) {
5895                 if (p2p_ctrl_presence_req(wpa_s, "") < 0)
5896                         reply_len = -1;
5897         } else if (os_strncmp(buf, "P2P_EXT_LISTEN ", 15) == 0) {
5898                 if (p2p_ctrl_ext_listen(wpa_s, buf + 15) < 0)
5899                         reply_len = -1;
5900         } else if (os_strcmp(buf, "P2P_EXT_LISTEN") == 0) {
5901                 if (p2p_ctrl_ext_listen(wpa_s, "") < 0)
5902                         reply_len = -1;
5903         } else if (os_strncmp(buf, "P2P_REMOVE_CLIENT ", 18) == 0) {
5904                 if (p2p_ctrl_remove_client(wpa_s, buf + 18) < 0)
5905                         reply_len = -1;
5906 #endif /* CONFIG_P2P */
5907 #ifdef CONFIG_WIFI_DISPLAY
5908         } else if (os_strncmp(buf, "WFD_SUBELEM_SET ", 16) == 0) {
5909                 if (wifi_display_subelem_set(wpa_s->global, buf + 16) < 0)
5910                         reply_len = -1;
5911         } else if (os_strncmp(buf, "WFD_SUBELEM_GET ", 16) == 0) {
5912                 reply_len = wifi_display_subelem_get(wpa_s->global, buf + 16,
5913                                                      reply, reply_size);
5914 #endif /* CONFIG_WIFI_DISPLAY */
5915 #ifdef CONFIG_INTERWORKING
5916         } else if (os_strcmp(buf, "FETCH_ANQP") == 0) {
5917                 if (interworking_fetch_anqp(wpa_s) < 0)
5918                         reply_len = -1;
5919         } else if (os_strcmp(buf, "STOP_FETCH_ANQP") == 0) {
5920                 interworking_stop_fetch_anqp(wpa_s);
5921         } else if (os_strcmp(buf, "INTERWORKING_SELECT") == 0) {
5922                 if (ctrl_interworking_select(wpa_s, NULL) < 0)
5923                         reply_len = -1;
5924         } else if (os_strncmp(buf, "INTERWORKING_SELECT ", 20) == 0) {
5925                 if (ctrl_interworking_select(wpa_s, buf + 20) < 0)
5926                         reply_len = -1;
5927         } else if (os_strncmp(buf, "INTERWORKING_CONNECT ", 21) == 0) {
5928                 if (ctrl_interworking_connect(wpa_s, buf + 21) < 0)
5929                         reply_len = -1;
5930         } else if (os_strncmp(buf, "ANQP_GET ", 9) == 0) {
5931                 if (get_anqp(wpa_s, buf + 9) < 0)
5932                         reply_len = -1;
5933         } else if (os_strncmp(buf, "GAS_REQUEST ", 12) == 0) {
5934                 if (gas_request(wpa_s, buf + 12) < 0)
5935                         reply_len = -1;
5936         } else if (os_strncmp(buf, "GAS_RESPONSE_GET ", 17) == 0) {
5937                 reply_len = gas_response_get(wpa_s, buf + 17, reply,
5938                                              reply_size);
5939 #endif /* CONFIG_INTERWORKING */
5940 #ifdef CONFIG_HS20
5941         } else if (os_strncmp(buf, "HS20_ANQP_GET ", 14) == 0) {
5942                 if (get_hs20_anqp(wpa_s, buf + 14) < 0)
5943                         reply_len = -1;
5944         } else if (os_strncmp(buf, "HS20_GET_NAI_HOME_REALM_LIST ", 29) == 0) {
5945                 if (hs20_get_nai_home_realm_list(wpa_s, buf + 29) < 0)
5946                         reply_len = -1;
5947 #endif /* CONFIG_HS20 */
5948         } else if (os_strncmp(buf, WPA_CTRL_RSP, os_strlen(WPA_CTRL_RSP)) == 0)
5949         {
5950                 if (wpa_supplicant_ctrl_iface_ctrl_rsp(
5951                             wpa_s, buf + os_strlen(WPA_CTRL_RSP)))
5952                         reply_len = -1;
5953                 else {
5954                         /*
5955                          * Notify response from timeout to allow the control
5956                          * interface response to be sent first.
5957                          */
5958                         eloop_register_timeout(0, 0, wpas_ctrl_eapol_response,
5959                                                wpa_s, NULL);
5960                 }
5961         } else if (os_strcmp(buf, "RECONFIGURE") == 0) {
5962                 if (wpa_supplicant_reload_configuration(wpa_s))
5963                         reply_len = -1;
5964         } else if (os_strcmp(buf, "TERMINATE") == 0) {
5965                 wpa_supplicant_terminate_proc(wpa_s->global);
5966         } else if (os_strncmp(buf, "BSSID ", 6) == 0) {
5967                 if (wpa_supplicant_ctrl_iface_bssid(wpa_s, buf + 6))
5968                         reply_len = -1;
5969         } else if (os_strncmp(buf, "BLACKLIST", 9) == 0) {
5970                 reply_len = wpa_supplicant_ctrl_iface_blacklist(
5971                         wpa_s, buf + 9, reply, reply_size);
5972         } else if (os_strncmp(buf, "LOG_LEVEL", 9) == 0) {
5973                 reply_len = wpa_supplicant_ctrl_iface_log_level(
5974                         wpa_s, buf + 9, reply, reply_size);
5975         } else if (os_strcmp(buf, "LIST_NETWORKS") == 0) {
5976                 reply_len = wpa_supplicant_ctrl_iface_list_networks(
5977                         wpa_s, reply, reply_size);
5978         } else if (os_strcmp(buf, "DISCONNECT") == 0) {
5979 #ifdef CONFIG_SME
5980                 wpa_s->sme.prev_bssid_set = 0;
5981 #endif /* CONFIG_SME */
5982                 wpa_s->reassociate = 0;
5983                 wpa_s->disconnected = 1;
5984                 wpa_supplicant_cancel_sched_scan(wpa_s);
5985                 wpa_supplicant_cancel_scan(wpa_s);
5986                 wpa_supplicant_deauthenticate(wpa_s,
5987                                               WLAN_REASON_DEAUTH_LEAVING);
5988         } else if (os_strcmp(buf, "SCAN") == 0) {
5989                 wpas_ctrl_scan(wpa_s, NULL, reply, reply_size, &reply_len);
5990         } else if (os_strncmp(buf, "SCAN ", 5) == 0) {
5991                 wpas_ctrl_scan(wpa_s, buf + 5, reply, reply_size, &reply_len);
5992         } else if (os_strcmp(buf, "SCAN_RESULTS") == 0) {
5993                 reply_len = wpa_supplicant_ctrl_iface_scan_results(
5994                         wpa_s, reply, reply_size);
5995         } else if (os_strncmp(buf, "SELECT_NETWORK ", 15) == 0) {
5996                 if (wpa_supplicant_ctrl_iface_select_network(wpa_s, buf + 15))
5997                         reply_len = -1;
5998         } else if (os_strncmp(buf, "ENABLE_NETWORK ", 15) == 0) {
5999                 if (wpa_supplicant_ctrl_iface_enable_network(wpa_s, buf + 15))
6000                         reply_len = -1;
6001         } else if (os_strncmp(buf, "DISABLE_NETWORK ", 16) == 0) {
6002                 if (wpa_supplicant_ctrl_iface_disable_network(wpa_s, buf + 16))
6003                         reply_len = -1;
6004         } else if (os_strcmp(buf, "ADD_NETWORK") == 0) {
6005                 reply_len = wpa_supplicant_ctrl_iface_add_network(
6006                         wpa_s, reply, reply_size);
6007         } else if (os_strncmp(buf, "REMOVE_NETWORK ", 15) == 0) {
6008                 if (wpa_supplicant_ctrl_iface_remove_network(wpa_s, buf + 15))
6009                         reply_len = -1;
6010         } else if (os_strncmp(buf, "SET_NETWORK ", 12) == 0) {
6011                 if (wpa_supplicant_ctrl_iface_set_network(wpa_s, buf + 12))
6012                         reply_len = -1;
6013         } else if (os_strncmp(buf, "GET_NETWORK ", 12) == 0) {
6014                 reply_len = wpa_supplicant_ctrl_iface_get_network(
6015                         wpa_s, buf + 12, reply, reply_size);
6016         } else if (os_strcmp(buf, "LIST_CREDS") == 0) {
6017                 reply_len = wpa_supplicant_ctrl_iface_list_creds(
6018                         wpa_s, reply, reply_size);
6019         } else if (os_strcmp(buf, "ADD_CRED") == 0) {
6020                 reply_len = wpa_supplicant_ctrl_iface_add_cred(
6021                         wpa_s, reply, reply_size);
6022         } else if (os_strncmp(buf, "REMOVE_CRED ", 12) == 0) {
6023                 if (wpa_supplicant_ctrl_iface_remove_cred(wpa_s, buf + 12))
6024                         reply_len = -1;
6025         } else if (os_strncmp(buf, "SET_CRED ", 9) == 0) {
6026                 if (wpa_supplicant_ctrl_iface_set_cred(wpa_s, buf + 9))
6027                         reply_len = -1;
6028 #ifndef CONFIG_NO_CONFIG_WRITE
6029         } else if (os_strcmp(buf, "SAVE_CONFIG") == 0) {
6030                 if (wpa_supplicant_ctrl_iface_save_config(wpa_s))
6031                         reply_len = -1;
6032 #endif /* CONFIG_NO_CONFIG_WRITE */
6033         } else if (os_strncmp(buf, "GET_CAPABILITY ", 15) == 0) {
6034                 reply_len = wpa_supplicant_ctrl_iface_get_capability(
6035                         wpa_s, buf + 15, reply, reply_size);
6036         } else if (os_strncmp(buf, "AP_SCAN ", 8) == 0) {
6037                 if (wpa_supplicant_ctrl_iface_ap_scan(wpa_s, buf + 8))
6038                         reply_len = -1;
6039         } else if (os_strncmp(buf, "SCAN_INTERVAL ", 14) == 0) {
6040                 if (wpa_supplicant_ctrl_iface_scan_interval(wpa_s, buf + 14))
6041                         reply_len = -1;
6042         } else if (os_strcmp(buf, "INTERFACE_LIST") == 0) {
6043                 reply_len = wpa_supplicant_global_iface_list(
6044                         wpa_s->global, reply, reply_size);
6045         } else if (os_strcmp(buf, "INTERFACES") == 0) {
6046                 reply_len = wpa_supplicant_global_iface_interfaces(
6047                         wpa_s->global, reply, reply_size);
6048         } else if (os_strncmp(buf, "BSS ", 4) == 0) {
6049                 reply_len = wpa_supplicant_ctrl_iface_bss(
6050                         wpa_s, buf + 4, reply, reply_size);
6051 #ifdef CONFIG_AP
6052         } else if (os_strcmp(buf, "STA-FIRST") == 0) {
6053                 reply_len = ap_ctrl_iface_sta_first(wpa_s, reply, reply_size);
6054         } else if (os_strncmp(buf, "STA ", 4) == 0) {
6055                 reply_len = ap_ctrl_iface_sta(wpa_s, buf + 4, reply,
6056                                               reply_size);
6057         } else if (os_strncmp(buf, "STA-NEXT ", 9) == 0) {
6058                 reply_len = ap_ctrl_iface_sta_next(wpa_s, buf + 9, reply,
6059                                                    reply_size);
6060         } else if (os_strncmp(buf, "DEAUTHENTICATE ", 15) == 0) {
6061                 if (ap_ctrl_iface_sta_deauthenticate(wpa_s, buf + 15))
6062                         reply_len = -1;
6063         } else if (os_strncmp(buf, "DISASSOCIATE ", 13) == 0) {
6064                 if (ap_ctrl_iface_sta_disassociate(wpa_s, buf + 13))
6065                         reply_len = -1;
6066         } else if (os_strncmp(buf, "CHAN_SWITCH ", 12) == 0) {
6067                 if (ap_ctrl_iface_chanswitch(wpa_s, buf + 12))
6068                         reply_len = -1;
6069 #endif /* CONFIG_AP */
6070         } else if (os_strcmp(buf, "SUSPEND") == 0) {
6071                 wpas_notify_suspend(wpa_s->global);
6072         } else if (os_strcmp(buf, "RESUME") == 0) {
6073                 wpas_notify_resume(wpa_s->global);
6074         } else if (os_strcmp(buf, "DROP_SA") == 0) {
6075                 wpa_supplicant_ctrl_iface_drop_sa(wpa_s);
6076         } else if (os_strncmp(buf, "ROAM ", 5) == 0) {
6077                 if (wpa_supplicant_ctrl_iface_roam(wpa_s, buf + 5))
6078                         reply_len = -1;
6079         } else if (os_strncmp(buf, "STA_AUTOCONNECT ", 16) == 0) {
6080                 if (wpa_supplicant_ctrl_iface_sta_autoconnect(wpa_s, buf + 16))
6081                         reply_len = -1;
6082         } else if (os_strncmp(buf, "BSS_EXPIRE_AGE ", 15) == 0) {
6083                 if (wpa_supplicant_ctrl_iface_bss_expire_age(wpa_s, buf + 15))
6084                         reply_len = -1;
6085         } else if (os_strncmp(buf, "BSS_EXPIRE_COUNT ", 17) == 0) {
6086                 if (wpa_supplicant_ctrl_iface_bss_expire_count(wpa_s,
6087                                                                buf + 17))
6088                         reply_len = -1;
6089         } else if (os_strncmp(buf, "BSS_FLUSH ", 10) == 0) {
6090                 if (wpa_supplicant_ctrl_iface_bss_flush(wpa_s, buf + 10))
6091                         reply_len = -1;
6092 #ifdef CONFIG_TDLS
6093         } else if (os_strncmp(buf, "TDLS_DISCOVER ", 14) == 0) {
6094                 if (wpa_supplicant_ctrl_iface_tdls_discover(wpa_s, buf + 14))
6095                         reply_len = -1;
6096         } else if (os_strncmp(buf, "TDLS_SETUP ", 11) == 0) {
6097                 if (wpa_supplicant_ctrl_iface_tdls_setup(wpa_s, buf + 11))
6098                         reply_len = -1;
6099         } else if (os_strncmp(buf, "TDLS_TEARDOWN ", 14) == 0) {
6100                 if (wpa_supplicant_ctrl_iface_tdls_teardown(wpa_s, buf + 14))
6101                         reply_len = -1;
6102 #endif /* CONFIG_TDLS */
6103         } else if (os_strncmp(buf, "SIGNAL_POLL", 11) == 0) {
6104                 reply_len = wpa_supplicant_signal_poll(wpa_s, reply,
6105                                                        reply_size);
6106         } else if (os_strncmp(buf, "PKTCNT_POLL", 11) == 0) {
6107                 reply_len = wpa_supplicant_pktcnt_poll(wpa_s, reply,
6108                                                        reply_size);
6109 #ifdef CONFIG_AUTOSCAN
6110         } else if (os_strncmp(buf, "AUTOSCAN ", 9) == 0) {
6111                 if (wpa_supplicant_ctrl_iface_autoscan(wpa_s, buf + 9))
6112                         reply_len = -1;
6113 #endif /* CONFIG_AUTOSCAN */
6114 #ifdef ANDROID
6115         } else if (os_strncmp(buf, "DRIVER ", 7) == 0) {
6116                 reply_len = wpa_supplicant_driver_cmd(wpa_s, buf + 7, reply,
6117                                                       reply_size);
6118 #endif /* ANDROID */
6119         } else if (os_strcmp(buf, "REAUTHENTICATE") == 0) {
6120                 pmksa_cache_clear_current(wpa_s->wpa);
6121                 eapol_sm_request_reauth(wpa_s->eapol);
6122 #ifdef CONFIG_WNM
6123         } else if (os_strncmp(buf, "WNM_SLEEP ", 10) == 0) {
6124                 if (wpas_ctrl_iface_wnm_sleep(wpa_s, buf + 10))
6125                         reply_len = -1;
6126         } else if (os_strncmp(buf, "WNM_BSS_QUERY ", 10) == 0) {
6127                 if (wpas_ctrl_iface_wnm_bss_query(wpa_s, buf + 10))
6128                                 reply_len = -1;
6129 #endif /* CONFIG_WNM */
6130         } else if (os_strcmp(buf, "FLUSH") == 0) {
6131                 wpa_supplicant_ctrl_iface_flush(wpa_s);
6132         } else if (os_strncmp(buf, "RADIO_WORK ", 11) == 0) {
6133                 reply_len = wpas_ctrl_radio_work(wpa_s, buf + 11, reply,
6134                                                  reply_size);
6135         } else {
6136                 os_memcpy(reply, "UNKNOWN COMMAND\n", 16);
6137                 reply_len = 16;
6138         }
6139
6140         if (reply_len < 0) {
6141                 os_memcpy(reply, "FAIL\n", 5);
6142                 reply_len = 5;
6143         }
6144
6145         *resp_len = reply_len;
6146         return reply;
6147 }
6148
6149
6150 static int wpa_supplicant_global_iface_add(struct wpa_global *global,
6151                                            char *cmd)
6152 {
6153         struct wpa_interface iface;
6154         char *pos;
6155
6156         /*
6157          * <ifname>TAB<confname>TAB<driver>TAB<ctrl_interface>TAB<driver_param>
6158          * TAB<bridge_ifname>
6159          */
6160         wpa_printf(MSG_DEBUG, "CTRL_IFACE GLOBAL INTERFACE_ADD '%s'", cmd);
6161
6162         os_memset(&iface, 0, sizeof(iface));
6163
6164         do {
6165                 iface.ifname = pos = cmd;
6166                 pos = os_strchr(pos, '\t');
6167                 if (pos)
6168                         *pos++ = '\0';
6169                 if (iface.ifname[0] == '\0')
6170                         return -1;
6171                 if (pos == NULL)
6172                         break;
6173
6174                 iface.confname = pos;
6175                 pos = os_strchr(pos, '\t');
6176                 if (pos)
6177                         *pos++ = '\0';
6178                 if (iface.confname[0] == '\0')
6179                         iface.confname = NULL;
6180                 if (pos == NULL)
6181                         break;
6182
6183                 iface.driver = pos;
6184                 pos = os_strchr(pos, '\t');
6185                 if (pos)
6186                         *pos++ = '\0';
6187                 if (iface.driver[0] == '\0')
6188                         iface.driver = NULL;
6189                 if (pos == NULL)
6190                         break;
6191
6192                 iface.ctrl_interface = pos;
6193                 pos = os_strchr(pos, '\t');
6194                 if (pos)
6195                         *pos++ = '\0';
6196                 if (iface.ctrl_interface[0] == '\0')
6197                         iface.ctrl_interface = NULL;
6198                 if (pos == NULL)
6199                         break;
6200
6201                 iface.driver_param = pos;
6202                 pos = os_strchr(pos, '\t');
6203                 if (pos)
6204                         *pos++ = '\0';
6205                 if (iface.driver_param[0] == '\0')
6206                         iface.driver_param = NULL;
6207                 if (pos == NULL)
6208                         break;
6209
6210                 iface.bridge_ifname = pos;
6211                 pos = os_strchr(pos, '\t');
6212                 if (pos)
6213                         *pos++ = '\0';
6214                 if (iface.bridge_ifname[0] == '\0')
6215                         iface.bridge_ifname = NULL;
6216                 if (pos == NULL)
6217                         break;
6218         } while (0);
6219
6220         if (wpa_supplicant_get_iface(global, iface.ifname))
6221                 return -1;
6222
6223         return wpa_supplicant_add_iface(global, &iface) ? 0 : -1;
6224 }
6225
6226
6227 static int wpa_supplicant_global_iface_remove(struct wpa_global *global,
6228                                               char *cmd)
6229 {
6230         struct wpa_supplicant *wpa_s;
6231
6232         wpa_printf(MSG_DEBUG, "CTRL_IFACE GLOBAL INTERFACE_REMOVE '%s'", cmd);
6233
6234         wpa_s = wpa_supplicant_get_iface(global, cmd);
6235         if (wpa_s == NULL)
6236                 return -1;
6237         return wpa_supplicant_remove_iface(global, wpa_s, 0);
6238 }
6239
6240
6241 static void wpa_free_iface_info(struct wpa_interface_info *iface)
6242 {
6243         struct wpa_interface_info *prev;
6244
6245         while (iface) {
6246                 prev = iface;
6247                 iface = iface->next;
6248
6249                 os_free(prev->ifname);
6250                 os_free(prev->desc);
6251                 os_free(prev);
6252         }
6253 }
6254
6255
6256 static int wpa_supplicant_global_iface_list(struct wpa_global *global,
6257                                             char *buf, int len)
6258 {
6259         int i, res;
6260         struct wpa_interface_info *iface = NULL, *last = NULL, *tmp;
6261         char *pos, *end;
6262
6263         for (i = 0; wpa_drivers[i]; i++) {
6264                 struct wpa_driver_ops *drv = wpa_drivers[i];
6265                 if (drv->get_interfaces == NULL)
6266                         continue;
6267                 tmp = drv->get_interfaces(global->drv_priv[i]);
6268                 if (tmp == NULL)
6269                         continue;
6270
6271                 if (last == NULL)
6272                         iface = last = tmp;
6273                 else
6274                         last->next = tmp;
6275                 while (last->next)
6276                         last = last->next;
6277         }
6278
6279         pos = buf;
6280         end = buf + len;
6281         for (tmp = iface; tmp; tmp = tmp->next) {
6282                 res = os_snprintf(pos, end - pos, "%s\t%s\t%s\n",
6283                                   tmp->drv_name, tmp->ifname,
6284                                   tmp->desc ? tmp->desc : "");
6285                 if (res < 0 || res >= end - pos) {
6286                         *pos = '\0';
6287                         break;
6288                 }
6289                 pos += res;
6290         }
6291
6292         wpa_free_iface_info(iface);
6293
6294         return pos - buf;
6295 }
6296
6297
6298 static int wpa_supplicant_global_iface_interfaces(struct wpa_global *global,
6299                                                   char *buf, int len)
6300 {
6301         int res;
6302         char *pos, *end;
6303         struct wpa_supplicant *wpa_s;
6304
6305         wpa_s = global->ifaces;
6306         pos = buf;
6307         end = buf + len;
6308
6309         while (wpa_s) {
6310                 res = os_snprintf(pos, end - pos, "%s\n", wpa_s->ifname);
6311                 if (res < 0 || res >= end - pos) {
6312                         *pos = '\0';
6313                         break;
6314                 }
6315                 pos += res;
6316                 wpa_s = wpa_s->next;
6317         }
6318         return pos - buf;
6319 }
6320
6321
6322 static char * wpas_global_ctrl_iface_ifname(struct wpa_global *global,
6323                                             const char *ifname,
6324                                             char *cmd, size_t *resp_len)
6325 {
6326         struct wpa_supplicant *wpa_s;
6327
6328         for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
6329                 if (os_strcmp(ifname, wpa_s->ifname) == 0)
6330                         break;
6331         }
6332
6333         if (wpa_s == NULL) {
6334                 char *resp = os_strdup("FAIL-NO-IFNAME-MATCH\n");
6335                 if (resp)
6336                         *resp_len = os_strlen(resp);
6337                 else
6338                         *resp_len = 1;
6339                 return resp;
6340         }
6341
6342         return wpa_supplicant_ctrl_iface_process(wpa_s, cmd, resp_len);
6343 }
6344
6345
6346 static char * wpas_global_ctrl_iface_redir_p2p(struct wpa_global *global,
6347                                                char *buf, size_t *resp_len)
6348 {
6349 #ifdef CONFIG_P2P
6350         static const char * cmd[] = {
6351                 "LIST_NETWORKS",
6352                 "SAVE_CONFIG",
6353                 "P2P_FIND",
6354                 "P2P_STOP_FIND",
6355                 "P2P_LISTEN",
6356                 "P2P_GROUP_ADD",
6357                 "P2P_GET_PASSPHRASE",
6358                 "P2P_SERVICE_UPDATE",
6359                 "P2P_SERVICE_FLUSH",
6360                 "P2P_FLUSH",
6361                 "P2P_CANCEL",
6362                 "P2P_PRESENCE_REQ",
6363                 "P2P_EXT_LISTEN",
6364                 NULL
6365         };
6366         static const char * prefix[] = {
6367 #ifdef ANDROID
6368                 "DRIVER ",
6369 #endif /* ANDROID */
6370                 "GET_NETWORK ",
6371                 "REMOVE_NETWORK ",
6372                 "SET ",
6373                 "P2P_FIND ",
6374                 "P2P_CONNECT ",
6375                 "P2P_LISTEN ",
6376                 "P2P_GROUP_REMOVE ",
6377                 "P2P_GROUP_ADD ",
6378                 "P2P_PROV_DISC ",
6379                 "P2P_SERV_DISC_REQ ",
6380                 "P2P_SERV_DISC_CANCEL_REQ ",
6381                 "P2P_SERV_DISC_RESP ",
6382                 "P2P_SERV_DISC_EXTERNAL ",
6383                 "P2P_SERVICE_ADD ",
6384                 "P2P_SERVICE_DEL ",
6385                 "P2P_REJECT ",
6386                 "P2P_INVITE ",
6387                 "P2P_PEER ",
6388                 "P2P_SET ",
6389                 "P2P_UNAUTHORIZE ",
6390                 "P2P_PRESENCE_REQ ",
6391                 "P2P_EXT_LISTEN ",
6392                 "P2P_REMOVE_CLIENT ",
6393                 NULL
6394         };
6395         int found = 0;
6396         int i;
6397
6398         if (global->p2p_init_wpa_s == NULL)
6399                 return NULL;
6400
6401         for (i = 0; !found && cmd[i]; i++) {
6402                 if (os_strcmp(buf, cmd[i]) == 0)
6403                         found = 1;
6404         }
6405
6406         for (i = 0; !found && prefix[i]; i++) {
6407                 if (os_strncmp(buf, prefix[i], os_strlen(prefix[i])) == 0)
6408                         found = 1;
6409         }
6410
6411         if (found)
6412                 return wpa_supplicant_ctrl_iface_process(global->p2p_init_wpa_s,
6413                                                          buf, resp_len);
6414 #endif /* CONFIG_P2P */
6415         return NULL;
6416 }
6417
6418
6419 static char * wpas_global_ctrl_iface_redir_wfd(struct wpa_global *global,
6420                                                char *buf, size_t *resp_len)
6421 {
6422 #ifdef CONFIG_WIFI_DISPLAY
6423         if (global->p2p_init_wpa_s == NULL)
6424                 return NULL;
6425         if (os_strncmp(buf, "WFD_SUBELEM_SET ", 16) == 0 ||
6426             os_strncmp(buf, "WFD_SUBELEM_GET ", 16) == 0)
6427                 return wpa_supplicant_ctrl_iface_process(global->p2p_init_wpa_s,
6428                                                          buf, resp_len);
6429 #endif /* CONFIG_WIFI_DISPLAY */
6430         return NULL;
6431 }
6432
6433
6434 static char * wpas_global_ctrl_iface_redir(struct wpa_global *global,
6435                                            char *buf, size_t *resp_len)
6436 {
6437         char *ret;
6438
6439         ret = wpas_global_ctrl_iface_redir_p2p(global, buf, resp_len);
6440         if (ret)
6441                 return ret;
6442
6443         ret = wpas_global_ctrl_iface_redir_wfd(global, buf, resp_len);
6444         if (ret)
6445                 return ret;
6446
6447         return NULL;
6448 }
6449
6450
6451 static int wpas_global_ctrl_iface_set(struct wpa_global *global, char *cmd)
6452 {
6453         char *value;
6454
6455         value = os_strchr(cmd, ' ');
6456         if (value == NULL)
6457                 return -1;
6458         *value++ = '\0';
6459
6460         wpa_printf(MSG_DEBUG, "GLOBAL_CTRL_IFACE SET '%s'='%s'", cmd, value);
6461
6462 #ifdef CONFIG_WIFI_DISPLAY
6463         if (os_strcasecmp(cmd, "wifi_display") == 0) {
6464                 wifi_display_enable(global, !!atoi(value));
6465                 return 0;
6466         }
6467 #endif /* CONFIG_WIFI_DISPLAY */
6468
6469         return -1;
6470 }
6471
6472
6473 #ifndef CONFIG_NO_CONFIG_WRITE
6474 static int wpas_global_ctrl_iface_save_config(struct wpa_global *global)
6475 {
6476         int ret = 0;
6477         struct wpa_supplicant *wpa_s;
6478
6479         for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
6480                 if (!wpa_s->conf->update_config) {
6481                         wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Not allowed to update configuration (update_config=0)");
6482                         continue;
6483                 }
6484
6485                 if (wpa_config_write(wpa_s->confname, wpa_s->conf)) {
6486                         wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Failed to update configuration");
6487                         ret = 1;
6488                 } else {
6489                         wpa_dbg(wpa_s, MSG_DEBUG, "CTRL_IFACE: SAVE_CONFIG - Configuration updated");
6490                 }
6491         }
6492
6493         return ret;
6494 }
6495 #endif /* CONFIG_NO_CONFIG_WRITE */
6496
6497
6498 static int wpas_global_ctrl_iface_status(struct wpa_global *global,
6499                                          char *buf, size_t buflen)
6500 {
6501         char *pos, *end;
6502         int ret;
6503         struct wpa_supplicant *wpa_s;
6504
6505         pos = buf;
6506         end = buf + buflen;
6507
6508 #ifdef CONFIG_P2P
6509         if (global->p2p && !global->p2p_disabled) {
6510                 ret = os_snprintf(pos, end - pos, "p2p_device_address=" MACSTR
6511                                   "\n"
6512                                   "p2p_state=%s\n",
6513                                   MAC2STR(global->p2p_dev_addr),
6514                                   p2p_get_state_txt(global->p2p));
6515                 if (ret < 0 || ret >= end - pos)
6516                         return pos - buf;
6517                 pos += ret;
6518         } else if (global->p2p) {
6519                 ret = os_snprintf(pos, end - pos, "p2p_state=DISABLED\n");
6520                 if (ret < 0 || ret >= end - pos)
6521                         return pos - buf;
6522                 pos += ret;
6523         }
6524 #endif /* CONFIG_P2P */
6525
6526 #ifdef CONFIG_WIFI_DISPLAY
6527         ret = os_snprintf(pos, end - pos, "wifi_display=%d\n",
6528                           !!global->wifi_display);
6529         if (ret < 0 || ret >= end - pos)
6530                 return pos - buf;
6531         pos += ret;
6532 #endif /* CONFIG_WIFI_DISPLAY */
6533
6534         for (wpa_s = global->ifaces; wpa_s; wpa_s = wpa_s->next) {
6535                 ret = os_snprintf(pos, end - pos, "ifname=%s\n"
6536                                   "address=" MACSTR "\n",
6537                                   wpa_s->ifname, MAC2STR(wpa_s->own_addr));
6538                 if (ret < 0 || ret >= end - pos)
6539                         return pos - buf;
6540                 pos += ret;
6541         }
6542
6543         return pos - buf;
6544 }
6545
6546
6547 char * wpa_supplicant_global_ctrl_iface_process(struct wpa_global *global,
6548                                                 char *buf, size_t *resp_len)
6549 {
6550         char *reply;
6551         const int reply_size = 2048;
6552         int reply_len;
6553         int level = MSG_DEBUG;
6554
6555         if (os_strncmp(buf, "IFNAME=", 7) == 0) {
6556                 char *pos = os_strchr(buf + 7, ' ');
6557                 if (pos) {
6558                         *pos++ = '\0';
6559                         return wpas_global_ctrl_iface_ifname(global,
6560                                                              buf + 7, pos,
6561                                                              resp_len);
6562                 }
6563         }
6564
6565         reply = wpas_global_ctrl_iface_redir(global, buf, resp_len);
6566         if (reply)
6567                 return reply;
6568
6569         if (os_strcmp(buf, "PING") == 0)
6570                 level = MSG_EXCESSIVE;
6571         wpa_hexdump_ascii(level, "RX global ctrl_iface",
6572                           (const u8 *) buf, os_strlen(buf));
6573
6574         reply = os_malloc(reply_size);
6575         if (reply == NULL) {
6576                 *resp_len = 1;
6577                 return NULL;
6578         }
6579
6580         os_memcpy(reply, "OK\n", 3);
6581         reply_len = 3;
6582
6583         if (os_strcmp(buf, "PING") == 0) {
6584                 os_memcpy(reply, "PONG\n", 5);
6585                 reply_len = 5;
6586         } else if (os_strncmp(buf, "INTERFACE_ADD ", 14) == 0) {
6587                 if (wpa_supplicant_global_iface_add(global, buf + 14))
6588                         reply_len = -1;
6589         } else if (os_strncmp(buf, "INTERFACE_REMOVE ", 17) == 0) {
6590                 if (wpa_supplicant_global_iface_remove(global, buf + 17))
6591                         reply_len = -1;
6592         } else if (os_strcmp(buf, "INTERFACE_LIST") == 0) {
6593                 reply_len = wpa_supplicant_global_iface_list(
6594                         global, reply, reply_size);
6595         } else if (os_strcmp(buf, "INTERFACES") == 0) {
6596                 reply_len = wpa_supplicant_global_iface_interfaces(
6597                         global, reply, reply_size);
6598         } else if (os_strcmp(buf, "TERMINATE") == 0) {
6599                 wpa_supplicant_terminate_proc(global);
6600         } else if (os_strcmp(buf, "SUSPEND") == 0) {
6601                 wpas_notify_suspend(global);
6602         } else if (os_strcmp(buf, "RESUME") == 0) {
6603                 wpas_notify_resume(global);
6604         } else if (os_strncmp(buf, "SET ", 4) == 0) {
6605                 if (wpas_global_ctrl_iface_set(global, buf + 4))
6606                         reply_len = -1;
6607 #ifndef CONFIG_NO_CONFIG_WRITE
6608         } else if (os_strcmp(buf, "SAVE_CONFIG") == 0) {
6609                 if (wpas_global_ctrl_iface_save_config(global))
6610                         reply_len = -1;
6611 #endif /* CONFIG_NO_CONFIG_WRITE */
6612         } else if (os_strcmp(buf, "STATUS") == 0) {
6613                 reply_len = wpas_global_ctrl_iface_status(global, reply,
6614                                                           reply_size);
6615         } else {
6616                 os_memcpy(reply, "UNKNOWN COMMAND\n", 16);
6617                 reply_len = 16;
6618         }
6619
6620         if (reply_len < 0) {
6621                 os_memcpy(reply, "FAIL\n", 5);
6622                 reply_len = 5;
6623         }
6624
6625         *resp_len = reply_len;
6626         return reply;
6627 }