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