18e99ea8dSJohannes Berg // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
28e99ea8dSJohannes Berg /*
34f7411d6SRoee Goldfiner  * Copyright (C) 2005-2014, 2018-2021 Intel Corporation
48e99ea8dSJohannes Berg  * Copyright (C) 2013-2015 Intel Mobile Communications GmbH
58e99ea8dSJohannes Berg  * Copyright (C) 2016-2017 Intel Deutschland GmbH
68e99ea8dSJohannes Berg  */
7e705c121SKalle Valo #include <linux/completion.h>
8e705c121SKalle Valo #include <linux/dma-mapping.h>
9e705c121SKalle Valo #include <linux/firmware.h>
10e705c121SKalle Valo #include <linux/module.h>
11e705c121SKalle Valo #include <linux/vmalloc.h>
12e705c121SKalle Valo 
13e705c121SKalle Valo #include "iwl-drv.h"
14e705c121SKalle Valo #include "iwl-csr.h"
15e705c121SKalle Valo #include "iwl-debug.h"
16e705c121SKalle Valo #include "iwl-trans.h"
17e705c121SKalle Valo #include "iwl-op-mode.h"
18e705c121SKalle Valo #include "iwl-agn-hw.h"
19d962f9b1SJohannes Berg #include "fw/img.h"
20f14cda6fSSara Sharon #include "iwl-dbg-tlv.h"
21e705c121SKalle Valo #include "iwl-config.h"
22e705c121SKalle Valo #include "iwl-modparams.h"
2322463857SShahar S Matityahu #include "fw/api/alive.h"
24be9ae34eSNathan Errera #include "fw/api/mac.h"
25e705c121SKalle Valo 
26e705c121SKalle Valo /******************************************************************************
27e705c121SKalle Valo  *
28e705c121SKalle Valo  * module boiler plate
29e705c121SKalle Valo  *
30e705c121SKalle Valo  ******************************************************************************/
31e705c121SKalle Valo 
32e705c121SKalle Valo #define DRV_DESCRIPTION	"Intel(R) Wireless WiFi driver for Linux"
33e705c121SKalle Valo MODULE_DESCRIPTION(DRV_DESCRIPTION);
34e705c121SKalle Valo MODULE_LICENSE("GPL");
35e705c121SKalle Valo 
36e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS
37e705c121SKalle Valo static struct dentry *iwl_dbgfs_root;
38e705c121SKalle Valo #endif
39e705c121SKalle Valo 
40e705c121SKalle Valo /**
41e705c121SKalle Valo  * struct iwl_drv - drv common data
42e705c121SKalle Valo  * @list: list of drv structures using this opmode
43e705c121SKalle Valo  * @fw: the iwl_fw structure
44e705c121SKalle Valo  * @op_mode: the running op_mode
45e705c121SKalle Valo  * @trans: transport layer
46e705c121SKalle Valo  * @dev: for debug prints only
47e705c121SKalle Valo  * @fw_index: firmware revision to try loading
48e705c121SKalle Valo  * @firmware_name: composite filename of ucode file to load
49e705c121SKalle Valo  * @request_firmware_complete: the firmware has been obtained from user space
507d4ced86SLee Jones  * @dbgfs_drv: debugfs root directory entry
517d4ced86SLee Jones  * @dbgfs_trans: debugfs transport directory entry
527d4ced86SLee Jones  * @dbgfs_op_mode: debugfs op_mode directory entry
53e705c121SKalle Valo  */
54e705c121SKalle Valo struct iwl_drv {
55e705c121SKalle Valo 	struct list_head list;
56e705c121SKalle Valo 	struct iwl_fw fw;
57e705c121SKalle Valo 
58e705c121SKalle Valo 	struct iwl_op_mode *op_mode;
59e705c121SKalle Valo 	struct iwl_trans *trans;
60e705c121SKalle Valo 	struct device *dev;
61e705c121SKalle Valo 
62e705c121SKalle Valo 	int fw_index;                   /* firmware we're trying to load */
630730ffb1SHaim Dreyfuss 	char firmware_name[64];         /* name of firmware file to load */
64e705c121SKalle Valo 
65e705c121SKalle Valo 	struct completion request_firmware_complete;
66e705c121SKalle Valo 
67e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS
68e705c121SKalle Valo 	struct dentry *dbgfs_drv;
69e705c121SKalle Valo 	struct dentry *dbgfs_trans;
70e705c121SKalle Valo 	struct dentry *dbgfs_op_mode;
71e705c121SKalle Valo #endif
72e705c121SKalle Valo };
73e705c121SKalle Valo 
74e705c121SKalle Valo enum {
756d48fcd9SJohannes Berg 	DVM_OP_MODE,
766d48fcd9SJohannes Berg 	MVM_OP_MODE,
77e705c121SKalle Valo };
78e705c121SKalle Valo 
79e705c121SKalle Valo /* Protects the table contents, i.e. the ops pointer & drv list */
805993c90cSZheng Yongjun static DEFINE_MUTEX(iwlwifi_opmode_table_mtx);
81e705c121SKalle Valo static struct iwlwifi_opmode_table {
82e705c121SKalle Valo 	const char *name;			/* name: iwldvm, iwlmvm, etc */
83e705c121SKalle Valo 	const struct iwl_op_mode_ops *ops;	/* pointer to op_mode ops */
84e705c121SKalle Valo 	struct list_head drv;		/* list of devices using this op_mode */
85e705c121SKalle Valo } iwlwifi_opmode_table[] = {		/* ops set when driver is initialized */
86e705c121SKalle Valo 	[DVM_OP_MODE] = { .name = "iwldvm", .ops = NULL },
87e705c121SKalle Valo 	[MVM_OP_MODE] = { .name = "iwlmvm", .ops = NULL },
88e705c121SKalle Valo };
89e705c121SKalle Valo 
90e705c121SKalle Valo #define IWL_DEFAULT_SCAN_CHANNELS 40
91e705c121SKalle Valo 
92e705c121SKalle Valo /*
93e705c121SKalle Valo  * struct fw_sec: Just for the image parsing process.
94e705c121SKalle Valo  * For the fw storage we are using struct fw_desc.
95e705c121SKalle Valo  */
96e705c121SKalle Valo struct fw_sec {
97e705c121SKalle Valo 	const void *data;		/* the sec data */
98e705c121SKalle Valo 	size_t size;			/* section size */
99e705c121SKalle Valo 	u32 offset;			/* offset of writing in the device */
100e705c121SKalle Valo };
101e705c121SKalle Valo 
102e705c121SKalle Valo static void iwl_free_fw_desc(struct iwl_drv *drv, struct fw_desc *desc)
103e705c121SKalle Valo {
104e705c121SKalle Valo 	vfree(desc->data);
105e705c121SKalle Valo 	desc->data = NULL;
106e705c121SKalle Valo 	desc->len = 0;
107e705c121SKalle Valo }
108e705c121SKalle Valo 
109e705c121SKalle Valo static void iwl_free_fw_img(struct iwl_drv *drv, struct fw_img *img)
110e705c121SKalle Valo {
111e705c121SKalle Valo 	int i;
112eef187a7SSara Sharon 	for (i = 0; i < img->num_sec; i++)
113e705c121SKalle Valo 		iwl_free_fw_desc(drv, &img->sec[i]);
114eef187a7SSara Sharon 	kfree(img->sec);
115e705c121SKalle Valo }
116e705c121SKalle Valo 
117e705c121SKalle Valo static void iwl_dealloc_ucode(struct iwl_drv *drv)
118e705c121SKalle Valo {
119e705c121SKalle Valo 	int i;
120e705c121SKalle Valo 
12117b809c9SSara Sharon 	kfree(drv->fw.dbg.dest_tlv);
12217b809c9SSara Sharon 	for (i = 0; i < ARRAY_SIZE(drv->fw.dbg.conf_tlv); i++)
12317b809c9SSara Sharon 		kfree(drv->fw.dbg.conf_tlv[i]);
12417b809c9SSara Sharon 	for (i = 0; i < ARRAY_SIZE(drv->fw.dbg.trigger_tlv); i++)
12517b809c9SSara Sharon 		kfree(drv->fw.dbg.trigger_tlv[i]);
12617b809c9SSara Sharon 	kfree(drv->fw.dbg.mem_tlv);
127132db31cSGolan Ben-Ami 	kfree(drv->fw.iml);
128b081e23cSJohannes Berg 	kfree(drv->fw.ucode_capa.cmd_versions);
129a1d59263SDror Moshe 	kfree(drv->fw.phy_integration_ver);
130e705c121SKalle Valo 
131e705c121SKalle Valo 	for (i = 0; i < IWL_UCODE_TYPE_MAX; i++)
132e705c121SKalle Valo 		iwl_free_fw_img(drv, drv->fw.img + i);
133e705c121SKalle Valo }
134e705c121SKalle Valo 
135e705c121SKalle Valo static int iwl_alloc_fw_desc(struct iwl_drv *drv, struct fw_desc *desc,
136e705c121SKalle Valo 			     struct fw_sec *sec)
137e705c121SKalle Valo {
138e705c121SKalle Valo 	void *data;
139e705c121SKalle Valo 
140e705c121SKalle Valo 	desc->data = NULL;
141e705c121SKalle Valo 
142e705c121SKalle Valo 	if (!sec || !sec->size)
143e705c121SKalle Valo 		return -EINVAL;
144e705c121SKalle Valo 
145e705c121SKalle Valo 	data = vmalloc(sec->size);
146e705c121SKalle Valo 	if (!data)
147e705c121SKalle Valo 		return -ENOMEM;
148e705c121SKalle Valo 
149e705c121SKalle Valo 	desc->len = sec->size;
150e705c121SKalle Valo 	desc->offset = sec->offset;
151e705c121SKalle Valo 	memcpy(data, sec->data, desc->len);
152e705c121SKalle Valo 	desc->data = data;
153e705c121SKalle Valo 
154e705c121SKalle Valo 	return 0;
155e705c121SKalle Valo }
156e705c121SKalle Valo 
157e705c121SKalle Valo static void iwl_req_fw_callback(const struct firmware *ucode_raw,
158e705c121SKalle Valo 				void *context);
159e705c121SKalle Valo 
160e705c121SKalle Valo static int iwl_request_firmware(struct iwl_drv *drv, bool first)
161e705c121SKalle Valo {
1626ffff630SLuca Coelho 	const struct iwl_cfg *cfg = drv->trans->cfg;
163e705c121SKalle Valo 	char tag[8];
1645da083d1SLiad Kaufman 
165286ca8ebSLuca Coelho 	if (drv->trans->trans_cfg->device_family == IWL_DEVICE_FAMILY_9000 &&
166b7226f10SLuca Coelho 	    (CSR_HW_REV_STEP(drv->trans->hw_rev) != SILICON_B_STEP &&
167b7226f10SLuca Coelho 	     CSR_HW_REV_STEP(drv->trans->hw_rev) != SILICON_C_STEP)) {
168b7226f10SLuca Coelho 		IWL_ERR(drv,
169b7226f10SLuca Coelho 			"Only HW steps B and C are currently supported (0x%0x)\n",
170b7226f10SLuca Coelho 			drv->trans->hw_rev);
171b7226f10SLuca Coelho 		return -EINVAL;
172b7226f10SLuca Coelho 	}
173e705c121SKalle Valo 
174e705c121SKalle Valo 	if (first) {
1756ffff630SLuca Coelho 		drv->fw_index = cfg->ucode_api_max;
176e705c121SKalle Valo 		sprintf(tag, "%d", drv->fw_index);
177e705c121SKalle Valo 	} else {
178e705c121SKalle Valo 		drv->fw_index--;
179e705c121SKalle Valo 		sprintf(tag, "%d", drv->fw_index);
180e705c121SKalle Valo 	}
181e705c121SKalle Valo 
1826ffff630SLuca Coelho 	if (drv->fw_index < cfg->ucode_api_min) {
183e705c121SKalle Valo 		IWL_ERR(drv, "no suitable firmware found!\n");
1846ffff630SLuca Coelho 
1856ffff630SLuca Coelho 		if (cfg->ucode_api_min == cfg->ucode_api_max) {
186b7226f10SLuca Coelho 			IWL_ERR(drv, "%s%d is required\n", cfg->fw_name_pre,
1876ffff630SLuca Coelho 				cfg->ucode_api_max);
1886ffff630SLuca Coelho 		} else {
1896ffff630SLuca Coelho 			IWL_ERR(drv, "minimum version required: %s%d\n",
190b7226f10SLuca Coelho 				cfg->fw_name_pre, cfg->ucode_api_min);
1916ffff630SLuca Coelho 			IWL_ERR(drv, "maximum version supported: %s%d\n",
192b7226f10SLuca Coelho 				cfg->fw_name_pre, cfg->ucode_api_max);
1936ffff630SLuca Coelho 		}
1946ffff630SLuca Coelho 
1956ffff630SLuca Coelho 		IWL_ERR(drv,
1966ffff630SLuca Coelho 			"check git://git.kernel.org/pub/scm/linux/kernel/git/firmware/linux-firmware.git\n");
197e705c121SKalle Valo 		return -ENOENT;
198e705c121SKalle Valo 	}
199e705c121SKalle Valo 
200e705c121SKalle Valo 	snprintf(drv->firmware_name, sizeof(drv->firmware_name), "%s%s.ucode",
201b7226f10SLuca Coelho 		 cfg->fw_name_pre, tag);
202e705c121SKalle Valo 
2032953c393SShahar S Matityahu 	IWL_DEBUG_FW_INFO(drv, "attempting to load firmware '%s'\n",
204e705c121SKalle Valo 			  drv->firmware_name);
205e705c121SKalle Valo 
206e705c121SKalle Valo 	return request_firmware_nowait(THIS_MODULE, 1, drv->firmware_name,
207e705c121SKalle Valo 				       drv->trans->dev,
208e705c121SKalle Valo 				       GFP_KERNEL, drv, iwl_req_fw_callback);
209e705c121SKalle Valo }
210e705c121SKalle Valo 
211e705c121SKalle Valo struct fw_img_parsing {
212eef187a7SSara Sharon 	struct fw_sec *sec;
213e705c121SKalle Valo 	int sec_counter;
214e705c121SKalle Valo };
215e705c121SKalle Valo 
216e705c121SKalle Valo /*
217e705c121SKalle Valo  * struct fw_sec_parsing: to extract fw section and it's offset from tlv
218e705c121SKalle Valo  */
219e705c121SKalle Valo struct fw_sec_parsing {
220e705c121SKalle Valo 	__le32 offset;
221e705c121SKalle Valo 	const u8 data[];
222e705c121SKalle Valo } __packed;
223e705c121SKalle Valo 
224e705c121SKalle Valo /**
225e705c121SKalle Valo  * struct iwl_tlv_calib_data - parse the default calib data from TLV
226e705c121SKalle Valo  *
227e705c121SKalle Valo  * @ucode_type: the uCode to which the following default calib relates.
228e705c121SKalle Valo  * @calib: default calibrations.
229e705c121SKalle Valo  */
230e705c121SKalle Valo struct iwl_tlv_calib_data {
231e705c121SKalle Valo 	__le32 ucode_type;
232e705c121SKalle Valo 	struct iwl_tlv_calib_ctrl calib;
233e705c121SKalle Valo } __packed;
234e705c121SKalle Valo 
235e705c121SKalle Valo struct iwl_firmware_pieces {
236e705c121SKalle Valo 	struct fw_img_parsing img[IWL_UCODE_TYPE_MAX];
237e705c121SKalle Valo 
238e705c121SKalle Valo 	u32 init_evtlog_ptr, init_evtlog_size, init_errlog_ptr;
239e705c121SKalle Valo 	u32 inst_evtlog_ptr, inst_evtlog_size, inst_errlog_ptr;
240e705c121SKalle Valo 
241e705c121SKalle Valo 	/* FW debug data parsed for driver usage */
242fd527eb5SGolan Ben Ami 	bool dbg_dest_tlv_init;
243fd527eb5SGolan Ben Ami 	u8 *dbg_dest_ver;
244fd527eb5SGolan Ben Ami 	union {
245e705c121SKalle Valo 		struct iwl_fw_dbg_dest_tlv *dbg_dest_tlv;
246fd527eb5SGolan Ben Ami 		struct iwl_fw_dbg_dest_tlv_v1 *dbg_dest_tlv_v1;
247fd527eb5SGolan Ben Ami 	};
248e705c121SKalle Valo 	struct iwl_fw_dbg_conf_tlv *dbg_conf_tlv[FW_DBG_CONF_MAX];
249e705c121SKalle Valo 	size_t dbg_conf_tlv_len[FW_DBG_CONF_MAX];
250e705c121SKalle Valo 	struct iwl_fw_dbg_trigger_tlv *dbg_trigger_tlv[FW_DBG_TRIGGER_MAX];
251e705c121SKalle Valo 	size_t dbg_trigger_tlv_len[FW_DBG_TRIGGER_MAX];
2522ed1e019SJohannes Berg 	struct iwl_fw_dbg_mem_seg_tlv *dbg_mem_tlv;
25317b809c9SSara Sharon 	size_t n_mem_tlv;
254e705c121SKalle Valo };
255e705c121SKalle Valo 
256e705c121SKalle Valo /*
257e705c121SKalle Valo  * These functions are just to extract uCode section data from the pieces
258e705c121SKalle Valo  * structure.
259e705c121SKalle Valo  */
260e705c121SKalle Valo static struct fw_sec *get_sec(struct iwl_firmware_pieces *pieces,
261e705c121SKalle Valo 			      enum iwl_ucode_type type,
262e705c121SKalle Valo 			      int  sec)
263e705c121SKalle Valo {
264e705c121SKalle Valo 	return &pieces->img[type].sec[sec];
265e705c121SKalle Valo }
266e705c121SKalle Valo 
267d546530eSSara Sharon static void alloc_sec_data(struct iwl_firmware_pieces *pieces,
268d546530eSSara Sharon 			   enum iwl_ucode_type type,
269d546530eSSara Sharon 			   int sec)
270d546530eSSara Sharon {
271d546530eSSara Sharon 	struct fw_img_parsing *img = &pieces->img[type];
272d546530eSSara Sharon 	struct fw_sec *sec_memory;
273d546530eSSara Sharon 	int size = sec + 1;
274d546530eSSara Sharon 	size_t alloc_size = sizeof(*img->sec) * size;
275d546530eSSara Sharon 
276d546530eSSara Sharon 	if (img->sec && img->sec_counter >= size)
277d546530eSSara Sharon 		return;
278d546530eSSara Sharon 
279d546530eSSara Sharon 	sec_memory = krealloc(img->sec, alloc_size, GFP_KERNEL);
280d546530eSSara Sharon 	if (!sec_memory)
281d546530eSSara Sharon 		return;
282d546530eSSara Sharon 
283d546530eSSara Sharon 	img->sec = sec_memory;
284d546530eSSara Sharon 	img->sec_counter = size;
285d546530eSSara Sharon }
286d546530eSSara Sharon 
287e705c121SKalle Valo static void set_sec_data(struct iwl_firmware_pieces *pieces,
288e705c121SKalle Valo 			 enum iwl_ucode_type type,
289e705c121SKalle Valo 			 int sec,
290e705c121SKalle Valo 			 const void *data)
291e705c121SKalle Valo {
292d546530eSSara Sharon 	alloc_sec_data(pieces, type, sec);
293d546530eSSara Sharon 
294e705c121SKalle Valo 	pieces->img[type].sec[sec].data = data;
295e705c121SKalle Valo }
296e705c121SKalle Valo 
297e705c121SKalle Valo static void set_sec_size(struct iwl_firmware_pieces *pieces,
298e705c121SKalle Valo 			 enum iwl_ucode_type type,
299e705c121SKalle Valo 			 int sec,
300e705c121SKalle Valo 			 size_t size)
301e705c121SKalle Valo {
302d546530eSSara Sharon 	alloc_sec_data(pieces, type, sec);
303d546530eSSara Sharon 
304e705c121SKalle Valo 	pieces->img[type].sec[sec].size = size;
305e705c121SKalle Valo }
306e705c121SKalle Valo 
307e705c121SKalle Valo static size_t get_sec_size(struct iwl_firmware_pieces *pieces,
308e705c121SKalle Valo 			   enum iwl_ucode_type type,
309e705c121SKalle Valo 			   int sec)
310e705c121SKalle Valo {
311e705c121SKalle Valo 	return pieces->img[type].sec[sec].size;
312e705c121SKalle Valo }
313e705c121SKalle Valo 
314e705c121SKalle Valo static void set_sec_offset(struct iwl_firmware_pieces *pieces,
315e705c121SKalle Valo 			   enum iwl_ucode_type type,
316e705c121SKalle Valo 			   int sec,
317e705c121SKalle Valo 			   u32 offset)
318e705c121SKalle Valo {
319d546530eSSara Sharon 	alloc_sec_data(pieces, type, sec);
320d546530eSSara Sharon 
321e705c121SKalle Valo 	pieces->img[type].sec[sec].offset = offset;
322e705c121SKalle Valo }
323e705c121SKalle Valo 
324e705c121SKalle Valo static int iwl_store_cscheme(struct iwl_fw *fw, const u8 *data, const u32 len)
325e705c121SKalle Valo {
326e705c121SKalle Valo 	int i, j;
327e705c121SKalle Valo 	struct iwl_fw_cscheme_list *l = (struct iwl_fw_cscheme_list *)data;
328e705c121SKalle Valo 	struct iwl_fw_cipher_scheme *fwcs;
329e705c121SKalle Valo 
330e705c121SKalle Valo 	if (len < sizeof(*l) ||
331e705c121SKalle Valo 	    len < sizeof(l->size) + l->size * sizeof(l->cs[0]))
332e705c121SKalle Valo 		return -EINVAL;
333e705c121SKalle Valo 
334e705c121SKalle Valo 	for (i = 0, j = 0; i < IWL_UCODE_MAX_CS && i < l->size; i++) {
335e705c121SKalle Valo 		fwcs = &l->cs[j];
336e705c121SKalle Valo 
337e705c121SKalle Valo 		/* we skip schemes with zero cipher suite selector */
33824ddddf3SJohannes Berg 		if (!fwcs->cipher)
339e705c121SKalle Valo 			continue;
340e705c121SKalle Valo 
34124ddddf3SJohannes Berg 		fw->cs[j++] = *fwcs;
342e705c121SKalle Valo 	}
343e705c121SKalle Valo 
344e705c121SKalle Valo 	return 0;
345e705c121SKalle Valo }
346e705c121SKalle Valo 
347e705c121SKalle Valo /*
348e705c121SKalle Valo  * Gets uCode section from tlv.
349e705c121SKalle Valo  */
350e705c121SKalle Valo static int iwl_store_ucode_sec(struct iwl_firmware_pieces *pieces,
351e705c121SKalle Valo 			       const void *data, enum iwl_ucode_type type,
352e705c121SKalle Valo 			       int size)
353e705c121SKalle Valo {
354e705c121SKalle Valo 	struct fw_img_parsing *img;
355e705c121SKalle Valo 	struct fw_sec *sec;
356e705c121SKalle Valo 	struct fw_sec_parsing *sec_parse;
357eef187a7SSara Sharon 	size_t alloc_size;
358e705c121SKalle Valo 
359e705c121SKalle Valo 	if (WARN_ON(!pieces || !data || type >= IWL_UCODE_TYPE_MAX))
360e705c121SKalle Valo 		return -1;
361e705c121SKalle Valo 
362e705c121SKalle Valo 	sec_parse = (struct fw_sec_parsing *)data;
363e705c121SKalle Valo 
364e705c121SKalle Valo 	img = &pieces->img[type];
365eef187a7SSara Sharon 
366eef187a7SSara Sharon 	alloc_size = sizeof(*img->sec) * (img->sec_counter + 1);
367eef187a7SSara Sharon 	sec = krealloc(img->sec, alloc_size, GFP_KERNEL);
368eef187a7SSara Sharon 	if (!sec)
369eef187a7SSara Sharon 		return -ENOMEM;
370eef187a7SSara Sharon 	img->sec = sec;
371eef187a7SSara Sharon 
372e705c121SKalle Valo 	sec = &img->sec[img->sec_counter];
373e705c121SKalle Valo 
374e705c121SKalle Valo 	sec->offset = le32_to_cpu(sec_parse->offset);
375e705c121SKalle Valo 	sec->data = sec_parse->data;
376e705c121SKalle Valo 	sec->size = size - sizeof(sec_parse->offset);
377e705c121SKalle Valo 
378e705c121SKalle Valo 	++img->sec_counter;
379e705c121SKalle Valo 
380e705c121SKalle Valo 	return 0;
381e705c121SKalle Valo }
382e705c121SKalle Valo 
383e705c121SKalle Valo static int iwl_set_default_calib(struct iwl_drv *drv, const u8 *data)
384e705c121SKalle Valo {
385e705c121SKalle Valo 	struct iwl_tlv_calib_data *def_calib =
386e705c121SKalle Valo 					(struct iwl_tlv_calib_data *)data;
387e705c121SKalle Valo 	u32 ucode_type = le32_to_cpu(def_calib->ucode_type);
388e705c121SKalle Valo 	if (ucode_type >= IWL_UCODE_TYPE_MAX) {
389e705c121SKalle Valo 		IWL_ERR(drv, "Wrong ucode_type %u for default calibration.\n",
390e705c121SKalle Valo 			ucode_type);
391e705c121SKalle Valo 		return -EINVAL;
392e705c121SKalle Valo 	}
393e705c121SKalle Valo 	drv->fw.default_calib[ucode_type].flow_trigger =
394e705c121SKalle Valo 		def_calib->calib.flow_trigger;
395e705c121SKalle Valo 	drv->fw.default_calib[ucode_type].event_trigger =
396e705c121SKalle Valo 		def_calib->calib.event_trigger;
397e705c121SKalle Valo 
398e705c121SKalle Valo 	return 0;
399e705c121SKalle Valo }
400e705c121SKalle Valo 
401a4380b4eSSharon Dvir static void iwl_set_ucode_api_flags(struct iwl_drv *drv, const u8 *data,
402e705c121SKalle Valo 				    struct iwl_ucode_capabilities *capa)
403e705c121SKalle Valo {
404e705c121SKalle Valo 	const struct iwl_ucode_api *ucode_api = (void *)data;
405e705c121SKalle Valo 	u32 api_index = le32_to_cpu(ucode_api->api_index);
406e705c121SKalle Valo 	u32 api_flags = le32_to_cpu(ucode_api->api_flags);
407e705c121SKalle Valo 	int i;
408e705c121SKalle Valo 
409e705c121SKalle Valo 	if (api_index >= DIV_ROUND_UP(NUM_IWL_UCODE_TLV_API, 32)) {
4105f5537acSJoão Paulo Rechi Vita 		IWL_WARN(drv,
41120f4d39aSJohannes Berg 			 "api flags index %d larger than supported by driver\n",
41220f4d39aSJohannes Berg 			 api_index);
413a4380b4eSSharon Dvir 		return;
414e705c121SKalle Valo 	}
415e705c121SKalle Valo 
416e705c121SKalle Valo 	for (i = 0; i < 32; i++) {
417e705c121SKalle Valo 		if (api_flags & BIT(i))
418e705c121SKalle Valo 			__set_bit(i + 32 * api_index, capa->_api);
419e705c121SKalle Valo 	}
420e705c121SKalle Valo }
421e705c121SKalle Valo 
422a4380b4eSSharon Dvir static void iwl_set_ucode_capabilities(struct iwl_drv *drv, const u8 *data,
423e705c121SKalle Valo 				       struct iwl_ucode_capabilities *capa)
424e705c121SKalle Valo {
425e705c121SKalle Valo 	const struct iwl_ucode_capa *ucode_capa = (void *)data;
426e705c121SKalle Valo 	u32 api_index = le32_to_cpu(ucode_capa->api_index);
427e705c121SKalle Valo 	u32 api_flags = le32_to_cpu(ucode_capa->api_capa);
428e705c121SKalle Valo 	int i;
429e705c121SKalle Valo 
430e705c121SKalle Valo 	if (api_index >= DIV_ROUND_UP(NUM_IWL_UCODE_TLV_CAPA, 32)) {
4315f5537acSJoão Paulo Rechi Vita 		IWL_WARN(drv,
43220f4d39aSJohannes Berg 			 "capa flags index %d larger than supported by driver\n",
43320f4d39aSJohannes Berg 			 api_index);
434a4380b4eSSharon Dvir 		return;
435e705c121SKalle Valo 	}
436e705c121SKalle Valo 
437e705c121SKalle Valo 	for (i = 0; i < 32; i++) {
438e705c121SKalle Valo 		if (api_flags & BIT(i))
439e705c121SKalle Valo 			__set_bit(i + 32 * api_index, capa->_capa);
440e705c121SKalle Valo 	}
441e705c121SKalle Valo }
442e705c121SKalle Valo 
44355b514b4SJohannes Berg static const char *iwl_reduced_fw_name(struct iwl_drv *drv)
44455b514b4SJohannes Berg {
44555b514b4SJohannes Berg 	const char *name = drv->firmware_name;
44655b514b4SJohannes Berg 
44755b514b4SJohannes Berg 	if (strncmp(name, "iwlwifi-", 8) == 0)
44855b514b4SJohannes Berg 		name += 8;
44955b514b4SJohannes Berg 
45055b514b4SJohannes Berg 	return name;
45155b514b4SJohannes Berg }
45255b514b4SJohannes Berg 
453e705c121SKalle Valo static int iwl_parse_v1_v2_firmware(struct iwl_drv *drv,
454e705c121SKalle Valo 				    const struct firmware *ucode_raw,
455e705c121SKalle Valo 				    struct iwl_firmware_pieces *pieces)
456e705c121SKalle Valo {
457e705c121SKalle Valo 	struct iwl_ucode_header *ucode = (void *)ucode_raw->data;
458e705c121SKalle Valo 	u32 api_ver, hdr_size, build;
459e705c121SKalle Valo 	char buildstr[25];
460e705c121SKalle Valo 	const u8 *src;
461e705c121SKalle Valo 
462e705c121SKalle Valo 	drv->fw.ucode_ver = le32_to_cpu(ucode->ver);
463e705c121SKalle Valo 	api_ver = IWL_UCODE_API(drv->fw.ucode_ver);
464e705c121SKalle Valo 
465e705c121SKalle Valo 	switch (api_ver) {
466e705c121SKalle Valo 	default:
467e705c121SKalle Valo 		hdr_size = 28;
468e705c121SKalle Valo 		if (ucode_raw->size < hdr_size) {
469e705c121SKalle Valo 			IWL_ERR(drv, "File size too small!\n");
470e705c121SKalle Valo 			return -EINVAL;
471e705c121SKalle Valo 		}
472e705c121SKalle Valo 		build = le32_to_cpu(ucode->u.v2.build);
473e705c121SKalle Valo 		set_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST,
474e705c121SKalle Valo 			     le32_to_cpu(ucode->u.v2.inst_size));
475e705c121SKalle Valo 		set_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA,
476e705c121SKalle Valo 			     le32_to_cpu(ucode->u.v2.data_size));
477e705c121SKalle Valo 		set_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST,
478e705c121SKalle Valo 			     le32_to_cpu(ucode->u.v2.init_size));
479e705c121SKalle Valo 		set_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA,
480e705c121SKalle Valo 			     le32_to_cpu(ucode->u.v2.init_data_size));
481e705c121SKalle Valo 		src = ucode->u.v2.data;
482e705c121SKalle Valo 		break;
483e705c121SKalle Valo 	case 0:
484e705c121SKalle Valo 	case 1:
485e705c121SKalle Valo 	case 2:
486e705c121SKalle Valo 		hdr_size = 24;
487e705c121SKalle Valo 		if (ucode_raw->size < hdr_size) {
488e705c121SKalle Valo 			IWL_ERR(drv, "File size too small!\n");
489e705c121SKalle Valo 			return -EINVAL;
490e705c121SKalle Valo 		}
491e705c121SKalle Valo 		build = 0;
492e705c121SKalle Valo 		set_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST,
493e705c121SKalle Valo 			     le32_to_cpu(ucode->u.v1.inst_size));
494e705c121SKalle Valo 		set_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA,
495e705c121SKalle Valo 			     le32_to_cpu(ucode->u.v1.data_size));
496e705c121SKalle Valo 		set_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST,
497e705c121SKalle Valo 			     le32_to_cpu(ucode->u.v1.init_size));
498e705c121SKalle Valo 		set_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA,
499e705c121SKalle Valo 			     le32_to_cpu(ucode->u.v1.init_data_size));
500e705c121SKalle Valo 		src = ucode->u.v1.data;
501e705c121SKalle Valo 		break;
502e705c121SKalle Valo 	}
503e705c121SKalle Valo 
504e705c121SKalle Valo 	if (build)
50575094dc8SEmmanuel Grumbach 		sprintf(buildstr, " build %u", build);
506e705c121SKalle Valo 	else
507e705c121SKalle Valo 		buildstr[0] = '\0';
508e705c121SKalle Valo 
509e705c121SKalle Valo 	snprintf(drv->fw.fw_version,
510e705c121SKalle Valo 		 sizeof(drv->fw.fw_version),
51155b514b4SJohannes Berg 		 "%u.%u.%u.%u%s %s",
512e705c121SKalle Valo 		 IWL_UCODE_MAJOR(drv->fw.ucode_ver),
513e705c121SKalle Valo 		 IWL_UCODE_MINOR(drv->fw.ucode_ver),
514e705c121SKalle Valo 		 IWL_UCODE_API(drv->fw.ucode_ver),
515e705c121SKalle Valo 		 IWL_UCODE_SERIAL(drv->fw.ucode_ver),
51655b514b4SJohannes Berg 		 buildstr, iwl_reduced_fw_name(drv));
517e705c121SKalle Valo 
518e705c121SKalle Valo 	/* Verify size of file vs. image size info in file's header */
519e705c121SKalle Valo 
520e705c121SKalle Valo 	if (ucode_raw->size != hdr_size +
521e705c121SKalle Valo 	    get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST) +
522e705c121SKalle Valo 	    get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA) +
523e705c121SKalle Valo 	    get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST) +
524e705c121SKalle Valo 	    get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA)) {
525e705c121SKalle Valo 
526e705c121SKalle Valo 		IWL_ERR(drv,
527e705c121SKalle Valo 			"uCode file size %d does not match expected size\n",
528e705c121SKalle Valo 			(int)ucode_raw->size);
529e705c121SKalle Valo 		return -EINVAL;
530e705c121SKalle Valo 	}
531e705c121SKalle Valo 
532e705c121SKalle Valo 
533e705c121SKalle Valo 	set_sec_data(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST, src);
534e705c121SKalle Valo 	src += get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST);
535e705c121SKalle Valo 	set_sec_offset(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST,
536e705c121SKalle Valo 		       IWLAGN_RTC_INST_LOWER_BOUND);
537e705c121SKalle Valo 	set_sec_data(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA, src);
538e705c121SKalle Valo 	src += get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA);
539e705c121SKalle Valo 	set_sec_offset(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA,
540e705c121SKalle Valo 		       IWLAGN_RTC_DATA_LOWER_BOUND);
541e705c121SKalle Valo 	set_sec_data(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST, src);
542e705c121SKalle Valo 	src += get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST);
543e705c121SKalle Valo 	set_sec_offset(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST,
544e705c121SKalle Valo 		       IWLAGN_RTC_INST_LOWER_BOUND);
545e705c121SKalle Valo 	set_sec_data(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA, src);
546e705c121SKalle Valo 	src += get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA);
547e705c121SKalle Valo 	set_sec_offset(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA,
548e705c121SKalle Valo 		       IWLAGN_RTC_DATA_LOWER_BOUND);
549e705c121SKalle Valo 	return 0;
550e705c121SKalle Valo }
551e705c121SKalle Valo 
552fad92a1dSJohannes Berg static void iwl_drv_set_dump_exclude(struct iwl_drv *drv,
553fad92a1dSJohannes Berg 				     enum iwl_ucode_tlv_type tlv_type,
554fad92a1dSJohannes Berg 				     const void *tlv_data, u32 tlv_len)
555fad92a1dSJohannes Berg {
556fad92a1dSJohannes Berg 	const struct iwl_fw_dump_exclude *fw = tlv_data;
557fad92a1dSJohannes Berg 	struct iwl_dump_exclude *excl;
558fad92a1dSJohannes Berg 
559fad92a1dSJohannes Berg 	if (tlv_len < sizeof(*fw))
560fad92a1dSJohannes Berg 		return;
561fad92a1dSJohannes Berg 
562fad92a1dSJohannes Berg 	if (tlv_type == IWL_UCODE_TLV_SEC_TABLE_ADDR) {
563fad92a1dSJohannes Berg 		excl = &drv->fw.dump_excl[0];
564fad92a1dSJohannes Berg 
565fad92a1dSJohannes Berg 		/* second time we find this, it's for WoWLAN */
566fad92a1dSJohannes Berg 		if (excl->addr)
567fad92a1dSJohannes Berg 			excl = &drv->fw.dump_excl_wowlan[0];
568fad92a1dSJohannes Berg 	} else if (fw_has_capa(&drv->fw.ucode_capa,
569fad92a1dSJohannes Berg 			       IWL_UCODE_TLV_CAPA_CNSLDTD_D3_D0_IMG)) {
570fad92a1dSJohannes Berg 		/* IWL_UCODE_TLV_D3_KEK_KCK_ADDR is regular image */
571fad92a1dSJohannes Berg 		excl = &drv->fw.dump_excl[0];
572fad92a1dSJohannes Berg 	} else {
573fad92a1dSJohannes Berg 		/* IWL_UCODE_TLV_D3_KEK_KCK_ADDR is WoWLAN image */
574fad92a1dSJohannes Berg 		excl = &drv->fw.dump_excl_wowlan[0];
575fad92a1dSJohannes Berg 	}
576fad92a1dSJohannes Berg 
577fad92a1dSJohannes Berg 	if (excl->addr)
578fad92a1dSJohannes Berg 		excl++;
579fad92a1dSJohannes Berg 
580fad92a1dSJohannes Berg 	if (excl->addr) {
581fad92a1dSJohannes Berg 		IWL_DEBUG_FW_INFO(drv, "found too many excludes in fw file\n");
582fad92a1dSJohannes Berg 		return;
583fad92a1dSJohannes Berg 	}
584fad92a1dSJohannes Berg 
585fad92a1dSJohannes Berg 	excl->addr = le32_to_cpu(fw->addr) & ~FW_ADDR_CACHE_CONTROL;
586fad92a1dSJohannes Berg 	excl->size = le32_to_cpu(fw->size);
587fad92a1dSJohannes Berg }
588fad92a1dSJohannes Berg 
589e705c121SKalle Valo static int iwl_parse_tlv_firmware(struct iwl_drv *drv,
590e705c121SKalle Valo 				const struct firmware *ucode_raw,
591e705c121SKalle Valo 				struct iwl_firmware_pieces *pieces,
592e6eb8ca9SGolan Ben-Ami 				struct iwl_ucode_capabilities *capa,
593e6eb8ca9SGolan Ben-Ami 				bool *usniffer_images)
594e705c121SKalle Valo {
595e705c121SKalle Valo 	struct iwl_tlv_ucode_header *ucode = (void *)ucode_raw->data;
596403ea939STakashi Iwai 	const struct iwl_ucode_tlv *tlv;
597e705c121SKalle Valo 	size_t len = ucode_raw->size;
598e705c121SKalle Valo 	const u8 *data;
599e705c121SKalle Valo 	u32 tlv_len;
600e705c121SKalle Valo 	u32 usniffer_img;
601e705c121SKalle Valo 	enum iwl_ucode_tlv_type tlv_type;
602e705c121SKalle Valo 	const u8 *tlv_data;
603e705c121SKalle Valo 	char buildstr[25];
604e705c121SKalle Valo 	u32 build, paging_mem_size;
605e705c121SKalle Valo 	int num_of_cpus;
606e705c121SKalle Valo 	bool usniffer_req = false;
607e705c121SKalle Valo 
608e705c121SKalle Valo 	if (len < sizeof(*ucode)) {
609e705c121SKalle Valo 		IWL_ERR(drv, "uCode has invalid length: %zd\n", len);
610e705c121SKalle Valo 		return -EINVAL;
611e705c121SKalle Valo 	}
612e705c121SKalle Valo 
613e705c121SKalle Valo 	if (ucode->magic != cpu_to_le32(IWL_TLV_UCODE_MAGIC)) {
614e705c121SKalle Valo 		IWL_ERR(drv, "invalid uCode magic: 0X%x\n",
615e705c121SKalle Valo 			le32_to_cpu(ucode->magic));
616e705c121SKalle Valo 		return -EINVAL;
617e705c121SKalle Valo 	}
618e705c121SKalle Valo 
619e705c121SKalle Valo 	drv->fw.ucode_ver = le32_to_cpu(ucode->ver);
620e705c121SKalle Valo 	memcpy(drv->fw.human_readable, ucode->human_readable,
621e705c121SKalle Valo 	       sizeof(drv->fw.human_readable));
622e705c121SKalle Valo 	build = le32_to_cpu(ucode->build);
623e705c121SKalle Valo 
624e705c121SKalle Valo 	if (build)
62575094dc8SEmmanuel Grumbach 		sprintf(buildstr, " build %u", build);
626e705c121SKalle Valo 	else
627e705c121SKalle Valo 		buildstr[0] = '\0';
628e705c121SKalle Valo 
629e705c121SKalle Valo 	snprintf(drv->fw.fw_version,
630e705c121SKalle Valo 		 sizeof(drv->fw.fw_version),
63155b514b4SJohannes Berg 		 "%u.%u.%u.%u%s %s",
632e705c121SKalle Valo 		 IWL_UCODE_MAJOR(drv->fw.ucode_ver),
633e705c121SKalle Valo 		 IWL_UCODE_MINOR(drv->fw.ucode_ver),
634e705c121SKalle Valo 		 IWL_UCODE_API(drv->fw.ucode_ver),
635e705c121SKalle Valo 		 IWL_UCODE_SERIAL(drv->fw.ucode_ver),
63655b514b4SJohannes Berg 		 buildstr, iwl_reduced_fw_name(drv));
637e705c121SKalle Valo 
638e705c121SKalle Valo 	data = ucode->data;
639e705c121SKalle Valo 
640e705c121SKalle Valo 	len -= sizeof(*ucode);
641e705c121SKalle Valo 
642e705c121SKalle Valo 	while (len >= sizeof(*tlv)) {
643e705c121SKalle Valo 		len -= sizeof(*tlv);
644e705c121SKalle Valo 		tlv = (void *)data;
645e705c121SKalle Valo 
646e705c121SKalle Valo 		tlv_len = le32_to_cpu(tlv->length);
647e705c121SKalle Valo 		tlv_type = le32_to_cpu(tlv->type);
648e705c121SKalle Valo 		tlv_data = tlv->data;
649e705c121SKalle Valo 
650e705c121SKalle Valo 		if (len < tlv_len) {
651e705c121SKalle Valo 			IWL_ERR(drv, "invalid TLV len: %zd/%u\n",
652e705c121SKalle Valo 				len, tlv_len);
653e705c121SKalle Valo 			return -EINVAL;
654e705c121SKalle Valo 		}
655e705c121SKalle Valo 		len -= ALIGN(tlv_len, 4);
656e705c121SKalle Valo 		data += sizeof(*tlv) + ALIGN(tlv_len, 4);
657e705c121SKalle Valo 
658e705c121SKalle Valo 		switch (tlv_type) {
659e705c121SKalle Valo 		case IWL_UCODE_TLV_INST:
660e705c121SKalle Valo 			set_sec_data(pieces, IWL_UCODE_REGULAR,
661e705c121SKalle Valo 				     IWL_UCODE_SECTION_INST, tlv_data);
662e705c121SKalle Valo 			set_sec_size(pieces, IWL_UCODE_REGULAR,
663e705c121SKalle Valo 				     IWL_UCODE_SECTION_INST, tlv_len);
664e705c121SKalle Valo 			set_sec_offset(pieces, IWL_UCODE_REGULAR,
665e705c121SKalle Valo 				       IWL_UCODE_SECTION_INST,
666e705c121SKalle Valo 				       IWLAGN_RTC_INST_LOWER_BOUND);
667e705c121SKalle Valo 			break;
668e705c121SKalle Valo 		case IWL_UCODE_TLV_DATA:
669e705c121SKalle Valo 			set_sec_data(pieces, IWL_UCODE_REGULAR,
670e705c121SKalle Valo 				     IWL_UCODE_SECTION_DATA, tlv_data);
671e705c121SKalle Valo 			set_sec_size(pieces, IWL_UCODE_REGULAR,
672e705c121SKalle Valo 				     IWL_UCODE_SECTION_DATA, tlv_len);
673e705c121SKalle Valo 			set_sec_offset(pieces, IWL_UCODE_REGULAR,
674e705c121SKalle Valo 				       IWL_UCODE_SECTION_DATA,
675e705c121SKalle Valo 				       IWLAGN_RTC_DATA_LOWER_BOUND);
676e705c121SKalle Valo 			break;
677e705c121SKalle Valo 		case IWL_UCODE_TLV_INIT:
678e705c121SKalle Valo 			set_sec_data(pieces, IWL_UCODE_INIT,
679e705c121SKalle Valo 				     IWL_UCODE_SECTION_INST, tlv_data);
680e705c121SKalle Valo 			set_sec_size(pieces, IWL_UCODE_INIT,
681e705c121SKalle Valo 				     IWL_UCODE_SECTION_INST, tlv_len);
682e705c121SKalle Valo 			set_sec_offset(pieces, IWL_UCODE_INIT,
683e705c121SKalle Valo 				       IWL_UCODE_SECTION_INST,
684e705c121SKalle Valo 				       IWLAGN_RTC_INST_LOWER_BOUND);
685e705c121SKalle Valo 			break;
686e705c121SKalle Valo 		case IWL_UCODE_TLV_INIT_DATA:
687e705c121SKalle Valo 			set_sec_data(pieces, IWL_UCODE_INIT,
688e705c121SKalle Valo 				     IWL_UCODE_SECTION_DATA, tlv_data);
689e705c121SKalle Valo 			set_sec_size(pieces, IWL_UCODE_INIT,
690e705c121SKalle Valo 				     IWL_UCODE_SECTION_DATA, tlv_len);
691e705c121SKalle Valo 			set_sec_offset(pieces, IWL_UCODE_INIT,
692e705c121SKalle Valo 				       IWL_UCODE_SECTION_DATA,
693e705c121SKalle Valo 				       IWLAGN_RTC_DATA_LOWER_BOUND);
694e705c121SKalle Valo 			break;
695e705c121SKalle Valo 		case IWL_UCODE_TLV_BOOT:
696e705c121SKalle Valo 			IWL_ERR(drv, "Found unexpected BOOT ucode\n");
697e705c121SKalle Valo 			break;
698e705c121SKalle Valo 		case IWL_UCODE_TLV_PROBE_MAX_LEN:
699e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
700e705c121SKalle Valo 				goto invalid_tlv_len;
701e705c121SKalle Valo 			capa->max_probe_length =
702e705c121SKalle Valo 					le32_to_cpup((__le32 *)tlv_data);
703e705c121SKalle Valo 			break;
704e705c121SKalle Valo 		case IWL_UCODE_TLV_PAN:
705e705c121SKalle Valo 			if (tlv_len)
706e705c121SKalle Valo 				goto invalid_tlv_len;
707e705c121SKalle Valo 			capa->flags |= IWL_UCODE_TLV_FLAGS_PAN;
708e705c121SKalle Valo 			break;
709e705c121SKalle Valo 		case IWL_UCODE_TLV_FLAGS:
710e705c121SKalle Valo 			/* must be at least one u32 */
711e705c121SKalle Valo 			if (tlv_len < sizeof(u32))
712e705c121SKalle Valo 				goto invalid_tlv_len;
713e705c121SKalle Valo 			/* and a proper number of u32s */
714e705c121SKalle Valo 			if (tlv_len % sizeof(u32))
715e705c121SKalle Valo 				goto invalid_tlv_len;
716e705c121SKalle Valo 			/*
717e705c121SKalle Valo 			 * This driver only reads the first u32 as
718e705c121SKalle Valo 			 * right now no more features are defined,
719e705c121SKalle Valo 			 * if that changes then either the driver
720e705c121SKalle Valo 			 * will not work with the new firmware, or
721e705c121SKalle Valo 			 * it'll not take advantage of new features.
722e705c121SKalle Valo 			 */
723e705c121SKalle Valo 			capa->flags = le32_to_cpup((__le32 *)tlv_data);
724e705c121SKalle Valo 			break;
725e705c121SKalle Valo 		case IWL_UCODE_TLV_API_CHANGES_SET:
726e705c121SKalle Valo 			if (tlv_len != sizeof(struct iwl_ucode_api))
727e705c121SKalle Valo 				goto invalid_tlv_len;
728a4380b4eSSharon Dvir 			iwl_set_ucode_api_flags(drv, tlv_data, capa);
729e705c121SKalle Valo 			break;
730e705c121SKalle Valo 		case IWL_UCODE_TLV_ENABLED_CAPABILITIES:
731e705c121SKalle Valo 			if (tlv_len != sizeof(struct iwl_ucode_capa))
732e705c121SKalle Valo 				goto invalid_tlv_len;
733a4380b4eSSharon Dvir 			iwl_set_ucode_capabilities(drv, tlv_data, capa);
734e705c121SKalle Valo 			break;
735e705c121SKalle Valo 		case IWL_UCODE_TLV_INIT_EVTLOG_PTR:
736e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
737e705c121SKalle Valo 				goto invalid_tlv_len;
738e705c121SKalle Valo 			pieces->init_evtlog_ptr =
739e705c121SKalle Valo 					le32_to_cpup((__le32 *)tlv_data);
740e705c121SKalle Valo 			break;
741e705c121SKalle Valo 		case IWL_UCODE_TLV_INIT_EVTLOG_SIZE:
742e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
743e705c121SKalle Valo 				goto invalid_tlv_len;
744e705c121SKalle Valo 			pieces->init_evtlog_size =
745e705c121SKalle Valo 					le32_to_cpup((__le32 *)tlv_data);
746e705c121SKalle Valo 			break;
747e705c121SKalle Valo 		case IWL_UCODE_TLV_INIT_ERRLOG_PTR:
748e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
749e705c121SKalle Valo 				goto invalid_tlv_len;
750e705c121SKalle Valo 			pieces->init_errlog_ptr =
751e705c121SKalle Valo 					le32_to_cpup((__le32 *)tlv_data);
752e705c121SKalle Valo 			break;
753e705c121SKalle Valo 		case IWL_UCODE_TLV_RUNT_EVTLOG_PTR:
754e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
755e705c121SKalle Valo 				goto invalid_tlv_len;
756e705c121SKalle Valo 			pieces->inst_evtlog_ptr =
757e705c121SKalle Valo 					le32_to_cpup((__le32 *)tlv_data);
758e705c121SKalle Valo 			break;
759e705c121SKalle Valo 		case IWL_UCODE_TLV_RUNT_EVTLOG_SIZE:
760e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
761e705c121SKalle Valo 				goto invalid_tlv_len;
762e705c121SKalle Valo 			pieces->inst_evtlog_size =
763e705c121SKalle Valo 					le32_to_cpup((__le32 *)tlv_data);
764e705c121SKalle Valo 			break;
765e705c121SKalle Valo 		case IWL_UCODE_TLV_RUNT_ERRLOG_PTR:
766e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
767e705c121SKalle Valo 				goto invalid_tlv_len;
768e705c121SKalle Valo 			pieces->inst_errlog_ptr =
769e705c121SKalle Valo 					le32_to_cpup((__le32 *)tlv_data);
770e705c121SKalle Valo 			break;
771e705c121SKalle Valo 		case IWL_UCODE_TLV_ENHANCE_SENS_TBL:
772e705c121SKalle Valo 			if (tlv_len)
773e705c121SKalle Valo 				goto invalid_tlv_len;
774e705c121SKalle Valo 			drv->fw.enhance_sensitivity_table = true;
775e705c121SKalle Valo 			break;
776e705c121SKalle Valo 		case IWL_UCODE_TLV_WOWLAN_INST:
777e705c121SKalle Valo 			set_sec_data(pieces, IWL_UCODE_WOWLAN,
778e705c121SKalle Valo 				     IWL_UCODE_SECTION_INST, tlv_data);
779e705c121SKalle Valo 			set_sec_size(pieces, IWL_UCODE_WOWLAN,
780e705c121SKalle Valo 				     IWL_UCODE_SECTION_INST, tlv_len);
781e705c121SKalle Valo 			set_sec_offset(pieces, IWL_UCODE_WOWLAN,
782e705c121SKalle Valo 				       IWL_UCODE_SECTION_INST,
783e705c121SKalle Valo 				       IWLAGN_RTC_INST_LOWER_BOUND);
784e705c121SKalle Valo 			break;
785e705c121SKalle Valo 		case IWL_UCODE_TLV_WOWLAN_DATA:
786e705c121SKalle Valo 			set_sec_data(pieces, IWL_UCODE_WOWLAN,
787e705c121SKalle Valo 				     IWL_UCODE_SECTION_DATA, tlv_data);
788e705c121SKalle Valo 			set_sec_size(pieces, IWL_UCODE_WOWLAN,
789e705c121SKalle Valo 				     IWL_UCODE_SECTION_DATA, tlv_len);
790e705c121SKalle Valo 			set_sec_offset(pieces, IWL_UCODE_WOWLAN,
791e705c121SKalle Valo 				       IWL_UCODE_SECTION_DATA,
792e705c121SKalle Valo 				       IWLAGN_RTC_DATA_LOWER_BOUND);
793e705c121SKalle Valo 			break;
794e705c121SKalle Valo 		case IWL_UCODE_TLV_PHY_CALIBRATION_SIZE:
795e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
796e705c121SKalle Valo 				goto invalid_tlv_len;
797e705c121SKalle Valo 			capa->standard_phy_calibration_size =
798e705c121SKalle Valo 					le32_to_cpup((__le32 *)tlv_data);
799e705c121SKalle Valo 			break;
800e705c121SKalle Valo 		case IWL_UCODE_TLV_SEC_RT:
801e705c121SKalle Valo 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_REGULAR,
802e705c121SKalle Valo 					    tlv_len);
803ca221c9bSJohannes Berg 			drv->fw.type = IWL_FW_MVM;
804e705c121SKalle Valo 			break;
805e705c121SKalle Valo 		case IWL_UCODE_TLV_SEC_INIT:
806e705c121SKalle Valo 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_INIT,
807e705c121SKalle Valo 					    tlv_len);
808ca221c9bSJohannes Berg 			drv->fw.type = IWL_FW_MVM;
809e705c121SKalle Valo 			break;
810e705c121SKalle Valo 		case IWL_UCODE_TLV_SEC_WOWLAN:
811e705c121SKalle Valo 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_WOWLAN,
812e705c121SKalle Valo 					    tlv_len);
813ca221c9bSJohannes Berg 			drv->fw.type = IWL_FW_MVM;
814e705c121SKalle Valo 			break;
815e705c121SKalle Valo 		case IWL_UCODE_TLV_DEF_CALIB:
816e705c121SKalle Valo 			if (tlv_len != sizeof(struct iwl_tlv_calib_data))
817e705c121SKalle Valo 				goto invalid_tlv_len;
818e705c121SKalle Valo 			if (iwl_set_default_calib(drv, tlv_data))
819e705c121SKalle Valo 				goto tlv_error;
820e705c121SKalle Valo 			break;
821e705c121SKalle Valo 		case IWL_UCODE_TLV_PHY_SKU:
822e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
823e705c121SKalle Valo 				goto invalid_tlv_len;
824e705c121SKalle Valo 			drv->fw.phy_config = le32_to_cpup((__le32 *)tlv_data);
825e705c121SKalle Valo 			drv->fw.valid_tx_ant = (drv->fw.phy_config &
826e705c121SKalle Valo 						FW_PHY_CFG_TX_CHAIN) >>
827e705c121SKalle Valo 						FW_PHY_CFG_TX_CHAIN_POS;
828e705c121SKalle Valo 			drv->fw.valid_rx_ant = (drv->fw.phy_config &
829e705c121SKalle Valo 						FW_PHY_CFG_RX_CHAIN) >>
830e705c121SKalle Valo 						FW_PHY_CFG_RX_CHAIN_POS;
831e705c121SKalle Valo 			break;
832e705c121SKalle Valo 		case IWL_UCODE_TLV_SECURE_SEC_RT:
833e705c121SKalle Valo 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_REGULAR,
834e705c121SKalle Valo 					    tlv_len);
835ca221c9bSJohannes Berg 			drv->fw.type = IWL_FW_MVM;
836e705c121SKalle Valo 			break;
837e705c121SKalle Valo 		case IWL_UCODE_TLV_SECURE_SEC_INIT:
838e705c121SKalle Valo 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_INIT,
839e705c121SKalle Valo 					    tlv_len);
840ca221c9bSJohannes Berg 			drv->fw.type = IWL_FW_MVM;
841e705c121SKalle Valo 			break;
842e705c121SKalle Valo 		case IWL_UCODE_TLV_SECURE_SEC_WOWLAN:
843e705c121SKalle Valo 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_WOWLAN,
844e705c121SKalle Valo 					    tlv_len);
845ca221c9bSJohannes Berg 			drv->fw.type = IWL_FW_MVM;
846e705c121SKalle Valo 			break;
847e705c121SKalle Valo 		case IWL_UCODE_TLV_NUM_OF_CPU:
848e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
849e705c121SKalle Valo 				goto invalid_tlv_len;
850e705c121SKalle Valo 			num_of_cpus =
851e705c121SKalle Valo 				le32_to_cpup((__le32 *)tlv_data);
852e705c121SKalle Valo 
853e705c121SKalle Valo 			if (num_of_cpus == 2) {
854e705c121SKalle Valo 				drv->fw.img[IWL_UCODE_REGULAR].is_dual_cpus =
855e705c121SKalle Valo 					true;
856e705c121SKalle Valo 				drv->fw.img[IWL_UCODE_INIT].is_dual_cpus =
857e705c121SKalle Valo 					true;
858e705c121SKalle Valo 				drv->fw.img[IWL_UCODE_WOWLAN].is_dual_cpus =
859e705c121SKalle Valo 					true;
860e705c121SKalle Valo 			} else if ((num_of_cpus > 2) || (num_of_cpus < 1)) {
861e705c121SKalle Valo 				IWL_ERR(drv, "Driver support upto 2 CPUs\n");
862e705c121SKalle Valo 				return -EINVAL;
863e705c121SKalle Valo 			}
864e705c121SKalle Valo 			break;
865e705c121SKalle Valo 		case IWL_UCODE_TLV_CSCHEME:
866e705c121SKalle Valo 			if (iwl_store_cscheme(&drv->fw, tlv_data, tlv_len))
867e705c121SKalle Valo 				goto invalid_tlv_len;
868e705c121SKalle Valo 			break;
869e705c121SKalle Valo 		case IWL_UCODE_TLV_N_SCAN_CHANNELS:
870e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
871e705c121SKalle Valo 				goto invalid_tlv_len;
872e705c121SKalle Valo 			capa->n_scan_channels =
873e705c121SKalle Valo 				le32_to_cpup((__le32 *)tlv_data);
874e705c121SKalle Valo 			break;
875e705c121SKalle Valo 		case IWL_UCODE_TLV_FW_VERSION: {
876e705c121SKalle Valo 			__le32 *ptr = (void *)tlv_data;
877e705c121SKalle Valo 			u32 major, minor;
878e705c121SKalle Valo 			u8 local_comp;
879e705c121SKalle Valo 
880e705c121SKalle Valo 			if (tlv_len != sizeof(u32) * 3)
881e705c121SKalle Valo 				goto invalid_tlv_len;
882e705c121SKalle Valo 
883e705c121SKalle Valo 			major = le32_to_cpup(ptr++);
884e705c121SKalle Valo 			minor = le32_to_cpup(ptr++);
885e705c121SKalle Valo 			local_comp = le32_to_cpup(ptr);
886e705c121SKalle Valo 
88776c5bcb3SEmmanuel Grumbach 			if (major >= 35)
888e705c121SKalle Valo 				snprintf(drv->fw.fw_version,
88976c5bcb3SEmmanuel Grumbach 					 sizeof(drv->fw.fw_version),
89055b514b4SJohannes Berg 					"%u.%08x.%u %s", major, minor,
89155b514b4SJohannes Berg 					local_comp, iwl_reduced_fw_name(drv));
89276c5bcb3SEmmanuel Grumbach 			else
89376c5bcb3SEmmanuel Grumbach 				snprintf(drv->fw.fw_version,
89476c5bcb3SEmmanuel Grumbach 					 sizeof(drv->fw.fw_version),
89555b514b4SJohannes Berg 					"%u.%u.%u %s", major, minor,
89655b514b4SJohannes Berg 					local_comp, iwl_reduced_fw_name(drv));
897e705c121SKalle Valo 			break;
898e705c121SKalle Valo 			}
899e705c121SKalle Valo 		case IWL_UCODE_TLV_FW_DBG_DEST: {
900fd527eb5SGolan Ben Ami 			struct iwl_fw_dbg_dest_tlv *dest = NULL;
901fd527eb5SGolan Ben Ami 			struct iwl_fw_dbg_dest_tlv_v1 *dest_v1 = NULL;
902fd527eb5SGolan Ben Ami 			u8 mon_mode;
903e705c121SKalle Valo 
904fd527eb5SGolan Ben Ami 			pieces->dbg_dest_ver = (u8 *)tlv_data;
905fd527eb5SGolan Ben Ami 			if (*pieces->dbg_dest_ver == 1) {
906fd527eb5SGolan Ben Ami 				dest = (void *)tlv_data;
907fd527eb5SGolan Ben Ami 			} else if (*pieces->dbg_dest_ver == 0) {
908fd527eb5SGolan Ben Ami 				dest_v1 = (void *)tlv_data;
909fd527eb5SGolan Ben Ami 			} else {
910fd527eb5SGolan Ben Ami 				IWL_ERR(drv,
911fd527eb5SGolan Ben Ami 					"The version is %d, and it is invalid\n",
912fd527eb5SGolan Ben Ami 					*pieces->dbg_dest_ver);
913fd527eb5SGolan Ben Ami 				break;
914fd527eb5SGolan Ben Ami 			}
915fd527eb5SGolan Ben Ami 
916fd527eb5SGolan Ben Ami 			if (pieces->dbg_dest_tlv_init) {
917e705c121SKalle Valo 				IWL_ERR(drv,
918e705c121SKalle Valo 					"dbg destination ignored, already exists\n");
919e705c121SKalle Valo 				break;
920e705c121SKalle Valo 			}
921e705c121SKalle Valo 
922fd527eb5SGolan Ben Ami 			pieces->dbg_dest_tlv_init = true;
923e705c121SKalle Valo 
924fd527eb5SGolan Ben Ami 			if (dest_v1) {
925fd527eb5SGolan Ben Ami 				pieces->dbg_dest_tlv_v1 = dest_v1;
926fd527eb5SGolan Ben Ami 				mon_mode = dest_v1->monitor_mode;
927fd527eb5SGolan Ben Ami 			} else {
928fd527eb5SGolan Ben Ami 				pieces->dbg_dest_tlv = dest;
929fd527eb5SGolan Ben Ami 				mon_mode = dest->monitor_mode;
930fd527eb5SGolan Ben Ami 			}
931fd527eb5SGolan Ben Ami 
932fd527eb5SGolan Ben Ami 			IWL_INFO(drv, "Found debug destination: %s\n",
933fd527eb5SGolan Ben Ami 				 get_fw_dbg_mode_string(mon_mode));
934fd527eb5SGolan Ben Ami 
93517b809c9SSara Sharon 			drv->fw.dbg.n_dest_reg = (dest_v1) ?
936fd527eb5SGolan Ben Ami 				tlv_len -
937fd527eb5SGolan Ben Ami 				offsetof(struct iwl_fw_dbg_dest_tlv_v1,
938fd527eb5SGolan Ben Ami 					 reg_ops) :
939fd527eb5SGolan Ben Ami 				tlv_len -
940fd527eb5SGolan Ben Ami 				offsetof(struct iwl_fw_dbg_dest_tlv,
941e705c121SKalle Valo 					 reg_ops);
942fd527eb5SGolan Ben Ami 
94317b809c9SSara Sharon 			drv->fw.dbg.n_dest_reg /=
94417b809c9SSara Sharon 				sizeof(drv->fw.dbg.dest_tlv->reg_ops[0]);
945e705c121SKalle Valo 
946e705c121SKalle Valo 			break;
947e705c121SKalle Valo 			}
948e705c121SKalle Valo 		case IWL_UCODE_TLV_FW_DBG_CONF: {
949e705c121SKalle Valo 			struct iwl_fw_dbg_conf_tlv *conf = (void *)tlv_data;
950e705c121SKalle Valo 
951fd527eb5SGolan Ben Ami 			if (!pieces->dbg_dest_tlv_init) {
952e705c121SKalle Valo 				IWL_ERR(drv,
953e705c121SKalle Valo 					"Ignore dbg config %d - no destination configured\n",
954e705c121SKalle Valo 					conf->id);
955e705c121SKalle Valo 				break;
956e705c121SKalle Valo 			}
957e705c121SKalle Valo 
95817b809c9SSara Sharon 			if (conf->id >= ARRAY_SIZE(drv->fw.dbg.conf_tlv)) {
959e705c121SKalle Valo 				IWL_ERR(drv,
960e705c121SKalle Valo 					"Skip unknown configuration: %d\n",
961e705c121SKalle Valo 					conf->id);
962e705c121SKalle Valo 				break;
963e705c121SKalle Valo 			}
964e705c121SKalle Valo 
965e705c121SKalle Valo 			if (pieces->dbg_conf_tlv[conf->id]) {
966e705c121SKalle Valo 				IWL_ERR(drv,
967e705c121SKalle Valo 					"Ignore duplicate dbg config %d\n",
968e705c121SKalle Valo 					conf->id);
969e705c121SKalle Valo 				break;
970e705c121SKalle Valo 			}
971e705c121SKalle Valo 
972e705c121SKalle Valo 			if (conf->usniffer)
973e705c121SKalle Valo 				usniffer_req = true;
974e705c121SKalle Valo 
975e705c121SKalle Valo 			IWL_INFO(drv, "Found debug configuration: %d\n",
976e705c121SKalle Valo 				 conf->id);
977e705c121SKalle Valo 
978e705c121SKalle Valo 			pieces->dbg_conf_tlv[conf->id] = conf;
979e705c121SKalle Valo 			pieces->dbg_conf_tlv_len[conf->id] = tlv_len;
980e705c121SKalle Valo 			break;
981e705c121SKalle Valo 			}
982e705c121SKalle Valo 		case IWL_UCODE_TLV_FW_DBG_TRIGGER: {
983e705c121SKalle Valo 			struct iwl_fw_dbg_trigger_tlv *trigger =
984e705c121SKalle Valo 				(void *)tlv_data;
985e705c121SKalle Valo 			u32 trigger_id = le32_to_cpu(trigger->id);
986e705c121SKalle Valo 
98717b809c9SSara Sharon 			if (trigger_id >= ARRAY_SIZE(drv->fw.dbg.trigger_tlv)) {
988e705c121SKalle Valo 				IWL_ERR(drv,
989e705c121SKalle Valo 					"Skip unknown trigger: %u\n",
990e705c121SKalle Valo 					trigger->id);
991e705c121SKalle Valo 				break;
992e705c121SKalle Valo 			}
993e705c121SKalle Valo 
994e705c121SKalle Valo 			if (pieces->dbg_trigger_tlv[trigger_id]) {
995e705c121SKalle Valo 				IWL_ERR(drv,
996e705c121SKalle Valo 					"Ignore duplicate dbg trigger %u\n",
997e705c121SKalle Valo 					trigger->id);
998e705c121SKalle Valo 				break;
999e705c121SKalle Valo 			}
1000e705c121SKalle Valo 
1001e705c121SKalle Valo 			IWL_INFO(drv, "Found debug trigger: %u\n", trigger->id);
1002e705c121SKalle Valo 
1003e705c121SKalle Valo 			pieces->dbg_trigger_tlv[trigger_id] = trigger;
1004e705c121SKalle Valo 			pieces->dbg_trigger_tlv_len[trigger_id] = tlv_len;
1005e705c121SKalle Valo 			break;
1006e705c121SKalle Valo 			}
1007520f03eaSShahar S Matityahu 		case IWL_UCODE_TLV_FW_DBG_DUMP_LST: {
1008520f03eaSShahar S Matityahu 			if (tlv_len != sizeof(u32)) {
1009520f03eaSShahar S Matityahu 				IWL_ERR(drv,
1010520f03eaSShahar S Matityahu 					"dbg lst mask size incorrect, skip\n");
1011520f03eaSShahar S Matityahu 				break;
1012520f03eaSShahar S Matityahu 			}
1013520f03eaSShahar S Matityahu 
101417b809c9SSara Sharon 			drv->fw.dbg.dump_mask =
1015520f03eaSShahar S Matityahu 				le32_to_cpup((__le32 *)tlv_data);
1016520f03eaSShahar S Matityahu 			break;
1017520f03eaSShahar S Matityahu 			}
1018e705c121SKalle Valo 		case IWL_UCODE_TLV_SEC_RT_USNIFFER:
1019e6eb8ca9SGolan Ben-Ami 			*usniffer_images = true;
1020e705c121SKalle Valo 			iwl_store_ucode_sec(pieces, tlv_data,
1021e705c121SKalle Valo 					    IWL_UCODE_REGULAR_USNIFFER,
1022e705c121SKalle Valo 					    tlv_len);
1023e705c121SKalle Valo 			break;
1024e705c121SKalle Valo 		case IWL_UCODE_TLV_PAGING:
1025e705c121SKalle Valo 			if (tlv_len != sizeof(u32))
1026e705c121SKalle Valo 				goto invalid_tlv_len;
1027e705c121SKalle Valo 			paging_mem_size = le32_to_cpup((__le32 *)tlv_data);
1028e705c121SKalle Valo 
1029e705c121SKalle Valo 			IWL_DEBUG_FW(drv,
1030e705c121SKalle Valo 				     "Paging: paging enabled (size = %u bytes)\n",
1031e705c121SKalle Valo 				     paging_mem_size);
1032e705c121SKalle Valo 
1033e705c121SKalle Valo 			if (paging_mem_size > MAX_PAGING_IMAGE_SIZE) {
1034e705c121SKalle Valo 				IWL_ERR(drv,
1035e705c121SKalle Valo 					"Paging: driver supports up to %lu bytes for paging image\n",
1036e705c121SKalle Valo 					MAX_PAGING_IMAGE_SIZE);
1037e705c121SKalle Valo 				return -EINVAL;
1038e705c121SKalle Valo 			}
1039e705c121SKalle Valo 
1040e705c121SKalle Valo 			if (paging_mem_size & (FW_PAGING_SIZE - 1)) {
1041e705c121SKalle Valo 				IWL_ERR(drv,
1042e705c121SKalle Valo 					"Paging: image isn't multiple %lu\n",
1043e705c121SKalle Valo 					FW_PAGING_SIZE);
1044e705c121SKalle Valo 				return -EINVAL;
1045e705c121SKalle Valo 			}
1046e705c121SKalle Valo 
1047e705c121SKalle Valo 			drv->fw.img[IWL_UCODE_REGULAR].paging_mem_size =
1048e705c121SKalle Valo 				paging_mem_size;
1049e705c121SKalle Valo 			usniffer_img = IWL_UCODE_REGULAR_USNIFFER;
1050e705c121SKalle Valo 			drv->fw.img[usniffer_img].paging_mem_size =
1051e705c121SKalle Valo 				paging_mem_size;
1052e705c121SKalle Valo 			break;
1053e705c121SKalle Valo 		case IWL_UCODE_TLV_FW_GSCAN_CAPA:
1054266ab689SLuca Coelho 			/* ignored */
1055e705c121SKalle Valo 			break;
1056a6017b90SGolan Ben-Ami 		case IWL_UCODE_TLV_FW_MEM_SEG: {
1057a6017b90SGolan Ben-Ami 			struct iwl_fw_dbg_mem_seg_tlv *dbg_mem =
1058a6017b90SGolan Ben-Ami 				(void *)tlv_data;
10592ed1e019SJohannes Berg 			size_t size;
10602ed1e019SJohannes Berg 			struct iwl_fw_dbg_mem_seg_tlv *n;
1061a6017b90SGolan Ben-Ami 
1062a6017b90SGolan Ben-Ami 			if (tlv_len != (sizeof(*dbg_mem)))
1063a6017b90SGolan Ben-Ami 				goto invalid_tlv_len;
1064a6017b90SGolan Ben-Ami 
1065a6017b90SGolan Ben-Ami 			IWL_DEBUG_INFO(drv, "Found debug memory segment: %u\n",
1066a6017b90SGolan Ben-Ami 				       dbg_mem->data_type);
1067a6017b90SGolan Ben-Ami 
10682ed1e019SJohannes Berg 			size = sizeof(*pieces->dbg_mem_tlv) *
106917b809c9SSara Sharon 			       (pieces->n_mem_tlv + 1);
10702ed1e019SJohannes Berg 			n = krealloc(pieces->dbg_mem_tlv, size, GFP_KERNEL);
10712ed1e019SJohannes Berg 			if (!n)
10722ed1e019SJohannes Berg 				return -ENOMEM;
10732ed1e019SJohannes Berg 			pieces->dbg_mem_tlv = n;
107417b809c9SSara Sharon 			pieces->dbg_mem_tlv[pieces->n_mem_tlv] = *dbg_mem;
107517b809c9SSara Sharon 			pieces->n_mem_tlv++;
1076a6017b90SGolan Ben-Ami 			break;
1077a6017b90SGolan Ben-Ami 			}
1078132db31cSGolan Ben-Ami 		case IWL_UCODE_TLV_IML: {
1079132db31cSGolan Ben-Ami 			drv->fw.iml_len = tlv_len;
1080132db31cSGolan Ben-Ami 			drv->fw.iml = kmemdup(tlv_data, tlv_len, GFP_KERNEL);
1081132db31cSGolan Ben-Ami 			if (!drv->fw.iml)
1082132db31cSGolan Ben-Ami 				return -ENOMEM;
1083132db31cSGolan Ben-Ami 			break;
1084132db31cSGolan Ben-Ami 			}
1085f130bb75SMordechay Goodstein 		case IWL_UCODE_TLV_FW_RECOVERY_INFO: {
1086f130bb75SMordechay Goodstein 			struct {
1087f130bb75SMordechay Goodstein 				__le32 buf_addr;
1088f130bb75SMordechay Goodstein 				__le32 buf_size;
1089f130bb75SMordechay Goodstein 			} *recov_info = (void *)tlv_data;
1090f130bb75SMordechay Goodstein 
1091f130bb75SMordechay Goodstein 			if (tlv_len != sizeof(*recov_info))
1092f130bb75SMordechay Goodstein 				goto invalid_tlv_len;
1093f130bb75SMordechay Goodstein 			capa->error_log_addr =
1094f130bb75SMordechay Goodstein 				le32_to_cpu(recov_info->buf_addr);
1095f130bb75SMordechay Goodstein 			capa->error_log_size =
1096f130bb75SMordechay Goodstein 				le32_to_cpu(recov_info->buf_size);
1097f130bb75SMordechay Goodstein 			}
1098f130bb75SMordechay Goodstein 			break;
10995cdb2044SEmmanuel Grumbach 		case IWL_UCODE_TLV_FW_FSEQ_VERSION: {
11005cdb2044SEmmanuel Grumbach 			struct {
11015cdb2044SEmmanuel Grumbach 				u8 version[32];
11025cdb2044SEmmanuel Grumbach 				u8 sha1[20];
11035cdb2044SEmmanuel Grumbach 			} *fseq_ver = (void *)tlv_data;
11045cdb2044SEmmanuel Grumbach 
11055cdb2044SEmmanuel Grumbach 			if (tlv_len != sizeof(*fseq_ver))
11065cdb2044SEmmanuel Grumbach 				goto invalid_tlv_len;
11075cdb2044SEmmanuel Grumbach 			IWL_INFO(drv, "TLV_FW_FSEQ_VERSION: %s\n",
11085cdb2044SEmmanuel Grumbach 				 fseq_ver->version);
11095cdb2044SEmmanuel Grumbach 			}
11105cdb2044SEmmanuel Grumbach 			break;
1111be9ae34eSNathan Errera 		case IWL_UCODE_TLV_FW_NUM_STATIONS:
1112be9ae34eSNathan Errera 			if (tlv_len != sizeof(u32))
1113be9ae34eSNathan Errera 				goto invalid_tlv_len;
1114be9ae34eSNathan Errera 			if (le32_to_cpup((__le32 *)tlv_data) >
1115be9ae34eSNathan Errera 			    IWL_MVM_STATION_COUNT_MAX) {
1116be9ae34eSNathan Errera 				IWL_ERR(drv,
1117be9ae34eSNathan Errera 					"%d is an invalid number of station\n",
1118be9ae34eSNathan Errera 					le32_to_cpup((__le32 *)tlv_data));
1119be9ae34eSNathan Errera 				goto tlv_error;
1120be9ae34eSNathan Errera 			}
1121be9ae34eSNathan Errera 			capa->num_stations =
1122be9ae34eSNathan Errera 				le32_to_cpup((__le32 *)tlv_data);
1123be9ae34eSNathan Errera 			break;
112422463857SShahar S Matityahu 		case IWL_UCODE_TLV_UMAC_DEBUG_ADDRS: {
112522463857SShahar S Matityahu 			struct iwl_umac_debug_addrs *dbg_ptrs =
112622463857SShahar S Matityahu 				(void *)tlv_data;
112722463857SShahar S Matityahu 
112822463857SShahar S Matityahu 			if (tlv_len != sizeof(*dbg_ptrs))
112922463857SShahar S Matityahu 				goto invalid_tlv_len;
1130286ca8ebSLuca Coelho 			if (drv->trans->trans_cfg->device_family <
113122463857SShahar S Matityahu 			    IWL_DEVICE_FAMILY_22000)
113222463857SShahar S Matityahu 				break;
113391c28b83SShahar S Matityahu 			drv->trans->dbg.umac_error_event_table =
113422463857SShahar S Matityahu 				le32_to_cpu(dbg_ptrs->error_info_addr) &
113522463857SShahar S Matityahu 				~FW_ADDR_CACHE_CONTROL;
113691c28b83SShahar S Matityahu 			drv->trans->dbg.error_event_table_tlv_status |=
113722463857SShahar S Matityahu 				IWL_ERROR_EVENT_TABLE_UMAC;
113822463857SShahar S Matityahu 			break;
113922463857SShahar S Matityahu 			}
114022463857SShahar S Matityahu 		case IWL_UCODE_TLV_LMAC_DEBUG_ADDRS: {
114122463857SShahar S Matityahu 			struct iwl_lmac_debug_addrs *dbg_ptrs =
114222463857SShahar S Matityahu 				(void *)tlv_data;
114322463857SShahar S Matityahu 
114422463857SShahar S Matityahu 			if (tlv_len != sizeof(*dbg_ptrs))
114522463857SShahar S Matityahu 				goto invalid_tlv_len;
1146286ca8ebSLuca Coelho 			if (drv->trans->trans_cfg->device_family <
114722463857SShahar S Matityahu 			    IWL_DEVICE_FAMILY_22000)
114822463857SShahar S Matityahu 				break;
114991c28b83SShahar S Matityahu 			drv->trans->dbg.lmac_error_event_table[0] =
115022463857SShahar S Matityahu 				le32_to_cpu(dbg_ptrs->error_event_table_ptr) &
115122463857SShahar S Matityahu 				~FW_ADDR_CACHE_CONTROL;
115291c28b83SShahar S Matityahu 			drv->trans->dbg.error_event_table_tlv_status |=
115322463857SShahar S Matityahu 				IWL_ERROR_EVENT_TABLE_LMAC1;
115422463857SShahar S Matityahu 			break;
115522463857SShahar S Matityahu 			}
115648d0c8d5SJohannes Berg 		case IWL_UCODE_TLV_TCM_DEBUG_ADDRS: {
115748d0c8d5SJohannes Berg 			struct iwl_fw_tcm_error_addr *ptr = (void *)tlv_data;
115848d0c8d5SJohannes Berg 
115948d0c8d5SJohannes Berg 			if (tlv_len != sizeof(*ptr))
116048d0c8d5SJohannes Berg 				goto invalid_tlv_len;
116148d0c8d5SJohannes Berg 			drv->trans->dbg.tcm_error_event_table =
116248d0c8d5SJohannes Berg 				le32_to_cpu(ptr->addr) & ~FW_ADDR_CACHE_CONTROL;
116348d0c8d5SJohannes Berg 			drv->trans->dbg.error_event_table_tlv_status |=
116448d0c8d5SJohannes Berg 				IWL_ERROR_EVENT_TABLE_TCM;
116548d0c8d5SJohannes Berg 			break;
116648d0c8d5SJohannes Berg 			}
116757d88b11SShahar S Matityahu 		case IWL_UCODE_TLV_TYPE_DEBUG_INFO:
1168f14cda6fSSara Sharon 		case IWL_UCODE_TLV_TYPE_BUFFER_ALLOCATION:
1169f14cda6fSSara Sharon 		case IWL_UCODE_TLV_TYPE_HCMD:
1170f14cda6fSSara Sharon 		case IWL_UCODE_TLV_TYPE_REGIONS:
1171f14cda6fSSara Sharon 		case IWL_UCODE_TLV_TYPE_TRIGGERS:
1172f21baf24SMukesh Sisodiya 		case IWL_UCODE_TLV_TYPE_CONF_SET:
1173f14cda6fSSara Sharon 			if (iwlwifi_mod_params.enable_ini)
1174341bd290SShahar S Matityahu 				iwl_dbg_tlv_alloc(drv->trans, tlv, false);
117519de2fa8SShahar S Matityahu 			break;
1176b081e23cSJohannes Berg 		case IWL_UCODE_TLV_CMD_VERSIONS:
1177b081e23cSJohannes Berg 			if (tlv_len % sizeof(struct iwl_fw_cmd_version)) {
1178b081e23cSJohannes Berg 				IWL_ERR(drv,
1179b081e23cSJohannes Berg 					"Invalid length for command versions: %u\n",
1180b081e23cSJohannes Berg 					tlv_len);
1181b081e23cSJohannes Berg 				tlv_len /= sizeof(struct iwl_fw_cmd_version);
1182b081e23cSJohannes Berg 				tlv_len *= sizeof(struct iwl_fw_cmd_version);
1183b081e23cSJohannes Berg 			}
1184b081e23cSJohannes Berg 			if (WARN_ON(capa->cmd_versions))
1185b081e23cSJohannes Berg 				return -EINVAL;
1186b081e23cSJohannes Berg 			capa->cmd_versions = kmemdup(tlv_data, tlv_len,
1187b081e23cSJohannes Berg 						     GFP_KERNEL);
1188b081e23cSJohannes Berg 			if (!capa->cmd_versions)
1189b081e23cSJohannes Berg 				return -ENOMEM;
1190b081e23cSJohannes Berg 			capa->n_cmd_versions =
1191b081e23cSJohannes Berg 				tlv_len / sizeof(struct iwl_fw_cmd_version);
1192b081e23cSJohannes Berg 			break;
1193a1d59263SDror Moshe 		case IWL_UCODE_TLV_PHY_INTEGRATION_VERSION:
1194a1d59263SDror Moshe 			if (drv->fw.phy_integration_ver) {
1195a1d59263SDror Moshe 				IWL_ERR(drv,
1196a1d59263SDror Moshe 					"phy integration str ignored, already exists\n");
1197a1d59263SDror Moshe 				break;
1198a1d59263SDror Moshe 			}
1199a1d59263SDror Moshe 
1200a1d59263SDror Moshe 			drv->fw.phy_integration_ver =
1201a1d59263SDror Moshe 				kmemdup(tlv_data, tlv_len, GFP_KERNEL);
1202a1d59263SDror Moshe 			if (!drv->fw.phy_integration_ver)
1203a1d59263SDror Moshe 				return -ENOMEM;
1204a1d59263SDror Moshe 			drv->fw.phy_integration_ver_len = tlv_len;
1205a1d59263SDror Moshe 			break;
1206fad92a1dSJohannes Berg 		case IWL_UCODE_TLV_SEC_TABLE_ADDR:
1207fad92a1dSJohannes Berg 		case IWL_UCODE_TLV_D3_KEK_KCK_ADDR:
1208fad92a1dSJohannes Berg 			iwl_drv_set_dump_exclude(drv, tlv_type,
1209fad92a1dSJohannes Berg 						 tlv_data, tlv_len);
1210fad92a1dSJohannes Berg 			break;
1211e705c121SKalle Valo 		default:
1212e705c121SKalle Valo 			IWL_DEBUG_INFO(drv, "unknown TLV: %d\n", tlv_type);
1213e705c121SKalle Valo 			break;
1214e705c121SKalle Valo 		}
1215e705c121SKalle Valo 	}
1216e705c121SKalle Valo 
12173d2d4422SGolan Ben-Ami 	if (!fw_has_capa(capa, IWL_UCODE_TLV_CAPA_USNIFFER_UNIFIED) &&
12183d2d4422SGolan Ben-Ami 	    usniffer_req && !*usniffer_images) {
1219e705c121SKalle Valo 		IWL_ERR(drv,
1220e705c121SKalle Valo 			"user selected to work with usniffer but usniffer image isn't available in ucode package\n");
1221e705c121SKalle Valo 		return -EINVAL;
1222e705c121SKalle Valo 	}
1223e705c121SKalle Valo 
1224e705c121SKalle Valo 	if (len) {
1225e705c121SKalle Valo 		IWL_ERR(drv, "invalid TLV after parsing: %zd\n", len);
1226e705c121SKalle Valo 		iwl_print_hex_dump(drv, IWL_DL_FW, (u8 *)data, len);
1227e705c121SKalle Valo 		return -EINVAL;
1228e705c121SKalle Valo 	}
1229e705c121SKalle Valo 
1230e705c121SKalle Valo 	return 0;
1231e705c121SKalle Valo 
1232e705c121SKalle Valo  invalid_tlv_len:
1233e705c121SKalle Valo 	IWL_ERR(drv, "TLV %d has invalid size: %u\n", tlv_type, tlv_len);
1234e705c121SKalle Valo  tlv_error:
1235e705c121SKalle Valo 	iwl_print_hex_dump(drv, IWL_DL_FW, tlv_data, tlv_len);
1236e705c121SKalle Valo 
1237e705c121SKalle Valo 	return -EINVAL;
1238e705c121SKalle Valo }
1239e705c121SKalle Valo 
1240e705c121SKalle Valo static int iwl_alloc_ucode(struct iwl_drv *drv,
1241e705c121SKalle Valo 			   struct iwl_firmware_pieces *pieces,
1242e705c121SKalle Valo 			   enum iwl_ucode_type type)
1243e705c121SKalle Valo {
1244e705c121SKalle Valo 	int i;
1245eef187a7SSara Sharon 	struct fw_desc *sec;
1246eef187a7SSara Sharon 
1247eef187a7SSara Sharon 	sec = kcalloc(pieces->img[type].sec_counter, sizeof(*sec), GFP_KERNEL);
1248eef187a7SSara Sharon 	if (!sec)
1249e705c121SKalle Valo 		return -ENOMEM;
1250eef187a7SSara Sharon 	drv->fw.img[type].sec = sec;
1251eef187a7SSara Sharon 	drv->fw.img[type].num_sec = pieces->img[type].sec_counter;
1252eef187a7SSara Sharon 
1253eef187a7SSara Sharon 	for (i = 0; i < pieces->img[type].sec_counter; i++)
1254eef187a7SSara Sharon 		if (iwl_alloc_fw_desc(drv, &sec[i], get_sec(pieces, type, i)))
1255eef187a7SSara Sharon 			return -ENOMEM;
1256eef187a7SSara Sharon 
1257e705c121SKalle Valo 	return 0;
1258e705c121SKalle Valo }
1259e705c121SKalle Valo 
1260e705c121SKalle Valo static int validate_sec_sizes(struct iwl_drv *drv,
1261e705c121SKalle Valo 			      struct iwl_firmware_pieces *pieces,
1262e705c121SKalle Valo 			      const struct iwl_cfg *cfg)
1263e705c121SKalle Valo {
12645b5e0928SAlexey Dobriyan 	IWL_DEBUG_INFO(drv, "f/w package hdr runtime inst size = %zd\n",
1265e705c121SKalle Valo 		get_sec_size(pieces, IWL_UCODE_REGULAR,
1266e705c121SKalle Valo 			     IWL_UCODE_SECTION_INST));
12675b5e0928SAlexey Dobriyan 	IWL_DEBUG_INFO(drv, "f/w package hdr runtime data size = %zd\n",
1268e705c121SKalle Valo 		get_sec_size(pieces, IWL_UCODE_REGULAR,
1269e705c121SKalle Valo 			     IWL_UCODE_SECTION_DATA));
12705b5e0928SAlexey Dobriyan 	IWL_DEBUG_INFO(drv, "f/w package hdr init inst size = %zd\n",
1271e705c121SKalle Valo 		get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST));
12725b5e0928SAlexey Dobriyan 	IWL_DEBUG_INFO(drv, "f/w package hdr init data size = %zd\n",
1273e705c121SKalle Valo 		get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA));
1274e705c121SKalle Valo 
1275e705c121SKalle Valo 	/* Verify that uCode images will fit in card's SRAM. */
1276e705c121SKalle Valo 	if (get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST) >
1277e705c121SKalle Valo 	    cfg->max_inst_size) {
12785b5e0928SAlexey Dobriyan 		IWL_ERR(drv, "uCode instr len %zd too large to fit in\n",
1279e705c121SKalle Valo 			get_sec_size(pieces, IWL_UCODE_REGULAR,
1280e705c121SKalle Valo 				     IWL_UCODE_SECTION_INST));
1281e705c121SKalle Valo 		return -1;
1282e705c121SKalle Valo 	}
1283e705c121SKalle Valo 
1284e705c121SKalle Valo 	if (get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA) >
1285e705c121SKalle Valo 	    cfg->max_data_size) {
12865b5e0928SAlexey Dobriyan 		IWL_ERR(drv, "uCode data len %zd too large to fit in\n",
1287e705c121SKalle Valo 			get_sec_size(pieces, IWL_UCODE_REGULAR,
1288e705c121SKalle Valo 				     IWL_UCODE_SECTION_DATA));
1289e705c121SKalle Valo 		return -1;
1290e705c121SKalle Valo 	}
1291e705c121SKalle Valo 
1292e705c121SKalle Valo 	if (get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST) >
1293e705c121SKalle Valo 	     cfg->max_inst_size) {
12945b5e0928SAlexey Dobriyan 		IWL_ERR(drv, "uCode init instr len %zd too large to fit in\n",
1295e705c121SKalle Valo 			get_sec_size(pieces, IWL_UCODE_INIT,
1296e705c121SKalle Valo 				     IWL_UCODE_SECTION_INST));
1297e705c121SKalle Valo 		return -1;
1298e705c121SKalle Valo 	}
1299e705c121SKalle Valo 
1300e705c121SKalle Valo 	if (get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA) >
1301e705c121SKalle Valo 	    cfg->max_data_size) {
13025b5e0928SAlexey Dobriyan 		IWL_ERR(drv, "uCode init data len %zd too large to fit in\n",
1303e705c121SKalle Valo 			get_sec_size(pieces, IWL_UCODE_REGULAR,
1304e705c121SKalle Valo 				     IWL_UCODE_SECTION_DATA));
1305e705c121SKalle Valo 		return -1;
1306e705c121SKalle Valo 	}
1307e705c121SKalle Valo 	return 0;
1308e705c121SKalle Valo }
1309e705c121SKalle Valo 
1310e705c121SKalle Valo static struct iwl_op_mode *
1311e705c121SKalle Valo _iwl_op_mode_start(struct iwl_drv *drv, struct iwlwifi_opmode_table *op)
1312e705c121SKalle Valo {
1313e705c121SKalle Valo 	const struct iwl_op_mode_ops *ops = op->ops;
1314e705c121SKalle Valo 	struct dentry *dbgfs_dir = NULL;
1315e705c121SKalle Valo 	struct iwl_op_mode *op_mode = NULL;
1316*5283dd67SMordechay Goodstein 	int retry, max_retry = !!iwlwifi_mod_params.fw_restart * IWL_MAX_INIT_RETRY;
1317*5283dd67SMordechay Goodstein 
1318*5283dd67SMordechay Goodstein 	for (retry = 0; retry <= max_retry; retry++) {
1319e705c121SKalle Valo 
1320e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS
1321e705c121SKalle Valo 		drv->dbgfs_op_mode = debugfs_create_dir(op->name,
1322e705c121SKalle Valo 							drv->dbgfs_drv);
1323e705c121SKalle Valo 		dbgfs_dir = drv->dbgfs_op_mode;
1324e705c121SKalle Valo #endif
1325e705c121SKalle Valo 
1326*5283dd67SMordechay Goodstein 		op_mode = ops->start(drv->trans, drv->trans->cfg,
1327*5283dd67SMordechay Goodstein 				     &drv->fw, dbgfs_dir);
1328*5283dd67SMordechay Goodstein 
1329*5283dd67SMordechay Goodstein 		if (op_mode)
1330*5283dd67SMordechay Goodstein 			return op_mode;
1331*5283dd67SMordechay Goodstein 
1332*5283dd67SMordechay Goodstein 		IWL_ERR(drv, "retry init count %d\n", retry);
1333e705c121SKalle Valo 
1334e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS
1335e705c121SKalle Valo 		debugfs_remove_recursive(drv->dbgfs_op_mode);
1336e705c121SKalle Valo 		drv->dbgfs_op_mode = NULL;
1337e705c121SKalle Valo #endif
1338*5283dd67SMordechay Goodstein 	}
1339e705c121SKalle Valo 
1340*5283dd67SMordechay Goodstein 	return NULL;
1341e705c121SKalle Valo }
1342e705c121SKalle Valo 
1343e705c121SKalle Valo static void _iwl_op_mode_stop(struct iwl_drv *drv)
1344e705c121SKalle Valo {
1345e705c121SKalle Valo 	/* op_mode can be NULL if its start failed */
1346e705c121SKalle Valo 	if (drv->op_mode) {
1347e705c121SKalle Valo 		iwl_op_mode_stop(drv->op_mode);
1348e705c121SKalle Valo 		drv->op_mode = NULL;
1349e705c121SKalle Valo 
1350e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS
1351e705c121SKalle Valo 		debugfs_remove_recursive(drv->dbgfs_op_mode);
1352e705c121SKalle Valo 		drv->dbgfs_op_mode = NULL;
1353e705c121SKalle Valo #endif
1354e705c121SKalle Valo 	}
1355e705c121SKalle Valo }
1356e705c121SKalle Valo 
13577d4ced86SLee Jones /*
1358e705c121SKalle Valo  * iwl_req_fw_callback - callback when firmware was loaded
1359e705c121SKalle Valo  *
1360e705c121SKalle Valo  * If loaded successfully, copies the firmware into buffers
1361e705c121SKalle Valo  * for the card to fetch (via DMA).
1362e705c121SKalle Valo  */
1363e705c121SKalle Valo static void iwl_req_fw_callback(const struct firmware *ucode_raw, void *context)
1364e705c121SKalle Valo {
1365e705c121SKalle Valo 	struct iwl_drv *drv = context;
1366e705c121SKalle Valo 	struct iwl_fw *fw = &drv->fw;
1367e705c121SKalle Valo 	struct iwl_ucode_header *ucode;
1368e705c121SKalle Valo 	struct iwlwifi_opmode_table *op;
1369e705c121SKalle Valo 	int err;
1370e705c121SKalle Valo 	struct iwl_firmware_pieces *pieces;
13710c4881ceSLuca Coelho 	const unsigned int api_max = drv->trans->cfg->ucode_api_max;
13720c4881ceSLuca Coelho 	const unsigned int api_min = drv->trans->cfg->ucode_api_min;
1373e705c121SKalle Valo 	size_t trigger_tlv_sz[FW_DBG_TRIGGER_MAX];
1374e705c121SKalle Valo 	u32 api_ver;
1375e705c121SKalle Valo 	int i;
1376e705c121SKalle Valo 	bool load_module = false;
1377e6eb8ca9SGolan Ben-Ami 	bool usniffer_images = false;
1378e705c121SKalle Valo 
1379e705c121SKalle Valo 	fw->ucode_capa.max_probe_length = IWL_DEFAULT_MAX_PROBE_LENGTH;
1380e705c121SKalle Valo 	fw->ucode_capa.standard_phy_calibration_size =
1381e705c121SKalle Valo 			IWL_DEFAULT_STANDARD_PHY_CALIBRATE_TBL_SIZE;
1382e705c121SKalle Valo 	fw->ucode_capa.n_scan_channels = IWL_DEFAULT_SCAN_CHANNELS;
1383be9ae34eSNathan Errera 	fw->ucode_capa.num_stations = IWL_MVM_STATION_COUNT_MAX;
1384971377e6SShahar S Matityahu 	/* dump all fw memory areas by default */
1385971377e6SShahar S Matityahu 	fw->dbg.dump_mask = 0xffffffff;
1386e705c121SKalle Valo 
1387e705c121SKalle Valo 	pieces = kzalloc(sizeof(*pieces), GFP_KERNEL);
1388e705c121SKalle Valo 	if (!pieces)
138953d515ecSJohannes Berg 		goto out_free_fw;
1390e705c121SKalle Valo 
13919d9b21d1SEmmanuel Grumbach 	if (!ucode_raw)
1392e705c121SKalle Valo 		goto try_again;
1393e705c121SKalle Valo 
13942953c393SShahar S Matityahu 	IWL_DEBUG_FW_INFO(drv, "Loaded firmware file '%s' (%zd bytes).\n",
1395e705c121SKalle Valo 			  drv->firmware_name, ucode_raw->size);
1396e705c121SKalle Valo 
1397e705c121SKalle Valo 	/* Make sure that we got at least the API version number */
1398e705c121SKalle Valo 	if (ucode_raw->size < 4) {
1399e705c121SKalle Valo 		IWL_ERR(drv, "File size way too small!\n");
1400e705c121SKalle Valo 		goto try_again;
1401e705c121SKalle Valo 	}
1402e705c121SKalle Valo 
1403e705c121SKalle Valo 	/* Data from ucode file:  header followed by uCode images */
1404e705c121SKalle Valo 	ucode = (struct iwl_ucode_header *)ucode_raw->data;
1405e705c121SKalle Valo 
1406e705c121SKalle Valo 	if (ucode->ver)
1407e705c121SKalle Valo 		err = iwl_parse_v1_v2_firmware(drv, ucode_raw, pieces);
1408e705c121SKalle Valo 	else
1409e705c121SKalle Valo 		err = iwl_parse_tlv_firmware(drv, ucode_raw, pieces,
1410e6eb8ca9SGolan Ben-Ami 					     &fw->ucode_capa, &usniffer_images);
1411e705c121SKalle Valo 
1412e705c121SKalle Valo 	if (err)
1413e705c121SKalle Valo 		goto try_again;
1414e705c121SKalle Valo 
1415f0d8f38cSLuca Coelho 	if (fw_has_api(&drv->fw.ucode_capa, IWL_UCODE_TLV_API_NEW_VERSION))
1416e705c121SKalle Valo 		api_ver = drv->fw.ucode_ver;
1417f0d8f38cSLuca Coelho 	else
1418f0d8f38cSLuca Coelho 		api_ver = IWL_UCODE_API(drv->fw.ucode_ver);
1419e705c121SKalle Valo 
1420e705c121SKalle Valo 	/*
1421e705c121SKalle Valo 	 * api_ver should match the api version forming part of the
1422e705c121SKalle Valo 	 * firmware filename ... but we don't check for that and only rely
1423e705c121SKalle Valo 	 * on the API version read from firmware header from here on forward
1424e705c121SKalle Valo 	 */
1425e705c121SKalle Valo 	if (api_ver < api_min || api_ver > api_max) {
1426e705c121SKalle Valo 		IWL_ERR(drv,
1427e705c121SKalle Valo 			"Driver unable to support your firmware API. "
1428e705c121SKalle Valo 			"Driver supports v%u, firmware is v%u.\n",
1429e705c121SKalle Valo 			api_max, api_ver);
1430e705c121SKalle Valo 		goto try_again;
1431e705c121SKalle Valo 	}
1432e705c121SKalle Valo 
1433e705c121SKalle Valo 	/*
1434e705c121SKalle Valo 	 * In mvm uCode there is no difference between data and instructions
1435e705c121SKalle Valo 	 * sections.
1436e705c121SKalle Valo 	 */
14370c4881ceSLuca Coelho 	if (fw->type == IWL_FW_DVM && validate_sec_sizes(drv, pieces,
14380c4881ceSLuca Coelho 							 drv->trans->cfg))
1439e705c121SKalle Valo 		goto try_again;
1440e705c121SKalle Valo 
1441e705c121SKalle Valo 	/* Allocate ucode buffers for card's bus-master loading ... */
1442e705c121SKalle Valo 
1443e705c121SKalle Valo 	/* Runtime instructions and 2 copies of data:
1444e705c121SKalle Valo 	 * 1) unmodified from disk
14451e37f799SChristoph Böhmwalder 	 * 2) backup cache for save/restore during power-downs
14461e37f799SChristoph Böhmwalder 	 */
1447e705c121SKalle Valo 	for (i = 0; i < IWL_UCODE_TYPE_MAX; i++)
1448e705c121SKalle Valo 		if (iwl_alloc_ucode(drv, pieces, i))
1449e705c121SKalle Valo 			goto out_free_fw;
1450e705c121SKalle Valo 
1451fd527eb5SGolan Ben Ami 	if (pieces->dbg_dest_tlv_init) {
145217b809c9SSara Sharon 		size_t dbg_dest_size = sizeof(*drv->fw.dbg.dest_tlv) +
145317b809c9SSara Sharon 			sizeof(drv->fw.dbg.dest_tlv->reg_ops[0]) *
145417b809c9SSara Sharon 			drv->fw.dbg.n_dest_reg;
1455fd527eb5SGolan Ben Ami 
145617b809c9SSara Sharon 		drv->fw.dbg.dest_tlv = kmalloc(dbg_dest_size, GFP_KERNEL);
1457e705c121SKalle Valo 
145817b809c9SSara Sharon 		if (!drv->fw.dbg.dest_tlv)
1459e705c121SKalle Valo 			goto out_free_fw;
1460fd527eb5SGolan Ben Ami 
1461fd527eb5SGolan Ben Ami 		if (*pieces->dbg_dest_ver == 0) {
146217b809c9SSara Sharon 			memcpy(drv->fw.dbg.dest_tlv, pieces->dbg_dest_tlv_v1,
1463fd527eb5SGolan Ben Ami 			       dbg_dest_size);
1464fd527eb5SGolan Ben Ami 		} else {
1465fd527eb5SGolan Ben Ami 			struct iwl_fw_dbg_dest_tlv_v1 *dest_tlv =
146617b809c9SSara Sharon 				drv->fw.dbg.dest_tlv;
1467fd527eb5SGolan Ben Ami 
1468fd527eb5SGolan Ben Ami 			dest_tlv->version = pieces->dbg_dest_tlv->version;
1469fd527eb5SGolan Ben Ami 			dest_tlv->monitor_mode =
1470fd527eb5SGolan Ben Ami 				pieces->dbg_dest_tlv->monitor_mode;
1471fd527eb5SGolan Ben Ami 			dest_tlv->size_power =
1472fd527eb5SGolan Ben Ami 				pieces->dbg_dest_tlv->size_power;
1473fd527eb5SGolan Ben Ami 			dest_tlv->wrap_count =
1474fd527eb5SGolan Ben Ami 				pieces->dbg_dest_tlv->wrap_count;
1475fd527eb5SGolan Ben Ami 			dest_tlv->write_ptr_reg =
1476fd527eb5SGolan Ben Ami 				pieces->dbg_dest_tlv->write_ptr_reg;
1477fd527eb5SGolan Ben Ami 			dest_tlv->base_shift =
1478fd527eb5SGolan Ben Ami 				pieces->dbg_dest_tlv->base_shift;
1479fd527eb5SGolan Ben Ami 			memcpy(dest_tlv->reg_ops,
1480fd527eb5SGolan Ben Ami 			       pieces->dbg_dest_tlv->reg_ops,
148117b809c9SSara Sharon 			       sizeof(drv->fw.dbg.dest_tlv->reg_ops[0]) *
148217b809c9SSara Sharon 			       drv->fw.dbg.n_dest_reg);
1483fd527eb5SGolan Ben Ami 
1484fd527eb5SGolan Ben Ami 			/* In version 1 of the destination tlv, which is
1485fd527eb5SGolan Ben Ami 			 * relevant for internal buffer exclusively,
1486fd527eb5SGolan Ben Ami 			 * the base address is part of given with the length
1487fd527eb5SGolan Ben Ami 			 * of the buffer, and the size shift is give instead of
1488fd527eb5SGolan Ben Ami 			 * end shift. We now store these values in base_reg,
1489fd527eb5SGolan Ben Ami 			 * and end shift, and when dumping the data we'll
1490fd527eb5SGolan Ben Ami 			 * manipulate it for extracting both the length and
1491fd527eb5SGolan Ben Ami 			 * base address */
1492fd527eb5SGolan Ben Ami 			dest_tlv->base_reg = pieces->dbg_dest_tlv->cfg_reg;
1493fd527eb5SGolan Ben Ami 			dest_tlv->end_shift =
1494fd527eb5SGolan Ben Ami 				pieces->dbg_dest_tlv->size_shift;
1495fd527eb5SGolan Ben Ami 		}
1496e705c121SKalle Valo 	}
1497e705c121SKalle Valo 
149817b809c9SSara Sharon 	for (i = 0; i < ARRAY_SIZE(drv->fw.dbg.conf_tlv); i++) {
1499e705c121SKalle Valo 		if (pieces->dbg_conf_tlv[i]) {
150017b809c9SSara Sharon 			drv->fw.dbg.conf_tlv[i] =
1501e705c121SKalle Valo 				kmemdup(pieces->dbg_conf_tlv[i],
150217b809c9SSara Sharon 					pieces->dbg_conf_tlv_len[i],
1503e705c121SKalle Valo 					GFP_KERNEL);
1504a176e114SChris Rorvick 			if (!drv->fw.dbg.conf_tlv[i])
1505e705c121SKalle Valo 				goto out_free_fw;
1506e705c121SKalle Valo 		}
1507e705c121SKalle Valo 	}
1508e705c121SKalle Valo 
1509e705c121SKalle Valo 	memset(&trigger_tlv_sz, 0xff, sizeof(trigger_tlv_sz));
1510e705c121SKalle Valo 
1511e705c121SKalle Valo 	trigger_tlv_sz[FW_DBG_TRIGGER_MISSED_BEACONS] =
1512e705c121SKalle Valo 		sizeof(struct iwl_fw_dbg_trigger_missed_bcon);
1513e705c121SKalle Valo 	trigger_tlv_sz[FW_DBG_TRIGGER_CHANNEL_SWITCH] = 0;
1514e705c121SKalle Valo 	trigger_tlv_sz[FW_DBG_TRIGGER_FW_NOTIF] =
1515e705c121SKalle Valo 		sizeof(struct iwl_fw_dbg_trigger_cmd);
1516e705c121SKalle Valo 	trigger_tlv_sz[FW_DBG_TRIGGER_MLME] =
1517e705c121SKalle Valo 		sizeof(struct iwl_fw_dbg_trigger_mlme);
1518e705c121SKalle Valo 	trigger_tlv_sz[FW_DBG_TRIGGER_STATS] =
1519e705c121SKalle Valo 		sizeof(struct iwl_fw_dbg_trigger_stats);
1520e705c121SKalle Valo 	trigger_tlv_sz[FW_DBG_TRIGGER_RSSI] =
1521e705c121SKalle Valo 		sizeof(struct iwl_fw_dbg_trigger_low_rssi);
1522e705c121SKalle Valo 	trigger_tlv_sz[FW_DBG_TRIGGER_TXQ_TIMERS] =
1523e705c121SKalle Valo 		sizeof(struct iwl_fw_dbg_trigger_txq_timer);
1524e705c121SKalle Valo 	trigger_tlv_sz[FW_DBG_TRIGGER_TIME_EVENT] =
1525e705c121SKalle Valo 		sizeof(struct iwl_fw_dbg_trigger_time_event);
1526e705c121SKalle Valo 	trigger_tlv_sz[FW_DBG_TRIGGER_BA] =
1527e705c121SKalle Valo 		sizeof(struct iwl_fw_dbg_trigger_ba);
15281e8f1329SGolan Ben-Ami 	trigger_tlv_sz[FW_DBG_TRIGGER_TDLS] =
15291e8f1329SGolan Ben-Ami 		sizeof(struct iwl_fw_dbg_trigger_tdls);
1530e705c121SKalle Valo 
153117b809c9SSara Sharon 	for (i = 0; i < ARRAY_SIZE(drv->fw.dbg.trigger_tlv); i++) {
1532e705c121SKalle Valo 		if (pieces->dbg_trigger_tlv[i]) {
1533e705c121SKalle Valo 			/*
1534e705c121SKalle Valo 			 * If the trigger isn't long enough, WARN and exit.
1535e705c121SKalle Valo 			 * Someone is trying to debug something and he won't
1536e705c121SKalle Valo 			 * be able to catch the bug he is trying to chase.
1537e705c121SKalle Valo 			 * We'd better be noisy to be sure he knows what's
1538e705c121SKalle Valo 			 * going on.
1539e705c121SKalle Valo 			 */
1540e705c121SKalle Valo 			if (WARN_ON(pieces->dbg_trigger_tlv_len[i] <
1541e705c121SKalle Valo 				    (trigger_tlv_sz[i] +
1542e705c121SKalle Valo 				     sizeof(struct iwl_fw_dbg_trigger_tlv))))
1543e705c121SKalle Valo 				goto out_free_fw;
154417b809c9SSara Sharon 			drv->fw.dbg.trigger_tlv_len[i] =
1545e705c121SKalle Valo 				pieces->dbg_trigger_tlv_len[i];
154617b809c9SSara Sharon 			drv->fw.dbg.trigger_tlv[i] =
1547e705c121SKalle Valo 				kmemdup(pieces->dbg_trigger_tlv[i],
154817b809c9SSara Sharon 					drv->fw.dbg.trigger_tlv_len[i],
1549e705c121SKalle Valo 					GFP_KERNEL);
155017b809c9SSara Sharon 			if (!drv->fw.dbg.trigger_tlv[i])
1551e705c121SKalle Valo 				goto out_free_fw;
1552e705c121SKalle Valo 		}
1553e705c121SKalle Valo 	}
1554e705c121SKalle Valo 
1555e705c121SKalle Valo 	/* Now that we can no longer fail, copy information */
1556e705c121SKalle Valo 
155717b809c9SSara Sharon 	drv->fw.dbg.mem_tlv = pieces->dbg_mem_tlv;
15582ed1e019SJohannes Berg 	pieces->dbg_mem_tlv = NULL;
155917b809c9SSara Sharon 	drv->fw.dbg.n_mem_tlv = pieces->n_mem_tlv;
15602ed1e019SJohannes Berg 
1561e705c121SKalle Valo 	/*
1562e705c121SKalle Valo 	 * The (size - 16) / 12 formula is based on the information recorded
1563e705c121SKalle Valo 	 * for each event, which is of mode 1 (including timestamp) for all
1564e705c121SKalle Valo 	 * new microcodes that include this information.
1565e705c121SKalle Valo 	 */
1566e705c121SKalle Valo 	fw->init_evtlog_ptr = pieces->init_evtlog_ptr;
1567e705c121SKalle Valo 	if (pieces->init_evtlog_size)
1568e705c121SKalle Valo 		fw->init_evtlog_size = (pieces->init_evtlog_size - 16)/12;
1569e705c121SKalle Valo 	else
1570e705c121SKalle Valo 		fw->init_evtlog_size =
1571286ca8ebSLuca Coelho 			drv->trans->trans_cfg->base_params->max_event_log_size;
1572e705c121SKalle Valo 	fw->init_errlog_ptr = pieces->init_errlog_ptr;
1573e705c121SKalle Valo 	fw->inst_evtlog_ptr = pieces->inst_evtlog_ptr;
1574e705c121SKalle Valo 	if (pieces->inst_evtlog_size)
1575e705c121SKalle Valo 		fw->inst_evtlog_size = (pieces->inst_evtlog_size - 16)/12;
1576e705c121SKalle Valo 	else
1577e705c121SKalle Valo 		fw->inst_evtlog_size =
1578286ca8ebSLuca Coelho 			drv->trans->trans_cfg->base_params->max_event_log_size;
1579e705c121SKalle Valo 	fw->inst_errlog_ptr = pieces->inst_errlog_ptr;
1580e705c121SKalle Valo 
1581e705c121SKalle Valo 	/*
1582e705c121SKalle Valo 	 * figure out the offset of chain noise reset and gain commands
1583e705c121SKalle Valo 	 * base on the size of standard phy calibration commands table size
1584e705c121SKalle Valo 	 */
1585e705c121SKalle Valo 	if (fw->ucode_capa.standard_phy_calibration_size >
1586e705c121SKalle Valo 	    IWL_MAX_PHY_CALIBRATE_TBL_SIZE)
1587e705c121SKalle Valo 		fw->ucode_capa.standard_phy_calibration_size =
1588e705c121SKalle Valo 			IWL_MAX_STANDARD_PHY_CALIBRATE_TBL_SIZE;
1589e705c121SKalle Valo 
1590e705c121SKalle Valo 	/* We have our copies now, allow OS release its copies */
1591e705c121SKalle Valo 	release_firmware(ucode_raw);
1592e705c121SKalle Valo 
1593e705c121SKalle Valo 	mutex_lock(&iwlwifi_opmode_table_mtx);
1594ca221c9bSJohannes Berg 	switch (fw->type) {
1595ca221c9bSJohannes Berg 	case IWL_FW_DVM:
1596e705c121SKalle Valo 		op = &iwlwifi_opmode_table[DVM_OP_MODE];
1597ca221c9bSJohannes Berg 		break;
1598ca221c9bSJohannes Berg 	default:
1599ca221c9bSJohannes Berg 		WARN(1, "Invalid fw type %d\n", fw->type);
160010a0472dSGustavo A. R. Silva 		fallthrough;
1601ca221c9bSJohannes Berg 	case IWL_FW_MVM:
1602ca221c9bSJohannes Berg 		op = &iwlwifi_opmode_table[MVM_OP_MODE];
1603ca221c9bSJohannes Berg 		break;
1604ca221c9bSJohannes Berg 	}
1605e705c121SKalle Valo 
1606e705c121SKalle Valo 	IWL_INFO(drv, "loaded firmware version %s op_mode %s\n",
1607e705c121SKalle Valo 		 drv->fw.fw_version, op->name);
1608e705c121SKalle Valo 
1609c03fe6d3SShahar S Matityahu 	iwl_dbg_tlv_load_bin(drv->trans->dev, drv->trans);
1610c03fe6d3SShahar S Matityahu 
1611e705c121SKalle Valo 	/* add this device to the list of devices using this op_mode */
1612e705c121SKalle Valo 	list_add_tail(&drv->list, &op->drv);
1613e705c121SKalle Valo 
1614e705c121SKalle Valo 	if (op->ops) {
1615e705c121SKalle Valo 		drv->op_mode = _iwl_op_mode_start(drv, op);
1616e705c121SKalle Valo 
1617e705c121SKalle Valo 		if (!drv->op_mode) {
1618e705c121SKalle Valo 			mutex_unlock(&iwlwifi_opmode_table_mtx);
1619e705c121SKalle Valo 			goto out_unbind;
1620e705c121SKalle Valo 		}
1621e705c121SKalle Valo 	} else {
1622e705c121SKalle Valo 		load_module = true;
1623e705c121SKalle Valo 	}
1624e705c121SKalle Valo 	mutex_unlock(&iwlwifi_opmode_table_mtx);
1625e705c121SKalle Valo 
1626e705c121SKalle Valo 	/*
1627e705c121SKalle Valo 	 * Complete the firmware request last so that
1628e705c121SKalle Valo 	 * a driver unbind (stop) doesn't run while we
1629e705c121SKalle Valo 	 * are doing the start() above.
1630e705c121SKalle Valo 	 */
1631e705c121SKalle Valo 	complete(&drv->request_firmware_complete);
1632e705c121SKalle Valo 
1633e705c121SKalle Valo 	/*
1634e705c121SKalle Valo 	 * Load the module last so we don't block anything
1635e705c121SKalle Valo 	 * else from proceeding if the module fails to load
1636e705c121SKalle Valo 	 * or hangs loading.
1637e705c121SKalle Valo 	 */
1638e705c121SKalle Valo 	if (load_module) {
163906a1e85eSJohannes Berg 		request_module("%s", op->name);
1640e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_OPMODE_MODULAR
1641e705c121SKalle Valo 		if (err)
1642e705c121SKalle Valo 			IWL_ERR(drv,
1643e705c121SKalle Valo 				"failed to load module %s (error %d), is dynamic loading enabled?\n",
1644e705c121SKalle Valo 				op->name, err);
1645e705c121SKalle Valo #endif
1646e705c121SKalle Valo 	}
16472ed1e019SJohannes Berg 	goto free;
1648e705c121SKalle Valo 
1649e705c121SKalle Valo  try_again:
1650e705c121SKalle Valo 	/* try next, if any */
1651e705c121SKalle Valo 	release_firmware(ucode_raw);
1652e705c121SKalle Valo 	if (iwl_request_firmware(drv, false))
1653e705c121SKalle Valo 		goto out_unbind;
16542ed1e019SJohannes Berg 	goto free;
1655e705c121SKalle Valo 
1656e705c121SKalle Valo  out_free_fw:
1657e705c121SKalle Valo 	release_firmware(ucode_raw);
1658e705c121SKalle Valo  out_unbind:
1659e705c121SKalle Valo 	complete(&drv->request_firmware_complete);
1660e705c121SKalle Valo 	device_release_driver(drv->trans->dev);
16612ed1e019SJohannes Berg  free:
166253d515ecSJohannes Berg 	if (pieces) {
1663eef187a7SSara Sharon 		for (i = 0; i < ARRAY_SIZE(pieces->img); i++)
1664eef187a7SSara Sharon 			kfree(pieces->img[i].sec);
16652ed1e019SJohannes Berg 		kfree(pieces->dbg_mem_tlv);
16662ed1e019SJohannes Berg 		kfree(pieces);
1667e705c121SKalle Valo 	}
166853d515ecSJohannes Berg }
1669e705c121SKalle Valo 
167049060383SLuca Coelho struct iwl_drv *iwl_drv_start(struct iwl_trans *trans)
1671e705c121SKalle Valo {
1672e705c121SKalle Valo 	struct iwl_drv *drv;
1673e705c121SKalle Valo 	int ret;
1674e705c121SKalle Valo 
1675e705c121SKalle Valo 	drv = kzalloc(sizeof(*drv), GFP_KERNEL);
1676e705c121SKalle Valo 	if (!drv) {
1677e705c121SKalle Valo 		ret = -ENOMEM;
1678e705c121SKalle Valo 		goto err;
1679e705c121SKalle Valo 	}
1680e705c121SKalle Valo 
1681e705c121SKalle Valo 	drv->trans = trans;
1682e705c121SKalle Valo 	drv->dev = trans->dev;
1683e705c121SKalle Valo 
1684e705c121SKalle Valo 	init_completion(&drv->request_firmware_complete);
1685e705c121SKalle Valo 	INIT_LIST_HEAD(&drv->list);
1686e705c121SKalle Valo 
1687e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS
1688e705c121SKalle Valo 	/* Create the device debugfs entries. */
1689e705c121SKalle Valo 	drv->dbgfs_drv = debugfs_create_dir(dev_name(trans->dev),
1690e705c121SKalle Valo 					    iwl_dbgfs_root);
1691e705c121SKalle Valo 
1692e705c121SKalle Valo 	/* Create transport layer debugfs dir */
1693e705c121SKalle Valo 	drv->trans->dbgfs_dir = debugfs_create_dir("trans", drv->dbgfs_drv);
1694e705c121SKalle Valo #endif
1695e705c121SKalle Valo 
1696e701da0cSLuca Coelho 	drv->trans->dbg.domains_bitmap = IWL_TRANS_FW_DBG_DOMAIN(drv->trans);
1697e701da0cSLuca Coelho 
1698e705c121SKalle Valo 	ret = iwl_request_firmware(drv, true);
1699e705c121SKalle Valo 	if (ret) {
1700e705c121SKalle Valo 		IWL_ERR(trans, "Couldn't request the fw\n");
1701e705c121SKalle Valo 		goto err_fw;
1702e705c121SKalle Valo 	}
1703e705c121SKalle Valo 
1704e705c121SKalle Valo 	return drv;
1705e705c121SKalle Valo 
1706e705c121SKalle Valo err_fw:
1707e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS
1708e705c121SKalle Valo 	debugfs_remove_recursive(drv->dbgfs_drv);
170941874d3aSShahar S Matityahu 	iwl_dbg_tlv_free(drv->trans);
1710e705c121SKalle Valo #endif
1711e705c121SKalle Valo 	kfree(drv);
1712e705c121SKalle Valo err:
1713e705c121SKalle Valo 	return ERR_PTR(ret);
1714e705c121SKalle Valo }
1715e705c121SKalle Valo 
1716e705c121SKalle Valo void iwl_drv_stop(struct iwl_drv *drv)
1717e705c121SKalle Valo {
1718e705c121SKalle Valo 	wait_for_completion(&drv->request_firmware_complete);
1719e705c121SKalle Valo 
1720e705c121SKalle Valo 	_iwl_op_mode_stop(drv);
1721e705c121SKalle Valo 
1722e705c121SKalle Valo 	iwl_dealloc_ucode(drv);
1723e705c121SKalle Valo 
1724e705c121SKalle Valo 	mutex_lock(&iwlwifi_opmode_table_mtx);
1725e705c121SKalle Valo 	/*
1726e705c121SKalle Valo 	 * List is empty (this item wasn't added)
1727e705c121SKalle Valo 	 * when firmware loading failed -- in that
1728e705c121SKalle Valo 	 * case we can't remove it from any list.
1729e705c121SKalle Valo 	 */
1730e705c121SKalle Valo 	if (!list_empty(&drv->list))
1731e705c121SKalle Valo 		list_del(&drv->list);
1732e705c121SKalle Valo 	mutex_unlock(&iwlwifi_opmode_table_mtx);
1733e705c121SKalle Valo 
1734e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS
1735f7805b33SLior Cohen 	drv->trans->ops->debugfs_cleanup(drv->trans);
1736f7805b33SLior Cohen 
1737e705c121SKalle Valo 	debugfs_remove_recursive(drv->dbgfs_drv);
1738e705c121SKalle Valo #endif
1739e705c121SKalle Valo 
174041874d3aSShahar S Matityahu 	iwl_dbg_tlv_free(drv->trans);
1741f14cda6fSSara Sharon 
1742e705c121SKalle Valo 	kfree(drv);
1743e705c121SKalle Valo }
1744e705c121SKalle Valo 
1745e705c121SKalle Valo 
1746e705c121SKalle Valo /* shared module parameters */
1747e705c121SKalle Valo struct iwl_mod_params iwlwifi_mod_params = {
17483b37f4c9SJohannes Berg 	.fw_restart = true,
1749e705c121SKalle Valo 	.bt_coex_active = true,
1750e705c121SKalle Valo 	.power_level = IWL_POWER_INDEX_1,
175111dee0b4SEmmanuel Grumbach 	.uapsd_disable = IWL_DISABLE_UAPSD_BSS | IWL_DISABLE_UAPSD_P2P_CLIENT,
1752b0d8d2c2SLuca Coelho 	.enable_ini = true,
1753e705c121SKalle Valo 	/* the rest are 0 by default */
1754e705c121SKalle Valo };
1755e705c121SKalle Valo IWL_EXPORT_SYMBOL(iwlwifi_mod_params);
1756e705c121SKalle Valo 
1757e705c121SKalle Valo int iwl_opmode_register(const char *name, const struct iwl_op_mode_ops *ops)
1758e705c121SKalle Valo {
1759e705c121SKalle Valo 	int i;
1760e705c121SKalle Valo 	struct iwl_drv *drv;
1761e705c121SKalle Valo 	struct iwlwifi_opmode_table *op;
1762e705c121SKalle Valo 
1763e705c121SKalle Valo 	mutex_lock(&iwlwifi_opmode_table_mtx);
1764e705c121SKalle Valo 	for (i = 0; i < ARRAY_SIZE(iwlwifi_opmode_table); i++) {
1765e705c121SKalle Valo 		op = &iwlwifi_opmode_table[i];
1766e705c121SKalle Valo 		if (strcmp(op->name, name))
1767e705c121SKalle Valo 			continue;
1768e705c121SKalle Valo 		op->ops = ops;
1769e705c121SKalle Valo 		/* TODO: need to handle exceptional case */
1770e705c121SKalle Valo 		list_for_each_entry(drv, &op->drv, list)
1771e705c121SKalle Valo 			drv->op_mode = _iwl_op_mode_start(drv, op);
1772e705c121SKalle Valo 
1773e705c121SKalle Valo 		mutex_unlock(&iwlwifi_opmode_table_mtx);
1774e705c121SKalle Valo 		return 0;
1775e705c121SKalle Valo 	}
1776e705c121SKalle Valo 	mutex_unlock(&iwlwifi_opmode_table_mtx);
1777e705c121SKalle Valo 	return -EIO;
1778e705c121SKalle Valo }
1779e705c121SKalle Valo IWL_EXPORT_SYMBOL(iwl_opmode_register);
1780e705c121SKalle Valo 
1781e705c121SKalle Valo void iwl_opmode_deregister(const char *name)
1782e705c121SKalle Valo {
1783e705c121SKalle Valo 	int i;
1784e705c121SKalle Valo 	struct iwl_drv *drv;
1785e705c121SKalle Valo 
1786e705c121SKalle Valo 	mutex_lock(&iwlwifi_opmode_table_mtx);
1787e705c121SKalle Valo 	for (i = 0; i < ARRAY_SIZE(iwlwifi_opmode_table); i++) {
1788e705c121SKalle Valo 		if (strcmp(iwlwifi_opmode_table[i].name, name))
1789e705c121SKalle Valo 			continue;
1790e705c121SKalle Valo 		iwlwifi_opmode_table[i].ops = NULL;
1791e705c121SKalle Valo 
1792e705c121SKalle Valo 		/* call the stop routine for all devices */
1793e705c121SKalle Valo 		list_for_each_entry(drv, &iwlwifi_opmode_table[i].drv, list)
1794e705c121SKalle Valo 			_iwl_op_mode_stop(drv);
1795e705c121SKalle Valo 
1796e705c121SKalle Valo 		mutex_unlock(&iwlwifi_opmode_table_mtx);
1797e705c121SKalle Valo 		return;
1798e705c121SKalle Valo 	}
1799e705c121SKalle Valo 	mutex_unlock(&iwlwifi_opmode_table_mtx);
1800e705c121SKalle Valo }
1801e705c121SKalle Valo IWL_EXPORT_SYMBOL(iwl_opmode_deregister);
1802e705c121SKalle Valo 
1803e705c121SKalle Valo static int __init iwl_drv_init(void)
1804e705c121SKalle Valo {
1805ee3399e5SJohannes Berg 	int i, err;
1806e705c121SKalle Valo 
1807e705c121SKalle Valo 	for (i = 0; i < ARRAY_SIZE(iwlwifi_opmode_table); i++)
1808e705c121SKalle Valo 		INIT_LIST_HEAD(&iwlwifi_opmode_table[i].drv);
1809e705c121SKalle Valo 
1810e705c121SKalle Valo 	pr_info(DRV_DESCRIPTION "\n");
1811e705c121SKalle Valo 
1812e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS
1813e705c121SKalle Valo 	/* Create the root of iwlwifi debugfs subsystem. */
1814e705c121SKalle Valo 	iwl_dbgfs_root = debugfs_create_dir(DRV_NAME, NULL);
1815e705c121SKalle Valo #endif
1816e705c121SKalle Valo 
1817ee3399e5SJohannes Berg 	err = iwl_pci_register_driver();
1818ee3399e5SJohannes Berg 	if (err)
1819ee3399e5SJohannes Berg 		goto cleanup_debugfs;
1820ee3399e5SJohannes Berg 
1821ee3399e5SJohannes Berg 	return 0;
1822ee3399e5SJohannes Berg 
1823ee3399e5SJohannes Berg cleanup_debugfs:
1824ee3399e5SJohannes Berg #ifdef CONFIG_IWLWIFI_DEBUGFS
1825ee3399e5SJohannes Berg 	debugfs_remove_recursive(iwl_dbgfs_root);
1826ee3399e5SJohannes Berg #endif
1827ee3399e5SJohannes Berg 	return err;
1828e705c121SKalle Valo }
1829e705c121SKalle Valo module_init(iwl_drv_init);
1830e705c121SKalle Valo 
1831e705c121SKalle Valo static void __exit iwl_drv_exit(void)
1832e705c121SKalle Valo {
1833e705c121SKalle Valo 	iwl_pci_unregister_driver();
1834e705c121SKalle Valo 
1835e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUGFS
1836e705c121SKalle Valo 	debugfs_remove_recursive(iwl_dbgfs_root);
1837e705c121SKalle Valo #endif
1838e705c121SKalle Valo }
1839e705c121SKalle Valo module_exit(iwl_drv_exit);
1840e705c121SKalle Valo 
1841e705c121SKalle Valo #ifdef CONFIG_IWLWIFI_DEBUG
18422ef00c53SJoe Perches module_param_named(debug, iwlwifi_mod_params.debug_level, uint, 0644);
1843e705c121SKalle Valo MODULE_PARM_DESC(debug, "debug output mask");
1844e705c121SKalle Valo #endif
1845e705c121SKalle Valo 
18462ef00c53SJoe Perches module_param_named(swcrypto, iwlwifi_mod_params.swcrypto, int, 0444);
1847e705c121SKalle Valo MODULE_PARM_DESC(swcrypto, "using crypto in software (default 0 [hardware])");
18482ef00c53SJoe Perches module_param_named(11n_disable, iwlwifi_mod_params.disable_11n, uint, 0444);
1849e705c121SKalle Valo MODULE_PARM_DESC(11n_disable,
1850e705c121SKalle Valo 	"disable 11n functionality, bitmap: 1: full, 2: disable agg TX, 4: disable agg RX, 8 enable agg TX");
18512ef00c53SJoe Perches module_param_named(amsdu_size, iwlwifi_mod_params.amsdu_size, int, 0444);
18524bdd4dfeSEmmanuel Grumbach MODULE_PARM_DESC(amsdu_size,
18533681021fSJohannes Berg 		 "amsdu size 0: 12K for multi Rx queue devices, 2K for AX210 devices, "
18543fa965c2SJohannes Berg 		 "4K for other devices 1:4K 2:8K 3:12K (16K buffers) 4: 2K (default 0)");
18552ef00c53SJoe Perches module_param_named(fw_restart, iwlwifi_mod_params.fw_restart, bool, 0444);
1856e705c121SKalle Valo MODULE_PARM_DESC(fw_restart, "restart firmware in case of error (default true)");
1857e705c121SKalle Valo 
18582ef00c53SJoe Perches module_param_named(nvm_file, iwlwifi_mod_params.nvm_file, charp, 0444);
1859e705c121SKalle Valo MODULE_PARM_DESC(nvm_file, "NVM file name");
1860e705c121SKalle Valo 
18612ef00c53SJoe Perches module_param_named(uapsd_disable, iwlwifi_mod_params.uapsd_disable, uint, 0644);
186211dee0b4SEmmanuel Grumbach MODULE_PARM_DESC(uapsd_disable,
186311dee0b4SEmmanuel Grumbach 		 "disable U-APSD functionality bitmap 1: BSS 2: P2P Client (default: 3)");
1864f14cda6fSSara Sharon module_param_named(enable_ini, iwlwifi_mod_params.enable_ini,
1865f14cda6fSSara Sharon 		   bool, S_IRUGO | S_IWUSR);
1866f14cda6fSSara Sharon MODULE_PARM_DESC(enable_ini,
1867b0d8d2c2SLuca Coelho 		 "Enable debug INI TLV FW debug infrastructure (default: true");
1868e705c121SKalle Valo 
1869e705c121SKalle Valo /*
1870e705c121SKalle Valo  * set bt_coex_active to true, uCode will do kill/defer
1871e705c121SKalle Valo  * every time the priority line is asserted (BT is sending signals on the
1872e705c121SKalle Valo  * priority line in the PCIx).
1873e705c121SKalle Valo  * set bt_coex_active to false, uCode will ignore the BT activity and
1874e705c121SKalle Valo  * perform the normal operation
1875e705c121SKalle Valo  *
1876e705c121SKalle Valo  * User might experience transmit issue on some platform due to WiFi/BT
1877e705c121SKalle Valo  * co-exist problem. The possible behaviors are:
1878e705c121SKalle Valo  *   Able to scan and finding all the available AP
1879e705c121SKalle Valo  *   Not able to associate with any AP
1880e705c121SKalle Valo  * On those platforms, WiFi communication can be restored by set
1881e705c121SKalle Valo  * "bt_coex_active" module parameter to "false"
1882e705c121SKalle Valo  *
1883e705c121SKalle Valo  * default: bt_coex_active = true (BT_COEX_ENABLE)
1884e705c121SKalle Valo  */
1885e705c121SKalle Valo module_param_named(bt_coex_active, iwlwifi_mod_params.bt_coex_active,
18862ef00c53SJoe Perches 		   bool, 0444);
1887e705c121SKalle Valo MODULE_PARM_DESC(bt_coex_active, "enable wifi/bt co-exist (default: enable)");
1888e705c121SKalle Valo 
18892ef00c53SJoe Perches module_param_named(led_mode, iwlwifi_mod_params.led_mode, int, 0444);
1890e705c121SKalle Valo MODULE_PARM_DESC(led_mode, "0=system default, "
1891e705c121SKalle Valo 		"1=On(RF On)/Off(RF Off), 2=blinking, 3=Off (default: 0)");
1892e705c121SKalle Valo 
18932ef00c53SJoe Perches module_param_named(power_save, iwlwifi_mod_params.power_save, bool, 0444);
1894e705c121SKalle Valo MODULE_PARM_DESC(power_save,
1895e705c121SKalle Valo 		 "enable WiFi power management (default: disable)");
1896e705c121SKalle Valo 
18972ef00c53SJoe Perches module_param_named(power_level, iwlwifi_mod_params.power_level, int, 0444);
1898e705c121SKalle Valo MODULE_PARM_DESC(power_level,
1899e705c121SKalle Valo 		 "default power save level (range from 1 - 5, default: 1)");
1900e705c121SKalle Valo 
19012ef00c53SJoe Perches module_param_named(disable_11ac, iwlwifi_mod_params.disable_11ac, bool, 0444);
19025c887759SEmmanuel Grumbach MODULE_PARM_DESC(disable_11ac, "Disable VHT capabilities (default: false)");
190349564a80SLuca Coelho 
190449564a80SLuca Coelho module_param_named(remove_when_gone,
190549564a80SLuca Coelho 		   iwlwifi_mod_params.remove_when_gone, bool,
190649564a80SLuca Coelho 		   0444);
190749564a80SLuca Coelho MODULE_PARM_DESC(remove_when_gone,
190849564a80SLuca Coelho 		 "Remove dev from PCIe bus if it is deemed inaccessible (default: false)");
1909230ba6c5SLuca Coelho 
1910230ba6c5SLuca Coelho module_param_named(disable_11ax, iwlwifi_mod_params.disable_11ax, bool,
1911230ba6c5SLuca Coelho 		   S_IRUGO);
1912230ba6c5SLuca Coelho MODULE_PARM_DESC(disable_11ax, "Disable HE capabilities (default: false)");
1913