xref: /linux/drivers/net/wireless/intel/iwlwifi/fw/dbg-old.c (revision b2128290c29902315e632ea59e0504d6bc9e9b42)
1*2c3ea36aSJohannes Berg // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2*2c3ea36aSJohannes Berg /*
3*2c3ea36aSJohannes Berg  * Copyright (C) 2005-2014, 2018-2026 Intel Corporation
4*2c3ea36aSJohannes Berg  * Copyright (C) 2013-2015 Intel Mobile Communications GmbH
5*2c3ea36aSJohannes Berg  * Copyright (C) 2015-2017 Intel Deutschland GmbH
6*2c3ea36aSJohannes Berg  */
7*2c3ea36aSJohannes Berg #include <linux/devcoredump.h>
8*2c3ea36aSJohannes Berg #include "iwl-drv.h"
9*2c3ea36aSJohannes Berg #include "runtime.h"
10*2c3ea36aSJohannes Berg #include "dbg.h"
11*2c3ea36aSJohannes Berg #include "debugfs.h"
12*2c3ea36aSJohannes Berg #include "iwl-io.h"
13*2c3ea36aSJohannes Berg #include "iwl-prph.h"
14*2c3ea36aSJohannes Berg #include "iwl-csr.h"
15*2c3ea36aSJohannes Berg #include "iwl-fh.h"
16*2c3ea36aSJohannes Berg 
17*2c3ea36aSJohannes Berg /**
18*2c3ea36aSJohannes Berg  * struct iwl_fw_dump_ptrs - set of pointers needed for the fw-error-dump
19*2c3ea36aSJohannes Berg  *
20*2c3ea36aSJohannes Berg  * @fwrt_ptr: pointer to the buffer coming from fwrt
21*2c3ea36aSJohannes Berg  * @trans_ptr: pointer to struct %iwl_trans_dump_data which contains the
22*2c3ea36aSJohannes Berg  *	transport's data.
23*2c3ea36aSJohannes Berg  * @fwrt_len: length of the valid data in fwrt_ptr
24*2c3ea36aSJohannes Berg  */
25*2c3ea36aSJohannes Berg struct iwl_fw_dump_ptrs {
26*2c3ea36aSJohannes Berg 	struct iwl_trans_dump_data *trans_ptr;
27*2c3ea36aSJohannes Berg 	void *fwrt_ptr;
28*2c3ea36aSJohannes Berg 	u32 fwrt_len;
29*2c3ea36aSJohannes Berg };
30*2c3ea36aSJohannes Berg 
31*2c3ea36aSJohannes Berg #define RADIO_REG_MAX_READ 0x2ad
32*2c3ea36aSJohannes Berg static void iwl_read_radio_regs(struct iwl_fw_runtime *fwrt,
33*2c3ea36aSJohannes Berg 				struct iwl_fw_error_dump_data **dump_data)
34*2c3ea36aSJohannes Berg {
35*2c3ea36aSJohannes Berg 	u8 *pos = (void *)(*dump_data)->data;
36*2c3ea36aSJohannes Berg 	int i;
37*2c3ea36aSJohannes Berg 
38*2c3ea36aSJohannes Berg 	IWL_DEBUG_INFO(fwrt, "WRT radio registers dump\n");
39*2c3ea36aSJohannes Berg 
40*2c3ea36aSJohannes Berg 	if (!iwl_trans_grab_nic_access(fwrt->trans))
41*2c3ea36aSJohannes Berg 		return;
42*2c3ea36aSJohannes Berg 
43*2c3ea36aSJohannes Berg 	(*dump_data)->type = cpu_to_le32(IWL_FW_ERROR_DUMP_RADIO_REG);
44*2c3ea36aSJohannes Berg 	(*dump_data)->len = cpu_to_le32(RADIO_REG_MAX_READ);
45*2c3ea36aSJohannes Berg 
46*2c3ea36aSJohannes Berg 	for (i = 0; i < RADIO_REG_MAX_READ; i++) {
47*2c3ea36aSJohannes Berg 		u32 rd_cmd = RADIO_RSP_RD_CMD;
48*2c3ea36aSJohannes Berg 
49*2c3ea36aSJohannes Berg 		rd_cmd |= i << RADIO_RSP_ADDR_POS;
50*2c3ea36aSJohannes Berg 		iwl_trans_write_prph(fwrt->trans, RSP_RADIO_CMD, rd_cmd);
51*2c3ea36aSJohannes Berg 		*pos = (u8)iwl_trans_read_prph(fwrt->trans, RSP_RADIO_RDDAT);
52*2c3ea36aSJohannes Berg 
53*2c3ea36aSJohannes Berg 		pos++;
54*2c3ea36aSJohannes Berg 	}
55*2c3ea36aSJohannes Berg 
56*2c3ea36aSJohannes Berg 	*dump_data = iwl_fw_error_next_data(*dump_data);
57*2c3ea36aSJohannes Berg 
58*2c3ea36aSJohannes Berg 	iwl_trans_release_nic_access(fwrt->trans);
59*2c3ea36aSJohannes Berg }
60*2c3ea36aSJohannes Berg 
61*2c3ea36aSJohannes Berg static void iwl_fwrt_dump_rxf(struct iwl_fw_runtime *fwrt,
62*2c3ea36aSJohannes Berg 			      struct iwl_fw_error_dump_data **dump_data,
63*2c3ea36aSJohannes Berg 			      int size, u32 offset, int fifo_num)
64*2c3ea36aSJohannes Berg {
65*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_fifo *fifo_hdr;
66*2c3ea36aSJohannes Berg 	u32 *fifo_data;
67*2c3ea36aSJohannes Berg 	u32 fifo_len;
68*2c3ea36aSJohannes Berg 	int i;
69*2c3ea36aSJohannes Berg 
70*2c3ea36aSJohannes Berg 	fifo_hdr = (void *)(*dump_data)->data;
71*2c3ea36aSJohannes Berg 	fifo_data = (void *)fifo_hdr->data;
72*2c3ea36aSJohannes Berg 	fifo_len = size;
73*2c3ea36aSJohannes Berg 
74*2c3ea36aSJohannes Berg 	/* No need to try to read the data if the length is 0 */
75*2c3ea36aSJohannes Berg 	if (fifo_len == 0)
76*2c3ea36aSJohannes Berg 		return;
77*2c3ea36aSJohannes Berg 
78*2c3ea36aSJohannes Berg 	/* Add a TLV for the RXF */
79*2c3ea36aSJohannes Berg 	(*dump_data)->type = cpu_to_le32(IWL_FW_ERROR_DUMP_RXF);
80*2c3ea36aSJohannes Berg 	(*dump_data)->len = cpu_to_le32(fifo_len + sizeof(*fifo_hdr));
81*2c3ea36aSJohannes Berg 
82*2c3ea36aSJohannes Berg 	fifo_hdr->fifo_num = cpu_to_le32(fifo_num);
83*2c3ea36aSJohannes Berg 	fifo_hdr->available_bytes =
84*2c3ea36aSJohannes Berg 		cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
85*2c3ea36aSJohannes Berg 						RXF_RD_D_SPACE + offset));
86*2c3ea36aSJohannes Berg 	fifo_hdr->wr_ptr =
87*2c3ea36aSJohannes Berg 		cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
88*2c3ea36aSJohannes Berg 						RXF_RD_WR_PTR + offset));
89*2c3ea36aSJohannes Berg 	fifo_hdr->rd_ptr =
90*2c3ea36aSJohannes Berg 		cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
91*2c3ea36aSJohannes Berg 						RXF_RD_RD_PTR + offset));
92*2c3ea36aSJohannes Berg 	fifo_hdr->fence_ptr =
93*2c3ea36aSJohannes Berg 		cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
94*2c3ea36aSJohannes Berg 						RXF_RD_FENCE_PTR + offset));
95*2c3ea36aSJohannes Berg 	fifo_hdr->fence_mode =
96*2c3ea36aSJohannes Berg 		cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
97*2c3ea36aSJohannes Berg 						RXF_SET_FENCE_MODE + offset));
98*2c3ea36aSJohannes Berg 
99*2c3ea36aSJohannes Berg 	/* Lock fence */
100*2c3ea36aSJohannes Berg 	iwl_trans_write_prph(fwrt->trans, RXF_SET_FENCE_MODE + offset, 0x1);
101*2c3ea36aSJohannes Berg 	/* Set fence pointer to the same place like WR pointer */
102*2c3ea36aSJohannes Berg 	iwl_trans_write_prph(fwrt->trans, RXF_LD_WR2FENCE + offset, 0x1);
103*2c3ea36aSJohannes Berg 	/* Set fence offset */
104*2c3ea36aSJohannes Berg 	iwl_trans_write_prph(fwrt->trans,
105*2c3ea36aSJohannes Berg 			     RXF_LD_FENCE_OFFSET_ADDR + offset, 0x0);
106*2c3ea36aSJohannes Berg 
107*2c3ea36aSJohannes Berg 	/* Read FIFO */
108*2c3ea36aSJohannes Berg 	fifo_len /= sizeof(u32); /* Size in DWORDS */
109*2c3ea36aSJohannes Berg 	for (i = 0; i < fifo_len; i++)
110*2c3ea36aSJohannes Berg 		fifo_data[i] = iwl_trans_read_prph(fwrt->trans,
111*2c3ea36aSJohannes Berg 						 RXF_FIFO_RD_FENCE_INC +
112*2c3ea36aSJohannes Berg 						 offset);
113*2c3ea36aSJohannes Berg 	*dump_data = iwl_fw_error_next_data(*dump_data);
114*2c3ea36aSJohannes Berg }
115*2c3ea36aSJohannes Berg 
116*2c3ea36aSJohannes Berg static void iwl_fwrt_dump_txf(struct iwl_fw_runtime *fwrt,
117*2c3ea36aSJohannes Berg 			      struct iwl_fw_error_dump_data **dump_data,
118*2c3ea36aSJohannes Berg 			      int size, u32 offset, int fifo_num)
119*2c3ea36aSJohannes Berg {
120*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_fifo *fifo_hdr;
121*2c3ea36aSJohannes Berg 	u32 *fifo_data;
122*2c3ea36aSJohannes Berg 	u32 fifo_len;
123*2c3ea36aSJohannes Berg 	int i;
124*2c3ea36aSJohannes Berg 
125*2c3ea36aSJohannes Berg 	fifo_hdr = (void *)(*dump_data)->data;
126*2c3ea36aSJohannes Berg 	fifo_data = (void *)fifo_hdr->data;
127*2c3ea36aSJohannes Berg 	fifo_len = size;
128*2c3ea36aSJohannes Berg 
129*2c3ea36aSJohannes Berg 	/* No need to try to read the data if the length is 0 */
130*2c3ea36aSJohannes Berg 	if (fifo_len == 0)
131*2c3ea36aSJohannes Berg 		return;
132*2c3ea36aSJohannes Berg 
133*2c3ea36aSJohannes Berg 	/* Add a TLV for the FIFO */
134*2c3ea36aSJohannes Berg 	(*dump_data)->type = cpu_to_le32(IWL_FW_ERROR_DUMP_TXF);
135*2c3ea36aSJohannes Berg 	(*dump_data)->len = cpu_to_le32(fifo_len + sizeof(*fifo_hdr));
136*2c3ea36aSJohannes Berg 
137*2c3ea36aSJohannes Berg 	fifo_hdr->fifo_num = cpu_to_le32(fifo_num);
138*2c3ea36aSJohannes Berg 	fifo_hdr->available_bytes =
139*2c3ea36aSJohannes Berg 		cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
140*2c3ea36aSJohannes Berg 						TXF_FIFO_ITEM_CNT + offset));
141*2c3ea36aSJohannes Berg 	fifo_hdr->wr_ptr =
142*2c3ea36aSJohannes Berg 		cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
143*2c3ea36aSJohannes Berg 						TXF_WR_PTR + offset));
144*2c3ea36aSJohannes Berg 	fifo_hdr->rd_ptr =
145*2c3ea36aSJohannes Berg 		cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
146*2c3ea36aSJohannes Berg 						TXF_RD_PTR + offset));
147*2c3ea36aSJohannes Berg 	fifo_hdr->fence_ptr =
148*2c3ea36aSJohannes Berg 		cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
149*2c3ea36aSJohannes Berg 						TXF_FENCE_PTR + offset));
150*2c3ea36aSJohannes Berg 	fifo_hdr->fence_mode =
151*2c3ea36aSJohannes Berg 		cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
152*2c3ea36aSJohannes Berg 						TXF_LOCK_FENCE + offset));
153*2c3ea36aSJohannes Berg 
154*2c3ea36aSJohannes Berg 	/* Set the TXF_READ_MODIFY_ADDR to TXF_WR_PTR */
155*2c3ea36aSJohannes Berg 	iwl_trans_write_prph(fwrt->trans, TXF_READ_MODIFY_ADDR + offset,
156*2c3ea36aSJohannes Berg 			     TXF_WR_PTR + offset);
157*2c3ea36aSJohannes Berg 
158*2c3ea36aSJohannes Berg 	/* Dummy-read to advance the read pointer to the head */
159*2c3ea36aSJohannes Berg 	iwl_trans_read_prph(fwrt->trans, TXF_READ_MODIFY_DATA + offset);
160*2c3ea36aSJohannes Berg 
161*2c3ea36aSJohannes Berg 	/* Read FIFO */
162*2c3ea36aSJohannes Berg 	for (i = 0; i < fifo_len / sizeof(u32); i++)
163*2c3ea36aSJohannes Berg 		fifo_data[i] = iwl_trans_read_prph(fwrt->trans,
164*2c3ea36aSJohannes Berg 						  TXF_READ_MODIFY_DATA +
165*2c3ea36aSJohannes Berg 						  offset);
166*2c3ea36aSJohannes Berg 
167*2c3ea36aSJohannes Berg 	if (fwrt->sanitize_ops && fwrt->sanitize_ops->frob_txf)
168*2c3ea36aSJohannes Berg 		fwrt->sanitize_ops->frob_txf(fwrt->sanitize_ctx,
169*2c3ea36aSJohannes Berg 					     fifo_data, fifo_len);
170*2c3ea36aSJohannes Berg 
171*2c3ea36aSJohannes Berg 	*dump_data = iwl_fw_error_next_data(*dump_data);
172*2c3ea36aSJohannes Berg }
173*2c3ea36aSJohannes Berg 
174*2c3ea36aSJohannes Berg static void iwl_fw_dump_rxf(struct iwl_fw_runtime *fwrt,
175*2c3ea36aSJohannes Berg 			    struct iwl_fw_error_dump_data **dump_data)
176*2c3ea36aSJohannes Berg {
177*2c3ea36aSJohannes Berg 	struct iwl_fwrt_shared_mem_cfg *cfg = &fwrt->smem_cfg;
178*2c3ea36aSJohannes Berg 
179*2c3ea36aSJohannes Berg 	IWL_DEBUG_INFO(fwrt, "WRT RX FIFO dump\n");
180*2c3ea36aSJohannes Berg 
181*2c3ea36aSJohannes Berg 	if (!iwl_trans_grab_nic_access(fwrt->trans))
182*2c3ea36aSJohannes Berg 		return;
183*2c3ea36aSJohannes Berg 
184*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_RXF)) {
185*2c3ea36aSJohannes Berg 		/* Pull RXF1 */
186*2c3ea36aSJohannes Berg 		iwl_fwrt_dump_rxf(fwrt, dump_data,
187*2c3ea36aSJohannes Berg 				  cfg->lmac[0].rxfifo1_size, 0, 0);
188*2c3ea36aSJohannes Berg 		/* Pull RXF2 */
189*2c3ea36aSJohannes Berg 		iwl_fwrt_dump_rxf(fwrt, dump_data, cfg->rxfifo2_size,
190*2c3ea36aSJohannes Berg 				  RXF_DIFF_FROM_PREV +
191*2c3ea36aSJohannes Berg 				  fwrt->trans->mac_cfg->umac_prph_offset, 1);
192*2c3ea36aSJohannes Berg 		/* Pull LMAC2 RXF1 */
193*2c3ea36aSJohannes Berg 		if (fwrt->smem_cfg.num_lmacs > 1)
194*2c3ea36aSJohannes Berg 			iwl_fwrt_dump_rxf(fwrt, dump_data,
195*2c3ea36aSJohannes Berg 					  cfg->lmac[1].rxfifo1_size,
196*2c3ea36aSJohannes Berg 					  LMAC2_PRPH_OFFSET, 2);
197*2c3ea36aSJohannes Berg 	}
198*2c3ea36aSJohannes Berg 
199*2c3ea36aSJohannes Berg 	iwl_trans_release_nic_access(fwrt->trans);
200*2c3ea36aSJohannes Berg }
201*2c3ea36aSJohannes Berg 
202*2c3ea36aSJohannes Berg static void iwl_fw_dump_txf(struct iwl_fw_runtime *fwrt,
203*2c3ea36aSJohannes Berg 			    struct iwl_fw_error_dump_data **dump_data)
204*2c3ea36aSJohannes Berg {
205*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_fifo *fifo_hdr;
206*2c3ea36aSJohannes Berg 	struct iwl_fwrt_shared_mem_cfg *cfg = &fwrt->smem_cfg;
207*2c3ea36aSJohannes Berg 	u32 *fifo_data;
208*2c3ea36aSJohannes Berg 	u32 fifo_len;
209*2c3ea36aSJohannes Berg 	int i, j;
210*2c3ea36aSJohannes Berg 
211*2c3ea36aSJohannes Berg 	IWL_DEBUG_INFO(fwrt, "WRT TX FIFO dump\n");
212*2c3ea36aSJohannes Berg 
213*2c3ea36aSJohannes Berg 	if (!iwl_trans_grab_nic_access(fwrt->trans))
214*2c3ea36aSJohannes Berg 		return;
215*2c3ea36aSJohannes Berg 
216*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_TXF)) {
217*2c3ea36aSJohannes Berg 		/* Pull TXF data from LMAC1 */
218*2c3ea36aSJohannes Berg 		for (i = 0; i < fwrt->smem_cfg.num_txfifo_entries; i++) {
219*2c3ea36aSJohannes Berg 			/* Mark the number of TXF we're pulling now */
220*2c3ea36aSJohannes Berg 			iwl_trans_write_prph(fwrt->trans, TXF_LARC_NUM, i);
221*2c3ea36aSJohannes Berg 			iwl_fwrt_dump_txf(fwrt, dump_data,
222*2c3ea36aSJohannes Berg 					  cfg->lmac[0].txfifo_size[i], 0, i);
223*2c3ea36aSJohannes Berg 		}
224*2c3ea36aSJohannes Berg 
225*2c3ea36aSJohannes Berg 		/* Pull TXF data from LMAC2 */
226*2c3ea36aSJohannes Berg 		if (fwrt->smem_cfg.num_lmacs > 1) {
227*2c3ea36aSJohannes Berg 			for (i = 0; i < fwrt->smem_cfg.num_txfifo_entries;
228*2c3ea36aSJohannes Berg 			     i++) {
229*2c3ea36aSJohannes Berg 				/* Mark the number of TXF we're pulling now */
230*2c3ea36aSJohannes Berg 				iwl_trans_write_prph(fwrt->trans,
231*2c3ea36aSJohannes Berg 						     TXF_LARC_NUM +
232*2c3ea36aSJohannes Berg 						     LMAC2_PRPH_OFFSET, i);
233*2c3ea36aSJohannes Berg 				iwl_fwrt_dump_txf(fwrt, dump_data,
234*2c3ea36aSJohannes Berg 						  cfg->lmac[1].txfifo_size[i],
235*2c3ea36aSJohannes Berg 						  LMAC2_PRPH_OFFSET,
236*2c3ea36aSJohannes Berg 						  i + cfg->num_txfifo_entries);
237*2c3ea36aSJohannes Berg 			}
238*2c3ea36aSJohannes Berg 		}
239*2c3ea36aSJohannes Berg 	}
240*2c3ea36aSJohannes Berg 
241*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_INTERNAL_TXF) &&
242*2c3ea36aSJohannes Berg 	    fw_has_capa(&fwrt->fw->ucode_capa,
243*2c3ea36aSJohannes Berg 			IWL_UCODE_TLV_CAPA_EXTEND_SHARED_MEM_CFG)) {
244*2c3ea36aSJohannes Berg 		/* Pull UMAC internal TXF data from all TXFs */
245*2c3ea36aSJohannes Berg 		for (i = 0;
246*2c3ea36aSJohannes Berg 		     i < ARRAY_SIZE(fwrt->smem_cfg.internal_txfifo_size);
247*2c3ea36aSJohannes Berg 		     i++) {
248*2c3ea36aSJohannes Berg 			fifo_hdr = (void *)(*dump_data)->data;
249*2c3ea36aSJohannes Berg 			fifo_data = (void *)fifo_hdr->data;
250*2c3ea36aSJohannes Berg 			fifo_len = fwrt->smem_cfg.internal_txfifo_size[i];
251*2c3ea36aSJohannes Berg 
252*2c3ea36aSJohannes Berg 			/* No need to try to read the data if the length is 0 */
253*2c3ea36aSJohannes Berg 			if (fifo_len == 0)
254*2c3ea36aSJohannes Berg 				continue;
255*2c3ea36aSJohannes Berg 
256*2c3ea36aSJohannes Berg 			/* Add a TLV for the internal FIFOs */
257*2c3ea36aSJohannes Berg 			(*dump_data)->type =
258*2c3ea36aSJohannes Berg 				cpu_to_le32(IWL_FW_ERROR_DUMP_INTERNAL_TXF);
259*2c3ea36aSJohannes Berg 			(*dump_data)->len =
260*2c3ea36aSJohannes Berg 				cpu_to_le32(fifo_len + sizeof(*fifo_hdr));
261*2c3ea36aSJohannes Berg 
262*2c3ea36aSJohannes Berg 			fifo_hdr->fifo_num = cpu_to_le32(i);
263*2c3ea36aSJohannes Berg 
264*2c3ea36aSJohannes Berg 			/* Mark the number of TXF we're pulling now */
265*2c3ea36aSJohannes Berg 			iwl_trans_write_prph(fwrt->trans, TXF_CPU2_NUM, i +
266*2c3ea36aSJohannes Berg 				fwrt->smem_cfg.num_txfifo_entries);
267*2c3ea36aSJohannes Berg 
268*2c3ea36aSJohannes Berg 			fifo_hdr->available_bytes =
269*2c3ea36aSJohannes Berg 				cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
270*2c3ea36aSJohannes Berg 								TXF_CPU2_FIFO_ITEM_CNT));
271*2c3ea36aSJohannes Berg 			fifo_hdr->wr_ptr =
272*2c3ea36aSJohannes Berg 				cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
273*2c3ea36aSJohannes Berg 								TXF_CPU2_WR_PTR));
274*2c3ea36aSJohannes Berg 			fifo_hdr->rd_ptr =
275*2c3ea36aSJohannes Berg 				cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
276*2c3ea36aSJohannes Berg 								TXF_CPU2_RD_PTR));
277*2c3ea36aSJohannes Berg 			fifo_hdr->fence_ptr =
278*2c3ea36aSJohannes Berg 				cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
279*2c3ea36aSJohannes Berg 								TXF_CPU2_FENCE_PTR));
280*2c3ea36aSJohannes Berg 			fifo_hdr->fence_mode =
281*2c3ea36aSJohannes Berg 				cpu_to_le32(iwl_trans_read_prph(fwrt->trans,
282*2c3ea36aSJohannes Berg 								TXF_CPU2_LOCK_FENCE));
283*2c3ea36aSJohannes Berg 
284*2c3ea36aSJohannes Berg 			/* Set TXF_CPU2_READ_MODIFY_ADDR to TXF_CPU2_WR_PTR */
285*2c3ea36aSJohannes Berg 			iwl_trans_write_prph(fwrt->trans,
286*2c3ea36aSJohannes Berg 					     TXF_CPU2_READ_MODIFY_ADDR,
287*2c3ea36aSJohannes Berg 					     TXF_CPU2_WR_PTR);
288*2c3ea36aSJohannes Berg 
289*2c3ea36aSJohannes Berg 			/* Dummy-read to advance the read pointer to head */
290*2c3ea36aSJohannes Berg 			iwl_trans_read_prph(fwrt->trans,
291*2c3ea36aSJohannes Berg 					    TXF_CPU2_READ_MODIFY_DATA);
292*2c3ea36aSJohannes Berg 
293*2c3ea36aSJohannes Berg 			/* Read FIFO */
294*2c3ea36aSJohannes Berg 			fifo_len /= sizeof(u32); /* Size in DWORDS */
295*2c3ea36aSJohannes Berg 			for (j = 0; j < fifo_len; j++)
296*2c3ea36aSJohannes Berg 				fifo_data[j] =
297*2c3ea36aSJohannes Berg 					iwl_trans_read_prph(fwrt->trans,
298*2c3ea36aSJohannes Berg 							    TXF_CPU2_READ_MODIFY_DATA);
299*2c3ea36aSJohannes Berg 			*dump_data = iwl_fw_error_next_data(*dump_data);
300*2c3ea36aSJohannes Berg 		}
301*2c3ea36aSJohannes Berg 	}
302*2c3ea36aSJohannes Berg 
303*2c3ea36aSJohannes Berg 	iwl_trans_release_nic_access(fwrt->trans);
304*2c3ea36aSJohannes Berg }
305*2c3ea36aSJohannes Berg 
306*2c3ea36aSJohannes Berg struct iwl_prph_range {
307*2c3ea36aSJohannes Berg 	u32 start, end;
308*2c3ea36aSJohannes Berg };
309*2c3ea36aSJohannes Berg 
310*2c3ea36aSJohannes Berg static const struct iwl_prph_range iwl_prph_dump_addr_comm[] = {
311*2c3ea36aSJohannes Berg 	{ .start = 0x00a00000, .end = 0x00a00000 },
312*2c3ea36aSJohannes Berg 	{ .start = 0x00a0000c, .end = 0x00a00024 },
313*2c3ea36aSJohannes Berg 	{ .start = 0x00a0002c, .end = 0x00a0003c },
314*2c3ea36aSJohannes Berg 	{ .start = 0x00a00410, .end = 0x00a00418 },
315*2c3ea36aSJohannes Berg 	{ .start = 0x00a00420, .end = 0x00a00420 },
316*2c3ea36aSJohannes Berg 	{ .start = 0x00a00428, .end = 0x00a00428 },
317*2c3ea36aSJohannes Berg 	{ .start = 0x00a00430, .end = 0x00a0043c },
318*2c3ea36aSJohannes Berg 	{ .start = 0x00a00444, .end = 0x00a00444 },
319*2c3ea36aSJohannes Berg 	{ .start = 0x00a004c0, .end = 0x00a004cc },
320*2c3ea36aSJohannes Berg 	{ .start = 0x00a004d8, .end = 0x00a004d8 },
321*2c3ea36aSJohannes Berg 	{ .start = 0x00a004e0, .end = 0x00a004f0 },
322*2c3ea36aSJohannes Berg 	{ .start = 0x00a00840, .end = 0x00a00840 },
323*2c3ea36aSJohannes Berg 	{ .start = 0x00a00850, .end = 0x00a00858 },
324*2c3ea36aSJohannes Berg 	{ .start = 0x00a01004, .end = 0x00a01008 },
325*2c3ea36aSJohannes Berg 	{ .start = 0x00a01010, .end = 0x00a01010 },
326*2c3ea36aSJohannes Berg 	{ .start = 0x00a01018, .end = 0x00a01018 },
327*2c3ea36aSJohannes Berg 	{ .start = 0x00a01024, .end = 0x00a01024 },
328*2c3ea36aSJohannes Berg 	{ .start = 0x00a0102c, .end = 0x00a01034 },
329*2c3ea36aSJohannes Berg 	{ .start = 0x00a0103c, .end = 0x00a01040 },
330*2c3ea36aSJohannes Berg 	{ .start = 0x00a01048, .end = 0x00a01094 },
331*2c3ea36aSJohannes Berg 	{ .start = 0x00a01c00, .end = 0x00a01c20 },
332*2c3ea36aSJohannes Berg 	{ .start = 0x00a01c58, .end = 0x00a01c58 },
333*2c3ea36aSJohannes Berg 	{ .start = 0x00a01c7c, .end = 0x00a01c7c },
334*2c3ea36aSJohannes Berg 	{ .start = 0x00a01c28, .end = 0x00a01c54 },
335*2c3ea36aSJohannes Berg 	{ .start = 0x00a01c5c, .end = 0x00a01c5c },
336*2c3ea36aSJohannes Berg 	{ .start = 0x00a01c60, .end = 0x00a01cdc },
337*2c3ea36aSJohannes Berg 	{ .start = 0x00a01ce0, .end = 0x00a01d0c },
338*2c3ea36aSJohannes Berg 	{ .start = 0x00a01d18, .end = 0x00a01d20 },
339*2c3ea36aSJohannes Berg 	{ .start = 0x00a01d2c, .end = 0x00a01d30 },
340*2c3ea36aSJohannes Berg 	{ .start = 0x00a01d40, .end = 0x00a01d5c },
341*2c3ea36aSJohannes Berg 	{ .start = 0x00a01d80, .end = 0x00a01d80 },
342*2c3ea36aSJohannes Berg 	{ .start = 0x00a01d98, .end = 0x00a01d9c },
343*2c3ea36aSJohannes Berg 	{ .start = 0x00a01da8, .end = 0x00a01da8 },
344*2c3ea36aSJohannes Berg 	{ .start = 0x00a01db8, .end = 0x00a01df4 },
345*2c3ea36aSJohannes Berg 	{ .start = 0x00a01dc0, .end = 0x00a01dfc },
346*2c3ea36aSJohannes Berg 	{ .start = 0x00a01e00, .end = 0x00a01e2c },
347*2c3ea36aSJohannes Berg 	{ .start = 0x00a01e40, .end = 0x00a01e60 },
348*2c3ea36aSJohannes Berg 	{ .start = 0x00a01e68, .end = 0x00a01e6c },
349*2c3ea36aSJohannes Berg 	{ .start = 0x00a01e74, .end = 0x00a01e74 },
350*2c3ea36aSJohannes Berg 	{ .start = 0x00a01e84, .end = 0x00a01e90 },
351*2c3ea36aSJohannes Berg 	{ .start = 0x00a01e9c, .end = 0x00a01ec4 },
352*2c3ea36aSJohannes Berg 	{ .start = 0x00a01ed0, .end = 0x00a01ee0 },
353*2c3ea36aSJohannes Berg 	{ .start = 0x00a01f00, .end = 0x00a01f1c },
354*2c3ea36aSJohannes Berg 	{ .start = 0x00a01f44, .end = 0x00a01ffc },
355*2c3ea36aSJohannes Berg 	{ .start = 0x00a02000, .end = 0x00a02048 },
356*2c3ea36aSJohannes Berg 	{ .start = 0x00a02068, .end = 0x00a020f0 },
357*2c3ea36aSJohannes Berg 	{ .start = 0x00a02100, .end = 0x00a02118 },
358*2c3ea36aSJohannes Berg 	{ .start = 0x00a02140, .end = 0x00a0214c },
359*2c3ea36aSJohannes Berg 	{ .start = 0x00a02168, .end = 0x00a0218c },
360*2c3ea36aSJohannes Berg 	{ .start = 0x00a021c0, .end = 0x00a021c0 },
361*2c3ea36aSJohannes Berg 	{ .start = 0x00a02400, .end = 0x00a02410 },
362*2c3ea36aSJohannes Berg 	{ .start = 0x00a02418, .end = 0x00a02420 },
363*2c3ea36aSJohannes Berg 	{ .start = 0x00a02428, .end = 0x00a0242c },
364*2c3ea36aSJohannes Berg 	{ .start = 0x00a02434, .end = 0x00a02434 },
365*2c3ea36aSJohannes Berg 	{ .start = 0x00a02440, .end = 0x00a02460 },
366*2c3ea36aSJohannes Berg 	{ .start = 0x00a02468, .end = 0x00a024b0 },
367*2c3ea36aSJohannes Berg 	{ .start = 0x00a024c8, .end = 0x00a024cc },
368*2c3ea36aSJohannes Berg 	{ .start = 0x00a02500, .end = 0x00a02504 },
369*2c3ea36aSJohannes Berg 	{ .start = 0x00a0250c, .end = 0x00a02510 },
370*2c3ea36aSJohannes Berg 	{ .start = 0x00a02540, .end = 0x00a02554 },
371*2c3ea36aSJohannes Berg 	{ .start = 0x00a02580, .end = 0x00a025f4 },
372*2c3ea36aSJohannes Berg 	{ .start = 0x00a02600, .end = 0x00a0260c },
373*2c3ea36aSJohannes Berg 	{ .start = 0x00a02648, .end = 0x00a02650 },
374*2c3ea36aSJohannes Berg 	{ .start = 0x00a02680, .end = 0x00a02680 },
375*2c3ea36aSJohannes Berg 	{ .start = 0x00a026c0, .end = 0x00a026d0 },
376*2c3ea36aSJohannes Berg 	{ .start = 0x00a02700, .end = 0x00a0270c },
377*2c3ea36aSJohannes Berg 	{ .start = 0x00a02804, .end = 0x00a02804 },
378*2c3ea36aSJohannes Berg 	{ .start = 0x00a02818, .end = 0x00a0281c },
379*2c3ea36aSJohannes Berg 	{ .start = 0x00a02c00, .end = 0x00a02db4 },
380*2c3ea36aSJohannes Berg 	{ .start = 0x00a02df4, .end = 0x00a02fb0 },
381*2c3ea36aSJohannes Berg 	{ .start = 0x00a03000, .end = 0x00a03014 },
382*2c3ea36aSJohannes Berg 	{ .start = 0x00a0301c, .end = 0x00a0302c },
383*2c3ea36aSJohannes Berg 	{ .start = 0x00a03034, .end = 0x00a03038 },
384*2c3ea36aSJohannes Berg 	{ .start = 0x00a03040, .end = 0x00a03048 },
385*2c3ea36aSJohannes Berg 	{ .start = 0x00a03060, .end = 0x00a03068 },
386*2c3ea36aSJohannes Berg 	{ .start = 0x00a03070, .end = 0x00a03074 },
387*2c3ea36aSJohannes Berg 	{ .start = 0x00a0307c, .end = 0x00a0307c },
388*2c3ea36aSJohannes Berg 	{ .start = 0x00a03080, .end = 0x00a03084 },
389*2c3ea36aSJohannes Berg 	{ .start = 0x00a0308c, .end = 0x00a03090 },
390*2c3ea36aSJohannes Berg 	{ .start = 0x00a03098, .end = 0x00a03098 },
391*2c3ea36aSJohannes Berg 	{ .start = 0x00a030a0, .end = 0x00a030a0 },
392*2c3ea36aSJohannes Berg 	{ .start = 0x00a030a8, .end = 0x00a030b4 },
393*2c3ea36aSJohannes Berg 	{ .start = 0x00a030bc, .end = 0x00a030bc },
394*2c3ea36aSJohannes Berg 	{ .start = 0x00a030c0, .end = 0x00a0312c },
395*2c3ea36aSJohannes Berg 	{ .start = 0x00a03c00, .end = 0x00a03c5c },
396*2c3ea36aSJohannes Berg 	{ .start = 0x00a04400, .end = 0x00a04454 },
397*2c3ea36aSJohannes Berg 	{ .start = 0x00a04460, .end = 0x00a04474 },
398*2c3ea36aSJohannes Berg 	{ .start = 0x00a044c0, .end = 0x00a044ec },
399*2c3ea36aSJohannes Berg 	{ .start = 0x00a04500, .end = 0x00a04504 },
400*2c3ea36aSJohannes Berg 	{ .start = 0x00a04510, .end = 0x00a04538 },
401*2c3ea36aSJohannes Berg 	{ .start = 0x00a04540, .end = 0x00a04548 },
402*2c3ea36aSJohannes Berg 	{ .start = 0x00a04560, .end = 0x00a0457c },
403*2c3ea36aSJohannes Berg 	{ .start = 0x00a04590, .end = 0x00a04598 },
404*2c3ea36aSJohannes Berg 	{ .start = 0x00a045c0, .end = 0x00a045f4 },
405*2c3ea36aSJohannes Berg };
406*2c3ea36aSJohannes Berg 
407*2c3ea36aSJohannes Berg static const struct iwl_prph_range iwl_prph_dump_addr_9000[] = {
408*2c3ea36aSJohannes Berg 	{ .start = 0x00a05c00, .end = 0x00a05c18 },
409*2c3ea36aSJohannes Berg 	{ .start = 0x00a05400, .end = 0x00a056e8 },
410*2c3ea36aSJohannes Berg 	{ .start = 0x00a08000, .end = 0x00a098bc },
411*2c3ea36aSJohannes Berg 	{ .start = 0x00a02400, .end = 0x00a02758 },
412*2c3ea36aSJohannes Berg 	{ .start = 0x00a04764, .end = 0x00a0476c },
413*2c3ea36aSJohannes Berg 	{ .start = 0x00a04770, .end = 0x00a04774 },
414*2c3ea36aSJohannes Berg 	{ .start = 0x00a04620, .end = 0x00a04624 },
415*2c3ea36aSJohannes Berg };
416*2c3ea36aSJohannes Berg 
417*2c3ea36aSJohannes Berg static const struct iwl_prph_range iwl_prph_dump_addr_22000[] = {
418*2c3ea36aSJohannes Berg 	{ .start = 0x00a00000, .end = 0x00a00000 },
419*2c3ea36aSJohannes Berg 	{ .start = 0x00a0000c, .end = 0x00a00024 },
420*2c3ea36aSJohannes Berg 	{ .start = 0x00a0002c, .end = 0x00a00034 },
421*2c3ea36aSJohannes Berg 	{ .start = 0x00a0003c, .end = 0x00a0003c },
422*2c3ea36aSJohannes Berg 	{ .start = 0x00a00410, .end = 0x00a00418 },
423*2c3ea36aSJohannes Berg 	{ .start = 0x00a00420, .end = 0x00a00420 },
424*2c3ea36aSJohannes Berg 	{ .start = 0x00a00428, .end = 0x00a00428 },
425*2c3ea36aSJohannes Berg 	{ .start = 0x00a00430, .end = 0x00a0043c },
426*2c3ea36aSJohannes Berg 	{ .start = 0x00a00444, .end = 0x00a00444 },
427*2c3ea36aSJohannes Berg 	{ .start = 0x00a00840, .end = 0x00a00840 },
428*2c3ea36aSJohannes Berg 	{ .start = 0x00a00850, .end = 0x00a00858 },
429*2c3ea36aSJohannes Berg 	{ .start = 0x00a01004, .end = 0x00a01008 },
430*2c3ea36aSJohannes Berg 	{ .start = 0x00a01010, .end = 0x00a01010 },
431*2c3ea36aSJohannes Berg 	{ .start = 0x00a01018, .end = 0x00a01018 },
432*2c3ea36aSJohannes Berg 	{ .start = 0x00a01024, .end = 0x00a01024 },
433*2c3ea36aSJohannes Berg 	{ .start = 0x00a0102c, .end = 0x00a01034 },
434*2c3ea36aSJohannes Berg 	{ .start = 0x00a0103c, .end = 0x00a01040 },
435*2c3ea36aSJohannes Berg 	{ .start = 0x00a01048, .end = 0x00a01050 },
436*2c3ea36aSJohannes Berg 	{ .start = 0x00a01058, .end = 0x00a01058 },
437*2c3ea36aSJohannes Berg 	{ .start = 0x00a01060, .end = 0x00a01070 },
438*2c3ea36aSJohannes Berg 	{ .start = 0x00a0108c, .end = 0x00a0108c },
439*2c3ea36aSJohannes Berg 	{ .start = 0x00a01c20, .end = 0x00a01c28 },
440*2c3ea36aSJohannes Berg 	{ .start = 0x00a01d10, .end = 0x00a01d10 },
441*2c3ea36aSJohannes Berg 	{ .start = 0x00a01e28, .end = 0x00a01e2c },
442*2c3ea36aSJohannes Berg 	{ .start = 0x00a01e60, .end = 0x00a01e60 },
443*2c3ea36aSJohannes Berg 	{ .start = 0x00a01e80, .end = 0x00a01e80 },
444*2c3ea36aSJohannes Berg 	{ .start = 0x00a01ea0, .end = 0x00a01ea0 },
445*2c3ea36aSJohannes Berg 	{ .start = 0x00a02000, .end = 0x00a0201c },
446*2c3ea36aSJohannes Berg 	{ .start = 0x00a02024, .end = 0x00a02024 },
447*2c3ea36aSJohannes Berg 	{ .start = 0x00a02040, .end = 0x00a02048 },
448*2c3ea36aSJohannes Berg 	{ .start = 0x00a020c0, .end = 0x00a020e0 },
449*2c3ea36aSJohannes Berg 	{ .start = 0x00a02400, .end = 0x00a02404 },
450*2c3ea36aSJohannes Berg 	{ .start = 0x00a0240c, .end = 0x00a02414 },
451*2c3ea36aSJohannes Berg 	{ .start = 0x00a0241c, .end = 0x00a0243c },
452*2c3ea36aSJohannes Berg 	{ .start = 0x00a02448, .end = 0x00a024bc },
453*2c3ea36aSJohannes Berg 	{ .start = 0x00a024c4, .end = 0x00a024cc },
454*2c3ea36aSJohannes Berg 	{ .start = 0x00a02508, .end = 0x00a02508 },
455*2c3ea36aSJohannes Berg 	{ .start = 0x00a02510, .end = 0x00a02514 },
456*2c3ea36aSJohannes Berg 	{ .start = 0x00a0251c, .end = 0x00a0251c },
457*2c3ea36aSJohannes Berg 	{ .start = 0x00a0252c, .end = 0x00a0255c },
458*2c3ea36aSJohannes Berg 	{ .start = 0x00a02564, .end = 0x00a025a0 },
459*2c3ea36aSJohannes Berg 	{ .start = 0x00a025a8, .end = 0x00a025b4 },
460*2c3ea36aSJohannes Berg 	{ .start = 0x00a025c0, .end = 0x00a025c0 },
461*2c3ea36aSJohannes Berg 	{ .start = 0x00a025e8, .end = 0x00a025f4 },
462*2c3ea36aSJohannes Berg 	{ .start = 0x00a02c08, .end = 0x00a02c18 },
463*2c3ea36aSJohannes Berg 	{ .start = 0x00a02c2c, .end = 0x00a02c38 },
464*2c3ea36aSJohannes Berg 	{ .start = 0x00a02c68, .end = 0x00a02c78 },
465*2c3ea36aSJohannes Berg 	{ .start = 0x00a03000, .end = 0x00a03000 },
466*2c3ea36aSJohannes Berg 	{ .start = 0x00a03010, .end = 0x00a03014 },
467*2c3ea36aSJohannes Berg 	{ .start = 0x00a0301c, .end = 0x00a0302c },
468*2c3ea36aSJohannes Berg 	{ .start = 0x00a03034, .end = 0x00a03038 },
469*2c3ea36aSJohannes Berg 	{ .start = 0x00a03040, .end = 0x00a03044 },
470*2c3ea36aSJohannes Berg 	{ .start = 0x00a03060, .end = 0x00a03068 },
471*2c3ea36aSJohannes Berg 	{ .start = 0x00a03070, .end = 0x00a03070 },
472*2c3ea36aSJohannes Berg 	{ .start = 0x00a0307c, .end = 0x00a03084 },
473*2c3ea36aSJohannes Berg 	{ .start = 0x00a0308c, .end = 0x00a03090 },
474*2c3ea36aSJohannes Berg 	{ .start = 0x00a03098, .end = 0x00a03098 },
475*2c3ea36aSJohannes Berg 	{ .start = 0x00a030a0, .end = 0x00a030a0 },
476*2c3ea36aSJohannes Berg 	{ .start = 0x00a030a8, .end = 0x00a030b4 },
477*2c3ea36aSJohannes Berg 	{ .start = 0x00a030bc, .end = 0x00a030c0 },
478*2c3ea36aSJohannes Berg 	{ .start = 0x00a030c8, .end = 0x00a030f4 },
479*2c3ea36aSJohannes Berg 	{ .start = 0x00a03100, .end = 0x00a0312c },
480*2c3ea36aSJohannes Berg 	{ .start = 0x00a03c00, .end = 0x00a03c5c },
481*2c3ea36aSJohannes Berg 	{ .start = 0x00a04400, .end = 0x00a04454 },
482*2c3ea36aSJohannes Berg 	{ .start = 0x00a04460, .end = 0x00a04474 },
483*2c3ea36aSJohannes Berg 	{ .start = 0x00a044c0, .end = 0x00a044ec },
484*2c3ea36aSJohannes Berg 	{ .start = 0x00a04500, .end = 0x00a04504 },
485*2c3ea36aSJohannes Berg 	{ .start = 0x00a04510, .end = 0x00a04538 },
486*2c3ea36aSJohannes Berg 	{ .start = 0x00a04540, .end = 0x00a04548 },
487*2c3ea36aSJohannes Berg 	{ .start = 0x00a04560, .end = 0x00a04560 },
488*2c3ea36aSJohannes Berg 	{ .start = 0x00a04570, .end = 0x00a0457c },
489*2c3ea36aSJohannes Berg 	{ .start = 0x00a04590, .end = 0x00a04590 },
490*2c3ea36aSJohannes Berg 	{ .start = 0x00a04598, .end = 0x00a04598 },
491*2c3ea36aSJohannes Berg 	{ .start = 0x00a045c0, .end = 0x00a045f4 },
492*2c3ea36aSJohannes Berg 	{ .start = 0x00a05c18, .end = 0x00a05c1c },
493*2c3ea36aSJohannes Berg 	{ .start = 0x00a0c000, .end = 0x00a0c018 },
494*2c3ea36aSJohannes Berg 	{ .start = 0x00a0c020, .end = 0x00a0c028 },
495*2c3ea36aSJohannes Berg 	{ .start = 0x00a0c038, .end = 0x00a0c094 },
496*2c3ea36aSJohannes Berg 	{ .start = 0x00a0c0c0, .end = 0x00a0c104 },
497*2c3ea36aSJohannes Berg 	{ .start = 0x00a0c10c, .end = 0x00a0c118 },
498*2c3ea36aSJohannes Berg 	{ .start = 0x00a0c150, .end = 0x00a0c174 },
499*2c3ea36aSJohannes Berg 	{ .start = 0x00a0c17c, .end = 0x00a0c188 },
500*2c3ea36aSJohannes Berg 	{ .start = 0x00a0c190, .end = 0x00a0c198 },
501*2c3ea36aSJohannes Berg 	{ .start = 0x00a0c1a0, .end = 0x00a0c1a8 },
502*2c3ea36aSJohannes Berg 	{ .start = 0x00a0c1b0, .end = 0x00a0c1b8 },
503*2c3ea36aSJohannes Berg };
504*2c3ea36aSJohannes Berg 
505*2c3ea36aSJohannes Berg static const struct iwl_prph_range iwl_prph_dump_addr_ax210[] = {
506*2c3ea36aSJohannes Berg 	{ .start = 0x00d03c00, .end = 0x00d03c64 },
507*2c3ea36aSJohannes Berg 	{ .start = 0x00d05c18, .end = 0x00d05c1c },
508*2c3ea36aSJohannes Berg 	{ .start = 0x00d0c000, .end = 0x00d0c174 },
509*2c3ea36aSJohannes Berg };
510*2c3ea36aSJohannes Berg 
511*2c3ea36aSJohannes Berg static void iwl_read_prph_block(struct iwl_trans *trans, u32 start,
512*2c3ea36aSJohannes Berg 				u32 len_bytes, __le32 *data)
513*2c3ea36aSJohannes Berg {
514*2c3ea36aSJohannes Berg 	u32 i;
515*2c3ea36aSJohannes Berg 
516*2c3ea36aSJohannes Berg 	for (i = 0; i < len_bytes; i += 4)
517*2c3ea36aSJohannes Berg 		*data++ = cpu_to_le32(iwl_trans_read_prph(trans, start + i));
518*2c3ea36aSJohannes Berg }
519*2c3ea36aSJohannes Berg 
520*2c3ea36aSJohannes Berg static void iwl_dump_prph(struct iwl_fw_runtime *fwrt,
521*2c3ea36aSJohannes Berg 			  const struct iwl_prph_range *iwl_prph_dump_addr,
522*2c3ea36aSJohannes Berg 			  u32 range_len, void *ptr)
523*2c3ea36aSJohannes Berg {
524*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_prph *prph;
525*2c3ea36aSJohannes Berg 	struct iwl_trans *trans = fwrt->trans;
526*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_data **data =
527*2c3ea36aSJohannes Berg 		(struct iwl_fw_error_dump_data **)ptr;
528*2c3ea36aSJohannes Berg 	u32 i;
529*2c3ea36aSJohannes Berg 
530*2c3ea36aSJohannes Berg 	if (!data)
531*2c3ea36aSJohannes Berg 		return;
532*2c3ea36aSJohannes Berg 
533*2c3ea36aSJohannes Berg 	IWL_DEBUG_INFO(trans, "WRT PRPH dump\n");
534*2c3ea36aSJohannes Berg 
535*2c3ea36aSJohannes Berg 	if (!iwl_trans_grab_nic_access(trans))
536*2c3ea36aSJohannes Berg 		return;
537*2c3ea36aSJohannes Berg 
538*2c3ea36aSJohannes Berg 	for (i = 0; i < range_len; i++) {
539*2c3ea36aSJohannes Berg 		/* The range includes both boundaries */
540*2c3ea36aSJohannes Berg 		int num_bytes_in_chunk = iwl_prph_dump_addr[i].end -
541*2c3ea36aSJohannes Berg 			 iwl_prph_dump_addr[i].start + 4;
542*2c3ea36aSJohannes Berg 
543*2c3ea36aSJohannes Berg 		(*data)->type = cpu_to_le32(IWL_FW_ERROR_DUMP_PRPH);
544*2c3ea36aSJohannes Berg 		(*data)->len = cpu_to_le32(sizeof(*prph) +
545*2c3ea36aSJohannes Berg 					num_bytes_in_chunk);
546*2c3ea36aSJohannes Berg 		prph = (void *)(*data)->data;
547*2c3ea36aSJohannes Berg 		prph->prph_start = cpu_to_le32(iwl_prph_dump_addr[i].start);
548*2c3ea36aSJohannes Berg 
549*2c3ea36aSJohannes Berg 		iwl_read_prph_block(trans, iwl_prph_dump_addr[i].start,
550*2c3ea36aSJohannes Berg 				    /* our range is inclusive, hence + 4 */
551*2c3ea36aSJohannes Berg 				    iwl_prph_dump_addr[i].end -
552*2c3ea36aSJohannes Berg 				    iwl_prph_dump_addr[i].start + 4,
553*2c3ea36aSJohannes Berg 				    (void *)prph->data);
554*2c3ea36aSJohannes Berg 
555*2c3ea36aSJohannes Berg 		*data = iwl_fw_error_next_data(*data);
556*2c3ea36aSJohannes Berg 	}
557*2c3ea36aSJohannes Berg 
558*2c3ea36aSJohannes Berg 	iwl_trans_release_nic_access(trans);
559*2c3ea36aSJohannes Berg }
560*2c3ea36aSJohannes Berg 
561*2c3ea36aSJohannes Berg static void iwl_fw_get_prph_len(struct iwl_fw_runtime *fwrt,
562*2c3ea36aSJohannes Berg 				const struct iwl_prph_range *iwl_prph_dump_addr,
563*2c3ea36aSJohannes Berg 				u32 range_len, void *ptr)
564*2c3ea36aSJohannes Berg {
565*2c3ea36aSJohannes Berg 	u32 *prph_len = (u32 *)ptr;
566*2c3ea36aSJohannes Berg 	int i, num_bytes_in_chunk;
567*2c3ea36aSJohannes Berg 
568*2c3ea36aSJohannes Berg 	if (!prph_len)
569*2c3ea36aSJohannes Berg 		return;
570*2c3ea36aSJohannes Berg 
571*2c3ea36aSJohannes Berg 	for (i = 0; i < range_len; i++) {
572*2c3ea36aSJohannes Berg 		/* The range includes both boundaries */
573*2c3ea36aSJohannes Berg 		num_bytes_in_chunk =
574*2c3ea36aSJohannes Berg 			iwl_prph_dump_addr[i].end -
575*2c3ea36aSJohannes Berg 			iwl_prph_dump_addr[i].start + 4;
576*2c3ea36aSJohannes Berg 
577*2c3ea36aSJohannes Berg 		*prph_len += sizeof(struct iwl_fw_error_dump_data) +
578*2c3ea36aSJohannes Berg 			sizeof(struct iwl_fw_error_dump_prph) +
579*2c3ea36aSJohannes Berg 			num_bytes_in_chunk;
580*2c3ea36aSJohannes Berg 	}
581*2c3ea36aSJohannes Berg }
582*2c3ea36aSJohannes Berg 
583*2c3ea36aSJohannes Berg static void iwl_fw_prph_handler(struct iwl_fw_runtime *fwrt, void *ptr,
584*2c3ea36aSJohannes Berg 				void (*handler)(struct iwl_fw_runtime *,
585*2c3ea36aSJohannes Berg 						const struct iwl_prph_range *,
586*2c3ea36aSJohannes Berg 						u32, void *))
587*2c3ea36aSJohannes Berg {
588*2c3ea36aSJohannes Berg 	u32 range_len;
589*2c3ea36aSJohannes Berg 
590*2c3ea36aSJohannes Berg 	if (fwrt->trans->mac_cfg->device_family >= IWL_DEVICE_FAMILY_AX210) {
591*2c3ea36aSJohannes Berg 		range_len = ARRAY_SIZE(iwl_prph_dump_addr_ax210);
592*2c3ea36aSJohannes Berg 		handler(fwrt, iwl_prph_dump_addr_ax210, range_len, ptr);
593*2c3ea36aSJohannes Berg 	} else if (fwrt->trans->mac_cfg->device_family >=
594*2c3ea36aSJohannes Berg 		   IWL_DEVICE_FAMILY_22000) {
595*2c3ea36aSJohannes Berg 		range_len = ARRAY_SIZE(iwl_prph_dump_addr_22000);
596*2c3ea36aSJohannes Berg 		handler(fwrt, iwl_prph_dump_addr_22000, range_len, ptr);
597*2c3ea36aSJohannes Berg 	} else {
598*2c3ea36aSJohannes Berg 		range_len = ARRAY_SIZE(iwl_prph_dump_addr_comm);
599*2c3ea36aSJohannes Berg 		handler(fwrt, iwl_prph_dump_addr_comm, range_len, ptr);
600*2c3ea36aSJohannes Berg 
601*2c3ea36aSJohannes Berg 		if (fwrt->trans->mac_cfg->mq_rx_supported) {
602*2c3ea36aSJohannes Berg 			range_len = ARRAY_SIZE(iwl_prph_dump_addr_9000);
603*2c3ea36aSJohannes Berg 			handler(fwrt, iwl_prph_dump_addr_9000, range_len, ptr);
604*2c3ea36aSJohannes Berg 		}
605*2c3ea36aSJohannes Berg 	}
606*2c3ea36aSJohannes Berg }
607*2c3ea36aSJohannes Berg 
608*2c3ea36aSJohannes Berg static void iwl_fw_dump_mem(struct iwl_fw_runtime *fwrt,
609*2c3ea36aSJohannes Berg 			    struct iwl_fw_error_dump_data **dump_data,
610*2c3ea36aSJohannes Berg 			    u32 len, u32 ofs, u32 type)
611*2c3ea36aSJohannes Berg {
612*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_mem *dump_mem;
613*2c3ea36aSJohannes Berg 
614*2c3ea36aSJohannes Berg 	if (!len)
615*2c3ea36aSJohannes Berg 		return;
616*2c3ea36aSJohannes Berg 
617*2c3ea36aSJohannes Berg 	(*dump_data)->type = cpu_to_le32(IWL_FW_ERROR_DUMP_MEM);
618*2c3ea36aSJohannes Berg 	(*dump_data)->len = cpu_to_le32(len + sizeof(*dump_mem));
619*2c3ea36aSJohannes Berg 	dump_mem = (void *)(*dump_data)->data;
620*2c3ea36aSJohannes Berg 	dump_mem->type = cpu_to_le32(type);
621*2c3ea36aSJohannes Berg 	dump_mem->offset = cpu_to_le32(ofs);
622*2c3ea36aSJohannes Berg 	iwl_trans_read_mem_bytes(fwrt->trans, ofs, dump_mem->data, len);
623*2c3ea36aSJohannes Berg 	*dump_data = iwl_fw_error_next_data(*dump_data);
624*2c3ea36aSJohannes Berg 
625*2c3ea36aSJohannes Berg 	if (fwrt->sanitize_ops && fwrt->sanitize_ops->frob_mem)
626*2c3ea36aSJohannes Berg 		fwrt->sanitize_ops->frob_mem(fwrt->sanitize_ctx, ofs,
627*2c3ea36aSJohannes Berg 					     dump_mem->data, len);
628*2c3ea36aSJohannes Berg 
629*2c3ea36aSJohannes Berg 	IWL_DEBUG_INFO(fwrt, "WRT memory dump. Type=%u\n", dump_mem->type);
630*2c3ea36aSJohannes Berg }
631*2c3ea36aSJohannes Berg 
632*2c3ea36aSJohannes Berg #define ADD_LEN(len, item_len, const_len) \
633*2c3ea36aSJohannes Berg 	do {size_t item = item_len; len += (!!item) * const_len + item; } \
634*2c3ea36aSJohannes Berg 	while (0)
635*2c3ea36aSJohannes Berg 
636*2c3ea36aSJohannes Berg static int iwl_fw_rxf_len(struct iwl_fw_runtime *fwrt,
637*2c3ea36aSJohannes Berg 			  struct iwl_fwrt_shared_mem_cfg *mem_cfg)
638*2c3ea36aSJohannes Berg {
639*2c3ea36aSJohannes Berg 	size_t hdr_len = sizeof(struct iwl_fw_error_dump_data) +
640*2c3ea36aSJohannes Berg 			 sizeof(struct iwl_fw_error_dump_fifo);
641*2c3ea36aSJohannes Berg 	u32 fifo_len = 0;
642*2c3ea36aSJohannes Berg 	int i;
643*2c3ea36aSJohannes Berg 
644*2c3ea36aSJohannes Berg 	if (!iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_RXF))
645*2c3ea36aSJohannes Berg 		return 0;
646*2c3ea36aSJohannes Berg 
647*2c3ea36aSJohannes Berg 	/* Count RXF2 size */
648*2c3ea36aSJohannes Berg 	ADD_LEN(fifo_len, mem_cfg->rxfifo2_size, hdr_len);
649*2c3ea36aSJohannes Berg 
650*2c3ea36aSJohannes Berg 	/* Count RXF1 sizes */
651*2c3ea36aSJohannes Berg 	if (WARN_ON(mem_cfg->num_lmacs > MAX_NUM_LMAC))
652*2c3ea36aSJohannes Berg 		mem_cfg->num_lmacs = MAX_NUM_LMAC;
653*2c3ea36aSJohannes Berg 
654*2c3ea36aSJohannes Berg 	for (i = 0; i < mem_cfg->num_lmacs; i++)
655*2c3ea36aSJohannes Berg 		ADD_LEN(fifo_len, mem_cfg->lmac[i].rxfifo1_size, hdr_len);
656*2c3ea36aSJohannes Berg 
657*2c3ea36aSJohannes Berg 	return fifo_len;
658*2c3ea36aSJohannes Berg }
659*2c3ea36aSJohannes Berg 
660*2c3ea36aSJohannes Berg static int iwl_fw_txf_len(struct iwl_fw_runtime *fwrt,
661*2c3ea36aSJohannes Berg 			  struct iwl_fwrt_shared_mem_cfg *mem_cfg)
662*2c3ea36aSJohannes Berg {
663*2c3ea36aSJohannes Berg 	size_t hdr_len = sizeof(struct iwl_fw_error_dump_data) +
664*2c3ea36aSJohannes Berg 			 sizeof(struct iwl_fw_error_dump_fifo);
665*2c3ea36aSJohannes Berg 	u32 fifo_len = 0;
666*2c3ea36aSJohannes Berg 	int i;
667*2c3ea36aSJohannes Berg 
668*2c3ea36aSJohannes Berg 	if (!iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_TXF))
669*2c3ea36aSJohannes Berg 		goto dump_internal_txf;
670*2c3ea36aSJohannes Berg 
671*2c3ea36aSJohannes Berg 	/* Count TXF sizes */
672*2c3ea36aSJohannes Berg 	if (WARN_ON(mem_cfg->num_lmacs > MAX_NUM_LMAC))
673*2c3ea36aSJohannes Berg 		mem_cfg->num_lmacs = MAX_NUM_LMAC;
674*2c3ea36aSJohannes Berg 
675*2c3ea36aSJohannes Berg 	for (i = 0; i < mem_cfg->num_lmacs; i++) {
676*2c3ea36aSJohannes Berg 		int j;
677*2c3ea36aSJohannes Berg 
678*2c3ea36aSJohannes Berg 		for (j = 0; j < mem_cfg->num_txfifo_entries; j++)
679*2c3ea36aSJohannes Berg 			ADD_LEN(fifo_len, mem_cfg->lmac[i].txfifo_size[j],
680*2c3ea36aSJohannes Berg 				hdr_len);
681*2c3ea36aSJohannes Berg 	}
682*2c3ea36aSJohannes Berg 
683*2c3ea36aSJohannes Berg dump_internal_txf:
684*2c3ea36aSJohannes Berg 	if (!(iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_INTERNAL_TXF) &&
685*2c3ea36aSJohannes Berg 	      fw_has_capa(&fwrt->fw->ucode_capa,
686*2c3ea36aSJohannes Berg 			  IWL_UCODE_TLV_CAPA_EXTEND_SHARED_MEM_CFG)))
687*2c3ea36aSJohannes Berg 		goto out;
688*2c3ea36aSJohannes Berg 
689*2c3ea36aSJohannes Berg 	for (i = 0; i < ARRAY_SIZE(mem_cfg->internal_txfifo_size); i++)
690*2c3ea36aSJohannes Berg 		ADD_LEN(fifo_len, mem_cfg->internal_txfifo_size[i], hdr_len);
691*2c3ea36aSJohannes Berg 
692*2c3ea36aSJohannes Berg out:
693*2c3ea36aSJohannes Berg 	return fifo_len;
694*2c3ea36aSJohannes Berg }
695*2c3ea36aSJohannes Berg 
696*2c3ea36aSJohannes Berg static void iwl_dump_paging(struct iwl_fw_runtime *fwrt,
697*2c3ea36aSJohannes Berg 			    struct iwl_fw_error_dump_data **data)
698*2c3ea36aSJohannes Berg {
699*2c3ea36aSJohannes Berg 	int i;
700*2c3ea36aSJohannes Berg 
701*2c3ea36aSJohannes Berg 	IWL_DEBUG_INFO(fwrt, "WRT paging dump\n");
702*2c3ea36aSJohannes Berg 	for (i = 1; i < fwrt->num_of_paging_blk + 1; i++) {
703*2c3ea36aSJohannes Berg 		struct iwl_fw_error_dump_paging *paging;
704*2c3ea36aSJohannes Berg 		struct page *pages =
705*2c3ea36aSJohannes Berg 			fwrt->fw_paging_db[i].fw_paging_block;
706*2c3ea36aSJohannes Berg 		dma_addr_t addr = fwrt->fw_paging_db[i].fw_paging_phys;
707*2c3ea36aSJohannes Berg 
708*2c3ea36aSJohannes Berg 		(*data)->type = cpu_to_le32(IWL_FW_ERROR_DUMP_PAGING);
709*2c3ea36aSJohannes Berg 		(*data)->len = cpu_to_le32(sizeof(*paging) +
710*2c3ea36aSJohannes Berg 					     PAGING_BLOCK_SIZE);
711*2c3ea36aSJohannes Berg 		paging =  (void *)(*data)->data;
712*2c3ea36aSJohannes Berg 		paging->index = cpu_to_le32(i);
713*2c3ea36aSJohannes Berg 		dma_sync_single_for_cpu(fwrt->trans->dev, addr,
714*2c3ea36aSJohannes Berg 					PAGING_BLOCK_SIZE,
715*2c3ea36aSJohannes Berg 					DMA_BIDIRECTIONAL);
716*2c3ea36aSJohannes Berg 		memcpy(paging->data, page_address(pages),
717*2c3ea36aSJohannes Berg 		       PAGING_BLOCK_SIZE);
718*2c3ea36aSJohannes Berg 		dma_sync_single_for_device(fwrt->trans->dev, addr,
719*2c3ea36aSJohannes Berg 					   PAGING_BLOCK_SIZE,
720*2c3ea36aSJohannes Berg 					   DMA_BIDIRECTIONAL);
721*2c3ea36aSJohannes Berg 		(*data) = iwl_fw_error_next_data(*data);
722*2c3ea36aSJohannes Berg 
723*2c3ea36aSJohannes Berg 		if (fwrt->sanitize_ops && fwrt->sanitize_ops->frob_mem)
724*2c3ea36aSJohannes Berg 			fwrt->sanitize_ops->frob_mem(fwrt->sanitize_ctx,
725*2c3ea36aSJohannes Berg 						     fwrt->fw_paging_db[i].fw_offs,
726*2c3ea36aSJohannes Berg 						     paging->data,
727*2c3ea36aSJohannes Berg 						     PAGING_BLOCK_SIZE);
728*2c3ea36aSJohannes Berg 	}
729*2c3ea36aSJohannes Berg }
730*2c3ea36aSJohannes Berg 
731*2c3ea36aSJohannes Berg static struct iwl_fw_error_dump_file *
732*2c3ea36aSJohannes Berg iwl_fw_error_dump_file(struct iwl_fw_runtime *fwrt,
733*2c3ea36aSJohannes Berg 		       struct iwl_fw_dump_ptrs *fw_error_dump,
734*2c3ea36aSJohannes Berg 		       struct iwl_fwrt_dump_data *data)
735*2c3ea36aSJohannes Berg {
736*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_file *dump_file;
737*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_data *dump_data;
738*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_info *dump_info;
739*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_smem_cfg *dump_smem_cfg;
740*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_trigger_desc *dump_trig;
741*2c3ea36aSJohannes Berg 	u32 sram_len, sram_ofs;
742*2c3ea36aSJohannes Berg 	const struct iwl_fw_dbg_mem_seg_tlv *fw_mem = fwrt->fw->dbg.mem_tlv;
743*2c3ea36aSJohannes Berg 	struct iwl_fwrt_shared_mem_cfg *mem_cfg = &fwrt->smem_cfg;
744*2c3ea36aSJohannes Berg 	u32 file_len, fifo_len = 0, prph_len = 0, radio_len = 0;
745*2c3ea36aSJohannes Berg 	u32 smem_len = fwrt->fw->dbg.n_mem_tlv ? 0 : fwrt->trans->mac_cfg->base->smem_len;
746*2c3ea36aSJohannes Berg 	u32 sram2_len = fwrt->fw->dbg.n_mem_tlv ?
747*2c3ea36aSJohannes Berg 				0 : fwrt->trans->cfg->dccm2_len;
748*2c3ea36aSJohannes Berg 	int i;
749*2c3ea36aSJohannes Berg 
750*2c3ea36aSJohannes Berg 	/* SRAM - include stack CCM if driver knows the values for it */
751*2c3ea36aSJohannes Berg 	if (!fwrt->trans->cfg->dccm_offset ||
752*2c3ea36aSJohannes Berg 	    !fwrt->trans->cfg->dccm_len) {
753*2c3ea36aSJohannes Berg 		const struct fw_img *img;
754*2c3ea36aSJohannes Berg 
755*2c3ea36aSJohannes Berg 		if (fwrt->cur_fw_img >= IWL_UCODE_TYPE_MAX)
756*2c3ea36aSJohannes Berg 			return NULL;
757*2c3ea36aSJohannes Berg 		img = &fwrt->fw->img[fwrt->cur_fw_img];
758*2c3ea36aSJohannes Berg 		sram_ofs = img->sec[IWL_UCODE_SECTION_DATA].offset;
759*2c3ea36aSJohannes Berg 		sram_len = img->sec[IWL_UCODE_SECTION_DATA].len;
760*2c3ea36aSJohannes Berg 	} else {
761*2c3ea36aSJohannes Berg 		sram_ofs = fwrt->trans->cfg->dccm_offset;
762*2c3ea36aSJohannes Berg 		sram_len = fwrt->trans->cfg->dccm_len;
763*2c3ea36aSJohannes Berg 	}
764*2c3ea36aSJohannes Berg 
765*2c3ea36aSJohannes Berg 	/* reading RXF/TXF sizes */
766*2c3ea36aSJohannes Berg 	if (iwl_trans_is_fw_error(fwrt->trans)) {
767*2c3ea36aSJohannes Berg 		fifo_len = iwl_fw_rxf_len(fwrt, mem_cfg);
768*2c3ea36aSJohannes Berg 		fifo_len += iwl_fw_txf_len(fwrt, mem_cfg);
769*2c3ea36aSJohannes Berg 
770*2c3ea36aSJohannes Berg 		/* Make room for PRPH registers */
771*2c3ea36aSJohannes Berg 		if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_PRPH))
772*2c3ea36aSJohannes Berg 			iwl_fw_prph_handler(fwrt, &prph_len,
773*2c3ea36aSJohannes Berg 					    iwl_fw_get_prph_len);
774*2c3ea36aSJohannes Berg 
775*2c3ea36aSJohannes Berg 		if (fwrt->trans->mac_cfg->device_family ==
776*2c3ea36aSJohannes Berg 		    IWL_DEVICE_FAMILY_7000 &&
777*2c3ea36aSJohannes Berg 		    iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_RADIO_REG))
778*2c3ea36aSJohannes Berg 			radio_len = sizeof(*dump_data) + RADIO_REG_MAX_READ;
779*2c3ea36aSJohannes Berg 	}
780*2c3ea36aSJohannes Berg 
781*2c3ea36aSJohannes Berg 	file_len = sizeof(*dump_file) + fifo_len + prph_len + radio_len;
782*2c3ea36aSJohannes Berg 
783*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_DEV_FW_INFO))
784*2c3ea36aSJohannes Berg 		file_len += sizeof(*dump_data) + sizeof(*dump_info);
785*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_MEM_CFG))
786*2c3ea36aSJohannes Berg 		file_len += sizeof(*dump_data) + sizeof(*dump_smem_cfg);
787*2c3ea36aSJohannes Berg 
788*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_MEM)) {
789*2c3ea36aSJohannes Berg 		size_t hdr_len = sizeof(*dump_data) +
790*2c3ea36aSJohannes Berg 				 sizeof(struct iwl_fw_error_dump_mem);
791*2c3ea36aSJohannes Berg 
792*2c3ea36aSJohannes Berg 		/* Dump SRAM only if no mem_tlvs */
793*2c3ea36aSJohannes Berg 		if (!fwrt->fw->dbg.n_mem_tlv)
794*2c3ea36aSJohannes Berg 			ADD_LEN(file_len, sram_len, hdr_len);
795*2c3ea36aSJohannes Berg 
796*2c3ea36aSJohannes Berg 		/* Make room for all mem types that exist */
797*2c3ea36aSJohannes Berg 		ADD_LEN(file_len, smem_len, hdr_len);
798*2c3ea36aSJohannes Berg 		ADD_LEN(file_len, sram2_len, hdr_len);
799*2c3ea36aSJohannes Berg 
800*2c3ea36aSJohannes Berg 		for (i = 0; i < fwrt->fw->dbg.n_mem_tlv; i++)
801*2c3ea36aSJohannes Berg 			ADD_LEN(file_len, le32_to_cpu(fw_mem[i].len), hdr_len);
802*2c3ea36aSJohannes Berg 	}
803*2c3ea36aSJohannes Berg 
804*2c3ea36aSJohannes Berg 	/* Make room for fw's virtual image pages, if it exists */
805*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_is_paging_enabled(fwrt))
806*2c3ea36aSJohannes Berg 		file_len += fwrt->num_of_paging_blk *
807*2c3ea36aSJohannes Berg 			(sizeof(*dump_data) +
808*2c3ea36aSJohannes Berg 			 sizeof(struct iwl_fw_error_dump_paging) +
809*2c3ea36aSJohannes Berg 			 PAGING_BLOCK_SIZE);
810*2c3ea36aSJohannes Berg 
811*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_is_d3_debug_enabled(fwrt) && fwrt->dump.d3_debug_data) {
812*2c3ea36aSJohannes Berg 		file_len += sizeof(*dump_data) +
813*2c3ea36aSJohannes Berg 			fwrt->trans->mac_cfg->base->d3_debug_data_length * 2;
814*2c3ea36aSJohannes Berg 	}
815*2c3ea36aSJohannes Berg 
816*2c3ea36aSJohannes Berg 	/* If we only want a monitor dump, reset the file length */
817*2c3ea36aSJohannes Berg 	if (data->monitor_only) {
818*2c3ea36aSJohannes Berg 		file_len = sizeof(*dump_file) + sizeof(*dump_data) * 2 +
819*2c3ea36aSJohannes Berg 			   sizeof(*dump_info) + sizeof(*dump_smem_cfg);
820*2c3ea36aSJohannes Berg 	}
821*2c3ea36aSJohannes Berg 
822*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_ERROR_INFO) &&
823*2c3ea36aSJohannes Berg 	    data->desc)
824*2c3ea36aSJohannes Berg 		file_len += sizeof(*dump_data) + sizeof(*dump_trig) +
825*2c3ea36aSJohannes Berg 			data->desc->len;
826*2c3ea36aSJohannes Berg 
827*2c3ea36aSJohannes Berg 	dump_file = vzalloc(file_len);
828*2c3ea36aSJohannes Berg 	if (!dump_file)
829*2c3ea36aSJohannes Berg 		return NULL;
830*2c3ea36aSJohannes Berg 
831*2c3ea36aSJohannes Berg 	fw_error_dump->fwrt_ptr = dump_file;
832*2c3ea36aSJohannes Berg 
833*2c3ea36aSJohannes Berg 	dump_file->barker = cpu_to_le32(IWL_FW_ERROR_DUMP_BARKER);
834*2c3ea36aSJohannes Berg 	dump_data = (void *)dump_file->data;
835*2c3ea36aSJohannes Berg 
836*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_DEV_FW_INFO)) {
837*2c3ea36aSJohannes Berg 		dump_data->type = cpu_to_le32(IWL_FW_ERROR_DUMP_DEV_FW_INFO);
838*2c3ea36aSJohannes Berg 		dump_data->len = cpu_to_le32(sizeof(*dump_info));
839*2c3ea36aSJohannes Berg 		dump_info = (void *)dump_data->data;
840*2c3ea36aSJohannes Berg 		dump_info->hw_type =
841*2c3ea36aSJohannes Berg 			cpu_to_le32(CSR_HW_REV_TYPE(fwrt->trans->info.hw_rev));
842*2c3ea36aSJohannes Berg 		dump_info->hw_step =
843*2c3ea36aSJohannes Berg 			cpu_to_le32(fwrt->trans->info.hw_rev_step);
844*2c3ea36aSJohannes Berg 		memcpy(dump_info->fw_human_readable, fwrt->fw->human_readable,
845*2c3ea36aSJohannes Berg 		       sizeof(dump_info->fw_human_readable));
846*2c3ea36aSJohannes Berg 		strscpy_pad(dump_info->dev_human_readable,
847*2c3ea36aSJohannes Berg 			    fwrt->trans->info.name,
848*2c3ea36aSJohannes Berg 			    sizeof(dump_info->dev_human_readable));
849*2c3ea36aSJohannes Berg 		strscpy_pad(dump_info->bus_human_readable, fwrt->dev->bus->name,
850*2c3ea36aSJohannes Berg 			sizeof(dump_info->bus_human_readable));
851*2c3ea36aSJohannes Berg 		dump_info->num_of_lmacs = fwrt->smem_cfg.num_lmacs;
852*2c3ea36aSJohannes Berg 		dump_info->lmac_err_id[0] =
853*2c3ea36aSJohannes Berg 			cpu_to_le32(fwrt->dump.lmac_err_id[0]);
854*2c3ea36aSJohannes Berg 		if (fwrt->smem_cfg.num_lmacs > 1)
855*2c3ea36aSJohannes Berg 			dump_info->lmac_err_id[1] =
856*2c3ea36aSJohannes Berg 				cpu_to_le32(fwrt->dump.lmac_err_id[1]);
857*2c3ea36aSJohannes Berg 		dump_info->umac_err_id = cpu_to_le32(fwrt->dump.umac_err_id);
858*2c3ea36aSJohannes Berg 
859*2c3ea36aSJohannes Berg 		dump_data = iwl_fw_error_next_data(dump_data);
860*2c3ea36aSJohannes Berg 	}
861*2c3ea36aSJohannes Berg 
862*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_MEM_CFG)) {
863*2c3ea36aSJohannes Berg 		/* Dump shared memory configuration */
864*2c3ea36aSJohannes Berg 		dump_data->type = cpu_to_le32(IWL_FW_ERROR_DUMP_MEM_CFG);
865*2c3ea36aSJohannes Berg 		dump_data->len = cpu_to_le32(sizeof(*dump_smem_cfg));
866*2c3ea36aSJohannes Berg 		dump_smem_cfg = (void *)dump_data->data;
867*2c3ea36aSJohannes Berg 		dump_smem_cfg->num_lmacs = cpu_to_le32(mem_cfg->num_lmacs);
868*2c3ea36aSJohannes Berg 		dump_smem_cfg->num_txfifo_entries =
869*2c3ea36aSJohannes Berg 			cpu_to_le32(mem_cfg->num_txfifo_entries);
870*2c3ea36aSJohannes Berg 		for (i = 0; i < MAX_NUM_LMAC; i++) {
871*2c3ea36aSJohannes Berg 			int j;
872*2c3ea36aSJohannes Berg 			u32 *txf_size = mem_cfg->lmac[i].txfifo_size;
873*2c3ea36aSJohannes Berg 
874*2c3ea36aSJohannes Berg 			for (j = 0; j < TX_FIFO_MAX_NUM; j++)
875*2c3ea36aSJohannes Berg 				dump_smem_cfg->lmac[i].txfifo_size[j] =
876*2c3ea36aSJohannes Berg 					cpu_to_le32(txf_size[j]);
877*2c3ea36aSJohannes Berg 			dump_smem_cfg->lmac[i].rxfifo1_size =
878*2c3ea36aSJohannes Berg 				cpu_to_le32(mem_cfg->lmac[i].rxfifo1_size);
879*2c3ea36aSJohannes Berg 		}
880*2c3ea36aSJohannes Berg 		dump_smem_cfg->rxfifo2_size =
881*2c3ea36aSJohannes Berg 			cpu_to_le32(mem_cfg->rxfifo2_size);
882*2c3ea36aSJohannes Berg 		dump_smem_cfg->internal_txfifo_addr =
883*2c3ea36aSJohannes Berg 			cpu_to_le32(mem_cfg->internal_txfifo_addr);
884*2c3ea36aSJohannes Berg 		for (i = 0; i < TX_FIFO_INTERNAL_MAX_NUM; i++) {
885*2c3ea36aSJohannes Berg 			dump_smem_cfg->internal_txfifo_size[i] =
886*2c3ea36aSJohannes Berg 				cpu_to_le32(mem_cfg->internal_txfifo_size[i]);
887*2c3ea36aSJohannes Berg 		}
888*2c3ea36aSJohannes Berg 
889*2c3ea36aSJohannes Berg 		dump_data = iwl_fw_error_next_data(dump_data);
890*2c3ea36aSJohannes Berg 	}
891*2c3ea36aSJohannes Berg 
892*2c3ea36aSJohannes Berg 	/* We only dump the FIFOs if the FW is in error state */
893*2c3ea36aSJohannes Berg 	if (fifo_len) {
894*2c3ea36aSJohannes Berg 		iwl_fw_dump_rxf(fwrt, &dump_data);
895*2c3ea36aSJohannes Berg 		iwl_fw_dump_txf(fwrt, &dump_data);
896*2c3ea36aSJohannes Berg 	}
897*2c3ea36aSJohannes Berg 
898*2c3ea36aSJohannes Berg 	if (radio_len)
899*2c3ea36aSJohannes Berg 		iwl_read_radio_regs(fwrt, &dump_data);
900*2c3ea36aSJohannes Berg 
901*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_ERROR_INFO) &&
902*2c3ea36aSJohannes Berg 	    data->desc) {
903*2c3ea36aSJohannes Berg 		dump_data->type = cpu_to_le32(IWL_FW_ERROR_DUMP_ERROR_INFO);
904*2c3ea36aSJohannes Berg 		dump_data->len = cpu_to_le32(sizeof(*dump_trig) +
905*2c3ea36aSJohannes Berg 					     data->desc->len);
906*2c3ea36aSJohannes Berg 		dump_trig = (void *)dump_data->data;
907*2c3ea36aSJohannes Berg 		memcpy(dump_trig, &data->desc->trig_desc,
908*2c3ea36aSJohannes Berg 		       sizeof(*dump_trig) + data->desc->len);
909*2c3ea36aSJohannes Berg 
910*2c3ea36aSJohannes Berg 		dump_data = iwl_fw_error_next_data(dump_data);
911*2c3ea36aSJohannes Berg 	}
912*2c3ea36aSJohannes Berg 
913*2c3ea36aSJohannes Berg 	/* In case we only want monitor dump, skip to dump transport data */
914*2c3ea36aSJohannes Berg 	if (data->monitor_only)
915*2c3ea36aSJohannes Berg 		goto out;
916*2c3ea36aSJohannes Berg 
917*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_type_on(fwrt, IWL_FW_ERROR_DUMP_MEM)) {
918*2c3ea36aSJohannes Berg 		const struct iwl_fw_dbg_mem_seg_tlv *fw_dbg_mem =
919*2c3ea36aSJohannes Berg 			fwrt->fw->dbg.mem_tlv;
920*2c3ea36aSJohannes Berg 
921*2c3ea36aSJohannes Berg 		if (!fwrt->fw->dbg.n_mem_tlv)
922*2c3ea36aSJohannes Berg 			iwl_fw_dump_mem(fwrt, &dump_data, sram_len, sram_ofs,
923*2c3ea36aSJohannes Berg 					IWL_FW_ERROR_DUMP_MEM_SRAM);
924*2c3ea36aSJohannes Berg 
925*2c3ea36aSJohannes Berg 		for (i = 0; i < fwrt->fw->dbg.n_mem_tlv; i++) {
926*2c3ea36aSJohannes Berg 			u32 len = le32_to_cpu(fw_dbg_mem[i].len);
927*2c3ea36aSJohannes Berg 			u32 ofs = le32_to_cpu(fw_dbg_mem[i].ofs);
928*2c3ea36aSJohannes Berg 
929*2c3ea36aSJohannes Berg 			iwl_fw_dump_mem(fwrt, &dump_data, len, ofs,
930*2c3ea36aSJohannes Berg 					le32_to_cpu(fw_dbg_mem[i].data_type));
931*2c3ea36aSJohannes Berg 		}
932*2c3ea36aSJohannes Berg 
933*2c3ea36aSJohannes Berg 		iwl_fw_dump_mem(fwrt, &dump_data, smem_len,
934*2c3ea36aSJohannes Berg 				fwrt->trans->mac_cfg->base->smem_offset,
935*2c3ea36aSJohannes Berg 				IWL_FW_ERROR_DUMP_MEM_SMEM);
936*2c3ea36aSJohannes Berg 
937*2c3ea36aSJohannes Berg 		iwl_fw_dump_mem(fwrt, &dump_data, sram2_len,
938*2c3ea36aSJohannes Berg 				fwrt->trans->cfg->dccm2_offset,
939*2c3ea36aSJohannes Berg 				IWL_FW_ERROR_DUMP_MEM_SRAM);
940*2c3ea36aSJohannes Berg 	}
941*2c3ea36aSJohannes Berg 
942*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_is_d3_debug_enabled(fwrt) && fwrt->dump.d3_debug_data) {
943*2c3ea36aSJohannes Berg 		u32 addr = fwrt->trans->mac_cfg->base->d3_debug_data_base_addr;
944*2c3ea36aSJohannes Berg 		size_t data_size = fwrt->trans->mac_cfg->base->d3_debug_data_length;
945*2c3ea36aSJohannes Berg 
946*2c3ea36aSJohannes Berg 		dump_data->type = cpu_to_le32(IWL_FW_ERROR_DUMP_D3_DEBUG_DATA);
947*2c3ea36aSJohannes Berg 		dump_data->len = cpu_to_le32(data_size * 2);
948*2c3ea36aSJohannes Berg 
949*2c3ea36aSJohannes Berg 		memcpy(dump_data->data, fwrt->dump.d3_debug_data, data_size);
950*2c3ea36aSJohannes Berg 
951*2c3ea36aSJohannes Berg 		kfree(fwrt->dump.d3_debug_data);
952*2c3ea36aSJohannes Berg 		fwrt->dump.d3_debug_data = NULL;
953*2c3ea36aSJohannes Berg 
954*2c3ea36aSJohannes Berg 		iwl_trans_read_mem_bytes(fwrt->trans, addr,
955*2c3ea36aSJohannes Berg 					 dump_data->data + data_size,
956*2c3ea36aSJohannes Berg 					 data_size);
957*2c3ea36aSJohannes Berg 
958*2c3ea36aSJohannes Berg 		if (fwrt->sanitize_ops && fwrt->sanitize_ops->frob_mem)
959*2c3ea36aSJohannes Berg 			fwrt->sanitize_ops->frob_mem(fwrt->sanitize_ctx, addr,
960*2c3ea36aSJohannes Berg 						     dump_data->data + data_size,
961*2c3ea36aSJohannes Berg 						     data_size);
962*2c3ea36aSJohannes Berg 
963*2c3ea36aSJohannes Berg 		dump_data = iwl_fw_error_next_data(dump_data);
964*2c3ea36aSJohannes Berg 	}
965*2c3ea36aSJohannes Berg 
966*2c3ea36aSJohannes Berg 	/* Dump fw's virtual image */
967*2c3ea36aSJohannes Berg 	if (iwl_fw_dbg_is_paging_enabled(fwrt))
968*2c3ea36aSJohannes Berg 		iwl_dump_paging(fwrt, &dump_data);
969*2c3ea36aSJohannes Berg 
970*2c3ea36aSJohannes Berg 	if (prph_len)
971*2c3ea36aSJohannes Berg 		iwl_fw_prph_handler(fwrt, &dump_data, iwl_dump_prph);
972*2c3ea36aSJohannes Berg 
973*2c3ea36aSJohannes Berg out:
974*2c3ea36aSJohannes Berg 	dump_file->file_len = cpu_to_le32(file_len);
975*2c3ea36aSJohannes Berg 	return dump_file;
976*2c3ea36aSJohannes Berg }
977*2c3ea36aSJohannes Berg 
978*2c3ea36aSJohannes Berg void iwl_fw_error_dump(struct iwl_fw_runtime *fwrt,
979*2c3ea36aSJohannes Berg 		       struct iwl_fwrt_dump_data *dump_data)
980*2c3ea36aSJohannes Berg {
981*2c3ea36aSJohannes Berg 	struct iwl_fw_dump_ptrs fw_error_dump = {};
982*2c3ea36aSJohannes Berg 	struct iwl_fw_error_dump_file *dump_file;
983*2c3ea36aSJohannes Berg 	struct scatterlist *sg_dump_data;
984*2c3ea36aSJohannes Berg 	u32 file_len;
985*2c3ea36aSJohannes Berg 	u32 dump_mask = fwrt->fw->dbg.dump_mask;
986*2c3ea36aSJohannes Berg 
987*2c3ea36aSJohannes Berg 	dump_file = iwl_fw_error_dump_file(fwrt, &fw_error_dump, dump_data);
988*2c3ea36aSJohannes Berg 	if (!dump_file)
989*2c3ea36aSJohannes Berg 		return;
990*2c3ea36aSJohannes Berg 
991*2c3ea36aSJohannes Berg 	if (dump_data->monitor_only)
992*2c3ea36aSJohannes Berg 		dump_mask &= BIT(IWL_FW_ERROR_DUMP_FW_MONITOR);
993*2c3ea36aSJohannes Berg 
994*2c3ea36aSJohannes Berg 	fw_error_dump.trans_ptr = iwl_trans_dump_data(fwrt->trans, dump_mask,
995*2c3ea36aSJohannes Berg 						      fwrt->sanitize_ops,
996*2c3ea36aSJohannes Berg 						      fwrt->sanitize_ctx);
997*2c3ea36aSJohannes Berg 	file_len = le32_to_cpu(dump_file->file_len);
998*2c3ea36aSJohannes Berg 	fw_error_dump.fwrt_len = file_len;
999*2c3ea36aSJohannes Berg 
1000*2c3ea36aSJohannes Berg 	if (fw_error_dump.trans_ptr) {
1001*2c3ea36aSJohannes Berg 		file_len += fw_error_dump.trans_ptr->len;
1002*2c3ea36aSJohannes Berg 		dump_file->file_len = cpu_to_le32(file_len);
1003*2c3ea36aSJohannes Berg 	}
1004*2c3ea36aSJohannes Berg 
1005*2c3ea36aSJohannes Berg 	sg_dump_data = iwl_fw_dbg_alloc_sgtable(file_len);
1006*2c3ea36aSJohannes Berg 	if (sg_dump_data) {
1007*2c3ea36aSJohannes Berg 		sg_pcopy_from_buffer(sg_dump_data,
1008*2c3ea36aSJohannes Berg 				     sg_nents(sg_dump_data),
1009*2c3ea36aSJohannes Berg 				     fw_error_dump.fwrt_ptr,
1010*2c3ea36aSJohannes Berg 				     fw_error_dump.fwrt_len, 0);
1011*2c3ea36aSJohannes Berg 		if (fw_error_dump.trans_ptr)
1012*2c3ea36aSJohannes Berg 			sg_pcopy_from_buffer(sg_dump_data,
1013*2c3ea36aSJohannes Berg 					     sg_nents(sg_dump_data),
1014*2c3ea36aSJohannes Berg 					     fw_error_dump.trans_ptr->data,
1015*2c3ea36aSJohannes Berg 					     fw_error_dump.trans_ptr->len,
1016*2c3ea36aSJohannes Berg 					     fw_error_dump.fwrt_len);
1017*2c3ea36aSJohannes Berg 		dev_coredumpsg(fwrt->trans->dev, sg_dump_data, file_len,
1018*2c3ea36aSJohannes Berg 			       GFP_KERNEL);
1019*2c3ea36aSJohannes Berg 	}
1020*2c3ea36aSJohannes Berg 	vfree(fw_error_dump.fwrt_ptr);
1021*2c3ea36aSJohannes Berg 	vfree(fw_error_dump.trans_ptr);
1022*2c3ea36aSJohannes Berg }
1023