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         u8 dfs_domain;
  82
  83         if (hostapd_drv_none(hapd))
  84                 return -1;
  85         modes = hostapd_get_hw_feature_data(hapd, &num_modes, &flags,
  86                                             &dfs_domain);
  87         if (modes == NULL) {
  88                 hostapd_logger(hapd, NULL, HOSTAPD_MODULE_IEEE80211,
  89                                HOSTAPD_LEVEL_DEBUG,
  90                                "Fetching hardware channel/rate support not "
  91                                "supported.");
  92                 return -1;
  93         }
  94
  95         iface->hw_flags = flags;
  96         iface->dfs_domain = dfs_domain;
  97
  98         hostapd_free_hw_features(iface->hw_features, iface->num_hw_features);
  99         iface->hw_features = modes;
 100         iface->num_hw_features = num_modes;
 101
 102         for (i = 0; i < num_modes; i++) {
 103                 struct hostapd_hw_modes *feature = &modes[i];
 104                 int dfs_enabled = hapd->iconf->ieee80211h &&
 105                         (iface->drv_flags & WPA_DRIVER_FLAGS_RADAR);
 106
 107                 /* set flag for channels we can use in current regulatory
 108                  * domain */
 109                 for (j = 0; j < feature->num_channels; j++) {
 110                         int dfs = 0;
 111
 112                         /*
 113                          * Disable all channels that are marked not to allow
 114                          * to initiate radiation (a.k.a. passive scan and no
 115                          * IBSS).
 116                          * Use radar channels only if the driver supports DFS.
 117                          */
 118                         if ((feature->channels[j].flag &
 119                              HOSTAPD_CHAN_RADAR) && dfs_enabled) {
 120                                 dfs = 1;
 121                         } else if (((feature->channels[j].flag &
 122                                      HOSTAPD_CHAN_RADAR) &&
 123                                     !(iface->drv_flags &
 124                                       WPA_DRIVER_FLAGS_DFS_OFFLOAD)) ||
 125                                    (feature->channels[j].flag &
 126                                     HOSTAPD_CHAN_NO_IR)) {
 127                                 feature->channels[j].flag |=
 128                                         HOSTAPD_CHAN_DISABLED;
 129                         }
 130
 131                         if (feature->channels[j].flag & HOSTAPD_CHAN_DISABLED)
 132                                 continue;
 133
 134                         wpa_printf(MSG_MSGDUMP, "Allowed channel: mode=%d "
 135                                    "chan=%d freq=%d MHz max_tx_power=%d dBm%s",
 136                                    feature->mode,
 137                                    feature->channels[j].chan,
 138                                    feature->channels[j].freq,
 139                                    feature->channels[j].max_tx_power,
 140                                    dfs ? dfs_info(&feature->channels[j]) : "");
 141                 }
 142         }
 143
 144         return 0;
 145 }
 146
 147
 148 int hostapd_prepare_rates(struct hostapd_iface *iface,
 149                           struct hostapd_hw_modes *mode)
 150 {
 151         int i, num_basic_rates = 0;
 152         int basic_rates_a[] = { 60, 120, 240, -1 };
 153         int basic_rates_b[] = { 10, 20, -1 };
 154         int basic_rates_g[] = { 10, 20, 55, 110, -1 };
 155         int *basic_rates;
 156
 157         if (iface->conf->basic_rates)
 158                 basic_rates = iface->conf->basic_rates;
 159         else switch (mode->mode) {
 160         case HOSTAPD_MODE_IEEE80211A:
 161                 basic_rates = basic_rates_a;
 162                 break;
 163         case HOSTAPD_MODE_IEEE80211B:
 164                 basic_rates = basic_rates_b;
 165                 break;
 166         case HOSTAPD_MODE_IEEE80211G:
 167                 basic_rates = basic_rates_g;
 168                 break;
 169         case HOSTAPD_MODE_IEEE80211AD:
 170                 return 0; /* No basic rates for 11ad */
 171         default:
 172                 return -1;
 173         }
 174
 175         i = 0;
 176         while (basic_rates[i] >= 0)
 177                 i++;
 178         if (i)
 179                 i++; /* -1 termination */
 180         os_free(iface->basic_rates);
 181         iface->basic_rates = os_malloc(i * sizeof(int));
 182         if (iface->basic_rates)
 183                 os_memcpy(iface->basic_rates, basic_rates, i * sizeof(int));
 184
 185         os_free(iface->current_rates);
 186         iface->num_rates = 0;
 187
 188         iface->current_rates =
 189                 os_calloc(mode->num_rates, sizeof(struct hostapd_rate_data));
 190         if (!iface->current_rates) {
 191                 wpa_printf(MSG_ERROR, "Failed to allocate memory for rate "
 192                            "table.");
 193                 return -1;
 194         }
 195
 196         for (i = 0; i < mode->num_rates; i++) {
 197                 struct hostapd_rate_data *rate;
 198
 199                 if (iface->conf->supported_rates &&
 200                     !hostapd_rate_found(iface->conf->supported_rates,
 201                                         mode->rates[i]))
 202                         continue;
 203
 204                 rate = &iface->current_rates[iface->num_rates];
 205                 rate->rate = mode->rates[i];
 206                 if (hostapd_rate_found(basic_rates, rate->rate)) {
 207                         rate->flags |= HOSTAPD_RATE_BASIC;
 208                         num_basic_rates++;
 209                 }
 210                 wpa_printf(MSG_DEBUG, "RATE[%d] rate=%d flags=0x%x",
 211                            iface->num_rates, rate->rate, rate->flags);
 212                 iface->num_rates++;
 213         }
 214
 215         if ((iface->num_rates == 0 || num_basic_rates == 0) &&
 216             (!iface->conf->ieee80211n || !iface->conf->require_ht)) {
 217                 wpa_printf(MSG_ERROR, "No rates remaining in supported/basic "
 218                            "rate sets (%d,%d).",
 219                            iface->num_rates, num_basic_rates);
 220                 return -1;
 221         }
 222
 223         return 0;
 224 }
 225
 226
 227 #ifdef CONFIG_IEEE80211N
 228 static int ieee80211n_allowed_ht40_channel_pair(struct hostapd_iface *iface)
 229 {
 230         int pri_freq, sec_freq;
 231         struct hostapd_channel_data *p_chan, *s_chan;
 232
 233         pri_freq = iface->freq;
 234         sec_freq = pri_freq + iface->conf->secondary_channel * 20;
 235
 236         if (!iface->current_mode)
 237                 return 0;
 238
 239         p_chan = hw_get_channel_freq(iface->current_mode->mode, pri_freq, NULL,
 240                                      iface->hw_features,
 241                                      iface->num_hw_features);
 242
 243         s_chan = hw_get_channel_freq(iface->current_mode->mode, sec_freq, NULL,
 244                                      iface->hw_features,
 245                                      iface->num_hw_features);
 246
 247         return allowed_ht40_channel_pair(iface->current_mode->mode,
 248                                          p_chan, s_chan);
 249 }
 250
 251
 252 static void ieee80211n_switch_pri_sec(struct hostapd_iface *iface)
 253 {
 254         if (iface->conf->secondary_channel > 0) {
 255                 iface->conf->channel += 4;
 256                 iface->freq += 20;
 257                 iface->conf->secondary_channel = -1;
 258         } else {
 259                 iface->conf->channel -= 4;
 260                 iface->freq -= 20;
 261                 iface->conf->secondary_channel = 1;
 262         }
 263 }
 264
 265
 266 static int ieee80211n_check_40mhz_5g(struct hostapd_iface *iface,
 267                                      struct wpa_scan_results *scan_res)
 268 {
 269         unsigned int pri_freq, sec_freq;
 270         int res;
 271         struct hostapd_channel_data *pri_chan, *sec_chan;
 272
 273         pri_freq = iface->freq;
 274         sec_freq = pri_freq + iface->conf->secondary_channel * 20;
 275
 276         if (!iface->current_mode)
 277                 return 0;
 278         pri_chan = hw_get_channel_freq(iface->current_mode->mode, pri_freq,
 279                                        NULL, iface->hw_features,
 280                                        iface->num_hw_features);
 281         sec_chan = hw_get_channel_freq(iface->current_mode->mode, sec_freq,
 282                                        NULL, iface->hw_features,
 283                                        iface->num_hw_features);
 284
 285         res = check_40mhz_5g(scan_res, pri_chan, sec_chan);
 286
 287         if (res == 2) {
 288                 if (iface->conf->no_pri_sec_switch) {
 289                         wpa_printf(MSG_DEBUG,
 290                                    "Cannot switch PRI/SEC channels due to local constraint");
 291                 } else {
 292                         ieee80211n_switch_pri_sec(iface);
 293                 }
 294         }
 295
 296         return !!res;
 297 }
 298
 299
 300 static int ieee80211n_check_40mhz_2g4(struct hostapd_iface *iface,
 301                                       struct wpa_scan_results *scan_res)
 302 {
 303         int pri_chan, sec_chan;
 304
 305         pri_chan = iface->conf->channel;
 306         sec_chan = pri_chan + iface->conf->secondary_channel * 4;
 307
 308         return check_40mhz_2g4(iface->current_mode, scan_res, pri_chan,
 309                                sec_chan);
 310 }
 311
 312
 313 static void ieee80211n_check_scan(struct hostapd_iface *iface)
 314 {
 315         struct wpa_scan_results *scan_res;
 316         int oper40;
 317         int res;
 318
 319         /* Check list of neighboring BSSes (from scan) to see whether 40 MHz is
 320          * allowed per IEEE Std 802.11-2012, 10.15.3.2 */
 321
 322         iface->scan_cb = NULL;
 323
 324         scan_res = hostapd_driver_get_scan_results(iface->bss[0]);
 325         if (scan_res == NULL) {
 326                 hostapd_setup_interface_complete(iface, 1);
 327                 return;
 328         }
 329
 330         if (iface->current_mode->mode == HOSTAPD_MODE_IEEE80211A)
 331                 oper40 = ieee80211n_check_40mhz_5g(iface, scan_res);
 332         else
 333                 oper40 = ieee80211n_check_40mhz_2g4(iface, scan_res);
 334         wpa_scan_results_free(scan_res);
 335
 336         iface->secondary_ch = iface->conf->secondary_channel;
 337         if (!oper40) {
 338                 wpa_printf(MSG_INFO, "20/40 MHz operation not permitted on "
 339                            "channel pri=%d sec=%d based on overlapping BSSes",
 340                            iface->conf->channel,
 341                            iface->conf->channel +
 342                            iface->conf->secondary_channel * 4);
 343                 iface->conf->secondary_channel = 0;
 344                 if (iface->drv_flags & WPA_DRIVER_FLAGS_HT_2040_COEX) {
 345                         /*
 346                          * TODO: Could consider scheduling another scan to check
 347                          * if channel width can be changed if no coex reports
 348                          * are received from associating stations.
 349                          */
 350                 }
 351         }
 352
 353         res = ieee80211n_allowed_ht40_channel_pair(iface);
 354         if (!res) {
 355                 iface->conf->secondary_channel = 0;
 356                 hostapd_set_oper_centr_freq_seg0_idx(iface->conf, 0);
 357                 hostapd_set_oper_centr_freq_seg1_idx(iface->conf, 0);
 358                 hostapd_set_oper_chwidth(iface->conf, CHANWIDTH_USE_HT);
 359                 res = 1;
 360                 wpa_printf(MSG_INFO, "Fallback to 20 MHz");
 361         }
 362
 363         hostapd_setup_interface_complete(iface, !res);
 364 }
 365
 366
 367 static void ieee80211n_scan_channels_2g4(struct hostapd_iface *iface,
 368                                          struct wpa_driver_scan_params *params)
 369 {
 370         /* Scan only the affected frequency range */
 371         int pri_freq, sec_freq;
 372         int affected_start, affected_end;
 373         int i, pos;
 374         struct hostapd_hw_modes *mode;
 375
 376         if (iface->current_mode == NULL)
 377                 return;
 378
 379         pri_freq = iface->freq;
 380         if (iface->conf->secondary_channel > 0)
 381                 sec_freq = pri_freq + 20;
 382         else
 383                 sec_freq = pri_freq - 20;
 384         /*
 385          * Note: Need to find the PRI channel also in cases where the affected
 386          * channel is the SEC channel of a 40 MHz BSS, so need to include the
 387          * scanning coverage here to be 40 MHz from the center frequency.
 388          */
 389         affected_start = (pri_freq + sec_freq) / 2 - 40;
 390         affected_end = (pri_freq + sec_freq) / 2 + 40;
 391         wpa_printf(MSG_DEBUG, "40 MHz affected channel range: [%d,%d] MHz",
 392                    affected_start, affected_end);
 393
 394         mode = iface->current_mode;
 395         params->freqs = os_calloc(mode->num_channels + 1, sizeof(int));
 396         if (params->freqs == NULL)
 397                 return;
 398         pos = 0;
 399
 400         for (i = 0; i < mode->num_channels; i++) {
 401                 struct hostapd_channel_data *chan = &mode->channels[i];
 402                 if (chan->flag & HOSTAPD_CHAN_DISABLED)
 403                         continue;
 404                 if (chan->freq < affected_start ||
 405                     chan->freq > affected_end)
 406                         continue;
 407                 params->freqs[pos++] = chan->freq;
 408         }
 409 }
 410
 411
 412 static void ieee80211n_scan_channels_5g(struct hostapd_iface *iface,
 413                                         struct wpa_driver_scan_params *params)
 414 {
 415         /* Scan only the affected frequency range */
 416         int pri_freq;
 417         int affected_start, affected_end;
 418         int i, pos;
 419         struct hostapd_hw_modes *mode;
 420
 421         if (iface->current_mode == NULL)
 422                 return;
 423
 424         pri_freq = iface->freq;
 425         if (iface->conf->secondary_channel > 0) {
 426                 affected_start = pri_freq - 10;
 427                 affected_end = pri_freq + 30;
 428         } else {
 429                 affected_start = pri_freq - 30;
 430                 affected_end = pri_freq + 10;
 431         }
 432         wpa_printf(MSG_DEBUG, "40 MHz affected channel range: [%d,%d] MHz",
 433                    affected_start, affected_end);
 434
 435         mode = iface->current_mode;
 436         params->freqs = os_calloc(mode->num_channels + 1, sizeof(int));
 437         if (params->freqs == NULL)
 438                 return;
 439         pos = 0;
 440
 441         for (i = 0; i < mode->num_channels; i++) {
 442                 struct hostapd_channel_data *chan = &mode->channels[i];
 443                 if (chan->flag & HOSTAPD_CHAN_DISABLED)
 444                         continue;
 445                 if (chan->freq < affected_start ||
 446                     chan->freq > affected_end)
 447                         continue;
 448                 params->freqs[pos++] = chan->freq;
 449         }
 450 }
 451
 452
 453 static void ap_ht40_scan_retry(void *eloop_data, void *user_data)
 454 {
 455 #define HT2040_COEX_SCAN_RETRY 15
 456         struct hostapd_iface *iface = eloop_data;
 457         struct wpa_driver_scan_params params;
 458         int ret;
 459
 460         os_memset(&params, 0, sizeof(params));
 461         if (iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G)
 462                 ieee80211n_scan_channels_2g4(iface, &params);
 463         else
 464                 ieee80211n_scan_channels_5g(iface, &params);
 465
 466         ret = hostapd_driver_scan(iface->bss[0], &params);
 467         iface->num_ht40_scan_tries++;
 468         os_free(params.freqs);
 469
 470         if (ret == -EBUSY &&
 471             iface->num_ht40_scan_tries < HT2040_COEX_SCAN_RETRY) {
 472                 wpa_printf(MSG_ERROR,
 473                            "Failed to request a scan of neighboring BSSes ret=%d (%s) - try to scan again (attempt %d)",
 474                            ret, strerror(-ret), iface->num_ht40_scan_tries);
 475                 eloop_register_timeout(1, 0, ap_ht40_scan_retry, iface, NULL);
 476                 return;
 477         }
 478
 479         if (ret == 0) {
 480                 iface->scan_cb = ieee80211n_check_scan;
 481                 return;
 482         }
 483
 484         wpa_printf(MSG_DEBUG,
 485                    "Failed to request a scan in device, bringing up in HT20 mode");
 486         iface->conf->secondary_channel = 0;
 487         iface->conf->ht_capab &= ~HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET;
 488         hostapd_setup_interface_complete(iface, 0);
 489 }
 490
 491
 492 void hostapd_stop_setup_timers(struct hostapd_iface *iface)
 493 {
 494         eloop_cancel_timeout(ap_ht40_scan_retry, iface, NULL);
 495 }
 496
 497
 498 static int ieee80211n_check_40mhz(struct hostapd_iface *iface)
 499 {
 500         struct wpa_driver_scan_params params;
 501         int ret;
 502
 503         /* Check that HT40 is used and PRI / SEC switch is allowed */
 504         if (!iface->conf->secondary_channel || iface->conf->no_pri_sec_switch)
 505                 return 0;
 506
 507         hostapd_set_state(iface, HAPD_IFACE_HT_SCAN);
 508         wpa_printf(MSG_DEBUG, "Scan for neighboring BSSes prior to enabling "
 509                    "40 MHz channel");
 510         os_memset(&params, 0, sizeof(params));
 511         if (iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G)
 512                 ieee80211n_scan_channels_2g4(iface, &params);
 513         else
 514                 ieee80211n_scan_channels_5g(iface, &params);
 515
 516         ret = hostapd_driver_scan(iface->bss[0], &params);
 517         os_free(params.freqs);
 518
 519         if (ret == -EBUSY) {
 520                 wpa_printf(MSG_ERROR,
 521                            "Failed to request a scan of neighboring BSSes ret=%d (%s) - try to scan again",
 522                            ret, strerror(-ret));
 523                 iface->num_ht40_scan_tries = 1;
 524                 eloop_cancel_timeout(ap_ht40_scan_retry, iface, NULL);
 525                 eloop_register_timeout(1, 0, ap_ht40_scan_retry, iface, NULL);
 526                 return 1;
 527         }
 528
 529         if (ret < 0) {
 530                 wpa_printf(MSG_ERROR,
 531                            "Failed to request a scan of neighboring BSSes ret=%d (%s)",
 532                            ret, strerror(-ret));
 533                 return -1;
 534         }
 535
 536         iface->scan_cb = ieee80211n_check_scan;
 537         return 1;
 538 }
 539
 540
 541 static int ieee80211n_supported_ht_capab(struct hostapd_iface *iface)
 542 {
 543         u16 hw = iface->current_mode->ht_capab;
 544         u16 conf = iface->conf->ht_capab;
 545
 546         if ((conf & HT_CAP_INFO_LDPC_CODING_CAP) &&
 547             !(hw & HT_CAP_INFO_LDPC_CODING_CAP)) {
 548                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 549                            "HT capability [LDPC]");
 550                 return 0;
 551         }
 552
 553         /*
 554          * Driver ACS chosen channel may not be HT40 due to internal driver
 555          * restrictions.
 556          */
 557         if (!iface->conf->acs && (conf & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET) &&
 558             !(hw & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET)) {
 559                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 560                            "HT capability [HT40*]");
 561                 return 0;
 562         }
 563
 564         switch (conf & HT_CAP_INFO_SMPS_MASK) {
 565         case HT_CAP_INFO_SMPS_STATIC:
 566                 if (!(iface->smps_modes & WPA_DRIVER_SMPS_MODE_STATIC)) {
 567                         wpa_printf(MSG_ERROR,
 568                                    "Driver does not support configured HT capability [SMPS-STATIC]");
 569                         return 0;
 570                 }
 571                 break;
 572         case HT_CAP_INFO_SMPS_DYNAMIC:
 573                 if (!(iface->smps_modes & WPA_DRIVER_SMPS_MODE_DYNAMIC)) {
 574                         wpa_printf(MSG_ERROR,
 575                                    "Driver does not support configured HT capability [SMPS-DYNAMIC]");
 576                         return 0;
 577                 }
 578                 break;
 579         case HT_CAP_INFO_SMPS_DISABLED:
 580         default:
 581                 break;
 582         }
 583
 584         if ((conf & HT_CAP_INFO_GREEN_FIELD) &&
 585             !(hw & HT_CAP_INFO_GREEN_FIELD)) {
 586                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 587                            "HT capability [GF]");
 588                 return 0;
 589         }
 590
 591         if ((conf & HT_CAP_INFO_SHORT_GI20MHZ) &&
 592             !(hw & HT_CAP_INFO_SHORT_GI20MHZ)) {
 593                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 594                            "HT capability [SHORT-GI-20]");
 595                 return 0;
 596         }
 597
 598         if ((conf & HT_CAP_INFO_SHORT_GI40MHZ) &&
 599             !(hw & HT_CAP_INFO_SHORT_GI40MHZ)) {
 600                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 601                            "HT capability [SHORT-GI-40]");
 602                 return 0;
 603         }
 604
 605         if ((conf & HT_CAP_INFO_TX_STBC) && !(hw & HT_CAP_INFO_TX_STBC)) {
 606                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 607                            "HT capability [TX-STBC]");
 608                 return 0;
 609         }
 610
 611         if ((conf & HT_CAP_INFO_RX_STBC_MASK) >
 612             (hw & HT_CAP_INFO_RX_STBC_MASK)) {
 613                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 614                            "HT capability [RX-STBC*]");
 615                 return 0;
 616         }
 617
 618         if ((conf & HT_CAP_INFO_DELAYED_BA) &&
 619             !(hw & HT_CAP_INFO_DELAYED_BA)) {
 620                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 621                            "HT capability [DELAYED-BA]");
 622                 return 0;
 623         }
 624
 625         if ((conf & HT_CAP_INFO_MAX_AMSDU_SIZE) &&
 626             !(hw & HT_CAP_INFO_MAX_AMSDU_SIZE)) {
 627                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 628                            "HT capability [MAX-AMSDU-7935]");
 629                 return 0;
 630         }
 631
 632         if ((conf & HT_CAP_INFO_DSSS_CCK40MHZ) &&
 633             !(hw & HT_CAP_INFO_DSSS_CCK40MHZ)) {
 634                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 635                            "HT capability [DSSS_CCK-40]");
 636                 return 0;
 637         }
 638
 639         if ((conf & HT_CAP_INFO_LSIG_TXOP_PROTECT_SUPPORT) &&
 640             !(hw & HT_CAP_INFO_LSIG_TXOP_PROTECT_SUPPORT)) {
 641                 wpa_printf(MSG_ERROR, "Driver does not support configured "
 642                            "HT capability [LSIG-TXOP-PROT]");
 643                 return 0;
 644         }
 645
 646         return 1;
 647 }
 648
 649
 650 #ifdef CONFIG_IEEE80211AC
 651 static int ieee80211ac_supported_vht_capab(struct hostapd_iface *iface)
 652 {
 653         struct hostapd_hw_modes *mode = iface->current_mode;
 654         u32 hw = mode->vht_capab;
 655         u32 conf = iface->conf->vht_capab;
 656
 657         wpa_printf(MSG_DEBUG, "hw vht capab: 0x%x, conf vht capab: 0x%x",
 658                    hw, conf);
 659
 660         if (mode->mode == HOSTAPD_MODE_IEEE80211G &&
 661             iface->conf->bss[0]->vendor_vht &&
 662             mode->vht_capab == 0 && iface->hw_features) {
 663                 int i;
 664
 665                 for (i = 0; i < iface->num_hw_features; i++) {
 666                         if (iface->hw_features[i].mode ==
 667                             HOSTAPD_MODE_IEEE80211A) {
 668                                 mode = &iface->hw_features[i];
 669                                 hw = mode->vht_capab;
 670                                 wpa_printf(MSG_DEBUG,
 671                                            "update hw vht capab based on 5 GHz band: 0x%x",
 672                                            hw);
 673                                 break;
 674                         }
 675                 }
 676         }
 677
 678         return ieee80211ac_cap_check(hw, conf);
 679 }
 680 #endif /* CONFIG_IEEE80211AC */
 681
 682
 683 #ifdef CONFIG_IEEE80211AX
 684 static int ieee80211ax_supported_he_capab(struct hostapd_iface *iface)
 685 {
 686         return 1;
 687 }
 688 #endif /* CONFIG_IEEE80211AX */
 689
 690 #endif /* CONFIG_IEEE80211N */
 691
 692
 693 int hostapd_check_ht_capab(struct hostapd_iface *iface)
 694 {
 695 #ifdef CONFIG_IEEE80211N
 696         int ret;
 697
 698         if (is_6ghz_freq(iface->freq))
 699                 return 0;
 700         if (!iface->conf->ieee80211n)
 701                 return 0;
 702
 703         if (iface->current_mode->mode != HOSTAPD_MODE_IEEE80211B &&
 704             iface->current_mode->mode != HOSTAPD_MODE_IEEE80211G &&
 705             (iface->conf->ht_capab & HT_CAP_INFO_DSSS_CCK40MHZ)) {
 706                 wpa_printf(MSG_DEBUG,
 707                            "Disable HT capability [DSSS_CCK-40] on 5 GHz band");
 708                 iface->conf->ht_capab &= ~HT_CAP_INFO_DSSS_CCK40MHZ;
 709         }
 710
 711         if (!ieee80211n_supported_ht_capab(iface))
 712                 return -1;
 713 #ifdef CONFIG_IEEE80211AX
 714         if (iface->conf->ieee80211ax &&
 715             !ieee80211ax_supported_he_capab(iface))
 716                 return -1;
 717 #endif /* CONFIG_IEEE80211AX */
 718 #ifdef CONFIG_IEEE80211AC
 719         if (iface->conf->ieee80211ac &&
 720             !ieee80211ac_supported_vht_capab(iface))
 721                 return -1;
 722 #endif /* CONFIG_IEEE80211AC */
 723         ret = ieee80211n_check_40mhz(iface);
 724         if (ret)
 725                 return ret;
 726         if (!ieee80211n_allowed_ht40_channel_pair(iface))
 727                 return -1;
 728 #endif /* CONFIG_IEEE80211N */
 729
 730         return 0;
 731 }
 732
 733
 734 int hostapd_check_edmg_capab(struct hostapd_iface *iface)
 735 {
 736         struct hostapd_hw_modes *mode = iface->hw_features;
 737         struct ieee80211_edmg_config edmg;
 738
 739         if (!iface->conf->enable_edmg)
 740                 return 0;
 741
 742         hostapd_encode_edmg_chan(iface->conf->enable_edmg,
 743                                  iface->conf->edmg_channel,
 744                                  iface->conf->channel,
 745                                  &edmg);
 746
 747         if (mode->edmg.channels && ieee802_edmg_is_allowed(mode->edmg, edmg))
 748                 return 0;
 749
 750         wpa_printf(MSG_WARNING, "Requested EDMG configuration is not valid");
 751         wpa_printf(MSG_INFO, "EDMG capab: channels 0x%x, bw_config %d",
 752                    mode->edmg.channels, mode->edmg.bw_config);
 753         wpa_printf(MSG_INFO,
 754                    "Requested EDMG configuration: channels 0x%x, bw_config %d",
 755                    edmg.channels, edmg.bw_config);
 756         return -1;
 757 }
 758
 759
 760 static int hostapd_is_usable_chan(struct hostapd_iface *iface,
 761                                   int frequency, int primary)
 762 {
 763         struct hostapd_channel_data *chan;
 764
 765         if (!iface->current_mode)
 766                 return 0;
 767
 768         chan = hw_get_channel_freq(iface->current_mode->mode, frequency, NULL,
 769                                    iface->hw_features, iface->num_hw_features);
 770         if (!chan)
 771                 return 0;
 772
 773         if ((primary && chan_pri_allowed(chan)) ||
 774             (!primary && !(chan->flag & HOSTAPD_CHAN_DISABLED)))
 775                 return 1;
 776
 777         wpa_printf(MSG_INFO,
 778                    "Frequency %d (%s) not allowed for AP mode, flags: 0x%x%s%s",
 779                    frequency, primary ? "primary" : "secondary",
 780                    chan->flag,
 781                    chan->flag & HOSTAPD_CHAN_NO_IR ? " NO-IR" : "",
 782                    chan->flag & HOSTAPD_CHAN_RADAR ? " RADAR" : "");
 783         return 0;
 784 }
 785
 786
 787 static int hostapd_is_usable_edmg(struct hostapd_iface *iface)
 788 {
 789         int i, contiguous = 0;
 790         int num_of_enabled = 0;
 791         int max_contiguous = 0;
 792         struct ieee80211_edmg_config edmg;
 793         struct hostapd_channel_data *pri_chan;
 794
 795         if (!iface->conf->enable_edmg)
 796                 return 1;
 797
 798         if (!iface->current_mode)
 799                 return 0;
 800         pri_chan = hw_get_channel_freq(iface->current_mode->mode,
 801                                        iface->freq, NULL,
 802                                        iface->hw_features,
 803                                        iface->num_hw_features);
 804         hostapd_encode_edmg_chan(iface->conf->enable_edmg,
 805                                  iface->conf->edmg_channel,
 806                                  pri_chan->chan,
 807                                  &edmg);
 808         if (!(edmg.channels & BIT(pri_chan->chan - 1)))
 809                 return 0;
 810
 811         /* 60 GHz channels 1..6 */
 812         for (i = 0; i < 6; i++) {
 813                 int freq = 56160 + 2160 * i;
 814
 815                 if (edmg.channels & BIT(i)) {
 816                         contiguous++;
 817                         num_of_enabled++;
 818                 } else {
 819                         contiguous = 0;
 820                         continue;
 821                 }
 822
 823                 /* P802.11ay defines that the total number of subfields
 824                  * set to one does not exceed 4.
 825                  */
 826                 if (num_of_enabled > 4)
 827                         return 0;
 828
 829                 if (!hostapd_is_usable_chan(iface, freq, 1))
 830                         return 0;
 831
 832                 if (contiguous > max_contiguous)
 833                         max_contiguous = contiguous;
 834         }
 835
 836         /* Check if the EDMG configuration is valid under the limitations
 837          * of P802.11ay.
 838          */
 839         /* check bw_config against contiguous EDMG channels */
 840         switch (edmg.bw_config) {
 841         case EDMG_BW_CONFIG_4:
 842                 if (!max_contiguous)
 843                         return 0;
 844                 break;
 845         case EDMG_BW_CONFIG_5:
 846                 if (max_contiguous < 2)
 847                         return 0;
 848                 break;
 849         default:
 850                 return 0;
 851         }
 852
 853         return 1;
 854 }
 855
 856
 857 static int hostapd_is_usable_chans(struct hostapd_iface *iface)
 858 {
 859         int secondary_freq;
 860         struct hostapd_channel_data *pri_chan;
 861
 862         if (!iface->current_mode)
 863                 return 0;
 864         pri_chan = hw_get_channel_freq(iface->current_mode->mode,
 865                                        iface->freq, NULL,
 866                                        iface->hw_features,
 867                                        iface->num_hw_features);
 868         if (!pri_chan) {
 869                 wpa_printf(MSG_ERROR, "Primary frequency not present");
 870                 return 0;
 871         }
 872         if (!hostapd_is_usable_chan(iface, pri_chan->freq, 1)) {
 873                 wpa_printf(MSG_ERROR, "Primary frequency not allowed");
 874                 return 0;
 875         }
 876         if (!hostapd_is_usable_edmg(iface))
 877                 return 0;
 878
 879         if (!iface->conf->secondary_channel)
 880                 return 1;
 881
 882         if (hostapd_is_usable_chan(iface, iface->freq +
 883                                    iface->conf->secondary_channel * 20, 0))
 884                 return 1;
 885         if (!iface->conf->ht40_plus_minus_allowed)
 886                 return 0;
 887
 888         /* Both HT40+ and HT40- are set, pick a valid secondary channel */
 889         secondary_freq = iface->freq + 20;
 890         if (hostapd_is_usable_chan(iface, secondary_freq, 0) &&
 891             (pri_chan->allowed_bw & HOSTAPD_CHAN_WIDTH_40P)) {
 892                 iface->conf->secondary_channel = 1;
 893                 return 1;
 894         }
 895
 896         secondary_freq = iface->freq - 20;
 897         if (hostapd_is_usable_chan(iface, secondary_freq, 0) &&
 898             (pri_chan->allowed_bw & HOSTAPD_CHAN_WIDTH_40M)) {
 899                 iface->conf->secondary_channel = -1;
 900                 return 1;
 901         }
 902
 903         return 0;
 904 }
 905
 906
 907 static enum hostapd_chan_status
 908 hostapd_check_chans(struct hostapd_iface *iface)
 909 {
 910         if (iface->freq) {
 911                 if (hostapd_is_usable_chans(iface))
 912                         return HOSTAPD_CHAN_VALID;
 913                 else
 914                         return HOSTAPD_CHAN_INVALID;
 915         }
 916
 917         /*
 918          * The user set channel=0 or channel=acs_survey
 919          * which is used to trigger ACS.
 920          */
 921
 922         switch (acs_init(iface)) {
 923         case HOSTAPD_CHAN_ACS:
 924                 return HOSTAPD_CHAN_ACS;
 925         case HOSTAPD_CHAN_VALID:
 926         case HOSTAPD_CHAN_INVALID:
 927         default:
 928                 return HOSTAPD_CHAN_INVALID;
 929         }
 930 }
 931
 932
 933 static void hostapd_notify_bad_chans(struct hostapd_iface *iface)
 934 {
 935         if (!iface->current_mode) {
 936                 hostapd_logger(iface->bss[0], NULL, HOSTAPD_MODULE_IEEE80211,
 937                                HOSTAPD_LEVEL_WARNING,
 938                                "Hardware does not support configured mode");
 939                 return;
 940         }
 941         hostapd_logger(iface->bss[0], NULL,
 942                        HOSTAPD_MODULE_IEEE80211,
 943                        HOSTAPD_LEVEL_WARNING,
 944                        "Configured channel (%d) or frequency (%d) not found from the channel list of the current mode (%d) %s",
 945                        iface->conf->channel,
 946                        iface->freq,
 947                        iface->current_mode->mode,
 948                        hostapd_hw_mode_txt(iface->current_mode->mode));
 949         hostapd_logger(iface->bss[0], NULL, HOSTAPD_MODULE_IEEE80211,
 950                        HOSTAPD_LEVEL_WARNING,
 951                        "Hardware does not support configured channel");
 952 }
 953
 954
 955 int hostapd_acs_completed(struct hostapd_iface *iface, int err)
 956 {
 957         int ret = -1;
 958
 959         if (err)
 960                 goto out;
 961
 962         switch (hostapd_check_chans(iface)) {
 963         case HOSTAPD_CHAN_VALID:
 964                 wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO,
 965                         ACS_EVENT_COMPLETED "freq=%d channel=%d",
 966                         iface->freq, iface->conf->channel);
 967                 break;
 968         case HOSTAPD_CHAN_ACS:
 969                 wpa_printf(MSG_ERROR, "ACS error - reported complete, but no result available");
 970                 wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, ACS_EVENT_FAILED);
 971                 hostapd_notify_bad_chans(iface);
 972                 goto out;
 973         case HOSTAPD_CHAN_INVALID:
 974         default:
 975                 wpa_printf(MSG_ERROR, "ACS picked unusable channels");
 976                 wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, ACS_EVENT_FAILED);
 977                 hostapd_notify_bad_chans(iface);
 978                 goto out;
 979         }
 980
 981         ret = hostapd_check_ht_capab(iface);
 982         if (ret < 0)
 983                 goto out;
 984         if (ret == 1) {
 985                 wpa_printf(MSG_DEBUG, "Interface initialization will be completed in a callback");
 986                 return 0;
 987         }
 988
 989         ret = 0;
 990 out:
 991         return hostapd_setup_interface_complete(iface, ret);
 992 }
 993
 994
 995 /**
 996  * hostapd_select_hw_mode - Select the hardware mode
 997  * @iface: Pointer to interface data.
 998  * Returns: 0 on success, < 0 on failure
 999  *
1000  * Sets up the hardware mode, channel, rates, and passive scanning
1001  * based on the configuration.
1002  */
1003 int hostapd_select_hw_mode(struct hostapd_iface *iface)
1004 {
1005         int i;
1006
1007         if (iface->num_hw_features < 1)
1008                 return -1;
1009
1010         if ((iface->conf->hw_mode == HOSTAPD_MODE_IEEE80211G ||
1011              iface->conf->ieee80211n || iface->conf->ieee80211ac ||
1012              iface->conf->ieee80211ax) &&
1013             iface->conf->channel == 14) {
1014                 wpa_printf(MSG_INFO, "Disable OFDM/HT/VHT/HE on channel 14");
1015                 iface->conf->hw_mode = HOSTAPD_MODE_IEEE80211B;
1016                 iface->conf->ieee80211n = 0;
1017                 iface->conf->ieee80211ac = 0;
1018                 iface->conf->ieee80211ax = 0;
1019         }
1020
1021         iface->current_mode = NULL;
1022         for (i = 0; i < iface->num_hw_features; i++) {
1023                 struct hostapd_hw_modes *mode = &iface->hw_features[i];
1024                 if (mode->mode == iface->conf->hw_mode) {
1025                         if (iface->freq > 0 &&
1026                             !hw_get_chan(mode->mode, iface->freq,
1027                                          iface->hw_features,
1028                                          iface->num_hw_features))
1029                                 continue;
1030                         iface->current_mode = mode;
1031                         break;
1032                 }
1033         }
1034
1035         if (iface->current_mode == NULL) {
1036                 if (!(iface->drv_flags & WPA_DRIVER_FLAGS_ACS_OFFLOAD) ||
1037                     !(iface->drv_flags & WPA_DRIVER_FLAGS_SUPPORT_HW_MODE_ANY))
1038                 {
1039                         wpa_printf(MSG_ERROR,
1040                                    "Hardware does not support configured mode");
1041                         hostapd_logger(iface->bss[0], NULL,
1042                                        HOSTAPD_MODULE_IEEE80211,
1043                                        HOSTAPD_LEVEL_WARNING,
1044                                        "Hardware does not support configured mode (%d) (hw_mode in hostapd.conf)",
1045                                        (int) iface->conf->hw_mode);
1046                         return -2;
1047                 }
1048         }
1049
1050         switch (hostapd_check_chans(iface)) {
1051         case HOSTAPD_CHAN_VALID:
1052                 return 0;
1053         case HOSTAPD_CHAN_ACS: /* ACS will run and later complete */
1054                 return 1;
1055         case HOSTAPD_CHAN_INVALID:
1056         default:
1057                 hostapd_notify_bad_chans(iface);
1058                 return -3;
1059         }
1060 }
1061
1062
1063 const char * hostapd_hw_mode_txt(int mode)
1064 {
1065         switch (mode) {
1066         case HOSTAPD_MODE_IEEE80211A:
1067                 return "IEEE 802.11a";
1068         case HOSTAPD_MODE_IEEE80211B:
1069                 return "IEEE 802.11b";
1070         case HOSTAPD_MODE_IEEE80211G:
1071                 return "IEEE 802.11g";
1072         case HOSTAPD_MODE_IEEE80211AD:
1073                 return "IEEE 802.11ad";
1074         default:
1075                 return "UNKNOWN";
1076         }
1077 }
1078
1079
1080 int hostapd_hw_get_freq(struct hostapd_data *hapd, int chan)
1081 {
1082         return hw_get_freq(hapd->iface->current_mode, chan);
1083 }
1084
1085
1086 int hostapd_hw_get_channel(struct hostapd_data *hapd, int freq)
1087 {
1088         int i, channel;
1089         struct hostapd_hw_modes *mode;
1090
1091         if (hapd->iface->current_mode) {
1092                 channel = hw_get_chan(hapd->iface->current_mode->mode, freq,
1093                                       hapd->iface->hw_features,
1094                                       hapd->iface->num_hw_features);
1095                 if (channel)
1096                         return channel;
1097         }
1098
1099         /* Check other available modes since the channel list for the current
1100          * mode did not include the specified frequency. */
1101         if (!hapd->iface->hw_features)
1102                 return 0;
1103         for (i = 0; i < hapd->iface->num_hw_features; i++) {
1104                 mode = &hapd->iface->hw_features[i];
1105                 channel = hw_get_chan(mode->mode, freq,
1106                                       hapd->iface->hw_features,
1107                                       hapd->iface->num_hw_features);
1108                 if (channel)
1109                         return channel;
1110         }
1111         return 0;
1112 }