xref: /freebsd/sys/contrib/dev/iwlwifi/iwl-drv.c (revision 8ac82ba19efbaeec065621215c3843f054fa419e)
1bfcc09ddSBjoern A. Zeeb // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2bfcc09ddSBjoern A. Zeeb /*
3a4128aadSBjoern A. Zeeb  * Copyright (C) 2005-2014, 2018-2024 Intel Corporation
4bfcc09ddSBjoern A. Zeeb  * Copyright (C) 2013-2015 Intel Mobile Communications GmbH
5bfcc09ddSBjoern A. Zeeb  * Copyright (C) 2016-2017 Intel Deutschland GmbH
6bfcc09ddSBjoern A. Zeeb  */
7bfcc09ddSBjoern A. Zeeb #if defined(__FreeBSD__)
8bfcc09ddSBjoern A. Zeeb #define	LINUXKPI_PARAM_PREFIX	iwlwifi_
9bfcc09ddSBjoern A. Zeeb #endif
10bfcc09ddSBjoern A. Zeeb #include <linux/completion.h>
11bfcc09ddSBjoern A. Zeeb #include <linux/dma-mapping.h>
12bfcc09ddSBjoern A. Zeeb #include <linux/firmware.h>
13bfcc09ddSBjoern A. Zeeb #include <linux/module.h>
14bfcc09ddSBjoern A. Zeeb #include <linux/vmalloc.h>
15bfcc09ddSBjoern A. Zeeb 
16bfcc09ddSBjoern A. Zeeb #include "iwl-drv.h"
17bfcc09ddSBjoern A. Zeeb #include "iwl-csr.h"
18bfcc09ddSBjoern A. Zeeb #include "iwl-debug.h"
19bfcc09ddSBjoern A. Zeeb #include "iwl-trans.h"
20bfcc09ddSBjoern A. Zeeb #include "iwl-op-mode.h"
21bfcc09ddSBjoern A. Zeeb #include "iwl-agn-hw.h"
22bfcc09ddSBjoern A. Zeeb #include "fw/img.h"
23bfcc09ddSBjoern A. Zeeb #include "iwl-dbg-tlv.h"
24bfcc09ddSBjoern A. Zeeb #include "iwl-config.h"
25bfcc09ddSBjoern A. Zeeb #include "iwl-modparams.h"
26bfcc09ddSBjoern A. Zeeb #include "fw/api/alive.h"
27bfcc09ddSBjoern A. Zeeb #include "fw/api/mac.h"
28bfcc09ddSBjoern A. Zeeb 
29bfcc09ddSBjoern A. Zeeb /******************************************************************************
30bfcc09ddSBjoern A. Zeeb  *
31bfcc09ddSBjoern A. Zeeb  * module boiler plate
32bfcc09ddSBjoern A. Zeeb  *
33bfcc09ddSBjoern A. Zeeb  ******************************************************************************/
34bfcc09ddSBjoern A. Zeeb 
35bfcc09ddSBjoern A. Zeeb #if defined(__linux__)
36bfcc09ddSBjoern A. Zeeb #define DRV_DESCRIPTION	"Intel(R) Wireless WiFi driver for Linux"
37a4128aadSBjoern A. Zeeb MODULE_DESCRIPTION(DRV_DESCRIPTION);
38bfcc09ddSBjoern A. Zeeb MODULE_LICENSE("GPL");
39bfcc09ddSBjoern A. Zeeb #elif defined(__FreeBSD__)
40bfcc09ddSBjoern A. Zeeb #define DRV_DESCRIPTION	"Intel(R) Wireless WiFi based driver for FreeBSD"
41a4128aadSBjoern A. Zeeb MODULE_DESCRIPTION(DRV_DESCRIPTION);
42bfcc09ddSBjoern A. Zeeb MODULE_LICENSE("BSD");
4381ff67ffSBjoern A. Zeeb MODULE_VERSION(if_iwlwifi, 1);
4481ff67ffSBjoern A. Zeeb MODULE_DEPEND(if_iwlwifi, linuxkpi, 1, 1, 1);
4581ff67ffSBjoern A. Zeeb MODULE_DEPEND(if_iwlwifi, linuxkpi_wlan, 1, 1, 1);
4692daf3a6SBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
4792daf3a6SBjoern A. Zeeb MODULE_DEPEND(if_iwlwifi, lindebugfs, 1, 1, 1);
4892daf3a6SBjoern A. Zeeb #endif
49bfcc09ddSBjoern A. Zeeb #endif
50bfcc09ddSBjoern A. Zeeb 
51bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
52bfcc09ddSBjoern A. Zeeb static struct dentry *iwl_dbgfs_root;
53bfcc09ddSBjoern A. Zeeb #endif
54bfcc09ddSBjoern A. Zeeb 
55bfcc09ddSBjoern A. Zeeb /**
56bfcc09ddSBjoern A. Zeeb  * struct iwl_drv - drv common data
57bfcc09ddSBjoern A. Zeeb  * @list: list of drv structures using this opmode
58bfcc09ddSBjoern A. Zeeb  * @fw: the iwl_fw structure
59bfcc09ddSBjoern A. Zeeb  * @op_mode: the running op_mode
60bfcc09ddSBjoern A. Zeeb  * @trans: transport layer
61bfcc09ddSBjoern A. Zeeb  * @dev: for debug prints only
62bfcc09ddSBjoern A. Zeeb  * @fw_index: firmware revision to try loading
63bfcc09ddSBjoern A. Zeeb  * @firmware_name: composite filename of ucode file to load
64bfcc09ddSBjoern A. Zeeb  * @request_firmware_complete: the firmware has been obtained from user space
65bfcc09ddSBjoern A. Zeeb  * @dbgfs_drv: debugfs root directory entry
66bfcc09ddSBjoern A. Zeeb  * @dbgfs_trans: debugfs transport directory entry
67bfcc09ddSBjoern A. Zeeb  * @dbgfs_op_mode: debugfs op_mode directory entry
68bfcc09ddSBjoern A. Zeeb  */
69bfcc09ddSBjoern A. Zeeb struct iwl_drv {
70bfcc09ddSBjoern A. Zeeb 	struct list_head list;
71bfcc09ddSBjoern A. Zeeb 	struct iwl_fw fw;
72bfcc09ddSBjoern A. Zeeb 
73bfcc09ddSBjoern A. Zeeb 	struct iwl_op_mode *op_mode;
74bfcc09ddSBjoern A. Zeeb 	struct iwl_trans *trans;
75bfcc09ddSBjoern A. Zeeb 	struct device *dev;
76bfcc09ddSBjoern A. Zeeb 
77bfcc09ddSBjoern A. Zeeb 	int fw_index;                   /* firmware we're trying to load */
78bfcc09ddSBjoern A. Zeeb 	char firmware_name[64];         /* name of firmware file to load */
79bfcc09ddSBjoern A. Zeeb 
80bfcc09ddSBjoern A. Zeeb 	struct completion request_firmware_complete;
81bee60c98SBjoern A. Zeeb #if defined(__FreeBSD__)
82bee60c98SBjoern A. Zeeb 	struct completion drv_start_complete;
83bee60c98SBjoern A. Zeeb #endif
84bfcc09ddSBjoern A. Zeeb 
85bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
86bfcc09ddSBjoern A. Zeeb 	struct dentry *dbgfs_drv;
87bfcc09ddSBjoern A. Zeeb 	struct dentry *dbgfs_trans;
88bfcc09ddSBjoern A. Zeeb 	struct dentry *dbgfs_op_mode;
89bfcc09ddSBjoern A. Zeeb #endif
90bfcc09ddSBjoern A. Zeeb };
91bfcc09ddSBjoern A. Zeeb 
92bfcc09ddSBjoern A. Zeeb enum {
93bfcc09ddSBjoern A. Zeeb 	DVM_OP_MODE,
94bfcc09ddSBjoern A. Zeeb 	MVM_OP_MODE,
95bfcc09ddSBjoern A. Zeeb };
96bfcc09ddSBjoern A. Zeeb 
97bfcc09ddSBjoern A. Zeeb /* Protects the table contents, i.e. the ops pointer & drv list */
98bfcc09ddSBjoern A. Zeeb static DEFINE_MUTEX(iwlwifi_opmode_table_mtx);
99bfcc09ddSBjoern A. Zeeb static struct iwlwifi_opmode_table {
100bfcc09ddSBjoern A. Zeeb 	const char *name;			/* name: iwldvm, iwlmvm, etc */
101bfcc09ddSBjoern A. Zeeb 	const struct iwl_op_mode_ops *ops;	/* pointer to op_mode ops */
102bfcc09ddSBjoern A. Zeeb 	struct list_head drv;		/* list of devices using this op_mode */
103bfcc09ddSBjoern A. Zeeb } iwlwifi_opmode_table[] = {		/* ops set when driver is initialized */
104bfcc09ddSBjoern A. Zeeb 	[DVM_OP_MODE] = { .name = "iwldvm", .ops = NULL },
105bfcc09ddSBjoern A. Zeeb 	[MVM_OP_MODE] = { .name = "iwlmvm", .ops = NULL },
106bfcc09ddSBjoern A. Zeeb };
107bfcc09ddSBjoern A. Zeeb 
108bfcc09ddSBjoern A. Zeeb #define IWL_DEFAULT_SCAN_CHANNELS 40
109bfcc09ddSBjoern A. Zeeb 
110bfcc09ddSBjoern A. Zeeb /*
111bfcc09ddSBjoern A. Zeeb  * struct fw_sec: Just for the image parsing process.
112bfcc09ddSBjoern A. Zeeb  * For the fw storage we are using struct fw_desc.
113bfcc09ddSBjoern A. Zeeb  */
114bfcc09ddSBjoern A. Zeeb struct fw_sec {
115bfcc09ddSBjoern A. Zeeb 	const void *data;		/* the sec data */
116bfcc09ddSBjoern A. Zeeb 	size_t size;			/* section size */
117bfcc09ddSBjoern A. Zeeb 	u32 offset;			/* offset of writing in the device */
118bfcc09ddSBjoern A. Zeeb };
119bfcc09ddSBjoern A. Zeeb 
iwl_free_fw_desc(struct iwl_drv * drv,struct fw_desc * desc)120bfcc09ddSBjoern A. Zeeb static void iwl_free_fw_desc(struct iwl_drv *drv, struct fw_desc *desc)
121bfcc09ddSBjoern A. Zeeb {
122bfcc09ddSBjoern A. Zeeb 	vfree(desc->data);
123bfcc09ddSBjoern A. Zeeb 	desc->data = NULL;
124bfcc09ddSBjoern A. Zeeb 	desc->len = 0;
125bfcc09ddSBjoern A. Zeeb }
126bfcc09ddSBjoern A. Zeeb 
iwl_free_fw_img(struct iwl_drv * drv,struct fw_img * img)127bfcc09ddSBjoern A. Zeeb static void iwl_free_fw_img(struct iwl_drv *drv, struct fw_img *img)
128bfcc09ddSBjoern A. Zeeb {
129bfcc09ddSBjoern A. Zeeb 	int i;
130bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < img->num_sec; i++)
131bfcc09ddSBjoern A. Zeeb 		iwl_free_fw_desc(drv, &img->sec[i]);
132bfcc09ddSBjoern A. Zeeb 	kfree(img->sec);
133bfcc09ddSBjoern A. Zeeb }
134bfcc09ddSBjoern A. Zeeb 
iwl_dealloc_ucode(struct iwl_drv * drv)135bfcc09ddSBjoern A. Zeeb static void iwl_dealloc_ucode(struct iwl_drv *drv)
136bfcc09ddSBjoern A. Zeeb {
137bfcc09ddSBjoern A. Zeeb 	int i;
138bfcc09ddSBjoern A. Zeeb 
139bfcc09ddSBjoern A. Zeeb 	kfree(drv->fw.dbg.dest_tlv);
140bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < ARRAY_SIZE(drv->fw.dbg.conf_tlv); i++)
141bfcc09ddSBjoern A. Zeeb 		kfree(drv->fw.dbg.conf_tlv[i]);
142bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < ARRAY_SIZE(drv->fw.dbg.trigger_tlv); i++)
143bfcc09ddSBjoern A. Zeeb 		kfree(drv->fw.dbg.trigger_tlv[i]);
144bfcc09ddSBjoern A. Zeeb 	kfree(drv->fw.dbg.mem_tlv);
145bfcc09ddSBjoern A. Zeeb 	kfree(drv->fw.iml);
146bfcc09ddSBjoern A. Zeeb 	kfree(drv->fw.ucode_capa.cmd_versions);
147bfcc09ddSBjoern A. Zeeb 	kfree(drv->fw.phy_integration_ver);
1489af1bba4SBjoern A. Zeeb 	kfree(drv->trans->dbg.pc_data);
149a4128aadSBjoern A. Zeeb 	drv->trans->dbg.pc_data = NULL;
150bfcc09ddSBjoern A. Zeeb 
151bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < IWL_UCODE_TYPE_MAX; i++)
152bfcc09ddSBjoern A. Zeeb 		iwl_free_fw_img(drv, drv->fw.img + i);
153d9836fb4SBjoern A. Zeeb 
154d9836fb4SBjoern A. Zeeb 	/* clear the data for the aborted load case */
155d9836fb4SBjoern A. Zeeb 	memset(&drv->fw, 0, sizeof(drv->fw));
156bfcc09ddSBjoern A. Zeeb }
157bfcc09ddSBjoern A. Zeeb 
iwl_alloc_fw_desc(struct iwl_drv * drv,struct fw_desc * desc,struct fw_sec * sec)158bfcc09ddSBjoern A. Zeeb static int iwl_alloc_fw_desc(struct iwl_drv *drv, struct fw_desc *desc,
159bfcc09ddSBjoern A. Zeeb 			     struct fw_sec *sec)
160bfcc09ddSBjoern A. Zeeb {
161bfcc09ddSBjoern A. Zeeb 	void *data;
162bfcc09ddSBjoern A. Zeeb 
163bfcc09ddSBjoern A. Zeeb 	desc->data = NULL;
164bfcc09ddSBjoern A. Zeeb 
165bfcc09ddSBjoern A. Zeeb 	if (!sec || !sec->size)
166bfcc09ddSBjoern A. Zeeb 		return -EINVAL;
167bfcc09ddSBjoern A. Zeeb 
168bfcc09ddSBjoern A. Zeeb 	data = vmalloc(sec->size);
169bfcc09ddSBjoern A. Zeeb 	if (!data)
170bfcc09ddSBjoern A. Zeeb 		return -ENOMEM;
171bfcc09ddSBjoern A. Zeeb 
172bfcc09ddSBjoern A. Zeeb 	desc->len = sec->size;
173bfcc09ddSBjoern A. Zeeb 	desc->offset = sec->offset;
174bfcc09ddSBjoern A. Zeeb 	memcpy(data, sec->data, desc->len);
175bfcc09ddSBjoern A. Zeeb 	desc->data = data;
176bfcc09ddSBjoern A. Zeeb 
177bfcc09ddSBjoern A. Zeeb 	return 0;
178bfcc09ddSBjoern A. Zeeb }
179bfcc09ddSBjoern A. Zeeb 
iwl_drv_get_step(int step)1809af1bba4SBjoern A. Zeeb static inline char iwl_drv_get_step(int step)
1819af1bba4SBjoern A. Zeeb {
1829af1bba4SBjoern A. Zeeb 	if (step == SILICON_Z_STEP)
1839af1bba4SBjoern A. Zeeb 		return 'z';
184a4128aadSBjoern A. Zeeb 	if (step == SILICON_TC_STEP)
185a4128aadSBjoern A. Zeeb 		return 'a';
1869af1bba4SBjoern A. Zeeb 	return 'a' + step;
1879af1bba4SBjoern A. Zeeb }
1889af1bba4SBjoern A. Zeeb 
iwl_drv_get_fwname_pre(struct iwl_trans * trans,char * buf)1899af1bba4SBjoern A. Zeeb const char *iwl_drv_get_fwname_pre(struct iwl_trans *trans, char *buf)
1909af1bba4SBjoern A. Zeeb {
1919af1bba4SBjoern A. Zeeb 	char mac_step, rf_step;
1929af1bba4SBjoern A. Zeeb 	const char *rf, *cdb;
1939af1bba4SBjoern A. Zeeb 
1949af1bba4SBjoern A. Zeeb 	if (trans->cfg->fw_name_pre)
1959af1bba4SBjoern A. Zeeb 		return trans->cfg->fw_name_pre;
1969af1bba4SBjoern A. Zeeb 
1979af1bba4SBjoern A. Zeeb 	if (WARN_ON(!trans->cfg->fw_name_mac))
1989af1bba4SBjoern A. Zeeb 		return "unconfigured";
1999af1bba4SBjoern A. Zeeb 
2009af1bba4SBjoern A. Zeeb 	mac_step = iwl_drv_get_step(trans->hw_rev_step);
2019af1bba4SBjoern A. Zeeb 
202a4128aadSBjoern A. Zeeb 	rf_step = iwl_drv_get_step(CSR_HW_RFID_STEP(trans->hw_rf_id));
203a4128aadSBjoern A. Zeeb 
2049af1bba4SBjoern A. Zeeb 	switch (CSR_HW_RFID_TYPE(trans->hw_rf_id)) {
2059af1bba4SBjoern A. Zeeb 	case IWL_CFG_RF_TYPE_HR1:
2069af1bba4SBjoern A. Zeeb 	case IWL_CFG_RF_TYPE_HR2:
2079af1bba4SBjoern A. Zeeb 		rf = "hr";
208a4128aadSBjoern A. Zeeb 		rf_step = 'b';
2099af1bba4SBjoern A. Zeeb 		break;
2109af1bba4SBjoern A. Zeeb 	case IWL_CFG_RF_TYPE_GF:
2119af1bba4SBjoern A. Zeeb 		rf = "gf";
2129af1bba4SBjoern A. Zeeb 		break;
2139af1bba4SBjoern A. Zeeb 	case IWL_CFG_RF_TYPE_FM:
2149af1bba4SBjoern A. Zeeb 		rf = "fm";
2159af1bba4SBjoern A. Zeeb 		break;
2169af1bba4SBjoern A. Zeeb 	case IWL_CFG_RF_TYPE_WH:
217a4128aadSBjoern A. Zeeb 		if (SILICON_Z_STEP ==
218a4128aadSBjoern A. Zeeb 		    CSR_HW_RFID_STEP(trans->hw_rf_id)) {
219a4128aadSBjoern A. Zeeb 			rf = "whtc";
220a4128aadSBjoern A. Zeeb 			rf_step = 'a';
221a4128aadSBjoern A. Zeeb 		} else {
2229af1bba4SBjoern A. Zeeb 			rf = "wh";
223a4128aadSBjoern A. Zeeb 		}
2249af1bba4SBjoern A. Zeeb 		break;
2259af1bba4SBjoern A. Zeeb 	default:
2269af1bba4SBjoern A. Zeeb 		return "unknown-rf";
2279af1bba4SBjoern A. Zeeb 	}
2289af1bba4SBjoern A. Zeeb 
2299af1bba4SBjoern A. Zeeb 	cdb = CSR_HW_RFID_IS_CDB(trans->hw_rf_id) ? "4" : "";
2309af1bba4SBjoern A. Zeeb 
2319af1bba4SBjoern A. Zeeb 	scnprintf(buf, FW_NAME_PRE_BUFSIZE,
2329af1bba4SBjoern A. Zeeb 		  "iwlwifi-%s-%c0-%s%s-%c0",
2339af1bba4SBjoern A. Zeeb 		  trans->cfg->fw_name_mac, mac_step,
2349af1bba4SBjoern A. Zeeb 		  rf, cdb, rf_step);
2359af1bba4SBjoern A. Zeeb 
2369af1bba4SBjoern A. Zeeb 	return buf;
2379af1bba4SBjoern A. Zeeb }
2389af1bba4SBjoern A. Zeeb IWL_EXPORT_SYMBOL(iwl_drv_get_fwname_pre);
2399af1bba4SBjoern A. Zeeb 
240bfcc09ddSBjoern A. Zeeb static void iwl_req_fw_callback(const struct firmware *ucode_raw,
241bfcc09ddSBjoern A. Zeeb 				void *context);
242bfcc09ddSBjoern A. Zeeb 
iwl_request_firmware(struct iwl_drv * drv,bool first)243bfcc09ddSBjoern A. Zeeb static int iwl_request_firmware(struct iwl_drv *drv, bool first)
244bfcc09ddSBjoern A. Zeeb {
245bfcc09ddSBjoern A. Zeeb 	const struct iwl_cfg *cfg = drv->trans->cfg;
2469af1bba4SBjoern A. Zeeb 	char _fw_name_pre[FW_NAME_PRE_BUFSIZE];
2479af1bba4SBjoern A. Zeeb 	const char *fw_name_pre;
248bfcc09ddSBjoern A. Zeeb 
249bfcc09ddSBjoern A. Zeeb 	if (drv->trans->trans_cfg->device_family == IWL_DEVICE_FAMILY_9000 &&
250d9836fb4SBjoern A. Zeeb 	    (drv->trans->hw_rev_step != SILICON_B_STEP &&
251d9836fb4SBjoern A. Zeeb 	     drv->trans->hw_rev_step != SILICON_C_STEP)) {
252bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv,
253bfcc09ddSBjoern A. Zeeb 			"Only HW steps B and C are currently supported (0x%0x)\n",
254bfcc09ddSBjoern A. Zeeb 			drv->trans->hw_rev);
255bfcc09ddSBjoern A. Zeeb 		return -EINVAL;
256bfcc09ddSBjoern A. Zeeb 	}
257bfcc09ddSBjoern A. Zeeb 
2589af1bba4SBjoern A. Zeeb 	fw_name_pre = iwl_drv_get_fwname_pre(drv->trans, _fw_name_pre);
2599af1bba4SBjoern A. Zeeb 
2609af1bba4SBjoern A. Zeeb 	if (first)
261bfcc09ddSBjoern A. Zeeb 		drv->fw_index = cfg->ucode_api_max;
2629af1bba4SBjoern A. Zeeb 	else
263bfcc09ddSBjoern A. Zeeb 		drv->fw_index--;
264bfcc09ddSBjoern A. Zeeb 
265bfcc09ddSBjoern A. Zeeb 	if (drv->fw_index < cfg->ucode_api_min) {
266bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv, "no suitable firmware found!\n");
267bfcc09ddSBjoern A. Zeeb 
268bfcc09ddSBjoern A. Zeeb 		if (cfg->ucode_api_min == cfg->ucode_api_max) {
2699af1bba4SBjoern A. Zeeb 			IWL_ERR(drv, "%s-%d is required\n", fw_name_pre,
270bfcc09ddSBjoern A. Zeeb 				cfg->ucode_api_max);
271bfcc09ddSBjoern A. Zeeb 		} else {
2729af1bba4SBjoern A. Zeeb 			IWL_ERR(drv, "minimum version required: %s-%d\n",
2739af1bba4SBjoern A. Zeeb 				fw_name_pre, cfg->ucode_api_min);
2749af1bba4SBjoern A. Zeeb 			IWL_ERR(drv, "maximum version supported: %s-%d\n",
2759af1bba4SBjoern A. Zeeb 				fw_name_pre, cfg->ucode_api_max);
276bfcc09ddSBjoern A. Zeeb 		}
277bfcc09ddSBjoern A. Zeeb 
278bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv,
279bfcc09ddSBjoern A. Zeeb 			"check git://git.kernel.org/pub/scm/linux/kernel/git/firmware/linux-firmware.git\n");
280*8ac82ba1SBjoern A. Zeeb #if defined(__FreeBSD__)
281*8ac82ba1SBjoern A. Zeeb 		IWL_ERR(drv, "On FreeBSD the firmware package can be installed running fwget(8).\n");
282*8ac82ba1SBjoern A. Zeeb #endif
283bfcc09ddSBjoern A. Zeeb 		return -ENOENT;
284bfcc09ddSBjoern A. Zeeb 	}
285bfcc09ddSBjoern A. Zeeb 
2869af1bba4SBjoern A. Zeeb 	snprintf(drv->firmware_name, sizeof(drv->firmware_name), "%s-%d.ucode",
2879af1bba4SBjoern A. Zeeb 		 fw_name_pre, drv->fw_index);
288bfcc09ddSBjoern A. Zeeb 
289bfcc09ddSBjoern A. Zeeb 	IWL_DEBUG_FW_INFO(drv, "attempting to load firmware '%s'\n",
290bfcc09ddSBjoern A. Zeeb 			  drv->firmware_name);
291bfcc09ddSBjoern A. Zeeb 
292bfcc09ddSBjoern A. Zeeb 	return request_firmware_nowait(THIS_MODULE, 1, drv->firmware_name,
293bfcc09ddSBjoern A. Zeeb 				       drv->trans->dev,
294bfcc09ddSBjoern A. Zeeb 				       GFP_KERNEL, drv, iwl_req_fw_callback);
295bfcc09ddSBjoern A. Zeeb }
296bfcc09ddSBjoern A. Zeeb 
297bfcc09ddSBjoern A. Zeeb struct fw_img_parsing {
298bfcc09ddSBjoern A. Zeeb 	struct fw_sec *sec;
299bfcc09ddSBjoern A. Zeeb 	int sec_counter;
300bfcc09ddSBjoern A. Zeeb };
301bfcc09ddSBjoern A. Zeeb 
302bfcc09ddSBjoern A. Zeeb /*
303bfcc09ddSBjoern A. Zeeb  * struct fw_sec_parsing: to extract fw section and it's offset from tlv
304bfcc09ddSBjoern A. Zeeb  */
305bfcc09ddSBjoern A. Zeeb struct fw_sec_parsing {
306bfcc09ddSBjoern A. Zeeb 	__le32 offset;
307bfcc09ddSBjoern A. Zeeb 	const u8 data[];
308bfcc09ddSBjoern A. Zeeb } __packed;
309bfcc09ddSBjoern A. Zeeb 
310bfcc09ddSBjoern A. Zeeb /**
311bfcc09ddSBjoern A. Zeeb  * struct iwl_tlv_calib_data - parse the default calib data from TLV
312bfcc09ddSBjoern A. Zeeb  *
313bfcc09ddSBjoern A. Zeeb  * @ucode_type: the uCode to which the following default calib relates.
314bfcc09ddSBjoern A. Zeeb  * @calib: default calibrations.
315bfcc09ddSBjoern A. Zeeb  */
316bfcc09ddSBjoern A. Zeeb struct iwl_tlv_calib_data {
317bfcc09ddSBjoern A. Zeeb 	__le32 ucode_type;
318bfcc09ddSBjoern A. Zeeb 	struct iwl_tlv_calib_ctrl calib;
319bfcc09ddSBjoern A. Zeeb } __packed;
320bfcc09ddSBjoern A. Zeeb 
321bfcc09ddSBjoern A. Zeeb struct iwl_firmware_pieces {
322bfcc09ddSBjoern A. Zeeb 	struct fw_img_parsing img[IWL_UCODE_TYPE_MAX];
323bfcc09ddSBjoern A. Zeeb 
324bfcc09ddSBjoern A. Zeeb 	u32 init_evtlog_ptr, init_evtlog_size, init_errlog_ptr;
325bfcc09ddSBjoern A. Zeeb 	u32 inst_evtlog_ptr, inst_evtlog_size, inst_errlog_ptr;
326bfcc09ddSBjoern A. Zeeb 
327bfcc09ddSBjoern A. Zeeb 	/* FW debug data parsed for driver usage */
328bfcc09ddSBjoern A. Zeeb 	bool dbg_dest_tlv_init;
329bfcc09ddSBjoern A. Zeeb 	const u8 *dbg_dest_ver;
330bfcc09ddSBjoern A. Zeeb 	union {
331bfcc09ddSBjoern A. Zeeb 		const struct iwl_fw_dbg_dest_tlv *dbg_dest_tlv;
332bfcc09ddSBjoern A. Zeeb 		const struct iwl_fw_dbg_dest_tlv_v1 *dbg_dest_tlv_v1;
333bfcc09ddSBjoern A. Zeeb 	};
334bfcc09ddSBjoern A. Zeeb 	const struct iwl_fw_dbg_conf_tlv *dbg_conf_tlv[FW_DBG_CONF_MAX];
335bfcc09ddSBjoern A. Zeeb 	size_t dbg_conf_tlv_len[FW_DBG_CONF_MAX];
336bfcc09ddSBjoern A. Zeeb 	const struct iwl_fw_dbg_trigger_tlv *dbg_trigger_tlv[FW_DBG_TRIGGER_MAX];
337bfcc09ddSBjoern A. Zeeb 	size_t dbg_trigger_tlv_len[FW_DBG_TRIGGER_MAX];
338bfcc09ddSBjoern A. Zeeb 	struct iwl_fw_dbg_mem_seg_tlv *dbg_mem_tlv;
339bfcc09ddSBjoern A. Zeeb 	size_t n_mem_tlv;
340bfcc09ddSBjoern A. Zeeb };
341bfcc09ddSBjoern A. Zeeb 
342bfcc09ddSBjoern A. Zeeb /*
343bfcc09ddSBjoern A. Zeeb  * These functions are just to extract uCode section data from the pieces
344bfcc09ddSBjoern A. Zeeb  * structure.
345bfcc09ddSBjoern A. Zeeb  */
get_sec(struct iwl_firmware_pieces * pieces,enum iwl_ucode_type type,int sec)346bfcc09ddSBjoern A. Zeeb static struct fw_sec *get_sec(struct iwl_firmware_pieces *pieces,
347bfcc09ddSBjoern A. Zeeb 			      enum iwl_ucode_type type,
348bfcc09ddSBjoern A. Zeeb 			      int  sec)
349bfcc09ddSBjoern A. Zeeb {
350bfcc09ddSBjoern A. Zeeb 	return &pieces->img[type].sec[sec];
351bfcc09ddSBjoern A. Zeeb }
352bfcc09ddSBjoern A. Zeeb 
alloc_sec_data(struct iwl_firmware_pieces * pieces,enum iwl_ucode_type type,int sec)353bfcc09ddSBjoern A. Zeeb static void alloc_sec_data(struct iwl_firmware_pieces *pieces,
354bfcc09ddSBjoern A. Zeeb 			   enum iwl_ucode_type type,
355bfcc09ddSBjoern A. Zeeb 			   int sec)
356bfcc09ddSBjoern A. Zeeb {
357bfcc09ddSBjoern A. Zeeb 	struct fw_img_parsing *img = &pieces->img[type];
358bfcc09ddSBjoern A. Zeeb 	struct fw_sec *sec_memory;
359bfcc09ddSBjoern A. Zeeb 	int size = sec + 1;
360bfcc09ddSBjoern A. Zeeb 	size_t alloc_size = sizeof(*img->sec) * size;
361bfcc09ddSBjoern A. Zeeb 
362bfcc09ddSBjoern A. Zeeb 	if (img->sec && img->sec_counter >= size)
363bfcc09ddSBjoern A. Zeeb 		return;
364bfcc09ddSBjoern A. Zeeb 
365bfcc09ddSBjoern A. Zeeb 	sec_memory = krealloc(img->sec, alloc_size, GFP_KERNEL);
366bfcc09ddSBjoern A. Zeeb 	if (!sec_memory)
367bfcc09ddSBjoern A. Zeeb 		return;
368bfcc09ddSBjoern A. Zeeb 
369bfcc09ddSBjoern A. Zeeb 	img->sec = sec_memory;
370bfcc09ddSBjoern A. Zeeb 	img->sec_counter = size;
371bfcc09ddSBjoern A. Zeeb }
372bfcc09ddSBjoern A. Zeeb 
set_sec_data(struct iwl_firmware_pieces * pieces,enum iwl_ucode_type type,int sec,const void * data)373bfcc09ddSBjoern A. Zeeb static void set_sec_data(struct iwl_firmware_pieces *pieces,
374bfcc09ddSBjoern A. Zeeb 			 enum iwl_ucode_type type,
375bfcc09ddSBjoern A. Zeeb 			 int sec,
376bfcc09ddSBjoern A. Zeeb 			 const void *data)
377bfcc09ddSBjoern A. Zeeb {
378bfcc09ddSBjoern A. Zeeb 	alloc_sec_data(pieces, type, sec);
379bfcc09ddSBjoern A. Zeeb 
380bfcc09ddSBjoern A. Zeeb 	pieces->img[type].sec[sec].data = data;
381bfcc09ddSBjoern A. Zeeb }
382bfcc09ddSBjoern A. Zeeb 
set_sec_size(struct iwl_firmware_pieces * pieces,enum iwl_ucode_type type,int sec,size_t size)383bfcc09ddSBjoern A. Zeeb static void set_sec_size(struct iwl_firmware_pieces *pieces,
384bfcc09ddSBjoern A. Zeeb 			 enum iwl_ucode_type type,
385bfcc09ddSBjoern A. Zeeb 			 int sec,
386bfcc09ddSBjoern A. Zeeb 			 size_t size)
387bfcc09ddSBjoern A. Zeeb {
388bfcc09ddSBjoern A. Zeeb 	alloc_sec_data(pieces, type, sec);
389bfcc09ddSBjoern A. Zeeb 
390bfcc09ddSBjoern A. Zeeb 	pieces->img[type].sec[sec].size = size;
391bfcc09ddSBjoern A. Zeeb }
392bfcc09ddSBjoern A. Zeeb 
get_sec_size(struct iwl_firmware_pieces * pieces,enum iwl_ucode_type type,int sec)393bfcc09ddSBjoern A. Zeeb static size_t get_sec_size(struct iwl_firmware_pieces *pieces,
394bfcc09ddSBjoern A. Zeeb 			   enum iwl_ucode_type type,
395bfcc09ddSBjoern A. Zeeb 			   int sec)
396bfcc09ddSBjoern A. Zeeb {
397bfcc09ddSBjoern A. Zeeb 	return pieces->img[type].sec[sec].size;
398bfcc09ddSBjoern A. Zeeb }
399bfcc09ddSBjoern A. Zeeb 
set_sec_offset(struct iwl_firmware_pieces * pieces,enum iwl_ucode_type type,int sec,u32 offset)400bfcc09ddSBjoern A. Zeeb static void set_sec_offset(struct iwl_firmware_pieces *pieces,
401bfcc09ddSBjoern A. Zeeb 			   enum iwl_ucode_type type,
402bfcc09ddSBjoern A. Zeeb 			   int sec,
403bfcc09ddSBjoern A. Zeeb 			   u32 offset)
404bfcc09ddSBjoern A. Zeeb {
405bfcc09ddSBjoern A. Zeeb 	alloc_sec_data(pieces, type, sec);
406bfcc09ddSBjoern A. Zeeb 
407bfcc09ddSBjoern A. Zeeb 	pieces->img[type].sec[sec].offset = offset;
408bfcc09ddSBjoern A. Zeeb }
409bfcc09ddSBjoern A. Zeeb 
410bfcc09ddSBjoern A. Zeeb /*
411bfcc09ddSBjoern A. Zeeb  * Gets uCode section from tlv.
412bfcc09ddSBjoern A. Zeeb  */
iwl_store_ucode_sec(struct iwl_firmware_pieces * pieces,const void * data,enum iwl_ucode_type type,int size)413bfcc09ddSBjoern A. Zeeb static int iwl_store_ucode_sec(struct iwl_firmware_pieces *pieces,
414bfcc09ddSBjoern A. Zeeb 			       const void *data, enum iwl_ucode_type type,
415bfcc09ddSBjoern A. Zeeb 			       int size)
416bfcc09ddSBjoern A. Zeeb {
417bfcc09ddSBjoern A. Zeeb 	struct fw_img_parsing *img;
418bfcc09ddSBjoern A. Zeeb 	struct fw_sec *sec;
419bfcc09ddSBjoern A. Zeeb 	const struct fw_sec_parsing *sec_parse;
420bfcc09ddSBjoern A. Zeeb 	size_t alloc_size;
421bfcc09ddSBjoern A. Zeeb 
422bfcc09ddSBjoern A. Zeeb 	if (WARN_ON(!pieces || !data || type >= IWL_UCODE_TYPE_MAX))
423bfcc09ddSBjoern A. Zeeb 		return -1;
424bfcc09ddSBjoern A. Zeeb 
425bfcc09ddSBjoern A. Zeeb 	sec_parse = (const struct fw_sec_parsing *)data;
426bfcc09ddSBjoern A. Zeeb 
427bfcc09ddSBjoern A. Zeeb 	img = &pieces->img[type];
428bfcc09ddSBjoern A. Zeeb 
429bfcc09ddSBjoern A. Zeeb 	alloc_size = sizeof(*img->sec) * (img->sec_counter + 1);
430bfcc09ddSBjoern A. Zeeb 	sec = krealloc(img->sec, alloc_size, GFP_KERNEL);
431bfcc09ddSBjoern A. Zeeb 	if (!sec)
432bfcc09ddSBjoern A. Zeeb 		return -ENOMEM;
433bfcc09ddSBjoern A. Zeeb 	img->sec = sec;
434bfcc09ddSBjoern A. Zeeb 
435bfcc09ddSBjoern A. Zeeb 	sec = &img->sec[img->sec_counter];
436bfcc09ddSBjoern A. Zeeb 
437bfcc09ddSBjoern A. Zeeb 	sec->offset = le32_to_cpu(sec_parse->offset);
438bfcc09ddSBjoern A. Zeeb 	sec->data = sec_parse->data;
439bfcc09ddSBjoern A. Zeeb 	sec->size = size - sizeof(sec_parse->offset);
440bfcc09ddSBjoern A. Zeeb 
441bfcc09ddSBjoern A. Zeeb 	++img->sec_counter;
442bfcc09ddSBjoern A. Zeeb 
443bfcc09ddSBjoern A. Zeeb 	return 0;
444bfcc09ddSBjoern A. Zeeb }
445bfcc09ddSBjoern A. Zeeb 
iwl_set_default_calib(struct iwl_drv * drv,const u8 * data)446bfcc09ddSBjoern A. Zeeb static int iwl_set_default_calib(struct iwl_drv *drv, const u8 *data)
447bfcc09ddSBjoern A. Zeeb {
448bfcc09ddSBjoern A. Zeeb 	const struct iwl_tlv_calib_data *def_calib =
449bfcc09ddSBjoern A. Zeeb 					(const struct iwl_tlv_calib_data *)data;
450bfcc09ddSBjoern A. Zeeb 	u32 ucode_type = le32_to_cpu(def_calib->ucode_type);
451bfcc09ddSBjoern A. Zeeb 	if (ucode_type >= IWL_UCODE_TYPE_MAX) {
452bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv, "Wrong ucode_type %u for default calibration.\n",
453bfcc09ddSBjoern A. Zeeb 			ucode_type);
454bfcc09ddSBjoern A. Zeeb 		return -EINVAL;
455bfcc09ddSBjoern A. Zeeb 	}
456bfcc09ddSBjoern A. Zeeb 	drv->fw.default_calib[ucode_type].flow_trigger =
457bfcc09ddSBjoern A. Zeeb 		def_calib->calib.flow_trigger;
458bfcc09ddSBjoern A. Zeeb 	drv->fw.default_calib[ucode_type].event_trigger =
459bfcc09ddSBjoern A. Zeeb 		def_calib->calib.event_trigger;
460bfcc09ddSBjoern A. Zeeb 
461bfcc09ddSBjoern A. Zeeb 	return 0;
462bfcc09ddSBjoern A. Zeeb }
463bfcc09ddSBjoern A. Zeeb 
iwl_set_ucode_api_flags(struct iwl_drv * drv,const u8 * data,struct iwl_ucode_capabilities * capa)464bfcc09ddSBjoern A. Zeeb static void iwl_set_ucode_api_flags(struct iwl_drv *drv, const u8 *data,
465bfcc09ddSBjoern A. Zeeb 				    struct iwl_ucode_capabilities *capa)
466bfcc09ddSBjoern A. Zeeb {
467bfcc09ddSBjoern A. Zeeb 	const struct iwl_ucode_api *ucode_api = (const void *)data;
468bfcc09ddSBjoern A. Zeeb 	u32 api_index = le32_to_cpu(ucode_api->api_index);
469bfcc09ddSBjoern A. Zeeb 	u32 api_flags = le32_to_cpu(ucode_api->api_flags);
470bfcc09ddSBjoern A. Zeeb 	int i;
471bfcc09ddSBjoern A. Zeeb 
472bfcc09ddSBjoern A. Zeeb 	if (api_index >= DIV_ROUND_UP(NUM_IWL_UCODE_TLV_API, 32)) {
473bfcc09ddSBjoern A. Zeeb 		IWL_WARN(drv,
474bfcc09ddSBjoern A. Zeeb 			 "api flags index %d larger than supported by driver\n",
475bfcc09ddSBjoern A. Zeeb 			 api_index);
476bfcc09ddSBjoern A. Zeeb 		return;
477bfcc09ddSBjoern A. Zeeb 	}
478bfcc09ddSBjoern A. Zeeb 
479bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < 32; i++) {
480bfcc09ddSBjoern A. Zeeb 		if (api_flags & BIT(i))
481bfcc09ddSBjoern A. Zeeb 			__set_bit(i + 32 * api_index, capa->_api);
482bfcc09ddSBjoern A. Zeeb 	}
483bfcc09ddSBjoern A. Zeeb }
484bfcc09ddSBjoern A. Zeeb 
iwl_set_ucode_capabilities(struct iwl_drv * drv,const u8 * data,struct iwl_ucode_capabilities * capa)485bfcc09ddSBjoern A. Zeeb static void iwl_set_ucode_capabilities(struct iwl_drv *drv, const u8 *data,
486bfcc09ddSBjoern A. Zeeb 				       struct iwl_ucode_capabilities *capa)
487bfcc09ddSBjoern A. Zeeb {
488bfcc09ddSBjoern A. Zeeb 	const struct iwl_ucode_capa *ucode_capa = (const void *)data;
489bfcc09ddSBjoern A. Zeeb 	u32 api_index = le32_to_cpu(ucode_capa->api_index);
490bfcc09ddSBjoern A. Zeeb 	u32 api_flags = le32_to_cpu(ucode_capa->api_capa);
491bfcc09ddSBjoern A. Zeeb 	int i;
492bfcc09ddSBjoern A. Zeeb 
493bfcc09ddSBjoern A. Zeeb 	if (api_index >= DIV_ROUND_UP(NUM_IWL_UCODE_TLV_CAPA, 32)) {
494bfcc09ddSBjoern A. Zeeb 		IWL_WARN(drv,
495bfcc09ddSBjoern A. Zeeb 			 "capa flags index %d larger than supported by driver\n",
496bfcc09ddSBjoern A. Zeeb 			 api_index);
497bfcc09ddSBjoern A. Zeeb 		return;
498bfcc09ddSBjoern A. Zeeb 	}
499bfcc09ddSBjoern A. Zeeb 
500bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < 32; i++) {
501bfcc09ddSBjoern A. Zeeb 		if (api_flags & BIT(i))
502bfcc09ddSBjoern A. Zeeb 			__set_bit(i + 32 * api_index, capa->_capa);
503bfcc09ddSBjoern A. Zeeb 	}
504bfcc09ddSBjoern A. Zeeb }
505bfcc09ddSBjoern A. Zeeb 
iwl_reduced_fw_name(struct iwl_drv * drv)506bfcc09ddSBjoern A. Zeeb static const char *iwl_reduced_fw_name(struct iwl_drv *drv)
507bfcc09ddSBjoern A. Zeeb {
508bfcc09ddSBjoern A. Zeeb 	const char *name = drv->firmware_name;
509bfcc09ddSBjoern A. Zeeb 
510bfcc09ddSBjoern A. Zeeb 	if (strncmp(name, "iwlwifi-", 8) == 0)
511bfcc09ddSBjoern A. Zeeb 		name += 8;
512bfcc09ddSBjoern A. Zeeb 
513bfcc09ddSBjoern A. Zeeb 	return name;
514bfcc09ddSBjoern A. Zeeb }
515bfcc09ddSBjoern A. Zeeb 
iwl_parse_v1_v2_firmware(struct iwl_drv * drv,const struct firmware * ucode_raw,struct iwl_firmware_pieces * pieces)516bfcc09ddSBjoern A. Zeeb static int iwl_parse_v1_v2_firmware(struct iwl_drv *drv,
517bfcc09ddSBjoern A. Zeeb 				    const struct firmware *ucode_raw,
518bfcc09ddSBjoern A. Zeeb 				    struct iwl_firmware_pieces *pieces)
519bfcc09ddSBjoern A. Zeeb {
520bfcc09ddSBjoern A. Zeeb 	const struct iwl_ucode_header *ucode = (const void *)ucode_raw->data;
521bfcc09ddSBjoern A. Zeeb 	u32 api_ver, hdr_size, build;
522bfcc09ddSBjoern A. Zeeb 	char buildstr[25];
523bfcc09ddSBjoern A. Zeeb 	const u8 *src;
524bfcc09ddSBjoern A. Zeeb 
525bfcc09ddSBjoern A. Zeeb 	drv->fw.ucode_ver = le32_to_cpu(ucode->ver);
526bfcc09ddSBjoern A. Zeeb 	api_ver = IWL_UCODE_API(drv->fw.ucode_ver);
527bfcc09ddSBjoern A. Zeeb 
528bfcc09ddSBjoern A. Zeeb 	switch (api_ver) {
529bfcc09ddSBjoern A. Zeeb 	default:
530bfcc09ddSBjoern A. Zeeb 		hdr_size = 28;
531bfcc09ddSBjoern A. Zeeb 		if (ucode_raw->size < hdr_size) {
532bfcc09ddSBjoern A. Zeeb 			IWL_ERR(drv, "File size too small!\n");
533bfcc09ddSBjoern A. Zeeb 			return -EINVAL;
534bfcc09ddSBjoern A. Zeeb 		}
535bfcc09ddSBjoern A. Zeeb 		build = le32_to_cpu(ucode->u.v2.build);
536bfcc09ddSBjoern A. Zeeb 		set_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST,
537bfcc09ddSBjoern A. Zeeb 			     le32_to_cpu(ucode->u.v2.inst_size));
538bfcc09ddSBjoern A. Zeeb 		set_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA,
539bfcc09ddSBjoern A. Zeeb 			     le32_to_cpu(ucode->u.v2.data_size));
540bfcc09ddSBjoern A. Zeeb 		set_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST,
541bfcc09ddSBjoern A. Zeeb 			     le32_to_cpu(ucode->u.v2.init_size));
542bfcc09ddSBjoern A. Zeeb 		set_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA,
543bfcc09ddSBjoern A. Zeeb 			     le32_to_cpu(ucode->u.v2.init_data_size));
544bfcc09ddSBjoern A. Zeeb 		src = ucode->u.v2.data;
545bfcc09ddSBjoern A. Zeeb 		break;
546bfcc09ddSBjoern A. Zeeb 	case 0:
547bfcc09ddSBjoern A. Zeeb 	case 1:
548bfcc09ddSBjoern A. Zeeb 	case 2:
549bfcc09ddSBjoern A. Zeeb 		hdr_size = 24;
550bfcc09ddSBjoern A. Zeeb 		if (ucode_raw->size < hdr_size) {
551bfcc09ddSBjoern A. Zeeb 			IWL_ERR(drv, "File size too small!\n");
552bfcc09ddSBjoern A. Zeeb 			return -EINVAL;
553bfcc09ddSBjoern A. Zeeb 		}
554bfcc09ddSBjoern A. Zeeb 		build = 0;
555bfcc09ddSBjoern A. Zeeb 		set_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST,
556bfcc09ddSBjoern A. Zeeb 			     le32_to_cpu(ucode->u.v1.inst_size));
557bfcc09ddSBjoern A. Zeeb 		set_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA,
558bfcc09ddSBjoern A. Zeeb 			     le32_to_cpu(ucode->u.v1.data_size));
559bfcc09ddSBjoern A. Zeeb 		set_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST,
560bfcc09ddSBjoern A. Zeeb 			     le32_to_cpu(ucode->u.v1.init_size));
561bfcc09ddSBjoern A. Zeeb 		set_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA,
562bfcc09ddSBjoern A. Zeeb 			     le32_to_cpu(ucode->u.v1.init_data_size));
563bfcc09ddSBjoern A. Zeeb 		src = ucode->u.v1.data;
564bfcc09ddSBjoern A. Zeeb 		break;
565bfcc09ddSBjoern A. Zeeb 	}
566bfcc09ddSBjoern A. Zeeb 
567bfcc09ddSBjoern A. Zeeb 	if (build)
568bfcc09ddSBjoern A. Zeeb 		sprintf(buildstr, " build %u", build);
569bfcc09ddSBjoern A. Zeeb 	else
570bfcc09ddSBjoern A. Zeeb 		buildstr[0] = '\0';
571bfcc09ddSBjoern A. Zeeb 
572bfcc09ddSBjoern A. Zeeb 	snprintf(drv->fw.fw_version,
573bfcc09ddSBjoern A. Zeeb 		 sizeof(drv->fw.fw_version),
574bfcc09ddSBjoern A. Zeeb 		 "%u.%u.%u.%u%s %s",
575bfcc09ddSBjoern A. Zeeb 		 IWL_UCODE_MAJOR(drv->fw.ucode_ver),
576bfcc09ddSBjoern A. Zeeb 		 IWL_UCODE_MINOR(drv->fw.ucode_ver),
577bfcc09ddSBjoern A. Zeeb 		 IWL_UCODE_API(drv->fw.ucode_ver),
578bfcc09ddSBjoern A. Zeeb 		 IWL_UCODE_SERIAL(drv->fw.ucode_ver),
579bfcc09ddSBjoern A. Zeeb 		 buildstr, iwl_reduced_fw_name(drv));
580bfcc09ddSBjoern A. Zeeb 
581bfcc09ddSBjoern A. Zeeb 	/* Verify size of file vs. image size info in file's header */
582bfcc09ddSBjoern A. Zeeb 
583bfcc09ddSBjoern A. Zeeb 	if (ucode_raw->size != hdr_size +
584bfcc09ddSBjoern A. Zeeb 	    get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST) +
585bfcc09ddSBjoern A. Zeeb 	    get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA) +
586bfcc09ddSBjoern A. Zeeb 	    get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST) +
587bfcc09ddSBjoern A. Zeeb 	    get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA)) {
588bfcc09ddSBjoern A. Zeeb 
589bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv,
590bfcc09ddSBjoern A. Zeeb 			"uCode file size %d does not match expected size\n",
591bfcc09ddSBjoern A. Zeeb 			(int)ucode_raw->size);
592bfcc09ddSBjoern A. Zeeb 		return -EINVAL;
593bfcc09ddSBjoern A. Zeeb 	}
594bfcc09ddSBjoern A. Zeeb 
595bfcc09ddSBjoern A. Zeeb 
596bfcc09ddSBjoern A. Zeeb 	set_sec_data(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST, src);
597bfcc09ddSBjoern A. Zeeb 	src += get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST);
598bfcc09ddSBjoern A. Zeeb 	set_sec_offset(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST,
599bfcc09ddSBjoern A. Zeeb 		       IWLAGN_RTC_INST_LOWER_BOUND);
600bfcc09ddSBjoern A. Zeeb 	set_sec_data(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA, src);
601bfcc09ddSBjoern A. Zeeb 	src += get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA);
602bfcc09ddSBjoern A. Zeeb 	set_sec_offset(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA,
603bfcc09ddSBjoern A. Zeeb 		       IWLAGN_RTC_DATA_LOWER_BOUND);
604bfcc09ddSBjoern A. Zeeb 	set_sec_data(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST, src);
605bfcc09ddSBjoern A. Zeeb 	src += get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST);
606bfcc09ddSBjoern A. Zeeb 	set_sec_offset(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST,
607bfcc09ddSBjoern A. Zeeb 		       IWLAGN_RTC_INST_LOWER_BOUND);
608bfcc09ddSBjoern A. Zeeb 	set_sec_data(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA, src);
609bfcc09ddSBjoern A. Zeeb 	src += get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA);
610bfcc09ddSBjoern A. Zeeb 	set_sec_offset(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA,
611bfcc09ddSBjoern A. Zeeb 		       IWLAGN_RTC_DATA_LOWER_BOUND);
612bfcc09ddSBjoern A. Zeeb 	return 0;
613bfcc09ddSBjoern A. Zeeb }
614bfcc09ddSBjoern A. Zeeb 
iwl_drv_set_dump_exclude(struct iwl_drv * drv,enum iwl_ucode_tlv_type tlv_type,const void * tlv_data,u32 tlv_len)615bfcc09ddSBjoern A. Zeeb static void iwl_drv_set_dump_exclude(struct iwl_drv *drv,
616bfcc09ddSBjoern A. Zeeb 				     enum iwl_ucode_tlv_type tlv_type,
617bfcc09ddSBjoern A. Zeeb 				     const void *tlv_data, u32 tlv_len)
618bfcc09ddSBjoern A. Zeeb {
619bfcc09ddSBjoern A. Zeeb 	const struct iwl_fw_dump_exclude *fw = tlv_data;
620bfcc09ddSBjoern A. Zeeb 	struct iwl_dump_exclude *excl;
621bfcc09ddSBjoern A. Zeeb 
622bfcc09ddSBjoern A. Zeeb 	if (tlv_len < sizeof(*fw))
623bfcc09ddSBjoern A. Zeeb 		return;
624bfcc09ddSBjoern A. Zeeb 
625bfcc09ddSBjoern A. Zeeb 	if (tlv_type == IWL_UCODE_TLV_SEC_TABLE_ADDR) {
626bfcc09ddSBjoern A. Zeeb 		excl = &drv->fw.dump_excl[0];
627bfcc09ddSBjoern A. Zeeb 
628bfcc09ddSBjoern A. Zeeb 		/* second time we find this, it's for WoWLAN */
629bfcc09ddSBjoern A. Zeeb 		if (excl->addr)
630bfcc09ddSBjoern A. Zeeb 			excl = &drv->fw.dump_excl_wowlan[0];
631bfcc09ddSBjoern A. Zeeb 	} else if (fw_has_capa(&drv->fw.ucode_capa,
632bfcc09ddSBjoern A. Zeeb 			       IWL_UCODE_TLV_CAPA_CNSLDTD_D3_D0_IMG)) {
633bfcc09ddSBjoern A. Zeeb 		/* IWL_UCODE_TLV_D3_KEK_KCK_ADDR is regular image */
634bfcc09ddSBjoern A. Zeeb 		excl = &drv->fw.dump_excl[0];
635bfcc09ddSBjoern A. Zeeb 	} else {
636bfcc09ddSBjoern A. Zeeb 		/* IWL_UCODE_TLV_D3_KEK_KCK_ADDR is WoWLAN image */
637bfcc09ddSBjoern A. Zeeb 		excl = &drv->fw.dump_excl_wowlan[0];
638bfcc09ddSBjoern A. Zeeb 	}
639bfcc09ddSBjoern A. Zeeb 
640bfcc09ddSBjoern A. Zeeb 	if (excl->addr)
641bfcc09ddSBjoern A. Zeeb 		excl++;
642bfcc09ddSBjoern A. Zeeb 
643bfcc09ddSBjoern A. Zeeb 	if (excl->addr) {
644bfcc09ddSBjoern A. Zeeb 		IWL_DEBUG_FW_INFO(drv, "found too many excludes in fw file\n");
645bfcc09ddSBjoern A. Zeeb 		return;
646bfcc09ddSBjoern A. Zeeb 	}
647bfcc09ddSBjoern A. Zeeb 
648bfcc09ddSBjoern A. Zeeb 	excl->addr = le32_to_cpu(fw->addr) & ~FW_ADDR_CACHE_CONTROL;
649bfcc09ddSBjoern A. Zeeb 	excl->size = le32_to_cpu(fw->size);
650bfcc09ddSBjoern A. Zeeb }
651bfcc09ddSBjoern A. Zeeb 
iwl_parse_dbg_tlv_assert_tables(struct iwl_drv * drv,const struct iwl_ucode_tlv * tlv)652d9836fb4SBjoern A. Zeeb static void iwl_parse_dbg_tlv_assert_tables(struct iwl_drv *drv,
653d9836fb4SBjoern A. Zeeb 					    const struct iwl_ucode_tlv *tlv)
654d9836fb4SBjoern A. Zeeb {
655d9836fb4SBjoern A. Zeeb 	const struct iwl_fw_ini_region_tlv *region;
656d9836fb4SBjoern A. Zeeb 	u32 length = le32_to_cpu(tlv->length);
657d9836fb4SBjoern A. Zeeb 	u32 addr;
658d9836fb4SBjoern A. Zeeb 
659d9836fb4SBjoern A. Zeeb 	if (length < offsetof(typeof(*region), special_mem) +
660d9836fb4SBjoern A. Zeeb 		     sizeof(region->special_mem))
661d9836fb4SBjoern A. Zeeb 		return;
662d9836fb4SBjoern A. Zeeb 
663d9836fb4SBjoern A. Zeeb 	region = (const void *)tlv->data;
664d9836fb4SBjoern A. Zeeb 	addr = le32_to_cpu(region->special_mem.base_addr);
665d9836fb4SBjoern A. Zeeb 	addr += le32_to_cpu(region->special_mem.offset);
666d9836fb4SBjoern A. Zeeb 	addr &= ~FW_ADDR_CACHE_CONTROL;
667d9836fb4SBjoern A. Zeeb 
668d9836fb4SBjoern A. Zeeb 	if (region->type != IWL_FW_INI_REGION_SPECIAL_DEVICE_MEMORY)
669d9836fb4SBjoern A. Zeeb 		return;
670d9836fb4SBjoern A. Zeeb 
671d9836fb4SBjoern A. Zeeb 	switch (region->sub_type) {
672d9836fb4SBjoern A. Zeeb 	case IWL_FW_INI_REGION_DEVICE_MEMORY_SUBTYPE_UMAC_ERROR_TABLE:
673d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.umac_error_event_table = addr;
674d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.error_event_table_tlv_status |=
675d9836fb4SBjoern A. Zeeb 			IWL_ERROR_EVENT_TABLE_UMAC;
676d9836fb4SBjoern A. Zeeb 		break;
677d9836fb4SBjoern A. Zeeb 	case IWL_FW_INI_REGION_DEVICE_MEMORY_SUBTYPE_LMAC_1_ERROR_TABLE:
678d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.lmac_error_event_table[0] = addr;
679d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.error_event_table_tlv_status |=
680d9836fb4SBjoern A. Zeeb 			IWL_ERROR_EVENT_TABLE_LMAC1;
681d9836fb4SBjoern A. Zeeb 		break;
682d9836fb4SBjoern A. Zeeb 	case IWL_FW_INI_REGION_DEVICE_MEMORY_SUBTYPE_LMAC_2_ERROR_TABLE:
683d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.lmac_error_event_table[1] = addr;
684d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.error_event_table_tlv_status |=
685d9836fb4SBjoern A. Zeeb 			IWL_ERROR_EVENT_TABLE_LMAC2;
686d9836fb4SBjoern A. Zeeb 		break;
687d9836fb4SBjoern A. Zeeb 	case IWL_FW_INI_REGION_DEVICE_MEMORY_SUBTYPE_TCM_1_ERROR_TABLE:
688d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.tcm_error_event_table[0] = addr;
689d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.error_event_table_tlv_status |=
690d9836fb4SBjoern A. Zeeb 			IWL_ERROR_EVENT_TABLE_TCM1;
691d9836fb4SBjoern A. Zeeb 		break;
692d9836fb4SBjoern A. Zeeb 	case IWL_FW_INI_REGION_DEVICE_MEMORY_SUBTYPE_TCM_2_ERROR_TABLE:
693d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.tcm_error_event_table[1] = addr;
694d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.error_event_table_tlv_status |=
695d9836fb4SBjoern A. Zeeb 			IWL_ERROR_EVENT_TABLE_TCM2;
696d9836fb4SBjoern A. Zeeb 		break;
697d9836fb4SBjoern A. Zeeb 	case IWL_FW_INI_REGION_DEVICE_MEMORY_SUBTYPE_RCM_1_ERROR_TABLE:
698d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.rcm_error_event_table[0] = addr;
699d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.error_event_table_tlv_status |=
700d9836fb4SBjoern A. Zeeb 			IWL_ERROR_EVENT_TABLE_RCM1;
701d9836fb4SBjoern A. Zeeb 		break;
702d9836fb4SBjoern A. Zeeb 	case IWL_FW_INI_REGION_DEVICE_MEMORY_SUBTYPE_RCM_2_ERROR_TABLE:
703d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.rcm_error_event_table[1] = addr;
704d9836fb4SBjoern A. Zeeb 		drv->trans->dbg.error_event_table_tlv_status |=
705d9836fb4SBjoern A. Zeeb 			IWL_ERROR_EVENT_TABLE_RCM2;
706d9836fb4SBjoern A. Zeeb 		break;
707d9836fb4SBjoern A. Zeeb 	default:
708d9836fb4SBjoern A. Zeeb 		break;
709d9836fb4SBjoern A. Zeeb 	}
710d9836fb4SBjoern A. Zeeb }
711d9836fb4SBjoern A. Zeeb 
iwl_parse_tlv_firmware(struct iwl_drv * drv,const struct firmware * ucode_raw,struct iwl_firmware_pieces * pieces,struct iwl_ucode_capabilities * capa,bool * usniffer_images)712bfcc09ddSBjoern A. Zeeb static int iwl_parse_tlv_firmware(struct iwl_drv *drv,
713bfcc09ddSBjoern A. Zeeb 				const struct firmware *ucode_raw,
714bfcc09ddSBjoern A. Zeeb 				struct iwl_firmware_pieces *pieces,
715bfcc09ddSBjoern A. Zeeb 				struct iwl_ucode_capabilities *capa,
716bfcc09ddSBjoern A. Zeeb 				bool *usniffer_images)
717bfcc09ddSBjoern A. Zeeb {
718bfcc09ddSBjoern A. Zeeb 	const struct iwl_tlv_ucode_header *ucode = (const void *)ucode_raw->data;
719bfcc09ddSBjoern A. Zeeb 	const struct iwl_ucode_tlv *tlv;
720bfcc09ddSBjoern A. Zeeb 	size_t len = ucode_raw->size;
721bfcc09ddSBjoern A. Zeeb 	const u8 *data;
722bfcc09ddSBjoern A. Zeeb 	u32 tlv_len;
723bfcc09ddSBjoern A. Zeeb 	u32 usniffer_img;
724bfcc09ddSBjoern A. Zeeb 	enum iwl_ucode_tlv_type tlv_type;
725bfcc09ddSBjoern A. Zeeb 	const u8 *tlv_data;
726bfcc09ddSBjoern A. Zeeb 	char buildstr[25];
727bfcc09ddSBjoern A. Zeeb 	u32 build, paging_mem_size;
728bfcc09ddSBjoern A. Zeeb 	int num_of_cpus;
729bfcc09ddSBjoern A. Zeeb 	bool usniffer_req = false;
730bfcc09ddSBjoern A. Zeeb 
731bfcc09ddSBjoern A. Zeeb 	if (len < sizeof(*ucode)) {
732bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv, "uCode has invalid length: %zd\n", len);
733bfcc09ddSBjoern A. Zeeb 		return -EINVAL;
734bfcc09ddSBjoern A. Zeeb 	}
735bfcc09ddSBjoern A. Zeeb 
736bfcc09ddSBjoern A. Zeeb 	if (ucode->magic != cpu_to_le32(IWL_TLV_UCODE_MAGIC)) {
737bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv, "invalid uCode magic: 0X%x\n",
738bfcc09ddSBjoern A. Zeeb 			le32_to_cpu(ucode->magic));
739bfcc09ddSBjoern A. Zeeb 		return -EINVAL;
740bfcc09ddSBjoern A. Zeeb 	}
741bfcc09ddSBjoern A. Zeeb 
742bfcc09ddSBjoern A. Zeeb 	drv->fw.ucode_ver = le32_to_cpu(ucode->ver);
743bfcc09ddSBjoern A. Zeeb 	memcpy(drv->fw.human_readable, ucode->human_readable,
744bfcc09ddSBjoern A. Zeeb 	       sizeof(drv->fw.human_readable));
745bfcc09ddSBjoern A. Zeeb 	build = le32_to_cpu(ucode->build);
746bfcc09ddSBjoern A. Zeeb 
747bfcc09ddSBjoern A. Zeeb 	if (build)
748bfcc09ddSBjoern A. Zeeb 		sprintf(buildstr, " build %u", build);
749bfcc09ddSBjoern A. Zeeb 	else
750bfcc09ddSBjoern A. Zeeb 		buildstr[0] = '\0';
751bfcc09ddSBjoern A. Zeeb 
752bfcc09ddSBjoern A. Zeeb 	snprintf(drv->fw.fw_version,
753bfcc09ddSBjoern A. Zeeb 		 sizeof(drv->fw.fw_version),
754bfcc09ddSBjoern A. Zeeb 		 "%u.%u.%u.%u%s %s",
755bfcc09ddSBjoern A. Zeeb 		 IWL_UCODE_MAJOR(drv->fw.ucode_ver),
756bfcc09ddSBjoern A. Zeeb 		 IWL_UCODE_MINOR(drv->fw.ucode_ver),
757bfcc09ddSBjoern A. Zeeb 		 IWL_UCODE_API(drv->fw.ucode_ver),
758bfcc09ddSBjoern A. Zeeb 		 IWL_UCODE_SERIAL(drv->fw.ucode_ver),
759bfcc09ddSBjoern A. Zeeb 		 buildstr, iwl_reduced_fw_name(drv));
760bfcc09ddSBjoern A. Zeeb 
761bfcc09ddSBjoern A. Zeeb 	data = ucode->data;
762bfcc09ddSBjoern A. Zeeb 
763bfcc09ddSBjoern A. Zeeb 	len -= sizeof(*ucode);
764bfcc09ddSBjoern A. Zeeb 
765bfcc09ddSBjoern A. Zeeb 	while (len >= sizeof(*tlv)) {
766bfcc09ddSBjoern A. Zeeb 		len -= sizeof(*tlv);
767bfcc09ddSBjoern A. Zeeb 
768d9836fb4SBjoern A. Zeeb 		tlv = (const void *)data;
769bfcc09ddSBjoern A. Zeeb 		tlv_len = le32_to_cpu(tlv->length);
770bfcc09ddSBjoern A. Zeeb 		tlv_type = le32_to_cpu(tlv->type);
771bfcc09ddSBjoern A. Zeeb 		tlv_data = tlv->data;
772bfcc09ddSBjoern A. Zeeb 
773bfcc09ddSBjoern A. Zeeb 		if (len < tlv_len) {
774bfcc09ddSBjoern A. Zeeb 			IWL_ERR(drv, "invalid TLV len: %zd/%u\n",
775bfcc09ddSBjoern A. Zeeb 				len, tlv_len);
776bfcc09ddSBjoern A. Zeeb 			return -EINVAL;
777bfcc09ddSBjoern A. Zeeb 		}
778bfcc09ddSBjoern A. Zeeb 		len -= ALIGN(tlv_len, 4);
779bfcc09ddSBjoern A. Zeeb 		data += sizeof(*tlv) + ALIGN(tlv_len, 4);
780bfcc09ddSBjoern A. Zeeb 
781bfcc09ddSBjoern A. Zeeb 		switch (tlv_type) {
782bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_INST:
783bfcc09ddSBjoern A. Zeeb 			set_sec_data(pieces, IWL_UCODE_REGULAR,
784bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_INST, tlv_data);
785bfcc09ddSBjoern A. Zeeb 			set_sec_size(pieces, IWL_UCODE_REGULAR,
786bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_INST, tlv_len);
787bfcc09ddSBjoern A. Zeeb 			set_sec_offset(pieces, IWL_UCODE_REGULAR,
788bfcc09ddSBjoern A. Zeeb 				       IWL_UCODE_SECTION_INST,
789bfcc09ddSBjoern A. Zeeb 				       IWLAGN_RTC_INST_LOWER_BOUND);
790bfcc09ddSBjoern A. Zeeb 			break;
791bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_DATA:
792bfcc09ddSBjoern A. Zeeb 			set_sec_data(pieces, IWL_UCODE_REGULAR,
793bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_DATA, tlv_data);
794bfcc09ddSBjoern A. Zeeb 			set_sec_size(pieces, IWL_UCODE_REGULAR,
795bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_DATA, tlv_len);
796bfcc09ddSBjoern A. Zeeb 			set_sec_offset(pieces, IWL_UCODE_REGULAR,
797bfcc09ddSBjoern A. Zeeb 				       IWL_UCODE_SECTION_DATA,
798bfcc09ddSBjoern A. Zeeb 				       IWLAGN_RTC_DATA_LOWER_BOUND);
799bfcc09ddSBjoern A. Zeeb 			break;
800bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_INIT:
801bfcc09ddSBjoern A. Zeeb 			set_sec_data(pieces, IWL_UCODE_INIT,
802bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_INST, tlv_data);
803bfcc09ddSBjoern A. Zeeb 			set_sec_size(pieces, IWL_UCODE_INIT,
804bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_INST, tlv_len);
805bfcc09ddSBjoern A. Zeeb 			set_sec_offset(pieces, IWL_UCODE_INIT,
806bfcc09ddSBjoern A. Zeeb 				       IWL_UCODE_SECTION_INST,
807bfcc09ddSBjoern A. Zeeb 				       IWLAGN_RTC_INST_LOWER_BOUND);
808bfcc09ddSBjoern A. Zeeb 			break;
809bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_INIT_DATA:
810bfcc09ddSBjoern A. Zeeb 			set_sec_data(pieces, IWL_UCODE_INIT,
811bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_DATA, tlv_data);
812bfcc09ddSBjoern A. Zeeb 			set_sec_size(pieces, IWL_UCODE_INIT,
813bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_DATA, tlv_len);
814bfcc09ddSBjoern A. Zeeb 			set_sec_offset(pieces, IWL_UCODE_INIT,
815bfcc09ddSBjoern A. Zeeb 				       IWL_UCODE_SECTION_DATA,
816bfcc09ddSBjoern A. Zeeb 				       IWLAGN_RTC_DATA_LOWER_BOUND);
817bfcc09ddSBjoern A. Zeeb 			break;
818bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_BOOT:
819bfcc09ddSBjoern A. Zeeb 			IWL_ERR(drv, "Found unexpected BOOT ucode\n");
820bfcc09ddSBjoern A. Zeeb 			break;
821bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_PROBE_MAX_LEN:
822bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
823bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
824bfcc09ddSBjoern A. Zeeb 			capa->max_probe_length =
825bfcc09ddSBjoern A. Zeeb 					le32_to_cpup((const __le32 *)tlv_data);
826bfcc09ddSBjoern A. Zeeb 			break;
827bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_PAN:
828bfcc09ddSBjoern A. Zeeb 			if (tlv_len)
829bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
830bfcc09ddSBjoern A. Zeeb 			capa->flags |= IWL_UCODE_TLV_FLAGS_PAN;
831bfcc09ddSBjoern A. Zeeb 			break;
832bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FLAGS:
833bfcc09ddSBjoern A. Zeeb 			/* must be at least one u32 */
834bfcc09ddSBjoern A. Zeeb 			if (tlv_len < sizeof(u32))
835bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
836bfcc09ddSBjoern A. Zeeb 			/* and a proper number of u32s */
837bfcc09ddSBjoern A. Zeeb 			if (tlv_len % sizeof(u32))
838bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
839bfcc09ddSBjoern A. Zeeb 			/*
840bfcc09ddSBjoern A. Zeeb 			 * This driver only reads the first u32 as
841bfcc09ddSBjoern A. Zeeb 			 * right now no more features are defined,
842bfcc09ddSBjoern A. Zeeb 			 * if that changes then either the driver
843bfcc09ddSBjoern A. Zeeb 			 * will not work with the new firmware, or
844bfcc09ddSBjoern A. Zeeb 			 * it'll not take advantage of new features.
845bfcc09ddSBjoern A. Zeeb 			 */
846bfcc09ddSBjoern A. Zeeb 			capa->flags = le32_to_cpup((const __le32 *)tlv_data);
847bfcc09ddSBjoern A. Zeeb 			break;
848bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_API_CHANGES_SET:
849bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(struct iwl_ucode_api))
850bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
851bfcc09ddSBjoern A. Zeeb 			iwl_set_ucode_api_flags(drv, tlv_data, capa);
852bfcc09ddSBjoern A. Zeeb 			break;
853bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_ENABLED_CAPABILITIES:
854bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(struct iwl_ucode_capa))
855bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
856bfcc09ddSBjoern A. Zeeb 			iwl_set_ucode_capabilities(drv, tlv_data, capa);
857bfcc09ddSBjoern A. Zeeb 			break;
858bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_INIT_EVTLOG_PTR:
859bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
860bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
861bfcc09ddSBjoern A. Zeeb 			pieces->init_evtlog_ptr =
862bfcc09ddSBjoern A. Zeeb 					le32_to_cpup((const __le32 *)tlv_data);
863bfcc09ddSBjoern A. Zeeb 			break;
864bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_INIT_EVTLOG_SIZE:
865bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
866bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
867bfcc09ddSBjoern A. Zeeb 			pieces->init_evtlog_size =
868bfcc09ddSBjoern A. Zeeb 					le32_to_cpup((const __le32 *)tlv_data);
869bfcc09ddSBjoern A. Zeeb 			break;
870bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_INIT_ERRLOG_PTR:
871bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
872bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
873bfcc09ddSBjoern A. Zeeb 			pieces->init_errlog_ptr =
874bfcc09ddSBjoern A. Zeeb 					le32_to_cpup((const __le32 *)tlv_data);
875bfcc09ddSBjoern A. Zeeb 			break;
876bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_RUNT_EVTLOG_PTR:
877bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
878bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
879bfcc09ddSBjoern A. Zeeb 			pieces->inst_evtlog_ptr =
880bfcc09ddSBjoern A. Zeeb 					le32_to_cpup((const __le32 *)tlv_data);
881bfcc09ddSBjoern A. Zeeb 			break;
882bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_RUNT_EVTLOG_SIZE:
883bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
884bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
885bfcc09ddSBjoern A. Zeeb 			pieces->inst_evtlog_size =
886bfcc09ddSBjoern A. Zeeb 					le32_to_cpup((const __le32 *)tlv_data);
887bfcc09ddSBjoern A. Zeeb 			break;
888bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_RUNT_ERRLOG_PTR:
889bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
890bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
891bfcc09ddSBjoern A. Zeeb 			pieces->inst_errlog_ptr =
892bfcc09ddSBjoern A. Zeeb 					le32_to_cpup((const __le32 *)tlv_data);
893bfcc09ddSBjoern A. Zeeb 			break;
894bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_ENHANCE_SENS_TBL:
895bfcc09ddSBjoern A. Zeeb 			if (tlv_len)
896bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
897bfcc09ddSBjoern A. Zeeb 			drv->fw.enhance_sensitivity_table = true;
898bfcc09ddSBjoern A. Zeeb 			break;
899bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_WOWLAN_INST:
900bfcc09ddSBjoern A. Zeeb 			set_sec_data(pieces, IWL_UCODE_WOWLAN,
901bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_INST, tlv_data);
902bfcc09ddSBjoern A. Zeeb 			set_sec_size(pieces, IWL_UCODE_WOWLAN,
903bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_INST, tlv_len);
904bfcc09ddSBjoern A. Zeeb 			set_sec_offset(pieces, IWL_UCODE_WOWLAN,
905bfcc09ddSBjoern A. Zeeb 				       IWL_UCODE_SECTION_INST,
906bfcc09ddSBjoern A. Zeeb 				       IWLAGN_RTC_INST_LOWER_BOUND);
907bfcc09ddSBjoern A. Zeeb 			break;
908bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_WOWLAN_DATA:
909bfcc09ddSBjoern A. Zeeb 			set_sec_data(pieces, IWL_UCODE_WOWLAN,
910bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_DATA, tlv_data);
911bfcc09ddSBjoern A. Zeeb 			set_sec_size(pieces, IWL_UCODE_WOWLAN,
912bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_DATA, tlv_len);
913bfcc09ddSBjoern A. Zeeb 			set_sec_offset(pieces, IWL_UCODE_WOWLAN,
914bfcc09ddSBjoern A. Zeeb 				       IWL_UCODE_SECTION_DATA,
915bfcc09ddSBjoern A. Zeeb 				       IWLAGN_RTC_DATA_LOWER_BOUND);
916bfcc09ddSBjoern A. Zeeb 			break;
917bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_PHY_CALIBRATION_SIZE:
918bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
919bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
920bfcc09ddSBjoern A. Zeeb 			capa->standard_phy_calibration_size =
921bfcc09ddSBjoern A. Zeeb 					le32_to_cpup((const __le32 *)tlv_data);
922bfcc09ddSBjoern A. Zeeb 			break;
923bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_SEC_RT:
924bfcc09ddSBjoern A. Zeeb 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_REGULAR,
925bfcc09ddSBjoern A. Zeeb 					    tlv_len);
926bfcc09ddSBjoern A. Zeeb 			drv->fw.type = IWL_FW_MVM;
927bfcc09ddSBjoern A. Zeeb 			break;
928bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_SEC_INIT:
929bfcc09ddSBjoern A. Zeeb 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_INIT,
930bfcc09ddSBjoern A. Zeeb 					    tlv_len);
931bfcc09ddSBjoern A. Zeeb 			drv->fw.type = IWL_FW_MVM;
932bfcc09ddSBjoern A. Zeeb 			break;
933bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_SEC_WOWLAN:
934bfcc09ddSBjoern A. Zeeb 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_WOWLAN,
935bfcc09ddSBjoern A. Zeeb 					    tlv_len);
936bfcc09ddSBjoern A. Zeeb 			drv->fw.type = IWL_FW_MVM;
937bfcc09ddSBjoern A. Zeeb 			break;
938bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_DEF_CALIB:
939bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(struct iwl_tlv_calib_data))
940bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
941bfcc09ddSBjoern A. Zeeb 			if (iwl_set_default_calib(drv, tlv_data))
942bfcc09ddSBjoern A. Zeeb 				goto tlv_error;
943bfcc09ddSBjoern A. Zeeb 			break;
944bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_PHY_SKU:
945bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
946bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
947bfcc09ddSBjoern A. Zeeb 			drv->fw.phy_config = le32_to_cpup((const __le32 *)tlv_data);
948bfcc09ddSBjoern A. Zeeb 			drv->fw.valid_tx_ant = (drv->fw.phy_config &
949bfcc09ddSBjoern A. Zeeb 						FW_PHY_CFG_TX_CHAIN) >>
950bfcc09ddSBjoern A. Zeeb 						FW_PHY_CFG_TX_CHAIN_POS;
951bfcc09ddSBjoern A. Zeeb 			drv->fw.valid_rx_ant = (drv->fw.phy_config &
952bfcc09ddSBjoern A. Zeeb 						FW_PHY_CFG_RX_CHAIN) >>
953bfcc09ddSBjoern A. Zeeb 						FW_PHY_CFG_RX_CHAIN_POS;
954bfcc09ddSBjoern A. Zeeb 			break;
955bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_SECURE_SEC_RT:
956bfcc09ddSBjoern A. Zeeb 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_REGULAR,
957bfcc09ddSBjoern A. Zeeb 					    tlv_len);
958bfcc09ddSBjoern A. Zeeb 			drv->fw.type = IWL_FW_MVM;
959bfcc09ddSBjoern A. Zeeb 			break;
960bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_SECURE_SEC_INIT:
961bfcc09ddSBjoern A. Zeeb 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_INIT,
962bfcc09ddSBjoern A. Zeeb 					    tlv_len);
963bfcc09ddSBjoern A. Zeeb 			drv->fw.type = IWL_FW_MVM;
964bfcc09ddSBjoern A. Zeeb 			break;
965bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_SECURE_SEC_WOWLAN:
966bfcc09ddSBjoern A. Zeeb 			iwl_store_ucode_sec(pieces, tlv_data, IWL_UCODE_WOWLAN,
967bfcc09ddSBjoern A. Zeeb 					    tlv_len);
968bfcc09ddSBjoern A. Zeeb 			drv->fw.type = IWL_FW_MVM;
969bfcc09ddSBjoern A. Zeeb 			break;
970bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_NUM_OF_CPU:
971bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
972bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
973bfcc09ddSBjoern A. Zeeb 			num_of_cpus =
974bfcc09ddSBjoern A. Zeeb 				le32_to_cpup((const __le32 *)tlv_data);
975bfcc09ddSBjoern A. Zeeb 
976bfcc09ddSBjoern A. Zeeb 			if (num_of_cpus == 2) {
977bfcc09ddSBjoern A. Zeeb 				drv->fw.img[IWL_UCODE_REGULAR].is_dual_cpus =
978bfcc09ddSBjoern A. Zeeb 					true;
979bfcc09ddSBjoern A. Zeeb 				drv->fw.img[IWL_UCODE_INIT].is_dual_cpus =
980bfcc09ddSBjoern A. Zeeb 					true;
981bfcc09ddSBjoern A. Zeeb 				drv->fw.img[IWL_UCODE_WOWLAN].is_dual_cpus =
982bfcc09ddSBjoern A. Zeeb 					true;
983bfcc09ddSBjoern A. Zeeb 			} else if ((num_of_cpus > 2) || (num_of_cpus < 1)) {
984bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv, "Driver support up to 2 CPUs\n");
985bfcc09ddSBjoern A. Zeeb 				return -EINVAL;
986bfcc09ddSBjoern A. Zeeb 			}
987bfcc09ddSBjoern A. Zeeb 			break;
988bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_N_SCAN_CHANNELS:
989bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
990bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
991bfcc09ddSBjoern A. Zeeb 			capa->n_scan_channels =
992bfcc09ddSBjoern A. Zeeb 				le32_to_cpup((const __le32 *)tlv_data);
993bfcc09ddSBjoern A. Zeeb 			break;
994bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_VERSION: {
995d9836fb4SBjoern A. Zeeb 			const __le32 *ptr = (const void *)tlv_data;
996bfcc09ddSBjoern A. Zeeb 			u32 major, minor;
997bfcc09ddSBjoern A. Zeeb 			u8 local_comp;
998bfcc09ddSBjoern A. Zeeb 
999bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32) * 3)
1000bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
1001bfcc09ddSBjoern A. Zeeb 
1002bfcc09ddSBjoern A. Zeeb 			major = le32_to_cpup(ptr++);
1003bfcc09ddSBjoern A. Zeeb 			minor = le32_to_cpup(ptr++);
1004bfcc09ddSBjoern A. Zeeb 			local_comp = le32_to_cpup(ptr);
1005bfcc09ddSBjoern A. Zeeb 
1006bfcc09ddSBjoern A. Zeeb 			snprintf(drv->fw.fw_version,
1007bfcc09ddSBjoern A. Zeeb 				 sizeof(drv->fw.fw_version),
1008bfcc09ddSBjoern A. Zeeb 				 "%u.%08x.%u %s", major, minor,
1009bfcc09ddSBjoern A. Zeeb 				 local_comp, iwl_reduced_fw_name(drv));
1010bfcc09ddSBjoern A. Zeeb 			break;
1011bfcc09ddSBjoern A. Zeeb 			}
1012bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_DBG_DEST: {
1013bfcc09ddSBjoern A. Zeeb 			const struct iwl_fw_dbg_dest_tlv *dest = NULL;
1014bfcc09ddSBjoern A. Zeeb 			const struct iwl_fw_dbg_dest_tlv_v1 *dest_v1 = NULL;
1015bfcc09ddSBjoern A. Zeeb 			u8 mon_mode;
1016bfcc09ddSBjoern A. Zeeb 
1017bfcc09ddSBjoern A. Zeeb 			pieces->dbg_dest_ver = (const u8 *)tlv_data;
1018bfcc09ddSBjoern A. Zeeb 			if (*pieces->dbg_dest_ver == 1) {
1019bfcc09ddSBjoern A. Zeeb 				dest = (const void *)tlv_data;
1020bfcc09ddSBjoern A. Zeeb 			} else if (*pieces->dbg_dest_ver == 0) {
1021bfcc09ddSBjoern A. Zeeb 				dest_v1 = (const void *)tlv_data;
1022bfcc09ddSBjoern A. Zeeb 			} else {
1023bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1024bfcc09ddSBjoern A. Zeeb 					"The version is %d, and it is invalid\n",
1025bfcc09ddSBjoern A. Zeeb 					*pieces->dbg_dest_ver);
1026bfcc09ddSBjoern A. Zeeb 				break;
1027bfcc09ddSBjoern A. Zeeb 			}
1028bfcc09ddSBjoern A. Zeeb 
1029bfcc09ddSBjoern A. Zeeb 			if (pieces->dbg_dest_tlv_init) {
1030bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1031bfcc09ddSBjoern A. Zeeb 					"dbg destination ignored, already exists\n");
1032bfcc09ddSBjoern A. Zeeb 				break;
1033bfcc09ddSBjoern A. Zeeb 			}
1034bfcc09ddSBjoern A. Zeeb 
1035bfcc09ddSBjoern A. Zeeb 			pieces->dbg_dest_tlv_init = true;
1036bfcc09ddSBjoern A. Zeeb 
1037bfcc09ddSBjoern A. Zeeb 			if (dest_v1) {
1038bfcc09ddSBjoern A. Zeeb 				pieces->dbg_dest_tlv_v1 = dest_v1;
1039bfcc09ddSBjoern A. Zeeb 				mon_mode = dest_v1->monitor_mode;
1040bfcc09ddSBjoern A. Zeeb 			} else {
1041bfcc09ddSBjoern A. Zeeb 				pieces->dbg_dest_tlv = dest;
1042bfcc09ddSBjoern A. Zeeb 				mon_mode = dest->monitor_mode;
1043bfcc09ddSBjoern A. Zeeb 			}
1044bfcc09ddSBjoern A. Zeeb 
1045bfcc09ddSBjoern A. Zeeb 			IWL_INFO(drv, "Found debug destination: %s\n",
1046bfcc09ddSBjoern A. Zeeb 				 get_fw_dbg_mode_string(mon_mode));
1047bfcc09ddSBjoern A. Zeeb 
1048bfcc09ddSBjoern A. Zeeb 			drv->fw.dbg.n_dest_reg = (dest_v1) ?
1049bfcc09ddSBjoern A. Zeeb 				tlv_len -
1050bfcc09ddSBjoern A. Zeeb 				offsetof(struct iwl_fw_dbg_dest_tlv_v1,
1051bfcc09ddSBjoern A. Zeeb 					 reg_ops) :
1052bfcc09ddSBjoern A. Zeeb 				tlv_len -
1053bfcc09ddSBjoern A. Zeeb 				offsetof(struct iwl_fw_dbg_dest_tlv,
1054bfcc09ddSBjoern A. Zeeb 					 reg_ops);
1055bfcc09ddSBjoern A. Zeeb 
1056bfcc09ddSBjoern A. Zeeb 			drv->fw.dbg.n_dest_reg /=
1057bfcc09ddSBjoern A. Zeeb 				sizeof(drv->fw.dbg.dest_tlv->reg_ops[0]);
1058bfcc09ddSBjoern A. Zeeb 
1059bfcc09ddSBjoern A. Zeeb 			break;
1060bfcc09ddSBjoern A. Zeeb 			}
1061bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_DBG_CONF: {
1062bfcc09ddSBjoern A. Zeeb 			const struct iwl_fw_dbg_conf_tlv *conf =
1063bfcc09ddSBjoern A. Zeeb 				(const void *)tlv_data;
1064bfcc09ddSBjoern A. Zeeb 
1065bfcc09ddSBjoern A. Zeeb 			if (!pieces->dbg_dest_tlv_init) {
1066bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1067bfcc09ddSBjoern A. Zeeb 					"Ignore dbg config %d - no destination configured\n",
1068bfcc09ddSBjoern A. Zeeb 					conf->id);
1069bfcc09ddSBjoern A. Zeeb 				break;
1070bfcc09ddSBjoern A. Zeeb 			}
1071bfcc09ddSBjoern A. Zeeb 
1072bfcc09ddSBjoern A. Zeeb 			if (conf->id >= ARRAY_SIZE(drv->fw.dbg.conf_tlv)) {
1073bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1074bfcc09ddSBjoern A. Zeeb 					"Skip unknown configuration: %d\n",
1075bfcc09ddSBjoern A. Zeeb 					conf->id);
1076bfcc09ddSBjoern A. Zeeb 				break;
1077bfcc09ddSBjoern A. Zeeb 			}
1078bfcc09ddSBjoern A. Zeeb 
1079bfcc09ddSBjoern A. Zeeb 			if (pieces->dbg_conf_tlv[conf->id]) {
1080bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1081bfcc09ddSBjoern A. Zeeb 					"Ignore duplicate dbg config %d\n",
1082bfcc09ddSBjoern A. Zeeb 					conf->id);
1083bfcc09ddSBjoern A. Zeeb 				break;
1084bfcc09ddSBjoern A. Zeeb 			}
1085bfcc09ddSBjoern A. Zeeb 
1086bfcc09ddSBjoern A. Zeeb 			if (conf->usniffer)
1087bfcc09ddSBjoern A. Zeeb 				usniffer_req = true;
1088bfcc09ddSBjoern A. Zeeb 
1089bfcc09ddSBjoern A. Zeeb 			IWL_INFO(drv, "Found debug configuration: %d\n",
1090bfcc09ddSBjoern A. Zeeb 				 conf->id);
1091bfcc09ddSBjoern A. Zeeb 
1092bfcc09ddSBjoern A. Zeeb 			pieces->dbg_conf_tlv[conf->id] = conf;
1093bfcc09ddSBjoern A. Zeeb 			pieces->dbg_conf_tlv_len[conf->id] = tlv_len;
1094bfcc09ddSBjoern A. Zeeb 			break;
1095bfcc09ddSBjoern A. Zeeb 			}
1096bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_DBG_TRIGGER: {
1097bfcc09ddSBjoern A. Zeeb 			const struct iwl_fw_dbg_trigger_tlv *trigger =
1098bfcc09ddSBjoern A. Zeeb 				(const void *)tlv_data;
1099bfcc09ddSBjoern A. Zeeb 			u32 trigger_id = le32_to_cpu(trigger->id);
1100bfcc09ddSBjoern A. Zeeb 
1101bfcc09ddSBjoern A. Zeeb 			if (trigger_id >= ARRAY_SIZE(drv->fw.dbg.trigger_tlv)) {
1102bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1103bfcc09ddSBjoern A. Zeeb 					"Skip unknown trigger: %u\n",
1104bfcc09ddSBjoern A. Zeeb 					trigger->id);
1105bfcc09ddSBjoern A. Zeeb 				break;
1106bfcc09ddSBjoern A. Zeeb 			}
1107bfcc09ddSBjoern A. Zeeb 
1108bfcc09ddSBjoern A. Zeeb 			if (pieces->dbg_trigger_tlv[trigger_id]) {
1109bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1110bfcc09ddSBjoern A. Zeeb 					"Ignore duplicate dbg trigger %u\n",
1111bfcc09ddSBjoern A. Zeeb 					trigger->id);
1112bfcc09ddSBjoern A. Zeeb 				break;
1113bfcc09ddSBjoern A. Zeeb 			}
1114bfcc09ddSBjoern A. Zeeb 
1115bfcc09ddSBjoern A. Zeeb 			IWL_INFO(drv, "Found debug trigger: %u\n", trigger->id);
1116bfcc09ddSBjoern A. Zeeb 
1117bfcc09ddSBjoern A. Zeeb 			pieces->dbg_trigger_tlv[trigger_id] = trigger;
1118bfcc09ddSBjoern A. Zeeb 			pieces->dbg_trigger_tlv_len[trigger_id] = tlv_len;
1119bfcc09ddSBjoern A. Zeeb 			break;
1120bfcc09ddSBjoern A. Zeeb 			}
1121bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_DBG_DUMP_LST: {
1122bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32)) {
1123bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1124bfcc09ddSBjoern A. Zeeb 					"dbg lst mask size incorrect, skip\n");
1125bfcc09ddSBjoern A. Zeeb 				break;
1126bfcc09ddSBjoern A. Zeeb 			}
1127bfcc09ddSBjoern A. Zeeb 
1128bfcc09ddSBjoern A. Zeeb 			drv->fw.dbg.dump_mask =
1129bfcc09ddSBjoern A. Zeeb 				le32_to_cpup((const __le32 *)tlv_data);
1130bfcc09ddSBjoern A. Zeeb 			break;
1131bfcc09ddSBjoern A. Zeeb 			}
1132bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_SEC_RT_USNIFFER:
1133bfcc09ddSBjoern A. Zeeb 			*usniffer_images = true;
1134bfcc09ddSBjoern A. Zeeb 			iwl_store_ucode_sec(pieces, tlv_data,
1135bfcc09ddSBjoern A. Zeeb 					    IWL_UCODE_REGULAR_USNIFFER,
1136bfcc09ddSBjoern A. Zeeb 					    tlv_len);
1137bfcc09ddSBjoern A. Zeeb 			break;
1138bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_PAGING:
1139bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
1140bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
1141bfcc09ddSBjoern A. Zeeb 			paging_mem_size = le32_to_cpup((const __le32 *)tlv_data);
1142bfcc09ddSBjoern A. Zeeb 
1143bfcc09ddSBjoern A. Zeeb 			IWL_DEBUG_FW(drv,
1144bfcc09ddSBjoern A. Zeeb 				     "Paging: paging enabled (size = %u bytes)\n",
1145bfcc09ddSBjoern A. Zeeb 				     paging_mem_size);
1146bfcc09ddSBjoern A. Zeeb 
1147bfcc09ddSBjoern A. Zeeb 			if (paging_mem_size > MAX_PAGING_IMAGE_SIZE) {
1148bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1149bfcc09ddSBjoern A. Zeeb 					"Paging: driver supports up to %lu bytes for paging image\n",
1150bfcc09ddSBjoern A. Zeeb 					MAX_PAGING_IMAGE_SIZE);
1151bfcc09ddSBjoern A. Zeeb 				return -EINVAL;
1152bfcc09ddSBjoern A. Zeeb 			}
1153bfcc09ddSBjoern A. Zeeb 
1154bfcc09ddSBjoern A. Zeeb 			if (paging_mem_size & (FW_PAGING_SIZE - 1)) {
1155bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1156bfcc09ddSBjoern A. Zeeb 					"Paging: image isn't multiple %lu\n",
1157bfcc09ddSBjoern A. Zeeb 					FW_PAGING_SIZE);
1158bfcc09ddSBjoern A. Zeeb 				return -EINVAL;
1159bfcc09ddSBjoern A. Zeeb 			}
1160bfcc09ddSBjoern A. Zeeb 
1161bfcc09ddSBjoern A. Zeeb 			drv->fw.img[IWL_UCODE_REGULAR].paging_mem_size =
1162bfcc09ddSBjoern A. Zeeb 				paging_mem_size;
1163bfcc09ddSBjoern A. Zeeb 			usniffer_img = IWL_UCODE_REGULAR_USNIFFER;
1164bfcc09ddSBjoern A. Zeeb 			drv->fw.img[usniffer_img].paging_mem_size =
1165bfcc09ddSBjoern A. Zeeb 				paging_mem_size;
1166bfcc09ddSBjoern A. Zeeb 			break;
1167bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_GSCAN_CAPA:
1168bfcc09ddSBjoern A. Zeeb 			/* ignored */
1169bfcc09ddSBjoern A. Zeeb 			break;
1170bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_MEM_SEG: {
1171bfcc09ddSBjoern A. Zeeb 			const struct iwl_fw_dbg_mem_seg_tlv *dbg_mem =
1172bfcc09ddSBjoern A. Zeeb 				(const void *)tlv_data;
1173bfcc09ddSBjoern A. Zeeb 			size_t size;
1174bfcc09ddSBjoern A. Zeeb 			struct iwl_fw_dbg_mem_seg_tlv *n;
1175bfcc09ddSBjoern A. Zeeb 
1176bfcc09ddSBjoern A. Zeeb 			if (tlv_len != (sizeof(*dbg_mem)))
1177bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
1178bfcc09ddSBjoern A. Zeeb 
1179bfcc09ddSBjoern A. Zeeb 			IWL_DEBUG_INFO(drv, "Found debug memory segment: %u\n",
1180bfcc09ddSBjoern A. Zeeb 				       dbg_mem->data_type);
1181bfcc09ddSBjoern A. Zeeb 
1182bfcc09ddSBjoern A. Zeeb 			size = sizeof(*pieces->dbg_mem_tlv) *
1183bfcc09ddSBjoern A. Zeeb 			       (pieces->n_mem_tlv + 1);
1184bfcc09ddSBjoern A. Zeeb 			n = krealloc(pieces->dbg_mem_tlv, size, GFP_KERNEL);
1185bfcc09ddSBjoern A. Zeeb 			if (!n)
1186bfcc09ddSBjoern A. Zeeb 				return -ENOMEM;
1187bfcc09ddSBjoern A. Zeeb 			pieces->dbg_mem_tlv = n;
1188bfcc09ddSBjoern A. Zeeb 			pieces->dbg_mem_tlv[pieces->n_mem_tlv] = *dbg_mem;
1189bfcc09ddSBjoern A. Zeeb 			pieces->n_mem_tlv++;
1190bfcc09ddSBjoern A. Zeeb 			break;
1191bfcc09ddSBjoern A. Zeeb 			}
1192bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_IML: {
1193bfcc09ddSBjoern A. Zeeb 			drv->fw.iml_len = tlv_len;
1194bfcc09ddSBjoern A. Zeeb 			drv->fw.iml = kmemdup(tlv_data, tlv_len, GFP_KERNEL);
1195bfcc09ddSBjoern A. Zeeb 			if (!drv->fw.iml)
1196bfcc09ddSBjoern A. Zeeb 				return -ENOMEM;
1197bfcc09ddSBjoern A. Zeeb 			break;
1198bfcc09ddSBjoern A. Zeeb 			}
1199bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_RECOVERY_INFO: {
1200bfcc09ddSBjoern A. Zeeb 			const struct {
1201bfcc09ddSBjoern A. Zeeb 				__le32 buf_addr;
1202bfcc09ddSBjoern A. Zeeb 				__le32 buf_size;
1203bfcc09ddSBjoern A. Zeeb 			} *recov_info = (const void *)tlv_data;
1204bfcc09ddSBjoern A. Zeeb 
1205bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(*recov_info))
1206bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
1207bfcc09ddSBjoern A. Zeeb 			capa->error_log_addr =
1208bfcc09ddSBjoern A. Zeeb 				le32_to_cpu(recov_info->buf_addr);
1209bfcc09ddSBjoern A. Zeeb 			capa->error_log_size =
1210bfcc09ddSBjoern A. Zeeb 				le32_to_cpu(recov_info->buf_size);
1211bfcc09ddSBjoern A. Zeeb 			}
1212bfcc09ddSBjoern A. Zeeb 			break;
1213bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_FSEQ_VERSION: {
1214bfcc09ddSBjoern A. Zeeb 			const struct {
1215bfcc09ddSBjoern A. Zeeb 				u8 version[32];
1216bfcc09ddSBjoern A. Zeeb 				u8 sha1[20];
1217bfcc09ddSBjoern A. Zeeb 			} *fseq_ver = (const void *)tlv_data;
1218bfcc09ddSBjoern A. Zeeb 
1219bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(*fseq_ver))
1220bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
1221bfcc09ddSBjoern A. Zeeb 			IWL_INFO(drv, "TLV_FW_FSEQ_VERSION: %s\n",
1222bfcc09ddSBjoern A. Zeeb 				 fseq_ver->version);
1223bfcc09ddSBjoern A. Zeeb 			}
1224bfcc09ddSBjoern A. Zeeb 			break;
1225bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_NUM_STATIONS:
1226bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
1227bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
1228bfcc09ddSBjoern A. Zeeb 			if (le32_to_cpup((const __le32 *)tlv_data) >
1229bfcc09ddSBjoern A. Zeeb 			    IWL_MVM_STATION_COUNT_MAX) {
1230bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1231bfcc09ddSBjoern A. Zeeb 					"%d is an invalid number of station\n",
1232bfcc09ddSBjoern A. Zeeb 					le32_to_cpup((const __le32 *)tlv_data));
1233bfcc09ddSBjoern A. Zeeb 				goto tlv_error;
1234bfcc09ddSBjoern A. Zeeb 			}
1235bfcc09ddSBjoern A. Zeeb 			capa->num_stations =
1236bfcc09ddSBjoern A. Zeeb 				le32_to_cpup((const __le32 *)tlv_data);
1237bfcc09ddSBjoern A. Zeeb 			break;
12389af1bba4SBjoern A. Zeeb 		case IWL_UCODE_TLV_FW_NUM_BEACONS:
12399af1bba4SBjoern A. Zeeb 			if (tlv_len != sizeof(u32))
12409af1bba4SBjoern A. Zeeb 				goto invalid_tlv_len;
12419af1bba4SBjoern A. Zeeb 			capa->num_beacons =
12429af1bba4SBjoern A. Zeeb 				le32_to_cpup((const __le32 *)tlv_data);
12439af1bba4SBjoern A. Zeeb 			break;
1244bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_UMAC_DEBUG_ADDRS: {
1245bfcc09ddSBjoern A. Zeeb 			const struct iwl_umac_debug_addrs *dbg_ptrs =
1246bfcc09ddSBjoern A. Zeeb 				(const void *)tlv_data;
1247bfcc09ddSBjoern A. Zeeb 
1248bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(*dbg_ptrs))
1249bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
1250bfcc09ddSBjoern A. Zeeb 			if (drv->trans->trans_cfg->device_family <
1251bfcc09ddSBjoern A. Zeeb 			    IWL_DEVICE_FAMILY_22000)
1252bfcc09ddSBjoern A. Zeeb 				break;
1253bfcc09ddSBjoern A. Zeeb 			drv->trans->dbg.umac_error_event_table =
1254bfcc09ddSBjoern A. Zeeb 				le32_to_cpu(dbg_ptrs->error_info_addr) &
1255bfcc09ddSBjoern A. Zeeb 				~FW_ADDR_CACHE_CONTROL;
1256bfcc09ddSBjoern A. Zeeb 			drv->trans->dbg.error_event_table_tlv_status |=
1257bfcc09ddSBjoern A. Zeeb 				IWL_ERROR_EVENT_TABLE_UMAC;
1258bfcc09ddSBjoern A. Zeeb 			break;
1259bfcc09ddSBjoern A. Zeeb 			}
1260bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_LMAC_DEBUG_ADDRS: {
1261bfcc09ddSBjoern A. Zeeb 			const struct iwl_lmac_debug_addrs *dbg_ptrs =
1262bfcc09ddSBjoern A. Zeeb 				(const void *)tlv_data;
1263bfcc09ddSBjoern A. Zeeb 
1264bfcc09ddSBjoern A. Zeeb 			if (tlv_len != sizeof(*dbg_ptrs))
1265bfcc09ddSBjoern A. Zeeb 				goto invalid_tlv_len;
1266bfcc09ddSBjoern A. Zeeb 			if (drv->trans->trans_cfg->device_family <
1267bfcc09ddSBjoern A. Zeeb 			    IWL_DEVICE_FAMILY_22000)
1268bfcc09ddSBjoern A. Zeeb 				break;
1269bfcc09ddSBjoern A. Zeeb 			drv->trans->dbg.lmac_error_event_table[0] =
1270bfcc09ddSBjoern A. Zeeb 				le32_to_cpu(dbg_ptrs->error_event_table_ptr) &
1271bfcc09ddSBjoern A. Zeeb 				~FW_ADDR_CACHE_CONTROL;
1272bfcc09ddSBjoern A. Zeeb 			drv->trans->dbg.error_event_table_tlv_status |=
1273bfcc09ddSBjoern A. Zeeb 				IWL_ERROR_EVENT_TABLE_LMAC1;
1274bfcc09ddSBjoern A. Zeeb 			break;
1275bfcc09ddSBjoern A. Zeeb 			}
1276d9836fb4SBjoern A. Zeeb 		case IWL_UCODE_TLV_TYPE_REGIONS:
1277d9836fb4SBjoern A. Zeeb 			iwl_parse_dbg_tlv_assert_tables(drv, tlv);
1278d9836fb4SBjoern A. Zeeb 			fallthrough;
1279bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_TYPE_DEBUG_INFO:
1280bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_TYPE_BUFFER_ALLOCATION:
1281bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_TYPE_HCMD:
1282bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_TYPE_TRIGGERS:
1283bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_TYPE_CONF_SET:
1284bfcc09ddSBjoern A. Zeeb 			if (iwlwifi_mod_params.enable_ini)
1285bfcc09ddSBjoern A. Zeeb 				iwl_dbg_tlv_alloc(drv->trans, tlv, false);
1286bfcc09ddSBjoern A. Zeeb 			break;
1287bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_CMD_VERSIONS:
1288bfcc09ddSBjoern A. Zeeb 			if (tlv_len % sizeof(struct iwl_fw_cmd_version)) {
1289bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1290bfcc09ddSBjoern A. Zeeb 					"Invalid length for command versions: %u\n",
1291bfcc09ddSBjoern A. Zeeb 					tlv_len);
1292bfcc09ddSBjoern A. Zeeb 				tlv_len /= sizeof(struct iwl_fw_cmd_version);
1293bfcc09ddSBjoern A. Zeeb 				tlv_len *= sizeof(struct iwl_fw_cmd_version);
1294bfcc09ddSBjoern A. Zeeb 			}
1295bfcc09ddSBjoern A. Zeeb 			if (WARN_ON(capa->cmd_versions))
1296bfcc09ddSBjoern A. Zeeb 				return -EINVAL;
1297bfcc09ddSBjoern A. Zeeb 			capa->cmd_versions = kmemdup(tlv_data, tlv_len,
1298bfcc09ddSBjoern A. Zeeb 						     GFP_KERNEL);
1299bfcc09ddSBjoern A. Zeeb 			if (!capa->cmd_versions)
1300bfcc09ddSBjoern A. Zeeb 				return -ENOMEM;
1301bfcc09ddSBjoern A. Zeeb 			capa->n_cmd_versions =
1302bfcc09ddSBjoern A. Zeeb 				tlv_len / sizeof(struct iwl_fw_cmd_version);
1303bfcc09ddSBjoern A. Zeeb 			break;
1304bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_PHY_INTEGRATION_VERSION:
1305bfcc09ddSBjoern A. Zeeb 			if (drv->fw.phy_integration_ver) {
1306bfcc09ddSBjoern A. Zeeb 				IWL_ERR(drv,
1307bfcc09ddSBjoern A. Zeeb 					"phy integration str ignored, already exists\n");
1308bfcc09ddSBjoern A. Zeeb 				break;
1309bfcc09ddSBjoern A. Zeeb 			}
1310bfcc09ddSBjoern A. Zeeb 
1311bfcc09ddSBjoern A. Zeeb 			drv->fw.phy_integration_ver =
1312bfcc09ddSBjoern A. Zeeb 				kmemdup(tlv_data, tlv_len, GFP_KERNEL);
1313bfcc09ddSBjoern A. Zeeb 			if (!drv->fw.phy_integration_ver)
1314bfcc09ddSBjoern A. Zeeb 				return -ENOMEM;
1315bfcc09ddSBjoern A. Zeeb 			drv->fw.phy_integration_ver_len = tlv_len;
1316bfcc09ddSBjoern A. Zeeb 			break;
1317bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_SEC_TABLE_ADDR:
1318bfcc09ddSBjoern A. Zeeb 		case IWL_UCODE_TLV_D3_KEK_KCK_ADDR:
1319bfcc09ddSBjoern A. Zeeb 			iwl_drv_set_dump_exclude(drv, tlv_type,
1320bfcc09ddSBjoern A. Zeeb 						 tlv_data, tlv_len);
1321bfcc09ddSBjoern A. Zeeb 			break;
13229af1bba4SBjoern A. Zeeb 		case IWL_UCODE_TLV_CURRENT_PC:
13239af1bba4SBjoern A. Zeeb 			if (tlv_len < sizeof(struct iwl_pc_data))
13249af1bba4SBjoern A. Zeeb 				goto invalid_tlv_len;
13259af1bba4SBjoern A. Zeeb 			drv->trans->dbg.pc_data =
13269af1bba4SBjoern A. Zeeb 				kmemdup(tlv_data, tlv_len, GFP_KERNEL);
1327a4128aadSBjoern A. Zeeb 			if (!drv->trans->dbg.pc_data)
1328a4128aadSBjoern A. Zeeb 				return -ENOMEM;
1329a4128aadSBjoern A. Zeeb 			drv->trans->dbg.num_pc =
1330a4128aadSBjoern A. Zeeb 				tlv_len / sizeof(struct iwl_pc_data);
13319af1bba4SBjoern A. Zeeb 			break;
1332bfcc09ddSBjoern A. Zeeb 		default:
1333bfcc09ddSBjoern A. Zeeb 			IWL_DEBUG_INFO(drv, "unknown TLV: %d\n", tlv_type);
1334bfcc09ddSBjoern A. Zeeb 			break;
1335bfcc09ddSBjoern A. Zeeb 		}
1336bfcc09ddSBjoern A. Zeeb 	}
1337bfcc09ddSBjoern A. Zeeb 
1338bfcc09ddSBjoern A. Zeeb 	if (!fw_has_capa(capa, IWL_UCODE_TLV_CAPA_USNIFFER_UNIFIED) &&
1339bfcc09ddSBjoern A. Zeeb 	    usniffer_req && !*usniffer_images) {
1340bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv,
1341bfcc09ddSBjoern A. Zeeb 			"user selected to work with usniffer but usniffer image isn't available in ucode package\n");
1342bfcc09ddSBjoern A. Zeeb 		return -EINVAL;
1343bfcc09ddSBjoern A. Zeeb 	}
1344bfcc09ddSBjoern A. Zeeb 
1345bfcc09ddSBjoern A. Zeeb 	if (len) {
1346bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv, "invalid TLV after parsing: %zd\n", len);
1347d9836fb4SBjoern A. Zeeb #if defined(__linux__)
1348d9836fb4SBjoern A. Zeeb 		iwl_print_hex_dump(drv, IWL_DL_FW, data, len);
1349d9836fb4SBjoern A. Zeeb #elif defined(__FreeBSD__)
1350bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
1351d9836fb4SBjoern A. Zeeb 		iwl_print_hex_dump(drv, IWL_DL_FW, "TLV ", data, len);
1352d9836fb4SBjoern A. Zeeb #endif
1353bfcc09ddSBjoern A. Zeeb #endif
1354bfcc09ddSBjoern A. Zeeb 		return -EINVAL;
1355bfcc09ddSBjoern A. Zeeb 	}
1356bfcc09ddSBjoern A. Zeeb 
1357bfcc09ddSBjoern A. Zeeb 	return 0;
1358bfcc09ddSBjoern A. Zeeb 
1359bfcc09ddSBjoern A. Zeeb  invalid_tlv_len:
1360bfcc09ddSBjoern A. Zeeb 	IWL_ERR(drv, "TLV %d has invalid size: %u\n", tlv_type, tlv_len);
1361bfcc09ddSBjoern A. Zeeb  tlv_error:
1362d9836fb4SBjoern A. Zeeb #if defined(__linux__)
1363d9836fb4SBjoern A. Zeeb 	iwl_print_hex_dump(drv, IWL_DL_FW, tlv_data, tlv_len);
1364d9836fb4SBjoern A. Zeeb #elif defined(__FreeBSD__)
1365bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
1366bfcc09ddSBjoern A. Zeeb 	iwl_print_hex_dump(drv, IWL_DL_FW, "TLV ", tlv_data, tlv_len);
1367bfcc09ddSBjoern A. Zeeb #endif
1368d9836fb4SBjoern A. Zeeb #endif
1369bfcc09ddSBjoern A. Zeeb 
1370bfcc09ddSBjoern A. Zeeb 	return -EINVAL;
1371bfcc09ddSBjoern A. Zeeb }
1372bfcc09ddSBjoern A. Zeeb 
iwl_alloc_ucode(struct iwl_drv * drv,struct iwl_firmware_pieces * pieces,enum iwl_ucode_type type)1373bfcc09ddSBjoern A. Zeeb static int iwl_alloc_ucode(struct iwl_drv *drv,
1374bfcc09ddSBjoern A. Zeeb 			   struct iwl_firmware_pieces *pieces,
1375bfcc09ddSBjoern A. Zeeb 			   enum iwl_ucode_type type)
1376bfcc09ddSBjoern A. Zeeb {
1377bfcc09ddSBjoern A. Zeeb 	int i;
1378bfcc09ddSBjoern A. Zeeb 	struct fw_desc *sec;
1379bfcc09ddSBjoern A. Zeeb 
1380bfcc09ddSBjoern A. Zeeb 	sec = kcalloc(pieces->img[type].sec_counter, sizeof(*sec), GFP_KERNEL);
1381bfcc09ddSBjoern A. Zeeb 	if (!sec)
1382bfcc09ddSBjoern A. Zeeb 		return -ENOMEM;
1383bfcc09ddSBjoern A. Zeeb 	drv->fw.img[type].sec = sec;
1384bfcc09ddSBjoern A. Zeeb 	drv->fw.img[type].num_sec = pieces->img[type].sec_counter;
1385bfcc09ddSBjoern A. Zeeb 
1386bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < pieces->img[type].sec_counter; i++)
1387bfcc09ddSBjoern A. Zeeb 		if (iwl_alloc_fw_desc(drv, &sec[i], get_sec(pieces, type, i)))
1388bfcc09ddSBjoern A. Zeeb 			return -ENOMEM;
1389bfcc09ddSBjoern A. Zeeb 
1390bfcc09ddSBjoern A. Zeeb 	return 0;
1391bfcc09ddSBjoern A. Zeeb }
1392bfcc09ddSBjoern A. Zeeb 
validate_sec_sizes(struct iwl_drv * drv,struct iwl_firmware_pieces * pieces,const struct iwl_cfg * cfg)1393bfcc09ddSBjoern A. Zeeb static int validate_sec_sizes(struct iwl_drv *drv,
1394bfcc09ddSBjoern A. Zeeb 			      struct iwl_firmware_pieces *pieces,
1395bfcc09ddSBjoern A. Zeeb 			      const struct iwl_cfg *cfg)
1396bfcc09ddSBjoern A. Zeeb {
1397bfcc09ddSBjoern A. Zeeb 	IWL_DEBUG_INFO(drv, "f/w package hdr runtime inst size = %zd\n",
1398bfcc09ddSBjoern A. Zeeb 		get_sec_size(pieces, IWL_UCODE_REGULAR,
1399bfcc09ddSBjoern A. Zeeb 			     IWL_UCODE_SECTION_INST));
1400bfcc09ddSBjoern A. Zeeb 	IWL_DEBUG_INFO(drv, "f/w package hdr runtime data size = %zd\n",
1401bfcc09ddSBjoern A. Zeeb 		get_sec_size(pieces, IWL_UCODE_REGULAR,
1402bfcc09ddSBjoern A. Zeeb 			     IWL_UCODE_SECTION_DATA));
1403bfcc09ddSBjoern A. Zeeb 	IWL_DEBUG_INFO(drv, "f/w package hdr init inst size = %zd\n",
1404bfcc09ddSBjoern A. Zeeb 		get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST));
1405bfcc09ddSBjoern A. Zeeb 	IWL_DEBUG_INFO(drv, "f/w package hdr init data size = %zd\n",
1406bfcc09ddSBjoern A. Zeeb 		get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA));
1407bfcc09ddSBjoern A. Zeeb 
1408bfcc09ddSBjoern A. Zeeb 	/* Verify that uCode images will fit in card's SRAM. */
1409bfcc09ddSBjoern A. Zeeb 	if (get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_INST) >
1410bfcc09ddSBjoern A. Zeeb 	    cfg->max_inst_size) {
1411bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv, "uCode instr len %zd too large to fit in\n",
1412bfcc09ddSBjoern A. Zeeb 			get_sec_size(pieces, IWL_UCODE_REGULAR,
1413bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_INST));
1414bfcc09ddSBjoern A. Zeeb 		return -1;
1415bfcc09ddSBjoern A. Zeeb 	}
1416bfcc09ddSBjoern A. Zeeb 
1417bfcc09ddSBjoern A. Zeeb 	if (get_sec_size(pieces, IWL_UCODE_REGULAR, IWL_UCODE_SECTION_DATA) >
1418bfcc09ddSBjoern A. Zeeb 	    cfg->max_data_size) {
1419bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv, "uCode data len %zd too large to fit in\n",
1420bfcc09ddSBjoern A. Zeeb 			get_sec_size(pieces, IWL_UCODE_REGULAR,
1421bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_DATA));
1422bfcc09ddSBjoern A. Zeeb 		return -1;
1423bfcc09ddSBjoern A. Zeeb 	}
1424bfcc09ddSBjoern A. Zeeb 
1425bfcc09ddSBjoern A. Zeeb 	if (get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_INST) >
1426bfcc09ddSBjoern A. Zeeb 	     cfg->max_inst_size) {
1427bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv, "uCode init instr len %zd too large to fit in\n",
1428bfcc09ddSBjoern A. Zeeb 			get_sec_size(pieces, IWL_UCODE_INIT,
1429bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_INST));
1430bfcc09ddSBjoern A. Zeeb 		return -1;
1431bfcc09ddSBjoern A. Zeeb 	}
1432bfcc09ddSBjoern A. Zeeb 
1433bfcc09ddSBjoern A. Zeeb 	if (get_sec_size(pieces, IWL_UCODE_INIT, IWL_UCODE_SECTION_DATA) >
1434bfcc09ddSBjoern A. Zeeb 	    cfg->max_data_size) {
1435bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv, "uCode init data len %zd too large to fit in\n",
1436bfcc09ddSBjoern A. Zeeb 			get_sec_size(pieces, IWL_UCODE_REGULAR,
1437bfcc09ddSBjoern A. Zeeb 				     IWL_UCODE_SECTION_DATA));
1438bfcc09ddSBjoern A. Zeeb 		return -1;
1439bfcc09ddSBjoern A. Zeeb 	}
1440bfcc09ddSBjoern A. Zeeb 	return 0;
1441bfcc09ddSBjoern A. Zeeb }
1442bfcc09ddSBjoern A. Zeeb 
1443bfcc09ddSBjoern A. Zeeb static struct iwl_op_mode *
_iwl_op_mode_start(struct iwl_drv * drv,struct iwlwifi_opmode_table * op)1444bfcc09ddSBjoern A. Zeeb _iwl_op_mode_start(struct iwl_drv *drv, struct iwlwifi_opmode_table *op)
1445bfcc09ddSBjoern A. Zeeb {
1446bfcc09ddSBjoern A. Zeeb 	const struct iwl_op_mode_ops *ops = op->ops;
1447bfcc09ddSBjoern A. Zeeb 	struct dentry *dbgfs_dir = NULL;
1448bfcc09ddSBjoern A. Zeeb 	struct iwl_op_mode *op_mode = NULL;
1449d9836fb4SBjoern A. Zeeb 
1450a4128aadSBjoern A. Zeeb 	/* also protects start/stop from racing against each other */
1451a4128aadSBjoern A. Zeeb 	lockdep_assert_held(&iwlwifi_opmode_table_mtx);
1452bfcc09ddSBjoern A. Zeeb 
1453bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
1454bfcc09ddSBjoern A. Zeeb 	drv->dbgfs_op_mode = debugfs_create_dir(op->name,
1455bfcc09ddSBjoern A. Zeeb 						drv->dbgfs_drv);
1456bfcc09ddSBjoern A. Zeeb 	dbgfs_dir = drv->dbgfs_op_mode;
1457bfcc09ddSBjoern A. Zeeb #endif
1458bfcc09ddSBjoern A. Zeeb 
1459d9836fb4SBjoern A. Zeeb 	op_mode = ops->start(drv->trans, drv->trans->cfg,
1460d9836fb4SBjoern A. Zeeb 			     &drv->fw, dbgfs_dir);
1461d9836fb4SBjoern A. Zeeb 	if (op_mode)
1462d9836fb4SBjoern A. Zeeb 		return op_mode;
1463d9836fb4SBjoern A. Zeeb 
1464bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
1465bfcc09ddSBjoern A. Zeeb 	debugfs_remove_recursive(drv->dbgfs_op_mode);
1466bfcc09ddSBjoern A. Zeeb 	drv->dbgfs_op_mode = NULL;
1467bfcc09ddSBjoern A. Zeeb #endif
1468bfcc09ddSBjoern A. Zeeb 
1469d9836fb4SBjoern A. Zeeb 	return NULL;
1470bfcc09ddSBjoern A. Zeeb }
1471bfcc09ddSBjoern A. Zeeb 
_iwl_op_mode_stop(struct iwl_drv * drv)1472bfcc09ddSBjoern A. Zeeb static void _iwl_op_mode_stop(struct iwl_drv *drv)
1473bfcc09ddSBjoern A. Zeeb {
1474a4128aadSBjoern A. Zeeb 	/* also protects start/stop from racing against each other */
1475a4128aadSBjoern A. Zeeb 	lockdep_assert_held(&iwlwifi_opmode_table_mtx);
1476a4128aadSBjoern A. Zeeb 
1477bfcc09ddSBjoern A. Zeeb 	/* op_mode can be NULL if its start failed */
1478bfcc09ddSBjoern A. Zeeb 	if (drv->op_mode) {
1479bfcc09ddSBjoern A. Zeeb 		iwl_op_mode_stop(drv->op_mode);
1480bfcc09ddSBjoern A. Zeeb 		drv->op_mode = NULL;
1481bfcc09ddSBjoern A. Zeeb 
1482bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
1483bfcc09ddSBjoern A. Zeeb 		debugfs_remove_recursive(drv->dbgfs_op_mode);
1484bfcc09ddSBjoern A. Zeeb 		drv->dbgfs_op_mode = NULL;
1485bfcc09ddSBjoern A. Zeeb #endif
1486bfcc09ddSBjoern A. Zeeb 	}
1487bfcc09ddSBjoern A. Zeeb }
1488bfcc09ddSBjoern A. Zeeb 
1489bfcc09ddSBjoern A. Zeeb /*
1490bfcc09ddSBjoern A. Zeeb  * iwl_req_fw_callback - callback when firmware was loaded
1491bfcc09ddSBjoern A. Zeeb  *
1492bfcc09ddSBjoern A. Zeeb  * If loaded successfully, copies the firmware into buffers
1493bfcc09ddSBjoern A. Zeeb  * for the card to fetch (via DMA).
1494bfcc09ddSBjoern A. Zeeb  */
iwl_req_fw_callback(const struct firmware * ucode_raw,void * context)1495bfcc09ddSBjoern A. Zeeb static void iwl_req_fw_callback(const struct firmware *ucode_raw, void *context)
1496bfcc09ddSBjoern A. Zeeb {
1497bfcc09ddSBjoern A. Zeeb 	struct iwl_drv *drv = context;
1498bfcc09ddSBjoern A. Zeeb 	struct iwl_fw *fw = &drv->fw;
1499bfcc09ddSBjoern A. Zeeb 	const struct iwl_ucode_header *ucode;
1500bfcc09ddSBjoern A. Zeeb 	struct iwlwifi_opmode_table *op;
1501bfcc09ddSBjoern A. Zeeb 	int err;
1502bfcc09ddSBjoern A. Zeeb 	struct iwl_firmware_pieces *pieces;
1503bfcc09ddSBjoern A. Zeeb 	const unsigned int api_max = drv->trans->cfg->ucode_api_max;
1504bfcc09ddSBjoern A. Zeeb 	const unsigned int api_min = drv->trans->cfg->ucode_api_min;
1505bfcc09ddSBjoern A. Zeeb 	size_t trigger_tlv_sz[FW_DBG_TRIGGER_MAX];
1506bfcc09ddSBjoern A. Zeeb 	u32 api_ver;
1507bfcc09ddSBjoern A. Zeeb 	int i;
1508bfcc09ddSBjoern A. Zeeb 	bool usniffer_images = false;
1509d9836fb4SBjoern A. Zeeb 	bool failure = true;
1510bfcc09ddSBjoern A. Zeeb 
1511bfcc09ddSBjoern A. Zeeb 	fw->ucode_capa.max_probe_length = IWL_DEFAULT_MAX_PROBE_LENGTH;
1512bfcc09ddSBjoern A. Zeeb 	fw->ucode_capa.standard_phy_calibration_size =
1513bfcc09ddSBjoern A. Zeeb 			IWL_DEFAULT_STANDARD_PHY_CALIBRATE_TBL_SIZE;
1514bfcc09ddSBjoern A. Zeeb 	fw->ucode_capa.n_scan_channels = IWL_DEFAULT_SCAN_CHANNELS;
1515bfcc09ddSBjoern A. Zeeb 	fw->ucode_capa.num_stations = IWL_MVM_STATION_COUNT_MAX;
15169af1bba4SBjoern A. Zeeb 	fw->ucode_capa.num_beacons = 1;
1517bfcc09ddSBjoern A. Zeeb 	/* dump all fw memory areas by default */
1518bfcc09ddSBjoern A. Zeeb 	fw->dbg.dump_mask = 0xffffffff;
1519bfcc09ddSBjoern A. Zeeb 
1520bfcc09ddSBjoern A. Zeeb 	pieces = kzalloc(sizeof(*pieces), GFP_KERNEL);
1521bfcc09ddSBjoern A. Zeeb 	if (!pieces)
1522bfcc09ddSBjoern A. Zeeb 		goto out_free_fw;
1523bfcc09ddSBjoern A. Zeeb 
1524bfcc09ddSBjoern A. Zeeb 	if (!ucode_raw)
1525bfcc09ddSBjoern A. Zeeb 		goto try_again;
1526bfcc09ddSBjoern A. Zeeb 
1527bfcc09ddSBjoern A. Zeeb 	IWL_DEBUG_FW_INFO(drv, "Loaded firmware file '%s' (%zd bytes).\n",
1528bfcc09ddSBjoern A. Zeeb 			  drv->firmware_name, ucode_raw->size);
1529bfcc09ddSBjoern A. Zeeb 
1530bfcc09ddSBjoern A. Zeeb 	/* Make sure that we got at least the API version number */
1531bfcc09ddSBjoern A. Zeeb 	if (ucode_raw->size < 4) {
1532bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv, "File size way too small!\n");
1533bfcc09ddSBjoern A. Zeeb 		goto try_again;
1534bfcc09ddSBjoern A. Zeeb 	}
1535bfcc09ddSBjoern A. Zeeb 
1536bfcc09ddSBjoern A. Zeeb 	/* Data from ucode file:  header followed by uCode images */
1537bfcc09ddSBjoern A. Zeeb 	ucode = (const struct iwl_ucode_header *)ucode_raw->data;
1538bfcc09ddSBjoern A. Zeeb 
1539bfcc09ddSBjoern A. Zeeb 	if (ucode->ver)
1540bfcc09ddSBjoern A. Zeeb 		err = iwl_parse_v1_v2_firmware(drv, ucode_raw, pieces);
1541bfcc09ddSBjoern A. Zeeb 	else
1542bfcc09ddSBjoern A. Zeeb 		err = iwl_parse_tlv_firmware(drv, ucode_raw, pieces,
1543bfcc09ddSBjoern A. Zeeb 					     &fw->ucode_capa, &usniffer_images);
1544bfcc09ddSBjoern A. Zeeb 
1545bfcc09ddSBjoern A. Zeeb 	if (err)
1546bfcc09ddSBjoern A. Zeeb 		goto try_again;
1547bfcc09ddSBjoern A. Zeeb 
1548bfcc09ddSBjoern A. Zeeb 	if (fw_has_api(&drv->fw.ucode_capa, IWL_UCODE_TLV_API_NEW_VERSION))
1549bfcc09ddSBjoern A. Zeeb 		api_ver = drv->fw.ucode_ver;
1550bfcc09ddSBjoern A. Zeeb 	else
1551bfcc09ddSBjoern A. Zeeb 		api_ver = IWL_UCODE_API(drv->fw.ucode_ver);
1552bfcc09ddSBjoern A. Zeeb 
1553bfcc09ddSBjoern A. Zeeb 	/*
1554bfcc09ddSBjoern A. Zeeb 	 * api_ver should match the api version forming part of the
1555bfcc09ddSBjoern A. Zeeb 	 * firmware filename ... but we don't check for that and only rely
1556bfcc09ddSBjoern A. Zeeb 	 * on the API version read from firmware header from here on forward
1557bfcc09ddSBjoern A. Zeeb 	 */
1558bfcc09ddSBjoern A. Zeeb 	if (api_ver < api_min || api_ver > api_max) {
1559bfcc09ddSBjoern A. Zeeb 		IWL_ERR(drv,
1560bfcc09ddSBjoern A. Zeeb 			"Driver unable to support your firmware API. "
1561bfcc09ddSBjoern A. Zeeb 			"Driver supports v%u, firmware is v%u.\n",
1562bfcc09ddSBjoern A. Zeeb 			api_max, api_ver);
1563bfcc09ddSBjoern A. Zeeb 		goto try_again;
1564bfcc09ddSBjoern A. Zeeb 	}
1565bfcc09ddSBjoern A. Zeeb 
1566bfcc09ddSBjoern A. Zeeb 	/*
1567bfcc09ddSBjoern A. Zeeb 	 * In mvm uCode there is no difference between data and instructions
1568bfcc09ddSBjoern A. Zeeb 	 * sections.
1569bfcc09ddSBjoern A. Zeeb 	 */
1570bfcc09ddSBjoern A. Zeeb 	if (fw->type == IWL_FW_DVM && validate_sec_sizes(drv, pieces,
1571bfcc09ddSBjoern A. Zeeb 							 drv->trans->cfg))
1572bfcc09ddSBjoern A. Zeeb 		goto try_again;
1573bfcc09ddSBjoern A. Zeeb 
1574bfcc09ddSBjoern A. Zeeb 	/* Allocate ucode buffers for card's bus-master loading ... */
1575bfcc09ddSBjoern A. Zeeb 
1576bfcc09ddSBjoern A. Zeeb 	/* Runtime instructions and 2 copies of data:
1577bfcc09ddSBjoern A. Zeeb 	 * 1) unmodified from disk
1578bfcc09ddSBjoern A. Zeeb 	 * 2) backup cache for save/restore during power-downs
1579bfcc09ddSBjoern A. Zeeb 	 */
1580bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < IWL_UCODE_TYPE_MAX; i++)
1581bfcc09ddSBjoern A. Zeeb 		if (iwl_alloc_ucode(drv, pieces, i))
1582bfcc09ddSBjoern A. Zeeb 			goto out_free_fw;
1583bfcc09ddSBjoern A. Zeeb 
1584bfcc09ddSBjoern A. Zeeb 	if (pieces->dbg_dest_tlv_init) {
1585bfcc09ddSBjoern A. Zeeb 		size_t dbg_dest_size = sizeof(*drv->fw.dbg.dest_tlv) +
1586bfcc09ddSBjoern A. Zeeb 			sizeof(drv->fw.dbg.dest_tlv->reg_ops[0]) *
1587bfcc09ddSBjoern A. Zeeb 			drv->fw.dbg.n_dest_reg;
1588bfcc09ddSBjoern A. Zeeb 
1589bfcc09ddSBjoern A. Zeeb 		drv->fw.dbg.dest_tlv = kmalloc(dbg_dest_size, GFP_KERNEL);
1590bfcc09ddSBjoern A. Zeeb 
1591bfcc09ddSBjoern A. Zeeb 		if (!drv->fw.dbg.dest_tlv)
1592bfcc09ddSBjoern A. Zeeb 			goto out_free_fw;
1593bfcc09ddSBjoern A. Zeeb 
1594bfcc09ddSBjoern A. Zeeb 		if (*pieces->dbg_dest_ver == 0) {
1595bfcc09ddSBjoern A. Zeeb 			memcpy(drv->fw.dbg.dest_tlv, pieces->dbg_dest_tlv_v1,
1596bfcc09ddSBjoern A. Zeeb 			       dbg_dest_size);
1597bfcc09ddSBjoern A. Zeeb 		} else {
1598bfcc09ddSBjoern A. Zeeb 			struct iwl_fw_dbg_dest_tlv_v1 *dest_tlv =
1599bfcc09ddSBjoern A. Zeeb 				drv->fw.dbg.dest_tlv;
1600bfcc09ddSBjoern A. Zeeb 
1601bfcc09ddSBjoern A. Zeeb 			dest_tlv->version = pieces->dbg_dest_tlv->version;
1602bfcc09ddSBjoern A. Zeeb 			dest_tlv->monitor_mode =
1603bfcc09ddSBjoern A. Zeeb 				pieces->dbg_dest_tlv->monitor_mode;
1604bfcc09ddSBjoern A. Zeeb 			dest_tlv->size_power =
1605bfcc09ddSBjoern A. Zeeb 				pieces->dbg_dest_tlv->size_power;
1606bfcc09ddSBjoern A. Zeeb 			dest_tlv->wrap_count =
1607bfcc09ddSBjoern A. Zeeb 				pieces->dbg_dest_tlv->wrap_count;
1608bfcc09ddSBjoern A. Zeeb 			dest_tlv->write_ptr_reg =
1609bfcc09ddSBjoern A. Zeeb 				pieces->dbg_dest_tlv->write_ptr_reg;
1610bfcc09ddSBjoern A. Zeeb 			dest_tlv->base_shift =
1611bfcc09ddSBjoern A. Zeeb 				pieces->dbg_dest_tlv->base_shift;
1612bfcc09ddSBjoern A. Zeeb 			memcpy(dest_tlv->reg_ops,
1613bfcc09ddSBjoern A. Zeeb 			       pieces->dbg_dest_tlv->reg_ops,
1614bfcc09ddSBjoern A. Zeeb 			       sizeof(drv->fw.dbg.dest_tlv->reg_ops[0]) *
1615bfcc09ddSBjoern A. Zeeb 			       drv->fw.dbg.n_dest_reg);
1616bfcc09ddSBjoern A. Zeeb 
1617bfcc09ddSBjoern A. Zeeb 			/* In version 1 of the destination tlv, which is
1618bfcc09ddSBjoern A. Zeeb 			 * relevant for internal buffer exclusively,
1619bfcc09ddSBjoern A. Zeeb 			 * the base address is part of given with the length
1620bfcc09ddSBjoern A. Zeeb 			 * of the buffer, and the size shift is give instead of
1621bfcc09ddSBjoern A. Zeeb 			 * end shift. We now store these values in base_reg,
1622bfcc09ddSBjoern A. Zeeb 			 * and end shift, and when dumping the data we'll
1623bfcc09ddSBjoern A. Zeeb 			 * manipulate it for extracting both the length and
1624bfcc09ddSBjoern A. Zeeb 			 * base address */
1625bfcc09ddSBjoern A. Zeeb 			dest_tlv->base_reg = pieces->dbg_dest_tlv->cfg_reg;
1626bfcc09ddSBjoern A. Zeeb 			dest_tlv->end_shift =
1627bfcc09ddSBjoern A. Zeeb 				pieces->dbg_dest_tlv->size_shift;
1628bfcc09ddSBjoern A. Zeeb 		}
1629bfcc09ddSBjoern A. Zeeb 	}
1630bfcc09ddSBjoern A. Zeeb 
1631bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < ARRAY_SIZE(drv->fw.dbg.conf_tlv); i++) {
1632bfcc09ddSBjoern A. Zeeb 		if (pieces->dbg_conf_tlv[i]) {
1633bfcc09ddSBjoern A. Zeeb 			drv->fw.dbg.conf_tlv[i] =
1634bfcc09ddSBjoern A. Zeeb 				kmemdup(pieces->dbg_conf_tlv[i],
1635bfcc09ddSBjoern A. Zeeb 					pieces->dbg_conf_tlv_len[i],
1636bfcc09ddSBjoern A. Zeeb 					GFP_KERNEL);
1637bfcc09ddSBjoern A. Zeeb 			if (!drv->fw.dbg.conf_tlv[i])
1638bfcc09ddSBjoern A. Zeeb 				goto out_free_fw;
1639bfcc09ddSBjoern A. Zeeb 		}
1640bfcc09ddSBjoern A. Zeeb 	}
1641bfcc09ddSBjoern A. Zeeb 
1642bfcc09ddSBjoern A. Zeeb 	memset(&trigger_tlv_sz, 0xff, sizeof(trigger_tlv_sz));
1643bfcc09ddSBjoern A. Zeeb 
1644bfcc09ddSBjoern A. Zeeb 	trigger_tlv_sz[FW_DBG_TRIGGER_MISSED_BEACONS] =
1645bfcc09ddSBjoern A. Zeeb 		sizeof(struct iwl_fw_dbg_trigger_missed_bcon);
1646bfcc09ddSBjoern A. Zeeb 	trigger_tlv_sz[FW_DBG_TRIGGER_CHANNEL_SWITCH] = 0;
1647bfcc09ddSBjoern A. Zeeb 	trigger_tlv_sz[FW_DBG_TRIGGER_FW_NOTIF] =
1648bfcc09ddSBjoern A. Zeeb 		sizeof(struct iwl_fw_dbg_trigger_cmd);
1649bfcc09ddSBjoern A. Zeeb 	trigger_tlv_sz[FW_DBG_TRIGGER_MLME] =
1650bfcc09ddSBjoern A. Zeeb 		sizeof(struct iwl_fw_dbg_trigger_mlme);
1651bfcc09ddSBjoern A. Zeeb 	trigger_tlv_sz[FW_DBG_TRIGGER_STATS] =
1652bfcc09ddSBjoern A. Zeeb 		sizeof(struct iwl_fw_dbg_trigger_stats);
1653bfcc09ddSBjoern A. Zeeb 	trigger_tlv_sz[FW_DBG_TRIGGER_RSSI] =
1654bfcc09ddSBjoern A. Zeeb 		sizeof(struct iwl_fw_dbg_trigger_low_rssi);
1655bfcc09ddSBjoern A. Zeeb 	trigger_tlv_sz[FW_DBG_TRIGGER_TXQ_TIMERS] =
1656bfcc09ddSBjoern A. Zeeb 		sizeof(struct iwl_fw_dbg_trigger_txq_timer);
1657bfcc09ddSBjoern A. Zeeb 	trigger_tlv_sz[FW_DBG_TRIGGER_TIME_EVENT] =
1658bfcc09ddSBjoern A. Zeeb 		sizeof(struct iwl_fw_dbg_trigger_time_event);
1659bfcc09ddSBjoern A. Zeeb 	trigger_tlv_sz[FW_DBG_TRIGGER_BA] =
1660bfcc09ddSBjoern A. Zeeb 		sizeof(struct iwl_fw_dbg_trigger_ba);
1661bfcc09ddSBjoern A. Zeeb 	trigger_tlv_sz[FW_DBG_TRIGGER_TDLS] =
1662bfcc09ddSBjoern A. Zeeb 		sizeof(struct iwl_fw_dbg_trigger_tdls);
1663bfcc09ddSBjoern A. Zeeb 
1664bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < ARRAY_SIZE(drv->fw.dbg.trigger_tlv); i++) {
1665bfcc09ddSBjoern A. Zeeb 		if (pieces->dbg_trigger_tlv[i]) {
1666bfcc09ddSBjoern A. Zeeb 			/*
1667bfcc09ddSBjoern A. Zeeb 			 * If the trigger isn't long enough, WARN and exit.
1668bfcc09ddSBjoern A. Zeeb 			 * Someone is trying to debug something and he won't
1669bfcc09ddSBjoern A. Zeeb 			 * be able to catch the bug he is trying to chase.
1670bfcc09ddSBjoern A. Zeeb 			 * We'd better be noisy to be sure he knows what's
1671bfcc09ddSBjoern A. Zeeb 			 * going on.
1672bfcc09ddSBjoern A. Zeeb 			 */
1673bfcc09ddSBjoern A. Zeeb 			if (WARN_ON(pieces->dbg_trigger_tlv_len[i] <
1674bfcc09ddSBjoern A. Zeeb 				    (trigger_tlv_sz[i] +
1675bfcc09ddSBjoern A. Zeeb 				     sizeof(struct iwl_fw_dbg_trigger_tlv))))
1676bfcc09ddSBjoern A. Zeeb 				goto out_free_fw;
1677bfcc09ddSBjoern A. Zeeb 			drv->fw.dbg.trigger_tlv_len[i] =
1678bfcc09ddSBjoern A. Zeeb 				pieces->dbg_trigger_tlv_len[i];
1679bfcc09ddSBjoern A. Zeeb 			drv->fw.dbg.trigger_tlv[i] =
1680bfcc09ddSBjoern A. Zeeb 				kmemdup(pieces->dbg_trigger_tlv[i],
1681bfcc09ddSBjoern A. Zeeb 					drv->fw.dbg.trigger_tlv_len[i],
1682bfcc09ddSBjoern A. Zeeb 					GFP_KERNEL);
1683bfcc09ddSBjoern A. Zeeb 			if (!drv->fw.dbg.trigger_tlv[i])
1684bfcc09ddSBjoern A. Zeeb 				goto out_free_fw;
1685bfcc09ddSBjoern A. Zeeb 		}
1686bfcc09ddSBjoern A. Zeeb 	}
1687bfcc09ddSBjoern A. Zeeb 
1688bfcc09ddSBjoern A. Zeeb 	/* Now that we can no longer fail, copy information */
1689bfcc09ddSBjoern A. Zeeb 
1690bfcc09ddSBjoern A. Zeeb 	drv->fw.dbg.mem_tlv = pieces->dbg_mem_tlv;
1691bfcc09ddSBjoern A. Zeeb 	pieces->dbg_mem_tlv = NULL;
1692bfcc09ddSBjoern A. Zeeb 	drv->fw.dbg.n_mem_tlv = pieces->n_mem_tlv;
1693bfcc09ddSBjoern A. Zeeb 
1694bfcc09ddSBjoern A. Zeeb 	/*
1695bfcc09ddSBjoern A. Zeeb 	 * The (size - 16) / 12 formula is based on the information recorded
1696bfcc09ddSBjoern A. Zeeb 	 * for each event, which is of mode 1 (including timestamp) for all
1697bfcc09ddSBjoern A. Zeeb 	 * new microcodes that include this information.
1698bfcc09ddSBjoern A. Zeeb 	 */
1699bfcc09ddSBjoern A. Zeeb 	fw->init_evtlog_ptr = pieces->init_evtlog_ptr;
1700bfcc09ddSBjoern A. Zeeb 	if (pieces->init_evtlog_size)
1701bfcc09ddSBjoern A. Zeeb 		fw->init_evtlog_size = (pieces->init_evtlog_size - 16)/12;
1702bfcc09ddSBjoern A. Zeeb 	else
1703bfcc09ddSBjoern A. Zeeb 		fw->init_evtlog_size =
1704bfcc09ddSBjoern A. Zeeb 			drv->trans->trans_cfg->base_params->max_event_log_size;
1705bfcc09ddSBjoern A. Zeeb 	fw->init_errlog_ptr = pieces->init_errlog_ptr;
1706bfcc09ddSBjoern A. Zeeb 	fw->inst_evtlog_ptr = pieces->inst_evtlog_ptr;
1707bfcc09ddSBjoern A. Zeeb 	if (pieces->inst_evtlog_size)
1708bfcc09ddSBjoern A. Zeeb 		fw->inst_evtlog_size = (pieces->inst_evtlog_size - 16)/12;
1709bfcc09ddSBjoern A. Zeeb 	else
1710bfcc09ddSBjoern A. Zeeb 		fw->inst_evtlog_size =
1711bfcc09ddSBjoern A. Zeeb 			drv->trans->trans_cfg->base_params->max_event_log_size;
1712bfcc09ddSBjoern A. Zeeb 	fw->inst_errlog_ptr = pieces->inst_errlog_ptr;
1713bfcc09ddSBjoern A. Zeeb 
1714bfcc09ddSBjoern A. Zeeb 	/*
1715bfcc09ddSBjoern A. Zeeb 	 * figure out the offset of chain noise reset and gain commands
1716bfcc09ddSBjoern A. Zeeb 	 * base on the size of standard phy calibration commands table size
1717bfcc09ddSBjoern A. Zeeb 	 */
1718bfcc09ddSBjoern A. Zeeb 	if (fw->ucode_capa.standard_phy_calibration_size >
1719bfcc09ddSBjoern A. Zeeb 	    IWL_MAX_PHY_CALIBRATE_TBL_SIZE)
1720bfcc09ddSBjoern A. Zeeb 		fw->ucode_capa.standard_phy_calibration_size =
1721bfcc09ddSBjoern A. Zeeb 			IWL_MAX_STANDARD_PHY_CALIBRATE_TBL_SIZE;
1722bfcc09ddSBjoern A. Zeeb 
1723bfcc09ddSBjoern A. Zeeb 	/* We have our copies now, allow OS release its copies */
1724bfcc09ddSBjoern A. Zeeb 	release_firmware(ucode_raw);
1725bfcc09ddSBjoern A. Zeeb 
1726d9836fb4SBjoern A. Zeeb 	iwl_dbg_tlv_load_bin(drv->trans->dev, drv->trans);
1727d9836fb4SBjoern A. Zeeb 
1728bfcc09ddSBjoern A. Zeeb 	mutex_lock(&iwlwifi_opmode_table_mtx);
1729bfcc09ddSBjoern A. Zeeb 	switch (fw->type) {
1730bfcc09ddSBjoern A. Zeeb 	case IWL_FW_DVM:
1731bfcc09ddSBjoern A. Zeeb 		op = &iwlwifi_opmode_table[DVM_OP_MODE];
1732bfcc09ddSBjoern A. Zeeb 		break;
1733bfcc09ddSBjoern A. Zeeb 	default:
1734bfcc09ddSBjoern A. Zeeb 		WARN(1, "Invalid fw type %d\n", fw->type);
1735bfcc09ddSBjoern A. Zeeb 		fallthrough;
1736bfcc09ddSBjoern A. Zeeb 	case IWL_FW_MVM:
1737bfcc09ddSBjoern A. Zeeb 		op = &iwlwifi_opmode_table[MVM_OP_MODE];
1738bfcc09ddSBjoern A. Zeeb 		break;
1739bfcc09ddSBjoern A. Zeeb 	}
1740bfcc09ddSBjoern A. Zeeb 
1741bfcc09ddSBjoern A. Zeeb 	IWL_INFO(drv, "loaded firmware version %s op_mode %s\n",
1742bfcc09ddSBjoern A. Zeeb 		 drv->fw.fw_version, op->name);
1743bfcc09ddSBjoern A. Zeeb 
1744bfcc09ddSBjoern A. Zeeb 	/* add this device to the list of devices using this op_mode */
1745bfcc09ddSBjoern A. Zeeb 	list_add_tail(&drv->list, &op->drv);
1746bfcc09ddSBjoern A. Zeeb 
1747bfcc09ddSBjoern A. Zeeb 	if (op->ops) {
1748bfcc09ddSBjoern A. Zeeb 		drv->op_mode = _iwl_op_mode_start(drv, op);
1749bfcc09ddSBjoern A. Zeeb 
1750bfcc09ddSBjoern A. Zeeb 		if (!drv->op_mode) {
1751bfcc09ddSBjoern A. Zeeb 			mutex_unlock(&iwlwifi_opmode_table_mtx);
1752bfcc09ddSBjoern A. Zeeb 			goto out_unbind;
1753bfcc09ddSBjoern A. Zeeb 		}
1754bfcc09ddSBjoern A. Zeeb 	} else {
175587e140a5SBjoern A. Zeeb #if defined(__linux__)
1756a4128aadSBjoern A. Zeeb 		request_module_nowait("%s", op->name);
175787e140a5SBjoern A. Zeeb #elif defined(__FreeBSD__)
175887e140a5SBjoern A. Zeeb 		/*
175987e140a5SBjoern A. Zeeb 		 * In FreeBSD if_iwlwifi contains all drv modules in a single
176087e140a5SBjoern A. Zeeb 		 * module.  SYSINIT will do the job later.  We cannot call
176187e140a5SBjoern A. Zeeb 		 * into kern_kldload() while being called from kern_kldload():
176287e140a5SBjoern A. Zeeb 		 * LinuxKPI request_module[_nowait] will hang hard.
176387e140a5SBjoern A. Zeeb 		 * Given this is request_module_nowait() we can simply skip it.
176487e140a5SBjoern A. Zeeb 		 */
176587e140a5SBjoern A. Zeeb 		if (bootverbose)
17665d09d107SBjoern A. Zeeb 			printf("%s: module '%s' not yet available; will be initialized in a moment\n",
17675d09d107SBjoern A. Zeeb 			    __func__, op->name);
176887e140a5SBjoern A. Zeeb #endif
1769bfcc09ddSBjoern A. Zeeb 	}
1770bfcc09ddSBjoern A. Zeeb 	mutex_unlock(&iwlwifi_opmode_table_mtx);
1771bfcc09ddSBjoern A. Zeeb 
1772bfcc09ddSBjoern A. Zeeb 	complete(&drv->request_firmware_complete);
1773bfcc09ddSBjoern A. Zeeb 
1774d9836fb4SBjoern A. Zeeb 	failure = false;
1775bfcc09ddSBjoern A. Zeeb 	goto free;
1776bfcc09ddSBjoern A. Zeeb 
1777bfcc09ddSBjoern A. Zeeb  try_again:
1778bfcc09ddSBjoern A. Zeeb 	/* try next, if any */
1779bfcc09ddSBjoern A. Zeeb 	release_firmware(ucode_raw);
1780bfcc09ddSBjoern A. Zeeb 	if (iwl_request_firmware(drv, false))
1781bfcc09ddSBjoern A. Zeeb 		goto out_unbind;
1782bfcc09ddSBjoern A. Zeeb 	goto free;
1783bfcc09ddSBjoern A. Zeeb 
1784bfcc09ddSBjoern A. Zeeb  out_free_fw:
1785bfcc09ddSBjoern A. Zeeb 	release_firmware(ucode_raw);
1786bfcc09ddSBjoern A. Zeeb  out_unbind:
1787bfcc09ddSBjoern A. Zeeb 	complete(&drv->request_firmware_complete);
1788bfcc09ddSBjoern A. Zeeb 	device_release_driver(drv->trans->dev);
1789fac1f593SBjoern A. Zeeb 	/* drv has just been freed by the release */
1790fac1f593SBjoern A. Zeeb 	failure = false;
1791bfcc09ddSBjoern A. Zeeb  free:
1792d9836fb4SBjoern A. Zeeb 	if (failure)
1793d9836fb4SBjoern A. Zeeb 		iwl_dealloc_ucode(drv);
1794d9836fb4SBjoern A. Zeeb 
1795bfcc09ddSBjoern A. Zeeb 	if (pieces) {
1796bfcc09ddSBjoern A. Zeeb 		for (i = 0; i < ARRAY_SIZE(pieces->img); i++)
1797bfcc09ddSBjoern A. Zeeb 			kfree(pieces->img[i].sec);
1798bfcc09ddSBjoern A. Zeeb 		kfree(pieces->dbg_mem_tlv);
1799bfcc09ddSBjoern A. Zeeb 		kfree(pieces);
1800bfcc09ddSBjoern A. Zeeb 	}
1801bfcc09ddSBjoern A. Zeeb }
1802bfcc09ddSBjoern A. Zeeb 
iwl_drv_start(struct iwl_trans * trans)1803bfcc09ddSBjoern A. Zeeb struct iwl_drv *iwl_drv_start(struct iwl_trans *trans)
1804bfcc09ddSBjoern A. Zeeb {
1805bfcc09ddSBjoern A. Zeeb 	struct iwl_drv *drv;
1806bfcc09ddSBjoern A. Zeeb 	int ret;
1807bfcc09ddSBjoern A. Zeeb 
1808bfcc09ddSBjoern A. Zeeb 	drv = kzalloc(sizeof(*drv), GFP_KERNEL);
1809bfcc09ddSBjoern A. Zeeb 	if (!drv) {
1810bfcc09ddSBjoern A. Zeeb 		ret = -ENOMEM;
1811bfcc09ddSBjoern A. Zeeb 		goto err;
1812bfcc09ddSBjoern A. Zeeb 	}
1813bfcc09ddSBjoern A. Zeeb 
1814bfcc09ddSBjoern A. Zeeb 	drv->trans = trans;
1815bfcc09ddSBjoern A. Zeeb 	drv->dev = trans->dev;
1816bfcc09ddSBjoern A. Zeeb 
1817bfcc09ddSBjoern A. Zeeb 	init_completion(&drv->request_firmware_complete);
1818bee60c98SBjoern A. Zeeb #if defined(__FreeBSD__)
1819bee60c98SBjoern A. Zeeb 	init_completion(&drv->drv_start_complete);
1820bee60c98SBjoern A. Zeeb #endif
1821bfcc09ddSBjoern A. Zeeb 	INIT_LIST_HEAD(&drv->list);
1822bfcc09ddSBjoern A. Zeeb 
1823bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
1824bfcc09ddSBjoern A. Zeeb 	/* Create the device debugfs entries. */
1825bfcc09ddSBjoern A. Zeeb 	drv->dbgfs_drv = debugfs_create_dir(dev_name(trans->dev),
1826bfcc09ddSBjoern A. Zeeb 					    iwl_dbgfs_root);
1827bfcc09ddSBjoern A. Zeeb 
1828bfcc09ddSBjoern A. Zeeb 	/* Create transport layer debugfs dir */
1829bfcc09ddSBjoern A. Zeeb 	drv->trans->dbgfs_dir = debugfs_create_dir("trans", drv->dbgfs_drv);
1830bfcc09ddSBjoern A. Zeeb #endif
1831bfcc09ddSBjoern A. Zeeb 
1832bfcc09ddSBjoern A. Zeeb 	drv->trans->dbg.domains_bitmap = IWL_TRANS_FW_DBG_DOMAIN(drv->trans);
1833a4128aadSBjoern A. Zeeb 	if (iwlwifi_mod_params.enable_ini != ENABLE_INI) {
1834a4128aadSBjoern A. Zeeb 		/* We have a non-default value in the module parameter,
1835a4128aadSBjoern A. Zeeb 		 * take its value
1836a4128aadSBjoern A. Zeeb 		 */
1837a4128aadSBjoern A. Zeeb 		drv->trans->dbg.domains_bitmap &= 0xffff;
1838a4128aadSBjoern A. Zeeb 		if (iwlwifi_mod_params.enable_ini != IWL_FW_INI_PRESET_DISABLE) {
1839a4128aadSBjoern A. Zeeb 			if (iwlwifi_mod_params.enable_ini > ENABLE_INI) {
1840a4128aadSBjoern A. Zeeb 				IWL_ERR(trans,
1841a4128aadSBjoern A. Zeeb 					"invalid enable_ini module parameter value: max = %d, using 0 instead\n",
1842a4128aadSBjoern A. Zeeb 					ENABLE_INI);
1843a4128aadSBjoern A. Zeeb 				iwlwifi_mod_params.enable_ini = 0;
1844a4128aadSBjoern A. Zeeb 			}
1845a4128aadSBjoern A. Zeeb 			drv->trans->dbg.domains_bitmap =
1846a4128aadSBjoern A. Zeeb 				BIT(IWL_FW_DBG_DOMAIN_POS + iwlwifi_mod_params.enable_ini);
1847a4128aadSBjoern A. Zeeb 		}
1848a4128aadSBjoern A. Zeeb 	}
1849bfcc09ddSBjoern A. Zeeb 
1850bfcc09ddSBjoern A. Zeeb 	ret = iwl_request_firmware(drv, true);
1851bfcc09ddSBjoern A. Zeeb 	if (ret) {
1852bfcc09ddSBjoern A. Zeeb 		IWL_ERR(trans, "Couldn't request the fw\n");
1853bfcc09ddSBjoern A. Zeeb 		goto err_fw;
1854bfcc09ddSBjoern A. Zeeb 	}
1855bfcc09ddSBjoern A. Zeeb 
1856f808c43aSBjoern A. Zeeb #if defined(__FreeBSD__)
1857f808c43aSBjoern A. Zeeb 	/*
1858f808c43aSBjoern A. Zeeb 	 * Wait until initilization is done before returning in order to
1859f808c43aSBjoern A. Zeeb 	 * replicate FreeBSD's synchronous behaviour -- we cannot create
1860f808c43aSBjoern A. Zeeb 	 * a vap before the com is fully created but if LinuxKPI "probe"
1861f808c43aSBjoern A. Zeeb 	 * returned before it was all done that is what could happen.
1862f808c43aSBjoern A. Zeeb 	 */
1863f808c43aSBjoern A. Zeeb 	wait_for_completion(&drv->request_firmware_complete);
1864bee60c98SBjoern A. Zeeb 	complete(&drv->drv_start_complete);
1865f808c43aSBjoern A. Zeeb #endif
1866f808c43aSBjoern A. Zeeb 
1867bfcc09ddSBjoern A. Zeeb 	return drv;
1868bfcc09ddSBjoern A. Zeeb 
1869bfcc09ddSBjoern A. Zeeb err_fw:
1870bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
1871bfcc09ddSBjoern A. Zeeb 	debugfs_remove_recursive(drv->dbgfs_drv);
1872bfcc09ddSBjoern A. Zeeb #endif
1873a4128aadSBjoern A. Zeeb 	iwl_dbg_tlv_free(drv->trans);
1874bfcc09ddSBjoern A. Zeeb 	kfree(drv);
1875bfcc09ddSBjoern A. Zeeb err:
1876bfcc09ddSBjoern A. Zeeb 	return ERR_PTR(ret);
1877bfcc09ddSBjoern A. Zeeb }
1878bfcc09ddSBjoern A. Zeeb 
iwl_drv_stop(struct iwl_drv * drv)1879bfcc09ddSBjoern A. Zeeb void iwl_drv_stop(struct iwl_drv *drv)
1880bfcc09ddSBjoern A. Zeeb {
1881bee60c98SBjoern A. Zeeb #if defined(__linux__)
1882bfcc09ddSBjoern A. Zeeb 	wait_for_completion(&drv->request_firmware_complete);
1883bee60c98SBjoern A. Zeeb #elif defined(__FreeBSD__)
1884bee60c98SBjoern A. Zeeb 	wait_for_completion(&drv->drv_start_complete);
1885bee60c98SBjoern A. Zeeb #endif
1886bfcc09ddSBjoern A. Zeeb 
1887a4128aadSBjoern A. Zeeb 	mutex_lock(&iwlwifi_opmode_table_mtx);
1888a4128aadSBjoern A. Zeeb 
1889bfcc09ddSBjoern A. Zeeb 	_iwl_op_mode_stop(drv);
1890bfcc09ddSBjoern A. Zeeb 
1891bfcc09ddSBjoern A. Zeeb 	iwl_dealloc_ucode(drv);
1892bfcc09ddSBjoern A. Zeeb 
1893bfcc09ddSBjoern A. Zeeb 	/*
1894bfcc09ddSBjoern A. Zeeb 	 * List is empty (this item wasn't added)
1895bfcc09ddSBjoern A. Zeeb 	 * when firmware loading failed -- in that
1896bfcc09ddSBjoern A. Zeeb 	 * case we can't remove it from any list.
1897bfcc09ddSBjoern A. Zeeb 	 */
1898bfcc09ddSBjoern A. Zeeb 	if (!list_empty(&drv->list))
1899bfcc09ddSBjoern A. Zeeb 		list_del(&drv->list);
1900bfcc09ddSBjoern A. Zeeb 	mutex_unlock(&iwlwifi_opmode_table_mtx);
1901bfcc09ddSBjoern A. Zeeb 
1902bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
1903a4128aadSBjoern A. Zeeb 	iwl_trans_debugfs_cleanup(drv->trans);
1904bfcc09ddSBjoern A. Zeeb 
1905bfcc09ddSBjoern A. Zeeb 	debugfs_remove_recursive(drv->dbgfs_drv);
1906bfcc09ddSBjoern A. Zeeb #endif
1907bfcc09ddSBjoern A. Zeeb 
1908bfcc09ddSBjoern A. Zeeb 	iwl_dbg_tlv_free(drv->trans);
1909bfcc09ddSBjoern A. Zeeb 
1910bfcc09ddSBjoern A. Zeeb 	kfree(drv);
1911bfcc09ddSBjoern A. Zeeb }
1912bfcc09ddSBjoern A. Zeeb 
1913bfcc09ddSBjoern A. Zeeb /* shared module parameters */
1914bfcc09ddSBjoern A. Zeeb struct iwl_mod_params iwlwifi_mod_params = {
1915bfcc09ddSBjoern A. Zeeb 	.fw_restart = true,
1916bfcc09ddSBjoern A. Zeeb 	.bt_coex_active = true,
1917bfcc09ddSBjoern A. Zeeb 	.power_level = IWL_POWER_INDEX_1,
1918bfcc09ddSBjoern A. Zeeb 	.uapsd_disable = IWL_DISABLE_UAPSD_BSS | IWL_DISABLE_UAPSD_P2P_CLIENT,
1919fac1f593SBjoern A. Zeeb 	.enable_ini = ENABLE_INI,
1920bfcc09ddSBjoern A. Zeeb #if defined(__FreeBSD__)
1921bfcc09ddSBjoern A. Zeeb 	.disable_11n = 1,
1922bfcc09ddSBjoern A. Zeeb 	.disable_11ac = true,
1923bfcc09ddSBjoern A. Zeeb 	.disable_11ax = true,
19249af1bba4SBjoern A. Zeeb 	.disable_11be = true,
1925bfcc09ddSBjoern A. Zeeb #endif
1926bfcc09ddSBjoern A. Zeeb 	/* the rest are 0 by default */
1927bfcc09ddSBjoern A. Zeeb };
1928bfcc09ddSBjoern A. Zeeb IWL_EXPORT_SYMBOL(iwlwifi_mod_params);
1929bfcc09ddSBjoern A. Zeeb 
iwl_opmode_register(const char * name,const struct iwl_op_mode_ops * ops)1930bfcc09ddSBjoern A. Zeeb int iwl_opmode_register(const char *name, const struct iwl_op_mode_ops *ops)
1931bfcc09ddSBjoern A. Zeeb {
1932bfcc09ddSBjoern A. Zeeb 	int i;
1933bfcc09ddSBjoern A. Zeeb 	struct iwl_drv *drv;
1934bfcc09ddSBjoern A. Zeeb 	struct iwlwifi_opmode_table *op;
1935bfcc09ddSBjoern A. Zeeb 
1936bfcc09ddSBjoern A. Zeeb 	mutex_lock(&iwlwifi_opmode_table_mtx);
1937bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < ARRAY_SIZE(iwlwifi_opmode_table); i++) {
1938bfcc09ddSBjoern A. Zeeb 		op = &iwlwifi_opmode_table[i];
1939bfcc09ddSBjoern A. Zeeb 		if (strcmp(op->name, name))
1940bfcc09ddSBjoern A. Zeeb 			continue;
1941bfcc09ddSBjoern A. Zeeb 		op->ops = ops;
1942bfcc09ddSBjoern A. Zeeb 		/* TODO: need to handle exceptional case */
1943bfcc09ddSBjoern A. Zeeb 		list_for_each_entry(drv, &op->drv, list)
1944bfcc09ddSBjoern A. Zeeb 			drv->op_mode = _iwl_op_mode_start(drv, op);
1945bfcc09ddSBjoern A. Zeeb 
1946bfcc09ddSBjoern A. Zeeb 		mutex_unlock(&iwlwifi_opmode_table_mtx);
1947bfcc09ddSBjoern A. Zeeb 		return 0;
1948bfcc09ddSBjoern A. Zeeb 	}
1949bfcc09ddSBjoern A. Zeeb 	mutex_unlock(&iwlwifi_opmode_table_mtx);
1950bfcc09ddSBjoern A. Zeeb 	return -EIO;
1951bfcc09ddSBjoern A. Zeeb }
1952bfcc09ddSBjoern A. Zeeb IWL_EXPORT_SYMBOL(iwl_opmode_register);
1953bfcc09ddSBjoern A. Zeeb 
iwl_opmode_deregister(const char * name)1954bfcc09ddSBjoern A. Zeeb void iwl_opmode_deregister(const char *name)
1955bfcc09ddSBjoern A. Zeeb {
1956bfcc09ddSBjoern A. Zeeb 	int i;
1957bfcc09ddSBjoern A. Zeeb 	struct iwl_drv *drv;
1958bfcc09ddSBjoern A. Zeeb 
1959bfcc09ddSBjoern A. Zeeb 	mutex_lock(&iwlwifi_opmode_table_mtx);
1960bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < ARRAY_SIZE(iwlwifi_opmode_table); i++) {
1961bfcc09ddSBjoern A. Zeeb 		if (strcmp(iwlwifi_opmode_table[i].name, name))
1962bfcc09ddSBjoern A. Zeeb 			continue;
1963bfcc09ddSBjoern A. Zeeb 		iwlwifi_opmode_table[i].ops = NULL;
1964bfcc09ddSBjoern A. Zeeb 
1965bfcc09ddSBjoern A. Zeeb 		/* call the stop routine for all devices */
1966bfcc09ddSBjoern A. Zeeb 		list_for_each_entry(drv, &iwlwifi_opmode_table[i].drv, list)
1967bfcc09ddSBjoern A. Zeeb 			_iwl_op_mode_stop(drv);
1968bfcc09ddSBjoern A. Zeeb 
1969bfcc09ddSBjoern A. Zeeb 		mutex_unlock(&iwlwifi_opmode_table_mtx);
1970bfcc09ddSBjoern A. Zeeb 		return;
1971bfcc09ddSBjoern A. Zeeb 	}
1972bfcc09ddSBjoern A. Zeeb 	mutex_unlock(&iwlwifi_opmode_table_mtx);
1973bfcc09ddSBjoern A. Zeeb }
1974bfcc09ddSBjoern A. Zeeb IWL_EXPORT_SYMBOL(iwl_opmode_deregister);
1975bfcc09ddSBjoern A. Zeeb 
iwl_drv_init(void)1976bfcc09ddSBjoern A. Zeeb static int __init iwl_drv_init(void)
1977bfcc09ddSBjoern A. Zeeb {
1978bfcc09ddSBjoern A. Zeeb 	int i, err;
1979bfcc09ddSBjoern A. Zeeb 
1980bfcc09ddSBjoern A. Zeeb 	for (i = 0; i < ARRAY_SIZE(iwlwifi_opmode_table); i++)
1981bfcc09ddSBjoern A. Zeeb 		INIT_LIST_HEAD(&iwlwifi_opmode_table[i].drv);
1982bfcc09ddSBjoern A. Zeeb 
1983bfcc09ddSBjoern A. Zeeb 	pr_info(DRV_DESCRIPTION "\n");
1984bfcc09ddSBjoern A. Zeeb 
1985bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
1986bfcc09ddSBjoern A. Zeeb 	/* Create the root of iwlwifi debugfs subsystem. */
1987bfcc09ddSBjoern A. Zeeb 	iwl_dbgfs_root = debugfs_create_dir(DRV_NAME, NULL);
1988bfcc09ddSBjoern A. Zeeb #endif
1989bfcc09ddSBjoern A. Zeeb 
1990bfcc09ddSBjoern A. Zeeb 	err = iwl_pci_register_driver();
1991bfcc09ddSBjoern A. Zeeb 	if (err)
1992bfcc09ddSBjoern A. Zeeb 		goto cleanup_debugfs;
1993bfcc09ddSBjoern A. Zeeb 
1994bfcc09ddSBjoern A. Zeeb 	return 0;
1995bfcc09ddSBjoern A. Zeeb 
1996bfcc09ddSBjoern A. Zeeb cleanup_debugfs:
1997bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
1998bfcc09ddSBjoern A. Zeeb 	debugfs_remove_recursive(iwl_dbgfs_root);
1999bfcc09ddSBjoern A. Zeeb #endif
2000bfcc09ddSBjoern A. Zeeb 	return err;
2001bfcc09ddSBjoern A. Zeeb }
2002bfcc09ddSBjoern A. Zeeb module_init(iwl_drv_init);
2003bfcc09ddSBjoern A. Zeeb 
iwl_drv_exit(void)2004bfcc09ddSBjoern A. Zeeb static void __exit iwl_drv_exit(void)
2005bfcc09ddSBjoern A. Zeeb {
2006bfcc09ddSBjoern A. Zeeb 	iwl_pci_unregister_driver();
2007bfcc09ddSBjoern A. Zeeb 
2008bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUGFS
2009bfcc09ddSBjoern A. Zeeb 	debugfs_remove_recursive(iwl_dbgfs_root);
2010bfcc09ddSBjoern A. Zeeb #endif
2011bfcc09ddSBjoern A. Zeeb }
2012bfcc09ddSBjoern A. Zeeb module_exit(iwl_drv_exit);
2013bfcc09ddSBjoern A. Zeeb 
2014bfcc09ddSBjoern A. Zeeb #ifdef CONFIG_IWLWIFI_DEBUG
2015bfcc09ddSBjoern A. Zeeb module_param_named(debug, iwlwifi_mod_params.debug_level, uint, 0644);
2016bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(debug, "debug output mask");
2017bfcc09ddSBjoern A. Zeeb #endif
2018bfcc09ddSBjoern A. Zeeb 
2019bfcc09ddSBjoern A. Zeeb module_param_named(swcrypto, iwlwifi_mod_params.swcrypto, int, 0444);
2020bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(swcrypto, "using crypto in software (default 0 [hardware])");
2021bfcc09ddSBjoern A. Zeeb module_param_named(11n_disable, iwlwifi_mod_params.disable_11n, uint, 0444);
2022bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(11n_disable,
2023bfcc09ddSBjoern A. Zeeb 	"disable 11n functionality, bitmap: 1: full, 2: disable agg TX, 4: disable agg RX, 8 enable agg TX");
2024bfcc09ddSBjoern A. Zeeb module_param_named(amsdu_size, iwlwifi_mod_params.amsdu_size, int, 0444);
2025bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(amsdu_size,
2026bfcc09ddSBjoern A. Zeeb 		 "amsdu size 0: 12K for multi Rx queue devices, 2K for AX210 devices, "
2027bfcc09ddSBjoern A. Zeeb 		 "4K for other devices 1:4K 2:8K 3:12K (16K buffers) 4: 2K (default 0)");
2028bfcc09ddSBjoern A. Zeeb module_param_named(fw_restart, iwlwifi_mod_params.fw_restart, bool, 0444);
2029bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(fw_restart, "restart firmware in case of error (default true)");
2030bfcc09ddSBjoern A. Zeeb 
2031bfcc09ddSBjoern A. Zeeb module_param_named(nvm_file, iwlwifi_mod_params.nvm_file, charp, 0444);
2032bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(nvm_file, "NVM file name");
2033bfcc09ddSBjoern A. Zeeb 
2034bfcc09ddSBjoern A. Zeeb module_param_named(uapsd_disable, iwlwifi_mod_params.uapsd_disable, uint, 0644);
2035bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(uapsd_disable,
2036bfcc09ddSBjoern A. Zeeb 		 "disable U-APSD functionality bitmap 1: BSS 2: P2P Client (default: 3)");
2037fac1f593SBjoern A. Zeeb 
2038a4128aadSBjoern A. Zeeb module_param_named(enable_ini, iwlwifi_mod_params.enable_ini, uint, 0444);
2039bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(enable_ini,
2040fac1f593SBjoern A. Zeeb 		 "0:disable, 1-15:FW_DBG_PRESET Values, 16:enabled without preset value defined,"
2041fac1f593SBjoern A. Zeeb 		 "Debug INI TLV FW debug infrastructure (default: 16)");
2042bfcc09ddSBjoern A. Zeeb 
2043bfcc09ddSBjoern A. Zeeb /*
2044bfcc09ddSBjoern A. Zeeb  * set bt_coex_active to true, uCode will do kill/defer
2045bfcc09ddSBjoern A. Zeeb  * every time the priority line is asserted (BT is sending signals on the
2046bfcc09ddSBjoern A. Zeeb  * priority line in the PCIx).
2047bfcc09ddSBjoern A. Zeeb  * set bt_coex_active to false, uCode will ignore the BT activity and
2048bfcc09ddSBjoern A. Zeeb  * perform the normal operation
2049bfcc09ddSBjoern A. Zeeb  *
2050bfcc09ddSBjoern A. Zeeb  * User might experience transmit issue on some platform due to WiFi/BT
2051bfcc09ddSBjoern A. Zeeb  * co-exist problem. The possible behaviors are:
2052bfcc09ddSBjoern A. Zeeb  *   Able to scan and finding all the available AP
2053bfcc09ddSBjoern A. Zeeb  *   Not able to associate with any AP
2054bfcc09ddSBjoern A. Zeeb  * On those platforms, WiFi communication can be restored by set
2055bfcc09ddSBjoern A. Zeeb  * "bt_coex_active" module parameter to "false"
2056bfcc09ddSBjoern A. Zeeb  *
2057bfcc09ddSBjoern A. Zeeb  * default: bt_coex_active = true (BT_COEX_ENABLE)
2058bfcc09ddSBjoern A. Zeeb  */
2059bfcc09ddSBjoern A. Zeeb module_param_named(bt_coex_active, iwlwifi_mod_params.bt_coex_active,
2060bfcc09ddSBjoern A. Zeeb 		   bool, 0444);
2061bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(bt_coex_active, "enable wifi/bt co-exist (default: enable)");
2062bfcc09ddSBjoern A. Zeeb 
2063bfcc09ddSBjoern A. Zeeb module_param_named(led_mode, iwlwifi_mod_params.led_mode, int, 0444);
2064bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(led_mode, "0=system default, "
2065bfcc09ddSBjoern A. Zeeb 		"1=On(RF On)/Off(RF Off), 2=blinking, 3=Off (default: 0)");
2066bfcc09ddSBjoern A. Zeeb 
2067bfcc09ddSBjoern A. Zeeb module_param_named(power_save, iwlwifi_mod_params.power_save, bool, 0444);
2068bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(power_save,
2069bfcc09ddSBjoern A. Zeeb 		 "enable WiFi power management (default: disable)");
2070bfcc09ddSBjoern A. Zeeb 
2071bfcc09ddSBjoern A. Zeeb module_param_named(power_level, iwlwifi_mod_params.power_level, int, 0444);
2072bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(power_level,
2073bfcc09ddSBjoern A. Zeeb 		 "default power save level (range from 1 - 5, default: 1)");
2074bfcc09ddSBjoern A. Zeeb 
2075bfcc09ddSBjoern A. Zeeb module_param_named(disable_11ac, iwlwifi_mod_params.disable_11ac, bool, 0444);
2076bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(disable_11ac, "Disable VHT capabilities (default: false)");
2077bfcc09ddSBjoern A. Zeeb 
2078bfcc09ddSBjoern A. Zeeb module_param_named(remove_when_gone,
2079bfcc09ddSBjoern A. Zeeb 		   iwlwifi_mod_params.remove_when_gone, bool,
2080bfcc09ddSBjoern A. Zeeb 		   0444);
2081bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(remove_when_gone,
2082bfcc09ddSBjoern A. Zeeb 		 "Remove dev from PCIe bus if it is deemed inaccessible (default: false)");
2083bfcc09ddSBjoern A. Zeeb 
2084bfcc09ddSBjoern A. Zeeb module_param_named(disable_11ax, iwlwifi_mod_params.disable_11ax, bool,
2085bfcc09ddSBjoern A. Zeeb 		   S_IRUGO);
2086bfcc09ddSBjoern A. Zeeb MODULE_PARM_DESC(disable_11ax, "Disable HE capabilities (default: false)");
20879af1bba4SBjoern A. Zeeb 
20889af1bba4SBjoern A. Zeeb module_param_named(disable_11be, iwlwifi_mod_params.disable_11be, bool, 0444);
20899af1bba4SBjoern A. Zeeb MODULE_PARM_DESC(disable_11be, "Disable EHT capabilities (default: false)");
2090