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