libeap/src/ap/hw_features.c

   1 /*
   2  * hostapd / Hardware feature query and different modes
   3  * Copyright 2002-2003, Instant802 Networks, Inc.
   4  * Copyright 2005-2006, Devicescape Software, Inc.
   5  * Copyright (c) 2008-2012, Jouni Malinen <j@w1.fi>
   6  *
   7  * This software may be distributed under the terms of the BSD license.
   8  * See README for more details.
   9  */
  10
  11 #include "utils/includes.h"
  12
  13 #include "utils/common.h"
  14 #include "utils/eloop.h"
  15 #include "common/ieee802_11_defs.h"
  16 #include "common/ieee802_11_common.h"
  17 #include "common/wpa_ctrl.h"
  18 #include "common/hw_features_common.h"
  19 #include "hostapd.h"
  20 #include "ap_config.h"
  21 #include "ap_drv_ops.h"
  22 #include "acs.h"
  23 #include "ieee802_11.h"
  24 #include "beacon.h"
  25 #include "hw_features.h"
  26
  27
  28 void hostapd_free_hw_features(struct hostapd_hw_modes *hw_features,
  29                               size_t num_hw_features)
  30 {
  31         size_t i;
  32
  33         if (hw_features == NULL)
  34                 return;
  35
  36         for (i = 0; i < num_hw_features; i++) {
  37                 os_free(hw_features[i].channels);
  38                 os_free(hw_features[i].rates);
  39         }
  40
  41         os_free(hw_features);
  42 }
  43
  44
  45 #ifndef CONFIG_NO_STDOUT_DEBUG
  46 static char * dfs_info(struct hostapd_channel_data *chan)
  47 {
  48         static char info[256];
  49         char *state;
  50
  51         switch (chan->flag & HOSTAPD_CHAN_DFS_MASK) {
  52         case HOSTAPD_CHAN_DFS_UNKNOWN:
  53                 state = "unknown";
  54                 break;
  55         case HOSTAPD_CHAN_DFS_USABLE:
  56                 state = "usable";
  57                 break;
  58         case HOSTAPD_CHAN_DFS_UNAVAILABLE:
  59                 state = "unavailable";
  60                 break;
  61         case HOSTAPD_CHAN_DFS_AVAILABLE:
  62                 state = "available";
  63                 break;
  64         default:
  65                 return "";
  66         }
  67         os_snprintf(info, sizeof(info), " (DFS state = %s)", state);
  68         info[sizeof(info) - 1] = '\0';
  69
  70         return info;
  71 }
  72 #endif /* CONFIG_NO_STDOUT_DEBUG */
  73
  74
  75 int hostapd_get_hw_features(struct hostapd_iface *iface)
  76 {
  77         struct hostapd_data *hapd = iface->bss[0];
  78         int i, j;
  79         u16 num_modes, flags;
  80         struct hostapd_hw_modes *modes;
  81
  82         if (hostapd_drv_none(hapd))
  83                 return -1;
  84         modes = hostapd_get_hw_feature_data(hapd, &num_modes, &flags);
  85         if (modes == NULL) {
  86                 hostapd_logger(hapd, NULL, HOSTAPD_MODULE_IEEE80211,
  87                                HOSTAPD_LEVEL_DEBUG,
  88                                "Fetching hardware channel/rate support not "
  89                                "supported.");
  90                 return -1;
  91         }
  92
  93         iface->hw_flags = flags;
  94
  95         hostapd_free_hw_features(iface->hw_features, iface->num_hw_features);
  96         iface->hw_features = modes;
  97         iface->num_hw_features = num_modes;
  98
  99         for (i = 0; i < num_modes; i++) {
 100                 struct hostapd_hw_modes *feature = &modes[i];
 101                 int dfs_enabled = hapd->iconf->ieee80211h &&
 102                         (iface->drv_flags & WPA_DRIVER_FLAGS_RADAR);
 103
 104                 /* set flag for channels we can use in current regulatory
 105                  * domain */
 106                 for (j = 0; j < feature->num_channels; j++) {
 107                         int dfs = 0;
 108
 109                         /*
 110                          * Disable all channels that are marked not to allow
 111                          * to initiate radiation (a.k.a. passive scan and no
 112                          * IBSS).
 113                          * Use radar channels only if the driver supports DFS.
 114                          */
 115                         if ((feature->channels[j].flag &
 116                              HOSTAPD_CHAN_RADAR) && dfs_enabled) {
 117                                 dfs = 1;
 118                         } else if (((feature->channels[j].flag &
 119                                      HOSTAPD_CHAN_RADAR) &&
 120                                     !(iface->drv_flags &
 121                                       WPA_DRIVER_FLAGS_DFS_OFFLOAD)) ||
 122                                    (feature->channels[j].flag &
 123                                     HOSTAPD_CHAN_NO_IR)) {
 124                                 feature->channels[j].flag |=
 125                                         HOSTAPD_CHAN_DISABLED;
 126                         }
 127
 128                         if (feature->channels[j].flag & HOSTAPD_CHAN_DISABLED)
 129                                 continue;
 130
 131                         wpa_printf(MSG_MSGDUMP, "Allowed channel: mode=%d "
 132                                    "chan=%d freq=%d MHz max_tx_power=%d dBm%s",
 133                                    feature->mode,
 134                                    feature->channels[j].chan,
 135                                    feature->channels[j].freq,
 136                                    feature->channels[j].max_tx_power,
 137                                    dfs ? dfs_info(&feature->channels[j]) : "");
 138                 }
 139         }
 140
 141         return 0;
 142 }
 143
 144
 145 int hostapd_prepare_rates(struct hostapd_iface *iface,
 146                           struct hostapd_hw_modes *mode)
 147 {
 148         int i, num_basic_rates = 0;
 149         int basic_rates_a[] = { 60, 120, 240, -1 };
 150         int basic_rates_b[] = { 10, 20, -1 };
 151         int basic_rates_g[] = { 10, 20, 55, 110, -1 };
 152         int *basic_rates;
 153
 154         if (iface->conf->basic_rates)
 155                 basic_rates = iface->conf->basic_rates;
 156         else switch (mode->mode) {
 157         case HOSTAPD_MODE_IEEE80211A:
 158                 basic_rates = basic_rates_a;
 159                 break;
 160         case HOSTAPD_MODE_IEEE80211B:
 161                 basic_rates = basic_rates_b;
 162                 break;
 163         case HOSTAPD_MODE_IEEE80211G:
 164                 basic_rates = basic_rates_g;
 165                 break;
 166         case HOSTAPD_MODE_IEEE80211AD:
 167                 return 0; /* No basic rates for 11ad */
 168         default:
 169                 return -1;
 170         }
 171
 172         i = 0;
 173         while (basic_rates[i] >= 0)
 174                 i++;
 175         if (i)
 176                 i++; /* -1 termination */
 177         os_free(iface->basic_rates);
 178         iface->basic_rates = os_malloc(i * sizeof(int));
 179         if (iface->basic_rates)
 180                 os_memcpy(iface->basic_rates, basic_rates, i * sizeof(int));
 181
 182         os_free(iface->current_rates);
 183         iface->num_rates = 0;
 184
 185         iface->current_rates =
 186                 os_calloc(mode->num_rates, sizeof(struct hostapd_rate_data));
 187         if (!iface->current_rates) {
 188                 wpa_printf(MSG_ERROR, "Failed to allocate memory for rate "
 189                            "table.");
 190                 return -1;
 191         }
 192
 193         for (i = 0; i < mode->num_rates; i++) {
 194                 struct hostapd_rate_data *rate;
 195
 196                 if (iface->conf->supported_rates &&
 197                     !hostapd_rate_found(iface->conf->supported_rates,
 198                                         mode->rates[i]))
 199                         continue;
 200
 201                 rate = &iface->current_rates[iface->num_rates];
 202                 rate->rate = mode->rates[i];
 203                 if (hostapd_rate_found(basic_rates, rate->rate)) {
 204                         rate->flags |= HOSTAPD_RATE_BASIC;
 205                         num_basic_rates++;
 206                 }
 207                 wpa_printf(MSG_DEBUG, "RATE[%d] rate=%d flags=0x%x",
 208                            iface->num_rates, rate->rate, rate->flags);
 209                 iface->num_rates++;
 210         }
 211
 212         if ((iface->num_rates == 0 || num_basic_rates == 0) &&
 213             (!iface->conf->ieee80211n || !iface->conf->require_ht)) {
 214                 wpa_printf(MSG_ERROR, "No rates remaining in supported/basic "
 215                            "rate sets (%d,%d).",
 216                            iface->num_rates, num_basic_rates);
 217                 return -1;
 218         }
 219
 220         return 0;
 221 }
 222
 223
 224 #ifdef CONFIG_IEEE80211N
 225 static int ieee80211n_allowed_ht40_channel_pair(struct hostapd_iface *iface)
 226 {
 227         int pri_chan, sec_chan;
 228
 229         if (!iface->conf->secondary_channel)
 230                 return 1; /* HT40 not used */
 231
 232         pri_chan = iface->conf->channel;
 233         sec_chan = pri_chan + iface->conf->secondary_channel * 4;
 234
 235         return allowed_ht40_channel_pair(iface->current_mode, pri_chan,
 236                                          sec_chan);
 237 }
 238
 239
 240 static void ieee80211n_switch_pri_sec(struct hostapd_iface *iface)
 241 {
 242         if (iface->conf->secondary_channel > 0) {
 243                 iface->conf->channel += 4;
 244                 iface->conf->secondary_channel = -1;
 245         } else {
 246                 iface->conf->channel -= 4;
 247                 iface->conf->secondary_channel = 1;
 248         }
 249 }
 250
 251
 252 static int ieee80211n_check_40mhz_5g(struct hostapd_iface *iface,
 253                                      struct wpa_scan_results *scan_res)
 254 {
 255         int pri_chan, sec_chan;
 256         int res;
 257
 258         pri_chan = iface->conf->channel;
 259         sec_chan = pri_chan + iface->conf->secondary_channel * 4;
 260
 261         res = check_40mhz_5g(iface->current_mode, scan_res, pri_chan, sec_chan);
 262
 263         if (res == 2) {
 264                 if (iface->conf->no_pri_sec_switch) {
 265                         wpa_printf(MSG_DEBUG,
 266                                    "Cannot switch PRI/SEC channels due to local constraint");
 267                 } else {
 268                         ieee80211n_switch_pri_sec(iface);
 269                 }
 270         }
 271
 272         return !!res;
 273 }
 274
 275
 276 static int ieee80211n_check_40mhz_2g4(struct hostapd_iface *iface,
 277                                       struct wpa_scan_results *scan_res)
 278 {
 279         int pri_chan, sec_chan;
 280
 281         pri_chan = iface->conf->channel;
 282         sec_chan = pri_chan + iface->conf->secondary_channel * 4;
 283
 284         return check_40mhz_2g4(iface->current_mode, scan_res, pri_chan,
 285                                sec_chan);
 286 }
 287
 288
 289 static void ieee80211n_check_scan(struct hostapd_iface *iface)
 290 {
 291         struct wpa_scan_results *scan_res;
 292         int oper40;
 293         int res;
 294
 295         /* Check list of neighboring BSSes (from scan) to see whether 40 MHz is
 296          * allowed per IEEE Std 802.11-2012, 10.15.3.2 */
 297
 298         iface->scan_cb = NULL;
 299
 300         scan_res = hostapd_driver_get_scan_results(iface->bss[0]);
 301         if (scan_res == NULL) {
 302                 hostapd_setup_interface_complete(iface, 1);
 303                 return;
 304         }
 305
 306         if (iface->current_mode->mode == HOSTAPD_MODE_IEEE80211A)
 307                 oper40 = ieee80211n_check_40mhz_5g(iface, scan_res);
 308         else
 309                 oper40 = ieee80211n_check_40mhz_2g4(iface, scan_res);
 310         wpa_scan_results_free(scan_res);
 311
 312         iface->secondary_ch = iface->conf->secondary_channel;
 313         if (!oper40) {
 314                 wpa_printf(MSG_INFO, "20/40 MHz operation not permitted on "
 315                            "channel pri=%d sec=%d based on overlapping BSSes",
 316                            iface->conf->channel,
 317                            iface->conf->channel +
 318                            iface->conf->secondary_channel * 4);
 319                 iface->conf->secondary_channel = 0;
 320                 if (iface->drv_flags & WPA_DRIVER_FLAGS_HT_2040_COEX) {
 321                         /*
 322                          * TODO: Could consider scheduling another scan to check
 323                          * if channel width can be changed if no coex reports
 324                          * are received from associating stations.
 325                          */
 326                 }
 327         }
 328
 329         res = ieee80211n_allowed_ht40_channel_pair(iface);
 330         if (!res) {
 331                 iface->conf->secondary_channel = 0;
 332                 wpa_printf(MSG_INFO, "Fallback to 20 MHz");
 333         }
 334
 335         hostapd_setup_interface_complete(iface, !res);
 336 }
 337
 338
 339 static void ieee80211n_scan_channels_2g4(struct hostapd_iface *iface,
 340                                          struct wpa_driver_scan_params *params)
 341 {
 342         /* Scan only the affected frequency range */
 343         int pri_freq, sec_freq;
 344         int affected_start, affected_end;
 345         int i, pos;
 346         struct hostapd_hw_modes *mode;
 347
 348         if (iface->current_mode == NULL)
 349                 return;
 350
 351         pri_freq = hostapd_hw_get_freq(iface->bss[0], iface->conf->channel);
 352         if (iface->conf->secondary_channel > 0)
 353                 sec_freq = pri_freq + 20;
 354         else
 355                 sec_freq = pri_freq - 20;
 356         /*
 357          * Note: Need to find the PRI channel also in cases where the affected
 358          * channel is the SEC channel of a 40 MHz BSS, so need to include the
 359          * scanning coverage here to be 40 MHz from the center frequency.
 360          */
 361         affected_start = (pri_freq + sec_freq) / 2 - 40;
 362         affected_end = (pri_freq + sec_freq) / 2 + 40;
 363         wpa_printf(MSG_DEBUG, "40 MHz affected channel range: [%d,%d] MHz",
 364                    affected_start, affected_end);
 365
 366         mode = iface->current_mode;
 367         params->freqs = os_calloc(mode->num_channels + 1, sizeof(int));
 368         if (params->freqs == NULL)
 369                 return;
 370         pos = 0;
 371
 372         for (i = 0; i < mode->num_channels; i++) {
 373                 struct hostapd_channel_data *chan = &mode->channels[i];
 374                 if (chan->flag & HOSTAPD_CHAN_DISABLED)
 375                         continue;
 376                 if (chan->freq < affected_start ||
 377                     chan->freq > affected_end)
 378                         continue;
 379                 params->freqs[pos++] = chan->freq;
 380         }
 381 }
 382
 383
 384 static void ieee80211n_scan_channels_5g(struct hostapd_iface *iface,
 385                                         struct wpa_driver_scan_params *params)
 386 {
 387         /* Scan only the affected frequency range */
 388         int pri_freq;
 389         int affected_start, affected_end;
 390         int i, pos;
 391         struct hostapd_hw_modes *mode;
 392
 393         if (iface->current_mode == NULL)
 394                 return;
 395
 396         pri_freq = hostapd_hw_get_freq(iface->bss[0], iface->conf->channel);
 397         if (iface->conf->secondary_channel > 0) {
 398                 affected_start = pri_freq - 10;
 399                 affected_end = pri_freq + 30;
 400         } else {
 401                 affected_start = pri_freq - 30;
 402                 affected_end = pri_freq + 10;
 403         }
 404         wpa_printf(MSG_DEBUG, "40 MHz affected channel range: [%d,%d] MHz",
 405                    affected_start, affected_end);
 406
 407         mode = iface->current_mode;
 408         params->freqs = os_calloc(mode->num_channels + 1, sizeof(int));
 409         if (params->freqs == NULL)
 410                 return;
 411         pos = 0;
 412
 413         for (i = 0; i < mode->num_channels; i++) {
 414                 struct hostapd_channel_data *chan = &mode->channels[i];
 415                 if (chan->flag & HOSTAPD_CHAN_DISABLED)
 416                         continue;
 417                 if (chan->freq < affected_start ||
 418                     chan->freq > affected_end)
 419                         continue;
 420                 params->freqs[pos++] = chan->freq;
 421         }
 422 }
 423
 424
 425 static void ap_ht40_scan_retry(void *eloop_data, void *user_data)
 426 {
 427 #define HT2040_COEX_SCAN_RETRY 15
 428         struct hostapd_iface *iface = eloop_data;
 429         struct wpa_driver_scan_params params;
 430         int ret;
 431
 432         os_memset(&params, 0, sizeof(params));
 433         if (iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G)
 434                 ieee80211n_scan_channels_2g4(iface, &params);
 435         else
 436                 ieee80211n_scan_channels_5g(iface, &params);
 437
 438         ret = hostapd_driver_scan(iface->bss[0], &params);
 439         iface->num_ht40_scan_tries++;
 440         os_free(params.freqs);
 441
 442         if (ret == -EBUSY &&
 443             iface->num_ht40_scan_tries < HT2040_COEX_SCAN_RETRY) {
 444                 wpa_printf(MSG_ERROR,
 445                            "Failed to request a scan of neighboring BSSes ret=%d (%s) - try to scan again (attempt %d)",
 446                            ret, strerror(-ret), iface->num_ht40_scan_tries);
 447                 eloop_register_timeout(1, 0, ap_ht40_scan_retry, iface, NULL);
 448                 return;
 449         }
 450
 451         if (ret == 0) {
 452                 iface->scan_cb = ieee80211n_check_scan;
 453                 return;
 454         }
 455
 456         wpa_printf(MSG_DEBUG,
 457                    "Failed to request a scan in device, bringing up in HT20 mode");
 458         iface->conf->secondary_channel = 0;
 459         iface->conf->ht_capab &= ~HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET;
 460         hostapd_setup_interface_complete(iface, 0);
 461 }
 462
 463
 464 void hostapd_stop_setup_timers(struct hostapd_iface *iface)
 465 {
 466         eloop_cancel_timeout(ap_ht40_scan_retry, iface, NULL);
 467 }
 468
 469
 470 static int ieee80211n_check_40mhz(struct hostapd_iface *iface)
 471 {
 472         struct wpa_driver_scan_params params;
 473         int ret;
 474
 475         if (!iface->conf->secondary_channel)
 476                 return 0; /* HT40 not used */
 477
 478         hostapd_set_state(iface, HAPD_IFACE_HT_SCAN);
 479         wpa_printf(MSG_DEBUG, "Scan for neighboring BSSes prior to enabling "
 480                    "40 MHz channel");
 481         os_memset(&params, 0, sizeof(params));
 482         if (iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G)
 483                 ieee80211n_scan_channels_2g4(iface, &params);
 484         else
 485                 ieee80211n_scan_channels_5g(iface, &params);
 486
 487         ret = hostapd_driver_scan(iface->bss[0], &params);
 488         os_free(params.freqs);
 489
 490         if (ret == -EBUSY) {
 491                 wpa_printf(MSG_ERROR,
 492                            "Failed to request a scan of neighboring BSSes ret=%d (%s) - try to scan again",
 493                            ret, strerror(-ret));
 494                 iface->num_ht40_scan_tries = 1;
 495                 eloop_cancel_timeout(ap_ht40_scan_retry, iface, NULL);
 496                 eloop_register_timeout(1, 0, ap_ht40_scan_retry, iface, NULL);
 497                 return 1;
 498         }
 499
 500         if (ret < 0) {
 501                 wpa_printf(MSG_ERROR,
 502                            "Failed to request a scan of neighboring BSSes ret=%d (%s)",
 503                            ret, strerror(-ret));
 504                 return -1;
 505         }
 506
 507         iface->scan_cb = ieee80211n_check_scan;
 508         return 1;
 509 }
 510
 511
 512 static int ieee80211n_supported_ht_capab(struct hostapd_iface *iface)
 513 {
 514         u16 hw = iface->current_mode->ht_capab;
 515         u16 conf = iface->conf->ht_capab;
 516
 517         if ((conf & HT_CAP_INFO_LDPC_CODING_CAP) &&
 518             !(hw & HT_CAP_INFO_LDPC_CODING_CAP)) {
 519                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 520                            "HT capability [LDPC]");
 521                 return 0;
 522         }
 523
 524         /*
 525          * Driver ACS chosen channel may not be HT40 due to internal driver
 526          * restrictions.
 527          */
 528         if (!iface->conf->acs && (conf & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET) &&
 529             !(hw & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET)) {
 530                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 531                            "HT capability [HT40*]");
 532                 return 0;
 533         }
 534
 535         switch (conf & HT_CAP_INFO_SMPS_MASK) {
 536         case HT_CAP_INFO_SMPS_STATIC:
 537                 if (!(iface->smps_modes & WPA_DRIVER_SMPS_MODE_STATIC)) {
 538                         wpa_printf(MSG_ERROR,
 539                                    "Driver does not support configured HT capability [SMPS-STATIC]");
 540                         return 0;
 541                 }
 542                 break;
 543         case HT_CAP_INFO_SMPS_DYNAMIC:
 544                 if (!(iface->smps_modes & WPA_DRIVER_SMPS_MODE_DYNAMIC)) {
 545                         wpa_printf(MSG_ERROR,
 546                                    "Driver does not support configured HT capability [SMPS-DYNAMIC]");
 547                         return 0;
 548                 }
 549                 break;
 550         case HT_CAP_INFO_SMPS_DISABLED:
 551         default:
 552                 break;
 553         }
 554
 555         if ((conf & HT_CAP_INFO_GREEN_FIELD) &&
 556             !(hw & HT_CAP_INFO_GREEN_FIELD)) {
 557                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 558                            "HT capability [GF]");
 559                 return 0;
 560         }
 561
 562         if ((conf & HT_CAP_INFO_SHORT_GI20MHZ) &&
 563             !(hw & HT_CAP_INFO_SHORT_GI20MHZ)) {
 564                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 565                            "HT capability [SHORT-GI-20]");
 566                 return 0;
 567         }
 568
 569         if ((conf & HT_CAP_INFO_SHORT_GI40MHZ) &&
 570             !(hw & HT_CAP_INFO_SHORT_GI40MHZ)) {
 571                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 572                            "HT capability [SHORT-GI-40]");
 573                 return 0;
 574         }
 575
 576         if ((conf & HT_CAP_INFO_TX_STBC) && !(hw & HT_CAP_INFO_TX_STBC)) {
 577                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 578                            "HT capability [TX-STBC]");
 579                 return 0;
 580         }
 581
 582         if ((conf & HT_CAP_INFO_RX_STBC_MASK) >
 583             (hw & HT_CAP_INFO_RX_STBC_MASK)) {
 584                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 585                            "HT capability [RX-STBC*]");
 586                 return 0;
 587         }
 588
 589         if ((conf & HT_CAP_INFO_DELAYED_BA) &&
 590             !(hw & HT_CAP_INFO_DELAYED_BA)) {
 591                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 592                            "HT capability [DELAYED-BA]");
 593                 return 0;
 594         }
 595
 596         if ((conf & HT_CAP_INFO_MAX_AMSDU_SIZE) &&
 597             !(hw & HT_CAP_INFO_MAX_AMSDU_SIZE)) {
 598                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 599                            "HT capability [MAX-AMSDU-7935]");
 600                 return 0;
 601         }
 602
 603         if ((conf & HT_CAP_INFO_DSSS_CCK40MHZ) &&
 604             !(hw & HT_CAP_INFO_DSSS_CCK40MHZ)) {
 605                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 606                            "HT capability [DSSS_CCK-40]");
 607                 return 0;
 608         }
 609
 610         if ((conf & HT_CAP_INFO_LSIG_TXOP_PROTECT_SUPPORT) &&
 611             !(hw & HT_CAP_INFO_LSIG_TXOP_PROTECT_SUPPORT)) {
 612                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 613                            "HT capability [LSIG-TXOP-PROT]");
 614                 return 0;
 615         }
 616
 617         return 1;
 618 }
 619
 620
 621 #ifdef CONFIG_IEEE80211AC
 622
 623 static int ieee80211ac_cap_check(u32 hw, u32 conf, u32 cap, const char *name)
 624 {
 625         u32 req_cap = conf & cap;
 626
 627         /*
 628          * Make sure we support all requested capabilities.
 629          * NOTE: We assume that 'cap' represents a capability mask,
 630          * not a discrete value.
 631          */
 632         if ((hw & req_cap) != req_cap) {
 633                 wpa_printf(MSG_ERROR, "Driver does not support configured VHT capability [%s]",
 634                            name);
 635                 return 0;
 636         }
 637         return 1;
 638 }
 639
 640
 641 static int ieee80211ac_cap_check_max(u32 hw, u32 conf, u32 mask,
 642                                      unsigned int shift,
 643                                      const char *name)
 644 {
 645         u32 hw_max = hw & mask;
 646         u32 conf_val = conf & mask;
 647
 648         if (conf_val > hw_max) {
 649                 wpa_printf(MSG_ERROR, "Configured VHT capability [%s] exceeds max value supported by the driver (%d > %d)",
 650                            name, conf_val >> shift, hw_max >> shift);
 651                 return 0;
 652         }
 653         return 1;
 654 }
 655
 656
 657 static int ieee80211ac_supported_vht_capab(struct hostapd_iface *iface)
 658 {
 659         struct hostapd_hw_modes *mode = iface->current_mode;
 660         u32 hw = mode->vht_capab;
 661         u32 conf = iface->conf->vht_capab;
 662
 663         wpa_printf(MSG_DEBUG, "hw vht capab: 0x%x, conf vht capab: 0x%x",
 664                    hw, conf);
 665
 666         if (mode->mode == HOSTAPD_MODE_IEEE80211G &&
 667             iface->conf->bss[0]->vendor_vht &&
 668             mode->vht_capab == 0 && iface->hw_features) {
 669                 int i;
 670
 671                 for (i = 0; i < iface->num_hw_features; i++) {
 672                         if (iface->hw_features[i].mode ==
 673                             HOSTAPD_MODE_IEEE80211A) {
 674                                 mode = &iface->hw_features[i];
 675                                 hw = mode->vht_capab;
 676                                 wpa_printf(MSG_DEBUG,
 677                                            "update hw vht capab based on 5 GHz band: 0x%x",
 678                                            hw);
 679                                 break;
 680                         }
 681                 }
 682         }
 683
 684 #define VHT_CAP_CHECK(cap) \
 685         do { \
 686                 if (!ieee80211ac_cap_check(hw, conf, cap, #cap)) \
 687                         return 0; \
 688         } while (0)
 689
 690 #define VHT_CAP_CHECK_MAX(cap) \
 691         do { \
 692                 if (!ieee80211ac_cap_check_max(hw, conf, cap, cap ## _SHIFT, \
 693                                                #cap)) \
 694                         return 0; \
 695         } while (0)
 696
 697         VHT_CAP_CHECK_MAX(VHT_CAP_MAX_MPDU_LENGTH_MASK);
 698         VHT_CAP_CHECK(VHT_CAP_SUPP_CHAN_WIDTH_160MHZ);
 699         VHT_CAP_CHECK(VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ);
 700         VHT_CAP_CHECK(VHT_CAP_RXLDPC);
 701         VHT_CAP_CHECK(VHT_CAP_SHORT_GI_80);
 702         VHT_CAP_CHECK(VHT_CAP_SHORT_GI_160);
 703         VHT_CAP_CHECK(VHT_CAP_TXSTBC);
 704         VHT_CAP_CHECK_MAX(VHT_CAP_RXSTBC_MASK);
 705         VHT_CAP_CHECK(VHT_CAP_SU_BEAMFORMER_CAPABLE);
 706         VHT_CAP_CHECK(VHT_CAP_SU_BEAMFORMEE_CAPABLE);
 707         VHT_CAP_CHECK_MAX(VHT_CAP_BEAMFORMEE_STS_MAX);
 708         VHT_CAP_CHECK_MAX(VHT_CAP_SOUNDING_DIMENSION_MAX);
 709         VHT_CAP_CHECK(VHT_CAP_MU_BEAMFORMER_CAPABLE);
 710         VHT_CAP_CHECK(VHT_CAP_MU_BEAMFORMEE_CAPABLE);
 711         VHT_CAP_CHECK(VHT_CAP_VHT_TXOP_PS);
 712         VHT_CAP_CHECK(VHT_CAP_HTC_VHT);
 713         VHT_CAP_CHECK_MAX(VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MAX);
 714         VHT_CAP_CHECK(VHT_CAP_VHT_LINK_ADAPTATION_VHT_UNSOL_MFB);
 715         VHT_CAP_CHECK(VHT_CAP_VHT_LINK_ADAPTATION_VHT_MRQ_MFB);
 716         VHT_CAP_CHECK(VHT_CAP_RX_ANTENNA_PATTERN);
 717         VHT_CAP_CHECK(VHT_CAP_TX_ANTENNA_PATTERN);
 718
 719 #undef VHT_CAP_CHECK
 720 #undef VHT_CAP_CHECK_MAX
 721
 722         return 1;
 723 }
 724 #endif /* CONFIG_IEEE80211AC */
 725
 726 #endif /* CONFIG_IEEE80211N */
 727
 728
 729 int hostapd_check_ht_capab(struct hostapd_iface *iface)
 730 {
 731 #ifdef CONFIG_IEEE80211N
 732         int ret;
 733         if (!iface->conf->ieee80211n)
 734                 return 0;
 735
 736         if (iface->current_mode->mode != HOSTAPD_MODE_IEEE80211B &&
 737             iface->current_mode->mode != HOSTAPD_MODE_IEEE80211G &&
 738             (iface->conf->ht_capab & HT_CAP_INFO_DSSS_CCK40MHZ)) {
 739                 wpa_printf(MSG_DEBUG,
 740                            "Disable HT capability [DSSS_CCK-40] on 5 GHz band");
 741                 iface->conf->ht_capab &= ~HT_CAP_INFO_DSSS_CCK40MHZ;
 742         }
 743
 744         if (!ieee80211n_supported_ht_capab(iface))
 745                 return -1;
 746 #ifdef CONFIG_IEEE80211AC
 747         if (!ieee80211ac_supported_vht_capab(iface))
 748                 return -1;
 749 #endif /* CONFIG_IEEE80211AC */
 750         ret = ieee80211n_check_40mhz(iface);
 751         if (ret)
 752                 return ret;
 753         if (!ieee80211n_allowed_ht40_channel_pair(iface))
 754                 return -1;
 755 #endif /* CONFIG_IEEE80211N */
 756
 757         return 0;
 758 }
 759
 760
 761 static int hostapd_is_usable_chan(struct hostapd_iface *iface,
 762                                   int channel, int primary)
 763 {
 764         int i;
 765         struct hostapd_channel_data *chan;
 766
 767         if (!iface->current_mode)
 768                 return 0;
 769
 770         for (i = 0; i < iface->current_mode->num_channels; i++) {
 771                 chan = &iface->current_mode->channels[i];
 772                 if (chan->chan != channel)
 773                         continue;
 774
 775                 if (!(chan->flag & HOSTAPD_CHAN_DISABLED))
 776                         return 1;
 777
 778                 wpa_printf(MSG_DEBUG,
 779                            "%schannel [%i] (%i) is disabled for use in AP mode, flags: 0x%x%s%s",
 780                            primary ? "" : "Configured HT40 secondary ",
 781                            i, chan->chan, chan->flag,
 782                            chan->flag & HOSTAPD_CHAN_NO_IR ? " NO-IR" : "",
 783                            chan->flag & HOSTAPD_CHAN_RADAR ? " RADAR" : "");
 784         }
 785
 786         return 0;
 787 }
 788
 789
 790 static int hostapd_is_usable_chans(struct hostapd_iface *iface)
 791 {
 792         if (!hostapd_is_usable_chan(iface, iface->conf->channel, 1))
 793                 return 0;
 794
 795         if (!iface->conf->secondary_channel)
 796                 return 1;
 797
 798         return hostapd_is_usable_chan(iface, iface->conf->channel +
 799                                       iface->conf->secondary_channel * 4, 0);
 800 }
 801
 802
 803 static enum hostapd_chan_status
 804 hostapd_check_chans(struct hostapd_iface *iface)
 805 {
 806         if (iface->conf->channel) {
 807                 if (hostapd_is_usable_chans(iface))
 808                         return HOSTAPD_CHAN_VALID;
 809                 else
 810                         return HOSTAPD_CHAN_INVALID;
 811         }
 812
 813         /*
 814          * The user set channel=0 or channel=acs_survey
 815          * which is used to trigger ACS.
 816          */
 817
 818         switch (acs_init(iface)) {
 819         case HOSTAPD_CHAN_ACS:
 820                 return HOSTAPD_CHAN_ACS;
 821         case HOSTAPD_CHAN_VALID:
 822         case HOSTAPD_CHAN_INVALID:
 823         default:
 824                 return HOSTAPD_CHAN_INVALID;
 825         }
 826 }
 827
 828
 829 static void hostapd_notify_bad_chans(struct hostapd_iface *iface)
 830 {
 831         if (!iface->current_mode) {
 832                 hostapd_logger(iface->bss[0], NULL, HOSTAPD_MODULE_IEEE80211,
 833                                HOSTAPD_LEVEL_WARNING,
 834                                "Hardware does not support configured mode");
 835                 return;
 836         }
 837         hostapd_logger(iface->bss[0], NULL,
 838                        HOSTAPD_MODULE_IEEE80211,
 839                        HOSTAPD_LEVEL_WARNING,
 840                        "Configured channel (%d) not found from the "
 841                        "channel list of current mode (%d) %s",
 842                        iface->conf->channel,
 843                        iface->current_mode->mode,
 844                        hostapd_hw_mode_txt(iface->current_mode->mode));
 845         hostapd_logger(iface->bss[0], NULL, HOSTAPD_MODULE_IEEE80211,
 846                        HOSTAPD_LEVEL_WARNING,
 847                        "Hardware does not support configured channel");
 848 }
 849
 850
 851 int hostapd_acs_completed(struct hostapd_iface *iface, int err)
 852 {
 853         int ret = -1;
 854
 855         if (err)
 856                 goto out;
 857
 858         switch (hostapd_check_chans(iface)) {
 859         case HOSTAPD_CHAN_VALID:
 860                 wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO,
 861                         ACS_EVENT_COMPLETED "freq=%d channel=%d",
 862                         hostapd_hw_get_freq(iface->bss[0],
 863                                             iface->conf->channel),
 864                         iface->conf->channel);
 865                 break;
 866         case HOSTAPD_CHAN_ACS:
 867                 wpa_printf(MSG_ERROR, "ACS error - reported complete, but no result available");
 868                 wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, ACS_EVENT_FAILED);
 869                 hostapd_notify_bad_chans(iface);
 870                 goto out;
 871         case HOSTAPD_CHAN_INVALID:
 872         default:
 873                 wpa_printf(MSG_ERROR, "ACS picked unusable channels");
 874                 wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, ACS_EVENT_FAILED);
 875                 hostapd_notify_bad_chans(iface);
 876                 goto out;
 877         }
 878
 879         ret = hostapd_check_ht_capab(iface);
 880         if (ret < 0)
 881                 goto out;
 882         if (ret == 1) {
 883                 wpa_printf(MSG_DEBUG, "Interface initialization will be completed in a callback");
 884                 return 0;
 885         }
 886
 887         ret = 0;
 888 out:
 889         return hostapd_setup_interface_complete(iface, ret);
 890 }
 891
 892
 893 /**
 894  * hostapd_select_hw_mode - Select the hardware mode
 895  * @iface: Pointer to interface data.
 896  * Returns: 0 on success, < 0 on failure
 897  *
 898  * Sets up the hardware mode, channel, rates, and passive scanning
 899  * based on the configuration.
 900  */
 901 int hostapd_select_hw_mode(struct hostapd_iface *iface)
 902 {
 903         int i;
 904
 905         if (iface->num_hw_features < 1)
 906                 return -1;
 907
 908         if ((iface->conf->hw_mode == HOSTAPD_MODE_IEEE80211G ||
 909              iface->conf->ieee80211n || iface->conf->ieee80211ac) &&
 910             iface->conf->channel == 14) {
 911                 wpa_printf(MSG_INFO, "Disable OFDM/HT/VHT on channel 14");
 912                 iface->conf->hw_mode = HOSTAPD_MODE_IEEE80211B;
 913                 iface->conf->ieee80211n = 0;
 914                 iface->conf->ieee80211ac = 0;
 915         }
 916
 917         iface->current_mode = NULL;
 918         for (i = 0; i < iface->num_hw_features; i++) {
 919                 struct hostapd_hw_modes *mode = &iface->hw_features[i];
 920                 if (mode->mode == iface->conf->hw_mode) {
 921                         iface->current_mode = mode;
 922                         break;
 923                 }
 924         }
 925
 926         if (iface->current_mode == NULL) {
 927                 if (!(iface->drv_flags & WPA_DRIVER_FLAGS_ACS_OFFLOAD) ||
 928                     !(iface->drv_flags & WPA_DRIVER_FLAGS_SUPPORT_HW_MODE_ANY))
 929                 {
 930                         wpa_printf(MSG_ERROR,
 931                                    "Hardware does not support configured mode");
 932                         hostapd_logger(iface->bss[0], NULL,
 933                                        HOSTAPD_MODULE_IEEE80211,
 934                                        HOSTAPD_LEVEL_WARNING,
 935                                        "Hardware does not support configured mode (%d) (hw_mode in hostapd.conf)",
 936                                        (int) iface->conf->hw_mode);
 937                         return -2;
 938                 }
 939         }
 940
 941         switch (hostapd_check_chans(iface)) {
 942         case HOSTAPD_CHAN_VALID:
 943                 return 0;
 944         case HOSTAPD_CHAN_ACS: /* ACS will run and later complete */
 945                 return 1;
 946         case HOSTAPD_CHAN_INVALID:
 947         default:
 948                 hostapd_notify_bad_chans(iface);
 949                 return -3;
 950         }
 951 }
 952
 953
 954 const char * hostapd_hw_mode_txt(int mode)
 955 {
 956         switch (mode) {
 957         case HOSTAPD_MODE_IEEE80211A:
 958                 return "IEEE 802.11a";
 959         case HOSTAPD_MODE_IEEE80211B:
 960                 return "IEEE 802.11b";
 961         case HOSTAPD_MODE_IEEE80211G:
 962                 return "IEEE 802.11g";
 963         case HOSTAPD_MODE_IEEE80211AD:
 964                 return "IEEE 802.11ad";
 965         default:
 966                 return "UNKNOWN";
 967         }
 968 }
 969
 970
 971 int hostapd_hw_get_freq(struct hostapd_data *hapd, int chan)
 972 {
 973         return hw_get_freq(hapd->iface->current_mode, chan);
 974 }
 975
 976
 977 int hostapd_hw_get_channel(struct hostapd_data *hapd, int freq)
 978 {
 979         return hw_get_chan(hapd->iface->current_mode, freq);
 980 }