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
 329         vht_cap->vht_supported = true;
 330
 331         vht_cap->cap = IEEE80211_VHT_CAP_SHORT_GI_80 |
 332                        IEEE80211_VHT_CAP_RXSTBC_1 |
 333                        IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE |
 334                        3 << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT |
 335                        7 << IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;
 336
 337         if (cfg->ht_params->ldpc)
 338                 vht_cap->cap |= IEEE80211_VHT_CAP_RXLDPC;
 339
 340         if (num_tx_ants > 1)
 341                 vht_cap->cap |= IEEE80211_VHT_CAP_TXSTBC;
 342         else
 343                 vht_cap->cap |= IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN;
 344
 345         if (iwlwifi_mod_params.amsdu_size_8K)
 346                 vht_cap->cap |= IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991;
 347
 348         vht_cap->vht_mcs.rx_mcs_map =
 349                 cpu_to_le16(IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 |
 350                             IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 |
 351                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 4 |
 352                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 6 |
 353                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 8 |
 354                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 10 |
 355                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 12 |
 356                             IEEE80211_VHT_MCS_NOT_SUPPORTED << 14);
 357
 358         if (num_rx_ants == 1 || cfg->rx_with_siso_diversity) {
 359                 vht_cap->cap |= IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN;
 360                 /* this works because NOT_SUPPORTED == 3 */
 361                 vht_cap->vht_mcs.rx_mcs_map |=
 362                         cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << 2);
 363         }
 364
 365         vht_cap->vht_mcs.tx_mcs_map = vht_cap->vht_mcs.rx_mcs_map;
 366 }
 367
 368 static void iwl_init_sbands(struct device *dev, const struct iwl_cfg *cfg,
 369                             struct iwl_nvm_data *data,
 370                             const __le16 *ch_section, bool enable_vht,
 371                             u8 tx_chains, u8 rx_chains)
 372 {
 373         int n_channels;
 374         int n_used = 0;
 375         struct ieee80211_supported_band *sband;
 376
 377         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 378                 n_channels = iwl_init_channel_map(
 379                                 dev, cfg, data,
 380                                 &ch_section[NVM_CHANNELS]);
 381         else
 382                 n_channels = iwl_init_channel_map(
 383                                 dev, cfg, data,
 384                                 &ch_section[NVM_CHANNELS_FAMILY_8000]);
 385
 386         sband = &data->bands[IEEE80211_BAND_2GHZ];
 387         sband->band = IEEE80211_BAND_2GHZ;
 388         sband->bitrates = &iwl_cfg80211_rates[RATES_24_OFFS];
 389         sband->n_bitrates = N_RATES_24;
 390         n_used += iwl_init_sband_channels(data, sband, n_channels,
 391                                           IEEE80211_BAND_2GHZ);
 392         iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_2GHZ,
 393                              tx_chains, rx_chains);
 394
 395         sband = &data->bands[IEEE80211_BAND_5GHZ];
 396         sband->band = IEEE80211_BAND_5GHZ;
 397         sband->bitrates = &iwl_cfg80211_rates[RATES_52_OFFS];
 398         sband->n_bitrates = N_RATES_52;
 399         n_used += iwl_init_sband_channels(data, sband, n_channels,
 400                                           IEEE80211_BAND_5GHZ);
 401         iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_5GHZ,
 402                              tx_chains, rx_chains);
 403         if (enable_vht)
 404                 iwl_init_vht_hw_capab(cfg, data, &sband->vht_cap,
 405                                       tx_chains, rx_chains);
 406
 407         if (n_channels != n_used)
 408                 IWL_ERR_DEV(dev, "NVM: used only %d of %d channels\n",
 409                             n_used, n_channels);
 410 }
 411
 412 static int iwl_get_sku(const struct iwl_cfg *cfg,
 413                        const __le16 *nvm_sw)
 414 {
 415         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 416                 return le16_to_cpup(nvm_sw + SKU);
 417         else
 418                 return le32_to_cpup((__le32 *)(nvm_sw + SKU_FAMILY_8000));
 419 }
 420
 421 static int iwl_get_nvm_version(const struct iwl_cfg *cfg,
 422                                const __le16 *nvm_sw)
 423 {
 424         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 425                 return le16_to_cpup(nvm_sw + NVM_VERSION);
 426         else
 427                 return le32_to_cpup((__le32 *)(nvm_sw +
 428                                                NVM_VERSION_FAMILY_8000));
 429 }
 430
 431 static int iwl_get_radio_cfg(const struct iwl_cfg *cfg,
 432                              const __le16 *nvm_sw)
 433 {
 434         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 435                 return le16_to_cpup(nvm_sw + RADIO_CFG);
 436         else
 437                 return le32_to_cpup((__le32 *)(nvm_sw + RADIO_CFG_FAMILY_8000));
 438 }
 439
 440 #define N_HW_ADDRS_MASK_FAMILY_8000     0xF
 441 static int iwl_get_n_hw_addrs(const struct iwl_cfg *cfg,
 442                               const __le16 *nvm_sw)
 443 {
 444         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 445                 return le16_to_cpup(nvm_sw + N_HW_ADDRS);
 446         else
 447                 return le32_to_cpup((__le32 *)(nvm_sw + N_HW_ADDRS_FAMILY_8000))
 448                        & N_HW_ADDRS_MASK_FAMILY_8000;
 449 }
 450
 451 static void iwl_set_radio_cfg(const struct iwl_cfg *cfg,
 452                               struct iwl_nvm_data *data,
 453                               u32 radio_cfg)
 454 {
 455         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 456                 data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK(radio_cfg);
 457                 data->radio_cfg_step = NVM_RF_CFG_STEP_MSK(radio_cfg);
 458                 data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK(radio_cfg);
 459                 data->radio_cfg_pnum = NVM_RF_CFG_PNUM_MSK(radio_cfg);
 460                 return;
 461         }
 462
 463         /* set the radio configuration for family 8000 */
 464         data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK_FAMILY_8000(radio_cfg);
 465         data->radio_cfg_step = NVM_RF_CFG_STEP_MSK_FAMILY_8000(radio_cfg);
 466         data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK_FAMILY_8000(radio_cfg);
 467         data->radio_cfg_pnum = NVM_RF_CFG_FLAVOR_MSK_FAMILY_8000(radio_cfg);
 468 }
 469
 470 static void iwl_set_hw_address(const struct iwl_cfg *cfg,
 471                                struct iwl_nvm_data *data,
 472                                const __le16 *nvm_sec)
 473 {
 474         const u8 *hw_addr = (const u8 *)(nvm_sec + HW_ADDR);
 475
 476         /* The byte order is little endian 16 bit, meaning 214365 */
 477         data->hw_addr[0] = hw_addr[1];
 478         data->hw_addr[1] = hw_addr[0];
 479         data->hw_addr[2] = hw_addr[3];
 480         data->hw_addr[3] = hw_addr[2];
 481         data->hw_addr[4] = hw_addr[5];
 482         data->hw_addr[5] = hw_addr[4];
 483 }
 484
 485 static void iwl_set_hw_address_family_8000(struct device *dev,
 486                                            const struct iwl_cfg *cfg,
 487                                            struct iwl_nvm_data *data,
 488                                            const __le16 *mac_override,
 489                                            const __le16 *nvm_hw)
 490 {
 491         const u8 *hw_addr;
 492
 493         if (mac_override) {
 494                 hw_addr = (const u8 *)(mac_override +
 495                                  MAC_ADDRESS_OVERRIDE_FAMILY_8000);
 496
 497                 /* The byte order is little endian 16 bit, meaning 214365 */
 498                 data->hw_addr[0] = hw_addr[1];
 499                 data->hw_addr[1] = hw_addr[0];
 500                 data->hw_addr[2] = hw_addr[3];
 501                 data->hw_addr[3] = hw_addr[2];
 502                 data->hw_addr[4] = hw_addr[5];
 503                 data->hw_addr[5] = hw_addr[4];
 504
 505                 if (is_valid_ether_addr(data->hw_addr))
 506                         return;
 507
 508                 IWL_ERR_DEV(dev,
 509                             "mac address from nvm override section is not valid\n");
 510         }
 511
 512         if (nvm_hw) {
 513                 /* read the MAC address from OTP */
 514                 if (!dev_is_pci(dev) || (data->nvm_version < 0xE08)) {
 515                         /* read the mac address from the WFPM location */
 516                         hw_addr = (const u8 *)(nvm_hw +
 517                                                HW_ADDR0_WFPM_FAMILY_8000);
 518                         data->hw_addr[0] = hw_addr[3];
 519                         data->hw_addr[1] = hw_addr[2];
 520                         data->hw_addr[2] = hw_addr[1];
 521                         data->hw_addr[3] = hw_addr[0];
 522
 523                         hw_addr = (const u8 *)(nvm_hw +
 524                                                HW_ADDR1_WFPM_FAMILY_8000);
 525                         data->hw_addr[4] = hw_addr[1];
 526                         data->hw_addr[5] = hw_addr[0];
 527                 } else if ((data->nvm_version >= 0xE08) &&
 528                            (data->nvm_version < 0xE0B)) {
 529                         /* read "reverse order"  from the PCIe location */
 530                         hw_addr = (const u8 *)(nvm_hw +
 531                                                HW_ADDR0_PCIE_FAMILY_8000);
 532                         data->hw_addr[5] = hw_addr[2];
 533                         data->hw_addr[4] = hw_addr[1];
 534                         data->hw_addr[3] = hw_addr[0];
 535
 536                         hw_addr = (const u8 *)(nvm_hw +
 537                                                HW_ADDR1_PCIE_FAMILY_8000);
 538                         data->hw_addr[2] = hw_addr[3];
 539                         data->hw_addr[1] = hw_addr[2];
 540                         data->hw_addr[0] = hw_addr[1];
 541                 } else {
 542                         /* read from the PCIe location */
 543                         hw_addr = (const u8 *)(nvm_hw +
 544                                                HW_ADDR0_PCIE_FAMILY_8000);
 545                         data->hw_addr[5] = hw_addr[0];
 546                         data->hw_addr[4] = hw_addr[1];
 547                         data->hw_addr[3] = hw_addr[2];
 548
 549                         hw_addr = (const u8 *)(nvm_hw +
 550                                                HW_ADDR1_PCIE_FAMILY_8000);
 551                         data->hw_addr[2] = hw_addr[1];
 552                         data->hw_addr[1] = hw_addr[2];
 553                         data->hw_addr[0] = hw_addr[3];
 554                 }
 555                 if (!is_valid_ether_addr(data->hw_addr))
 556                         IWL_ERR_DEV(dev,
 557                                     "mac address from hw section is not valid\n");
 558
 559                 return;
 560         }
 561
 562         IWL_ERR_DEV(dev, "mac address is not found\n");
 563 }
 564
 565 struct iwl_nvm_data *
 566 iwl_parse_nvm_data(struct device *dev, const struct iwl_cfg *cfg,
 567                    const __le16 *nvm_hw, const __le16 *nvm_sw,
 568                    const __le16 *nvm_calib, const __le16 *regulatory,
 569                    const __le16 *mac_override, u8 tx_chains, u8 rx_chains)
 570 {
 571         struct iwl_nvm_data *data;
 572         u32 sku;
 573         u32 radio_cfg;
 574
 575         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 576                 data = kzalloc(sizeof(*data) +
 577                                sizeof(struct ieee80211_channel) *
 578                                IWL_NUM_CHANNELS,
 579                                GFP_KERNEL);
 580         else
 581                 data = kzalloc(sizeof(*data) +
 582                                sizeof(struct ieee80211_channel) *
 583                                IWL_NUM_CHANNELS_FAMILY_8000,
 584                                GFP_KERNEL);
 585         if (!data)
 586                 return NULL;
 587
 588         data->nvm_version = iwl_get_nvm_version(cfg, nvm_sw);
 589
 590         radio_cfg = iwl_get_radio_cfg(cfg, nvm_sw);
 591         iwl_set_radio_cfg(cfg, data, radio_cfg);
 592
 593         sku = iwl_get_sku(cfg, nvm_sw);
 594         data->sku_cap_band_24GHz_enable = sku & NVM_SKU_CAP_BAND_24GHZ;
 595         data->sku_cap_band_52GHz_enable = sku & NVM_SKU_CAP_BAND_52GHZ;
 596         data->sku_cap_11n_enable = sku & NVM_SKU_CAP_11N_ENABLE;
 597         data->sku_cap_11ac_enable = sku & NVM_SKU_CAP_11AC_ENABLE;
 598         if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
 599                 data->sku_cap_11n_enable = false;
 600
 601         data->n_hw_addrs = iwl_get_n_hw_addrs(cfg, nvm_sw);
 602
 603         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 604                 /* Checking for required sections */
 605                 if (!nvm_calib) {
 606                         IWL_ERR_DEV(dev,
 607                                     "Can't parse empty Calib NVM sections\n");
 608                         kfree(data);
 609                         return NULL;
 610                 }
 611                 /* in family 8000 Xtal calibration values moved to OTP */
 612                 data->xtal_calib[0] = *(nvm_calib + XTAL_CALIB);
 613                 data->xtal_calib[1] = *(nvm_calib + XTAL_CALIB + 1);
 614         }
 615
 616         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 617                 iwl_set_hw_address(cfg, data, nvm_hw);
 618
 619                 iwl_init_sbands(dev, cfg, data, nvm_sw,
 620                                 sku & NVM_SKU_CAP_11AC_ENABLE, tx_chains,
 621                                 rx_chains);
 622         } else {
 623                 /* MAC address in family 8000 */
 624                 iwl_set_hw_address_family_8000(dev, cfg, data, mac_override,
 625                                                nvm_hw);
 626
 627                 iwl_init_sbands(dev, cfg, data, regulatory,
 628                                 sku & NVM_SKU_CAP_11AC_ENABLE, tx_chains,
 629                                 rx_chains);
 630         }
 631
 632         data->calib_version = 255;
 633
 634         return data;
 635 }
 636 IWL_EXPORT_SYMBOL(iwl_parse_nvm_data);