xref: /openbmc/linux/drivers/net/wireless/intel/iwlwifi/iwl-nvm-parse.c (revision b802fb99ae964681d1754428f67970911e0476e9)
1 /******************************************************************************
2  *
3  * This file is provided under a dual BSD/GPLv2 license.  When using or
4  * redistributing this file, you may do so under either license.
5  *
6  * GPL LICENSE SUMMARY
7  *
8  * Copyright(c) 2008 - 2014 Intel Corporation. All rights reserved.
9  * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH
10  *
11  * This program is free software; you can redistribute it and/or modify
12  * it under the terms of version 2 of the GNU General Public License as
13  * published by the Free Software Foundation.
14  *
15  * This program is distributed in the hope that it will be useful, but
16  * WITHOUT ANY WARRANTY; without even the implied warranty of
17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
18  * General Public License for more details.
19  *
20  * You should have received a copy of the GNU General Public License
21  * along with this program; if not, write to the Free Software
22  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
23  * USA
24  *
25  * The full GNU General Public License is included in this distribution
26  * in the file called COPYING.
27  *
28  * Contact Information:
29  *  Intel Linux Wireless <linuxwifi@intel.com>
30  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
31  *
32  * BSD LICENSE
33  *
34  * Copyright(c) 2005 - 2014 Intel Corporation. All rights reserved.
35  * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH
36  * All rights reserved.
37  *
38  * Redistribution and use in source and binary forms, with or without
39  * modification, are permitted provided that the following conditions
40  * are met:
41  *
42  *  * Redistributions of source code must retain the above copyright
43  *    notice, this list of conditions and the following disclaimer.
44  *  * Redistributions in binary form must reproduce the above copyright
45  *    notice, this list of conditions and the following disclaimer in
46  *    the documentation and/or other materials provided with the
47  *    distribution.
48  *  * Neither the name Intel Corporation nor the names of its
49  *    contributors may be used to endorse or promote products derived
50  *    from this software without specific prior written permission.
51  *
52  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
53  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
54  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
55  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
56  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
57  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
58  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
59  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
60  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
61  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
62  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
63  *****************************************************************************/
64 #include <linux/types.h>
65 #include <linux/slab.h>
66 #include <linux/export.h>
67 #include <linux/etherdevice.h>
68 #include <linux/pci.h>
69 #include "iwl-drv.h"
70 #include "iwl-modparams.h"
71 #include "iwl-nvm-parse.h"
72 
73 /* NVM offsets (in words) definitions */
74 enum wkp_nvm_offsets {
75 	/* NVM HW-Section offset (in words) definitions */
76 	HW_ADDR = 0x15,
77 
78 	/* NVM SW-Section offset (in words) definitions */
79 	NVM_SW_SECTION = 0x1C0,
80 	NVM_VERSION = 0,
81 	RADIO_CFG = 1,
82 	SKU = 2,
83 	N_HW_ADDRS = 3,
84 	NVM_CHANNELS = 0x1E0 - NVM_SW_SECTION,
85 
86 	/* NVM calibration section offset (in words) definitions */
87 	NVM_CALIB_SECTION = 0x2B8,
88 	XTAL_CALIB = 0x316 - NVM_CALIB_SECTION
89 };
90 
91 enum family_8000_nvm_offsets {
92 	/* NVM HW-Section offset (in words) definitions */
93 	HW_ADDR0_WFPM_FAMILY_8000 = 0x12,
94 	HW_ADDR1_WFPM_FAMILY_8000 = 0x16,
95 	HW_ADDR0_PCIE_FAMILY_8000 = 0x8A,
96 	HW_ADDR1_PCIE_FAMILY_8000 = 0x8E,
97 	MAC_ADDRESS_OVERRIDE_FAMILY_8000 = 1,
98 
99 	/* NVM SW-Section offset (in words) definitions */
100 	NVM_SW_SECTION_FAMILY_8000 = 0x1C0,
101 	NVM_VERSION_FAMILY_8000 = 0,
102 	RADIO_CFG_FAMILY_8000 = 0,
103 	SKU_FAMILY_8000 = 2,
104 	N_HW_ADDRS_FAMILY_8000 = 3,
105 
106 	/* NVM REGULATORY -Section offset (in words) definitions */
107 	NVM_CHANNELS_FAMILY_8000 = 0,
108 	NVM_LAR_OFFSET_FAMILY_8000_OLD = 0x4C7,
109 	NVM_LAR_OFFSET_FAMILY_8000 = 0x507,
110 	NVM_LAR_ENABLED_FAMILY_8000 = 0x7,
111 
112 	/* NVM calibration section offset (in words) definitions */
113 	NVM_CALIB_SECTION_FAMILY_8000 = 0x2B8,
114 	XTAL_CALIB_FAMILY_8000 = 0x316 - NVM_CALIB_SECTION_FAMILY_8000
115 };
116 
117 /* SKU Capabilities (actual values from NVM definition) */
118 enum nvm_sku_bits {
119 	NVM_SKU_CAP_BAND_24GHZ		= BIT(0),
120 	NVM_SKU_CAP_BAND_52GHZ		= BIT(1),
121 	NVM_SKU_CAP_11N_ENABLE		= BIT(2),
122 	NVM_SKU_CAP_11AC_ENABLE		= BIT(3),
123 	NVM_SKU_CAP_MIMO_DISABLE	= BIT(5),
124 };
125 
126 /*
127  * These are the channel numbers in the order that they are stored in the NVM
128  */
129 static const u8 iwl_nvm_channels[] = {
130 	/* 2.4 GHz */
131 	1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
132 	/* 5 GHz */
133 	36, 40, 44 , 48, 52, 56, 60, 64,
134 	100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144,
135 	149, 153, 157, 161, 165
136 };
137 
138 static const u8 iwl_nvm_channels_family_8000[] = {
139 	/* 2.4 GHz */
140 	1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
141 	/* 5 GHz */
142 	36, 40, 44, 48, 52, 56, 60, 64, 68, 72, 76, 80, 84, 88, 92,
143 	96, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144,
144 	149, 153, 157, 161, 165, 169, 173, 177, 181
145 };
146 
147 #define IWL_NUM_CHANNELS		ARRAY_SIZE(iwl_nvm_channels)
148 #define IWL_NUM_CHANNELS_FAMILY_8000	ARRAY_SIZE(iwl_nvm_channels_family_8000)
149 #define NUM_2GHZ_CHANNELS		14
150 #define NUM_2GHZ_CHANNELS_FAMILY_8000	14
151 #define FIRST_2GHZ_HT_MINUS		5
152 #define LAST_2GHZ_HT_PLUS		9
153 #define LAST_5GHZ_HT			165
154 #define LAST_5GHZ_HT_FAMILY_8000	181
155 #define N_HW_ADDR_MASK			0xF
156 
157 /* rate data (static) */
158 static struct ieee80211_rate iwl_cfg80211_rates[] = {
159 	{ .bitrate = 1 * 10, .hw_value = 0, .hw_value_short = 0, },
160 	{ .bitrate = 2 * 10, .hw_value = 1, .hw_value_short = 1,
161 	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
162 	{ .bitrate = 5.5 * 10, .hw_value = 2, .hw_value_short = 2,
163 	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
164 	{ .bitrate = 11 * 10, .hw_value = 3, .hw_value_short = 3,
165 	  .flags = IEEE80211_RATE_SHORT_PREAMBLE, },
166 	{ .bitrate = 6 * 10, .hw_value = 4, .hw_value_short = 4, },
167 	{ .bitrate = 9 * 10, .hw_value = 5, .hw_value_short = 5, },
168 	{ .bitrate = 12 * 10, .hw_value = 6, .hw_value_short = 6, },
169 	{ .bitrate = 18 * 10, .hw_value = 7, .hw_value_short = 7, },
170 	{ .bitrate = 24 * 10, .hw_value = 8, .hw_value_short = 8, },
171 	{ .bitrate = 36 * 10, .hw_value = 9, .hw_value_short = 9, },
172 	{ .bitrate = 48 * 10, .hw_value = 10, .hw_value_short = 10, },
173 	{ .bitrate = 54 * 10, .hw_value = 11, .hw_value_short = 11, },
174 };
175 #define RATES_24_OFFS	0
176 #define N_RATES_24	ARRAY_SIZE(iwl_cfg80211_rates)
177 #define RATES_52_OFFS	4
178 #define N_RATES_52	(N_RATES_24 - RATES_52_OFFS)
179 
180 /**
181  * enum iwl_nvm_channel_flags - channel flags in NVM
182  * @NVM_CHANNEL_VALID: channel is usable for this SKU/geo
183  * @NVM_CHANNEL_IBSS: usable as an IBSS channel
184  * @NVM_CHANNEL_ACTIVE: active scanning allowed
185  * @NVM_CHANNEL_RADAR: radar detection required
186  * @NVM_CHANNEL_INDOOR_ONLY: only indoor use is allowed
187  * @NVM_CHANNEL_GO_CONCURRENT: GO operation is allowed when connected to BSS
188  *	on same channel on 2.4 or same UNII band on 5.2
189  * @NVM_CHANNEL_WIDE: 20 MHz channel okay (?)
190  * @NVM_CHANNEL_40MHZ: 40 MHz channel okay (?)
191  * @NVM_CHANNEL_80MHZ: 80 MHz channel okay (?)
192  * @NVM_CHANNEL_160MHZ: 160 MHz channel okay (?)
193  */
194 enum iwl_nvm_channel_flags {
195 	NVM_CHANNEL_VALID = BIT(0),
196 	NVM_CHANNEL_IBSS = BIT(1),
197 	NVM_CHANNEL_ACTIVE = BIT(3),
198 	NVM_CHANNEL_RADAR = BIT(4),
199 	NVM_CHANNEL_INDOOR_ONLY = BIT(5),
200 	NVM_CHANNEL_GO_CONCURRENT = BIT(6),
201 	NVM_CHANNEL_WIDE = BIT(8),
202 	NVM_CHANNEL_40MHZ = BIT(9),
203 	NVM_CHANNEL_80MHZ = BIT(10),
204 	NVM_CHANNEL_160MHZ = BIT(11),
205 };
206 
207 #define CHECK_AND_PRINT_I(x)	\
208 	((ch_flags & NVM_CHANNEL_##x) ? # x " " : "")
209 
210 static u32 iwl_get_channel_flags(u8 ch_num, int ch_idx, bool is_5ghz,
211 				 u16 nvm_flags, const struct iwl_cfg *cfg)
212 {
213 	u32 flags = IEEE80211_CHAN_NO_HT40;
214 	u32 last_5ghz_ht = LAST_5GHZ_HT;
215 
216 	if (cfg->device_family == IWL_DEVICE_FAMILY_8000)
217 		last_5ghz_ht = LAST_5GHZ_HT_FAMILY_8000;
218 
219 	if (!is_5ghz && (nvm_flags & NVM_CHANNEL_40MHZ)) {
220 		if (ch_num <= LAST_2GHZ_HT_PLUS)
221 			flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
222 		if (ch_num >= FIRST_2GHZ_HT_MINUS)
223 			flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
224 	} else if (ch_num <= last_5ghz_ht && (nvm_flags & NVM_CHANNEL_40MHZ)) {
225 		if ((ch_idx - NUM_2GHZ_CHANNELS) % 2 == 0)
226 			flags &= ~IEEE80211_CHAN_NO_HT40PLUS;
227 		else
228 			flags &= ~IEEE80211_CHAN_NO_HT40MINUS;
229 	}
230 	if (!(nvm_flags & NVM_CHANNEL_80MHZ))
231 		flags |= IEEE80211_CHAN_NO_80MHZ;
232 	if (!(nvm_flags & NVM_CHANNEL_160MHZ))
233 		flags |= IEEE80211_CHAN_NO_160MHZ;
234 
235 	if (!(nvm_flags & NVM_CHANNEL_IBSS))
236 		flags |= IEEE80211_CHAN_NO_IR;
237 
238 	if (!(nvm_flags & NVM_CHANNEL_ACTIVE))
239 		flags |= IEEE80211_CHAN_NO_IR;
240 
241 	if (nvm_flags & NVM_CHANNEL_RADAR)
242 		flags |= IEEE80211_CHAN_RADAR;
243 
244 	if (nvm_flags & NVM_CHANNEL_INDOOR_ONLY)
245 		flags |= IEEE80211_CHAN_INDOOR_ONLY;
246 
247 	/* Set the GO concurrent flag only in case that NO_IR is set.
248 	 * Otherwise it is meaningless
249 	 */
250 	if ((nvm_flags & NVM_CHANNEL_GO_CONCURRENT) &&
251 	    (flags & IEEE80211_CHAN_NO_IR))
252 		flags |= IEEE80211_CHAN_IR_CONCURRENT;
253 
254 	return flags;
255 }
256 
257 static int iwl_init_channel_map(struct device *dev, const struct iwl_cfg *cfg,
258 				struct iwl_nvm_data *data,
259 				const __le16 * const nvm_ch_flags,
260 				bool lar_supported)
261 {
262 	int ch_idx;
263 	int n_channels = 0;
264 	struct ieee80211_channel *channel;
265 	u16 ch_flags;
266 	bool is_5ghz;
267 	int num_of_ch, num_2ghz_channels;
268 	const u8 *nvm_chan;
269 
270 	if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
271 		num_of_ch = IWL_NUM_CHANNELS;
272 		nvm_chan = &iwl_nvm_channels[0];
273 		num_2ghz_channels = NUM_2GHZ_CHANNELS;
274 	} else {
275 		num_of_ch = IWL_NUM_CHANNELS_FAMILY_8000;
276 		nvm_chan = &iwl_nvm_channels_family_8000[0];
277 		num_2ghz_channels = NUM_2GHZ_CHANNELS_FAMILY_8000;
278 	}
279 
280 	for (ch_idx = 0; ch_idx < num_of_ch; ch_idx++) {
281 		ch_flags = __le16_to_cpup(nvm_ch_flags + ch_idx);
282 
283 		if (ch_idx >= num_2ghz_channels &&
284 		    !data->sku_cap_band_52GHz_enable)
285 			continue;
286 
287 		if (!lar_supported && !(ch_flags & NVM_CHANNEL_VALID)) {
288 			/*
289 			 * Channels might become valid later if lar is
290 			 * supported, hence we still want to add them to
291 			 * the list of supported channels to cfg80211.
292 			 */
293 			IWL_DEBUG_EEPROM(dev,
294 					 "Ch. %d Flags %x [%sGHz] - No traffic\n",
295 					 nvm_chan[ch_idx],
296 					 ch_flags,
297 					 (ch_idx >= num_2ghz_channels) ?
298 					 "5.2" : "2.4");
299 			continue;
300 		}
301 
302 		channel = &data->channels[n_channels];
303 		n_channels++;
304 
305 		channel->hw_value = nvm_chan[ch_idx];
306 		channel->band = (ch_idx < num_2ghz_channels) ?
307 				IEEE80211_BAND_2GHZ : IEEE80211_BAND_5GHZ;
308 		channel->center_freq =
309 			ieee80211_channel_to_frequency(
310 				channel->hw_value, channel->band);
311 
312 		/* Initialize regulatory-based run-time data */
313 
314 		/*
315 		 * Default value - highest tx power value.  max_power
316 		 * is not used in mvm, and is used for backwards compatibility
317 		 */
318 		channel->max_power = IWL_DEFAULT_MAX_TX_POWER;
319 		is_5ghz = channel->band == IEEE80211_BAND_5GHZ;
320 
321 		/* don't put limitations in case we're using LAR */
322 		if (!lar_supported)
323 			channel->flags = iwl_get_channel_flags(nvm_chan[ch_idx],
324 							       ch_idx, is_5ghz,
325 							       ch_flags, cfg);
326 		else
327 			channel->flags = 0;
328 
329 		IWL_DEBUG_EEPROM(dev,
330 				 "Ch. %d [%sGHz] %s%s%s%s%s%s%s(0x%02x %ddBm): Ad-Hoc %ssupported\n",
331 				 channel->hw_value,
332 				 is_5ghz ? "5.2" : "2.4",
333 				 CHECK_AND_PRINT_I(VALID),
334 				 CHECK_AND_PRINT_I(IBSS),
335 				 CHECK_AND_PRINT_I(ACTIVE),
336 				 CHECK_AND_PRINT_I(RADAR),
337 				 CHECK_AND_PRINT_I(WIDE),
338 				 CHECK_AND_PRINT_I(INDOOR_ONLY),
339 				 CHECK_AND_PRINT_I(GO_CONCURRENT),
340 				 ch_flags,
341 				 channel->max_power,
342 				 ((ch_flags & NVM_CHANNEL_IBSS) &&
343 				  !(ch_flags & NVM_CHANNEL_RADAR))
344 					? "" : "not ");
345 	}
346 
347 	return n_channels;
348 }
349 
350 static void iwl_init_vht_hw_capab(const struct iwl_cfg *cfg,
351 				  struct iwl_nvm_data *data,
352 				  struct ieee80211_sta_vht_cap *vht_cap,
353 				  u8 tx_chains, u8 rx_chains)
354 {
355 	int num_rx_ants = num_of_ant(rx_chains);
356 	int num_tx_ants = num_of_ant(tx_chains);
357 	unsigned int max_ampdu_exponent = (cfg->max_vht_ampdu_exponent ?:
358 					   IEEE80211_VHT_MAX_AMPDU_1024K);
359 
360 	vht_cap->vht_supported = true;
361 
362 	vht_cap->cap = IEEE80211_VHT_CAP_SHORT_GI_80 |
363 		       IEEE80211_VHT_CAP_RXSTBC_1 |
364 		       IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE |
365 		       3 << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT |
366 		       max_ampdu_exponent <<
367 		       IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;
368 
369 	if (cfg->ht_params->ldpc)
370 		vht_cap->cap |= IEEE80211_VHT_CAP_RXLDPC;
371 
372 	if (data->sku_cap_mimo_disabled) {
373 		num_rx_ants = 1;
374 		num_tx_ants = 1;
375 	}
376 
377 	if (num_tx_ants > 1)
378 		vht_cap->cap |= IEEE80211_VHT_CAP_TXSTBC;
379 	else
380 		vht_cap->cap |= IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN;
381 
382 	switch (iwlwifi_mod_params.amsdu_size) {
383 	case IWL_AMSDU_4K:
384 		vht_cap->cap |= IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_3895;
385 		break;
386 	case IWL_AMSDU_8K:
387 		vht_cap->cap |= IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991;
388 		break;
389 	case IWL_AMSDU_12K:
390 		vht_cap->cap |= IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454;
391 		break;
392 	default:
393 		break;
394 	}
395 
396 	vht_cap->vht_mcs.rx_mcs_map =
397 		cpu_to_le16(IEEE80211_VHT_MCS_SUPPORT_0_9 << 0 |
398 			    IEEE80211_VHT_MCS_SUPPORT_0_9 << 2 |
399 			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 4 |
400 			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 6 |
401 			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 8 |
402 			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 10 |
403 			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 12 |
404 			    IEEE80211_VHT_MCS_NOT_SUPPORTED << 14);
405 
406 	if (num_rx_ants == 1 || cfg->rx_with_siso_diversity) {
407 		vht_cap->cap |= IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN;
408 		/* this works because NOT_SUPPORTED == 3 */
409 		vht_cap->vht_mcs.rx_mcs_map |=
410 			cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << 2);
411 	}
412 
413 	vht_cap->vht_mcs.tx_mcs_map = vht_cap->vht_mcs.rx_mcs_map;
414 }
415 
416 static void iwl_init_sbands(struct device *dev, const struct iwl_cfg *cfg,
417 			    struct iwl_nvm_data *data,
418 			    const __le16 *ch_section,
419 			    u8 tx_chains, u8 rx_chains, bool lar_supported)
420 {
421 	int n_channels;
422 	int n_used = 0;
423 	struct ieee80211_supported_band *sband;
424 
425 	if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
426 		n_channels = iwl_init_channel_map(
427 				dev, cfg, data,
428 				&ch_section[NVM_CHANNELS], lar_supported);
429 	else
430 		n_channels = iwl_init_channel_map(
431 				dev, cfg, data,
432 				&ch_section[NVM_CHANNELS_FAMILY_8000],
433 				lar_supported);
434 
435 	sband = &data->bands[IEEE80211_BAND_2GHZ];
436 	sband->band = IEEE80211_BAND_2GHZ;
437 	sband->bitrates = &iwl_cfg80211_rates[RATES_24_OFFS];
438 	sband->n_bitrates = N_RATES_24;
439 	n_used += iwl_init_sband_channels(data, sband, n_channels,
440 					  IEEE80211_BAND_2GHZ);
441 	iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_2GHZ,
442 			     tx_chains, rx_chains);
443 
444 	sband = &data->bands[IEEE80211_BAND_5GHZ];
445 	sband->band = IEEE80211_BAND_5GHZ;
446 	sband->bitrates = &iwl_cfg80211_rates[RATES_52_OFFS];
447 	sband->n_bitrates = N_RATES_52;
448 	n_used += iwl_init_sband_channels(data, sband, n_channels,
449 					  IEEE80211_BAND_5GHZ);
450 	iwl_init_ht_hw_capab(cfg, data, &sband->ht_cap, IEEE80211_BAND_5GHZ,
451 			     tx_chains, rx_chains);
452 	if (data->sku_cap_11ac_enable)
453 		iwl_init_vht_hw_capab(cfg, data, &sband->vht_cap,
454 				      tx_chains, rx_chains);
455 
456 	if (n_channels != n_used)
457 		IWL_ERR_DEV(dev, "NVM: used only %d of %d channels\n",
458 			    n_used, n_channels);
459 }
460 
461 static int iwl_get_sku(const struct iwl_cfg *cfg, const __le16 *nvm_sw,
462 		       const __le16 *phy_sku)
463 {
464 	if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
465 		return le16_to_cpup(nvm_sw + SKU);
466 
467 	return le32_to_cpup((__le32 *)(phy_sku + SKU_FAMILY_8000));
468 }
469 
470 static int iwl_get_nvm_version(const struct iwl_cfg *cfg, const __le16 *nvm_sw)
471 {
472 	if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
473 		return le16_to_cpup(nvm_sw + NVM_VERSION);
474 	else
475 		return le32_to_cpup((__le32 *)(nvm_sw +
476 					       NVM_VERSION_FAMILY_8000));
477 }
478 
479 static int iwl_get_radio_cfg(const struct iwl_cfg *cfg, const __le16 *nvm_sw,
480 			     const __le16 *phy_sku)
481 {
482 	if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
483 		return le16_to_cpup(nvm_sw + RADIO_CFG);
484 
485 	return le32_to_cpup((__le32 *)(phy_sku + RADIO_CFG_FAMILY_8000));
486 
487 }
488 
489 static int iwl_get_n_hw_addrs(const struct iwl_cfg *cfg, const __le16 *nvm_sw)
490 {
491 	int n_hw_addr;
492 
493 	if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
494 		return le16_to_cpup(nvm_sw + N_HW_ADDRS);
495 
496 	n_hw_addr = le32_to_cpup((__le32 *)(nvm_sw + N_HW_ADDRS_FAMILY_8000));
497 
498 	return n_hw_addr & N_HW_ADDR_MASK;
499 }
500 
501 static void iwl_set_radio_cfg(const struct iwl_cfg *cfg,
502 			      struct iwl_nvm_data *data,
503 			      u32 radio_cfg)
504 {
505 	if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
506 		data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK(radio_cfg);
507 		data->radio_cfg_step = NVM_RF_CFG_STEP_MSK(radio_cfg);
508 		data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK(radio_cfg);
509 		data->radio_cfg_pnum = NVM_RF_CFG_PNUM_MSK(radio_cfg);
510 		return;
511 	}
512 
513 	/* set the radio configuration for family 8000 */
514 	data->radio_cfg_type = NVM_RF_CFG_TYPE_MSK_FAMILY_8000(radio_cfg);
515 	data->radio_cfg_step = NVM_RF_CFG_STEP_MSK_FAMILY_8000(radio_cfg);
516 	data->radio_cfg_dash = NVM_RF_CFG_DASH_MSK_FAMILY_8000(radio_cfg);
517 	data->radio_cfg_pnum = NVM_RF_CFG_FLAVOR_MSK_FAMILY_8000(radio_cfg);
518 	data->valid_tx_ant = NVM_RF_CFG_TX_ANT_MSK_FAMILY_8000(radio_cfg);
519 	data->valid_rx_ant = NVM_RF_CFG_RX_ANT_MSK_FAMILY_8000(radio_cfg);
520 }
521 
522 static void iwl_set_hw_address(const struct iwl_cfg *cfg,
523 			       struct iwl_nvm_data *data,
524 			       const __le16 *nvm_sec)
525 {
526 	const u8 *hw_addr = (const u8 *)(nvm_sec + HW_ADDR);
527 
528 	/* The byte order is little endian 16 bit, meaning 214365 */
529 	data->hw_addr[0] = hw_addr[1];
530 	data->hw_addr[1] = hw_addr[0];
531 	data->hw_addr[2] = hw_addr[3];
532 	data->hw_addr[3] = hw_addr[2];
533 	data->hw_addr[4] = hw_addr[5];
534 	data->hw_addr[5] = hw_addr[4];
535 }
536 
537 static void iwl_set_hw_address_family_8000(struct device *dev,
538 					   const struct iwl_cfg *cfg,
539 					   struct iwl_nvm_data *data,
540 					   const __le16 *mac_override,
541 					   const __le16 *nvm_hw,
542 					   u32 mac_addr0, u32 mac_addr1)
543 {
544 	const u8 *hw_addr;
545 
546 	if (mac_override) {
547 		static const u8 reserved_mac[] = {
548 			0x02, 0xcc, 0xaa, 0xff, 0xee, 0x00
549 		};
550 
551 		hw_addr = (const u8 *)(mac_override +
552 				 MAC_ADDRESS_OVERRIDE_FAMILY_8000);
553 
554 		/*
555 		 * Store the MAC address from MAO section.
556 		 * No byte swapping is required in MAO section
557 		 */
558 		memcpy(data->hw_addr, hw_addr, ETH_ALEN);
559 
560 		/*
561 		 * Force the use of the OTP MAC address in case of reserved MAC
562 		 * address in the NVM, or if address is given but invalid.
563 		 */
564 		if (is_valid_ether_addr(data->hw_addr) &&
565 		    memcmp(reserved_mac, hw_addr, ETH_ALEN) != 0)
566 			return;
567 
568 		IWL_ERR_DEV(dev,
569 			    "mac address from nvm override section is not valid\n");
570 	}
571 
572 	if (nvm_hw) {
573 		/* read the MAC address from HW resisters */
574 		hw_addr = (const u8 *)&mac_addr0;
575 		data->hw_addr[0] = hw_addr[3];
576 		data->hw_addr[1] = hw_addr[2];
577 		data->hw_addr[2] = hw_addr[1];
578 		data->hw_addr[3] = hw_addr[0];
579 
580 		hw_addr = (const u8 *)&mac_addr1;
581 		data->hw_addr[4] = hw_addr[1];
582 		data->hw_addr[5] = hw_addr[0];
583 
584 		if (!is_valid_ether_addr(data->hw_addr))
585 			IWL_ERR_DEV(dev,
586 				    "mac address from hw section is not valid\n");
587 
588 		return;
589 	}
590 
591 	IWL_ERR_DEV(dev, "mac address is not found\n");
592 }
593 
594 struct iwl_nvm_data *
595 iwl_parse_nvm_data(struct device *dev, const struct iwl_cfg *cfg,
596 		   const __le16 *nvm_hw, const __le16 *nvm_sw,
597 		   const __le16 *nvm_calib, const __le16 *regulatory,
598 		   const __le16 *mac_override, const __le16 *phy_sku,
599 		   u8 tx_chains, u8 rx_chains, bool lar_fw_supported,
600 		   u32 mac_addr0, u32 mac_addr1)
601 {
602 	struct iwl_nvm_data *data;
603 	u32 sku;
604 	u32 radio_cfg;
605 	u16 lar_config;
606 
607 	if (cfg->device_family != IWL_DEVICE_FAMILY_8000)
608 		data = kzalloc(sizeof(*data) +
609 			       sizeof(struct ieee80211_channel) *
610 			       IWL_NUM_CHANNELS,
611 			       GFP_KERNEL);
612 	else
613 		data = kzalloc(sizeof(*data) +
614 			       sizeof(struct ieee80211_channel) *
615 			       IWL_NUM_CHANNELS_FAMILY_8000,
616 			       GFP_KERNEL);
617 	if (!data)
618 		return NULL;
619 
620 	data->nvm_version = iwl_get_nvm_version(cfg, nvm_sw);
621 
622 	radio_cfg = iwl_get_radio_cfg(cfg, nvm_sw, phy_sku);
623 	iwl_set_radio_cfg(cfg, data, radio_cfg);
624 	if (data->valid_tx_ant)
625 		tx_chains &= data->valid_tx_ant;
626 	if (data->valid_rx_ant)
627 		rx_chains &= data->valid_rx_ant;
628 
629 	sku = iwl_get_sku(cfg, nvm_sw, phy_sku);
630 	data->sku_cap_band_24GHz_enable = sku & NVM_SKU_CAP_BAND_24GHZ;
631 	data->sku_cap_band_52GHz_enable = sku & NVM_SKU_CAP_BAND_52GHZ;
632 	data->sku_cap_11n_enable = sku & NVM_SKU_CAP_11N_ENABLE;
633 	if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_ALL)
634 		data->sku_cap_11n_enable = false;
635 	data->sku_cap_11ac_enable = data->sku_cap_11n_enable &&
636 				    (sku & NVM_SKU_CAP_11AC_ENABLE);
637 	data->sku_cap_mimo_disabled = sku & NVM_SKU_CAP_MIMO_DISABLE;
638 
639 	data->n_hw_addrs = iwl_get_n_hw_addrs(cfg, nvm_sw);
640 
641 	if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
642 		/* Checking for required sections */
643 		if (!nvm_calib) {
644 			IWL_ERR_DEV(dev,
645 				    "Can't parse empty Calib NVM sections\n");
646 			kfree(data);
647 			return NULL;
648 		}
649 		/* in family 8000 Xtal calibration values moved to OTP */
650 		data->xtal_calib[0] = *(nvm_calib + XTAL_CALIB);
651 		data->xtal_calib[1] = *(nvm_calib + XTAL_CALIB + 1);
652 	}
653 
654 	if (cfg->device_family != IWL_DEVICE_FAMILY_8000) {
655 		iwl_set_hw_address(cfg, data, nvm_hw);
656 
657 		iwl_init_sbands(dev, cfg, data, nvm_sw,
658 				tx_chains, rx_chains, lar_fw_supported);
659 	} else {
660 		u16 lar_offset = data->nvm_version < 0xE39 ?
661 				 NVM_LAR_OFFSET_FAMILY_8000_OLD :
662 				 NVM_LAR_OFFSET_FAMILY_8000;
663 
664 		lar_config = le16_to_cpup(regulatory + lar_offset);
665 		data->lar_enabled = !!(lar_config &
666 				       NVM_LAR_ENABLED_FAMILY_8000);
667 
668 		/* MAC address in family 8000 */
669 		iwl_set_hw_address_family_8000(dev, cfg, data, mac_override,
670 					       nvm_hw, mac_addr0, mac_addr1);
671 
672 		iwl_init_sbands(dev, cfg, data, regulatory,
673 				tx_chains, rx_chains,
674 				lar_fw_supported && data->lar_enabled);
675 	}
676 
677 	data->calib_version = 255;
678 
679 	return data;
680 }
681 IWL_EXPORT_SYMBOL(iwl_parse_nvm_data);
682 
683 static u32 iwl_nvm_get_regdom_bw_flags(const u8 *nvm_chan,
684 				       int ch_idx, u16 nvm_flags,
685 				       const struct iwl_cfg *cfg)
686 {
687 	u32 flags = NL80211_RRF_NO_HT40;
688 	u32 last_5ghz_ht = LAST_5GHZ_HT;
689 
690 	if (cfg->device_family == IWL_DEVICE_FAMILY_8000)
691 		last_5ghz_ht = LAST_5GHZ_HT_FAMILY_8000;
692 
693 	if (ch_idx < NUM_2GHZ_CHANNELS &&
694 	    (nvm_flags & NVM_CHANNEL_40MHZ)) {
695 		if (nvm_chan[ch_idx] <= LAST_2GHZ_HT_PLUS)
696 			flags &= ~NL80211_RRF_NO_HT40PLUS;
697 		if (nvm_chan[ch_idx] >= FIRST_2GHZ_HT_MINUS)
698 			flags &= ~NL80211_RRF_NO_HT40MINUS;
699 	} else if (nvm_chan[ch_idx] <= last_5ghz_ht &&
700 		   (nvm_flags & NVM_CHANNEL_40MHZ)) {
701 		if ((ch_idx - NUM_2GHZ_CHANNELS) % 2 == 0)
702 			flags &= ~NL80211_RRF_NO_HT40PLUS;
703 		else
704 			flags &= ~NL80211_RRF_NO_HT40MINUS;
705 	}
706 
707 	if (!(nvm_flags & NVM_CHANNEL_80MHZ))
708 		flags |= NL80211_RRF_NO_80MHZ;
709 	if (!(nvm_flags & NVM_CHANNEL_160MHZ))
710 		flags |= NL80211_RRF_NO_160MHZ;
711 
712 	if (!(nvm_flags & NVM_CHANNEL_ACTIVE))
713 		flags |= NL80211_RRF_NO_IR;
714 
715 	if (nvm_flags & NVM_CHANNEL_RADAR)
716 		flags |= NL80211_RRF_DFS;
717 
718 	if (nvm_flags & NVM_CHANNEL_INDOOR_ONLY)
719 		flags |= NL80211_RRF_NO_OUTDOOR;
720 
721 	/* Set the GO concurrent flag only in case that NO_IR is set.
722 	 * Otherwise it is meaningless
723 	 */
724 	if ((nvm_flags & NVM_CHANNEL_GO_CONCURRENT) &&
725 	    (flags & NL80211_RRF_NO_IR))
726 		flags |= NL80211_RRF_GO_CONCURRENT;
727 
728 	return flags;
729 }
730 
731 struct ieee80211_regdomain *
732 iwl_parse_nvm_mcc_info(struct device *dev, const struct iwl_cfg *cfg,
733 		       int num_of_ch, __le32 *channels, u16 fw_mcc)
734 {
735 	int ch_idx;
736 	u16 ch_flags, prev_ch_flags = 0;
737 	const u8 *nvm_chan = cfg->device_family == IWL_DEVICE_FAMILY_8000 ?
738 			     iwl_nvm_channels_family_8000 : iwl_nvm_channels;
739 	struct ieee80211_regdomain *regd;
740 	int size_of_regd;
741 	struct ieee80211_reg_rule *rule;
742 	enum ieee80211_band band;
743 	int center_freq, prev_center_freq = 0;
744 	int valid_rules = 0;
745 	bool new_rule;
746 	int max_num_ch = cfg->device_family == IWL_DEVICE_FAMILY_8000 ?
747 			 IWL_NUM_CHANNELS_FAMILY_8000 : IWL_NUM_CHANNELS;
748 
749 	if (WARN_ON_ONCE(num_of_ch > NL80211_MAX_SUPP_REG_RULES))
750 		return ERR_PTR(-EINVAL);
751 
752 	if (WARN_ON(num_of_ch > max_num_ch))
753 		num_of_ch = max_num_ch;
754 
755 	IWL_DEBUG_DEV(dev, IWL_DL_LAR, "building regdom for %d channels\n",
756 		      num_of_ch);
757 
758 	/* build a regdomain rule for every valid channel */
759 	size_of_regd =
760 		sizeof(struct ieee80211_regdomain) +
761 		num_of_ch * sizeof(struct ieee80211_reg_rule);
762 
763 	regd = kzalloc(size_of_regd, GFP_KERNEL);
764 	if (!regd)
765 		return ERR_PTR(-ENOMEM);
766 
767 	for (ch_idx = 0; ch_idx < num_of_ch; ch_idx++) {
768 		ch_flags = (u16)__le32_to_cpup(channels + ch_idx);
769 		band = (ch_idx < NUM_2GHZ_CHANNELS) ?
770 		       IEEE80211_BAND_2GHZ : IEEE80211_BAND_5GHZ;
771 		center_freq = ieee80211_channel_to_frequency(nvm_chan[ch_idx],
772 							     band);
773 		new_rule = false;
774 
775 		if (!(ch_flags & NVM_CHANNEL_VALID)) {
776 			IWL_DEBUG_DEV(dev, IWL_DL_LAR,
777 				      "Ch. %d Flags %x [%sGHz] - No traffic\n",
778 				      nvm_chan[ch_idx],
779 				      ch_flags,
780 				      (ch_idx >= NUM_2GHZ_CHANNELS) ?
781 				      "5.2" : "2.4");
782 			continue;
783 		}
784 
785 		/* we can't continue the same rule */
786 		if (ch_idx == 0 || prev_ch_flags != ch_flags ||
787 		    center_freq - prev_center_freq > 20) {
788 			valid_rules++;
789 			new_rule = true;
790 		}
791 
792 		rule = &regd->reg_rules[valid_rules - 1];
793 
794 		if (new_rule)
795 			rule->freq_range.start_freq_khz =
796 						MHZ_TO_KHZ(center_freq - 10);
797 
798 		rule->freq_range.end_freq_khz = MHZ_TO_KHZ(center_freq + 10);
799 
800 		/* this doesn't matter - not used by FW */
801 		rule->power_rule.max_antenna_gain = DBI_TO_MBI(6);
802 		rule->power_rule.max_eirp =
803 			DBM_TO_MBM(IWL_DEFAULT_MAX_TX_POWER);
804 
805 		rule->flags = iwl_nvm_get_regdom_bw_flags(nvm_chan, ch_idx,
806 							  ch_flags, cfg);
807 
808 		/* rely on auto-calculation to merge BW of contiguous chans */
809 		rule->flags |= NL80211_RRF_AUTO_BW;
810 		rule->freq_range.max_bandwidth_khz = 0;
811 
812 		prev_ch_flags = ch_flags;
813 		prev_center_freq = center_freq;
814 
815 		IWL_DEBUG_DEV(dev, IWL_DL_LAR,
816 			      "Ch. %d [%sGHz] %s%s%s%s%s%s%s%s%s(0x%02x): Ad-Hoc %ssupported\n",
817 			      center_freq,
818 			      band == IEEE80211_BAND_5GHZ ? "5.2" : "2.4",
819 			      CHECK_AND_PRINT_I(VALID),
820 			      CHECK_AND_PRINT_I(ACTIVE),
821 			      CHECK_AND_PRINT_I(RADAR),
822 			      CHECK_AND_PRINT_I(WIDE),
823 			      CHECK_AND_PRINT_I(40MHZ),
824 			      CHECK_AND_PRINT_I(80MHZ),
825 			      CHECK_AND_PRINT_I(160MHZ),
826 			      CHECK_AND_PRINT_I(INDOOR_ONLY),
827 			      CHECK_AND_PRINT_I(GO_CONCURRENT),
828 			      ch_flags,
829 			      ((ch_flags & NVM_CHANNEL_ACTIVE) &&
830 			       !(ch_flags & NVM_CHANNEL_RADAR))
831 					 ? "" : "not ");
832 	}
833 
834 	regd->n_reg_rules = valid_rules;
835 
836 	/* set alpha2 from FW. */
837 	regd->alpha2[0] = fw_mcc >> 8;
838 	regd->alpha2[1] = fw_mcc & 0xff;
839 
840 	return regd;
841 }
842 IWL_EXPORT_SYMBOL(iwl_parse_nvm_mcc_info);
843