[deliverable/linux.git] / drivers / net / wireless / iwlwifi / iwl-nvm-parse.c

/******************************************************************************
 *
 * This file is provided under a dual BSD/GPLv2 license.  When using or
 * redistributing this file, you may do so under either license.
 *
 * GPL LICENSE SUMMARY
 *
 * Copyright(c) 2008 - 2014 Intel Corporation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
 * USA
 *
 * The full GNU General Public License is included in this distribution
 * in the file called COPYING.
 *
 * Contact Information:
 *  Intel Linux Wireless <ilw@linux.intel.com>
 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 *
 * BSD LICENSE
 *
 * Copyright(c) 2005 - 2014 Intel Corporation. All rights reserved.
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 *  * Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 *  * Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in
 *    the documentation and/or other materials provided with the
 *    distribution.
 *  * Neither the name Intel Corporation nor the names of its
 *    contributors may be used to endorse or promote products derived
 *    from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *****************************************************************************/
#include <linux/types.h>
#include <linux/slab.h>
#include <linux/export.h>
#include "iwl-drv.h"
#include "iwl-modparams.h"
#include "iwl-nvm-parse.h"

/* NVM offsets (in words) definitions */
enum wkp_nvm_offsets {
	/* NVM HW-Section offset (in words) definitions */
	HW_ADDR = 0x15,

/* NVM SW-Section offset (in words) definitions */
	NVM_SW_SECTION = 0x1C0,
	NVM_VERSION = 0,
	RADIO_CFG = 1,
	SKU = 2,
	N_HW_ADDRS = 3,
	NVM_CHANNELS = 0x1E0 - NVM_SW_SECTION,

/* NVM calibration section offset (in words) definitions */
	NVM_CALIB_SECTION = 0x2B8,
	XTAL_CALIB = 0x316 - NVM_CALIB_SECTION
};

/* SKU Capabilities (actual values from NVM definition) */
enum nvm_sku_bits {
	NVM_SKU_CAP_BAND_24GHZ	= BIT(0),
	NVM_SKU_CAP_BAND_52GHZ	= BIT(1),
	NVM_SKU_CAP_11N_ENABLE	= BIT(2),
	NVM_SKU_CAP_11AC_ENABLE	= BIT(3),
};

/* radio config bits (actual values from NVM definition) */
#define NVM_RF_CFG_DASH_MSK(x)   (x & 0x3)         /* bits 0-1   */
#define NVM_RF_CFG_STEP_MSK(x)   ((x >> 2)  & 0x3) /* bits 2-3   */
#define NVM_RF_CFG_TYPE_MSK(x)   ((x >> 4)  & 0x3) /* bits 4-5   */
#define NVM_RF_CFG_PNUM_MSK(x)   ((x >> 6)  & 0x3) /* bits 6-7   */
#define NVM_RF_CFG_TX_ANT_MSK(x) ((x >> 8)  & 0xF) /* bits 8-11  */
#define NVM_RF_CFG_RX_ANT_MSK(x) ((x >> 12) & 0xF) /* bits 12-15 */

/*
 * These are the channel numbers in the order that they are stored in the NVM
 */
static const u8 iwl_nvm_channels[] = {
	/* 2.4 GHz */
	1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
	/* 5 GHz */
	36, 40, 44 , 48, 52, 56, 60, 64,
	100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144,
	149, 153, 157, 161, 165
};

#define IWL_NUM_CHANNELS	ARRAY_SIZE(iwl_nvm_channels)
#define NUM_2GHZ_CHANNELS	14
#define FIRST_2GHZ_HT_MINUS	5
#define LAST_2GHZ_HT_PLUS	9
#define LAST_5GHZ_HT		161

#define DEFAULT_MAX_TX_POWER 16

