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