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 }
 472
 473 static void iwl_set_hw_address(const struct iwl_cfg *cfg,
 474                                struct iwl_nvm_data *data,
 475                                const __le16 *nvm_sec)
 476 {
 477         const u8 *hw_addr = (const u8 *)(nvm_sec + HW_ADDR);
 478
 479         /* The byte order is little endian 16 bit, meaning 214365 */
 480         data->hw_addr[0] = hw_addr[1];
 481         data->hw_addr[1] = hw_addr[0];
 482         data->hw_addr[2] = hw_addr[3];
 483         data->hw_addr[3] = hw_addr[2];
 484         data->hw_addr[4] = hw_addr[5];
 485         data->hw_addr[5] = hw_addr[4];
 486 }
 487
 488 static void iwl_set_hw_address_family_8000(struct device *dev,
 489                                            const struct iwl_cfg *cfg,
 490                                            struct iwl_nvm_data *data,
 491                                            const __le16 *mac_override,
 492                                            const __le16 *nvm_hw)
 493 {
 494         const u8 *hw_addr;
 495
 496         if (mac_override) {
 497                 hw_addr = (const u8 *)(mac_override +
 498                                  MAC_ADDRESS_OVERRIDE_FAMILY_8000);
 499
 500                 /* The byte order is little endian 16 bit, meaning 214365 */
 501                 data->hw_addr[0] = hw_addr[1];
 502                 data->hw_addr[1] = hw_addr[0];
 503                 data->hw_addr[2] = hw_addr[3];
 504                 data->hw_addr[3] = hw_addr[2];
 505                 data->hw_addr[4] = hw_addr[5];
 506                 data->hw_addr[5] = hw_addr[4];
 507
 508                 if (is_valid_ether_addr(data->hw_addr))
 509                         return;
 510
 511                 IWL_ERR_DEV(dev,
 512                             "mac address from nvm override section is not valid\n");
 513         }
 514
 515         if (nvm_hw) {
 516                 /* read the MAC address from OTP */
 517                 if (!dev_is_pci(dev) || (data->nvm_version < 0xE08)) {
 518                         /* read the mac address from the WFPM location */
 519                         hw_addr = (const u8 *)(nvm_hw +
 520                                                HW_ADDR0_WFPM_FAMILY_8000);
 521                         data->hw_addr[0] = hw_addr[3];
 522                         data->hw_addr[1] = hw_addr[2];
 523                         data->hw_addr[2] = hw_addr[1];
 524                         data->hw_addr[3] = hw_addr[0];
 525
 526                         hw_addr = (const u8 *)(nvm_hw +
 527                                                HW_ADDR1_WFPM_FAMILY_8000);
 528                         data->hw_addr[4] = hw_addr[1];
 529                         data->hw_addr[5] = hw_addr[0];
 530                 } else if ((data->nvm_version >= 0xE08) &&
 531                            (data->nvm_version < 0xE0B)) {
 532                         /* read "reverse order"  from the PCIe location */
 533                         hw_addr = (const u8 *)(nvm_hw +
 534                                                HW_ADDR0_PCIE_FAMILY_8000);
 535                         data->hw_addr[5] = hw_addr[2];
 536                         data->hw_addr[4] = hw_addr[1];
 537                         data->hw_addr[3] = hw_addr[0];
 538
 539                         hw_addr = (const u8 *)(nvm_hw +
 540                                                HW_ADDR1_PCIE_FAMILY_8000);
 541                         data->hw_addr[2] = hw_addr[3];
 542                         data->hw_addr[1] = hw_addr[2];
 543                         data->hw_addr[0] = hw_addr[1];
 544                 } else {
 545                         /* read from the PCIe location */
 546                         hw_addr = (const u8 *)(nvm_hw +
 547                                                HW_ADDR0_PCIE_FAMILY_8000);
 548                         data->hw_addr[5] = hw_addr[0];
 549                         data->hw_addr[4] = hw_addr[1];
 550                         data->hw_addr[3] = hw_addr[2];
 551
 552                         hw_addr = (const u8 *)(nvm_hw +
 553                                                HW_ADDR1_PCIE_FAMILY_8000);
 554                         data->hw_addr[2] = hw_addr[1];
 555                         data->hw_addr[1] = hw_addr[2];
 556                         data->hw_addr[0] = hw_addr[3];
 557                 }
 558                 if (!is_valid_ether_addr(data->hw_addr))
 559                         IWL_ERR_DEV(dev,
 560                                     "mac address from hw section is not valid\n");
 561
 562                 return;
 563         }
 564
 565         IWL_ERR_DEV(dev, "mac address is not found\n");
 566 }
 567
 568 struct iwl_nvm_data *
 569 iwl_parse_nvm_data(struct device *dev, const struct iwl_cfg *cfg,
 570                    const __le16 *nvm_hw, const __le16 *nvm_sw,
 571                    const __le16 *nvm_calib, const __le16 *regulatory,
 572                    const __le16 *mac_override, u8 tx_chains, u8 rx_chains)
 573 {
 574         struct iwl_nvm_data *data;
 575         u32 sku;
 576         u32 radio_cfg;
 577
 578         if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
 579                 data = kzalloc(sizeof(*data) +
 580                                sizeof(struct ieee80211_channel) *
 581                                IWL_NUM_CHANNELS,
 582                                GFP_KERNEL);
 583         else
 584                 data = kzalloc(sizeof(*data) +
 585                                sizeof(struct ieee80211_channel) *
 586                                IWL_NUM_CHANNELS_FAMILY_8000,
 587                                GFP_KERNEL);
 588         if (!data)
 589                 return NULL;
 590
 591         data->nvm_version = iwl_get_nvm_version(cfg, nvm_sw);
 592
 593         radio_cfg = iwl_get_radio_cfg(cfg, nvm_sw);
 594         iwl_set_radio_cfg(cfg, data, radio_cfg);
 595
 596         sku = iwl_get_sku(cfg, nvm_sw);
 597         data->sku_cap_band_24GHz_enable = sku & NVM_SKU_CAP_BAND_24GHZ;
 598         data->sku_cap_band_52GHz_enable = sku & NVM_SKU_CAP_BAND_52GHZ;
 599         data->sku_cap_11n_enable = sku & NVM_SKU_CAP_11N_ENABLE;
 600         data->sku_cap_11ac_enable = sku & NVM_SKU_CAP_11AC_ENABLE;
 601         if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
 602                 data->sku_cap_11n_enable = false;
 603
 604         data->n_hw_addrs = iwl_get_n_hw_addrs(cfg, nvm_sw);
 605
 606         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 607                 /* Checking for required sections */
 608                 if (!nvm_calib) {
 609                         IWL_ERR_DEV(dev,
 610                                     "Can't parse empty Calib NVM sections\n");
 611                         kfree(data);
 612                         return NULL;
 613                 }
 614                 /* in family 8000 Xtal calibration values moved to OTP */
 615                 data->xtal_calib[0] = *(nvm_calib + XTAL_CALIB);
 616                 data->xtal_calib[1] = *(nvm_calib + XTAL_CALIB + 1);
 617         }
 618
 619         if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
 620                 iwl_set_hw_address(cfg, data, nvm_hw);
 621
 622                 iwl_init_sbands(dev, cfg, data, nvm_sw,
 623                                 sku & NVM_SKU_CAP_11AC_ENABLE, tx_chains,
 624                                 rx_chains);
 625         } else {
 626                 /* MAC address in family 8000 */
 627                 iwl_set_hw_address_family_8000(dev, cfg, data, mac_override,
 628                                                nvm_hw);
 629
 630                 iwl_init_sbands(dev, cfg, data, regulatory,
 631                                 sku & NVM_SKU_CAP_11AC_ENABLE, tx_chains,
 632                                 rx_chains);
 633         }
 634
 635         data->calib_version = 255;
 636
 637         return data;
 638 }
 639 IWL_EXPORT_SYMBOL(iwl_parse_nvm_data);