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 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 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 */
106 struct 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) */
120 enum 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  */
144 static 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 
148 static const u8 iwl_eeprom_band_2[] = {	/* 4915-5080MHz */
149 	183, 184, 185, 187, 188, 189, 192, 196, 7, 8, 11, 12, 16
150 };
151 
152 static const u8 iwl_eeprom_band_3[] = {	/* 5170-5320MHz */
153 	34, 36, 38, 40, 42, 44, 46, 48, 52, 56, 60, 64
154 };
155 
156 static const u8 iwl_eeprom_band_4[] = {	/* 5500-5700MHz */
157 	100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140
158 };
159 
160 static const u8 iwl_eeprom_band_5[] = {	/* 5725-5825MHz */
161 	145, 149, 153, 157, 161, 165
162 };
163 
164 static const u8 iwl_eeprom_band_6[] = {	/* 2.4 ht40 channel */
165 	1, 2, 3, 4, 5, 6, 7
166 };
167 
168 static 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) */
179 static 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 
203 static 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 
210 static 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 
260 static 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 
271 static 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  */
295 enum 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  */
309 struct iwl_eeprom_channel {
310 	u8 flags;
311 	s8 max_power_avg;
312 } __packed;
313 
314 
315 enum 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  */
340 struct 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 
351 static 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 
384 static void
385 iwl_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 
412 static 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 
473 static 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 
524 static 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 
567 static 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 
706 int 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 
731 void iwl_init_ht_hw_capab(const struct iwl_cfg *cfg,
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 	int max_bit_rate = 0;
738 
739 	tx_chains = hweight8(tx_chains);
740 	if (cfg->rx_with_siso_diversity)
741 		rx_chains = 1;
742 	else
743 		rx_chains = hweight8(rx_chains);
744 
745 	if (!(data->sku_cap_11n_enable) ||
746 	    (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL) ||
747 	    !cfg->ht_params) {
748 		ht_info->ht_supported = false;
749 		return;
750 	}
751 
752 	if (data->sku_cap_mimo_disabled)
753 		rx_chains = 1;
754 
755 	ht_info->ht_supported = true;
756 	ht_info->cap = IEEE80211_HT_CAP_DSSSCCK40;
757 
758 	if (cfg->ht_params->stbc) {
759 		ht_info->cap |= (1 << IEEE80211_HT_CAP_RX_STBC_SHIFT);
760 
761 		if (tx_chains > 1)
762 			ht_info->cap |= IEEE80211_HT_CAP_TX_STBC;
763 	}
764 
765 	if (cfg->ht_params->ldpc)
766 		ht_info->cap |= IEEE80211_HT_CAP_LDPC_CODING;
767 
768 	if ((cfg->mq_rx_supported &&
769 	     iwlwifi_mod_params.amsdu_size == IWL_AMSDU_DEF) ||
770 	     iwlwifi_mod_params.amsdu_size >= IWL_AMSDU_8K)
771 		ht_info->cap |= IEEE80211_HT_CAP_MAX_AMSDU;
772 
773 	ht_info->ampdu_factor = cfg->max_ht_ampdu_exponent;
774 	ht_info->ampdu_density = IEEE80211_HT_MPDU_DENSITY_4;
775 
776 	ht_info->mcs.rx_mask[0] = 0xFF;
777 	if (rx_chains >= 2)
778 		ht_info->mcs.rx_mask[1] = 0xFF;
779 	if (rx_chains >= 3)
780 		ht_info->mcs.rx_mask[2] = 0xFF;
781 
782 	if (cfg->ht_params->ht_greenfield_support)
783 		ht_info->cap |= IEEE80211_HT_CAP_GRN_FLD;
784 	ht_info->cap |= IEEE80211_HT_CAP_SGI_20;
785 
786 	max_bit_rate = MAX_BIT_RATE_20_MHZ;
787 
788 	if (cfg->ht_params->ht40_bands & BIT(band)) {
789 		ht_info->cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40;
790 		ht_info->cap |= IEEE80211_HT_CAP_SGI_40;
791 		max_bit_rate = MAX_BIT_RATE_40_MHZ;
792 	}
793 
794 	/* Highest supported Rx data rate */
795 	max_bit_rate *= rx_chains;
796 	WARN_ON(max_bit_rate & ~IEEE80211_HT_MCS_RX_HIGHEST_MASK);
797 	ht_info->mcs.rx_highest = cpu_to_le16(max_bit_rate);
798 
799 	/* Tx MCS capabilities */
800 	ht_info->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
801 	if (tx_chains != rx_chains) {
802 		ht_info->mcs.tx_params |= IEEE80211_HT_MCS_TX_RX_DIFF;
803 		ht_info->mcs.tx_params |= ((tx_chains - 1) <<
804 				IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT);
805 	}
806 }
807 
808 static void iwl_init_sbands(struct device *dev, const struct iwl_cfg *cfg,
809 			    struct iwl_nvm_data *data,
810 			    const u8 *eeprom, size_t eeprom_size)
811 {
812 	int n_channels = iwl_init_channel_map(dev, cfg, data,
813 					      eeprom, eeprom_size);
814 	int n_used = 0;
815 	struct ieee80211_supported_band *sband;
816 
817 	sband = &data->bands[NL80211_BAND_2GHZ];
818 	sband->band = NL80211_BAND_2GHZ;
819 	sband->bitrates = &iwl_cfg80211_rates[RATES_24_OFFS];
820 	sband->n_bitrates = N_RATES_24;
821 	n_used += iwl_init_sband_channels(data, sband, n_channels,
822 					  NL80211_BAND_2GHZ);
823 	iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, NL80211_BAND_2GHZ,
824 			     data->valid_tx_ant, data->valid_rx_ant);
825 
826 	sband = &data->bands[NL80211_BAND_5GHZ];
827 	sband->band = NL80211_BAND_5GHZ;
828 	sband->bitrates = &iwl_cfg80211_rates[RATES_52_OFFS];
829 	sband->n_bitrates = N_RATES_52;
830 	n_used += iwl_init_sband_channels(data, sband, n_channels,
831 					  NL80211_BAND_5GHZ);
832 	iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, NL80211_BAND_5GHZ,
833 			     data->valid_tx_ant, data->valid_rx_ant);
834 
835 	if (n_channels != n_used)
836 		IWL_ERR_DEV(dev, "EEPROM: used only %d of %d channels\n",
837 			    n_used, n_channels);
838 }
839 
840 /* EEPROM data functions */
841 
842 struct iwl_nvm_data *
843 iwl_parse_eeprom_data(struct device *dev, const struct iwl_cfg *cfg,
844 		      const u8 *eeprom, size_t eeprom_size)
845 {
846 	struct iwl_nvm_data *data;
847 	const void *tmp;
848 	u16 radio_cfg, sku;
849 
850 	if (WARN_ON(!cfg || !cfg->eeprom_params))
851 		return NULL;
852 
853 	data = kzalloc(struct_size(data, channels, IWL_NUM_CHANNELS),
854 		       GFP_KERNEL);
855 	if (!data)
856 		return NULL;
857 
858 	/* get MAC address(es) */
859 	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size, EEPROM_MAC_ADDRESS);
860 	if (!tmp)
861 		goto err_free;
862 	memcpy(data->hw_addr, tmp, ETH_ALEN);
863 	data->n_hw_addrs = iwl_eeprom_query16(eeprom, eeprom_size,
864 					      EEPROM_NUM_MAC_ADDRESS);
865 
866 	if (iwl_eeprom_read_calib(eeprom, eeprom_size, data))
867 		goto err_free;
868 
869 	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size, EEPROM_XTAL);
870 	if (!tmp)
871 		goto err_free;
872 	memcpy(data->xtal_calib, tmp, sizeof(data->xtal_calib));
873 
874 	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size,
875 				    EEPROM_RAW_TEMPERATURE);
876 	if (!tmp)
877 		goto err_free;
878 	data->raw_temperature = *(__le16 *)tmp;
879 
880 	tmp = iwl_eeprom_query_addr(eeprom, eeprom_size,
881 				    EEPROM_KELVIN_TEMPERATURE);
882 	if (!tmp)
883 		goto err_free;
884 	data->kelvin_temperature = *(__le16 *)tmp;
885 	data->kelvin_voltage = *((__le16 *)tmp + 1);
886 
887 	radio_cfg = iwl_eeprom_query16(eeprom, eeprom_size,
888 					     EEPROM_RADIO_CONFIG);
889 	data->radio_cfg_dash = EEPROM_RF_CFG_DASH_MSK(radio_cfg);
890 	data->radio_cfg_pnum = EEPROM_RF_CFG_PNUM_MSK(radio_cfg);
891 	data->radio_cfg_step = EEPROM_RF_CFG_STEP_MSK(radio_cfg);
892 	data->radio_cfg_type = EEPROM_RF_CFG_TYPE_MSK(radio_cfg);
893 	data->valid_rx_ant = EEPROM_RF_CFG_RX_ANT_MSK(radio_cfg);
894 	data->valid_tx_ant = EEPROM_RF_CFG_TX_ANT_MSK(radio_cfg);
895 
896 	sku = iwl_eeprom_query16(eeprom, eeprom_size,
897 				 EEPROM_SKU_CAP);
898 	data->sku_cap_11n_enable = sku & EEPROM_SKU_CAP_11N_ENABLE;
899 	data->sku_cap_amt_enable = sku & EEPROM_SKU_CAP_AMT_ENABLE;
900 	data->sku_cap_band_24ghz_enable = sku & EEPROM_SKU_CAP_BAND_24GHZ;
901 	data->sku_cap_band_52ghz_enable = sku & EEPROM_SKU_CAP_BAND_52GHZ;
902 	data->sku_cap_ipan_enable = sku & EEPROM_SKU_CAP_IPAN_ENABLE;
903 	if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
904 		data->sku_cap_11n_enable = false;
905 
906 	data->nvm_version = iwl_eeprom_query16(eeprom, eeprom_size,
907 					       EEPROM_VERSION);
908 
909 	/* check overrides (some devices have wrong EEPROM) */
910 	if (cfg->valid_tx_ant)
911 		data->valid_tx_ant = cfg->valid_tx_ant;
912 	if (cfg->valid_rx_ant)
913 		data->valid_rx_ant = cfg->valid_rx_ant;
914 
915 	if (!data->valid_tx_ant || !data->valid_rx_ant) {
916 		IWL_ERR_DEV(dev, "invalid antennas (0x%x, 0x%x)\n",
917 			    data->valid_tx_ant, data->valid_rx_ant);
918 		goto err_free;
919 	}
920 
921 	iwl_init_sbands(dev, cfg, data, eeprom, eeprom_size);
922 
923 	return data;
924  err_free:
925 	kfree(data);
926 	return NULL;
927 }
928 IWL_EXPORT_SYMBOL(iwl_parse_eeprom_data);
929