[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 - 2013 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 - 2013 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 bf_sts_cap = num_of_ant(data->valid_rx_ant) - 1;

	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 |
		       bf_sts_cap << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT |
		       7 << IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;

	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_of_ant(data->valid_rx_ant) == 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	*
	8	* Copyright(c) 2008 - 2013 Intel Corporation. All rights reserved.
	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	*
	33	* Copyright(c) 2005 - 2013 Intel Corporation. All rights reserved.
	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	{
48e6de61 ES	266	int bf_sts_cap = num_of_ant(data->valid_rx_ant) - 1;
48e6de61 ES	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 \|
48e6de61	273	bf_sts_cap << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT \|
33158fef EL	274	7 << IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;
	275
	276	if (iwlwifi_mod_params.amsdu_size_8K)
	277	vht_cap->cap \|= IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991;
	278
	279	vht_cap->vht_mcs.rx_mcs_map =
	280	cpu_to_le16(IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 \|
	281	IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 \|
	282	IEEE80211_VHT_MCS_NOT_SUPPORTED << 4 \|
	283	IEEE80211_VHT_MCS_NOT_SUPPORTED << 6 \|
	284	IEEE80211_VHT_MCS_NOT_SUPPORTED << 8 \|
	285	IEEE80211_VHT_MCS_NOT_SUPPORTED << 10 \|
	286	IEEE80211_VHT_MCS_NOT_SUPPORTED << 12 \|
	287	IEEE80211_VHT_MCS_NOT_SUPPORTED << 14);
	288
a7b8b2ca ES	289	if (num_of_ant(data->valid_rx_ant) == 1 \|\|
a7b8b2ca ES	290	cfg->rx_with_siso_diversity) {
33158fef EL	291	vht_cap->cap \|= IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN \|
	292	IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN;
	293	/* this works because NOT_SUPPORTED == 3 */
	294	vht_cap->vht_mcs.rx_mcs_map \|=
	295	cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << 2);
	296	}
	297
	298	vht_cap->vht_mcs.tx_mcs_map = vht_cap->vht_mcs.rx_mcs_map;
	299	}
	300
b1e1adfa	301	static void iwl_init_sbands(struct device dev, const struct iwl_cfg cfg,
bfc824b0	302	struct iwl_nvm_data data, const __le16 nvm_sw,
9ce4fa72	303	bool enable_vht, u8 tx_chains, u8 rx_chains)
b1e1adfa JB	304	{
	305	int n_channels = iwl_init_channel_map(dev, cfg, data,
	306	&nvm_sw[NVM_CHANNELS]);
	307	int n_used = 0;
	308	struct ieee80211_supported_band *sband;
	309
	310	sband = &data->bands[IEEE80211_BAND_2GHZ];
	311	sband->band = IEEE80211_BAND_2GHZ;
	312	sband->bitrates = &iwl_cfg80211_rates[RATES_24_OFFS];
	313	sband->n_bitrates = N_RATES_24;
	314	n_used += iwl_init_sband_channels(data, sband, n_channels,
	315	IEEE80211_BAND_2GHZ);
9ce4fa72 EG	316	iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_2GHZ,
9ce4fa72 EG	317	tx_chains, rx_chains);
b1e1adfa JB	318
	319	sband = &data->bands[IEEE80211_BAND_5GHZ];
	320	sband->band = IEEE80211_BAND_5GHZ;
	321	sband->bitrates = &iwl_cfg80211_rates[RATES_52_OFFS];
	322	sband->n_bitrates = N_RATES_52;
	323	n_used += iwl_init_sband_channels(data, sband, n_channels,
	324	IEEE80211_BAND_5GHZ);