/* rate data (static) */
static struct ieee80211_rate iwl_cfg80211_rates[] = {
	{ .bitrate = 1 * 10, .hw_value = 0, .hw_value_short = 0, },
	{ .bitrate = 2 * 10, .hw_value = 1, .hw_value_short = 1,
	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
	{ .bitrate = 5.5 * 10, .hw_value = 2, .hw_value_short = 2,
	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
	{ .bitrate = 11 * 10, .hw_value = 3, .hw_value_short = 3,
	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
	{ .bitrate = 6 * 10, .hw_value = 4, .hw_value_short = 4, },
	{ .bitrate = 9 * 10, .hw_value = 5, .hw_value_short = 5, },
	{ .bitrate = 12 * 10, .hw_value = 6, .hw_value_short = 6, },
	{ .bitrate = 18 * 10, .hw_value = 7, .hw_value_short = 7, },
	{ .bitrate = 24 * 10, .hw_value = 8, .hw_value_short = 8, },
	{ .bitrate = 36 * 10, .hw_value = 9, .hw_value_short = 9, },
	{ .bitrate = 48 * 10, .hw_value = 10, .hw_value_short = 10, },
	{ .bitrate = 54 * 10, .hw_value = 11, .hw_value_short = 11, },
};
#define RATES_24_OFFS	0
#define N_RATES_24	ARRAY_SIZE(iwl_cfg80211_rates)
#define RATES_52_OFFS	4
#define N_RATES_52	(N_RATES_24 - RATES_52_OFFS)

/**
 * enum iwl_nvm_channel_flags - channel flags in NVM
 * @NVM_CHANNEL_VALID: channel is usable for this SKU/geo
 * @NVM_CHANNEL_IBSS: usable as an IBSS channel
 * @NVM_CHANNEL_ACTIVE: active scanning allowed
 * @NVM_CHANNEL_RADAR: radar detection required
 * @NVM_CHANNEL_DFS: dynamic freq selection candidate
 * @NVM_CHANNEL_WIDE: 20 MHz channel okay (?)
 * @NVM_CHANNEL_40MHZ: 40 MHz channel okay (?)
 * @NVM_CHANNEL_80MHZ: 80 MHz channel okay (?)
 * @NVM_CHANNEL_160MHZ: 160 MHz channel okay (?)
 */
enum iwl_nvm_channel_flags {
	NVM_CHANNEL_VALID = BIT(0),
	NVM_CHANNEL_IBSS = BIT(1),
	NVM_CHANNEL_ACTIVE = BIT(3),
	NVM_CHANNEL_RADAR = BIT(4),
	NVM_CHANNEL_DFS = BIT(7),
	NVM_CHANNEL_WIDE = BIT(8),
	NVM_CHANNEL_40MHZ = BIT(9),
	NVM_CHANNEL_80MHZ = BIT(10),
	NVM_CHANNEL_160MHZ = BIT(11),
};

#define CHECK_AND_PRINT_I(x)	\
	((ch_flags & NVM_CHANNEL_##x) ? # x " " : "")

static int iwl_init_channel_map(struct device *dev, const struct iwl_cfg *cfg,
				struct iwl_nvm_data *data,
				const __le16 * const nvm_ch_flags)
{
	int ch_idx;
	int n_channels = 0;
	struct ieee80211_channel *channel;
	u16 ch_flags;
	bool is_5ghz;

	for (ch_idx = 0; ch_idx < IWL_NUM_CHANNELS; ch_idx++) {
		ch_flags = __le16_to_cpup(nvm_ch_flags + ch_idx);
		if (!(ch_flags & NVM_CHANNEL_VALID)) {
			IWL_DEBUG_EEPROM(dev,
					 "Ch. %d Flags %x [%sGHz] - No traffic\n",
					 iwl_nvm_channels[ch_idx],
					 ch_flags,
					 (ch_idx >= NUM_2GHZ_CHANNELS) ?
					 "5.2" : "2.4");
			continue;
		}

		channel = &data->channels[n_channels];
		n_channels++;

		channel->hw_value = iwl_nvm_channels[ch_idx];
		channel->band = (ch_idx < NUM_2GHZ_CHANNELS) ?
				IEEE80211_BAND_2GHZ : IEEE80211_BAND_5GHZ;
		channel->center_freq =
			ieee80211_channel_to_frequency(
				channel->hw_value, channel->band);

		/* TODO: Need to be dependent to the NVM */
		channel->flags = IEEE80211_CHAN_NO_HT40;
		if (ch_idx < NUM_2GHZ_CHANNELS &&
		    (ch_flags & NVM_CHANNEL_40MHZ)) {
			if (iwl_nvm_channels[ch_idx] <= LAST_2GHZ_HT_PLUS)
				channel->flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
			if (iwl_nvm_channels[ch_idx] >= FIRST_2GHZ_HT_MINUS)
				channel->flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
		} else if (iwl_nvm_channels[ch_idx] <= LAST_5GHZ_HT &&
			   (ch_flags & NVM_CHANNEL_40MHZ)) {
			if ((ch_idx - NUM_2GHZ_CHANNELS) % 2 == 0)
				channel->flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
			else
				channel->flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
		}
		if (!(ch_flags & NVM_CHANNEL_80MHZ))
			channel->flags |= IEEE80211_CHAN_NO_80MHZ;
		if (!(ch_flags & NVM_CHANNEL_160MHZ))
			channel->flags |= IEEE80211_CHAN_NO_160MHZ;

		if (!(ch_flags & NVM_CHANNEL_IBSS))
			channel->flags |= IEEE80211_CHAN_NO_IR;

		if (!(ch_flags & NVM_CHANNEL_ACTIVE))
			channel->flags |= IEEE80211_CHAN_NO_IR;

		if (ch_flags & NVM_CHANNEL_RADAR)
			channel->flags |= IEEE80211_CHAN_RADAR;

		/* Initialize regulatory-based run-time data */

		/*
		 * Default value - highest tx power value.  max_power
		 * is not used in mvm, and is used for backwards compatibility
		 */
		channel->max_power = DEFAULT_MAX_TX_POWER;
		is_5ghz = channel->band == IEEE80211_BAND_5GHZ;
		IWL_DEBUG_EEPROM(dev,
				 "Ch. %d [%sGHz] %s%s%s%s%s%s(0x%02x %ddBm): Ad-Hoc %ssupported\n",
				 channel->hw_value,
				 is_5ghz ? "5.2" : "2.4",
				 CHECK_AND_PRINT_I(VALID),
				 CHECK_AND_PRINT_I(IBSS),
				 CHECK_AND_PRINT_I(ACTIVE),
				 CHECK_AND_PRINT_I(RADAR),
				 CHECK_AND_PRINT_I(WIDE),
				 CHECK_AND_PRINT_I(DFS),
				 ch_flags,
				 channel->max_power,
				 ((ch_flags & NVM_CHANNEL_IBSS) &&
				  !(ch_flags & NVM_CHANNEL_RADAR))
					? "" : "not ");
	}

	return n_channels;
}

static void iwl_init_vht_hw_capab(const struct iwl_cfg *cfg,
				  struct iwl_nvm_data *data,
				  struct ieee80211_sta_vht_cap *vht_cap)
{
	int num_ants = num_of_ant(data->valid_rx_ant);

	vht_cap->vht_supported = true;

	vht_cap->cap = IEEE80211_VHT_CAP_SHORT_GI_80 |
		       IEEE80211_VHT_CAP_RXSTBC_1 |
		       IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE |
		       3 << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT |
		       7 << IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;

	if (num_ants > 1)
		vht_cap->cap |= IEEE80211_VHT_CAP_TXSTBC;

	if (iwlwifi_mod_params.amsdu_size_8K)
		vht_cap->cap |= IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991;

	vht_cap->vht_mcs.rx_mcs_map =
		cpu_to_le16(IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 |
			    IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 |
			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 4 |
			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 6 |
			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 8 |
			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 10 |
			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 12 |
			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 14);

	if (num_ants == 1 ||
	    cfg->rx_with_siso_diversity) {
		vht_cap->cap |= IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN |
				IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN;
		/* this works because NOT_SUPPORTED == 3 */
		vht_cap->vht_mcs.rx_mcs_map |=
			cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << 2);
	}

	vht_cap->vht_mcs.tx_mcs_map = vht_cap->vht_mcs.rx_mcs_map;
}

static void iwl_init_sbands(struct device *dev, const struct iwl_cfg *cfg,
			    struct iwl_nvm_data *data, const __le16 *nvm_sw,
			    bool enable_vht, u8 tx_chains, u8 rx_chains)
{
	int n_channels = iwl_init_channel_map(dev, cfg, data,
			&nvm_sw[NVM_CHANNELS]);
	int n_used = 0;
	struct ieee80211_supported_band *sband;

	sband = &data->bands[IEEE80211_BAND_2GHZ];
	sband->band = IEEE80211_BAND_2GHZ;
	sband->bitrates = &iwl_cfg80211_rates[RATES_24_OFFS];
	sband->n_bitrates = N_RATES_24;
	n_used += iwl_init_sband_channels(data, sband, n_channels,
					  IEEE80211_BAND_2GHZ);
	iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_2GHZ,
			     tx_chains, rx_chains);

	sband = &data->bands[IEEE80211_BAND_5GHZ];
	sband->band = IEEE80211_BAND_5GHZ;
	sband->bitrates = &iwl_cfg80211_rates[RATES_52_OFFS];
	sband->n_bitrates = N_RATES_52;
	n_used += iwl_init_sband_channels(data, sband, n_channels,
					  IEEE80211_BAND_5GHZ);
	iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_5GHZ,
			     tx_chains, rx_chains);
	if (enable_vht)
		iwl_init_vht_hw_capab(cfg, data, &sband->vht_cap);

	if (n_channels != n_used)
		IWL_ERR_DEV(dev, "NVM: used only %d of %d channels\n",
			    n_used, n_channels);
}

struct iwl_nvm_data *
iwl_parse_nvm_data(struct device *dev, const struct iwl_cfg *cfg,
		   const __le16 *nvm_hw, const __le16 *nvm_sw,
		   const __le16 *nvm_calib, u8 tx_chains, u8 rx_chains)
{
	struct iwl_nvm_data *data;
	u8 hw_addr[ETH_ALEN];
	u16 radio_cfg, sku;

	data = kzalloc(sizeof(*data) +
		       sizeof(struct ieee80211_channel) * IWL_NUM_CHANNELS,
		       GFP_KERNEL);
	if (!data)
		return NULL;

	data->nvm_version = le16_to_cpup(nvm_sw + NVM_VERSION);

	radio_cfg = le16_to_cpup(nvm_sw + RADIO_CFG);
	data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK(radio_cfg);
	data->radio_cfg_step = NVM_RF_CFG_STEP_MSK(radio_cfg);
	data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK(radio_cfg);
	data->radio_cfg_pnum = NVM_RF_CFG_PNUM_MSK(radio_cfg);
	data->valid_tx_ant = NVM_RF_CFG_TX_ANT_MSK(radio_cfg);
	data->valid_rx_ant = NVM_RF_CFG_RX_ANT_MSK(radio_cfg);

	sku = le16_to_cpup(nvm_sw + SKU);
	data->sku_cap_band_24GHz_enable = sku & NVM_SKU_CAP_BAND_24GHZ;
	data->sku_cap_band_52GHz_enable = sku & NVM_SKU_CAP_BAND_52GHZ;
	data->sku_cap_11n_enable = sku & NVM_SKU_CAP_11N_ENABLE;
	if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
		data->sku_cap_11n_enable = false;

	/* check overrides (some devices have wrong NVM) */
	if (cfg->valid_tx_ant)
		data->valid_tx_ant = cfg->valid_tx_ant;
	if (cfg->valid_rx_ant)
		data->valid_rx_ant = cfg->valid_rx_ant;

	if (!data->valid_tx_ant || !data->valid_rx_ant) {
		IWL_ERR_DEV(dev, "invalid antennas (0x%x, 0x%x)\n",
			    data->valid_tx_ant, data->valid_rx_ant);
		kfree(data);
		return NULL;
	}

	data->n_hw_addrs = le16_to_cpup(nvm_sw + N_HW_ADDRS);

	data->xtal_calib[0] = *(nvm_calib + XTAL_CALIB);
	data->xtal_calib[1] = *(nvm_calib + XTAL_CALIB + 1);

	/* The byte order is little endian 16 bit, meaning 214365 */
	memcpy(hw_addr, nvm_hw + HW_ADDR, ETH_ALEN);
	data->hw_addr[0] = hw_addr[1];
	data->hw_addr[1] = hw_addr[0];
	data->hw_addr[2] = hw_addr[3];
	data->hw_addr[3] = hw_addr[2];
	data->hw_addr[4] = hw_addr[5];
	data->hw_addr[5] = hw_addr[4];

	iwl_init_sbands(dev, cfg, data, nvm_sw, sku & NVM_SKU_CAP_11AC_ENABLE,
			tx_chains, rx_chains);

	data->calib_version = 255;   /* TODO:
					this value will prevent some checks from
					failing, we need to check if this
					field is still needed, and if it does,
					where is it in the NVM*/

	return data;
}
IWL_EXPORT_SYMBOL(iwl_parse_nvm_data);
Commit	Line	Data
b1e1adfa JB	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	*
51368bf7	8	* Copyright(c) 2008 - 2014 Intel Corporation. All rights reserved.
b1e1adfa JB	9	*
	10	* This program is free software; you can redistribute it and/or modify
	11	* it under the terms of version 2 of the GNU General Public License as
	12	* published by the Free Software Foundation.
	13	*
	14	* This program is distributed in the hope that it will be useful, but
	15	* WITHOUT ANY WARRANTY; without even the implied warranty of
	16	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	17	* General Public License for more details.
	18	*
	19	* You should have received a copy of the GNU General Public License
	20	* along with this program; if not, write to the Free Software
	21	* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
	22	* USA
	23	*
	24	* The full GNU General Public License is included in this distribution
410dc5aa	25	* in the file called COPYING.
b1e1adfa JB	26	*
	27	* Contact Information:
	28	* Intel Linux Wireless <ilw@linux.intel.com>
	29	* Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
	30	*
	31	* BSD LICENSE
	32	*
51368bf7	33	* Copyright(c) 2005 - 2014 Intel Corporation. All rights reserved.
b1e1adfa JB	34	* All rights reserved.
	35	*
	36	* Redistribution and use in source and binary forms, with or without
	37	* modification, are permitted provided that the following conditions
	38	* are met:
	39	*
	40	* * Redistributions of source code must retain the above copyright
	41	* notice, this list of conditions and the following disclaimer.
	42	* * Redistributions in binary form must reproduce the above copyright
	43	* notice, this list of conditions and the following disclaimer in
	44	* the documentation and/or other materials provided with the
	45	* distribution.
	46	* * Neither the name Intel Corporation nor the names of its
	47	* contributors may be used to endorse or promote products derived
	48	* from this software without specific prior written permission.
	49	*
	50	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
	51	* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
	52	* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
	53	* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
	54	* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
	55	* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
	56	* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
	57	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
	58	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
	59	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
	60	* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	61	*****************************************************************************/
	62	#include <linux/types.h>
	63	#include <linux/slab.h>
	64	#include <linux/export.h>
48e29340	65	#include "iwl-drv.h"
b1e1adfa JB	66	#include "iwl-modparams.h"
	67	#include "iwl-nvm-parse.h"
	68
	69	/* NVM offsets (in words) definitions */
	70	enum wkp_nvm_offsets {
	71	/* NVM HW-Section offset (in words) definitions */
	72	HW_ADDR = 0x15,
	73
	74	/* NVM SW-Section offset (in words) definitions */
	75	NVM_SW_SECTION = 0x1C0,
	76	NVM_VERSION = 0,
	77	RADIO_CFG = 1,
	78	SKU = 2,
	79	N_HW_ADDRS = 3,
	80	NVM_CHANNELS = 0x1E0 - NVM_SW_SECTION,
	81
	82	/* NVM calibration section offset (in words) definitions */
	83	NVM_CALIB_SECTION = 0x2B8,
	84	XTAL_CALIB = 0x316 - NVM_CALIB_SECTION
	85	};
	86
	87	/* SKU Capabilities (actual values from NVM definition) */
	88	enum nvm_sku_bits {
	89	NVM_SKU_CAP_BAND_24GHZ = BIT(0),
	90	NVM_SKU_CAP_BAND_52GHZ = BIT(1),
	91	NVM_SKU_CAP_11N_ENABLE = BIT(2),
bfc824b0	92	NVM_SKU_CAP_11AC_ENABLE = BIT(3),
b1e1adfa JB	93	};
	94
	95	/* radio config bits (actual values from NVM definition) */
	96	#define NVM_RF_CFG_DASH_MSK(x) (x & 0x3) /* bits 0-1 */
	97	#define NVM_RF_CFG_STEP_MSK(x) ((x >> 2) & 0x3) /* bits 2-3 */
	98	#define NVM_RF_CFG_TYPE_MSK(x) ((x >> 4) & 0x3) /* bits 4-5 */
	99	#define NVM_RF_CFG_PNUM_MSK(x) ((x >> 6) & 0x3) /* bits 6-7 */
	100	#define NVM_RF_CFG_TX_ANT_MSK(x) ((x >> 8) & 0xF) /* bits 8-11 */
	101	#define NVM_RF_CFG_RX_ANT_MSK(x) ((x >> 12) & 0xF) /* bits 12-15 */
	102
	103	/*
	104	* These are the channel numbers in the order that they are stored in the NVM
	105	*/
	106	static const u8 iwl_nvm_channels[] = {
	107	/* 2.4 GHz */
	108	1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
	109	/* 5 GHz */
	110	36, 40, 44 , 48, 52, 56, 60, 64,
	111	100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144,
	112	149, 153, 157, 161, 165
	113	};
	114
	115	#define IWL_NUM_CHANNELS ARRAY_SIZE(iwl_nvm_channels)
	116	#define NUM_2GHZ_CHANNELS 14
	117	#define FIRST_2GHZ_HT_MINUS 5
	118	#define LAST_2GHZ_HT_PLUS 9
	119	#define LAST_5GHZ_HT 161
	120
88f2fd73	121	#define DEFAULT_MAX_TX_POWER 16
b1e1adfa JB	122
	123	/* rate data (static) */
	124	static struct ieee80211_rate iwl_cfg80211_rates[] = {
	125	{ .bitrate = 1 * 10, .hw_value = 0, .hw_value_short = 0, },
	126	{ .bitrate = 2 * 10, .hw_value = 1, .hw_value_short = 1,
	127	.flags = IEEE80211_RATE_SHORT_PREAMBLE, },
	128	{ .bitrate = 5.5 * 10, .hw_value = 2, .hw_value_short = 2,
	129	.flags = IEEE80211_RATE_SHORT_PREAMBLE, },
	130	{ .bitrate = 11 * 10, .hw_value = 3, .hw_value_short = 3,
	131	.flags = IEEE80211_RATE_SHORT_PREAMBLE, },
	132	{ .bitrate = 6 * 10, .hw_value = 4, .hw_value_short = 4, },
	133	{ .bitrate = 9 * 10, .hw_value = 5, .hw_value_short = 5, },
	134	{ .bitrate = 12 * 10, .hw_value = 6, .hw_value_short = 6, },
	135	{ .bitrate = 18 * 10, .hw_value = 7, .hw_value_short = 7, },
	136	{ .bitrate = 24 * 10, .hw_value = 8, .hw_value_short = 8, },
	137	{ .bitrate = 36 * 10, .hw_value = 9, .hw_value_short = 9, },
	138	{ .bitrate = 48 * 10, .hw_value = 10, .hw_value_short = 10, },
	139	{ .bitrate = 54 * 10, .hw_value = 11, .hw_value_short = 11, },
	140	};
	141	#define RATES_24_OFFS 0
	142	#define N_RATES_24 ARRAY_SIZE(iwl_cfg80211_rates)
	143	#define RATES_52_OFFS 4
	144	#define N_RATES_52 (N_RATES_24 - RATES_52_OFFS)
	145
	146	/**
	147	* enum iwl_nvm_channel_flags - channel flags in NVM
	148	* @NVM_CHANNEL_VALID: channel is usable for this SKU/geo
	149	* @NVM_CHANNEL_IBSS: usable as an IBSS channel
	150	* @NVM_CHANNEL_ACTIVE: active scanning allowed
	151	* @NVM_CHANNEL_RADAR: radar detection required
	152	* @NVM_CHANNEL_DFS: dynamic freq selection candidate
	153	* @NVM_CHANNEL_WIDE: 20 MHz channel okay (?)
	154	* @NVM_CHANNEL_40MHZ: 40 MHz channel okay (?)
33158fef EL	155	* @NVM_CHANNEL_80MHZ: 80 MHz channel okay (?)
33158fef EL	156	* @NVM_CHANNEL_160MHZ: 160 MHz channel okay (?)
b1e1adfa JB	157	*/
	158	enum iwl_nvm_channel_flags {
	159	NVM_CHANNEL_VALID = BIT(0),
	160	NVM_CHANNEL_IBSS = BIT(1),
	161	NVM_CHANNEL_ACTIVE = BIT(3),
	162	NVM_CHANNEL_RADAR = BIT(4),
	163	NVM_CHANNEL_DFS = BIT(7),
	164	NVM_CHANNEL_WIDE = BIT(8),
	165	NVM_CHANNEL_40MHZ = BIT(9),
33158fef EL	166	NVM_CHANNEL_80MHZ = BIT(10),
33158fef EL	167	NVM_CHANNEL_160MHZ = BIT(11),
b1e1adfa JB	168	};
	169
	170	#define CHECK_AND_PRINT_I(x) \
	171	((ch_flags & NVM_CHANNEL_##x) ? # x " " : "")
	172
	173	static int iwl_init_channel_map(struct device dev, const struct iwl_cfg cfg,
	174	struct iwl_nvm_data *data,
	175	const __le16 * const nvm_ch_flags)
	176	{
	177	int ch_idx;
	178	int n_channels = 0;
	179	struct ieee80211_channel *channel;
	180	u16 ch_flags;
	181	bool is_5ghz;
	182
	183	for (ch_idx = 0; ch_idx < IWL_NUM_CHANNELS; ch_idx++) {
	184	ch_flags = __le16_to_cpup(nvm_ch_flags + ch_idx);
	185	if (!(ch_flags & NVM_CHANNEL_VALID)) {
	186	IWL_DEBUG_EEPROM(dev,
	187	"Ch. %d Flags %x [%sGHz] - No traffic\n",
	188	iwl_nvm_channels[ch_idx],
	189	ch_flags,
	190	(ch_idx >= NUM_2GHZ_CHANNELS) ?
	191	"5.2" : "2.4");
	192	continue;
	193	}
	194
	195	channel = &data->channels[n_channels];
	196	n_channels++;
	197
	198	channel->hw_value = iwl_nvm_channels[ch_idx];
	199	channel->band = (ch_idx < NUM_2GHZ_CHANNELS) ?
	200	IEEE80211_BAND_2GHZ : IEEE80211_BAND_5GHZ;
	201	channel->center_freq =
	202	ieee80211_channel_to_frequency(
	203	channel->hw_value, channel->band);
	204
	205	/* TODO: Need to be dependent to the NVM */
	206	channel->flags = IEEE80211_CHAN_NO_HT40;
	207	if (ch_idx < NUM_2GHZ_CHANNELS &&
	208	(ch_flags & NVM_CHANNEL_40MHZ)) {
	209	if (iwl_nvm_channels[ch_idx] <= LAST_2GHZ_HT_PLUS)
	210	channel->flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
	211	if (iwl_nvm_channels[ch_idx] >= FIRST_2GHZ_HT_MINUS)
	212	channel->flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
	213	} else if (iwl_nvm_channels[ch_idx] <= LAST_5GHZ_HT &&
	214	(ch_flags & NVM_CHANNEL_40MHZ)) {
	215	if ((ch_idx - NUM_2GHZ_CHANNELS) % 2 == 0)
	216	channel->flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
	217	else
	218	channel->flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
	219	}
33158fef EL	220	if (!(ch_flags & NVM_CHANNEL_80MHZ))
	221	channel->flags \|= IEEE80211_CHAN_NO_80MHZ;
	222	if (!(ch_flags & NVM_CHANNEL_160MHZ))
	223	channel->flags \|= IEEE80211_CHAN_NO_160MHZ;
b1e1adfa JB	224
b1e1adfa JB	225	if (!(ch_flags & NVM_CHANNEL_IBSS))
8fe02e16	226	channel->flags \|= IEEE80211_CHAN_NO_IR;
b1e1adfa JB	227
b1e1adfa JB	228	if (!(ch_flags & NVM_CHANNEL_ACTIVE))
8fe02e16	229	channel->flags \|= IEEE80211_CHAN_NO_IR;
b1e1adfa JB	230
	231	if (ch_flags & NVM_CHANNEL_RADAR)
	232	channel->flags \|= IEEE80211_CHAN_RADAR;
	233
	234	/* Initialize regulatory-based run-time data */
	235
88f2fd73 MG	236	/*
	237	* Default value - highest tx power value. max_power
	238	* is not used in mvm, and is used for backwards compatibility
	239	*/
	240	channel->max_power = DEFAULT_MAX_TX_POWER;
b1e1adfa JB	241	is_5ghz = channel->band == IEEE80211_BAND_5GHZ;
	242	IWL_DEBUG_EEPROM(dev,
	243	"Ch. %d [%sGHz] %s%s%s%s%s%s(0x%02x %ddBm): Ad-Hoc %ssupported\n",
	244	channel->hw_value,
	245	is_5ghz ? "5.2" : "2.4",
	246	CHECK_AND_PRINT_I(VALID),
	247	CHECK_AND_PRINT_I(IBSS),
	248	CHECK_AND_PRINT_I(ACTIVE),
	249	CHECK_AND_PRINT_I(RADAR),
	250	CHECK_AND_PRINT_I(WIDE),
	251	CHECK_AND_PRINT_I(DFS),
	252	ch_flags,
	253	channel->max_power,
	254	((ch_flags & NVM_CHANNEL_IBSS) &&
	255	!(ch_flags & NVM_CHANNEL_RADAR))
	256	? "" : "not ");
	257	}
	258
	259	return n_channels;
	260	}
	261
33158fef EL	262	static void iwl_init_vht_hw_capab(const struct iwl_cfg *cfg,
	263	struct iwl_nvm_data *data,
	264	struct ieee80211_sta_vht_cap *vht_cap)
	265	{
5f7a6f9b	266	int num_ants = num_of_ant(data->valid_rx_ant);
48e6de61	267
33158fef EL	268	vht_cap->vht_supported = true;
	269
	270	vht_cap->cap = IEEE80211_VHT_CAP_SHORT_GI_80 \|
	271	IEEE80211_VHT_CAP_RXSTBC_1 \|
	272	IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE \|
e36b766d	273	3 << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT \|
33158fef EL	274	7 << IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;
33158fef EL	275
5f7a6f9b ES	276	if (num_ants > 1)
	277	vht_cap->cap \|= IEEE80211_VHT_CAP_TXSTBC;
	278
33158fef EL	279	if (iwlwifi_mod_params.amsdu_size_8K)
	280	vht_cap->cap \|= IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991;
	281
	282	vht_cap->vht_mcs.rx_mcs_map =
	283	cpu_to_le16(IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 \|
	284	IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 \|
	285	IEEE80211_VHT_MCS_NOT_SUPPORTED << 4 \|
	286	IEEE80211_VHT_MCS_NOT_SUPPORTED << 6 \|
	287	IEEE80211_VHT_MCS_NOT_SUPPORTED << 8 \|
	288	IEEE80211_VHT_MCS_NOT_SUPPORTED << 10 \|
	289	IEEE80211_VHT_MCS_NOT_SUPPORTED << 12 \|
	290	IEEE80211_VHT_MCS_NOT_SUPPORTED << 14);
	291
5f7a6f9b	292	if (num_ants == 1 \|\|
a7b8b2ca	293	cfg->rx_with_siso_diversity) {
33158fef EL	294	vht_cap->cap \|= IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN \|
	295	IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN;
	296	/* this works because NOT_SUPPORTED == 3 */
	297	vht_cap->vht_mcs.rx_mcs_map \|=
	298	cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << 2);
	299	}
	300
	301	vht_cap->vht_mcs.tx_mcs_map = vht_cap->vht_mcs.rx_mcs_map;
	302	}
	303
b1e1adfa	304	static void iwl_init_sbands(struct device dev, const struct iwl_cfg cfg,
bfc824b0	305	struct iwl_nvm_data data, const __le16 nvm_sw,
9ce4fa72	306	bool enable_vht, u8 tx_chains, u8 rx_chains)
b1e1adfa JB	307	{
	308	int n_channels = iwl_init_channel_map(dev, cfg, data,
	309	&nvm_sw[NVM_CHANNELS]);
	310	int n_used = 0;
	311	struct ieee80211_supported_band *sband;
	312
	313	sband = &data->bands[IEEE80211_BAND_2GHZ];
	314	sband->band = IEEE80211_BAND_2GHZ;
	315	sband->bitrates = &iwl_cfg80211_rates[RATES_24_OFFS];
	316	sband->n_bitrates = N_RATES_24;
	317	n_used += iwl_init_sband_channels(data, sband, n_channels,
	318	IEEE80211_BAND_2GHZ);
9ce4fa72 EG	319	iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_2GHZ,
9ce4fa72 EG	320	tx_chains, rx_chains);
b1e1adfa JB	321
	322	sband = &data->bands[IEEE80211_BAND_5GHZ];
	323	sband->band = IEEE80211_BAND_5GHZ;
	324	sband->bitrates = &iwl_cfg80211_rates[RATES_52_OFFS];
	325	sband->n_bitrates = N_RATES_52;
	326	n_used += iwl_init_sband_channels(data, sband, n_channels,
	327	IEEE80211_BAND_5GHZ);
9ce4fa72 EG	328	iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_5GHZ,
9ce4fa72 EG	329	tx_chains, rx_chains);
bfc824b0 JB	330	if (enable_vht)
bfc824b0 JB	331	iwl_init_vht_hw_capab(cfg, data, &sband->vht_cap);
b1e1adfa JB	332
	333	if (n_channels != n_used)
	334	IWL_ERR_DEV(dev, "NVM: used only %d of %d channels\n",
	335	n_used, n_channels);
	336	}
	337
	338	struct iwl_nvm_data *
	339	iwl_parse_nvm_data(struct device dev, const struct iwl_cfg cfg,
	340	const __le16 nvm_hw, const __le16 nvm_sw,
9ce4fa72	341	const __le16 *nvm_calib, u8 tx_chains, u8 rx_chains)
b1e1adfa JB	342	{
	343	struct iwl_nvm_data *data;
	344	u8 hw_addr[ETH_ALEN];
	345	u16 radio_cfg, sku;
	346
	347	data = kzalloc(sizeof(*data) +
	348	sizeof(struct ieee80211_channel) * IWL_NUM_CHANNELS,
	349	GFP_KERNEL);
	350	if (!data)
	351	return NULL;
	352
	353	data->nvm_version = le16_to_cpup(nvm_sw + NVM_VERSION);
	354
	355	radio_cfg = le16_to_cpup(nvm_sw + RADIO_CFG);
	356	data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK(radio_cfg);
	357	data->radio_cfg_step = NVM_RF_CFG_STEP_MSK(radio_cfg);
	358	data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK(radio_cfg);
	359	data->radio_cfg_pnum = NVM_RF_CFG_PNUM_MSK(radio_cfg);
	360	data->valid_tx_ant = NVM_RF_CFG_TX_ANT_MSK(radio_cfg);
	361	data->valid_rx_ant = NVM_RF_CFG_RX_ANT_MSK(radio_cfg);
	362
	363	sku = le16_to_cpup(nvm_sw + SKU);
	364	data->sku_cap_band_24GHz_enable = sku & NVM_SKU_CAP_BAND_24GHZ;
	365	data->sku_cap_band_52GHz_enable = sku & NVM_SKU_CAP_BAND_52GHZ;
	366	data->sku_cap_11n_enable = sku & NVM_SKU_CAP_11N_ENABLE;
	367	if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
	368	data->sku_cap_11n_enable = false;
	369
	370	/* check overrides (some devices have wrong NVM) */
	371	if (cfg->valid_tx_ant)
	372	data->valid_tx_ant = cfg->valid_tx_ant;
	373	if (cfg->valid_rx_ant)
	374	data->valid_rx_ant = cfg->valid_rx_ant;
	375
	376	if (!data->valid_tx_ant \|\| !data->valid_rx_ant) {
	377	IWL_ERR_DEV(dev, "invalid antennas (0x%x, 0x%x)\n",
	378	data->valid_tx_ant, data->valid_rx_ant);
	379	kfree(data);
	380	return NULL;
	381	}
	382
	383	data->n_hw_addrs = le16_to_cpup(nvm_sw + N_HW_ADDRS);
	384
	385	data->xtal_calib[0] = *(nvm_calib + XTAL_CALIB);
	386	data->xtal_calib[1] = *(nvm_calib + XTAL_CALIB + 1);
	387
	388	/* The byte order is little endian 16 bit, meaning 214365 */
	389	memcpy(hw_addr, nvm_hw + HW_ADDR, ETH_ALEN);
	390	data->hw_addr[0] = hw_addr[1];
	391	data->hw_addr[1] = hw_addr[0];
	392	data->hw_addr[2] = hw_addr[3];
	393	data->hw_addr[3] = hw_addr[2];
	394	data->hw_addr[4] = hw_addr[5];
	395	data->hw_addr[5] = hw_addr[4];
	396
9ce4fa72 EG	397	iwl_init_sbands(dev, cfg, data, nvm_sw, sku & NVM_SKU_CAP_11AC_ENABLE,
9ce4fa72 EG	398	tx_chains, rx_chains);
b1e1adfa JB	399
	400	data->calib_version = 255; /* TODO:
	401	this value will prevent some checks from
	402	failing, we need to check if this
	403	field is still needed, and if it does,
	404	where is it in the NVM*/
	405
	406	return data;
	407	}
48e29340	408	IWL_EXPORT_SYMBOL(iwl_parse_nvm_data);