1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /*
3  * Copyright (C) 2017 Intel Deutschland GmbH
4  * Copyright (C) 2018-2021 Intel Corporation
5  */
6 #include "iwl-trans.h"
7 #include "iwl-fh.h"
8 #include "iwl-context-info.h"
9 #include "internal.h"
10 #include "iwl-prph.h"
11 
_iwl_pcie_ctxt_info_dma_alloc_coherent(struct iwl_trans * trans,size_t size,dma_addr_t * phys,int depth)12 static void *_iwl_pcie_ctxt_info_dma_alloc_coherent(struct iwl_trans *trans,
13 						    size_t size,
14 						    dma_addr_t *phys,
15 						    int depth)
16 {
17 	void *result;
18 
19 	if (WARN(depth > 2,
20 		 "failed to allocate DMA memory not crossing 2^32 boundary"))
21 		return NULL;
22 
23 	result = dma_alloc_coherent(trans->dev, size, phys, GFP_KERNEL);
24 
25 	if (!result)
26 		return NULL;
27 
28 	if (unlikely(iwl_txq_crosses_4g_boundary(*phys, size))) {
29 		void *old = result;
30 		dma_addr_t oldphys = *phys;
31 
32 		result = _iwl_pcie_ctxt_info_dma_alloc_coherent(trans, size,
33 								phys,
34 								depth + 1);
35 		dma_free_coherent(trans->dev, size, old, oldphys);
36 	}
37 
38 	return result;
39 }
40 
iwl_pcie_ctxt_info_dma_alloc_coherent(struct iwl_trans * trans,size_t size,dma_addr_t * phys)41 static void *iwl_pcie_ctxt_info_dma_alloc_coherent(struct iwl_trans *trans,
42 						   size_t size,
43 						   dma_addr_t *phys)
44 {
45 	return _iwl_pcie_ctxt_info_dma_alloc_coherent(trans, size, phys, 0);
46 }
47 
iwl_pcie_ctxt_info_alloc_dma(struct iwl_trans * trans,const void * data,u32 len,struct iwl_dram_data * dram)48 int iwl_pcie_ctxt_info_alloc_dma(struct iwl_trans *trans,
49 				 const void *data, u32 len,
50 				 struct iwl_dram_data *dram)
51 {
52 	dram->block = iwl_pcie_ctxt_info_dma_alloc_coherent(trans, len,
53 							    &dram->physical);
54 	if (!dram->block)
55 		return -ENOMEM;
56 
57 	dram->size = len;
58 	memcpy(dram->block, data, len);
59 
60 	return 0;
61 }
62 
iwl_pcie_ctxt_info_free_paging(struct iwl_trans * trans)63 void iwl_pcie_ctxt_info_free_paging(struct iwl_trans *trans)
64 {
65 	struct iwl_self_init_dram *dram = &trans->init_dram;
66 	int i;
67 
68 	if (!dram->paging) {
69 		WARN_ON(dram->paging_cnt);
70 		return;
71 	}
72 
73 	/* free paging*/
74 	for (i = 0; i < dram->paging_cnt; i++)
75 		dma_free_coherent(trans->dev, dram->paging[i].size,
76 				  dram->paging[i].block,
77 				  dram->paging[i].physical);
78 
79 	kfree(dram->paging);
80 	dram->paging_cnt = 0;
81 	dram->paging = NULL;
82 }
83 
iwl_pcie_init_fw_sec(struct iwl_trans * trans,const struct fw_img * fw,struct iwl_context_info_dram * ctxt_dram)84 int iwl_pcie_init_fw_sec(struct iwl_trans *trans,
85 			 const struct fw_img *fw,
86 			 struct iwl_context_info_dram *ctxt_dram)
87 {
88 	struct iwl_self_init_dram *dram = &trans->init_dram;
89 	int i, ret, lmac_cnt, umac_cnt, paging_cnt;
90 
91 	if (WARN(dram->paging,
92 		 "paging shouldn't already be initialized (%d pages)\n",
93 		 dram->paging_cnt))
94 		iwl_pcie_ctxt_info_free_paging(trans);
95 
96 	lmac_cnt = iwl_pcie_get_num_sections(fw, 0);
97 	/* add 1 due to separator */
98 	umac_cnt = iwl_pcie_get_num_sections(fw, lmac_cnt + 1);
99 	/* add 2 due to separators */
100 	paging_cnt = iwl_pcie_get_num_sections(fw, lmac_cnt + umac_cnt + 2);
101 
102 	dram->fw = kcalloc(umac_cnt + lmac_cnt, sizeof(*dram->fw), GFP_KERNEL);
103 	if (!dram->fw)
104 		return -ENOMEM;
105 	dram->paging = kcalloc(paging_cnt, sizeof(*dram->paging), GFP_KERNEL);
106 	if (!dram->paging)
107 		return -ENOMEM;
108 
109 	/* initialize lmac sections */
110 	for (i = 0; i < lmac_cnt; i++) {
111 		ret = iwl_pcie_ctxt_info_alloc_dma(trans, fw->sec[i].data,
112 						   fw->sec[i].len,
113 						   &dram->fw[dram->fw_cnt]);
114 		if (ret)
115 			return ret;
116 		ctxt_dram->lmac_img[i] =
117 			cpu_to_le64(dram->fw[dram->fw_cnt].physical);
118 		dram->fw_cnt++;
119 	}
120 
121 	/* initialize umac sections */
122 	for (i = 0; i < umac_cnt; i++) {
123 		/* access FW with +1 to make up for lmac separator */
124 		ret = iwl_pcie_ctxt_info_alloc_dma(trans,
125 						   fw->sec[dram->fw_cnt + 1].data,
126 						   fw->sec[dram->fw_cnt + 1].len,
127 						   &dram->fw[dram->fw_cnt]);
128 		if (ret)
129 			return ret;
130 		ctxt_dram->umac_img[i] =
131 			cpu_to_le64(dram->fw[dram->fw_cnt].physical);
132 		dram->fw_cnt++;
133 	}
134 
135 	/*
136 	 * Initialize paging.
137 	 * Paging memory isn't stored in dram->fw as the umac and lmac - it is
138 	 * stored separately.
139 	 * This is since the timing of its release is different -
140 	 * while fw memory can be released on alive, the paging memory can be
141 	 * freed only when the device goes down.
142 	 * Given that, the logic here in accessing the fw image is a bit
143 	 * different - fw_cnt isn't changing so loop counter is added to it.
144 	 */
145 	for (i = 0; i < paging_cnt; i++) {
146 		/* access FW with +2 to make up for lmac & umac separators */
147 		int fw_idx = dram->fw_cnt + i + 2;
148 
149 		ret = iwl_pcie_ctxt_info_alloc_dma(trans, fw->sec[fw_idx].data,
150 						   fw->sec[fw_idx].len,
151 						   &dram->paging[i]);
152 		if (ret)
153 			return ret;
154 
155 		ctxt_dram->virtual_img[i] =
156 			cpu_to_le64(dram->paging[i].physical);
157 		dram->paging_cnt++;
158 	}
159 
160 	return 0;
161 }
162 
iwl_pcie_ctxt_info_init(struct iwl_trans * trans,const struct fw_img * fw)163 int iwl_pcie_ctxt_info_init(struct iwl_trans *trans,
164 			    const struct fw_img *fw)
165 {
166 	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
167 	struct iwl_context_info *ctxt_info;
168 	struct iwl_context_info_rbd_cfg *rx_cfg;
169 	u32 control_flags = 0, rb_size;
170 	dma_addr_t phys;
171 	int ret;
172 
173 	ctxt_info = iwl_pcie_ctxt_info_dma_alloc_coherent(trans,
174 							  sizeof(*ctxt_info),
175 							  &phys);
176 	if (!ctxt_info)
177 		return -ENOMEM;
178 
179 	trans_pcie->ctxt_info_dma_addr = phys;
180 
181 	ctxt_info->version.version = 0;
182 	ctxt_info->version.mac_id =
183 		cpu_to_le16((u16)iwl_read32(trans, CSR_HW_REV));
184 	/* size is in DWs */
185 	ctxt_info->version.size = cpu_to_le16(sizeof(*ctxt_info) / 4);
186 
187 	switch (trans_pcie->rx_buf_size) {
188 	case IWL_AMSDU_2K:
189 		rb_size = IWL_CTXT_INFO_RB_SIZE_2K;
190 		break;
191 	case IWL_AMSDU_4K:
192 		rb_size = IWL_CTXT_INFO_RB_SIZE_4K;
193 		break;
194 	case IWL_AMSDU_8K:
195 		rb_size = IWL_CTXT_INFO_RB_SIZE_8K;
196 		break;
197 	case IWL_AMSDU_12K:
198 		rb_size = IWL_CTXT_INFO_RB_SIZE_16K;
199 		break;
200 	default:
201 		WARN_ON(1);
202 		rb_size = IWL_CTXT_INFO_RB_SIZE_4K;
203 	}
204 
205 	WARN_ON(RX_QUEUE_CB_SIZE(trans->cfg->num_rbds) > 12);
206 	control_flags = IWL_CTXT_INFO_TFD_FORMAT_LONG;
207 	control_flags |=
208 		u32_encode_bits(RX_QUEUE_CB_SIZE(trans->cfg->num_rbds),
209 				IWL_CTXT_INFO_RB_CB_SIZE);
210 	control_flags |= u32_encode_bits(rb_size, IWL_CTXT_INFO_RB_SIZE);
211 	ctxt_info->control.control_flags = cpu_to_le32(control_flags);
212 
213 	/* initialize RX default queue */
214 	rx_cfg = &ctxt_info->rbd_cfg;
215 	rx_cfg->free_rbd_addr = cpu_to_le64(trans_pcie->rxq->bd_dma);
216 	rx_cfg->used_rbd_addr = cpu_to_le64(trans_pcie->rxq->used_bd_dma);
217 	rx_cfg->status_wr_ptr = cpu_to_le64(trans_pcie->rxq->rb_stts_dma);
218 
219 	/* initialize TX command queue */
220 	ctxt_info->hcmd_cfg.cmd_queue_addr =
221 		cpu_to_le64(trans->txqs.txq[trans->txqs.cmd.q_id]->dma_addr);
222 	ctxt_info->hcmd_cfg.cmd_queue_size =
223 		TFD_QUEUE_CB_SIZE(IWL_CMD_QUEUE_SIZE);
224 
225 	/* allocate ucode sections in dram and set addresses */
226 	ret = iwl_pcie_init_fw_sec(trans, fw, &ctxt_info->dram);
227 	if (ret) {
228 		dma_free_coherent(trans->dev, sizeof(*trans_pcie->ctxt_info),
229 				  ctxt_info, trans_pcie->ctxt_info_dma_addr);
230 		return ret;
231 	}
232 
233 	trans_pcie->ctxt_info = ctxt_info;
234 
235 	iwl_enable_fw_load_int_ctx_info(trans);
236 
237 	/* Configure debug, if exists */
238 	if (iwl_pcie_dbg_on(trans))
239 		iwl_pcie_apply_destination(trans);
240 
241 	/* kick FW self load */
242 	iwl_write64(trans, CSR_CTXT_INFO_BA, trans_pcie->ctxt_info_dma_addr);
243 
244 	/* Context info will be released upon alive or failure to get one */
245 
246 	return 0;
247 }
248 
iwl_pcie_ctxt_info_free(struct iwl_trans * trans)249 void iwl_pcie_ctxt_info_free(struct iwl_trans *trans)
250 {
251 	struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans);
252 
253 	if (!trans_pcie->ctxt_info)
254 		return;
255 
256 	dma_free_coherent(trans->dev, sizeof(*trans_pcie->ctxt_info),
257 			  trans_pcie->ctxt_info,
258 			  trans_pcie->ctxt_info_dma_addr);
259 	trans_pcie->ctxt_info_dma_addr = 0;
260 	trans_pcie->ctxt_info = NULL;
261 
262 	iwl_pcie_ctxt_info_free_fw_img(trans);
263 }
264