9ce4fa72 EG	325	iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_5GHZ,
9ce4fa72 EG	326	tx_chains, rx_chains);
bfc824b0 JB	327	if (enable_vht)
bfc824b0 JB	328	iwl_init_vht_hw_capab(cfg, data, &sband->vht_cap);
b1e1adfa JB	329
	330	if (n_channels != n_used)
	331	IWL_ERR_DEV(dev, "NVM: used only %d of %d channels\n",
	332	n_used, n_channels);
	333	}
	334
	335	struct iwl_nvm_data *
	336	iwl_parse_nvm_data(struct device dev, const struct iwl_cfg cfg,
	337	const __le16 nvm_hw, const __le16 nvm_sw,
9ce4fa72	338	const __le16 *nvm_calib, u8 tx_chains, u8 rx_chains)
b1e1adfa JB	339	{
	340	struct iwl_nvm_data *data;
	341	u8 hw_addr[ETH_ALEN];
	342	u16 radio_cfg, sku;
	343
	344	data = kzalloc(sizeof(*data) +
	345	sizeof(struct ieee80211_channel) * IWL_NUM_CHANNELS,
	346	GFP_KERNEL);
	347	if (!data)
	348	return NULL;
	349
	350	data->nvm_version = le16_to_cpup(nvm_sw + NVM_VERSION);
	351
	352	radio_cfg = le16_to_cpup(nvm_sw + RADIO_CFG);
	353	data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK(radio_cfg);
	354	data->radio_cfg_step = NVM_RF_CFG_STEP_MSK(radio_cfg);
	355	data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK(radio_cfg);
	356	data->radio_cfg_pnum = NVM_RF_CFG_PNUM_MSK(radio_cfg);
	357	data->valid_tx_ant = NVM_RF_CFG_TX_ANT_MSK(radio_cfg);
	358	data->valid_rx_ant = NVM_RF_CFG_RX_ANT_MSK(radio_cfg);
	359
	360	sku = le16_to_cpup(nvm_sw + SKU);
	361	data->sku_cap_band_24GHz_enable = sku & NVM_SKU_CAP_BAND_24GHZ;
	362	data->sku_cap_band_52GHz_enable = sku & NVM_SKU_CAP_BAND_52GHZ;
	363	data->sku_cap_11n_enable = sku & NVM_SKU_CAP_11N_ENABLE;
	364	if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
	365	data->sku_cap_11n_enable = false;
	366
	367	/* check overrides (some devices have wrong NVM) */
	368	if (cfg->valid_tx_ant)
	369	data->valid_tx_ant = cfg->valid_tx_ant;
	370	if (cfg->valid_rx_ant)
	371	data->valid_rx_ant = cfg->valid_rx_ant;
	372
	373	if (!data->valid_tx_ant \|\| !data->valid_rx_ant) {
	374	IWL_ERR_DEV(dev, "invalid antennas (0x%x, 0x%x)\n",
	375	data->valid_tx_ant, data->valid_rx_ant);
	376	kfree(data);
	377	return NULL;
	378	}
	379
	380	data->n_hw_addrs = le16_to_cpup(nvm_sw + N_HW_ADDRS);
	381
	382	data->xtal_calib[0] = *(nvm_calib + XTAL_CALIB);
	383	data->xtal_calib[1] = *(nvm_calib + XTAL_CALIB + 1);
	384
	385	/* The byte order is little endian 16 bit, meaning 214365 */
	386	memcpy(hw_addr, nvm_hw + HW_ADDR, ETH_ALEN);
	387	data->hw_addr[0] = hw_addr[1];
	388	data->hw_addr[1] = hw_addr[0];
	389	data->hw_addr[2] = hw_addr[3];
	390	data->hw_addr[3] = hw_addr[2];
	391	data->hw_addr[4] = hw_addr[5];
	392	data->hw_addr[5] = hw_addr[4];
	393
9ce4fa72 EG	394	iwl_init_sbands(dev, cfg, data, nvm_sw, sku & NVM_SKU_CAP_11AC_ENABLE,
9ce4fa72 EG	395	tx_chains, rx_chains);
b1e1adfa JB	396
	397	data->calib_version = 255; /* TODO:
	398	this value will prevent some checks from
	399	failing, we need to check if this
	400	field is still needed, and if it does,
	401	where is it in the NVM*/
	402
	403	return data;
	404	}
48e29340	405	IWL_EXPORT_SYMBOL(iwl_parse_nvm_data);