drivers/net/wireless/iwlwifi/iwl-nvm-parse.c

   1 /******************************************************************************
   2  *
   3  * This file is provided under a dual BSD/GPLv2 license.  When using or
   4  * redistributing this file, you may do so under either license.
   5  *
   6  * GPL LICENSE SUMMARY
   7  *
   8  * Copyright(c) 2008 - 2014 Intel Corporation. All rights reserved.
   9  * Copyright(c) 2013 - 2014 Intel Mobile Communications GmbH
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of version 2 of the GNU General Public License as
  13  * published by the Free Software Foundation.
  14  *
  15  * This program is distributed in the hope that it will be useful, but
  16  * WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  18  * General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
  23  * USA
  24  *
  25  * The full GNU General Public License is included in this distribution
  26  * in the file called COPYING.
  27  *
  28  * Contact Information:
  29  *  Intel Linux Wireless <ilw@linux.intel.com>
  30  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  31  *
  32  * BSD LICENSE
  33  *
  34  * Copyright(c) 2005 - 2014 Intel Corporation. All rights reserved.
  35  * Copyright(c) 2013 - 2014 Intel Mobile Communications GmbH
  36  * All rights reserved.
  37  *
  38  * Redistribution and use in source and binary forms, with or without
  39  * modification, are permitted provided that the following conditions
  40  * are met:
  41  *
  42  *  * Redistributions of source code must retain the above copyright
  43  *    notice, this list of conditions and the following disclaimer.
  44  *  * Redistributions in binary form must reproduce the above copyright
  45  *    notice, this list of conditions and the following disclaimer in
  46  *    the documentation and/or other materials provided with the
  47  *    distribution.
  48  *  * Neither the name Intel Corporation nor the names of its
  49  *    contributors may be used to endorse or promote products derived
  50  *    from this software without specific prior written permission.
  51  *
  52  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  53  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  54  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  55  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  56  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  57  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  58  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  59  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  60  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  61  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  62  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  63  *****************************************************************************/
  64 #include <linux/types.h>
  65 #include <linux/slab.h>
  66 #include <linux/export.h>
  67 #include <linux/etherdevice.h>
  68 #include <linux/pci.h>
  69 #include "iwl-drv.h"
  70 #include "iwl-modparams.h"
  71 #include "iwl-nvm-parse.h"
  72
  73 /* NVM offsets (in words) definitions */
  74 enum wkp_nvm_offsets {
  75         /* NVM HW-Section offset (in words) definitions */
  76         HW_ADDR = 0x15,
  77
  78         /* NVM SW-Section offset (in words) definitions */
  79         NVM_SW_SECTION = 0x1C0,
  80         NVM_VERSION = 0,
  81         RADIO_CFG = 1,
  82         SKU = 2,
  83         N_HW_ADDRS = 3,
  84         NVM_CHANNELS = 0x1E0 - NVM_SW_SECTION,
  85
  86         /* NVM calibration section offset (in words) definitions */
  87         NVM_CALIB_SECTION = 0x2B8,
  88         XTAL_CALIB = 0x316 - NVM_CALIB_SECTION
  89 };
  90
  91 enum family_8000_nvm_offsets {
  92         /* NVM HW-Section offset (in words) definitions */
  93         HW_ADDR0_WFPM_FAMILY_8000 = 0x12,
  94         HW_ADDR1_WFPM_FAMILY_8000 = 0x16,
  95         HW_ADDR0_PCIE_FAMILY_8000 = 0x8A,
  96         HW_ADDR1_PCIE_FAMILY_8000 = 0x8E,
  97         MAC_ADDRESS_OVERRIDE_FAMILY_8000 = 1,
  98
  99         /* NVM SW-Section offset (in words) definitions */
 100         NVM_SW_SECTION_FAMILY_8000 = 0x1C0,
 101         NVM_VERSION_FAMILY_8000 = 0,
 102         RADIO_CFG_FAMILY_8000 = 0,
 103         SKU_FAMILY_8000 = 2,
 104         N_HW_ADDRS_FAMILY_8000 = 3,
 105
 106         /* NVM REGULATORY -Section offset (in words) definitions */
 107         NVM_CHANNELS_FAMILY_8000 = 0,
 108         NVM_LAR_OFFSET_FAMILY_8000_OLD = 0x4C7,
 109         NVM_LAR_OFFSET_FAMILY_8000 = 0x507,
 110         NVM_LAR_ENABLED_FAMILY_8000 = 0x7,
 111
 112         /* NVM calibration section offset (in words) definitions */
 113         NVM_CALIB_SECTION_FAMILY_8000 = 0x2B8,
 114         XTAL_CALIB_FAMILY_8000 = 0x316 - NVM_CALIB_SECTION_FAMILY_8000
 115 };
 116
 117 /* SKU Capabilities (actual values from NVM definition) */
 118 enum nvm_sku_bits {
 119         NVM_SKU_CAP_BAND_24GHZ  = BIT(0),
 120         NVM_SKU_CAP_BAND_52GHZ  = BIT(1),
 121         NVM_SKU_CAP_11N_ENABLE  = BIT(2),
 122         NVM_SKU_CAP_11AC_ENABLE = BIT(3),
 123 };
 124
 125 /*
 126  * These are the channel numbers in the order that they are stored in the NVM
 127  */
 128 static const u8 iwl_nvm_channels[] = {
 129         /* 2.4 GHz */
 130         1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
 131         /* 5 GHz */
 132         36, 40, 44 , 48, 52, 56, 60, 64,
 133         100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144,
 134         149, 153, 157, 161, 165
 135 };
 136
 137 static const u8 iwl_nvm_channels_family_8000[] = {
 138         /* 2.4 GHz */
 139         1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
 140         /* 5 GHz */
 141         36, 40, 44, 48, 52, 56, 60, 64, 68, 72, 76, 80, 84, 88, 92,
 142         96, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144,
 143         149, 153, 157, 161, 165, 169, 173, 177, 181
 144 };
 145
 146 #define IWL_NUM_CHANNELS                ARRAY_SIZE(iwl_nvm_channels)
 147 #define IWL_NUM_CHANNELS_FAMILY_8000    ARRAY_SIZE(iwl_nvm_channels_family_8000)
 148 #define NUM_2GHZ_CHANNELS               14
 149 #define NUM_2GHZ_CHANNELS_FAMILY_8000   14
 150 #define FIRST_2GHZ_HT_MINUS             5
 151 #define LAST_2GHZ_HT_PLUS               9
 152 #define LAST_5GHZ_HT                    165
 153 #define LAST_5GHZ_HT_FAMILY_8000        181
 154 #define N_HW_ADDR_MASK                  0xF
 155
 156 /* rate data (static) */
 157 static struct ieee80211_rate iwl_cfg80211_rates[] = {
 158         { .bitrate = 1 * 10, .hw_value = 0, .hw_value_short = 0, },
 159         { .bitrate = 2 * 10, .hw_value = 1, .hw_value_short = 1,
 160           .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
 161         { .bitrate = 5.5 * 10, .hw_value = 2, .hw_value_short = 2,
 162           .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
 163         { .bitrate = 11 * 10, .hw_value = 3, .hw_value_short = 3,
 164           .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
 165         { .bitrate = 6 * 10, .hw_value = 4, .hw_value_short = 4, },
 166         { .bitrate = 9 * 10, .hw_value = 5, .hw_value_short = 5, },
 167         { .bitrate = 12 * 10, .hw_value = 6, .hw_value_short = 6, },
 168         { .bitrate = 18 * 10, .hw_value = 7, .hw_value_short = 7, },
 169         { .bitrate = 24 * 10, .hw_value = 8, .hw_value_short = 8, },
 170         { .bitrate = 36 * 10, .hw_value = 9, .hw_value_short = 9, },
 171         { .bitrate = 48 * 10, .hw_value = 10, .hw_value_short = 10, },
 172         { .bitrate = 54 * 10, .hw_value = 11, .hw_value_short = 11, },
 173 };
 174 #define RATES_24_OFFS   0
 175 #define N_RATES_24      ARRAY_SIZE(iwl_cfg80211_rates)
 176 #define RATES_52_OFFS   4
 177 #define N_RATES_52      (N_RATES_24 - RATES_52_OFFS)
 178
 179 /**
 180  * enum iwl_nvm_channel_flags - channel flags in NVM
 181  * @NVM_CHANNEL_VALID: channel is usable for this SKU/geo
 182  * @NVM_CHANNEL_IBSS: usable as an IBSS channel
 183  * @NVM_CHANNEL_ACTIVE: active scanning allowed
 184  * @NVM_CHANNEL_RADAR: radar detection required
 185  * @NVM_CHANNEL_INDOOR_ONLY: only indoor use is allowed
 186  * @NVM_CHANNEL_GO_CONCURRENT: GO operation is allowed when connected to BSS
 187  *      on same channel on 2.4 or same UNII band on 5.2
 188  * @NVM_CHANNEL_WIDE: 20 MHz channel okay (?)
 189  * @NVM_CHANNEL_40MHZ: 40 MHz channel okay (?)
 190  * @NVM_CHANNEL_80MHZ: 80 MHz channel okay (?)
 191  * @NVM_CHANNEL_160MHZ: 160 MHz channel okay (?)
 192  */
 193 enum iwl_nvm_channel_flags {
 194         NVM_CHANNEL_VALID = BIT(0),
 195         NVM_CHANNEL_IBSS = BIT(1),
 196         NVM_CHANNEL_ACTIVE = BIT(3),
 197         NVM_CHANNEL_RADAR = BIT(4),
 198         NVM_CHANNEL_INDOOR_ONLY = BIT(5),
 199         NVM_CHANNEL_GO_CONCURRENT = BIT(6),
 200         NVM_CHANNEL_WIDE = BIT(8),
 201         NVM_CHANNEL_40MHZ = BIT(9),
 202         NVM_CHANNEL_80MHZ = BIT(10),
 203         NVM_CHANNEL_160MHZ = BIT(11),
 204 };
 205
 206 #define CHECK_AND_PRINT_I(x)    \
 207         ((ch_flags & NVM_CHANNEL_##x) ? # x " " : "")
 208
 209 static u32 iwl_get_channel_flags(u8 ch_num, int ch_idx, bool is_5ghz,
 210                                  u16 nvm_flags, const struct iwl_cfg *cfg)
 211 {
 212         u32 flags = IEEE80211_CHAN_NO_HT40;
 213         u32 last_5ghz_ht = LAST_5GHZ_HT;
 214
 215         if (cfg->device_family == IWL_DEVICE_FAMILY_8000)
 216                 last_5ghz_ht = LAST_5GHZ_HT_FAMILY_8000;
 217
 218         if (!is_5ghz && (nvm_flags & NVM_CHANNEL_40MHZ)) {
 219                 if (ch_num <= LAST_2GHZ_HT_PLUS)
 220                         flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
 221                 if (ch_num >= FIRST_2GHZ_HT_MINUS)
 222                         flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
 223         } else if (ch_num <= last_5ghz_ht && (nvm_flags & NVM_CHANNEL_40MHZ)) {
 224                 if ((ch_idx - NUM_2GHZ_CHANNELS) % 2 == 0)
 225                         flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
 226                 else
 227                         flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
 228         }
 229         if (!(nvm_flags & NVM_CHANNEL_80MHZ))
 230                 flags |= IEEE80211_CHAN_NO_80MHZ;
 231         if (!(nvm_flags & NVM_CHANNEL_160MHZ))
 232                 flags |= IEEE80211_CHAN_NO_160MHZ;
 233
 234         if (!(nvm_flags & NVM_CHANNEL_IBSS))
 235                 flags |= IEEE80211_CHAN_NO_IR;
 236
 237         if (!(nvm_flags & NVM_CHANNEL_ACTIVE))
 238                 flags |= IEEE80211_CHAN_NO_IR;
 239
 240         if (nvm_flags & NVM_CHANNEL_RADAR)
 241                 flags |= IEEE80211_CHAN_RADAR;
 242
 243         if (nvm_flags & NVM_CHANNEL_INDOOR_ONLY)
 244                 flags |= IEEE80211_CHAN_INDOOR_ONLY;
 245
 246         /* Set the GO concurrent flag only in case that NO_IR is set.
 247          * Otherwise it is meaningless
 248          */
 249         if ((nvm_flags & NVM_CHANNEL_GO_CONCURRENT) &&
 250             (flags & IEEE80211_CHAN_NO_IR))
 251                 flags |= IEEE80211_CHAN_GO_CONCURRENT;
 252
 253         return flags;
 254 }
 255
 256 static int iwl_init_channel_map(struct device *dev, const struct iwl_cfg *cfg,
 257                                 struct iwl_nvm_data *data,
 258                                 const __le16 * const nvm_ch_flags,
 259                                 bool lar_supported)
 260 {
 261         int ch_idx;
 262         int n_channels = 0;
 263         struct ieee80211_channel *channel;
 264         u16 ch_flags;
 265         bool is_5ghz;
 266         int num_of_ch, num_2ghz_channels;
 267         const u8 *nvm_chan;
 268
 269         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 270                 num_of_ch = IWL_NUM_CHANNELS;
 271                 nvm_chan = &iwl_nvm_channels[0];
 272                 num_2ghz_channels = NUM_2GHZ_CHANNELS;
 273         } else {
 274                 num_of_ch = IWL_NUM_CHANNELS_FAMILY_8000;
 275                 nvm_chan = &iwl_nvm_channels_family_8000[0];
 276                 num_2ghz_channels = NUM_2GHZ_CHANNELS_FAMILY_8000;
 277         }
 278
 279         for (ch_idx = 0; ch_idx < num_of_ch; ch_idx++) {
 280                 ch_flags = __le16_to_cpup(nvm_ch_flags + ch_idx);
 281
 282                 if (ch_idx >= num_2ghz_channels &&
 283                     !data->sku_cap_band_52GHz_enable)
 284                         continue;
 285
 286                 if (!lar_supported && !(ch_flags & NVM_CHANNEL_VALID)) {
 287                         /*
 288                          * Channels might become valid later if lar is
 289                          * supported, hence we still want to add them to
 290                          * the list of supported channels to cfg80211.
 291                          */
 292                         IWL_DEBUG_EEPROM(dev,
 293                                          "Ch. %d Flags %x [%sGHz] - No traffic\n",
 294                                          nvm_chan[ch_idx],
 295                                          ch_flags,
 296                                          (ch_idx >= num_2ghz_channels) ?
 297                                          "5.2" : "2.4");
 298                         continue;
 299                 }
 300
 301                 channel = &data->channels[n_channels];
 302                 n_channels++;
 303
 304                 channel->hw_value = nvm_chan[ch_idx];
 305                 channel->band = (ch_idx < num_2ghz_channels) ?
 306                                 IEEE80211_BAND_2GHZ : IEEE80211_BAND_5GHZ;
 307                 channel->center_freq =
 308                         ieee80211_channel_to_frequency(
 309                                 channel->hw_value, channel->band);
 310
 311                 /* Initialize regulatory-based run-time data */
 312
 313                 /*
 314                  * Default value - highest tx power value.  max_power
 315                  * is not used in mvm, and is used for backwards compatibility
 316                  */
 317                 channel->max_power = IWL_DEFAULT_MAX_TX_POWER;
 318                 is_5ghz = channel->band == IEEE80211_BAND_5GHZ;
 319
 320                 /* don't put limitations in case we're using LAR */
 321                 if (!lar_supported)
 322                         channel->flags = iwl_get_channel_flags(nvm_chan[ch_idx],
 323                                                                ch_idx, is_5ghz,
 324                                                                ch_flags, cfg);
 325                 else
 326                         channel->flags = 0;
 327
 328                 IWL_DEBUG_EEPROM(dev,
 329                                  "Ch. %d [%sGHz] %s%s%s%s%s%s%s(0x%02x %ddBm): Ad-Hoc %ssupported\n",
 330                                  channel->hw_value,
 331                                  is_5ghz ? "5.2" : "2.4",
 332                                  CHECK_AND_PRINT_I(VALID),
 333                                  CHECK_AND_PRINT_I(IBSS),
 334                                  CHECK_AND_PRINT_I(ACTIVE),
 335                                  CHECK_AND_PRINT_I(RADAR),
 336                                  CHECK_AND_PRINT_I(WIDE),
 337                                  CHECK_AND_PRINT_I(INDOOR_ONLY),
 338                                  CHECK_AND_PRINT_I(GO_CONCURRENT),
 339                                  ch_flags,
 340                                  channel->max_power,
 341                                  ((ch_flags & NVM_CHANNEL_IBSS) &&
 342                                   !(ch_flags & NVM_CHANNEL_RADAR))
 343                                         ? "" : "not ");
 344         }
 345
 346         return n_channels;
 347 }
 348
 349 static void iwl_init_vht_hw_capab(const struct iwl_cfg *cfg,
 350                                   struct iwl_nvm_data *data,
 351                                   struct ieee80211_sta_vht_cap *vht_cap,
 352                                   u8 tx_chains, u8 rx_chains)
 353 {
 354         int num_rx_ants = num_of_ant(rx_chains);
 355         int num_tx_ants = num_of_ant(tx_chains);
 356         unsigned int max_ampdu_exponent = (cfg->max_vht_ampdu_exponent ?:
 357                                            IEEE80211_VHT_MAX_AMPDU_1024K);
 358
 359         vht_cap->vht_supported = true;
 360
 361         vht_cap->cap = IEEE80211_VHT_CAP_SHORT_GI_80 |
 362                        IEEE80211_VHT_CAP_RXSTBC_1 |
 363                        IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE |
 364                        3 << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT |
 365                        max_ampdu_exponent <<
 366                        IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;
 367
 368         if (cfg->ht_params->ldpc)
 369                 vht_cap->cap |= IEEE80211_VHT_CAP_RXLDPC;
 370
 371         if (num_tx_ants > 1)
 372                 vht_cap->cap |= IEEE80211_VHT_CAP_TXSTBC;
 373         else
 374                 vht_cap->cap |= IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN;
 375
 376         if (iwlwifi_mod_params.amsdu_size_8K)
 377                 vht_cap->cap |= IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991;
 378
 379         vht_cap->vht_mcs.rx_mcs_map =
 380                 cpu_to_le16(IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 |
 381                             IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 |
 382                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 4 |
 383                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 6 |
 384                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 8 |
 385                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 10 |
 386                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 12 |
 387                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 14);
 388
 389         if (num_rx_ants == 1 || cfg->rx_with_siso_diversity) {
 390                 vht_cap->cap |= IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN;
 391                 /* this works because NOT_SUPPORTED == 3 */
 392                 vht_cap->vht_mcs.rx_mcs_map |=
 393                         cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << 2);
 394         }
 395
 396         vht_cap->vht_mcs.tx_mcs_map = vht_cap->vht_mcs.rx_mcs_map;
 397 }
 398
 399 static void iwl_init_sbands(struct device *dev, const struct iwl_cfg *cfg,
 400                             struct iwl_nvm_data *data,
 401                             const __le16 *ch_section,
 402                             u8 tx_chains, u8 rx_chains, bool lar_supported)
 403 {
 404         int n_channels;
 405         int n_used = 0;
 406         struct ieee80211_supported_band *sband;
 407
 408         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 409                 n_channels = iwl_init_channel_map(
 410                                 dev, cfg, data,
 411                                 &ch_section[NVM_CHANNELS], lar_supported);
 412         else
 413                 n_channels = iwl_init_channel_map(
 414                                 dev, cfg, data,
 415                                 &ch_section[NVM_CHANNELS_FAMILY_8000],
 416                                 lar_supported);
 417
 418         sband = &data->bands[IEEE80211_BAND_2GHZ];
 419         sband->band = IEEE80211_BAND_2GHZ;
 420         sband->bitrates = &iwl_cfg80211_rates[RATES_24_OFFS];
 421         sband->n_bitrates = N_RATES_24;
 422         n_used += iwl_init_sband_channels(data, sband, n_channels,
 423                                           IEEE80211_BAND_2GHZ);
 424         iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_2GHZ,
 425                              tx_chains, rx_chains);
 426
 427         sband = &data->bands[IEEE80211_BAND_5GHZ];
 428         sband->band = IEEE80211_BAND_5GHZ;
 429         sband->bitrates = &iwl_cfg80211_rates[RATES_52_OFFS];
 430         sband->n_bitrates = N_RATES_52;
 431         n_used += iwl_init_sband_channels(data, sband, n_channels,
 432                                           IEEE80211_BAND_5GHZ);
 433         iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_5GHZ,
 434                              tx_chains, rx_chains);
 435         if (data->sku_cap_11ac_enable)
 436                 iwl_init_vht_hw_capab(cfg, data, &sband->vht_cap,
 437                                       tx_chains, rx_chains);
 438
 439         if (n_channels != n_used)
 440                 IWL_ERR_DEV(dev, "NVM: used only %d of %d channels\n",
 441                             n_used, n_channels);
 442 }
 443
 444 static int iwl_get_sku(const struct iwl_cfg *cfg, const __le16 *nvm_sw,
 445                        const __le16 *phy_sku)
 446 {
 447         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 448                 return le16_to_cpup(nvm_sw + SKU);
 449
 450         return le32_to_cpup((__le32 *)(phy_sku + SKU_FAMILY_8000));
 451 }
 452
 453 static int iwl_get_nvm_version(const struct iwl_cfg *cfg, const __le16 *nvm_sw)
 454 {
 455         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 456                 return le16_to_cpup(nvm_sw + NVM_VERSION);
 457         else
 458                 return le32_to_cpup((__le32 *)(nvm_sw +
 459                                                NVM_VERSION_FAMILY_8000));
 460 }
 461
 462 static int iwl_get_radio_cfg(const struct iwl_cfg *cfg, const __le16 *nvm_sw,
 463                              const __le16 *phy_sku)
 464 {
 465         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 466                 return le16_to_cpup(nvm_sw + RADIO_CFG);
 467
 468         return le32_to_cpup((__le32 *)(nvm_sw + RADIO_CFG_FAMILY_8000));
 469
 470 }
 471
 472 static int iwl_get_n_hw_addrs(const struct iwl_cfg *cfg, const __le16 *nvm_sw)
 473 {
 474         int n_hw_addr;
 475
 476         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 477                 return le16_to_cpup(nvm_sw + N_HW_ADDRS);
 478
 479         n_hw_addr = le32_to_cpup((__le32 *)(nvm_sw + N_HW_ADDRS_FAMILY_8000));
 480
 481         return n_hw_addr & N_HW_ADDR_MASK;
 482 }
 483
 484 static void iwl_set_radio_cfg(const struct iwl_cfg *cfg,
 485                               struct iwl_nvm_data *data,
 486                               u32 radio_cfg)
 487 {
 488         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 489                 data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK(radio_cfg);
 490                 data->radio_cfg_step = NVM_RF_CFG_STEP_MSK(radio_cfg);
 491                 data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK(radio_cfg);
 492                 data->radio_cfg_pnum = NVM_RF_CFG_PNUM_MSK(radio_cfg);
 493                 return;
 494         }
 495
 496         /* set the radio configuration for family 8000 */
 497         data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK_FAMILY_8000(radio_cfg);
 498         data->radio_cfg_step = NVM_RF_CFG_STEP_MSK_FAMILY_8000(radio_cfg);
 499         data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK_FAMILY_8000(radio_cfg);
 500         data->radio_cfg_pnum = NVM_RF_CFG_FLAVOR_MSK_FAMILY_8000(radio_cfg);
 501         data->valid_tx_ant = NVM_RF_CFG_TX_ANT_MSK_FAMILY_8000(radio_cfg);
 502         data->valid_rx_ant = NVM_RF_CFG_RX_ANT_MSK_FAMILY_8000(radio_cfg);
 503 }
 504
 505 static void iwl_set_hw_address(const struct iwl_cfg *cfg,
 506                                struct iwl_nvm_data *data,
 507                                const __le16 *nvm_sec)
 508 {
 509         const u8 *hw_addr = (const u8 *)(nvm_sec + HW_ADDR);
 510
 511         /* The byte order is little endian 16 bit, meaning 214365 */
 512         data->hw_addr[0] = hw_addr[1];
 513         data->hw_addr[1] = hw_addr[0];
 514         data->hw_addr[2] = hw_addr[3];
 515         data->hw_addr[3] = hw_addr[2];
 516         data->hw_addr[4] = hw_addr[5];
 517         data->hw_addr[5] = hw_addr[4];
 518 }
 519
 520 static void iwl_set_hw_address_family_8000(struct device *dev,
 521                                            const struct iwl_cfg *cfg,
 522                                            struct iwl_nvm_data *data,
 523                                            const __le16 *mac_override,
 524                                            const __le16 *nvm_hw,
 525                                            u32 mac_addr0, u32 mac_addr1)
 526 {
 527         const u8 *hw_addr;
 528
 529         if (mac_override) {
 530                 hw_addr = (const u8 *)(mac_override +
 531                                  MAC_ADDRESS_OVERRIDE_FAMILY_8000);
 532
 533                 /* The byte order is little endian 16 bit, meaning 214365 */
 534                 data->hw_addr[0] = hw_addr[1];
 535                 data->hw_addr[1] = hw_addr[0];
 536                 data->hw_addr[2] = hw_addr[3];
 537                 data->hw_addr[3] = hw_addr[2];
 538                 data->hw_addr[4] = hw_addr[5];
 539                 data->hw_addr[5] = hw_addr[4];
 540
 541                 if (is_valid_ether_addr(data->hw_addr))
 542                         return;
 543
 544                 IWL_ERR_DEV(dev,
 545                             "mac address from nvm override section is not valid\n");
 546         }
 547
 548         if (nvm_hw) {
 549                 /* read the MAC address from HW resisters */
 550                 hw_addr = (const u8 *)&mac_addr0;
 551                 data->hw_addr[0] = hw_addr[3];
 552                 data->hw_addr[1] = hw_addr[2];
 553                 data->hw_addr[2] = hw_addr[1];
 554                 data->hw_addr[3] = hw_addr[0];
 555
 556                 hw_addr = (const u8 *)&mac_addr1;
 557                 data->hw_addr[4] = hw_addr[1];
 558                 data->hw_addr[5] = hw_addr[0];
 559
 560                 if (!is_valid_ether_addr(data->hw_addr))
 561                         IWL_ERR_DEV(dev,
 562                                     "mac address from hw section is not valid\n");
 563
 564                 return;
 565         }
 566
 567         IWL_ERR_DEV(dev, "mac address is not found\n");
 568 }
 569
 570 struct iwl_nvm_data *
 571 iwl_parse_nvm_data(struct device *dev, const struct iwl_cfg *cfg,
 572                    const __le16 *nvm_hw, const __le16 *nvm_sw,
 573                    const __le16 *nvm_calib, const __le16 *regulatory,
 574                    const __le16 *mac_override, const __le16 *phy_sku,
 575                    u8 tx_chains, u8 rx_chains, bool lar_fw_supported,
 576                    u32 mac_addr0, u32 mac_addr1)
 577 {
 578         struct iwl_nvm_data *data;
 579         u32 sku;
 580         u32 radio_cfg;
 581         u16 lar_config;
 582
 583         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 584                 data = kzalloc(sizeof(*data) +
 585                                sizeof(struct ieee80211_channel) *
 586                                IWL_NUM_CHANNELS,
 587                                GFP_KERNEL);
 588         else
 589                 data = kzalloc(sizeof(*data) +
 590                                sizeof(struct ieee80211_channel) *
 591                                IWL_NUM_CHANNELS_FAMILY_8000,
 592                                GFP_KERNEL);
 593         if (!data)
 594                 return NULL;
 595
 596         data->nvm_version = iwl_get_nvm_version(cfg, nvm_sw);
 597
 598         radio_cfg = iwl_get_radio_cfg(cfg, nvm_sw, phy_sku);
 599         iwl_set_radio_cfg(cfg, data, radio_cfg);
 600         if (data->valid_tx_ant)
 601                 tx_chains &= data->valid_tx_ant;
 602         if (data->valid_rx_ant)
 603                 rx_chains &= data->valid_rx_ant;
 604
 605         sku = iwl_get_sku(cfg, nvm_sw, phy_sku);
 606         data->sku_cap_band_24GHz_enable = sku & NVM_SKU_CAP_BAND_24GHZ;
 607         data->sku_cap_band_52GHz_enable = sku & NVM_SKU_CAP_BAND_52GHZ;
 608         data->sku_cap_11n_enable = sku & NVM_SKU_CAP_11N_ENABLE;
 609         if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
 610                 data->sku_cap_11n_enable = false;
 611         data->sku_cap_11ac_enable = data->sku_cap_11n_enable &&
 612                                     (sku & NVM_SKU_CAP_11AC_ENABLE);
 613
 614         data->n_hw_addrs = iwl_get_n_hw_addrs(cfg, nvm_sw);
 615
 616         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 617                 /* Checking for required sections */
 618                 if (!nvm_calib) {
 619                         IWL_ERR_DEV(dev,
 620                                     "Can't parse empty Calib NVM sections\n");
 621                         kfree(data);
 622                         return NULL;
 623                 }
 624                 /* in family 8000 Xtal calibration values moved to OTP */
 625                 data->xtal_calib[0] = *(nvm_calib + XTAL_CALIB);
 626                 data->xtal_calib[1] = *(nvm_calib + XTAL_CALIB + 1);
 627         }
 628
 629         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 630                 iwl_set_hw_address(cfg, data, nvm_hw);
 631
 632                 iwl_init_sbands(dev, cfg, data, nvm_sw,
 633                                 tx_chains, rx_chains, lar_fw_supported);
 634         } else {
 635                 u16 lar_offset = data->nvm_version < 0xE39 ?
 636                                  NVM_LAR_OFFSET_FAMILY_8000_OLD :
 637                                  NVM_LAR_OFFSET_FAMILY_8000;
 638
 639                 lar_config = le16_to_cpup(regulatory + lar_offset);
 640                 data->lar_enabled = !!(lar_config &
 641                                        NVM_LAR_ENABLED_FAMILY_8000);
 642
 643                 /* MAC address in family 8000 */
 644                 iwl_set_hw_address_family_8000(dev, cfg, data, mac_override,
 645                                                nvm_hw, mac_addr0, mac_addr1);
 646
 647                 iwl_init_sbands(dev, cfg, data, regulatory,
 648                                 tx_chains, rx_chains,
 649                                 lar_fw_supported && data->lar_enabled);
 650         }
 651
 652         data->calib_version = 255;
 653
 654         return data;
 655 }
 656 IWL_EXPORT_SYMBOL(iwl_parse_nvm_data);
 657
 658 static u32 iwl_nvm_get_regdom_bw_flags(const u8 *nvm_chan,
 659                                        int ch_idx, u16 nvm_flags,
 660                                        const struct iwl_cfg *cfg)
 661 {
 662         u32 flags = NL80211_RRF_NO_HT40;
 663         u32 last_5ghz_ht = LAST_5GHZ_HT;
 664
 665         if (cfg->device_family == IWL_DEVICE_FAMILY_8000)
 666                 last_5ghz_ht = LAST_5GHZ_HT_FAMILY_8000;
 667
 668         if (ch_idx < NUM_2GHZ_CHANNELS &&
 669             (nvm_flags & NVM_CHANNEL_40MHZ)) {
 670                 if (nvm_chan[ch_idx] <= LAST_2GHZ_HT_PLUS)
 671                         flags &= ~NL80211_RRF_NO_HT40PLUS;
 672                 if (nvm_chan[ch_idx] >= FIRST_2GHZ_HT_MINUS)
 673                         flags &= ~NL80211_RRF_NO_HT40MINUS;
 674         } else if (nvm_chan[ch_idx] <= last_5ghz_ht &&
 675                    (nvm_flags & NVM_CHANNEL_40MHZ)) {
 676                 if ((ch_idx - NUM_2GHZ_CHANNELS) % 2 == 0)
 677                         flags &= ~NL80211_RRF_NO_HT40PLUS;
 678                 else
 679                         flags &= ~NL80211_RRF_NO_HT40MINUS;
 680         }
 681
 682         if (!(nvm_flags & NVM_CHANNEL_80MHZ))
 683                 flags |= NL80211_RRF_NO_80MHZ;
 684         if (!(nvm_flags & NVM_CHANNEL_160MHZ))
 685                 flags |= NL80211_RRF_NO_160MHZ;
 686
 687         if (!(nvm_flags & NVM_CHANNEL_ACTIVE))
 688                 flags |= NL80211_RRF_NO_IR;
 689
 690         if (nvm_flags & NVM_CHANNEL_RADAR)
 691                 flags |= NL80211_RRF_DFS;
 692
 693         if (nvm_flags & NVM_CHANNEL_INDOOR_ONLY)
 694                 flags |= NL80211_RRF_NO_OUTDOOR;
 695
 696         /* Set the GO concurrent flag only in case that NO_IR is set.
 697          * Otherwise it is meaningless
 698          */
 699         if ((nvm_flags & NVM_CHANNEL_GO_CONCURRENT) &&
 700             (flags & NL80211_RRF_NO_IR))
 701                 flags |= NL80211_RRF_GO_CONCURRENT;
 702
 703         return flags;
 704 }
 705
 706 struct ieee80211_regdomain *
 707 iwl_parse_nvm_mcc_info(struct device *dev, const struct iwl_cfg *cfg,
 708                        int num_of_ch, __le32 *channels, u16 fw_mcc)
 709 {
 710         int ch_idx;
 711         u16 ch_flags, prev_ch_flags = 0;
 712         const u8 *nvm_chan = cfg->device_family == IWL_DEVICE_FAMILY_8000 ?
 713                              iwl_nvm_channels_family_8000 : iwl_nvm_channels;
 714         struct ieee80211_regdomain *regd;
 715         int size_of_regd;
 716         struct ieee80211_reg_rule *rule;
 717         enum ieee80211_band band;
 718         int center_freq, prev_center_freq = 0;
 719         int valid_rules = 0;
 720         bool new_rule;
 721         int max_num_ch = cfg->device_family == IWL_DEVICE_FAMILY_8000 ?
 722                          IWL_NUM_CHANNELS_FAMILY_8000 : IWL_NUM_CHANNELS;
 723
 724         if (WARN_ON_ONCE(num_of_ch > NL80211_MAX_SUPP_REG_RULES))
 725                 return ERR_PTR(-EINVAL);
 726
 727         if (WARN_ON(num_of_ch > max_num_ch))
 728                 num_of_ch = max_num_ch;
 729
 730         IWL_DEBUG_DEV(dev, IWL_DL_LAR, "building regdom for %d channels\n",
 731                       num_of_ch);
 732
 733         /* build a regdomain rule for every valid channel */
 734         size_of_regd =
 735                 sizeof(struct ieee80211_regdomain) +
 736                 num_of_ch * sizeof(struct ieee80211_reg_rule);
 737
 738         regd = kzalloc(size_of_regd, GFP_KERNEL);
 739         if (!regd)
 740                 return ERR_PTR(-ENOMEM);
 741
 742         for (ch_idx = 0; ch_idx < num_of_ch; ch_idx++) {
 743                 ch_flags = (u16)__le32_to_cpup(channels + ch_idx);
 744                 band = (ch_idx < NUM_2GHZ_CHANNELS) ?
 745                        IEEE80211_BAND_2GHZ : IEEE80211_BAND_5GHZ;
 746                 center_freq = ieee80211_channel_to_frequency(nvm_chan[ch_idx],
 747                                                              band);
 748                 new_rule = false;
 749
 750                 if (!(ch_flags & NVM_CHANNEL_VALID)) {
 751                         IWL_DEBUG_DEV(dev, IWL_DL_LAR,
 752                                       "Ch. %d Flags %x [%sGHz] - No traffic\n",
 753                                       nvm_chan[ch_idx],
 754                                       ch_flags,
 755                                       (ch_idx >= NUM_2GHZ_CHANNELS) ?
 756                                       "5.2" : "2.4");
 757                         continue;
 758                 }
 759
 760                 /* we can't continue the same rule */
 761                 if (ch_idx == 0 || prev_ch_flags != ch_flags ||
 762                     center_freq - prev_center_freq > 20) {
 763                         valid_rules++;
 764                         new_rule = true;
 765                 }
 766
 767                 rule = &regd->reg_rules[valid_rules - 1];
 768
 769                 if (new_rule)
 770                         rule->freq_range.start_freq_khz =
 771                                                 MHZ_TO_KHZ(center_freq - 10);
 772
 773                 rule->freq_range.end_freq_khz = MHZ_TO_KHZ(center_freq + 10);
 774
 775                 /* this doesn't matter - not used by FW */
 776                 rule->power_rule.max_antenna_gain = DBI_TO_MBI(6);
 777                 rule->power_rule.max_eirp =
 778                         DBM_TO_MBM(IWL_DEFAULT_MAX_TX_POWER);
 779
 780                 rule->flags = iwl_nvm_get_regdom_bw_flags(nvm_chan, ch_idx,
 781                                                           ch_flags, cfg);
 782
 783                 /* rely on auto-calculation to merge BW of contiguous chans */
 784                 rule->flags |= NL80211_RRF_AUTO_BW;
 785                 rule->freq_range.max_bandwidth_khz = 0;
 786
 787                 prev_ch_flags = ch_flags;
 788                 prev_center_freq = center_freq;
 789
 790                 IWL_DEBUG_DEV(dev, IWL_DL_LAR,
 791                               "Ch. %d [%sGHz] %s%s%s%s%s%s%s%s%s(0x%02x): Ad-Hoc %ssupported\n",
 792                               center_freq,
 793                               band == IEEE80211_BAND_5GHZ ? "5.2" : "2.4",
 794                               CHECK_AND_PRINT_I(VALID),
 795                               CHECK_AND_PRINT_I(ACTIVE),
 796                               CHECK_AND_PRINT_I(RADAR),
 797                               CHECK_AND_PRINT_I(WIDE),
 798                               CHECK_AND_PRINT_I(40MHZ),
 799                               CHECK_AND_PRINT_I(80MHZ),
 800                               CHECK_AND_PRINT_I(160MHZ),
 801                               CHECK_AND_PRINT_I(INDOOR_ONLY),
 802                               CHECK_AND_PRINT_I(GO_CONCURRENT),
 803                               ch_flags,
 804                               ((ch_flags & NVM_CHANNEL_ACTIVE) &&
 805                                !(ch_flags & NVM_CHANNEL_RADAR))
 806                                          ? "" : "not ");
 807         }
 808
 809         regd->n_reg_rules = valid_rules;
 810
 811         /* set alpha2 from FW. */
 812         regd->alpha2[0] = fw_mcc >> 8;
 813         regd->alpha2[1] = fw_mcc & 0xff;
 814
 815         return regd;
 816 }
 817 IWL_EXPORT_SYMBOL(iwl_parse_nvm_mcc_info);