1 // SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0-only)
2 /* Copyright(c) 2014 - 2020 Intel Corporation */
3 #include <linux/slab.h>
4 #include <linux/delay.h>
5 #include <linux/pci_ids.h>
6
7 #include "adf_accel_devices.h"
8 #include "adf_common_drv.h"
9 #include "icp_qat_hal.h"
10 #include "icp_qat_uclo.h"
11
12 #define BAD_REGADDR 0xffff
13 #define MAX_RETRY_TIMES 10000
14 #define INIT_CTX_ARB_VALUE 0x0
15 #define INIT_CTX_ENABLE_VALUE 0x0
16 #define INIT_PC_VALUE 0x0
17 #define INIT_WAKEUP_EVENTS_VALUE 0x1
18 #define INIT_SIG_EVENTS_VALUE 0x1
19 #define INIT_CCENABLE_VALUE 0x2000
20 #define RST_CSR_QAT_LSB 20
21 #define RST_CSR_AE_LSB 0
22 #define MC_TIMESTAMP_ENABLE (0x1 << 7)
23
24 #define IGNORE_W1C_MASK ((~(1 << CE_BREAKPOINT_BITPOS)) & \
25 (~(1 << CE_CNTL_STORE_PARITY_ERROR_BITPOS)) & \
26 (~(1 << CE_REG_PAR_ERR_BITPOS)))
27 #define INSERT_IMMED_GPRA_CONST(inst, const_val) \
28 (inst = ((inst & 0xFFFF00C03FFull) | \
29 ((((const_val) << 12) & 0x0FF00000ull) | \
30 (((const_val) << 10) & 0x0003FC00ull))))
31 #define INSERT_IMMED_GPRB_CONST(inst, const_val) \
32 (inst = ((inst & 0xFFFF00FFF00ull) | \
33 ((((const_val) << 12) & 0x0FF00000ull) | \
34 (((const_val) << 0) & 0x000000FFull))))
35
36 #define AE(handle, ae) ((handle)->hal_handle->aes[ae])
37
38 static const u64 inst_4b[] = {
39 0x0F0400C0000ull, 0x0F4400C0000ull, 0x0F040000300ull, 0x0F440000300ull,
40 0x0FC066C0000ull, 0x0F0000C0300ull, 0x0F0000C0300ull, 0x0F0000C0300ull,
41 0x0A021000000ull
42 };
43
44 static const u64 inst[] = {
45 0x0F0000C0000ull, 0x0F000000380ull, 0x0D805000011ull, 0x0FC082C0300ull,
46 0x0F0000C0300ull, 0x0F0000C0300ull, 0x0F0000C0300ull, 0x0F0000C0300ull,
47 0x0A0643C0000ull, 0x0BAC0000301ull, 0x0D802000101ull, 0x0F0000C0001ull,
48 0x0FC066C0001ull, 0x0F0000C0300ull, 0x0F0000C0300ull, 0x0F0000C0300ull,
49 0x0F000400300ull, 0x0A0610C0000ull, 0x0BAC0000301ull, 0x0D804400101ull,
50 0x0A0580C0000ull, 0x0A0581C0000ull, 0x0A0582C0000ull, 0x0A0583C0000ull,
51 0x0A0584C0000ull, 0x0A0585C0000ull, 0x0A0586C0000ull, 0x0A0587C0000ull,
52 0x0A0588C0000ull, 0x0A0589C0000ull, 0x0A058AC0000ull, 0x0A058BC0000ull,
53 0x0A058CC0000ull, 0x0A058DC0000ull, 0x0A058EC0000ull, 0x0A058FC0000ull,
54 0x0A05C0C0000ull, 0x0A05C1C0000ull, 0x0A05C2C0000ull, 0x0A05C3C0000ull,
55 0x0A05C4C0000ull, 0x0A05C5C0000ull, 0x0A05C6C0000ull, 0x0A05C7C0000ull,
56 0x0A05C8C0000ull, 0x0A05C9C0000ull, 0x0A05CAC0000ull, 0x0A05CBC0000ull,
57 0x0A05CCC0000ull, 0x0A05CDC0000ull, 0x0A05CEC0000ull, 0x0A05CFC0000ull,
58 0x0A0400C0000ull, 0x0B0400C0000ull, 0x0A0401C0000ull, 0x0B0401C0000ull,
59 0x0A0402C0000ull, 0x0B0402C0000ull, 0x0A0403C0000ull, 0x0B0403C0000ull,
60 0x0A0404C0000ull, 0x0B0404C0000ull, 0x0A0405C0000ull, 0x0B0405C0000ull,
61 0x0A0406C0000ull, 0x0B0406C0000ull, 0x0A0407C0000ull, 0x0B0407C0000ull,
62 0x0A0408C0000ull, 0x0B0408C0000ull, 0x0A0409C0000ull, 0x0B0409C0000ull,
63 0x0A040AC0000ull, 0x0B040AC0000ull, 0x0A040BC0000ull, 0x0B040BC0000ull,
64 0x0A040CC0000ull, 0x0B040CC0000ull, 0x0A040DC0000ull, 0x0B040DC0000ull,
65 0x0A040EC0000ull, 0x0B040EC0000ull, 0x0A040FC0000ull, 0x0B040FC0000ull,
66 0x0D81581C010ull, 0x0E000010000ull, 0x0E000010000ull,
67 };
68
qat_hal_set_live_ctx(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int ctx_mask)69 void qat_hal_set_live_ctx(struct icp_qat_fw_loader_handle *handle,
70 unsigned char ae, unsigned int ctx_mask)
71 {
72 AE(handle, ae).live_ctx_mask = ctx_mask;
73 }
74
75 #define CSR_RETRY_TIMES 500
qat_hal_rd_ae_csr(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int csr)76 static int qat_hal_rd_ae_csr(struct icp_qat_fw_loader_handle *handle,
77 unsigned char ae, unsigned int csr)
78 {
79 unsigned int iterations = CSR_RETRY_TIMES;
80 int value;
81
82 do {
83 value = GET_AE_CSR(handle, ae, csr);
84 if (!(GET_AE_CSR(handle, ae, LOCAL_CSR_STATUS) & LCS_STATUS))
85 return value;
86 } while (iterations--);
87
88 pr_err("QAT: Read CSR timeout\n");
89 return 0;
90 }
91
qat_hal_wr_ae_csr(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int csr,unsigned int value)92 static int qat_hal_wr_ae_csr(struct icp_qat_fw_loader_handle *handle,
93 unsigned char ae, unsigned int csr,
94 unsigned int value)
95 {
96 unsigned int iterations = CSR_RETRY_TIMES;
97
98 do {
99 SET_AE_CSR(handle, ae, csr, value);
100 if (!(GET_AE_CSR(handle, ae, LOCAL_CSR_STATUS) & LCS_STATUS))
101 return 0;
102 } while (iterations--);
103
104 pr_err("QAT: Write CSR Timeout\n");
105 return -EFAULT;
106 }
107
qat_hal_get_wakeup_event(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char ctx,unsigned int * events)108 static void qat_hal_get_wakeup_event(struct icp_qat_fw_loader_handle *handle,
109 unsigned char ae, unsigned char ctx,
110 unsigned int *events)
111 {
112 unsigned int cur_ctx;
113
114 cur_ctx = qat_hal_rd_ae_csr(handle, ae, CSR_CTX_POINTER);
115 qat_hal_wr_ae_csr(handle, ae, CSR_CTX_POINTER, ctx);
116 *events = qat_hal_rd_ae_csr(handle, ae, CTX_WAKEUP_EVENTS_INDIRECT);
117 qat_hal_wr_ae_csr(handle, ae, CSR_CTX_POINTER, cur_ctx);
118 }
119
qat_hal_wait_cycles(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int cycles,int chk_inactive)120 static int qat_hal_wait_cycles(struct icp_qat_fw_loader_handle *handle,
121 unsigned char ae, unsigned int cycles,
122 int chk_inactive)
123 {
124 unsigned int base_cnt = 0, cur_cnt = 0;
125 unsigned int csr = (1 << ACS_ABO_BITPOS);
126 int times = MAX_RETRY_TIMES;
127 int elapsed_cycles = 0;
128
129 base_cnt = qat_hal_rd_ae_csr(handle, ae, PROFILE_COUNT);
130 base_cnt &= 0xffff;
131 while ((int)cycles > elapsed_cycles && times--) {
132 if (chk_inactive)
133 csr = qat_hal_rd_ae_csr(handle, ae, ACTIVE_CTX_STATUS);
134
135 cur_cnt = qat_hal_rd_ae_csr(handle, ae, PROFILE_COUNT);
136 cur_cnt &= 0xffff;
137 elapsed_cycles = cur_cnt - base_cnt;
138
139 if (elapsed_cycles < 0)
140 elapsed_cycles += 0x10000;
141
142 /* ensure at least 8 time cycles elapsed in wait_cycles */
143 if (elapsed_cycles >= 8 && !(csr & (1 << ACS_ABO_BITPOS)))
144 return 0;
145 }
146 if (times < 0) {
147 pr_err("QAT: wait_num_cycles time out\n");
148 return -EFAULT;
149 }
150 return 0;
151 }
152
153 #define CLR_BIT(wrd, bit) ((wrd) & ~(1 << (bit)))
154 #define SET_BIT(wrd, bit) ((wrd) | 1 << (bit))
155
qat_hal_set_ae_ctx_mode(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char mode)156 int qat_hal_set_ae_ctx_mode(struct icp_qat_fw_loader_handle *handle,
157 unsigned char ae, unsigned char mode)
158 {
159 unsigned int csr, new_csr;
160
161 if (mode != 4 && mode != 8) {
162 pr_err("QAT: bad ctx mode=%d\n", mode);
163 return -EINVAL;
164 }
165
166 /* Sets the accelaration engine context mode to either four or eight */
167 csr = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
168 csr = IGNORE_W1C_MASK & csr;
169 new_csr = (mode == 4) ?
170 SET_BIT(csr, CE_INUSE_CONTEXTS_BITPOS) :
171 CLR_BIT(csr, CE_INUSE_CONTEXTS_BITPOS);
172 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, new_csr);
173 return 0;
174 }
175
qat_hal_set_ae_nn_mode(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char mode)176 int qat_hal_set_ae_nn_mode(struct icp_qat_fw_loader_handle *handle,
177 unsigned char ae, unsigned char mode)
178 {
179 unsigned int csr, new_csr;
180
181 csr = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
182 csr &= IGNORE_W1C_MASK;
183
184 new_csr = (mode) ?
185 SET_BIT(csr, CE_NN_MODE_BITPOS) :
186 CLR_BIT(csr, CE_NN_MODE_BITPOS);
187
188 if (new_csr != csr)
189 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, new_csr);
190
191 return 0;
192 }
193
qat_hal_set_ae_lm_mode(struct icp_qat_fw_loader_handle * handle,unsigned char ae,enum icp_qat_uof_regtype lm_type,unsigned char mode)194 int qat_hal_set_ae_lm_mode(struct icp_qat_fw_loader_handle *handle,
195 unsigned char ae, enum icp_qat_uof_regtype lm_type,
196 unsigned char mode)
197 {
198 unsigned int csr, new_csr;
199
200 csr = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
201 csr &= IGNORE_W1C_MASK;
202 switch (lm_type) {
203 case ICP_LMEM0:
204 new_csr = (mode) ?
205 SET_BIT(csr, CE_LMADDR_0_GLOBAL_BITPOS) :
206 CLR_BIT(csr, CE_LMADDR_0_GLOBAL_BITPOS);
207 break;
208 case ICP_LMEM1:
209 new_csr = (mode) ?
210 SET_BIT(csr, CE_LMADDR_1_GLOBAL_BITPOS) :
211 CLR_BIT(csr, CE_LMADDR_1_GLOBAL_BITPOS);
212 break;
213 case ICP_LMEM2:
214 new_csr = (mode) ?
215 SET_BIT(csr, CE_LMADDR_2_GLOBAL_BITPOS) :
216 CLR_BIT(csr, CE_LMADDR_2_GLOBAL_BITPOS);
217 break;
218 case ICP_LMEM3:
219 new_csr = (mode) ?
220 SET_BIT(csr, CE_LMADDR_3_GLOBAL_BITPOS) :
221 CLR_BIT(csr, CE_LMADDR_3_GLOBAL_BITPOS);
222 break;
223 default:
224 pr_err("QAT: lmType = 0x%x\n", lm_type);
225 return -EINVAL;
226 }
227
228 if (new_csr != csr)
229 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, new_csr);
230 return 0;
231 }
232
qat_hal_set_ae_tindex_mode(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char mode)233 void qat_hal_set_ae_tindex_mode(struct icp_qat_fw_loader_handle *handle,
234 unsigned char ae, unsigned char mode)
235 {
236 unsigned int csr, new_csr;
237
238 csr = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
239 csr &= IGNORE_W1C_MASK;
240 new_csr = (mode) ?
241 SET_BIT(csr, CE_T_INDEX_GLOBAL_BITPOS) :
242 CLR_BIT(csr, CE_T_INDEX_GLOBAL_BITPOS);
243 if (new_csr != csr)
244 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, new_csr);
245 }
246
qat_hal_get_reg_addr(unsigned int type,unsigned short reg_num)247 static unsigned short qat_hal_get_reg_addr(unsigned int type,
248 unsigned short reg_num)
249 {
250 unsigned short reg_addr;
251
252 switch (type) {
253 case ICP_GPA_ABS:
254 case ICP_GPB_ABS:
255 reg_addr = 0x80 | (reg_num & 0x7f);
256 break;
257 case ICP_GPA_REL:
258 case ICP_GPB_REL:
259 reg_addr = reg_num & 0x1f;
260 break;
261 case ICP_SR_RD_REL:
262 case ICP_SR_WR_REL:
263 case ICP_SR_REL:
264 reg_addr = 0x180 | (reg_num & 0x1f);
265 break;
266 case ICP_SR_ABS:
267 reg_addr = 0x140 | ((reg_num & 0x3) << 1);
268 break;
269 case ICP_DR_RD_REL:
270 case ICP_DR_WR_REL:
271 case ICP_DR_REL:
272 reg_addr = 0x1c0 | (reg_num & 0x1f);
273 break;
274 case ICP_DR_ABS:
275 reg_addr = 0x100 | ((reg_num & 0x3) << 1);
276 break;
277 case ICP_NEIGH_REL:
278 reg_addr = 0x280 | (reg_num & 0x1f);
279 break;
280 case ICP_LMEM0:
281 reg_addr = 0x200;
282 break;
283 case ICP_LMEM1:
284 reg_addr = 0x220;
285 break;
286 case ICP_LMEM2:
287 reg_addr = 0x2c0;
288 break;
289 case ICP_LMEM3:
290 reg_addr = 0x2e0;
291 break;
292 case ICP_NO_DEST:
293 reg_addr = 0x300 | (reg_num & 0xff);
294 break;
295 default:
296 reg_addr = BAD_REGADDR;
297 break;
298 }
299 return reg_addr;
300 }
301
qat_hal_reset(struct icp_qat_fw_loader_handle * handle)302 void qat_hal_reset(struct icp_qat_fw_loader_handle *handle)
303 {
304 unsigned int reset_mask = handle->chip_info->icp_rst_mask;
305 unsigned int reset_csr = handle->chip_info->icp_rst_csr;
306 unsigned int csr_val;
307
308 csr_val = GET_CAP_CSR(handle, reset_csr);
309 csr_val |= reset_mask;
310 SET_CAP_CSR(handle, reset_csr, csr_val);
311 }
312
qat_hal_wr_indr_csr(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int ctx_mask,unsigned int ae_csr,unsigned int csr_val)313 static void qat_hal_wr_indr_csr(struct icp_qat_fw_loader_handle *handle,
314 unsigned char ae, unsigned int ctx_mask,
315 unsigned int ae_csr, unsigned int csr_val)
316 {
317 unsigned int ctx, cur_ctx;
318
319 cur_ctx = qat_hal_rd_ae_csr(handle, ae, CSR_CTX_POINTER);
320
321 for (ctx = 0; ctx < ICP_QAT_UCLO_MAX_CTX; ctx++) {
322 if (!(ctx_mask & (1 << ctx)))
323 continue;
324 qat_hal_wr_ae_csr(handle, ae, CSR_CTX_POINTER, ctx);
325 qat_hal_wr_ae_csr(handle, ae, ae_csr, csr_val);
326 }
327
328 qat_hal_wr_ae_csr(handle, ae, CSR_CTX_POINTER, cur_ctx);
329 }
330
qat_hal_rd_indr_csr(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char ctx,unsigned int ae_csr)331 static unsigned int qat_hal_rd_indr_csr(struct icp_qat_fw_loader_handle *handle,
332 unsigned char ae, unsigned char ctx,
333 unsigned int ae_csr)
334 {
335 unsigned int cur_ctx, csr_val;
336
337 cur_ctx = qat_hal_rd_ae_csr(handle, ae, CSR_CTX_POINTER);
338 qat_hal_wr_ae_csr(handle, ae, CSR_CTX_POINTER, ctx);
339 csr_val = qat_hal_rd_ae_csr(handle, ae, ae_csr);
340 qat_hal_wr_ae_csr(handle, ae, CSR_CTX_POINTER, cur_ctx);
341
342 return csr_val;
343 }
344
qat_hal_put_sig_event(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int ctx_mask,unsigned int events)345 static void qat_hal_put_sig_event(struct icp_qat_fw_loader_handle *handle,
346 unsigned char ae, unsigned int ctx_mask,
347 unsigned int events)
348 {
349 unsigned int ctx, cur_ctx;
350
351 cur_ctx = qat_hal_rd_ae_csr(handle, ae, CSR_CTX_POINTER);
352 for (ctx = 0; ctx < ICP_QAT_UCLO_MAX_CTX; ctx++) {
353 if (!(ctx_mask & (1 << ctx)))
354 continue;
355 qat_hal_wr_ae_csr(handle, ae, CSR_CTX_POINTER, ctx);
356 qat_hal_wr_ae_csr(handle, ae, CTX_SIG_EVENTS_INDIRECT, events);
357 }
358 qat_hal_wr_ae_csr(handle, ae, CSR_CTX_POINTER, cur_ctx);
359 }
360
qat_hal_put_wakeup_event(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int ctx_mask,unsigned int events)361 static void qat_hal_put_wakeup_event(struct icp_qat_fw_loader_handle *handle,
362 unsigned char ae, unsigned int ctx_mask,
363 unsigned int events)
364 {
365 unsigned int ctx, cur_ctx;
366
367 cur_ctx = qat_hal_rd_ae_csr(handle, ae, CSR_CTX_POINTER);
368 for (ctx = 0; ctx < ICP_QAT_UCLO_MAX_CTX; ctx++) {
369 if (!(ctx_mask & (1 << ctx)))
370 continue;
371 qat_hal_wr_ae_csr(handle, ae, CSR_CTX_POINTER, ctx);
372 qat_hal_wr_ae_csr(handle, ae, CTX_WAKEUP_EVENTS_INDIRECT,
373 events);
374 }
375 qat_hal_wr_ae_csr(handle, ae, CSR_CTX_POINTER, cur_ctx);
376 }
377
qat_hal_check_ae_alive(struct icp_qat_fw_loader_handle * handle)378 static int qat_hal_check_ae_alive(struct icp_qat_fw_loader_handle *handle)
379 {
380 unsigned long ae_mask = handle->hal_handle->ae_mask;
381 unsigned int base_cnt, cur_cnt;
382 unsigned char ae;
383 int times = MAX_RETRY_TIMES;
384
385 for_each_set_bit(ae, &ae_mask, handle->hal_handle->ae_max_num) {
386 base_cnt = qat_hal_rd_ae_csr(handle, ae, PROFILE_COUNT);
387 base_cnt &= 0xffff;
388
389 do {
390 cur_cnt = qat_hal_rd_ae_csr(handle, ae, PROFILE_COUNT);
391 cur_cnt &= 0xffff;
392 } while (times-- && (cur_cnt == base_cnt));
393
394 if (times < 0) {
395 pr_err("QAT: AE%d is inactive!!\n", ae);
396 return -EFAULT;
397 }
398 }
399
400 return 0;
401 }
402
qat_hal_check_ae_active(struct icp_qat_fw_loader_handle * handle,unsigned int ae)403 int qat_hal_check_ae_active(struct icp_qat_fw_loader_handle *handle,
404 unsigned int ae)
405 {
406 unsigned int enable = 0, active = 0;
407
408 enable = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
409 active = qat_hal_rd_ae_csr(handle, ae, ACTIVE_CTX_STATUS);
410 if ((enable & (0xff << CE_ENABLE_BITPOS)) ||
411 (active & (1 << ACS_ABO_BITPOS)))
412 return 1;
413 else
414 return 0;
415 }
416
qat_hal_reset_timestamp(struct icp_qat_fw_loader_handle * handle)417 static void qat_hal_reset_timestamp(struct icp_qat_fw_loader_handle *handle)
418 {
419 unsigned long ae_mask = handle->hal_handle->ae_mask;
420 unsigned int misc_ctl_csr, misc_ctl;
421 unsigned char ae;
422
423 misc_ctl_csr = handle->chip_info->misc_ctl_csr;
424 /* stop the timestamp timers */
425 misc_ctl = GET_CAP_CSR(handle, misc_ctl_csr);
426 if (misc_ctl & MC_TIMESTAMP_ENABLE)
427 SET_CAP_CSR(handle, misc_ctl_csr, misc_ctl &
428 (~MC_TIMESTAMP_ENABLE));
429
430 for_each_set_bit(ae, &ae_mask, handle->hal_handle->ae_max_num) {
431 qat_hal_wr_ae_csr(handle, ae, TIMESTAMP_LOW, 0);
432 qat_hal_wr_ae_csr(handle, ae, TIMESTAMP_HIGH, 0);
433 }
434 /* start timestamp timers */
435 SET_CAP_CSR(handle, misc_ctl_csr, misc_ctl | MC_TIMESTAMP_ENABLE);
436 }
437
438 #define ESRAM_AUTO_TINIT BIT(2)
439 #define ESRAM_AUTO_TINIT_DONE BIT(3)
440 #define ESRAM_AUTO_INIT_USED_CYCLES (1640)
441 #define ESRAM_AUTO_INIT_CSR_OFFSET 0xC1C
qat_hal_init_esram(struct icp_qat_fw_loader_handle * handle)442 static int qat_hal_init_esram(struct icp_qat_fw_loader_handle *handle)
443 {
444 void __iomem *csr_addr =
445 (void __iomem *)((uintptr_t)handle->hal_ep_csr_addr_v +
446 ESRAM_AUTO_INIT_CSR_OFFSET);
447 unsigned int csr_val;
448 int times = 30;
449
450 if (handle->pci_dev->device != PCI_DEVICE_ID_INTEL_QAT_DH895XCC)
451 return 0;
452
453 csr_val = ADF_CSR_RD(csr_addr, 0);
454 if ((csr_val & ESRAM_AUTO_TINIT) && (csr_val & ESRAM_AUTO_TINIT_DONE))
455 return 0;
456
457 csr_val = ADF_CSR_RD(csr_addr, 0);
458 csr_val |= ESRAM_AUTO_TINIT;
459 ADF_CSR_WR(csr_addr, 0, csr_val);
460
461 do {
462 qat_hal_wait_cycles(handle, 0, ESRAM_AUTO_INIT_USED_CYCLES, 0);
463 csr_val = ADF_CSR_RD(csr_addr, 0);
464 } while (!(csr_val & ESRAM_AUTO_TINIT_DONE) && times--);
465 if (times < 0) {
466 pr_err("QAT: Fail to init eSram!\n");
467 return -EFAULT;
468 }
469 return 0;
470 }
471
472 #define SHRAM_INIT_CYCLES 2060
qat_hal_clr_reset(struct icp_qat_fw_loader_handle * handle)473 int qat_hal_clr_reset(struct icp_qat_fw_loader_handle *handle)
474 {
475 unsigned int clk_csr = handle->chip_info->glb_clk_enable_csr;
476 unsigned int reset_mask = handle->chip_info->icp_rst_mask;
477 unsigned int reset_csr = handle->chip_info->icp_rst_csr;
478 unsigned long ae_mask = handle->hal_handle->ae_mask;
479 unsigned char ae = 0;
480 unsigned int times = 100;
481 unsigned int csr_val;
482
483 /* write to the reset csr */
484 csr_val = GET_CAP_CSR(handle, reset_csr);
485 csr_val &= ~reset_mask;
486 do {
487 SET_CAP_CSR(handle, reset_csr, csr_val);
488 if (!(times--))
489 goto out_err;
490 csr_val = GET_CAP_CSR(handle, reset_csr);
491 csr_val &= reset_mask;
492 } while (csr_val);
493 /* enable clock */
494 csr_val = GET_CAP_CSR(handle, clk_csr);
495 csr_val |= reset_mask;
496 SET_CAP_CSR(handle, clk_csr, csr_val);
497 if (qat_hal_check_ae_alive(handle))
498 goto out_err;
499
500 /* Set undefined power-up/reset states to reasonable default values */
501 for_each_set_bit(ae, &ae_mask, handle->hal_handle->ae_max_num) {
502 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES,
503 INIT_CTX_ENABLE_VALUE);
504 qat_hal_wr_indr_csr(handle, ae, ICP_QAT_UCLO_AE_ALL_CTX,
505 CTX_STS_INDIRECT,
506 handle->hal_handle->upc_mask &
507 INIT_PC_VALUE);
508 qat_hal_wr_ae_csr(handle, ae, CTX_ARB_CNTL, INIT_CTX_ARB_VALUE);
509 qat_hal_wr_ae_csr(handle, ae, CC_ENABLE, INIT_CCENABLE_VALUE);
510 qat_hal_put_wakeup_event(handle, ae,
511 ICP_QAT_UCLO_AE_ALL_CTX,
512 INIT_WAKEUP_EVENTS_VALUE);
513 qat_hal_put_sig_event(handle, ae,
514 ICP_QAT_UCLO_AE_ALL_CTX,
515 INIT_SIG_EVENTS_VALUE);
516 }
517 if (qat_hal_init_esram(handle))
518 goto out_err;
519 if (qat_hal_wait_cycles(handle, 0, SHRAM_INIT_CYCLES, 0))
520 goto out_err;
521 qat_hal_reset_timestamp(handle);
522
523 return 0;
524 out_err:
525 pr_err("QAT: failed to get device out of reset\n");
526 return -EFAULT;
527 }
528
qat_hal_disable_ctx(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int ctx_mask)529 static void qat_hal_disable_ctx(struct icp_qat_fw_loader_handle *handle,
530 unsigned char ae, unsigned int ctx_mask)
531 {
532 unsigned int ctx;
533
534 ctx = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
535 ctx &= IGNORE_W1C_MASK &
536 (~((ctx_mask & ICP_QAT_UCLO_AE_ALL_CTX) << CE_ENABLE_BITPOS));
537 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, ctx);
538 }
539
qat_hal_parity_64bit(u64 word)540 static u64 qat_hal_parity_64bit(u64 word)
541 {
542 word ^= word >> 1;
543 word ^= word >> 2;
544 word ^= word >> 4;
545 word ^= word >> 8;
546 word ^= word >> 16;
547 word ^= word >> 32;
548 return word & 1;
549 }
550
qat_hal_set_uword_ecc(u64 uword)551 static u64 qat_hal_set_uword_ecc(u64 uword)
552 {
553 u64 bit0_mask = 0xff800007fffULL, bit1_mask = 0x1f801ff801fULL,
554 bit2_mask = 0xe387e0781e1ULL, bit3_mask = 0x7cb8e388e22ULL,
555 bit4_mask = 0xaf5b2c93244ULL, bit5_mask = 0xf56d5525488ULL,
556 bit6_mask = 0xdaf69a46910ULL;
557
558 /* clear the ecc bits */
559 uword &= ~(0x7fULL << 0x2C);
560 uword |= qat_hal_parity_64bit(bit0_mask & uword) << 0x2C;
561 uword |= qat_hal_parity_64bit(bit1_mask & uword) << 0x2D;
562 uword |= qat_hal_parity_64bit(bit2_mask & uword) << 0x2E;
563 uword |= qat_hal_parity_64bit(bit3_mask & uword) << 0x2F;
564 uword |= qat_hal_parity_64bit(bit4_mask & uword) << 0x30;
565 uword |= qat_hal_parity_64bit(bit5_mask & uword) << 0x31;
566 uword |= qat_hal_parity_64bit(bit6_mask & uword) << 0x32;
567 return uword;
568 }
569
qat_hal_wr_uwords(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int uaddr,unsigned int words_num,u64 * uword)570 void qat_hal_wr_uwords(struct icp_qat_fw_loader_handle *handle,
571 unsigned char ae, unsigned int uaddr,
572 unsigned int words_num, u64 *uword)
573 {
574 unsigned int ustore_addr;
575 unsigned int i;
576
577 ustore_addr = qat_hal_rd_ae_csr(handle, ae, USTORE_ADDRESS);
578 uaddr |= UA_ECS;
579 qat_hal_wr_ae_csr(handle, ae, USTORE_ADDRESS, uaddr);
580 for (i = 0; i < words_num; i++) {
581 unsigned int uwrd_lo, uwrd_hi;
582 u64 tmp;
583
584 tmp = qat_hal_set_uword_ecc(uword[i]);
585 uwrd_lo = (unsigned int)(tmp & 0xffffffff);
586 uwrd_hi = (unsigned int)(tmp >> 0x20);
587 qat_hal_wr_ae_csr(handle, ae, USTORE_DATA_LOWER, uwrd_lo);
588 qat_hal_wr_ae_csr(handle, ae, USTORE_DATA_UPPER, uwrd_hi);
589 }
590 qat_hal_wr_ae_csr(handle, ae, USTORE_ADDRESS, ustore_addr);
591 }
592
qat_hal_enable_ctx(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int ctx_mask)593 static void qat_hal_enable_ctx(struct icp_qat_fw_loader_handle *handle,
594 unsigned char ae, unsigned int ctx_mask)
595 {
596 unsigned int ctx;
597
598 ctx = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
599 ctx &= IGNORE_W1C_MASK;
600 ctx_mask &= (ctx & CE_INUSE_CONTEXTS) ? 0x55 : 0xFF;
601 ctx |= (ctx_mask << CE_ENABLE_BITPOS);
602 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, ctx);
603 }
604
qat_hal_clear_xfer(struct icp_qat_fw_loader_handle * handle)605 static void qat_hal_clear_xfer(struct icp_qat_fw_loader_handle *handle)
606 {
607 unsigned long ae_mask = handle->hal_handle->ae_mask;
608 unsigned char ae;
609 unsigned short reg;
610
611 for_each_set_bit(ae, &ae_mask, handle->hal_handle->ae_max_num) {
612 for (reg = 0; reg < ICP_QAT_UCLO_MAX_GPR_REG; reg++) {
613 qat_hal_init_rd_xfer(handle, ae, 0, ICP_SR_RD_ABS,
614 reg, 0);
615 qat_hal_init_rd_xfer(handle, ae, 0, ICP_DR_RD_ABS,
616 reg, 0);
617 }
618 }
619 }
620
qat_hal_clear_gpr(struct icp_qat_fw_loader_handle * handle)621 static int qat_hal_clear_gpr(struct icp_qat_fw_loader_handle *handle)
622 {
623 unsigned long ae_mask = handle->hal_handle->ae_mask;
624 unsigned char ae;
625 unsigned int ctx_mask = ICP_QAT_UCLO_AE_ALL_CTX;
626 int times = MAX_RETRY_TIMES;
627 unsigned int csr_val = 0;
628 unsigned int savctx = 0;
629 int ret = 0;
630
631 for_each_set_bit(ae, &ae_mask, handle->hal_handle->ae_max_num) {
632 csr_val = qat_hal_rd_ae_csr(handle, ae, AE_MISC_CONTROL);
633 csr_val &= ~(1 << MMC_SHARE_CS_BITPOS);
634 qat_hal_wr_ae_csr(handle, ae, AE_MISC_CONTROL, csr_val);
635 csr_val = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
636 csr_val &= IGNORE_W1C_MASK;
637 if (handle->chip_info->nn)
638 csr_val |= CE_NN_MODE;
639
640 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, csr_val);
641 qat_hal_wr_uwords(handle, ae, 0, ARRAY_SIZE(inst),
642 (u64 *)inst);
643 qat_hal_wr_indr_csr(handle, ae, ctx_mask, CTX_STS_INDIRECT,
644 handle->hal_handle->upc_mask &
645 INIT_PC_VALUE);
646 savctx = qat_hal_rd_ae_csr(handle, ae, ACTIVE_CTX_STATUS);
647 qat_hal_wr_ae_csr(handle, ae, ACTIVE_CTX_STATUS, 0);
648 qat_hal_put_wakeup_event(handle, ae, ctx_mask, XCWE_VOLUNTARY);
649 qat_hal_wr_indr_csr(handle, ae, ctx_mask,
650 CTX_SIG_EVENTS_INDIRECT, 0);
651 qat_hal_wr_ae_csr(handle, ae, CTX_SIG_EVENTS_ACTIVE, 0);
652 qat_hal_enable_ctx(handle, ae, ctx_mask);
653 }
654 for_each_set_bit(ae, &ae_mask, handle->hal_handle->ae_max_num) {
655 /* wait for AE to finish */
656 do {
657 ret = qat_hal_wait_cycles(handle, ae, 20, 1);
658 } while (ret && times--);
659
660 if (times < 0) {
661 pr_err("QAT: clear GPR of AE %d failed", ae);
662 return -EINVAL;
663 }
664 qat_hal_disable_ctx(handle, ae, ctx_mask);
665 qat_hal_wr_ae_csr(handle, ae, ACTIVE_CTX_STATUS,
666 savctx & ACS_ACNO);
667 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES,
668 INIT_CTX_ENABLE_VALUE);
669 qat_hal_wr_indr_csr(handle, ae, ctx_mask, CTX_STS_INDIRECT,
670 handle->hal_handle->upc_mask &
671 INIT_PC_VALUE);
672 qat_hal_wr_ae_csr(handle, ae, CTX_ARB_CNTL, INIT_CTX_ARB_VALUE);
673 qat_hal_wr_ae_csr(handle, ae, CC_ENABLE, INIT_CCENABLE_VALUE);
674 qat_hal_put_wakeup_event(handle, ae, ctx_mask,
675 INIT_WAKEUP_EVENTS_VALUE);
676 qat_hal_put_sig_event(handle, ae, ctx_mask,
677 INIT_SIG_EVENTS_VALUE);
678 }
679 return 0;
680 }
681
qat_hal_chip_init(struct icp_qat_fw_loader_handle * handle,struct adf_accel_dev * accel_dev)682 static int qat_hal_chip_init(struct icp_qat_fw_loader_handle *handle,
683 struct adf_accel_dev *accel_dev)
684 {
685 struct adf_accel_pci *pci_info = &accel_dev->accel_pci_dev;
686 struct adf_hw_device_data *hw_data = accel_dev->hw_device;
687 void __iomem *pmisc_addr = adf_get_pmisc_base(accel_dev);
688 unsigned int max_en_ae_id = 0;
689 struct adf_bar *sram_bar;
690 unsigned int csr_val = 0;
691 unsigned long ae_mask;
692 unsigned char ae = 0;
693 int ret = 0;
694
695 handle->pci_dev = pci_info->pci_dev;
696 switch (handle->pci_dev->device) {
697 case ADF_4XXX_PCI_DEVICE_ID:
698 case ADF_401XX_PCI_DEVICE_ID:
699 handle->chip_info->mmp_sram_size = 0;
700 handle->chip_info->nn = false;
701 handle->chip_info->lm2lm3 = true;
702 handle->chip_info->lm_size = ICP_QAT_UCLO_MAX_LMEM_REG_2X;
703 handle->chip_info->icp_rst_csr = ICP_RESET_CPP0;
704 handle->chip_info->icp_rst_mask = 0x100015;
705 handle->chip_info->glb_clk_enable_csr = ICP_GLOBAL_CLK_ENABLE_CPP0;
706 handle->chip_info->misc_ctl_csr = MISC_CONTROL_C4XXX;
707 handle->chip_info->wakeup_event_val = 0x80000000;
708 handle->chip_info->fw_auth = true;
709 handle->chip_info->css_3k = true;
710 handle->chip_info->tgroup_share_ustore = true;
711 handle->chip_info->fcu_ctl_csr = FCU_CONTROL_4XXX;
712 handle->chip_info->fcu_sts_csr = FCU_STATUS_4XXX;
713 handle->chip_info->fcu_dram_addr_hi = FCU_DRAM_ADDR_HI_4XXX;
714 handle->chip_info->fcu_dram_addr_lo = FCU_DRAM_ADDR_LO_4XXX;
715 handle->chip_info->fcu_loaded_ae_csr = FCU_AE_LOADED_4XXX;
716 handle->chip_info->fcu_loaded_ae_pos = 0;
717
718 handle->hal_cap_g_ctl_csr_addr_v = pmisc_addr + ICP_QAT_CAP_OFFSET_4XXX;
719 handle->hal_cap_ae_xfer_csr_addr_v = pmisc_addr + ICP_QAT_AE_OFFSET_4XXX;
720 handle->hal_ep_csr_addr_v = pmisc_addr + ICP_QAT_EP_OFFSET_4XXX;
721 handle->hal_cap_ae_local_csr_addr_v =
722 (void __iomem *)((uintptr_t)handle->hal_cap_ae_xfer_csr_addr_v
723 + LOCAL_TO_XFER_REG_OFFSET);
724 break;
725 case PCI_DEVICE_ID_INTEL_QAT_C62X:
726 case PCI_DEVICE_ID_INTEL_QAT_C3XXX:
727 handle->chip_info->mmp_sram_size = 0;
728 handle->chip_info->nn = true;
729 handle->chip_info->lm2lm3 = false;
730 handle->chip_info->lm_size = ICP_QAT_UCLO_MAX_LMEM_REG;
731 handle->chip_info->icp_rst_csr = ICP_RESET;
732 handle->chip_info->icp_rst_mask = (hw_data->ae_mask << RST_CSR_AE_LSB) |
733 (hw_data->accel_mask << RST_CSR_QAT_LSB);
734 handle->chip_info->glb_clk_enable_csr = ICP_GLOBAL_CLK_ENABLE;
735 handle->chip_info->misc_ctl_csr = MISC_CONTROL;
736 handle->chip_info->wakeup_event_val = WAKEUP_EVENT;
737 handle->chip_info->fw_auth = true;
738 handle->chip_info->css_3k = false;
739 handle->chip_info->tgroup_share_ustore = false;
740 handle->chip_info->fcu_ctl_csr = FCU_CONTROL;
741 handle->chip_info->fcu_sts_csr = FCU_STATUS;
742 handle->chip_info->fcu_dram_addr_hi = FCU_DRAM_ADDR_HI;
743 handle->chip_info->fcu_dram_addr_lo = FCU_DRAM_ADDR_LO;
744 handle->chip_info->fcu_loaded_ae_csr = FCU_STATUS;
745 handle->chip_info->fcu_loaded_ae_pos = FCU_LOADED_AE_POS;
746 handle->hal_cap_g_ctl_csr_addr_v = pmisc_addr + ICP_QAT_CAP_OFFSET;
747 handle->hal_cap_ae_xfer_csr_addr_v = pmisc_addr + ICP_QAT_AE_OFFSET;
748 handle->hal_ep_csr_addr_v = pmisc_addr + ICP_QAT_EP_OFFSET;
749 handle->hal_cap_ae_local_csr_addr_v =
750 (void __iomem *)((uintptr_t)handle->hal_cap_ae_xfer_csr_addr_v
751 + LOCAL_TO_XFER_REG_OFFSET);
752 break;
753 case PCI_DEVICE_ID_INTEL_QAT_DH895XCC:
754 handle->chip_info->mmp_sram_size = 0x40000;
755 handle->chip_info->nn = true;
756 handle->chip_info->lm2lm3 = false;
757 handle->chip_info->lm_size = ICP_QAT_UCLO_MAX_LMEM_REG;
758 handle->chip_info->icp_rst_csr = ICP_RESET;
759 handle->chip_info->icp_rst_mask = (hw_data->ae_mask << RST_CSR_AE_LSB) |
760 (hw_data->accel_mask << RST_CSR_QAT_LSB);
761 handle->chip_info->glb_clk_enable_csr = ICP_GLOBAL_CLK_ENABLE;
762 handle->chip_info->misc_ctl_csr = MISC_CONTROL;
763 handle->chip_info->wakeup_event_val = WAKEUP_EVENT;
764 handle->chip_info->fw_auth = false;
765 handle->chip_info->css_3k = false;
766 handle->chip_info->tgroup_share_ustore = false;
767 handle->chip_info->fcu_ctl_csr = 0;
768 handle->chip_info->fcu_sts_csr = 0;
769 handle->chip_info->fcu_dram_addr_hi = 0;
770 handle->chip_info->fcu_dram_addr_lo = 0;
771 handle->chip_info->fcu_loaded_ae_csr = 0;
772 handle->chip_info->fcu_loaded_ae_pos = 0;
773 handle->hal_cap_g_ctl_csr_addr_v = pmisc_addr + ICP_QAT_CAP_OFFSET;
774 handle->hal_cap_ae_xfer_csr_addr_v = pmisc_addr + ICP_QAT_AE_OFFSET;
775 handle->hal_ep_csr_addr_v = pmisc_addr + ICP_QAT_EP_OFFSET;
776 handle->hal_cap_ae_local_csr_addr_v =
777 (void __iomem *)((uintptr_t)handle->hal_cap_ae_xfer_csr_addr_v
778 + LOCAL_TO_XFER_REG_OFFSET);
779 break;
780 default:
781 ret = -EINVAL;
782 goto out_err;
783 }
784
785 if (handle->chip_info->mmp_sram_size > 0) {
786 sram_bar =
787 &pci_info->pci_bars[hw_data->get_sram_bar_id(hw_data)];
788 handle->hal_sram_addr_v = sram_bar->virt_addr;
789 }
790 handle->hal_handle->revision_id = accel_dev->accel_pci_dev.revid;
791 handle->hal_handle->ae_mask = hw_data->ae_mask;
792 handle->hal_handle->admin_ae_mask = hw_data->admin_ae_mask;
793 handle->hal_handle->slice_mask = hw_data->accel_mask;
794 handle->cfg_ae_mask = ALL_AE_MASK;
795 /* create AE objects */
796 handle->hal_handle->upc_mask = 0x1ffff;
797 handle->hal_handle->max_ustore = 0x4000;
798
799 ae_mask = handle->hal_handle->ae_mask;
800 for_each_set_bit(ae, &ae_mask, ICP_QAT_UCLO_MAX_AE) {
801 handle->hal_handle->aes[ae].free_addr = 0;
802 handle->hal_handle->aes[ae].free_size =
803 handle->hal_handle->max_ustore;
804 handle->hal_handle->aes[ae].ustore_size =
805 handle->hal_handle->max_ustore;
806 handle->hal_handle->aes[ae].live_ctx_mask =
807 ICP_QAT_UCLO_AE_ALL_CTX;
808 max_en_ae_id = ae;
809 }
810 handle->hal_handle->ae_max_num = max_en_ae_id + 1;
811
812 /* Set SIGNATURE_ENABLE[0] to 0x1 in order to enable ALU_OUT csr */
813 for_each_set_bit(ae, &ae_mask, handle->hal_handle->ae_max_num) {
814 csr_val = qat_hal_rd_ae_csr(handle, ae, SIGNATURE_ENABLE);
815 csr_val |= 0x1;
816 qat_hal_wr_ae_csr(handle, ae, SIGNATURE_ENABLE, csr_val);
817 }
818 out_err:
819 return ret;
820 }
821
qat_hal_init(struct adf_accel_dev * accel_dev)822 int qat_hal_init(struct adf_accel_dev *accel_dev)
823 {
824 struct icp_qat_fw_loader_handle *handle;
825 int ret = 0;
826
827 handle = kzalloc(sizeof(*handle), GFP_KERNEL);
828 if (!handle)
829 return -ENOMEM;
830
831 handle->hal_handle = kzalloc(sizeof(*handle->hal_handle), GFP_KERNEL);
832 if (!handle->hal_handle) {
833 ret = -ENOMEM;
834 goto out_hal_handle;
835 }
836
837 handle->chip_info = kzalloc(sizeof(*handle->chip_info), GFP_KERNEL);
838 if (!handle->chip_info) {
839 ret = -ENOMEM;
840 goto out_chip_info;
841 }
842
843 ret = qat_hal_chip_init(handle, accel_dev);
844 if (ret) {
845 dev_err(&GET_DEV(accel_dev), "qat_hal_chip_init error\n");
846 goto out_err;
847 }
848
849 /* take all AEs out of reset */
850 ret = qat_hal_clr_reset(handle);
851 if (ret) {
852 dev_err(&GET_DEV(accel_dev), "qat_hal_clr_reset error\n");
853 goto out_err;
854 }
855
856 qat_hal_clear_xfer(handle);
857 if (!handle->chip_info->fw_auth) {
858 ret = qat_hal_clear_gpr(handle);
859 if (ret)
860 goto out_err;
861 }
862
863 accel_dev->fw_loader->fw_loader = handle;
864 return 0;
865
866 out_err:
867 kfree(handle->chip_info);
868 out_chip_info:
869 kfree(handle->hal_handle);
870 out_hal_handle:
871 kfree(handle);
872 return ret;
873 }
874
qat_hal_deinit(struct icp_qat_fw_loader_handle * handle)875 void qat_hal_deinit(struct icp_qat_fw_loader_handle *handle)
876 {
877 if (!handle)
878 return;
879 kfree(handle->chip_info);
880 kfree(handle->hal_handle);
881 kfree(handle);
882 }
883
qat_hal_start(struct icp_qat_fw_loader_handle * handle)884 int qat_hal_start(struct icp_qat_fw_loader_handle *handle)
885 {
886 unsigned long ae_mask = handle->hal_handle->ae_mask;
887 u32 wakeup_val = handle->chip_info->wakeup_event_val;
888 u32 fcu_ctl_csr, fcu_sts_csr;
889 unsigned int fcu_sts;
890 unsigned char ae;
891 u32 ae_ctr = 0;
892 int retry = 0;
893
894 if (handle->chip_info->fw_auth) {
895 fcu_ctl_csr = handle->chip_info->fcu_ctl_csr;
896 fcu_sts_csr = handle->chip_info->fcu_sts_csr;
897 ae_ctr = hweight32(ae_mask);
898 SET_CAP_CSR(handle, fcu_ctl_csr, FCU_CTRL_CMD_START);
899 do {
900 msleep(FW_AUTH_WAIT_PERIOD);
901 fcu_sts = GET_CAP_CSR(handle, fcu_sts_csr);
902 if (((fcu_sts >> FCU_STS_DONE_POS) & 0x1))
903 return ae_ctr;
904 } while (retry++ < FW_AUTH_MAX_RETRY);
905 pr_err("QAT: start error (FCU_STS = 0x%x)\n", fcu_sts);
906 return 0;
907 } else {
908 for_each_set_bit(ae, &ae_mask, handle->hal_handle->ae_max_num) {
909 qat_hal_put_wakeup_event(handle, ae, 0, wakeup_val);
910 qat_hal_enable_ctx(handle, ae, ICP_QAT_UCLO_AE_ALL_CTX);
911 ae_ctr++;
912 }
913 return ae_ctr;
914 }
915 }
916
qat_hal_stop(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int ctx_mask)917 void qat_hal_stop(struct icp_qat_fw_loader_handle *handle, unsigned char ae,
918 unsigned int ctx_mask)
919 {
920 if (!handle->chip_info->fw_auth)
921 qat_hal_disable_ctx(handle, ae, ctx_mask);
922 }
923
qat_hal_set_pc(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int ctx_mask,unsigned int upc)924 void qat_hal_set_pc(struct icp_qat_fw_loader_handle *handle,
925 unsigned char ae, unsigned int ctx_mask, unsigned int upc)
926 {
927 qat_hal_wr_indr_csr(handle, ae, ctx_mask, CTX_STS_INDIRECT,
928 handle->hal_handle->upc_mask & upc);
929 }
930
qat_hal_get_uwords(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int uaddr,unsigned int words_num,u64 * uword)931 static void qat_hal_get_uwords(struct icp_qat_fw_loader_handle *handle,
932 unsigned char ae, unsigned int uaddr,
933 unsigned int words_num, u64 *uword)
934 {
935 unsigned int i, uwrd_lo, uwrd_hi;
936 unsigned int ustore_addr, misc_control;
937
938 misc_control = qat_hal_rd_ae_csr(handle, ae, AE_MISC_CONTROL);
939 qat_hal_wr_ae_csr(handle, ae, AE_MISC_CONTROL,
940 misc_control & 0xfffffffb);
941 ustore_addr = qat_hal_rd_ae_csr(handle, ae, USTORE_ADDRESS);
942 uaddr |= UA_ECS;
943 for (i = 0; i < words_num; i++) {
944 qat_hal_wr_ae_csr(handle, ae, USTORE_ADDRESS, uaddr);
945 uaddr++;
946 uwrd_lo = qat_hal_rd_ae_csr(handle, ae, USTORE_DATA_LOWER);
947 uwrd_hi = qat_hal_rd_ae_csr(handle, ae, USTORE_DATA_UPPER);
948 uword[i] = uwrd_hi;
949 uword[i] = (uword[i] << 0x20) | uwrd_lo;
950 }
951 qat_hal_wr_ae_csr(handle, ae, AE_MISC_CONTROL, misc_control);
952 qat_hal_wr_ae_csr(handle, ae, USTORE_ADDRESS, ustore_addr);
953 }
954
qat_hal_wr_umem(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned int uaddr,unsigned int words_num,unsigned int * data)955 void qat_hal_wr_umem(struct icp_qat_fw_loader_handle *handle,
956 unsigned char ae, unsigned int uaddr,
957 unsigned int words_num, unsigned int *data)
958 {
959 unsigned int i, ustore_addr;
960
961 ustore_addr = qat_hal_rd_ae_csr(handle, ae, USTORE_ADDRESS);
962 uaddr |= UA_ECS;
963 qat_hal_wr_ae_csr(handle, ae, USTORE_ADDRESS, uaddr);
964 for (i = 0; i < words_num; i++) {
965 unsigned int uwrd_lo, uwrd_hi, tmp;
966
967 uwrd_lo = ((data[i] & 0xfff0000) << 4) | (0x3 << 18) |
968 ((data[i] & 0xff00) << 2) |
969 (0x3 << 8) | (data[i] & 0xff);
970 uwrd_hi = (0xf << 4) | ((data[i] & 0xf0000000) >> 28);
971 uwrd_hi |= (hweight32(data[i] & 0xffff) & 0x1) << 8;
972 tmp = ((data[i] >> 0x10) & 0xffff);
973 uwrd_hi |= (hweight32(tmp) & 0x1) << 9;
974 qat_hal_wr_ae_csr(handle, ae, USTORE_DATA_LOWER, uwrd_lo);
975 qat_hal_wr_ae_csr(handle, ae, USTORE_DATA_UPPER, uwrd_hi);
976 }
977 qat_hal_wr_ae_csr(handle, ae, USTORE_ADDRESS, ustore_addr);
978 }
979
980 #define MAX_EXEC_INST 100
qat_hal_exec_micro_inst(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char ctx,u64 * micro_inst,unsigned int inst_num,int code_off,unsigned int max_cycle,unsigned int * endpc)981 static int qat_hal_exec_micro_inst(struct icp_qat_fw_loader_handle *handle,
982 unsigned char ae, unsigned char ctx,
983 u64 *micro_inst, unsigned int inst_num,
984 int code_off, unsigned int max_cycle,
985 unsigned int *endpc)
986 {
987 unsigned int ind_lm_addr_byte0 = 0, ind_lm_addr_byte1 = 0;
988 unsigned int ind_lm_addr_byte2 = 0, ind_lm_addr_byte3 = 0;
989 unsigned int ind_t_index = 0, ind_t_index_byte = 0;
990 unsigned int ind_lm_addr0 = 0, ind_lm_addr1 = 0;
991 unsigned int ind_lm_addr2 = 0, ind_lm_addr3 = 0;
992 u64 savuwords[MAX_EXEC_INST];
993 unsigned int ind_cnt_sig;
994 unsigned int ind_sig, act_sig;
995 unsigned int csr_val = 0, newcsr_val;
996 unsigned int savctx;
997 unsigned int savcc, wakeup_events, savpc;
998 unsigned int ctxarb_ctl, ctx_enables;
999
1000 if ((inst_num > handle->hal_handle->max_ustore) || !micro_inst) {
1001 pr_err("QAT: invalid instruction num %d\n", inst_num);
1002 return -EINVAL;
1003 }
1004 /* save current context */
1005 ind_lm_addr0 = qat_hal_rd_indr_csr(handle, ae, ctx, LM_ADDR_0_INDIRECT);
1006 ind_lm_addr1 = qat_hal_rd_indr_csr(handle, ae, ctx, LM_ADDR_1_INDIRECT);
1007 ind_lm_addr_byte0 = qat_hal_rd_indr_csr(handle, ae, ctx,
1008 INDIRECT_LM_ADDR_0_BYTE_INDEX);
1009 ind_lm_addr_byte1 = qat_hal_rd_indr_csr(handle, ae, ctx,
1010 INDIRECT_LM_ADDR_1_BYTE_INDEX);
1011 if (handle->chip_info->lm2lm3) {
1012 ind_lm_addr2 = qat_hal_rd_indr_csr(handle, ae, ctx,
1013 LM_ADDR_2_INDIRECT);
1014 ind_lm_addr3 = qat_hal_rd_indr_csr(handle, ae, ctx,
1015 LM_ADDR_3_INDIRECT);
1016 ind_lm_addr_byte2 = qat_hal_rd_indr_csr(handle, ae, ctx,
1017 INDIRECT_LM_ADDR_2_BYTE_INDEX);
1018 ind_lm_addr_byte3 = qat_hal_rd_indr_csr(handle, ae, ctx,
1019 INDIRECT_LM_ADDR_3_BYTE_INDEX);
1020 ind_t_index = qat_hal_rd_indr_csr(handle, ae, ctx,
1021 INDIRECT_T_INDEX);
1022 ind_t_index_byte = qat_hal_rd_indr_csr(handle, ae, ctx,
1023 INDIRECT_T_INDEX_BYTE_INDEX);
1024 }
1025 if (inst_num <= MAX_EXEC_INST)
1026 qat_hal_get_uwords(handle, ae, 0, inst_num, savuwords);
1027 qat_hal_get_wakeup_event(handle, ae, ctx, &wakeup_events);
1028 savpc = qat_hal_rd_indr_csr(handle, ae, ctx, CTX_STS_INDIRECT);
1029 savpc = (savpc & handle->hal_handle->upc_mask) >> 0;
1030 ctx_enables = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
1031 ctx_enables &= IGNORE_W1C_MASK;
1032 savcc = qat_hal_rd_ae_csr(handle, ae, CC_ENABLE);
1033 savctx = qat_hal_rd_ae_csr(handle, ae, ACTIVE_CTX_STATUS);
1034 ctxarb_ctl = qat_hal_rd_ae_csr(handle, ae, CTX_ARB_CNTL);
1035 ind_cnt_sig = qat_hal_rd_indr_csr(handle, ae, ctx,
1036 FUTURE_COUNT_SIGNAL_INDIRECT);
1037 ind_sig = qat_hal_rd_indr_csr(handle, ae, ctx,
1038 CTX_SIG_EVENTS_INDIRECT);
1039 act_sig = qat_hal_rd_ae_csr(handle, ae, CTX_SIG_EVENTS_ACTIVE);
1040 /* execute micro codes */
1041 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, ctx_enables);
1042 qat_hal_wr_uwords(handle, ae, 0, inst_num, micro_inst);
1043 qat_hal_wr_indr_csr(handle, ae, (1 << ctx), CTX_STS_INDIRECT, 0);
1044 qat_hal_wr_ae_csr(handle, ae, ACTIVE_CTX_STATUS, ctx & ACS_ACNO);
1045 if (code_off)
1046 qat_hal_wr_ae_csr(handle, ae, CC_ENABLE, savcc & 0xffffdfff);
1047 qat_hal_put_wakeup_event(handle, ae, (1 << ctx), XCWE_VOLUNTARY);
1048 qat_hal_wr_indr_csr(handle, ae, (1 << ctx), CTX_SIG_EVENTS_INDIRECT, 0);
1049 qat_hal_wr_ae_csr(handle, ae, CTX_SIG_EVENTS_ACTIVE, 0);
1050 qat_hal_enable_ctx(handle, ae, (1 << ctx));
1051 /* wait for micro codes to finish */
1052 if (qat_hal_wait_cycles(handle, ae, max_cycle, 1) != 0)
1053 return -EFAULT;
1054 if (endpc) {
1055 unsigned int ctx_status;
1056
1057 ctx_status = qat_hal_rd_indr_csr(handle, ae, ctx,
1058 CTX_STS_INDIRECT);
1059 *endpc = ctx_status & handle->hal_handle->upc_mask;
1060 }
1061 /* retore to saved context */
1062 qat_hal_disable_ctx(handle, ae, (1 << ctx));
1063 if (inst_num <= MAX_EXEC_INST)
1064 qat_hal_wr_uwords(handle, ae, 0, inst_num, savuwords);
1065 qat_hal_put_wakeup_event(handle, ae, (1 << ctx), wakeup_events);
1066 qat_hal_wr_indr_csr(handle, ae, (1 << ctx), CTX_STS_INDIRECT,
1067 handle->hal_handle->upc_mask & savpc);
1068 csr_val = qat_hal_rd_ae_csr(handle, ae, AE_MISC_CONTROL);
1069 newcsr_val = CLR_BIT(csr_val, MMC_SHARE_CS_BITPOS);
1070 qat_hal_wr_ae_csr(handle, ae, AE_MISC_CONTROL, newcsr_val);
1071 qat_hal_wr_ae_csr(handle, ae, CC_ENABLE, savcc);
1072 qat_hal_wr_ae_csr(handle, ae, ACTIVE_CTX_STATUS, savctx & ACS_ACNO);
1073 qat_hal_wr_ae_csr(handle, ae, CTX_ARB_CNTL, ctxarb_ctl);
1074 qat_hal_wr_indr_csr(handle, ae, (1 << ctx),
1075 LM_ADDR_0_INDIRECT, ind_lm_addr0);
1076 qat_hal_wr_indr_csr(handle, ae, (1 << ctx),
1077 LM_ADDR_1_INDIRECT, ind_lm_addr1);
1078 qat_hal_wr_indr_csr(handle, ae, (1 << ctx),
1079 INDIRECT_LM_ADDR_0_BYTE_INDEX, ind_lm_addr_byte0);
1080 qat_hal_wr_indr_csr(handle, ae, (1 << ctx),
1081 INDIRECT_LM_ADDR_1_BYTE_INDEX, ind_lm_addr_byte1);
1082 if (handle->chip_info->lm2lm3) {
1083 qat_hal_wr_indr_csr(handle, ae, BIT(ctx), LM_ADDR_2_INDIRECT,
1084 ind_lm_addr2);
1085 qat_hal_wr_indr_csr(handle, ae, BIT(ctx), LM_ADDR_3_INDIRECT,
1086 ind_lm_addr3);
1087 qat_hal_wr_indr_csr(handle, ae, BIT(ctx),
1088 INDIRECT_LM_ADDR_2_BYTE_INDEX,
1089 ind_lm_addr_byte2);
1090 qat_hal_wr_indr_csr(handle, ae, BIT(ctx),
1091 INDIRECT_LM_ADDR_3_BYTE_INDEX,
1092 ind_lm_addr_byte3);
1093 qat_hal_wr_indr_csr(handle, ae, BIT(ctx),
1094 INDIRECT_T_INDEX, ind_t_index);
1095 qat_hal_wr_indr_csr(handle, ae, BIT(ctx),
1096 INDIRECT_T_INDEX_BYTE_INDEX,
1097 ind_t_index_byte);
1098 }
1099 qat_hal_wr_indr_csr(handle, ae, (1 << ctx),
1100 FUTURE_COUNT_SIGNAL_INDIRECT, ind_cnt_sig);
1101 qat_hal_wr_indr_csr(handle, ae, (1 << ctx),
1102 CTX_SIG_EVENTS_INDIRECT, ind_sig);
1103 qat_hal_wr_ae_csr(handle, ae, CTX_SIG_EVENTS_ACTIVE, act_sig);
1104 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, ctx_enables);
1105
1106 return 0;
1107 }
1108
qat_hal_rd_rel_reg(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char ctx,enum icp_qat_uof_regtype reg_type,unsigned short reg_num,unsigned int * data)1109 static int qat_hal_rd_rel_reg(struct icp_qat_fw_loader_handle *handle,
1110 unsigned char ae, unsigned char ctx,
1111 enum icp_qat_uof_regtype reg_type,
1112 unsigned short reg_num, unsigned int *data)
1113 {
1114 unsigned int savctx, uaddr, uwrd_lo, uwrd_hi;
1115 unsigned int ctxarb_cntl, ustore_addr, ctx_enables;
1116 unsigned short reg_addr;
1117 int status = 0;
1118 u64 insts, savuword;
1119
1120 reg_addr = qat_hal_get_reg_addr(reg_type, reg_num);
1121 if (reg_addr == BAD_REGADDR) {
1122 pr_err("QAT: bad regaddr=0x%x\n", reg_addr);
1123 return -EINVAL;
1124 }
1125 switch (reg_type) {
1126 case ICP_GPA_REL:
1127 insts = 0xA070000000ull | (reg_addr & 0x3ff);
1128 break;
1129 default:
1130 insts = (u64)0xA030000000ull | ((reg_addr & 0x3ff) << 10);
1131 break;
1132 }
1133 savctx = qat_hal_rd_ae_csr(handle, ae, ACTIVE_CTX_STATUS);
1134 ctxarb_cntl = qat_hal_rd_ae_csr(handle, ae, CTX_ARB_CNTL);
1135 ctx_enables = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
1136 ctx_enables &= IGNORE_W1C_MASK;
1137 if (ctx != (savctx & ACS_ACNO))
1138 qat_hal_wr_ae_csr(handle, ae, ACTIVE_CTX_STATUS,
1139 ctx & ACS_ACNO);
1140 qat_hal_get_uwords(handle, ae, 0, 1, &savuword);
1141 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, ctx_enables);
1142 ustore_addr = qat_hal_rd_ae_csr(handle, ae, USTORE_ADDRESS);
1143 uaddr = UA_ECS;
1144 qat_hal_wr_ae_csr(handle, ae, USTORE_ADDRESS, uaddr);
1145 insts = qat_hal_set_uword_ecc(insts);
1146 uwrd_lo = (unsigned int)(insts & 0xffffffff);
1147 uwrd_hi = (unsigned int)(insts >> 0x20);
1148 qat_hal_wr_ae_csr(handle, ae, USTORE_DATA_LOWER, uwrd_lo);
1149 qat_hal_wr_ae_csr(handle, ae, USTORE_DATA_UPPER, uwrd_hi);
1150 qat_hal_wr_ae_csr(handle, ae, USTORE_ADDRESS, uaddr);
1151 /* delay for at least 8 cycles */
1152 qat_hal_wait_cycles(handle, ae, 0x8, 0);
1153 /*
1154 * read ALU output
1155 * the instruction should have been executed
1156 * prior to clearing the ECS in putUwords
1157 */
1158 *data = qat_hal_rd_ae_csr(handle, ae, ALU_OUT);
1159 qat_hal_wr_ae_csr(handle, ae, USTORE_ADDRESS, ustore_addr);
1160 qat_hal_wr_uwords(handle, ae, 0, 1, &savuword);
1161 if (ctx != (savctx & ACS_ACNO))
1162 qat_hal_wr_ae_csr(handle, ae, ACTIVE_CTX_STATUS,
1163 savctx & ACS_ACNO);
1164 qat_hal_wr_ae_csr(handle, ae, CTX_ARB_CNTL, ctxarb_cntl);
1165 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, ctx_enables);
1166
1167 return status;
1168 }
1169
qat_hal_wr_rel_reg(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char ctx,enum icp_qat_uof_regtype reg_type,unsigned short reg_num,unsigned int data)1170 static int qat_hal_wr_rel_reg(struct icp_qat_fw_loader_handle *handle,
1171 unsigned char ae, unsigned char ctx,
1172 enum icp_qat_uof_regtype reg_type,
1173 unsigned short reg_num, unsigned int data)
1174 {
1175 unsigned short src_hiaddr, src_lowaddr, dest_addr, data16hi, data16lo;
1176 u64 insts[] = {
1177 0x0F440000000ull,
1178 0x0F040000000ull,
1179 0x0F0000C0300ull,
1180 0x0E000010000ull
1181 };
1182 const int num_inst = ARRAY_SIZE(insts), code_off = 1;
1183 const int imm_w1 = 0, imm_w0 = 1;
1184
1185 dest_addr = qat_hal_get_reg_addr(reg_type, reg_num);
1186 if (dest_addr == BAD_REGADDR) {
1187 pr_err("QAT: bad destAddr=0x%x\n", dest_addr);
1188 return -EINVAL;
1189 }
1190
1191 data16lo = 0xffff & data;
1192 data16hi = 0xffff & (data >> 0x10);
1193 src_hiaddr = qat_hal_get_reg_addr(ICP_NO_DEST, (unsigned short)
1194 (0xff & data16hi));
1195 src_lowaddr = qat_hal_get_reg_addr(ICP_NO_DEST, (unsigned short)
1196 (0xff & data16lo));
1197 switch (reg_type) {
1198 case ICP_GPA_REL:
1199 insts[imm_w1] = insts[imm_w1] | ((data16hi >> 8) << 20) |
1200 ((src_hiaddr & 0x3ff) << 10) | (dest_addr & 0x3ff);
1201 insts[imm_w0] = insts[imm_w0] | ((data16lo >> 8) << 20) |
1202 ((src_lowaddr & 0x3ff) << 10) | (dest_addr & 0x3ff);
1203 break;
1204 default:
1205 insts[imm_w1] = insts[imm_w1] | ((data16hi >> 8) << 20) |
1206 ((dest_addr & 0x3ff) << 10) | (src_hiaddr & 0x3ff);
1207
1208 insts[imm_w0] = insts[imm_w0] | ((data16lo >> 8) << 20) |
1209 ((dest_addr & 0x3ff) << 10) | (src_lowaddr & 0x3ff);
1210 break;
1211 }
1212
1213 return qat_hal_exec_micro_inst(handle, ae, ctx, insts, num_inst,
1214 code_off, num_inst * 0x5, NULL);
1215 }
1216
qat_hal_get_ins_num(void)1217 int qat_hal_get_ins_num(void)
1218 {
1219 return ARRAY_SIZE(inst_4b);
1220 }
1221
qat_hal_concat_micro_code(u64 * micro_inst,unsigned int inst_num,unsigned int size,unsigned int addr,unsigned int * value)1222 static int qat_hal_concat_micro_code(u64 *micro_inst,
1223 unsigned int inst_num, unsigned int size,
1224 unsigned int addr, unsigned int *value)
1225 {
1226 int i;
1227 unsigned int cur_value;
1228 const u64 *inst_arr;
1229 int fixup_offset;
1230 int usize = 0;
1231 int orig_num;
1232
1233 orig_num = inst_num;
1234 cur_value = value[0];
1235 inst_arr = inst_4b;
1236 usize = ARRAY_SIZE(inst_4b);
1237 fixup_offset = inst_num;
1238 for (i = 0; i < usize; i++)
1239 micro_inst[inst_num++] = inst_arr[i];
1240 INSERT_IMMED_GPRA_CONST(micro_inst[fixup_offset], (addr));
1241 fixup_offset++;
1242 INSERT_IMMED_GPRA_CONST(micro_inst[fixup_offset], 0);
1243 fixup_offset++;
1244 INSERT_IMMED_GPRB_CONST(micro_inst[fixup_offset], (cur_value >> 0));
1245 fixup_offset++;
1246 INSERT_IMMED_GPRB_CONST(micro_inst[fixup_offset], (cur_value >> 0x10));
1247
1248 return inst_num - orig_num;
1249 }
1250
qat_hal_exec_micro_init_lm(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char ctx,int * pfirst_exec,u64 * micro_inst,unsigned int inst_num)1251 static int qat_hal_exec_micro_init_lm(struct icp_qat_fw_loader_handle *handle,
1252 unsigned char ae, unsigned char ctx,
1253 int *pfirst_exec, u64 *micro_inst,
1254 unsigned int inst_num)
1255 {
1256 int stat = 0;
1257 unsigned int gpra0 = 0, gpra1 = 0, gpra2 = 0;
1258 unsigned int gprb0 = 0, gprb1 = 0;
1259
1260 if (*pfirst_exec) {
1261 qat_hal_rd_rel_reg(handle, ae, ctx, ICP_GPA_REL, 0, &gpra0);
1262 qat_hal_rd_rel_reg(handle, ae, ctx, ICP_GPA_REL, 0x1, &gpra1);
1263 qat_hal_rd_rel_reg(handle, ae, ctx, ICP_GPA_REL, 0x2, &gpra2);
1264 qat_hal_rd_rel_reg(handle, ae, ctx, ICP_GPB_REL, 0, &gprb0);
1265 qat_hal_rd_rel_reg(handle, ae, ctx, ICP_GPB_REL, 0x1, &gprb1);
1266 *pfirst_exec = 0;
1267 }
1268 stat = qat_hal_exec_micro_inst(handle, ae, ctx, micro_inst, inst_num, 1,
1269 inst_num * 0x5, NULL);
1270 if (stat != 0)
1271 return -EFAULT;
1272 qat_hal_wr_rel_reg(handle, ae, ctx, ICP_GPA_REL, 0, gpra0);
1273 qat_hal_wr_rel_reg(handle, ae, ctx, ICP_GPA_REL, 0x1, gpra1);
1274 qat_hal_wr_rel_reg(handle, ae, ctx, ICP_GPA_REL, 0x2, gpra2);
1275 qat_hal_wr_rel_reg(handle, ae, ctx, ICP_GPB_REL, 0, gprb0);
1276 qat_hal_wr_rel_reg(handle, ae, ctx, ICP_GPB_REL, 0x1, gprb1);
1277
1278 return 0;
1279 }
1280
qat_hal_batch_wr_lm(struct icp_qat_fw_loader_handle * handle,unsigned char ae,struct icp_qat_uof_batch_init * lm_init_header)1281 int qat_hal_batch_wr_lm(struct icp_qat_fw_loader_handle *handle,
1282 unsigned char ae,
1283 struct icp_qat_uof_batch_init *lm_init_header)
1284 {
1285 struct icp_qat_uof_batch_init *plm_init;
1286 u64 *micro_inst_arry;
1287 int micro_inst_num;
1288 int alloc_inst_size;
1289 int first_exec = 1;
1290 int stat = 0;
1291
1292 plm_init = lm_init_header->next;
1293 alloc_inst_size = lm_init_header->size;
1294 if ((unsigned int)alloc_inst_size > handle->hal_handle->max_ustore)
1295 alloc_inst_size = handle->hal_handle->max_ustore;
1296 micro_inst_arry = kmalloc_array(alloc_inst_size, sizeof(u64),
1297 GFP_KERNEL);
1298 if (!micro_inst_arry)
1299 return -ENOMEM;
1300 micro_inst_num = 0;
1301 while (plm_init) {
1302 unsigned int addr, *value, size;
1303
1304 ae = plm_init->ae;
1305 addr = plm_init->addr;
1306 value = plm_init->value;
1307 size = plm_init->size;
1308 micro_inst_num += qat_hal_concat_micro_code(micro_inst_arry,
1309 micro_inst_num,
1310 size, addr, value);
1311 plm_init = plm_init->next;
1312 }
1313 /* exec micro codes */
1314 if (micro_inst_arry && micro_inst_num > 0) {
1315 micro_inst_arry[micro_inst_num++] = 0x0E000010000ull;
1316 stat = qat_hal_exec_micro_init_lm(handle, ae, 0, &first_exec,
1317 micro_inst_arry,
1318 micro_inst_num);
1319 }
1320 kfree(micro_inst_arry);
1321 return stat;
1322 }
1323
qat_hal_put_rel_rd_xfer(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char ctx,enum icp_qat_uof_regtype reg_type,unsigned short reg_num,unsigned int val)1324 static int qat_hal_put_rel_rd_xfer(struct icp_qat_fw_loader_handle *handle,
1325 unsigned char ae, unsigned char ctx,
1326 enum icp_qat_uof_regtype reg_type,
1327 unsigned short reg_num, unsigned int val)
1328 {
1329 int status = 0;
1330 unsigned int reg_addr;
1331 unsigned int ctx_enables;
1332 unsigned short mask;
1333 unsigned short dr_offset = 0x10;
1334
1335 ctx_enables = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
1336 if (CE_INUSE_CONTEXTS & ctx_enables) {
1337 if (ctx & 0x1) {
1338 pr_err("QAT: bad 4-ctx mode,ctx=0x%x\n", ctx);
1339 return -EINVAL;
1340 }
1341 mask = 0x1f;
1342 dr_offset = 0x20;
1343 } else {
1344 mask = 0x0f;
1345 }
1346 if (reg_num & ~mask)
1347 return -EINVAL;
1348 reg_addr = reg_num + (ctx << 0x5);
1349 switch (reg_type) {
1350 case ICP_SR_RD_REL:
1351 case ICP_SR_REL:
1352 SET_AE_XFER(handle, ae, reg_addr, val);
1353 break;
1354 case ICP_DR_RD_REL:
1355 case ICP_DR_REL:
1356 SET_AE_XFER(handle, ae, (reg_addr + dr_offset), val);
1357 break;
1358 default:
1359 status = -EINVAL;
1360 break;
1361 }
1362 return status;
1363 }
1364
qat_hal_put_rel_wr_xfer(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char ctx,enum icp_qat_uof_regtype reg_type,unsigned short reg_num,unsigned int data)1365 static int qat_hal_put_rel_wr_xfer(struct icp_qat_fw_loader_handle *handle,
1366 unsigned char ae, unsigned char ctx,
1367 enum icp_qat_uof_regtype reg_type,
1368 unsigned short reg_num, unsigned int data)
1369 {
1370 unsigned int gprval, ctx_enables;
1371 unsigned short src_hiaddr, src_lowaddr, gpr_addr, xfr_addr, data16hi,
1372 data16low;
1373 unsigned short reg_mask;
1374 int status = 0;
1375 u64 micro_inst[] = {
1376 0x0F440000000ull,
1377 0x0F040000000ull,
1378 0x0A000000000ull,
1379 0x0F0000C0300ull,
1380 0x0E000010000ull
1381 };
1382 const int num_inst = ARRAY_SIZE(micro_inst), code_off = 1;
1383 const unsigned short gprnum = 0, dly = num_inst * 0x5;
1384
1385 ctx_enables = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
1386 if (CE_INUSE_CONTEXTS & ctx_enables) {
1387 if (ctx & 0x1) {
1388 pr_err("QAT: 4-ctx mode,ctx=0x%x\n", ctx);
1389 return -EINVAL;
1390 }
1391 reg_mask = (unsigned short)~0x1f;
1392 } else {
1393 reg_mask = (unsigned short)~0xf;
1394 }
1395 if (reg_num & reg_mask)
1396 return -EINVAL;
1397 xfr_addr = qat_hal_get_reg_addr(reg_type, reg_num);
1398 if (xfr_addr == BAD_REGADDR) {
1399 pr_err("QAT: bad xfrAddr=0x%x\n", xfr_addr);
1400 return -EINVAL;
1401 }
1402 status = qat_hal_rd_rel_reg(handle, ae, ctx, ICP_GPB_REL, gprnum, &gprval);
1403 if (status) {
1404 pr_err("QAT: failed to read register");
1405 return status;
1406 }
1407 gpr_addr = qat_hal_get_reg_addr(ICP_GPB_REL, gprnum);
1408 data16low = 0xffff & data;
1409 data16hi = 0xffff & (data >> 0x10);
1410 src_hiaddr = qat_hal_get_reg_addr(ICP_NO_DEST,
1411 (unsigned short)(0xff & data16hi));
1412 src_lowaddr = qat_hal_get_reg_addr(ICP_NO_DEST,
1413 (unsigned short)(0xff & data16low));
1414 micro_inst[0] = micro_inst[0x0] | ((data16hi >> 8) << 20) |
1415 ((gpr_addr & 0x3ff) << 10) | (src_hiaddr & 0x3ff);
1416 micro_inst[1] = micro_inst[0x1] | ((data16low >> 8) << 20) |
1417 ((gpr_addr & 0x3ff) << 10) | (src_lowaddr & 0x3ff);
1418 micro_inst[0x2] = micro_inst[0x2] |
1419 ((xfr_addr & 0x3ff) << 20) | ((gpr_addr & 0x3ff) << 10);
1420 status = qat_hal_exec_micro_inst(handle, ae, ctx, micro_inst, num_inst,
1421 code_off, dly, NULL);
1422 qat_hal_wr_rel_reg(handle, ae, ctx, ICP_GPB_REL, gprnum, gprval);
1423 return status;
1424 }
1425
qat_hal_put_rel_nn(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned char ctx,unsigned short nn,unsigned int val)1426 static int qat_hal_put_rel_nn(struct icp_qat_fw_loader_handle *handle,
1427 unsigned char ae, unsigned char ctx,
1428 unsigned short nn, unsigned int val)
1429 {
1430 unsigned int ctx_enables;
1431 int stat = 0;
1432
1433 ctx_enables = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
1434 ctx_enables &= IGNORE_W1C_MASK;
1435 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, ctx_enables | CE_NN_MODE);
1436
1437 stat = qat_hal_put_rel_wr_xfer(handle, ae, ctx, ICP_NEIGH_REL, nn, val);
1438 qat_hal_wr_ae_csr(handle, ae, CTX_ENABLES, ctx_enables);
1439 return stat;
1440 }
1441
qat_hal_convert_abs_to_rel(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned short absreg_num,unsigned short * relreg,unsigned char * ctx)1442 static int qat_hal_convert_abs_to_rel(struct icp_qat_fw_loader_handle
1443 *handle, unsigned char ae,
1444 unsigned short absreg_num,
1445 unsigned short *relreg,
1446 unsigned char *ctx)
1447 {
1448 unsigned int ctx_enables;
1449
1450 ctx_enables = qat_hal_rd_ae_csr(handle, ae, CTX_ENABLES);
1451 if (ctx_enables & CE_INUSE_CONTEXTS) {
1452 /* 4-ctx mode */
1453 *relreg = absreg_num & 0x1F;
1454 *ctx = (absreg_num >> 0x4) & 0x6;
1455 } else {
1456 /* 8-ctx mode */
1457 *relreg = absreg_num & 0x0F;
1458 *ctx = (absreg_num >> 0x4) & 0x7;
1459 }
1460 return 0;
1461 }
1462
qat_hal_init_gpr(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned long ctx_mask,enum icp_qat_uof_regtype reg_type,unsigned short reg_num,unsigned int regdata)1463 int qat_hal_init_gpr(struct icp_qat_fw_loader_handle *handle,
1464 unsigned char ae, unsigned long ctx_mask,
1465 enum icp_qat_uof_regtype reg_type,
1466 unsigned short reg_num, unsigned int regdata)
1467 {
1468 int stat = 0;
1469 unsigned short reg;
1470 unsigned char ctx = 0;
1471 enum icp_qat_uof_regtype type;
1472
1473 if (reg_num >= ICP_QAT_UCLO_MAX_GPR_REG)
1474 return -EINVAL;
1475
1476 do {
1477 if (ctx_mask == 0) {
1478 qat_hal_convert_abs_to_rel(handle, ae, reg_num, ®,
1479 &ctx);
1480 type = reg_type - 1;
1481 } else {
1482 reg = reg_num;
1483 type = reg_type;
1484 if (!test_bit(ctx, &ctx_mask))
1485 continue;
1486 }
1487 stat = qat_hal_wr_rel_reg(handle, ae, ctx, type, reg, regdata);
1488 if (stat) {
1489 pr_err("QAT: write gpr fail\n");
1490 return -EINVAL;
1491 }
1492 } while (ctx_mask && (ctx++ < ICP_QAT_UCLO_MAX_CTX));
1493
1494 return 0;
1495 }
1496
qat_hal_init_wr_xfer(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned long ctx_mask,enum icp_qat_uof_regtype reg_type,unsigned short reg_num,unsigned int regdata)1497 int qat_hal_init_wr_xfer(struct icp_qat_fw_loader_handle *handle,
1498 unsigned char ae, unsigned long ctx_mask,
1499 enum icp_qat_uof_regtype reg_type,
1500 unsigned short reg_num, unsigned int regdata)
1501 {
1502 int stat = 0;
1503 unsigned short reg;
1504 unsigned char ctx = 0;
1505 enum icp_qat_uof_regtype type;
1506
1507 if (reg_num >= ICP_QAT_UCLO_MAX_XFER_REG)
1508 return -EINVAL;
1509
1510 do {
1511 if (ctx_mask == 0) {
1512 qat_hal_convert_abs_to_rel(handle, ae, reg_num, ®,
1513 &ctx);
1514 type = reg_type - 3;
1515 } else {
1516 reg = reg_num;
1517 type = reg_type;
1518 if (!test_bit(ctx, &ctx_mask))
1519 continue;
1520 }
1521 stat = qat_hal_put_rel_wr_xfer(handle, ae, ctx, type, reg,
1522 regdata);
1523 if (stat) {
1524 pr_err("QAT: write wr xfer fail\n");
1525 return -EINVAL;
1526 }
1527 } while (ctx_mask && (ctx++ < ICP_QAT_UCLO_MAX_CTX));
1528
1529 return 0;
1530 }
1531
qat_hal_init_rd_xfer(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned long ctx_mask,enum icp_qat_uof_regtype reg_type,unsigned short reg_num,unsigned int regdata)1532 int qat_hal_init_rd_xfer(struct icp_qat_fw_loader_handle *handle,
1533 unsigned char ae, unsigned long ctx_mask,
1534 enum icp_qat_uof_regtype reg_type,
1535 unsigned short reg_num, unsigned int regdata)
1536 {
1537 int stat = 0;
1538 unsigned short reg;
1539 unsigned char ctx = 0;
1540 enum icp_qat_uof_regtype type;
1541
1542 if (reg_num >= ICP_QAT_UCLO_MAX_XFER_REG)
1543 return -EINVAL;
1544
1545 do {
1546 if (ctx_mask == 0) {
1547 qat_hal_convert_abs_to_rel(handle, ae, reg_num, ®,
1548 &ctx);
1549 type = reg_type - 3;
1550 } else {
1551 reg = reg_num;
1552 type = reg_type;
1553 if (!test_bit(ctx, &ctx_mask))
1554 continue;
1555 }
1556 stat = qat_hal_put_rel_rd_xfer(handle, ae, ctx, type, reg,
1557 regdata);
1558 if (stat) {
1559 pr_err("QAT: write rd xfer fail\n");
1560 return -EINVAL;
1561 }
1562 } while (ctx_mask && (ctx++ < ICP_QAT_UCLO_MAX_CTX));
1563
1564 return 0;
1565 }
1566
qat_hal_init_nn(struct icp_qat_fw_loader_handle * handle,unsigned char ae,unsigned long ctx_mask,unsigned short reg_num,unsigned int regdata)1567 int qat_hal_init_nn(struct icp_qat_fw_loader_handle *handle,
1568 unsigned char ae, unsigned long ctx_mask,
1569 unsigned short reg_num, unsigned int regdata)
1570 {
1571 int stat = 0;
1572 unsigned char ctx;
1573 if (!handle->chip_info->nn) {
1574 dev_err(&handle->pci_dev->dev, "QAT: No next neigh in 0x%x\n",
1575 handle->pci_dev->device);
1576 return -EINVAL;
1577 }
1578
1579 if (ctx_mask == 0)
1580 return -EINVAL;
1581
1582 for (ctx = 0; ctx < ICP_QAT_UCLO_MAX_CTX; ctx++) {
1583 if (!test_bit(ctx, &ctx_mask))
1584 continue;
1585 stat = qat_hal_put_rel_nn(handle, ae, ctx, reg_num, regdata);
1586 if (stat) {
1587 pr_err("QAT: write neigh error\n");
1588 return -EINVAL;
1589 }
1590 }
1591
1592 return 0;
1593 }
1594