Linux Audio

Check our new training course

Loading...
v6.8
  1// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
  2/*
  3 * Copyright (C) 2005-2014, 2018-2021, 2023 Intel Corporation
  4 * Copyright (C) 2015 Intel Mobile Communications GmbH
  5 */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  6#include <linux/types.h>
  7#include <linux/slab.h>
  8#include <linux/export.h>
  9#include "iwl-drv.h"
 10#include "iwl-modparams.h"
 11#include "iwl-eeprom-parse.h"
 12
 13#if IS_ENABLED(CONFIG_IWLDVM)
 14/* EEPROM offset definitions */
 15
 16/* indirect access definitions */
 17#define ADDRESS_MSK                 0x0000FFFF
 18#define INDIRECT_TYPE_MSK           0x000F0000
 19#define INDIRECT_HOST               0x00010000
 20#define INDIRECT_GENERAL            0x00020000
 21#define INDIRECT_REGULATORY         0x00030000
 22#define INDIRECT_CALIBRATION        0x00040000
 23#define INDIRECT_PROCESS_ADJST      0x00050000
 24#define INDIRECT_OTHERS             0x00060000
 25#define INDIRECT_TXP_LIMIT          0x00070000
 26#define INDIRECT_TXP_LIMIT_SIZE     0x00080000
 27#define INDIRECT_ADDRESS            0x00100000
 28
 29/* corresponding link offsets in EEPROM */
 30#define EEPROM_LINK_HOST             (2*0x64)
 31#define EEPROM_LINK_GENERAL          (2*0x65)
 32#define EEPROM_LINK_REGULATORY       (2*0x66)
 33#define EEPROM_LINK_CALIBRATION      (2*0x67)
 34#define EEPROM_LINK_PROCESS_ADJST    (2*0x68)
 35#define EEPROM_LINK_OTHERS           (2*0x69)
 36#define EEPROM_LINK_TXP_LIMIT        (2*0x6a)
 37#define EEPROM_LINK_TXP_LIMIT_SIZE   (2*0x6b)
 38
 39/* General */
 40#define EEPROM_DEVICE_ID                    (2*0x08)	/* 2 bytes */
 41#define EEPROM_SUBSYSTEM_ID		    (2*0x0A)	/* 2 bytes */
 42#define EEPROM_MAC_ADDRESS                  (2*0x15)	/* 6  bytes */
 43#define EEPROM_BOARD_REVISION               (2*0x35)	/* 2  bytes */
 44#define EEPROM_BOARD_PBA_NUMBER             (2*0x3B+1)	/* 9  bytes */
 45#define EEPROM_VERSION                      (2*0x44)	/* 2  bytes */
 46#define EEPROM_SKU_CAP                      (2*0x45)	/* 2  bytes */
 47#define EEPROM_OEM_MODE                     (2*0x46)	/* 2  bytes */
 48#define EEPROM_RADIO_CONFIG                 (2*0x48)	/* 2  bytes */
 49#define EEPROM_NUM_MAC_ADDRESS              (2*0x4C)	/* 2  bytes */
 50
 51/* calibration */
 52struct iwl_eeprom_calib_hdr {
 53	u8 version;
 54	u8 pa_type;
 55	__le16 voltage;
 56} __packed;
 57
 58#define EEPROM_CALIB_ALL	(INDIRECT_ADDRESS | INDIRECT_CALIBRATION)
 59#define EEPROM_XTAL		((2*0x128) | EEPROM_CALIB_ALL)
 60
 61/* temperature */
 62#define EEPROM_KELVIN_TEMPERATURE	((2*0x12A) | EEPROM_CALIB_ALL)
 63#define EEPROM_RAW_TEMPERATURE		((2*0x12B) | EEPROM_CALIB_ALL)
 64
 65/* SKU Capabilities (actual values from EEPROM definition) */
 66enum eeprom_sku_bits {
 67	EEPROM_SKU_CAP_BAND_24GHZ	= BIT(4),
 68	EEPROM_SKU_CAP_BAND_52GHZ	= BIT(5),
 69	EEPROM_SKU_CAP_11N_ENABLE	= BIT(6),
 70	EEPROM_SKU_CAP_AMT_ENABLE	= BIT(7),
 71	EEPROM_SKU_CAP_IPAN_ENABLE	= BIT(8)
 72};
 73
 74/* radio config bits (actual values from EEPROM definition) */
 75#define EEPROM_RF_CFG_TYPE_MSK(x)   (x & 0x3)         /* bits 0-1   */
 76#define EEPROM_RF_CFG_STEP_MSK(x)   ((x >> 2)  & 0x3) /* bits 2-3   */
 77#define EEPROM_RF_CFG_DASH_MSK(x)   ((x >> 4)  & 0x3) /* bits 4-5   */
 78#define EEPROM_RF_CFG_PNUM_MSK(x)   ((x >> 6)  & 0x3) /* bits 6-7   */
 79#define EEPROM_RF_CFG_TX_ANT_MSK(x) ((x >> 8)  & 0xF) /* bits 8-11  */
 80#define EEPROM_RF_CFG_RX_ANT_MSK(x) ((x >> 12) & 0xF) /* bits 12-15 */
 81
 82
 83/*
 84 * EEPROM bands
 85 * These are the channel numbers from each band in the order
 86 * that they are stored in the EEPROM band information. Note
 87 * that EEPROM bands aren't the same as mac80211 bands, and
 88 * there are even special "ht40 bands" in the EEPROM.
 89 */
 90static const u8 iwl_eeprom_band_1[14] = { /* 2.4 GHz */
 91	1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14
 92};
 93
 94static const u8 iwl_eeprom_band_2[] = {	/* 4915-5080MHz */
 95	183, 184, 185, 187, 188, 189, 192, 196, 7, 8, 11, 12, 16
 96};
 97
 98static const u8 iwl_eeprom_band_3[] = {	/* 5170-5320MHz */
 99	34, 36, 38, 40, 42, 44, 46, 48, 52, 56, 60, 64
100};
101
102static const u8 iwl_eeprom_band_4[] = {	/* 5500-5700MHz */
103	100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140
104};
105
106static const u8 iwl_eeprom_band_5[] = {	/* 5725-5825MHz */
107	145, 149, 153, 157, 161, 165
108};
109
110static const u8 iwl_eeprom_band_6[] = {	/* 2.4 ht40 channel */
111	1, 2, 3, 4, 5, 6, 7
112};
113
114static const u8 iwl_eeprom_band_7[] = {	/* 5.2 ht40 channel */
115	36, 44, 52, 60, 100, 108, 116, 124, 132, 149, 157
116};
117
118#define IWL_NUM_CHANNELS	(ARRAY_SIZE(iwl_eeprom_band_1) + \
119				 ARRAY_SIZE(iwl_eeprom_band_2) + \
120				 ARRAY_SIZE(iwl_eeprom_band_3) + \
121				 ARRAY_SIZE(iwl_eeprom_band_4) + \
122				 ARRAY_SIZE(iwl_eeprom_band_5))
123
124/* rate data (static) */
125static struct ieee80211_rate iwl_cfg80211_rates[] = {
126	{ .bitrate = 1 * 10, .hw_value = 0, .hw_value_short = 0, },
127	{ .bitrate = 2 * 10, .hw_value = 1, .hw_value_short = 1,
128	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
129	{ .bitrate = 5.5 * 10, .hw_value = 2, .hw_value_short = 2,
130	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
131	{ .bitrate = 11 * 10, .hw_value = 3, .hw_value_short = 3,
132	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
133	{ .bitrate = 6 * 10, .hw_value = 4, .hw_value_short = 4, },
134	{ .bitrate = 9 * 10, .hw_value = 5, .hw_value_short = 5, },
135	{ .bitrate = 12 * 10, .hw_value = 6, .hw_value_short = 6, },
136	{ .bitrate = 18 * 10, .hw_value = 7, .hw_value_short = 7, },
137	{ .bitrate = 24 * 10, .hw_value = 8, .hw_value_short = 8, },
138	{ .bitrate = 36 * 10, .hw_value = 9, .hw_value_short = 9, },
139	{ .bitrate = 48 * 10, .hw_value = 10, .hw_value_short = 10, },
140	{ .bitrate = 54 * 10, .hw_value = 11, .hw_value_short = 11, },
141};
142#define RATES_24_OFFS	0
143#define N_RATES_24	ARRAY_SIZE(iwl_cfg80211_rates)
144#define RATES_52_OFFS	4
145#define N_RATES_52	(N_RATES_24 - RATES_52_OFFS)
146
147/* EEPROM reading functions */
148
149static u16 iwl_eeprom_query16(const u8 *eeprom, size_t eeprom_size, int offset)
150{
151	if (WARN_ON(offset + sizeof(u16) > eeprom_size))
152		return 0;
153	return le16_to_cpup((__le16 *)(eeprom + offset));
154}
155
156static u32 eeprom_indirect_address(const u8 *eeprom, size_t eeprom_size,
157				   u32 address)
158{
159	u16 offset = 0;
160
161	if ((address & INDIRECT_ADDRESS) == 0)
162		return address;
163
164	switch (address & INDIRECT_TYPE_MSK) {
165	case INDIRECT_HOST:
166		offset = iwl_eeprom_query16(eeprom, eeprom_size,
167					    EEPROM_LINK_HOST);
168		break;
169	case INDIRECT_GENERAL:
170		offset = iwl_eeprom_query16(eeprom, eeprom_size,
171					    EEPROM_LINK_GENERAL);
172		break;
173	case INDIRECT_REGULATORY:
174		offset = iwl_eeprom_query16(eeprom, eeprom_size,
175					    EEPROM_LINK_REGULATORY);
176		break;
177	case INDIRECT_TXP_LIMIT:
178		offset = iwl_eeprom_query16(eeprom, eeprom_size,
179					    EEPROM_LINK_TXP_LIMIT);
180		break;
181	case INDIRECT_TXP_LIMIT_SIZE:
182		offset = iwl_eeprom_query16(eeprom, eeprom_size,
183					    EEPROM_LINK_TXP_LIMIT_SIZE);
184		break;
185	case INDIRECT_CALIBRATION:
186		offset = iwl_eeprom_query16(eeprom, eeprom_size,
187					    EEPROM_LINK_CALIBRATION);
188		break;
189	case INDIRECT_PROCESS_ADJST:
190		offset = iwl_eeprom_query16(eeprom, eeprom_size,
191					    EEPROM_LINK_PROCESS_ADJST);
192		break;
193	case INDIRECT_OTHERS:
194		offset = iwl_eeprom_query16(eeprom, eeprom_size,
195					    EEPROM_LINK_OTHERS);
196		break;
197	default:
198		WARN_ON(1);
199		break;
200	}
201
202	/* translate the offset from words to byte */
203	return (address & ADDRESS_MSK) + (offset << 1);
204}
205
206static const u8 *iwl_eeprom_query_addr(const u8 *eeprom, size_t eeprom_size,
207				       u32 offset)
208{
209	u32 address = eeprom_indirect_address(eeprom, eeprom_size, offset);
210
211	if (WARN_ON(address >= eeprom_size))
212		return NULL;
213
214	return &eeprom[address];
215}
216
217static int iwl_eeprom_read_calib(const u8 *eeprom, size_t eeprom_size,
218				 struct iwl_nvm_data *data)
219{
220	struct iwl_eeprom_calib_hdr *hdr;
221
222	hdr = (void *)iwl_eeprom_query_addr(eeprom, eeprom_size,
223					    EEPROM_CALIB_ALL);
224	if (!hdr)
225		return -ENODATA;
226	data->calib_version = hdr->version;
227	data->calib_voltage = hdr->voltage;
228
229	return 0;
230}
231
232/**
233 * enum iwl_eeprom_channel_flags - channel flags in EEPROM
234 * @EEPROM_CHANNEL_VALID: channel is usable for this SKU/geo
235 * @EEPROM_CHANNEL_IBSS: usable as an IBSS channel
236 * @EEPROM_CHANNEL_ACTIVE: active scanning allowed
237 * @EEPROM_CHANNEL_RADAR: radar detection required
238 * @EEPROM_CHANNEL_WIDE: 20 MHz channel okay (?)
239 * @EEPROM_CHANNEL_DFS: dynamic freq selection candidate
240 */
241enum iwl_eeprom_channel_flags {
242	EEPROM_CHANNEL_VALID = BIT(0),
243	EEPROM_CHANNEL_IBSS = BIT(1),
244	EEPROM_CHANNEL_ACTIVE = BIT(3),
245	EEPROM_CHANNEL_RADAR = BIT(4),
246	EEPROM_CHANNEL_WIDE = BIT(5),
247	EEPROM_CHANNEL_DFS = BIT(7),
248};
249
250/**
251 * struct iwl_eeprom_channel - EEPROM channel data
252 * @flags: %EEPROM_CHANNEL_* flags
253 * @max_power_avg: max power (in dBm) on this channel, at most 31 dBm
254 */
255struct iwl_eeprom_channel {
256	u8 flags;
257	s8 max_power_avg;
258} __packed;
259
260
261enum iwl_eeprom_enhanced_txpwr_flags {
262	IWL_EEPROM_ENH_TXP_FL_VALID = BIT(0),
263	IWL_EEPROM_ENH_TXP_FL_BAND_52G = BIT(1),
264	IWL_EEPROM_ENH_TXP_FL_OFDM = BIT(2),
265	IWL_EEPROM_ENH_TXP_FL_40MHZ = BIT(3),
266	IWL_EEPROM_ENH_TXP_FL_HT_AP = BIT(4),
267	IWL_EEPROM_ENH_TXP_FL_RES1 = BIT(5),
268	IWL_EEPROM_ENH_TXP_FL_RES2 = BIT(6),
269	IWL_EEPROM_ENH_TXP_FL_COMMON_TYPE = BIT(7),
270};
271
272/**
273 * struct iwl_eeprom_enhanced_txpwr
274 * @flags: entry flags
275 * @channel: channel number
276 * @chain_a_max: chain a max power in 1/2 dBm
277 * @chain_b_max: chain b max power in 1/2 dBm
278 * @chain_c_max: chain c max power in 1/2 dBm
279 * @delta_20_in_40: 20-in-40 deltas (hi/lo)
280 * @mimo2_max: mimo2 max power in 1/2 dBm
281 * @mimo3_max: mimo3 max power in 1/2 dBm
282 *
283 * This structure presents the enhanced regulatory tx power limit layout
284 * in an EEPROM image.
285 */
286struct iwl_eeprom_enhanced_txpwr {
287	u8 flags;
288	u8 channel;
289	s8 chain_a_max;
290	s8 chain_b_max;
291	s8 chain_c_max;
292	u8 delta_20_in_40;
293	s8 mimo2_max;
294	s8 mimo3_max;
295} __packed;
296
297static s8 iwl_get_max_txpwr_half_dbm(const struct iwl_nvm_data *data,
298				     struct iwl_eeprom_enhanced_txpwr *txp)
299{
300	s8 result = 0; /* (.5 dBm) */
301
302	/* Take the highest tx power from any valid chains */
303	if (data->valid_tx_ant & ANT_A && txp->chain_a_max > result)
304		result = txp->chain_a_max;
305
306	if (data->valid_tx_ant & ANT_B && txp->chain_b_max > result)
307		result = txp->chain_b_max;
308
309	if (data->valid_tx_ant & ANT_C && txp->chain_c_max > result)
310		result = txp->chain_c_max;
311
312	if ((data->valid_tx_ant == ANT_AB ||
313	     data->valid_tx_ant == ANT_BC ||
314	     data->valid_tx_ant == ANT_AC) && txp->mimo2_max > result)
315		result = txp->mimo2_max;
316
317	if (data->valid_tx_ant == ANT_ABC && txp->mimo3_max > result)
318		result = txp->mimo3_max;
319
320	return result;
321}
322
323#define EEPROM_TXP_OFFS	(0x00 | INDIRECT_ADDRESS | INDIRECT_TXP_LIMIT)
324#define EEPROM_TXP_ENTRY_LEN sizeof(struct iwl_eeprom_enhanced_txpwr)
325#define EEPROM_TXP_SZ_OFFS (0x00 | INDIRECT_ADDRESS | INDIRECT_TXP_LIMIT_SIZE)
326
327#define TXP_CHECK_AND_PRINT(x) \
328	((txp->flags & IWL_EEPROM_ENH_TXP_FL_##x) ? # x " " : "")
329
330static void
331iwl_eeprom_enh_txp_read_element(struct iwl_nvm_data *data,
332				struct iwl_eeprom_enhanced_txpwr *txp,
333				int n_channels, s8 max_txpower_avg)
334{
335	int ch_idx;
336	enum nl80211_band band;
337
338	band = txp->flags & IWL_EEPROM_ENH_TXP_FL_BAND_52G ?
339		NL80211_BAND_5GHZ : NL80211_BAND_2GHZ;
340
341	for (ch_idx = 0; ch_idx < n_channels; ch_idx++) {
342		struct ieee80211_channel *chan = &data->channels[ch_idx];
343
344		/* update matching channel or from common data only */
345		if (txp->channel != 0 && chan->hw_value != txp->channel)
346			continue;
347
348		/* update matching band only */
349		if (band != chan->band)
350			continue;
351
352		if (chan->max_power < max_txpower_avg &&
353		    !(txp->flags & IWL_EEPROM_ENH_TXP_FL_40MHZ))
354			chan->max_power = max_txpower_avg;
355	}
356}
357
358static void iwl_eeprom_enhanced_txpower(struct device *dev,
359					struct iwl_nvm_data *data,
360					const u8 *eeprom, size_t eeprom_size,
361					int n_channels)
362{
363	struct iwl_eeprom_enhanced_txpwr *txp_array, *txp;
364	int idx, entries;
365	__le16 *txp_len;
366	s8 max_txp_avg_halfdbm;
367
368	BUILD_BUG_ON(sizeof(struct iwl_eeprom_enhanced_txpwr) != 8);
369
370	/* the length is in 16-bit words, but we want entries */
371	txp_len = (__le16 *)iwl_eeprom_query_addr(eeprom, eeprom_size,
372						  EEPROM_TXP_SZ_OFFS);
373	entries = le16_to_cpup(txp_len) * 2 / EEPROM_TXP_ENTRY_LEN;
374
375	txp_array = (void *)iwl_eeprom_query_addr(eeprom, eeprom_size,
376						  EEPROM_TXP_OFFS);
377
378	for (idx = 0; idx < entries; idx++) {
379		txp = &txp_array[idx];
380		/* skip invalid entries */
381		if (!(txp->flags & IWL_EEPROM_ENH_TXP_FL_VALID))
382			continue;
383
384		IWL_DEBUG_EEPROM(dev, "%s %d:\t %s%s%s%s%s%s%s%s (0x%02x)\n",
385				 (txp->channel && (txp->flags &
386					IWL_EEPROM_ENH_TXP_FL_COMMON_TYPE)) ?
387					"Common " : (txp->channel) ?
388					"Channel" : "Common",
389				 (txp->channel),
390				 TXP_CHECK_AND_PRINT(VALID),
391				 TXP_CHECK_AND_PRINT(BAND_52G),
392				 TXP_CHECK_AND_PRINT(OFDM),
393				 TXP_CHECK_AND_PRINT(40MHZ),
394				 TXP_CHECK_AND_PRINT(HT_AP),
395				 TXP_CHECK_AND_PRINT(RES1),
396				 TXP_CHECK_AND_PRINT(RES2),
397				 TXP_CHECK_AND_PRINT(COMMON_TYPE),
398				 txp->flags);
399		IWL_DEBUG_EEPROM(dev,
400				 "\t\t chain_A: %d chain_B: %d chain_C: %d\n",
401				 txp->chain_a_max, txp->chain_b_max,
402				 txp->chain_c_max);
403		IWL_DEBUG_EEPROM(dev,
404				 "\t\t MIMO2: %d MIMO3: %d High 20_on_40: 0x%02x Low 20_on_40: 0x%02x\n",
405				 txp->mimo2_max, txp->mimo3_max,
406				 ((txp->delta_20_in_40 & 0xf0) >> 4),
407				 (txp->delta_20_in_40 & 0x0f));
408
409		max_txp_avg_halfdbm = iwl_get_max_txpwr_half_dbm(data, txp);
410
411		iwl_eeprom_enh_txp_read_element(data, txp, n_channels,
412				DIV_ROUND_UP(max_txp_avg_halfdbm, 2));
413
414		if (max_txp_avg_halfdbm > data->max_tx_pwr_half_dbm)
415			data->max_tx_pwr_half_dbm = max_txp_avg_halfdbm;
416	}
417}
418
419static void iwl_init_band_reference(const struct iwl_cfg *cfg,
420				    const u8 *eeprom, size_t eeprom_size,
421				    int eeprom_band, int *eeprom_ch_count,
422				    const struct iwl_eeprom_channel **ch_info,
423				    const u8 **eeprom_ch_array)
424{
425	u32 offset = cfg->eeprom_params->regulatory_bands[eeprom_band - 1];
426
427	offset |= INDIRECT_ADDRESS | INDIRECT_REGULATORY;
428
429	*ch_info = (void *)iwl_eeprom_query_addr(eeprom, eeprom_size, offset);
430
431	switch (eeprom_band) {
432	case 1:		/* 2.4GHz band */
433		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_1);
434		*eeprom_ch_array = iwl_eeprom_band_1;
435		break;
436	case 2:		/* 4.9GHz band */
437		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_2);
438		*eeprom_ch_array = iwl_eeprom_band_2;
439		break;
440	case 3:		/* 5.2GHz band */
441		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_3);
442		*eeprom_ch_array = iwl_eeprom_band_3;
443		break;
444	case 4:		/* 5.5GHz band */
445		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_4);
446		*eeprom_ch_array = iwl_eeprom_band_4;
447		break;
448	case 5:		/* 5.7GHz band */
449		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_5);
450		*eeprom_ch_array = iwl_eeprom_band_5;
451		break;
452	case 6:		/* 2.4GHz ht40 channels */
453		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_6);
454		*eeprom_ch_array = iwl_eeprom_band_6;
455		break;
456	case 7:		/* 5 GHz ht40 channels */
457		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_7);
458		*eeprom_ch_array = iwl_eeprom_band_7;
459		break;
460	default:
461		*eeprom_ch_count = 0;
462		*eeprom_ch_array = NULL;
463		WARN_ON(1);
464	}
465}
466
467#define CHECK_AND_PRINT(x) \
468	((eeprom_ch->flags & EEPROM_CHANNEL_##x) ? # x " " : "")
469
470static void iwl_mod_ht40_chan_info(struct device *dev,
471				   struct iwl_nvm_data *data, int n_channels,
472				   enum nl80211_band band, u16 channel,
473				   const struct iwl_eeprom_channel *eeprom_ch,
474				   u8 clear_ht40_extension_channel)
475{
476	struct ieee80211_channel *chan = NULL;
477	int i;
478
479	for (i = 0; i < n_channels; i++) {
480		if (data->channels[i].band != band)
481			continue;
482		if (data->channels[i].hw_value != channel)
483			continue;
484		chan = &data->channels[i];
485		break;
486	}
487
488	if (!chan)
489		return;
490
491	IWL_DEBUG_EEPROM(dev,
492			 "HT40 Ch. %d [%sGHz] %s%s%s%s%s(0x%02x %ddBm): Ad-Hoc %ssupported\n",
493			 channel,
494			 band == NL80211_BAND_5GHZ ? "5.2" : "2.4",
495			 CHECK_AND_PRINT(IBSS),
496			 CHECK_AND_PRINT(ACTIVE),
497			 CHECK_AND_PRINT(RADAR),
498			 CHECK_AND_PRINT(WIDE),
499			 CHECK_AND_PRINT(DFS),
500			 eeprom_ch->flags,
501			 eeprom_ch->max_power_avg,
502			 ((eeprom_ch->flags & EEPROM_CHANNEL_IBSS) &&
503			  !(eeprom_ch->flags & EEPROM_CHANNEL_RADAR)) ? ""
504								      : "not ");
505
506	if (eeprom_ch->flags & EEPROM_CHANNEL_VALID)
507		chan->flags &= ~clear_ht40_extension_channel;
508}
509
510#define CHECK_AND_PRINT_I(x)	\
511	((eeprom_ch_info[ch_idx].flags & EEPROM_CHANNEL_##x) ? # x " " : "")
512
513static int iwl_init_channel_map(struct device *dev, const struct iwl_cfg *cfg,
514				struct iwl_nvm_data *data,
515				const u8 *eeprom, size_t eeprom_size)
516{
517	int band, ch_idx;
518	const struct iwl_eeprom_channel *eeprom_ch_info;
519	const u8 *eeprom_ch_array;
520	int eeprom_ch_count;
521	int n_channels = 0;
522
523	/*
524	 * Loop through the 5 EEPROM bands and add them to the parse list
525	 */
526	for (band = 1; band <= 5; band++) {
527		struct ieee80211_channel *channel;
528
529		iwl_init_band_reference(cfg, eeprom, eeprom_size, band,
530					&eeprom_ch_count, &eeprom_ch_info,
531					&eeprom_ch_array);
532
533		/* Loop through each band adding each of the channels */
534		for (ch_idx = 0; ch_idx < eeprom_ch_count; ch_idx++) {
535			const struct iwl_eeprom_channel *eeprom_ch;
536
537			eeprom_ch = &eeprom_ch_info[ch_idx];
538
539			if (!(eeprom_ch->flags & EEPROM_CHANNEL_VALID)) {
540				IWL_DEBUG_EEPROM(dev,
541						 "Ch. %d Flags %x [%sGHz] - No traffic\n",
542						 eeprom_ch_array[ch_idx],
543						 eeprom_ch_info[ch_idx].flags,
544						 (band != 1) ? "5.2" : "2.4");
545				continue;
546			}
547
548			channel = &data->channels[n_channels];
549			n_channels++;
550
551			channel->hw_value = eeprom_ch_array[ch_idx];
552			channel->band = (band == 1) ? NL80211_BAND_2GHZ
553						    : NL80211_BAND_5GHZ;
554			channel->center_freq =
555				ieee80211_channel_to_frequency(
556					channel->hw_value, channel->band);
557
558			/* set no-HT40, will enable as appropriate later */
559			channel->flags = IEEE80211_CHAN_NO_HT40;
560
561			if (!(eeprom_ch->flags & EEPROM_CHANNEL_IBSS))
562				channel->flags |= IEEE80211_CHAN_NO_IR;
563
564			if (!(eeprom_ch->flags & EEPROM_CHANNEL_ACTIVE))
565				channel->flags |= IEEE80211_CHAN_NO_IR;
566
567			if (eeprom_ch->flags & EEPROM_CHANNEL_RADAR)
568				channel->flags |= IEEE80211_CHAN_RADAR;
569
570			/* Initialize regulatory-based run-time data */
571			channel->max_power =
572				eeprom_ch_info[ch_idx].max_power_avg;
573			IWL_DEBUG_EEPROM(dev,
574					 "Ch. %d [%sGHz] %s%s%s%s%s%s(0x%02x %ddBm): Ad-Hoc %ssupported\n",
575					 channel->hw_value,
576					 (band != 1) ? "5.2" : "2.4",
577					 CHECK_AND_PRINT_I(VALID),
578					 CHECK_AND_PRINT_I(IBSS),
579					 CHECK_AND_PRINT_I(ACTIVE),
580					 CHECK_AND_PRINT_I(RADAR),
581					 CHECK_AND_PRINT_I(WIDE),
582					 CHECK_AND_PRINT_I(DFS),
583					 eeprom_ch_info[ch_idx].flags,
584					 eeprom_ch_info[ch_idx].max_power_avg,
585					 ((eeprom_ch_info[ch_idx].flags &
586							EEPROM_CHANNEL_IBSS) &&
587					  !(eeprom_ch_info[ch_idx].flags &
588							EEPROM_CHANNEL_RADAR))
589						? "" : "not ");
590		}
591	}
592
593	if (cfg->eeprom_params->enhanced_txpower) {
594		/*
595		 * for newer device (6000 series and up)
596		 * EEPROM contain enhanced tx power information
597		 * driver need to process addition information
598		 * to determine the max channel tx power limits
599		 */
600		iwl_eeprom_enhanced_txpower(dev, data, eeprom, eeprom_size,
601					    n_channels);
602	} else {
603		/* All others use data from channel map */
604		int i;
605
606		data->max_tx_pwr_half_dbm = -128;
607
608		for (i = 0; i < n_channels; i++)
609			data->max_tx_pwr_half_dbm =
610				max_t(s8, data->max_tx_pwr_half_dbm,
611				      data->channels[i].max_power * 2);
612	}
613
614	/* Check if we do have HT40 channels */
615	if (cfg->eeprom_params->regulatory_bands[5] ==
616				EEPROM_REGULATORY_BAND_NO_HT40 &&
617	    cfg->eeprom_params->regulatory_bands[6] ==
618				EEPROM_REGULATORY_BAND_NO_HT40)
619		return n_channels;
620
621	/* Two additional EEPROM bands for 2.4 and 5 GHz HT40 channels */
622	for (band = 6; band <= 7; band++) {
623		enum nl80211_band ieeeband;
624
625		iwl_init_band_reference(cfg, eeprom, eeprom_size, band,
626					&eeprom_ch_count, &eeprom_ch_info,
627					&eeprom_ch_array);
628
629		/* EEPROM band 6 is 2.4, band 7 is 5 GHz */
630		ieeeband = (band == 6) ? NL80211_BAND_2GHZ
631				       : NL80211_BAND_5GHZ;
632
633		/* Loop through each band adding each of the channels */
634		for (ch_idx = 0; ch_idx < eeprom_ch_count; ch_idx++) {
635			/* Set up driver's info for lower half */
636			iwl_mod_ht40_chan_info(dev, data, n_channels, ieeeband,
637					       eeprom_ch_array[ch_idx],
638					       &eeprom_ch_info[ch_idx],
639					       IEEE80211_CHAN_NO_HT40PLUS);
640
641			/* Set up driver's info for upper half */
642			iwl_mod_ht40_chan_info(dev, data, n_channels, ieeeband,
643					       eeprom_ch_array[ch_idx] + 4,
644					       &eeprom_ch_info[ch_idx],
645					       IEEE80211_CHAN_NO_HT40MINUS);
646		}
647	}
648
649	return n_channels;
650}
651#endif
652
653int iwl_init_sband_channels(struct iwl_nvm_data *data,
654			    struct ieee80211_supported_band *sband,
655			    int n_channels, enum nl80211_band band)
656{
657	struct ieee80211_channel *chan = &data->channels[0];
658	int n = 0, idx = 0;
659
660	while (idx < n_channels && chan->band != band)
661		chan = &data->channels[++idx];
662
663	sband->channels = &data->channels[idx];
664
665	while (idx < n_channels && chan->band == band) {
666		chan = &data->channels[++idx];
667		n++;
668	}
669
670	sband->n_channels = n;
671
672	return n;
673}
674
675#define MAX_BIT_RATE_40_MHZ	150 /* Mbps */
676#define MAX_BIT_RATE_20_MHZ	72 /* Mbps */
677
678void iwl_init_ht_hw_capab(struct iwl_trans *trans,
679			  struct iwl_nvm_data *data,
680			  struct ieee80211_sta_ht_cap *ht_info,
681			  enum nl80211_band band,
682			  u8 tx_chains, u8 rx_chains)
683{
684	const struct iwl_cfg *cfg = trans->cfg;
685	int max_bit_rate = 0;
686
687	tx_chains = hweight8(tx_chains);
688	if (cfg->rx_with_siso_diversity)
689		rx_chains = 1;
690	else
691		rx_chains = hweight8(rx_chains);
692
693	if (!(data->sku_cap_11n_enable) ||
694	    (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL) ||
695	    !cfg->ht_params) {
696		ht_info->ht_supported = false;
697		return;
698	}
699
700	if (data->sku_cap_mimo_disabled)
701		rx_chains = 1;
702
703	ht_info->ht_supported = true;
704	ht_info->cap = IEEE80211_HT_CAP_DSSSCCK40;
705
706	if (cfg->ht_params->stbc) {
707		ht_info->cap |= (1 << IEEE80211_HT_CAP_RX_STBC_SHIFT);
708
709		if (tx_chains > 1)
710			ht_info->cap |= IEEE80211_HT_CAP_TX_STBC;
711	}
712
713	if (cfg->ht_params->ldpc)
714		ht_info->cap |= IEEE80211_HT_CAP_LDPC_CODING;
715
716	if (trans->trans_cfg->mq_rx_supported ||
717	    iwlwifi_mod_params.amsdu_size >= IWL_AMSDU_8K)
 
718		ht_info->cap |= IEEE80211_HT_CAP_MAX_AMSDU;
719
720	ht_info->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K;
721	ht_info->ampdu_density = IEEE80211_HT_MPDU_DENSITY_4;
722
723	ht_info->mcs.rx_mask[0] = 0xFF;
724	ht_info->mcs.rx_mask[1] = 0x00;
725	ht_info->mcs.rx_mask[2] = 0x00;
726
727	if (rx_chains >= 2)
728		ht_info->mcs.rx_mask[1] = 0xFF;
729	if (rx_chains >= 3)
730		ht_info->mcs.rx_mask[2] = 0xFF;
731
732	if (cfg->ht_params->ht_greenfield_support)
733		ht_info->cap |= IEEE80211_HT_CAP_GRN_FLD;
734	ht_info->cap |= IEEE80211_HT_CAP_SGI_20;
735
736	max_bit_rate = MAX_BIT_RATE_20_MHZ;
737
738	if (cfg->ht_params->ht40_bands & BIT(band)) {
739		ht_info->cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40;
740		ht_info->cap |= IEEE80211_HT_CAP_SGI_40;
741		max_bit_rate = MAX_BIT_RATE_40_MHZ;
742	}
743
744	/* Highest supported Rx data rate */
745	max_bit_rate *= rx_chains;
746	WARN_ON(max_bit_rate & ~IEEE80211_HT_MCS_RX_HIGHEST_MASK);
747	ht_info->mcs.rx_highest = cpu_to_le16(max_bit_rate);
748
749	/* Tx MCS capabilities */
750	ht_info->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
751	if (tx_chains != rx_chains) {
752		ht_info->mcs.tx_params |= IEEE80211_HT_MCS_TX_RX_DIFF;
753		ht_info->mcs.tx_params |= ((tx_chains - 1) <<
754				IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT);
755	}
756}
757
758#if IS_ENABLED(CONFIG_IWLDVM)
759static void iwl_init_sbands(struct iwl_trans *trans, const struct iwl_cfg *cfg,
760			    struct iwl_nvm_data *data,
761			    const u8 *eeprom, size_t eeprom_size)
762{
763	struct device *dev = trans->dev;
764	int n_channels = iwl_init_channel_map(dev, cfg, data,
765					      eeprom, eeprom_size);
766	int n_used = 0;
767	struct ieee80211_supported_band *sband;
768
769	sband = &data->bands[NL80211_BAND_2GHZ];
770	sband->band = NL80211_BAND_2GHZ;
771	sband->bitrates = &iwl_cfg80211_rates[RATES_24_OFFS];
772	sband->n_bitrates = N_RATES_24;
773	n_used += iwl_init_sband_channels(data, sband, n_channels,
774					  NL80211_BAND_2GHZ);
775	iwl_init_ht_hw_capab(trans, data, &sband->ht_cap, NL80211_BAND_2GHZ,
776			     data->valid_tx_ant, data->valid_rx_ant);
777
778	sband = &data->bands[NL80211_BAND_5GHZ];
779	sband->band = NL80211_BAND_5GHZ;
780	sband->bitrates = &iwl_cfg80211_rates[RATES_52_OFFS];
781	sband->n_bitrates = N_RATES_52;
782	n_used += iwl_init_sband_channels(data, sband, n_channels,
783					  NL80211_BAND_5GHZ);
784	iwl_init_ht_hw_capab(trans, data, &sband->ht_cap, NL80211_BAND_5GHZ,
785			     data->valid_tx_ant, data->valid_rx_ant);
786
787	if (n_channels != n_used)
788		IWL_ERR_DEV(dev, "EEPROM: used only %d of %d channels\n",
789			    n_used, n_channels);
790}
791
792/* EEPROM data functions */
793
794struct iwl_nvm_data *
795iwl_parse_eeprom_data(struct iwl_trans *trans, const struct iwl_cfg *cfg,
796		      const u8 *eeprom, size_t eeprom_size)
797{
798	struct iwl_nvm_data *data;
799	struct device *dev = trans->dev;
800	const void *tmp;
801	u16 radio_cfg, sku;
802
803	if (WARN_ON(!cfg || !cfg->eeprom_params))
804		return NULL;
805
806	data = kzalloc(struct_size(data, channels, IWL_NUM_CHANNELS),
807		       GFP_KERNEL);
808	if (!data)
809		return NULL;
810
811	/* get MAC address(es) */
812	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size, EEPROM_MAC_ADDRESS);
813	if (!tmp)
814		goto err_free;
815	memcpy(data->hw_addr, tmp, ETH_ALEN);
816	data->n_hw_addrs = iwl_eeprom_query16(eeprom, eeprom_size,
817					      EEPROM_NUM_MAC_ADDRESS);
818
819	if (iwl_eeprom_read_calib(eeprom, eeprom_size, data))
820		goto err_free;
821
822	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size, EEPROM_XTAL);
823	if (!tmp)
824		goto err_free;
825	memcpy(data->xtal_calib, tmp, sizeof(data->xtal_calib));
826
827	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size,
828				    EEPROM_RAW_TEMPERATURE);
829	if (!tmp)
830		goto err_free;
831	data->raw_temperature = *(__le16 *)tmp;
832
833	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size,
834				    EEPROM_KELVIN_TEMPERATURE);
835	if (!tmp)
836		goto err_free;
837	data->kelvin_temperature = *(__le16 *)tmp;
838	data->kelvin_voltage = *((__le16 *)tmp + 1);
839
840	radio_cfg = iwl_eeprom_query16(eeprom, eeprom_size,
841					     EEPROM_RADIO_CONFIG);
842	data->radio_cfg_dash = EEPROM_RF_CFG_DASH_MSK(radio_cfg);
843	data->radio_cfg_pnum = EEPROM_RF_CFG_PNUM_MSK(radio_cfg);
844	data->radio_cfg_step = EEPROM_RF_CFG_STEP_MSK(radio_cfg);
845	data->radio_cfg_type = EEPROM_RF_CFG_TYPE_MSK(radio_cfg);
846	data->valid_rx_ant = EEPROM_RF_CFG_RX_ANT_MSK(radio_cfg);
847	data->valid_tx_ant = EEPROM_RF_CFG_TX_ANT_MSK(radio_cfg);
848
849	sku = iwl_eeprom_query16(eeprom, eeprom_size,
850				 EEPROM_SKU_CAP);
851	data->sku_cap_11n_enable = sku & EEPROM_SKU_CAP_11N_ENABLE;
852	data->sku_cap_amt_enable = sku & EEPROM_SKU_CAP_AMT_ENABLE;
853	data->sku_cap_band_24ghz_enable = sku & EEPROM_SKU_CAP_BAND_24GHZ;
854	data->sku_cap_band_52ghz_enable = sku & EEPROM_SKU_CAP_BAND_52GHZ;
855	data->sku_cap_ipan_enable = sku & EEPROM_SKU_CAP_IPAN_ENABLE;
856	if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
857		data->sku_cap_11n_enable = false;
858
859	data->nvm_version = iwl_eeprom_query16(eeprom, eeprom_size,
860					       EEPROM_VERSION);
861
862	/* check overrides (some devices have wrong EEPROM) */
863	if (cfg->valid_tx_ant)
864		data->valid_tx_ant = cfg->valid_tx_ant;
865	if (cfg->valid_rx_ant)
866		data->valid_rx_ant = cfg->valid_rx_ant;
867
868	if (!data->valid_tx_ant || !data->valid_rx_ant) {
869		IWL_ERR_DEV(dev, "invalid antennas (0x%x, 0x%x)\n",
870			    data->valid_tx_ant, data->valid_rx_ant);
871		goto err_free;
872	}
873
874	iwl_init_sbands(trans, cfg, data, eeprom, eeprom_size);
875
876	return data;
877 err_free:
878	kfree(data);
879	return NULL;
880}
881IWL_EXPORT_SYMBOL(iwl_parse_eeprom_data);
882#endif
v5.9
  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) 2015 Intel Mobile Communications GmbH
 10 * Copyright(c) 2018 - 2019 Intel Corporation
 11 *
 12 * This program is free software; you can redistribute it and/or modify
 13 * it under the terms of version 2 of the GNU General Public License as
 14 * published by the Free Software Foundation.
 15 *
 16 * This program is distributed in the hope that it will be useful, but
 17 * WITHOUT ANY WARRANTY; without even the implied warranty of
 18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 19 * General Public License for more details.
 20 *
 21 * The full GNU General Public License is included in this distribution
 22 * in the file called COPYING.
 23 *
 24 * Contact Information:
 25 *  Intel Linux Wireless <linuxwifi@intel.com>
 26 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 27 *
 28 * BSD LICENSE
 29 *
 30 * Copyright(c) 2005 - 2014 Intel Corporation. All rights reserved.
 31 * Copyright(c) 2015 Intel Mobile Communications GmbH
 32 * Copyright(c) 2018 - 2019 Intel Corporation
 33 * All rights reserved.
 34 *
 35 * Redistribution and use in source and binary forms, with or without
 36 * modification, are permitted provided that the following conditions
 37 * are met:
 38 *
 39 *  * Redistributions of source code must retain the above copyright
 40 *    notice, this list of conditions and the following disclaimer.
 41 *  * Redistributions in binary form must reproduce the above copyright
 42 *    notice, this list of conditions and the following disclaimer in
 43 *    the documentation and/or other materials provided with the
 44 *    distribution.
 45 *  * Neither the name Intel Corporation nor the names of its
 46 *    contributors may be used to endorse or promote products derived
 47 *    from this software without specific prior written permission.
 48 *
 49 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 50 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 51 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 52 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 53 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 54 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 55 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 56 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 57 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 58 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 59 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 60 *****************************************************************************/
 61#include <linux/types.h>
 62#include <linux/slab.h>
 63#include <linux/export.h>
 64#include "iwl-drv.h"
 65#include "iwl-modparams.h"
 66#include "iwl-eeprom-parse.h"
 67
 
 68/* EEPROM offset definitions */
 69
 70/* indirect access definitions */
 71#define ADDRESS_MSK                 0x0000FFFF
 72#define INDIRECT_TYPE_MSK           0x000F0000
 73#define INDIRECT_HOST               0x00010000
 74#define INDIRECT_GENERAL            0x00020000
 75#define INDIRECT_REGULATORY         0x00030000
 76#define INDIRECT_CALIBRATION        0x00040000
 77#define INDIRECT_PROCESS_ADJST      0x00050000
 78#define INDIRECT_OTHERS             0x00060000
 79#define INDIRECT_TXP_LIMIT          0x00070000
 80#define INDIRECT_TXP_LIMIT_SIZE     0x00080000
 81#define INDIRECT_ADDRESS            0x00100000
 82
 83/* corresponding link offsets in EEPROM */
 84#define EEPROM_LINK_HOST             (2*0x64)
 85#define EEPROM_LINK_GENERAL          (2*0x65)
 86#define EEPROM_LINK_REGULATORY       (2*0x66)
 87#define EEPROM_LINK_CALIBRATION      (2*0x67)
 88#define EEPROM_LINK_PROCESS_ADJST    (2*0x68)
 89#define EEPROM_LINK_OTHERS           (2*0x69)
 90#define EEPROM_LINK_TXP_LIMIT        (2*0x6a)
 91#define EEPROM_LINK_TXP_LIMIT_SIZE   (2*0x6b)
 92
 93/* General */
 94#define EEPROM_DEVICE_ID                    (2*0x08)	/* 2 bytes */
 95#define EEPROM_SUBSYSTEM_ID		    (2*0x0A)	/* 2 bytes */
 96#define EEPROM_MAC_ADDRESS                  (2*0x15)	/* 6  bytes */
 97#define EEPROM_BOARD_REVISION               (2*0x35)	/* 2  bytes */
 98#define EEPROM_BOARD_PBA_NUMBER             (2*0x3B+1)	/* 9  bytes */
 99#define EEPROM_VERSION                      (2*0x44)	/* 2  bytes */
