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 = 2,
 103         SKU_FAMILY_8000 = 4,
 104         N_HW_ADDRS_FAMILY_8000 = 5,
 105
 106         /* NVM REGULATORY -Section offset (in words) definitions */
 107         NVM_CHANNELS_FAMILY_8000 = 0,
 108
 109         /* NVM calibration section offset (in words) definitions */
 110         NVM_CALIB_SECTION_FAMILY_8000 = 0x2B8,
 111         XTAL_CALIB_FAMILY_8000 = 0x316 - NVM_CALIB_SECTION_FAMILY_8000
 112 };
 113
 114 /* SKU Capabilities (actual values from NVM definition) */
 115 enum nvm_sku_bits {
 116         NVM_SKU_CAP_BAND_24GHZ  = BIT(0),
 117         NVM_SKU_CAP_BAND_52GHZ  = BIT(1),
 118         NVM_SKU_CAP_11N_ENABLE  = BIT(2),
 119         NVM_SKU_CAP_11AC_ENABLE = BIT(3),
 120 };
 121
 122 /*
 123  * These are the channel numbers in the order that they are stored in the NVM
 124  */
 125 static const u8 iwl_nvm_channels[] = {
 126         /* 2.4 GHz */
 127         1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
 128         /* 5 GHz */
 129         36, 40, 44 , 48, 52, 56, 60, 64,
 130         100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144,
 131         149, 153, 157, 161, 165
 132 };
 133
 134 static const u8 iwl_nvm_channels_family_8000[] = {
 135         /* 2.4 GHz */
 136         1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
 137         /* 5 GHz */
 138         36, 40, 44, 48, 52, 56, 60, 64, 68, 72, 76, 80, 84, 88, 92,
 139         96, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144,
 140         149, 153, 157, 161, 165, 169, 173, 177, 181
 141 };
 142
 143 #define IWL_NUM_CHANNELS                ARRAY_SIZE(iwl_nvm_channels)
 144 #define IWL_NUM_CHANNELS_FAMILY_8000    ARRAY_SIZE(iwl_nvm_channels_family_8000)
 145 #define NUM_2GHZ_CHANNELS               14
 146 #define NUM_2GHZ_CHANNELS_FAMILY_8000   14
 147 #define FIRST_2GHZ_HT_MINUS             5
 148 #define LAST_2GHZ_HT_PLUS               9
 149 #define LAST_5GHZ_HT                    161
 150
 151 /* rate data (static) */
 152 static struct ieee80211_rate iwl_cfg80211_rates[] = {
 153         { .bitrate = 1 * 10, .hw_value = 0, .hw_value_short = 0, },
 154         { .bitrate = 2 * 10, .hw_value = 1, .hw_value_short = 1,
 155           .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
 156         { .bitrate = 5.5 * 10, .hw_value = 2, .hw_value_short = 2,
 157           .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
 158         { .bitrate = 11 * 10, .hw_value = 3, .hw_value_short = 3,
 159           .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
 160         { .bitrate = 6 * 10, .hw_value = 4, .hw_value_short = 4, },
 161         { .bitrate = 9 * 10, .hw_value = 5, .hw_value_short = 5, },
 162         { .bitrate = 12 * 10, .hw_value = 6, .hw_value_short = 6, },
 163         { .bitrate = 18 * 10, .hw_value = 7, .hw_value_short = 7, },
 164         { .bitrate = 24 * 10, .hw_value = 8, .hw_value_short = 8, },
 165         { .bitrate = 36 * 10, .hw_value = 9, .hw_value_short = 9, },
 166         { .bitrate = 48 * 10, .hw_value = 10, .hw_value_short = 10, },
 167         { .bitrate = 54 * 10, .hw_value = 11, .hw_value_short = 11, },
 168 };
 169 #define RATES_24_OFFS   0
 170 #define N_RATES_24      ARRAY_SIZE(iwl_cfg80211_rates)
 171 #define RATES_52_OFFS   4
 172 #define N_RATES_52      (N_RATES_24 - RATES_52_OFFS)
 173
 174 /**
 175  * enum iwl_nvm_channel_flags - channel flags in NVM
 176  * @NVM_CHANNEL_VALID: channel is usable for this SKU/geo
 177  * @NVM_CHANNEL_IBSS: usable as an IBSS channel
 178  * @NVM_CHANNEL_ACTIVE: active scanning allowed
 179  * @NVM_CHANNEL_RADAR: radar detection required
 180  * @NVM_CHANNEL_INDOOR_ONLY: only indoor use is allowed
 181  * @NVM_CHANNEL_GO_CONCURRENT: GO operation is allowed when connected to BSS
 182  *      on same channel on 2.4 or same UNII band on 5.2
 183  * @NVM_CHANNEL_WIDE: 20 MHz channel okay (?)
 184  * @NVM_CHANNEL_40MHZ: 40 MHz channel okay (?)
 185  * @NVM_CHANNEL_80MHZ: 80 MHz channel okay (?)
 186  * @NVM_CHANNEL_160MHZ: 160 MHz channel okay (?)
 187  */
 188 enum iwl_nvm_channel_flags {
 189         NVM_CHANNEL_VALID = BIT(0),
 190         NVM_CHANNEL_IBSS = BIT(1),
 191         NVM_CHANNEL_ACTIVE = BIT(3),
 192         NVM_CHANNEL_RADAR = BIT(4),
 193         NVM_CHANNEL_INDOOR_ONLY = BIT(5),
 194         NVM_CHANNEL_GO_CONCURRENT = BIT(6),
 195         NVM_CHANNEL_WIDE = BIT(8),
 196         NVM_CHANNEL_40MHZ = BIT(9),
 197         NVM_CHANNEL_80MHZ = BIT(10),
 198         NVM_CHANNEL_160MHZ = BIT(11),
 199 };
 200
 201 #define CHECK_AND_PRINT_I(x)    \
 202         ((ch_flags & NVM_CHANNEL_##x) ? # x " " : "")
 203
 204 static int iwl_init_channel_map(struct device *dev, const struct iwl_cfg *cfg,
 205                                 struct iwl_nvm_data *data,
 206                                 const __le16 * const nvm_ch_flags)
 207 {
 208         int ch_idx;
 209         int n_channels = 0;
 210         struct ieee80211_channel *channel;
 211         u16 ch_flags;
 212         bool is_5ghz;
 213         int num_of_ch, num_2ghz_channels;
 214         const u8 *nvm_chan;
 215
 216         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 217                 num_of_ch = IWL_NUM_CHANNELS;
 218                 nvm_chan = &iwl_nvm_channels[0];
 219                 num_2ghz_channels = NUM_2GHZ_CHANNELS;
 220         } else {
 221                 num_of_ch = IWL_NUM_CHANNELS_FAMILY_8000;
 222                 nvm_chan = &iwl_nvm_channels_family_8000[0];
 223                 num_2ghz_channels = NUM_2GHZ_CHANNELS_FAMILY_8000;
 224         }
 225
 226         for (ch_idx = 0; ch_idx < num_of_ch; ch_idx++) {
 227                 ch_flags = __le16_to_cpup(nvm_ch_flags + ch_idx);
 228
 229                 if (ch_idx >= num_2ghz_channels &&
 230                     !data->sku_cap_band_52GHz_enable)
 231                         ch_flags &= ~NVM_CHANNEL_VALID;
 232
 233                 if (!(ch_flags & NVM_CHANNEL_VALID)) {
 234                         IWL_DEBUG_EEPROM(dev,
 235                                          "Ch. %d Flags %x [%sGHz] - No traffic\n",
 236                                          nvm_chan[ch_idx],
 237                                          ch_flags,
 238                                          (ch_idx >= num_2ghz_channels) ?
 239                                          "5.2" : "2.4");
 240                         continue;
 241                 }
 242
 243                 channel = &data->channels[n_channels];
 244                 n_channels++;
 245
 246                 channel->hw_value = nvm_chan[ch_idx];
 247                 channel->band = (ch_idx < num_2ghz_channels) ?
 248                                 IEEE80211_BAND_2GHZ : IEEE80211_BAND_5GHZ;
 249                 channel->center_freq =
 250                         ieee80211_channel_to_frequency(
 251                                 channel->hw_value, channel->band);
 252
 253                 /* TODO: Need to be dependent to the NVM */
 254                 channel->flags = IEEE80211_CHAN_NO_HT40;
 255                 if (ch_idx < num_2ghz_channels &&
 256                     (ch_flags & NVM_CHANNEL_40MHZ)) {
 257                         if (nvm_chan[ch_idx] <= LAST_2GHZ_HT_PLUS)
 258                                 channel->flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
 259                         if (nvm_chan[ch_idx] >= FIRST_2GHZ_HT_MINUS)
 260                                 channel->flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
 261                 } else if (nvm_chan[ch_idx] <= LAST_5GHZ_HT &&
 262                            (ch_flags & NVM_CHANNEL_40MHZ)) {
 263                         if ((ch_idx - num_2ghz_channels) % 2 == 0)
 264                                 channel->flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
 265                         else
 266                                 channel->flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
 267                 }
 268                 if (!(ch_flags & NVM_CHANNEL_80MHZ))
 269                         channel->flags |= IEEE80211_CHAN_NO_80MHZ;
 270                 if (!(ch_flags & NVM_CHANNEL_160MHZ))
 271                         channel->flags |= IEEE80211_CHAN_NO_160MHZ;
 272
 273                 if (!(ch_flags & NVM_CHANNEL_IBSS))
 274                         channel->flags |= IEEE80211_CHAN_NO_IR;
 275
 276                 if (!(ch_flags & NVM_CHANNEL_ACTIVE))
 277                         channel->flags |= IEEE80211_CHAN_NO_IR;
 278
 279                 if (ch_flags & NVM_CHANNEL_RADAR)
 280                         channel->flags |= IEEE80211_CHAN_RADAR;
 281
 282                 if (ch_flags & NVM_CHANNEL_INDOOR_ONLY)
 283                         channel->flags |= IEEE80211_CHAN_INDOOR_ONLY;
 284
 285                 /* Set the GO concurrent flag only in case that NO_IR is set.
 286                  * Otherwise it is meaningless
 287                  */
 288                 if ((ch_flags & NVM_CHANNEL_GO_CONCURRENT) &&
 289                     (channel->flags & IEEE80211_CHAN_NO_IR))
 290                         channel->flags |= IEEE80211_CHAN_GO_CONCURRENT;
 291
 292                 /* Initialize regulatory-based run-time data */
 293
 294                 /*
 295                  * Default value - highest tx power value.  max_power
 296                  * is not used in mvm, and is used for backwards compatibility
 297                  */
 298                 channel->max_power = IWL_DEFAULT_MAX_TX_POWER;
 299                 is_5ghz = channel->band == IEEE80211_BAND_5GHZ;
 300                 IWL_DEBUG_EEPROM(dev,
 301                                  "Ch. %d [%sGHz] %s%s%s%s%s%s%s(0x%02x %ddBm): Ad-Hoc %ssupported\n",
 302                                  channel->hw_value,
 303                                  is_5ghz ? "5.2" : "2.4",
 304                                  CHECK_AND_PRINT_I(VALID),
 305                                  CHECK_AND_PRINT_I(IBSS),
 306                                  CHECK_AND_PRINT_I(ACTIVE),
 307                                  CHECK_AND_PRINT_I(RADAR),
 308                                  CHECK_AND_PRINT_I(WIDE),
 309                                  CHECK_AND_PRINT_I(INDOOR_ONLY),
 310                                  CHECK_AND_PRINT_I(GO_CONCURRENT),
 311                                  ch_flags,
 312                                  channel->max_power,
 313                                  ((ch_flags & NVM_CHANNEL_IBSS) &&
 314                                   !(ch_flags & NVM_CHANNEL_RADAR))
 315                                         ? "" : "not ");
 316         }
 317
 318         return n_channels;
 319 }
 320
 321 static void iwl_init_vht_hw_capab(const struct iwl_cfg *cfg,
 322                                   struct iwl_nvm_data *data,
 323                                   struct ieee80211_sta_vht_cap *vht_cap,
 324                                   u8 tx_chains, u8 rx_chains)
 325 {
 326         int num_rx_ants = num_of_ant(rx_chains);
 327         int num_tx_ants = num_of_ant(tx_chains);
 328         unsigned int max_ampdu_exponent = (cfg->max_vht_ampdu_exponent ?:
 329                                            IEEE80211_VHT_MAX_AMPDU_1024K);
 330
 331         vht_cap->vht_supported = true;
 332
 333         vht_cap->cap = IEEE80211_VHT_CAP_SHORT_GI_80 |
 334                        IEEE80211_VHT_CAP_RXSTBC_1 |
 335                        IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE |
 336                        3 << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT |
 337                        max_ampdu_exponent <<
 338                        IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;
 339
 340         if (cfg->ht_params->ldpc)
 341                 vht_cap->cap |= IEEE80211_VHT_CAP_RXLDPC;
 342
 343         if (num_tx_ants > 1)
 344                 vht_cap->cap |= IEEE80211_VHT_CAP_TXSTBC;
 345         else
 346                 vht_cap->cap |= IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN;
 347
 348         if (iwlwifi_mod_params.amsdu_size_8K)
 349                 vht_cap->cap |= IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991;
 350
 351         vht_cap->vht_mcs.rx_mcs_map =
 352                 cpu_to_le16(IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 |
 353                             IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 |
 354                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 4 |
 355                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 6 |
 356                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 8 |
 357                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 10 |
 358                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 12 |
 359                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 14);
 360
 361         if (num_rx_ants == 1 || cfg->rx_with_siso_diversity) {
 362                 vht_cap->cap |= IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN;
 363                 /* this works because NOT_SUPPORTED == 3 */
 364                 vht_cap->vht_mcs.rx_mcs_map |=
 365                         cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << 2);
 366         }
 367
 368         vht_cap->vht_mcs.tx_mcs_map = vht_cap->vht_mcs.rx_mcs_map;
 369 }
 370
 371 static void iwl_init_sbands(struct device *dev, const struct iwl_cfg *cfg,
 372                             struct iwl_nvm_data *data,
 373                             const __le16 *ch_section, bool enable_vht,
 374                             u8 tx_chains, u8 rx_chains)
 375 {
 376         int n_channels;
 377         int n_used = 0;
 378         struct ieee80211_supported_band *sband;
 379
 380         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 381                 n_channels = iwl_init_channel_map(
 382                                 dev, cfg, data,
 383                                 &ch_section[NVM_CHANNELS]);
 384         else
 385                 n_channels = iwl_init_channel_map(
 386                                 dev, cfg, data,
 387                                 &ch_section[NVM_CHANNELS_FAMILY_8000]);
 388
 389         sband = &data->bands[IEEE80211_BAND_2GHZ];
 390         sband->band = IEEE80211_BAND_2GHZ;
 391         sband->bitrates = &iwl_cfg80211_rates[RATES_24_OFFS];
 392         sband->n_bitrates = N_RATES_24;
 393         n_used += iwl_init_sband_channels(data, sband, n_channels,
 394                                           IEEE80211_BAND_2GHZ);
 395         iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_2GHZ,
 396                              tx_chains, rx_chains);
 397
 398         sband = &data->bands[IEEE80211_BAND_5GHZ];
 399         sband->band = IEEE80211_BAND_5GHZ;
 400         sband->bitrates = &iwl_cfg80211_rates[RATES_52_OFFS];
 401         sband->n_bitrates = N_RATES_52;
 402         n_used += iwl_init_sband_channels(data, sband, n_channels,
 403                                           IEEE80211_BAND_5GHZ);
 404         iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_5GHZ,
 405                              tx_chains, rx_chains);
 406         if (enable_vht)
 407                 iwl_init_vht_hw_capab(cfg, data, &sband->vht_cap,
 408                                       tx_chains, rx_chains);
 409
 410         if (n_channels != n_used)
 411                 IWL_ERR_DEV(dev, "NVM: used only %d of %d channels\n",
 412                             n_used, n_channels);
 413 }
 414
 415 static int iwl_get_sku(const struct iwl_cfg *cfg,
 416                        const __le16 *nvm_sw)
 417 {
 418         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 419                 return le16_to_cpup(nvm_sw + SKU);
 420         else
 421                 return le32_to_cpup((__le32 *)(nvm_sw + SKU_FAMILY_8000));
 422 }
 423
 424 static int iwl_get_nvm_version(const struct iwl_cfg *cfg,
 425                                const __le16 *nvm_sw)
 426 {
 427         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 428                 return le16_to_cpup(nvm_sw + NVM_VERSION);
 429         else
 430                 return le32_to_cpup((__le32 *)(nvm_sw +
 431                                                NVM_VERSION_FAMILY_8000));
 432 }
 433
 434 static int iwl_get_radio_cfg(const struct iwl_cfg *cfg,
 435                              const __le16 *nvm_sw)
 436 {
 437         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 438                 return le16_to_cpup(nvm_sw + RADIO_CFG);
 439         else
 440                 return le32_to_cpup((__le32 *)(nvm_sw + RADIO_CFG_FAMILY_8000));
 441 }
 442
 443 #define N_HW_ADDRS_MASK_FAMILY_8000     0xF
 444 static int iwl_get_n_hw_addrs(const struct iwl_cfg *cfg,
 445                               const __le16 *nvm_sw)
 446 {
 447         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 448                 return le16_to_cpup(nvm_sw + N_HW_ADDRS);
 449         else
 450                 return le32_to_cpup((__le32 *)(nvm_sw + N_HW_ADDRS_FAMILY_8000))
 451                        & N_HW_ADDRS_MASK_FAMILY_8000;
 452 }
 453
 454 static void iwl_set_radio_cfg(const struct iwl_cfg *cfg,
 455                               struct iwl_nvm_data *data,
 456                               u32 radio_cfg)
 457 {
 458         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 459                 data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK(radio_cfg);
 460                 data->radio_cfg_step = NVM_RF_CFG_STEP_MSK(radio_cfg);
 461                 data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK(radio_cfg);
 462                 data->radio_cfg_pnum = NVM_RF_CFG_PNUM_MSK(radio_cfg);
 463                 return;
 464         }
 465
 466         /* set the radio configuration for family 8000 */
 467         data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK_FAMILY_8000(radio_cfg);
 468         data->radio_cfg_step = NVM_RF_CFG_STEP_MSK_FAMILY_8000(radio_cfg);
 469         data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK_FAMILY_8000(radio_cfg);
 470         data->radio_cfg_pnum = NVM_RF_CFG_FLAVOR_MSK_FAMILY_8000(radio_cfg);
 471         data->valid_tx_ant = NVM_RF_CFG_TX_ANT_MSK_FAMILY_8000(radio_cfg);
 472         data->valid_rx_ant = NVM_RF_CFG_RX_ANT_MSK_FAMILY_8000(radio_cfg);
 473 }
 474
 475 static void iwl_set_hw_address(const struct iwl_cfg *cfg,
 476                                struct iwl_nvm_data *data,
 477                                const __le16 *nvm_sec)
 478 {
 479         const u8 *hw_addr = (const u8 *)(nvm_sec + HW_ADDR);
 480
 481         /* The byte order is little endian 16 bit, meaning 214365 */
 482         data->hw_addr[0] = hw_addr[1];
 483         data->hw_addr[1] = hw_addr[0];
 484         data->hw_addr[2] = hw_addr[3];
 485         data->hw_addr[3] = hw_addr[2];
 486         data->hw_addr[4] = hw_addr[5];
 487         data->hw_addr[5] = hw_addr[4];
 488 }
 489
 490 static void iwl_set_hw_address_family_8000(struct device *dev,
 491                                            const struct iwl_cfg *cfg,
 492                                            struct iwl_nvm_data *data,
 493                                            const __le16 *mac_override,
 494                                            const __le16 *nvm_hw)
 495 {
 496         const u8 *hw_addr;
 497
 498         if (mac_override) {
 499                 hw_addr = (const u8 *)(mac_override +
 500                                  MAC_ADDRESS_OVERRIDE_FAMILY_8000);
 501
 502                 /* The byte order is little endian 16 bit, meaning 214365 */
 503                 data->hw_addr[0] = hw_addr[1];
 504                 data->hw_addr[1] = hw_addr[0];
 505                 data->hw_addr[2] = hw_addr[3];
 506                 data->hw_addr[3] = hw_addr[2];
 507                 data->hw_addr[4] = hw_addr[5];
 508                 data->hw_addr[5] = hw_addr[4];
 509
 510                 if (is_valid_ether_addr(data->hw_addr))
 511                         return;
 512
 513                 IWL_ERR_DEV(dev,
 514                             "mac address from nvm override section is not valid\n");
 515         }
 516
 517         if (nvm_hw) {
 518                 /* read the MAC address from OTP */
 519                 if (!dev_is_pci(dev) || (data->nvm_version < 0xE08)) {
 520                         /* read the mac address from the WFPM location */
 521                         hw_addr = (const u8 *)(nvm_hw +
 522                                                HW_ADDR0_WFPM_FAMILY_8000);
 523                         data->hw_addr[0] = hw_addr[3];
 524                         data->hw_addr[1] = hw_addr[2];
 525                         data->hw_addr[2] = hw_addr[1];
 526                         data->hw_addr[3] = hw_addr[0];
 527
 528                         hw_addr = (const u8 *)(nvm_hw +
 529                                                HW_ADDR1_WFPM_FAMILY_8000);
 530                         data->hw_addr[4] = hw_addr[1];
 531                         data->hw_addr[5] = hw_addr[0];
 532                 } else if ((data->nvm_version >= 0xE08) &&
 533                            (data->nvm_version < 0xE0B)) {
 534                         /* read "reverse order"  from the PCIe location */
 535                         hw_addr = (const u8 *)(nvm_hw +
 536                                                HW_ADDR0_PCIE_FAMILY_8000);
 537                         data->hw_addr[5] = hw_addr[2];
 538                         data->hw_addr[4] = hw_addr[1];
 539                         data->hw_addr[3] = hw_addr[0];
 540
 541                         hw_addr = (const u8 *)(nvm_hw +
 542                                                HW_ADDR1_PCIE_FAMILY_8000);
 543                         data->hw_addr[2] = hw_addr[3];
 544                         data->hw_addr[1] = hw_addr[2];
 545                         data->hw_addr[0] = hw_addr[1];
 546                 } else {
 547                         /* read from the PCIe location */
 548                         hw_addr = (const u8 *)(nvm_hw +
 549                                                HW_ADDR0_PCIE_FAMILY_8000);
 550                         data->hw_addr[5] = hw_addr[0];
 551                         data->hw_addr[4] = hw_addr[1];
 552                         data->hw_addr[3] = hw_addr[2];
 553
 554                         hw_addr = (const u8 *)(nvm_hw +
 555                                                HW_ADDR1_PCIE_FAMILY_8000);
 556                         data->hw_addr[2] = hw_addr[1];
 557                         data->hw_addr[1] = hw_addr[2];
 558                         data->hw_addr[0] = hw_addr[3];
 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, u8 tx_chains, u8 rx_chains)
 575 {
 576         struct iwl_nvm_data *data;
 577         u32 sku;
 578         u32 radio_cfg;
 579
 580         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 581                 data = kzalloc(sizeof(*data) +
 582                                sizeof(struct ieee80211_channel) *
 583                                IWL_NUM_CHANNELS,
 584                                GFP_KERNEL);
 585         else
 586                 data = kzalloc(sizeof(*data) +
 587                                sizeof(struct ieee80211_channel) *
 588                                IWL_NUM_CHANNELS_FAMILY_8000,
 589                                GFP_KERNEL);
 590         if (!data)
 591                 return NULL;
 592
 593         data->nvm_version = iwl_get_nvm_version(cfg, nvm_sw);
 594
 595         radio_cfg = iwl_get_radio_cfg(cfg, nvm_sw);
 596         iwl_set_radio_cfg(cfg, data, radio_cfg);
 597         if (data->valid_tx_ant)
 598                 tx_chains &= data->valid_tx_ant;
 599         if (data->valid_rx_ant)
 600                 rx_chains &= data->valid_rx_ant;
 601
 602         sku = iwl_get_sku(cfg, nvm_sw);
 603         data->sku_cap_band_24GHz_enable = sku & NVM_SKU_CAP_BAND_24GHZ;
 604         data->sku_cap_band_52GHz_enable = sku & NVM_SKU_CAP_BAND_52GHZ;
 605         data->sku_cap_11n_enable = sku & NVM_SKU_CAP_11N_ENABLE;
 606         data->sku_cap_11ac_enable = sku & NVM_SKU_CAP_11AC_ENABLE;
 607         if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
 608                 data->sku_cap_11n_enable = false;
 609
 610         data->n_hw_addrs = iwl_get_n_hw_addrs(cfg, nvm_sw);
 611
 612         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 613                 /* Checking for required sections */
 614                 if (!nvm_calib) {
 615                         IWL_ERR_DEV(dev,
 616                                     "Can't parse empty Calib NVM sections\n");
 617                         kfree(data);
 618                         return NULL;
 619                 }
 620                 /* in family 8000 Xtal calibration values moved to OTP */
 621                 data->xtal_calib[0] = *(nvm_calib + XTAL_CALIB);
 622                 data->xtal_calib[1] = *(nvm_calib + XTAL_CALIB + 1);
 623         }
 624
 625         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 626                 iwl_set_hw_address(cfg, data, nvm_hw);
 627
 628                 iwl_init_sbands(dev, cfg, data, nvm_sw,
 629                                 sku & NVM_SKU_CAP_11AC_ENABLE, tx_chains,
 630                                 rx_chains);
 631         } else {
 632                 /* MAC address in family 8000 */
 633                 iwl_set_hw_address_family_8000(dev, cfg, data, mac_override,
 634                                                nvm_hw);
 635
 636                 iwl_init_sbands(dev, cfg, data, regulatory,
 637                                 sku & NVM_SKU_CAP_11AC_ENABLE, tx_chains,
 638                                 rx_chains);
 639         }
 640
 641         data->calib_version = 255;
 642
 643         return data;
 644 }
 645 IWL_EXPORT_SYMBOL(iwl_parse_nvm_data);