100#define EEPROM_SKU_CAP                      (2*0x45)	/* 2  bytes */
101#define EEPROM_OEM_MODE                     (2*0x46)	/* 2  bytes */
102#define EEPROM_RADIO_CONFIG                 (2*0x48)	/* 2  bytes */
103#define EEPROM_NUM_MAC_ADDRESS              (2*0x4C)	/* 2  bytes */
104
105/* calibration */
106struct iwl_eeprom_calib_hdr {
107	u8 version;
108	u8 pa_type;
109	__le16 voltage;
110} __packed;
111
112#define EEPROM_CALIB_ALL	(INDIRECT_ADDRESS | INDIRECT_CALIBRATION)
113#define EEPROM_XTAL		((2*0x128) | EEPROM_CALIB_ALL)
114
115/* temperature */
116#define EEPROM_KELVIN_TEMPERATURE	((2*0x12A) | EEPROM_CALIB_ALL)
117#define EEPROM_RAW_TEMPERATURE		((2*0x12B) | EEPROM_CALIB_ALL)
118
119/* SKU Capabilities (actual values from EEPROM definition) */
120enum eeprom_sku_bits {
121	EEPROM_SKU_CAP_BAND_24GHZ	= BIT(4),
122	EEPROM_SKU_CAP_BAND_52GHZ	= BIT(5),
123	EEPROM_SKU_CAP_11N_ENABLE	= BIT(6),
124	EEPROM_SKU_CAP_AMT_ENABLE	= BIT(7),
125	EEPROM_SKU_CAP_IPAN_ENABLE	= BIT(8)
126};
127
128/* radio config bits (actual values from EEPROM definition) */
129#define EEPROM_RF_CFG_TYPE_MSK(x)   (x & 0x3)         /* bits 0-1   */
130#define EEPROM_RF_CFG_STEP_MSK(x)   ((x >> 2)  & 0x3) /* bits 2-3   */
131#define EEPROM_RF_CFG_DASH_MSK(x)   ((x >> 4)  & 0x3) /* bits 4-5   */
132#define EEPROM_RF_CFG_PNUM_MSK(x)   ((x >> 6)  & 0x3) /* bits 6-7   */
133#define EEPROM_RF_CFG_TX_ANT_MSK(x) ((x >> 8)  & 0xF) /* bits 8-11  */
134#define EEPROM_RF_CFG_RX_ANT_MSK(x) ((x >> 12) & 0xF) /* bits 12-15 */
135
136
137/*
138 * EEPROM bands
139 * These are the channel numbers from each band in the order
140 * that they are stored in the EEPROM band information. Note
141 * that EEPROM bands aren't the same as mac80211 bands, and
142 * there are even special "ht40 bands" in the EEPROM.
143 */
144static const u8 iwl_eeprom_band_1[14] = { /* 2.4 GHz */
145	1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14
146};
147
148static const u8 iwl_eeprom_band_2[] = {	/* 4915-5080MHz */
149	183, 184, 185, 187, 188, 189, 192, 196, 7, 8, 11, 12, 16
150};
151
152static const u8 iwl_eeprom_band_3[] = {	/* 5170-5320MHz */
153	34, 36, 38, 40, 42, 44, 46, 48, 52, 56, 60, 64
154};
155
156static const u8 iwl_eeprom_band_4[] = {	/* 5500-5700MHz */
157	100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140
158};
159
160static const u8 iwl_eeprom_band_5[] = {	/* 5725-5825MHz */
161	145, 149, 153, 157, 161, 165
162};
163
164static const u8 iwl_eeprom_band_6[] = {	/* 2.4 ht40 channel */
165	1, 2, 3, 4, 5, 6, 7
166};
167
168static const u8 iwl_eeprom_band_7[] = {	/* 5.2 ht40 channel */
169	36, 44, 52, 60, 100, 108, 116, 124, 132, 149, 157
170};
171
172#define IWL_NUM_CHANNELS	(ARRAY_SIZE(iwl_eeprom_band_1) + \
173				 ARRAY_SIZE(iwl_eeprom_band_2) + \
174				 ARRAY_SIZE(iwl_eeprom_band_3) + \
175				 ARRAY_SIZE(iwl_eeprom_band_4) + \
176				 ARRAY_SIZE(iwl_eeprom_band_5))
177
178/* rate data (static) */
179static struct ieee80211_rate iwl_cfg80211_rates[] = {
180	{ .bitrate = 1 * 10, .hw_value = 0, .hw_value_short = 0, },
181	{ .bitrate = 2 * 10, .hw_value = 1, .hw_value_short = 1,
182	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
183	{ .bitrate = 5.5 * 10, .hw_value = 2, .hw_value_short = 2,
184	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
185	{ .bitrate = 11 * 10, .hw_value = 3, .hw_value_short = 3,
186	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
187	{ .bitrate = 6 * 10, .hw_value = 4, .hw_value_short = 4, },
188	{ .bitrate = 9 * 10, .hw_value = 5, .hw_value_short = 5, },
189	{ .bitrate = 12 * 10, .hw_value = 6, .hw_value_short = 6, },
190	{ .bitrate = 18 * 10, .hw_value = 7, .hw_value_short = 7, },
191	{ .bitrate = 24 * 10, .hw_value = 8, .hw_value_short = 8, },
192	{ .bitrate = 36 * 10, .hw_value = 9, .hw_value_short = 9, },
193	{ .bitrate = 48 * 10, .hw_value = 10, .hw_value_short = 10, },
194	{ .bitrate = 54 * 10, .hw_value = 11, .hw_value_short = 11, },
195};
196#define RATES_24_OFFS	0
197#define N_RATES_24	ARRAY_SIZE(iwl_cfg80211_rates)
198#define RATES_52_OFFS	4
199#define N_RATES_52	(N_RATES_24 - RATES_52_OFFS)
200
201/* EEPROM reading functions */
202
203static u16 iwl_eeprom_query16(const u8 *eeprom, size_t eeprom_size, int offset)
204{
205	if (WARN_ON(offset + sizeof(u16) > eeprom_size))
206		return 0;
207	return le16_to_cpup((__le16 *)(eeprom + offset));
208}
209
210static u32 eeprom_indirect_address(const u8 *eeprom, size_t eeprom_size,
211				   u32 address)
212{
213	u16 offset = 0;
214
215	if ((address & INDIRECT_ADDRESS) == 0)
216		return address;
217
218	switch (address & INDIRECT_TYPE_MSK) {
219	case INDIRECT_HOST:
220		offset = iwl_eeprom_query16(eeprom, eeprom_size,
221					    EEPROM_LINK_HOST);
222		break;
223	case INDIRECT_GENERAL:
224		offset = iwl_eeprom_query16(eeprom, eeprom_size,
225					    EEPROM_LINK_GENERAL);
226		break;
227	case INDIRECT_REGULATORY:
228		offset = iwl_eeprom_query16(eeprom, eeprom_size,
229					    EEPROM_LINK_REGULATORY);
230		break;
231	case INDIRECT_TXP_LIMIT:
232		offset = iwl_eeprom_query16(eeprom, eeprom_size,
233					    EEPROM_LINK_TXP_LIMIT);
234		break;
235	case INDIRECT_TXP_LIMIT_SIZE:
236		offset = iwl_eeprom_query16(eeprom, eeprom_size,
237					    EEPROM_LINK_TXP_LIMIT_SIZE);
238		break;
239	case INDIRECT_CALIBRATION:
240		offset = iwl_eeprom_query16(eeprom, eeprom_size,
241					    EEPROM_LINK_CALIBRATION);
242		break;
243	case INDIRECT_PROCESS_ADJST:
244		offset = iwl_eeprom_query16(eeprom, eeprom_size,
245					    EEPROM_LINK_PROCESS_ADJST);
246		break;
247	case INDIRECT_OTHERS:
248		offset = iwl_eeprom_query16(eeprom, eeprom_size,
249					    EEPROM_LINK_OTHERS);
250		break;
251	default:
252		WARN_ON(1);
253		break;
254	}
255
256	/* translate the offset from words to byte */
257	return (address & ADDRESS_MSK) + (offset << 1);
258}
259
260static const u8 *iwl_eeprom_query_addr(const u8 *eeprom, size_t eeprom_size,
261				       u32 offset)
262{
263	u32 address = eeprom_indirect_address(eeprom, eeprom_size, offset);
264
265	if (WARN_ON(address >= eeprom_size))
266		return NULL;
267
268	return &eeprom[address];
269}
270
271static int iwl_eeprom_read_calib(const u8 *eeprom, size_t eeprom_size,
272				 struct iwl_nvm_data *data)
273{
274	struct iwl_eeprom_calib_hdr *hdr;
275
276	hdr = (void *)iwl_eeprom_query_addr(eeprom, eeprom_size,
277					    EEPROM_CALIB_ALL);
278	if (!hdr)
279		return -ENODATA;
280	data->calib_version = hdr->version;
281	data->calib_voltage = hdr->voltage;
282
283	return 0;
284}
285
286/**
287 * enum iwl_eeprom_channel_flags - channel flags in EEPROM
288 * @EEPROM_CHANNEL_VALID: channel is usable for this SKU/geo
289 * @EEPROM_CHANNEL_IBSS: usable as an IBSS channel
290 * @EEPROM_CHANNEL_ACTIVE: active scanning allowed
291 * @EEPROM_CHANNEL_RADAR: radar detection required
292 * @EEPROM_CHANNEL_WIDE: 20 MHz channel okay (?)
293 * @EEPROM_CHANNEL_DFS: dynamic freq selection candidate
294 */
295enum iwl_eeprom_channel_flags {
296	EEPROM_CHANNEL_VALID = BIT(0),
297	EEPROM_CHANNEL_IBSS = BIT(1),
298	EEPROM_CHANNEL_ACTIVE = BIT(3),
299	EEPROM_CHANNEL_RADAR = BIT(4),
300	EEPROM_CHANNEL_WIDE = BIT(5),
301	EEPROM_CHANNEL_DFS = BIT(7),
302};
303
304/**
305 * struct iwl_eeprom_channel - EEPROM channel data
306 * @flags: %EEPROM_CHANNEL_* flags
307 * @max_power_avg: max power (in dBm) on this channel, at most 31 dBm
308 */
309struct iwl_eeprom_channel {
310	u8 flags;
311	s8 max_power_avg;
312} __packed;
313
314
315enum iwl_eeprom_enhanced_txpwr_flags {
316	IWL_EEPROM_ENH_TXP_FL_VALID = BIT(0),
317	IWL_EEPROM_ENH_TXP_FL_BAND_52G = BIT(1),
318	IWL_EEPROM_ENH_TXP_FL_OFDM = BIT(2),
319	IWL_EEPROM_ENH_TXP_FL_40MHZ = BIT(3),
320	IWL_EEPROM_ENH_TXP_FL_HT_AP = BIT(4),
321	IWL_EEPROM_ENH_TXP_FL_RES1 = BIT(5),
322	IWL_EEPROM_ENH_TXP_FL_RES2 = BIT(6),
323	IWL_EEPROM_ENH_TXP_FL_COMMON_TYPE = BIT(7),
324};
325
326/**
327 * iwl_eeprom_enhanced_txpwr structure
328 * @flags: entry flags
329 * @channel: channel number
330 * @chain_a_max_pwr: chain a max power in 1/2 dBm
331 * @chain_b_max_pwr: chain b max power in 1/2 dBm
332 * @chain_c_max_pwr: chain c max power in 1/2 dBm
333 * @delta_20_in_40: 20-in-40 deltas (hi/lo)
334 * @mimo2_max_pwr: mimo2 max power in 1/2 dBm
335 * @mimo3_max_pwr: mimo3 max power in 1/2 dBm
336 *
337 * This structure presents the enhanced regulatory tx power limit layout
338 * in an EEPROM image.
339 */
340struct iwl_eeprom_enhanced_txpwr {
341	u8 flags;
342	u8 channel;
343	s8 chain_a_max;
344	s8 chain_b_max;
345	s8 chain_c_max;
346	u8 delta_20_in_40;
347	s8 mimo2_max;
348	s8 mimo3_max;
349} __packed;
350
351static s8 iwl_get_max_txpwr_half_dbm(const struct iwl_nvm_data *data,
352				     struct iwl_eeprom_enhanced_txpwr *txp)
353{
354	s8 result = 0; /* (.5 dBm) */
355
356	/* Take the highest tx power from any valid chains */
357	if (data->valid_tx_ant & ANT_A && txp->chain_a_max > result)
358		result = txp->chain_a_max;
359
360	if (data->valid_tx_ant & ANT_B && txp->chain_b_max > result)
361		result = txp->chain_b_max;
362
363	if (data->valid_tx_ant & ANT_C && txp->chain_c_max > result)
364		result = txp->chain_c_max;
365
366	if ((data->valid_tx_ant == ANT_AB ||
367	     data->valid_tx_ant == ANT_BC ||
368	     data->valid_tx_ant == ANT_AC) && txp->mimo2_max > result)
369		result = txp->mimo2_max;
370
371	if (data->valid_tx_ant == ANT_ABC && txp->mimo3_max > result)
372		result = txp->mimo3_max;
373
374	return result;
375}
376
377#define EEPROM_TXP_OFFS	(0x00 | INDIRECT_ADDRESS | INDIRECT_TXP_LIMIT)
378#define EEPROM_TXP_ENTRY_LEN sizeof(struct iwl_eeprom_enhanced_txpwr)
379#define EEPROM_TXP_SZ_OFFS (0x00 | INDIRECT_ADDRESS | INDIRECT_TXP_LIMIT_SIZE)
380
381#define TXP_CHECK_AND_PRINT(x) \
382	((txp->flags & IWL_EEPROM_ENH_TXP_FL_##x) ? # x " " : "")
383
384static void
385iwl_eeprom_enh_txp_read_element(struct iwl_nvm_data *data,
386				struct iwl_eeprom_enhanced_txpwr *txp,
387				int n_channels, s8 max_txpower_avg)
388{
389	int ch_idx;
390	enum nl80211_band band;
391
392	band = txp->flags & IWL_EEPROM_ENH_TXP_FL_BAND_52G ?
393		NL80211_BAND_5GHZ : NL80211_BAND_2GHZ;
394
395	for (ch_idx = 0; ch_idx < n_channels; ch_idx++) {
396		struct ieee80211_channel *chan = &data->channels[ch_idx];
397
398		/* update matching channel or from common data only */
399		if (txp->channel != 0 && chan->hw_value != txp->channel)
400			continue;
401
402		/* update matching band only */
403		if (band != chan->band)
404			continue;
405
406		if (chan->max_power < max_txpower_avg &&
407		    !(txp->flags & IWL_EEPROM_ENH_TXP_FL_40MHZ))
408			chan->max_power = max_txpower_avg;
409	}
410}
411
412static void iwl_eeprom_enhanced_txpower(struct device *dev,
413					struct iwl_nvm_data *data,
414					const u8 *eeprom, size_t eeprom_size,
415					int n_channels)
416{
417	struct iwl_eeprom_enhanced_txpwr *txp_array, *txp;
418	int idx, entries;
419	__le16 *txp_len;
420	s8 max_txp_avg_halfdbm;
421
422	BUILD_BUG_ON(sizeof(struct iwl_eeprom_enhanced_txpwr) != 8);
423
424	/* the length is in 16-bit words, but we want entries */
425	txp_len = (__le16 *)iwl_eeprom_query_addr(eeprom, eeprom_size,
426						  EEPROM_TXP_SZ_OFFS);
427	entries = le16_to_cpup(txp_len) * 2 / EEPROM_TXP_ENTRY_LEN;
428
429	txp_array = (void *)iwl_eeprom_query_addr(eeprom, eeprom_size,
430						  EEPROM_TXP_OFFS);
431
432	for (idx = 0; idx < entries; idx++) {
433		txp = &txp_array[idx];
434		/* skip invalid entries */
435		if (!(txp->flags & IWL_EEPROM_ENH_TXP_FL_VALID))
436			continue;
437
438		IWL_DEBUG_EEPROM(dev, "%s %d:\t %s%s%s%s%s%s%s%s (0x%02x)\n",
439				 (txp->channel && (txp->flags &
440					IWL_EEPROM_ENH_TXP_FL_COMMON_TYPE)) ?
441					"Common " : (txp->channel) ?
442					"Channel" : "Common",
443				 (txp->channel),
444				 TXP_CHECK_AND_PRINT(VALID),
445				 TXP_CHECK_AND_PRINT(BAND_52G),
446				 TXP_CHECK_AND_PRINT(OFDM),
447				 TXP_CHECK_AND_PRINT(40MHZ),
448				 TXP_CHECK_AND_PRINT(HT_AP),
449				 TXP_CHECK_AND_PRINT(RES1),
450				 TXP_CHECK_AND_PRINT(RES2),
451				 TXP_CHECK_AND_PRINT(COMMON_TYPE),
452				 txp->flags);
453		IWL_DEBUG_EEPROM(dev,
454				 "\t\t chain_A: %d chain_B: %d chain_C: %d\n",
455				 txp->chain_a_max, txp->chain_b_max,
456				 txp->chain_c_max);
457		IWL_DEBUG_EEPROM(dev,
458				 "\t\t MIMO2: %d MIMO3: %d High 20_on_40: 0x%02x Low 20_on_40: 0x%02x\n",
459				 txp->mimo2_max, txp->mimo3_max,
460				 ((txp->delta_20_in_40 & 0xf0) >> 4),
461				 (txp->delta_20_in_40 & 0x0f));
462
463		max_txp_avg_halfdbm = iwl_get_max_txpwr_half_dbm(data, txp);
464
465		iwl_eeprom_enh_txp_read_element(data, txp, n_channels,
466				DIV_ROUND_UP(max_txp_avg_halfdbm, 2));
467
468		if (max_txp_avg_halfdbm > data->max_tx_pwr_half_dbm)
469			data->max_tx_pwr_half_dbm = max_txp_avg_halfdbm;
470	}
471}
472
473static void iwl_init_band_reference(const struct iwl_cfg *cfg,
474				    const u8 *eeprom, size_t eeprom_size,
475				    int eeprom_band, int *eeprom_ch_count,
476				    const struct iwl_eeprom_channel **ch_info,
477				    const u8 **eeprom_ch_array)
478{
479	u32 offset = cfg->eeprom_params->regulatory_bands[eeprom_band - 1];
480
481	offset |= INDIRECT_ADDRESS | INDIRECT_REGULATORY;
482
483	*ch_info = (void *)iwl_eeprom_query_addr(eeprom, eeprom_size, offset);
484
485	switch (eeprom_band) {
486	case 1:		/* 2.4GHz band */
487		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_1);
488		*eeprom_ch_array = iwl_eeprom_band_1;
489		break;
490	case 2:		/* 4.9GHz band */
491		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_2);
492		*eeprom_ch_array = iwl_eeprom_band_2;
493		break;
494	case 3:		/* 5.2GHz band */
495		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_3);
496		*eeprom_ch_array = iwl_eeprom_band_3;
497		break;
498	case 4:		/* 5.5GHz band */
499		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_4);
500		*eeprom_ch_array = iwl_eeprom_band_4;
501		break;
502	case 5:		/* 5.7GHz band */
503		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_5);
504		*eeprom_ch_array = iwl_eeprom_band_5;
505		break;
506	case 6:		/* 2.4GHz ht40 channels */
507		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_6);
508		*eeprom_ch_array = iwl_eeprom_band_6;
509		break;
510	case 7:		/* 5 GHz ht40 channels */
511		*eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_7);
512		*eeprom_ch_array = iwl_eeprom_band_7;
513		break;
514	default:
515		*eeprom_ch_count = 0;
516		*eeprom_ch_array = NULL;
517		WARN_ON(1);
518	}
519}
520
521#define CHECK_AND_PRINT(x) \
522	((eeprom_ch->flags & EEPROM_CHANNEL_##x) ? # x " " : "")
523
524static void iwl_mod_ht40_chan_info(struct device *dev,
525				   struct iwl_nvm_data *data, int n_channels,
526				   enum nl80211_band band, u16 channel,
527				   const struct iwl_eeprom_channel *eeprom_ch,
528				   u8 clear_ht40_extension_channel)
529{
530	struct ieee80211_channel *chan = NULL;
531	int i;
532
533	for (i = 0; i < n_channels; i++) {
534		if (data->channels[i].band != band)
535			continue;
536		if (data->channels[i].hw_value != channel)
537			continue;
538		chan = &data->channels[i];
539		break;
540	}
541
542	if (!chan)
543		return;
544
545	IWL_DEBUG_EEPROM(dev,
546			 "HT40 Ch. %d [%sGHz] %s%s%s%s%s(0x%02x %ddBm): Ad-Hoc %ssupported\n",
547			 channel,
548			 band == NL80211_BAND_5GHZ ? "5.2" : "2.4",
549			 CHECK_AND_PRINT(IBSS),
550			 CHECK_AND_PRINT(ACTIVE),
551			 CHECK_AND_PRINT(RADAR),
552			 CHECK_AND_PRINT(WIDE),
553			 CHECK_AND_PRINT(DFS),
554			 eeprom_ch->flags,
555			 eeprom_ch->max_power_avg,
556			 ((eeprom_ch->flags & EEPROM_CHANNEL_IBSS) &&
557			  !(eeprom_ch->flags & EEPROM_CHANNEL_RADAR)) ? ""
558								      : "not ");
559
560	if (eeprom_ch->flags & EEPROM_CHANNEL_VALID)
561		chan->flags &= ~clear_ht40_extension_channel;
562}
563
564#define CHECK_AND_PRINT_I(x)	\
565	((eeprom_ch_info[ch_idx].flags & EEPROM_CHANNEL_##x) ? # x " " : "")
566
567static int iwl_init_channel_map(struct device *dev, const struct iwl_cfg *cfg,
568				struct iwl_nvm_data *data,
569				const u8 *eeprom, size_t eeprom_size)
570{
571	int band, ch_idx;
572	const struct iwl_eeprom_channel *eeprom_ch_info;
573	const u8 *eeprom_ch_array;
574	int eeprom_ch_count;
575	int n_channels = 0;
576
577	/*
578	 * Loop through the 5 EEPROM bands and add them to the parse list
579	 */
580	for (band = 1; band <= 5; band++) {
581		struct ieee80211_channel *channel;
582
583		iwl_init_band_reference(cfg, eeprom, eeprom_size, band,
584					&eeprom_ch_count, &eeprom_ch_info,
585					&eeprom_ch_array);
586
587		/* Loop through each band adding each of the channels */
588		for (ch_idx = 0; ch_idx < eeprom_ch_count; ch_idx++) {
589			const struct iwl_eeprom_channel *eeprom_ch;
590
591			eeprom_ch = &eeprom_ch_info[ch_idx];
592
593			if (!(eeprom_ch->flags & EEPROM_CHANNEL_VALID)) {
594				IWL_DEBUG_EEPROM(dev,
595						 "Ch. %d Flags %x [%sGHz] - No traffic\n",
596						 eeprom_ch_array[ch_idx],
597						 eeprom_ch_info[ch_idx].flags,
598						 (band != 1) ? "5.2" : "2.4");
599				continue;
600			}
601
602			channel = &data->channels[n_channels];
603			n_channels++;
604
605			channel->hw_value = eeprom_ch_array[ch_idx];
606			channel->band = (band == 1) ? NL80211_BAND_2GHZ
607						    : NL80211_BAND_5GHZ;
608			channel->center_freq =
609				ieee80211_channel_to_frequency(
610					channel->hw_value, channel->band);
611
612			/* set no-HT40, will enable as appropriate later */
613			channel->flags = IEEE80211_CHAN_NO_HT40;
614
615			if (!(eeprom_ch->flags & EEPROM_CHANNEL_IBSS))
616				channel->flags |= IEEE80211_CHAN_NO_IR;
617
618			if (!(eeprom_ch->flags & EEPROM_CHANNEL_ACTIVE))
619				channel->flags |= IEEE80211_CHAN_NO_IR;
620
621			if (eeprom_ch->flags & EEPROM_CHANNEL_RADAR)
622				channel->flags |= IEEE80211_CHAN_RADAR;
623
624			/* Initialize regulatory-based run-time data */
625			channel->max_power =
626				eeprom_ch_info[ch_idx].max_power_avg;
627			IWL_DEBUG_EEPROM(dev,
628					 "Ch. %d [%sGHz] %s%s%s%s%s%s(0x%02x %ddBm): Ad-Hoc %ssupported\n",
629					 channel->hw_value,
630					 (band != 1) ? "5.2" : "2.4",
631					 CHECK_AND_PRINT_I(VALID),
632					 CHECK_AND_PRINT_I(IBSS),
633					 CHECK_AND_PRINT_I(ACTIVE),
634					 CHECK_AND_PRINT_I(RADAR),
635					 CHECK_AND_PRINT_I(WIDE),
636					 CHECK_AND_PRINT_I(DFS),
637					 eeprom_ch_info[ch_idx].flags,
638					 eeprom_ch_info[ch_idx].max_power_avg,
639					 ((eeprom_ch_info[ch_idx].flags &
640							EEPROM_CHANNEL_IBSS) &&
641					  !(eeprom_ch_info[ch_idx].flags &
642							EEPROM_CHANNEL_RADAR))
643						? "" : "not ");
644		}
645	}
646
647	if (cfg->eeprom_params->enhanced_txpower) {
648		/*
649		 * for newer device (6000 series and up)
650		 * EEPROM contain enhanced tx power information
651		 * driver need to process addition information
652		 * to determine the max channel tx power limits
653		 */
654		iwl_eeprom_enhanced_txpower(dev, data, eeprom, eeprom_size,
655					    n_channels);
656	} else {
657		/* All others use data from channel map */
658		int i;
659
660		data->max_tx_pwr_half_dbm = -128;
661
662		for (i = 0; i < n_channels; i++)
663			data->max_tx_pwr_half_dbm =
664				max_t(s8, data->max_tx_pwr_half_dbm,
665				      data->channels[i].max_power * 2);
666	}
667
668	/* Check if we do have HT40 channels */
669	if (cfg->eeprom_params->regulatory_bands[5] ==
670				EEPROM_REGULATORY_BAND_NO_HT40 &&
671	    cfg->eeprom_params->regulatory_bands[6] ==
672				EEPROM_REGULATORY_BAND_NO_HT40)
673		return n_channels;
674
675	/* Two additional EEPROM bands for 2.4 and 5 GHz HT40 channels */
676	for (band = 6; band <= 7; band++) {
677		enum nl80211_band ieeeband;
678
679		iwl_init_band_reference(cfg, eeprom, eeprom_size, band,
680					&eeprom_ch_count, &eeprom_ch_info,
681					&eeprom_ch_array);
682
683		/* EEPROM band 6 is 2.4, band 7 is 5 GHz */
684		ieeeband = (band == 6) ? NL80211_BAND_2GHZ
685				       : NL80211_BAND_5GHZ;
686
687		/* Loop through each band adding each of the channels */
688		for (ch_idx = 0; ch_idx < eeprom_ch_count; ch_idx++) {
689			/* Set up driver's info for lower half */
690			iwl_mod_ht40_chan_info(dev, data, n_channels, ieeeband,
691					       eeprom_ch_array[ch_idx],
692					       &eeprom_ch_info[ch_idx],
693					       IEEE80211_CHAN_NO_HT40PLUS);
694
695			/* Set up driver's info for upper half */
696			iwl_mod_ht40_chan_info(dev, data, n_channels, ieeeband,
697					       eeprom_ch_array[ch_idx] + 4,
698					       &eeprom_ch_info[ch_idx],
699					       IEEE80211_CHAN_NO_HT40MINUS);
700		}
701	}
702
703	return n_channels;
704}
 
705
706int iwl_init_sband_channels(struct iwl_nvm_data *data,
707			    struct ieee80211_supported_band *sband,
708			    int n_channels, enum nl80211_band band)
709{
710	struct ieee80211_channel *chan = &data->channels[0];
711	int n = 0, idx = 0;
712
713	while (idx < n_channels && chan->band != band)
714		chan = &data->channels[++idx];
715
716	sband->channels = &data->channels[idx];
717
718	while (idx < n_channels && chan->band == band) {
719		chan = &data->channels[++idx];
720		n++;
721	}
722
723	sband->n_channels = n;
724
725	return n;
726}
727
728#define MAX_BIT_RATE_40_MHZ	150 /* Mbps */
729#define MAX_BIT_RATE_20_MHZ	72 /* Mbps */
730
731void iwl_init_ht_hw_capab(struct iwl_trans *trans,
732			  struct iwl_nvm_data *data,
733			  struct ieee80211_sta_ht_cap *ht_info,
734			  enum nl80211_band band,
735			  u8 tx_chains, u8 rx_chains)
736{
737	const struct iwl_cfg *cfg = trans->cfg;
738	int max_bit_rate = 0;
739
740	tx_chains = hweight8(tx_chains);
741	if (cfg->rx_with_siso_diversity)
742		rx_chains = 1;
743	else
744		rx_chains = hweight8(rx_chains);
745
746	if (!(data->sku_cap_11n_enable) ||
747	    (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL) ||
748	    !cfg->ht_params) {
749		ht_info->ht_supported = false;
750		return;
751	}
752
753	if (data->sku_cap_mimo_disabled)
754		rx_chains = 1;
755
756	ht_info->ht_supported = true;
757	ht_info->cap = IEEE80211_HT_CAP_DSSSCCK40;
758
759	if (cfg->ht_params->stbc) {
760		ht_info->cap |= (1 << IEEE80211_HT_CAP_RX_STBC_SHIFT);
761
762		if (tx_chains > 1)
763			ht_info->cap |= IEEE80211_HT_CAP_TX_STBC;
764	}
765
766	if (cfg->ht_params->ldpc)
767		ht_info->cap |= IEEE80211_HT_CAP_LDPC_CODING;
768
769	if ((trans->trans_cfg->mq_rx_supported &&
770	     iwlwifi_mod_params.amsdu_size == IWL_AMSDU_DEF) ||
771	     iwlwifi_mod_params.amsdu_size >= IWL_AMSDU_8K)
772		ht_info->cap |= IEEE80211_HT_CAP_MAX_AMSDU;
773
774	ht_info->ampdu_factor = cfg->max_ht_ampdu_exponent;
775	ht_info->ampdu_density = IEEE80211_HT_MPDU_DENSITY_4;
776
777	ht_info->mcs.rx_mask[0] = 0xFF;
 
 
 
778	if (rx_chains >= 2)
779		ht_info->mcs.rx_mask[1] = 0xFF;
780	if (rx_chains >= 3)
781		ht_info->mcs.rx_mask[2] = 0xFF;
782
783	if (cfg->ht_params->ht_greenfield_support)
784		ht_info->cap |= IEEE80211_HT_CAP_GRN_FLD;
785	ht_info->cap |= IEEE80211_HT_CAP_SGI_20;
786
787	max_bit_rate = MAX_BIT_RATE_20_MHZ;
788
789	if (cfg->ht_params->ht40_bands & BIT(band)) {
790		ht_info->cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40;
791		ht_info->cap |= IEEE80211_HT_CAP_SGI_40;
792		max_bit_rate = MAX_BIT_RATE_40_MHZ;
793	}
794
795	/* Highest supported Rx data rate */
796	max_bit_rate *= rx_chains;
797	WARN_ON(max_bit_rate & ~IEEE80211_HT_MCS_RX_HIGHEST_MASK);
798	ht_info->mcs.rx_highest = cpu_to_le16(max_bit_rate);
799
800	/* Tx MCS capabilities */
801	ht_info->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
802	if (tx_chains != rx_chains) {
803		ht_info->mcs.tx_params |= IEEE80211_HT_MCS_TX_RX_DIFF;
804		ht_info->mcs.tx_params |= ((tx_chains - 1) <<
805				IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT);
806	}
807}
808
 
809static void iwl_init_sbands(struct iwl_trans *trans, const struct iwl_cfg *cfg,
810			    struct iwl_nvm_data *data,
811			    const u8 *eeprom, size_t eeprom_size)
812{
813	struct device *dev = trans->dev;
814	int n_channels = iwl_init_channel_map(dev, cfg, data,
815					      eeprom, eeprom_size);
816	int n_used = 0;
817	struct ieee80211_supported_band *sband;
818
819	sband = &data->bands[NL80211_BAND_2GHZ];
820	sband->band = NL80211_BAND_2GHZ;
821	sband->bitrates = &iwl_cfg80211_rates[RATES_24_OFFS];
822	sband->n_bitrates = N_RATES_24;
823	n_used += iwl_init_sband_channels(data, sband, n_channels,
824					  NL80211_BAND_2GHZ);
825	iwl_init_ht_hw_capab(trans, data, &sband->ht_cap, NL80211_BAND_2GHZ,
826			     data->valid_tx_ant, data->valid_rx_ant);
827
828	sband = &data->bands[NL80211_BAND_5GHZ];
829	sband->band = NL80211_BAND_5GHZ;
830	sband->bitrates = &iwl_cfg80211_rates[RATES_52_OFFS];
831	sband->n_bitrates = N_RATES_52;
832	n_used += iwl_init_sband_channels(data, sband, n_channels,
833					  NL80211_BAND_5GHZ);
834	iwl_init_ht_hw_capab(trans, data, &sband->ht_cap, NL80211_BAND_5GHZ,
835			     data->valid_tx_ant, data->valid_rx_ant);
836
837	if (n_channels != n_used)
838		IWL_ERR_DEV(dev, "EEPROM: used only %d of %d channels\n",
839			    n_used, n_channels);
840}
841
842/* EEPROM data functions */
843
844struct iwl_nvm_data *
845iwl_parse_eeprom_data(struct iwl_trans *trans, const struct iwl_cfg *cfg,
846		      const u8 *eeprom, size_t eeprom_size)
847{
848	struct iwl_nvm_data *data;
849	struct device *dev = trans->dev;
850	const void *tmp;
851	u16 radio_cfg, sku;
852
853	if (WARN_ON(!cfg || !cfg->eeprom_params))
854		return NULL;
855
856	data = kzalloc(struct_size(data, channels, IWL_NUM_CHANNELS),
857		       GFP_KERNEL);
858	if (!data)
859		return NULL;
860
861	/* get MAC address(es) */
862	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size, EEPROM_MAC_ADDRESS);
863	if (!tmp)
864		goto err_free;
865	memcpy(data->hw_addr, tmp, ETH_ALEN);
866	data->n_hw_addrs = iwl_eeprom_query16(eeprom, eeprom_size,
867					      EEPROM_NUM_MAC_ADDRESS);
868
869	if (iwl_eeprom_read_calib(eeprom, eeprom_size, data))
870		goto err_free;
871
872	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size, EEPROM_XTAL);
873	if (!tmp)
874		goto err_free;
875	memcpy(data->xtal_calib, tmp, sizeof(data->xtal_calib));
876
877	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size,
878				    EEPROM_RAW_TEMPERATURE);
879	if (!tmp)
880		goto err_free;
881	data->raw_temperature = *(__le16 *)tmp;
882
883	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size,
884				    EEPROM_KELVIN_TEMPERATURE);
885	if (!tmp)
886		goto err_free;
887	data->kelvin_temperature = *(__le16 *)tmp;
888	data->kelvin_voltage = *((__le16 *)tmp + 1);
889
890	radio_cfg = iwl_eeprom_query16(eeprom, eeprom_size,
891					     EEPROM_RADIO_CONFIG);
892	data->radio_cfg_dash = EEPROM_RF_CFG_DASH_MSK(radio_cfg);
893	data->radio_cfg_pnum = EEPROM_RF_CFG_PNUM_MSK(radio_cfg);
894	data->radio_cfg_step = EEPROM_RF_CFG_STEP_MSK(radio_cfg);
895	data->radio_cfg_type = EEPROM_RF_CFG_TYPE_MSK(radio_cfg);
896	data->valid_rx_ant = EEPROM_RF_CFG_RX_ANT_MSK(radio_cfg);
897	data->valid_tx_ant = EEPROM_RF_CFG_TX_ANT_MSK(radio_cfg);
898
899	sku = iwl_eeprom_query16(eeprom, eeprom_size,
900				 EEPROM_SKU_CAP);
901	data->sku_cap_11n_enable = sku & EEPROM_SKU_CAP_11N_ENABLE;
902	data->sku_cap_amt_enable = sku & EEPROM_SKU_CAP_AMT_ENABLE;
903	data->sku_cap_band_24ghz_enable = sku & EEPROM_SKU_CAP_BAND_24GHZ;
904	data->sku_cap_band_52ghz_enable = sku & EEPROM_SKU_CAP_BAND_52GHZ;
905	data->sku_cap_ipan_enable = sku & EEPROM_SKU_CAP_IPAN_ENABLE;
906	if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
907		data->sku_cap_11n_enable = false;
908
909	data->nvm_version = iwl_eeprom_query16(eeprom, eeprom_size,
910					       EEPROM_VERSION);
911
912	/* check overrides (some devices have wrong EEPROM) */
913	if (cfg->valid_tx_ant)
914		data->valid_tx_ant = cfg->valid_tx_ant;
915	if (cfg->valid_rx_ant)
916		data->valid_rx_ant = cfg->valid_rx_ant;
917
918	if (!data->valid_tx_ant || !data->valid_rx_ant) {
919		IWL_ERR_DEV(dev, "invalid antennas (0x%x, 0x%x)\n",
920			    data->valid_tx_ant, data->valid_rx_ant);
921		goto err_free;
922	}
923
924	iwl_init_sbands(trans, cfg, data, eeprom, eeprom_size);
925
926	return data;
927 err_free:
928	kfree(data);
929	return NULL;
930}
931IWL_EXPORT_SYMBOL(iwl_parse_eeprom_data);