1 /* SPDX-License-Identifier: BSD-3-Clause */
2 /* Copyright(c) 2007-2022 Intel Corporation */
3 /* $FreeBSD$ */
4 #include "qat_freebsd.h"
5 #include "adf_cfg.h"
6 #include "adf_common_drv.h"
7 #include "adf_accel_devices.h"
8 #include "icp_qat_uclo.h"
9 #include "icp_qat_fw.h"
10 #include "icp_qat_fw_init_admin.h"
11 #include "adf_cfg_strings.h"
12 #include "adf_transport_access_macros.h"
13 #include "adf_transport_internal.h"
14 #include <linux/delay.h>
15 #include "adf_accel_devices.h"
16 #include "adf_transport_internal.h"
17 #include "adf_transport_access_macros.h"
18 #include "adf_cfg.h"
19 #include "adf_common_drv.h"
20
21 #define QAT_RING_ALIGNMENT 64
22
23 static inline u32
24 adf_modulo(u32 data, u32 shift)
25 {
26 u32 div = data >> shift;
27 u32 mult = div << shift;
28
29 return data - mult;
30 }
31
32 static inline int
33 adf_check_ring_alignment(u64 addr, u64 size)
34 {
35 if (((size - 1) & addr) != 0)
36 return EFAULT;
37 return 0;
38 }
39
40 static int
41 adf_verify_ring_size(u32 msg_size, u32 msg_num)
42 {
43 int i = ADF_MIN_RING_SIZE;
44
45 for (; i <= ADF_MAX_RING_SIZE; i++)
46 if ((msg_size * msg_num) == ADF_SIZE_TO_RING_SIZE_IN_BYTES(i))
47 return i;
48
49 return ADF_DEFAULT_RING_SIZE;
50 }
51
52 static int
53 adf_reserve_ring(struct adf_etr_bank_data *bank, u32 ring)
54 {
55 mtx_lock(&bank->lock);
56 if (bank->ring_mask & (1 << ring)) {
57 mtx_unlock(&bank->lock);
58 return EFAULT;
59 }
60 bank->ring_mask |= (1 << ring);
61 mtx_unlock(&bank->lock);
62 return 0;
63 }
64
65 static void
66 adf_unreserve_ring(struct adf_etr_bank_data *bank, u32 ring)
67 {
68 mtx_lock(&bank->lock);
69 bank->ring_mask &= ~(1 << ring);
70 mtx_unlock(&bank->lock);
71 }
72
73 static void
74 adf_enable_ring_irq(struct adf_etr_bank_data *bank, u32 ring)
75 {
76 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(bank->accel_dev);
77
78 mtx_lock(&bank->lock);
79 bank->irq_mask |= (1 << ring);
80 mtx_unlock(&bank->lock);
81 csr_ops->write_csr_int_col_en(bank->csr_addr,
82 bank->bank_number,
83 bank->irq_mask);
84 csr_ops->write_csr_int_col_ctl(bank->csr_addr,
85 bank->bank_number,
86 bank->irq_coalesc_timer);
87 }
88
89 static void
90 adf_disable_ring_irq(struct adf_etr_bank_data *bank, u32 ring)
91 {
92 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(bank->accel_dev);
93
94 mtx_lock(&bank->lock);
95 bank->irq_mask &= ~(1 << ring);
96 mtx_unlock(&bank->lock);
97 csr_ops->write_csr_int_col_en(bank->csr_addr,
98 bank->bank_number,
99 bank->irq_mask);
100 }
101
102 int
103 adf_send_message(struct adf_etr_ring_data *ring, u32 *msg)
104 {
105 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(ring->bank->accel_dev);
106 u32 msg_size = 0;
107
108 if (atomic_add_return(1, ring->inflights) > ring->max_inflights) {
109 atomic_dec(ring->inflights);
110 return EAGAIN;
111 }
112
113 msg_size = ADF_MSG_SIZE_TO_BYTES(ring->msg_size);
114 mtx_lock(&ring->lock);
115 memcpy((void *)((uintptr_t)ring->base_addr + ring->tail),
116 msg,
117 msg_size);
118
119 ring->tail = adf_modulo(ring->tail + msg_size,
120 ADF_RING_SIZE_MODULO(ring->ring_size));
121
122 csr_ops->write_csr_ring_tail(ring->bank->csr_addr,
123 ring->bank->bank_number,
124 ring->ring_number,
125 ring->tail);
126 ring->csr_tail_offset = ring->tail;
127 mtx_unlock(&ring->lock);
128 return 0;
129 }
130
131 int
132 adf_handle_response(struct adf_etr_ring_data *ring, u32 quota)
133 {
134 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(ring->bank->accel_dev);
135 u32 msg_counter = 0;
136 u32 *msg = (u32 *)((uintptr_t)ring->base_addr + ring->head);
137
138 if (!quota)
139 quota = ADF_NO_RESPONSE_QUOTA;
140
141 while ((*msg != ADF_RING_EMPTY_SIG) && (msg_counter < quota)) {
142 ring->callback((u32 *)msg);
143 atomic_dec(ring->inflights);
144 *msg = ADF_RING_EMPTY_SIG;
145 ring->head = adf_modulo(ring->head + ADF_MSG_SIZE_TO_BYTES(
146 ring->msg_size),
147 ADF_RING_SIZE_MODULO(ring->ring_size));
148 msg_counter++;
149 msg = (u32 *)((uintptr_t)ring->base_addr + ring->head);
150 }
151 if (msg_counter > 0)
152 csr_ops->write_csr_ring_head(ring->bank->csr_addr,
153 ring->bank->bank_number,
154 ring->ring_number,
155 ring->head);
156 return msg_counter;
157 }
158
159 int
160 adf_poll_bank(u32 accel_id, u32 bank_num, u32 quota)
161 {
162 int num_resp;
163 struct adf_accel_dev *accel_dev;
164 struct adf_etr_data *trans_data;
165 struct adf_etr_bank_data *bank;
166 struct adf_etr_ring_data *ring;
167 struct adf_hw_csr_ops *csr_ops;
168 u32 rings_not_empty;
169 u32 ring_num;
170 u32 resp_total = 0;
171 u32 num_rings_per_bank;
172
173 /* Find the accel device associated with the accelId
174 * passed in.
175 */
176 accel_dev = adf_devmgr_get_dev_by_id(accel_id);
177 if (!accel_dev) {
178 pr_err("There is no device with id: %d\n", accel_id);
179 return EINVAL;
180 }
181
182 csr_ops = GET_CSR_OPS(accel_dev);
183 trans_data = accel_dev->transport;
184 bank = &trans_data->banks[bank_num];
185 mtx_lock(&bank->lock);
186
187 /* Read the ring status CSR to determine which rings are empty. */
188 rings_not_empty =
189 csr_ops->read_csr_e_stat(bank->csr_addr, bank->bank_number);
190 /* Complement to find which rings have data to be processed. */
191 rings_not_empty = (~rings_not_empty) & bank->ring_mask;
192
193 /* Return RETRY if the bank polling rings
194 * are all empty.
195 */
196 if (!(rings_not_empty & bank->ring_mask)) {
197 mtx_unlock(&bank->lock);
198 return EAGAIN;
199 }
200
201 /*
202 * Loop over all rings within this bank.
203 * The ring structure is global to all
204 * rings hence while we loop over all rings in the
205 * bank we use ring_number to get the global ring.
206 */
207 num_rings_per_bank = accel_dev->hw_device->num_rings_per_bank;
208 for (ring_num = 0; ring_num < num_rings_per_bank; ring_num++) {
209 ring = &bank->rings[ring_num];
210
211 /* And with polling ring mask.
212 * If the there is no data on this ring
213 * move to the next one.
214 */
215 if (!(rings_not_empty & (1 << ring->ring_number)))
216 continue;
217
218 /* Poll the ring. */
219 num_resp = adf_handle_response(ring, quota);
220 resp_total += num_resp;
221 }
222
223 mtx_unlock(&bank->lock);
224 /* Return SUCCESS if there's any response message
225 * returned.
226 */
227 if (resp_total)
228 return 0;
229 return EAGAIN;
230 }
231
232 int
233 adf_poll_all_banks(u32 accel_id, u32 quota)
234 {
235 int status = EAGAIN;
236 struct adf_accel_dev *accel_dev;
237 struct adf_etr_data *trans_data;
238 struct adf_etr_bank_data *bank;
239 u32 bank_num;
240 u32 stat_total = 0;
241
242 /* Find the accel device associated with the accelId
243 * passed in.
244 */
245 accel_dev = adf_devmgr_get_dev_by_id(accel_id);
246 if (!accel_dev) {
247 pr_err("There is no device with id: %d\n", accel_id);
248 return EINVAL;
249 }
250
251 /* Loop over banks and call adf_poll_bank */
252 trans_data = accel_dev->transport;
253 for (bank_num = 0; bank_num < GET_MAX_BANKS(accel_dev); bank_num++) {
254 bank = &trans_data->banks[bank_num];
255 /* if there are no polling rings on this bank
256 * continue to the next bank number.
257 */
258 if (bank->ring_mask == 0)
259 continue;
260 status = adf_poll_bank(accel_id, bank_num, quota);
261 /* The successful status should be AGAIN or 0 */
262 if (status == 0)
263 stat_total++;
264 else if (status != EAGAIN)
265 return status;
266 }
267
268 /* Return SUCCESS if adf_poll_bank returned SUCCESS
269 * at any stage. adf_poll_bank cannot
270 * return fail in the above case.
271 */
272 if (stat_total)
273 return 0;
274
275 return EAGAIN;
276 }
277
278 static void
279 adf_configure_tx_ring(struct adf_etr_ring_data *ring)
280 {
281 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(ring->bank->accel_dev);
282 u32 ring_config = BUILD_RING_CONFIG(ring->ring_size);
283
284 csr_ops->write_csr_ring_config(ring->bank->csr_addr,
285 ring->bank->bank_number,
286 ring->ring_number,
287 ring_config);
288 }
289
290 static void
291 adf_configure_rx_ring(struct adf_etr_ring_data *ring)
292 {
293 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(ring->bank->accel_dev);
294 u32 ring_config = BUILD_RESP_RING_CONFIG(ring->ring_size,
295 ADF_RING_NEAR_WATERMARK_512,
296 ADF_RING_NEAR_WATERMARK_0);
297
298 csr_ops->write_csr_ring_config(ring->bank->csr_addr,
299 ring->bank->bank_number,
300 ring->ring_number,
301 ring_config);
302 }
303
304 static int
305 adf_init_ring(struct adf_etr_ring_data *ring)
306 {
307 struct adf_etr_bank_data *bank = ring->bank;
308 struct adf_accel_dev *accel_dev = bank->accel_dev;
309 struct adf_hw_device_data *hw_data = accel_dev->hw_device;
310 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(accel_dev);
311 u64 ring_base;
312 u32 ring_size_bytes = ADF_SIZE_TO_RING_SIZE_IN_BYTES(ring->ring_size);
313
314 ring_size_bytes = ADF_RING_SIZE_BYTES_MIN(ring_size_bytes);
315 int ret;
316
317 ret = bus_dma_mem_create(&ring->dma_mem,
318 accel_dev->dma_tag,
319 ring_size_bytes,
320 BUS_SPACE_MAXADDR,
321 ring_size_bytes,
322 M_WAITOK | M_ZERO);
323 if (ret)
324 return ret;
325 ring->base_addr = ring->dma_mem.dma_vaddr;
326 ring->dma_addr = ring->dma_mem.dma_baddr;
327
328 memset(ring->base_addr, 0x7F, ring_size_bytes);
329 /* The base_addr has to be aligned to the size of the buffer */
330 if (adf_check_ring_alignment(ring->dma_addr, ring_size_bytes)) {
331 device_printf(GET_DEV(accel_dev), "Ring address not aligned\n");
332 bus_dma_mem_free(&ring->dma_mem);
333 ring->base_addr = NULL;
334 return EFAULT;
335 }
336
337 if (hw_data->tx_rings_mask & (1 << ring->ring_number))
338 adf_configure_tx_ring(ring);
339 else
340 adf_configure_rx_ring(ring);
341
342 ring_base =
343 csr_ops->build_csr_ring_base_addr(ring->dma_addr, ring->ring_size);
344 csr_ops->write_csr_ring_base(ring->bank->csr_addr,
345 ring->bank->bank_number,
346 ring->ring_number,
347 ring_base);
348 mtx_init(&ring->lock, "adf bank", NULL, MTX_DEF);
349 return 0;
350 }
351
352 static void
353 adf_cleanup_ring(struct adf_etr_ring_data *ring)
354 {
355 u32 ring_size_bytes = ADF_SIZE_TO_RING_SIZE_IN_BYTES(ring->ring_size);
356 ring_size_bytes = ADF_RING_SIZE_BYTES_MIN(ring_size_bytes);
357
358 if (ring->base_addr) {
359 explicit_bzero(ring->base_addr, ring_size_bytes);
360 bus_dma_mem_free(&ring->dma_mem);
361 }
362 mtx_destroy(&ring->lock);
363 }
364
365 int
366 adf_create_ring(struct adf_accel_dev *accel_dev,
367 const char *section,
368 u32 bank_num,
369 u32 num_msgs,
370 u32 msg_size,
371 const char *ring_name,
372 adf_callback_fn callback,
373 int poll_mode,
374 struct adf_etr_ring_data **ring_ptr)
375 {
376 struct adf_etr_data *transport_data = accel_dev->transport;
377 struct adf_etr_bank_data *bank;
378 struct adf_etr_ring_data *ring;
379 char val[ADF_CFG_MAX_VAL_LEN_IN_BYTES];
380 u32 ring_num;
381 int ret;
382 u8 num_rings_per_bank = accel_dev->hw_device->num_rings_per_bank;
383
384 if (bank_num >= GET_MAX_BANKS(accel_dev)) {
385 device_printf(GET_DEV(accel_dev), "Invalid bank number\n");
386 return EFAULT;
387 }
388 if (msg_size > ADF_MSG_SIZE_TO_BYTES(ADF_MAX_MSG_SIZE)) {
389 device_printf(GET_DEV(accel_dev), "Invalid msg size\n");
390 return EFAULT;
391 }
392 if (ADF_MAX_INFLIGHTS(adf_verify_ring_size(msg_size, num_msgs),
393 ADF_BYTES_TO_MSG_SIZE(msg_size)) < 2) {
394 device_printf(GET_DEV(accel_dev),
395 "Invalid ring size for given msg size\n");
396 return EFAULT;
397 }
398 if (adf_cfg_get_param_value(accel_dev, section, ring_name, val)) {
399 device_printf(GET_DEV(accel_dev),
400 "Section %s, no such entry : %s\n",
401 section,
402 ring_name);
403 return EFAULT;
404 }
405 if (compat_strtouint(val, 10, &ring_num)) {
406 device_printf(GET_DEV(accel_dev), "Can't get ring number\n");
407 return EFAULT;
408 }
409 if (ring_num >= num_rings_per_bank) {
410 device_printf(GET_DEV(accel_dev), "Invalid ring number\n");
411 return EFAULT;
412 }
413
414 bank = &transport_data->banks[bank_num];
415 if (adf_reserve_ring(bank, ring_num)) {
416 device_printf(GET_DEV(accel_dev),
417 "Ring %d, %s already exists.\n",
418 ring_num,
419 ring_name);
420 return EFAULT;
421 }
422 ring = &bank->rings[ring_num];
423 ring->ring_number = ring_num;
424 ring->bank = bank;
425 ring->callback = callback;
426 ring->msg_size = ADF_BYTES_TO_MSG_SIZE(msg_size);
427 ring->ring_size = adf_verify_ring_size(msg_size, num_msgs);
428 ring->max_inflights =
429 ADF_MAX_INFLIGHTS(ring->ring_size, ring->msg_size);
430 ring->head = 0;
431 ring->tail = 0;
432 ring->csr_tail_offset = 0;
433 ret = adf_init_ring(ring);
434 if (ret)
435 goto err;
436
437 /* Enable HW arbitration for the given ring */
438 adf_update_ring_arb(ring);
439
440 if (adf_ring_debugfs_add(ring, ring_name)) {
441 device_printf(GET_DEV(accel_dev),
442 "Couldn't add ring debugfs entry\n");
443 ret = EFAULT;
444 goto err;
445 }
446
447 /* Enable interrupts if needed */
448 if (callback && !poll_mode)
449 adf_enable_ring_irq(bank, ring->ring_number);
450 *ring_ptr = ring;
451 return 0;
452 err:
453 adf_cleanup_ring(ring);
454 adf_unreserve_ring(bank, ring_num);
455 adf_update_ring_arb(ring);
456 return ret;
457 }
458
459 void
460 adf_remove_ring(struct adf_etr_ring_data *ring)
461 {
462 struct adf_etr_bank_data *bank = ring->bank;
463 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(bank->accel_dev);
464
465 /* Disable interrupts for the given ring */
466 adf_disable_ring_irq(bank, ring->ring_number);
467
468 /* Clear PCI config space */
469 csr_ops->write_csr_ring_config(bank->csr_addr,
470 bank->bank_number,
471 ring->ring_number,
472 0);
473 csr_ops->write_csr_ring_base(bank->csr_addr,
474 bank->bank_number,
475 ring->ring_number,
476 0);
477 adf_ring_debugfs_rm(ring);
478 adf_unreserve_ring(bank, ring->ring_number);
479 /* Disable HW arbitration for the given ring */
480 adf_update_ring_arb(ring);
481 adf_cleanup_ring(ring);
482 }
483
484 static void
485 adf_ring_response_handler(struct adf_etr_bank_data *bank)
486 {
487 struct adf_accel_dev *accel_dev = bank->accel_dev;
488 struct adf_hw_device_data *hw_data = accel_dev->hw_device;
489 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(accel_dev);
490 u8 num_rings_per_bank = hw_data->num_rings_per_bank;
491 u32 empty_rings, i;
492
493 empty_rings =
494 csr_ops->read_csr_e_stat(bank->csr_addr, bank->bank_number);
495 empty_rings = ~empty_rings & bank->irq_mask;
496
497 for (i = 0; i < num_rings_per_bank; ++i) {
498 if (empty_rings & (1 << i))
499 adf_handle_response(&bank->rings[i], 0);
500 }
501 }
502
503 void
504 adf_response_handler(uintptr_t bank_addr)
505 {
506 struct adf_etr_bank_data *bank = (void *)bank_addr;
507 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(bank->accel_dev);
508
509 /* Handle all the responses and re-enable IRQs */
510 adf_ring_response_handler(bank);
511 csr_ops->write_csr_int_flag_and_col(bank->csr_addr,
512 bank->bank_number,
513 bank->irq_mask);
514 }
515
516 static inline int
517 adf_get_cfg_int(struct adf_accel_dev *accel_dev,
518 const char *section,
519 const char *format,
520 u32 key,
521 u32 *value)
522 {
523 char key_buf[ADF_CFG_MAX_KEY_LEN_IN_BYTES];
524 char val_buf[ADF_CFG_MAX_VAL_LEN_IN_BYTES];
525
526 snprintf(key_buf, ADF_CFG_MAX_KEY_LEN_IN_BYTES, format, key);
527
528 if (adf_cfg_get_param_value(accel_dev, section, key_buf, val_buf))
529 return EFAULT;
530
531 if (compat_strtouint(val_buf, 10, value))
532 return EFAULT;
533 return 0;
534 }
535
536 static void
537 adf_get_coalesc_timer(struct adf_etr_bank_data *bank,
538 const char *section,
539 u32 bank_num_in_accel)
540 {
541 struct adf_accel_dev *accel_dev = bank->accel_dev;
542 struct adf_hw_device_data *hw_data = accel_dev->hw_device;
543 u32 coalesc_timer = ADF_COALESCING_DEF_TIME;
544
545 adf_get_cfg_int(accel_dev,
546 section,
547 ADF_ETRMGR_COALESCE_TIMER_FORMAT,
548 bank_num_in_accel,
549 &coalesc_timer);
550
551 if (hw_data->get_clock_speed)
552 bank->irq_coalesc_timer =
553 (coalesc_timer *
554 (hw_data->get_clock_speed(hw_data) / USEC_PER_SEC)) /
555 NSEC_PER_USEC;
556 else
557 bank->irq_coalesc_timer = coalesc_timer;
558
559 if (bank->irq_coalesc_timer > ADF_COALESCING_MAX_TIME)
560 bank->irq_coalesc_timer = ADF_COALESCING_MAX_TIME;
561 else if (bank->irq_coalesc_timer < ADF_COALESCING_MIN_TIME)
562 bank->irq_coalesc_timer = ADF_COALESCING_MIN_TIME;
563 }
564
565 static int
566 adf_init_bank(struct adf_accel_dev *accel_dev,
567 struct adf_etr_bank_data *bank,
568 u32 bank_num,
569 struct resource *csr_addr)
570 {
571 struct adf_hw_device_data *hw_data = accel_dev->hw_device;
572 struct adf_hw_csr_ops *csr_ops = &hw_data->csr_info.csr_ops;
573 struct adf_etr_ring_data *ring;
574 struct adf_etr_ring_data *tx_ring;
575 u32 i, coalesc_enabled = 0;
576 u8 num_rings_per_bank = hw_data->num_rings_per_bank;
577 u32 irq_mask = BIT(num_rings_per_bank) - 1;
578 u32 size = 0;
579
580 explicit_bzero(bank, sizeof(*bank));
581 bank->bank_number = bank_num;
582 bank->csr_addr = csr_addr;
583 bank->accel_dev = accel_dev;
584 mtx_init(&bank->lock, "adf bank", NULL, MTX_DEF);
585
586 /* Allocate the rings in the bank */
587 size = num_rings_per_bank * sizeof(struct adf_etr_ring_data);
588 bank->rings = kzalloc_node(size,
589 M_WAITOK | M_ZERO,
590 dev_to_node(GET_DEV(accel_dev)));
591
592 /* Enable IRQ coalescing always. This will allow to use
593 * the optimised flag and coalesc register.
594 * If it is disabled in the config file just use min time value */
595 if ((adf_get_cfg_int(accel_dev,
596 "Accelerator0",
597 ADF_ETRMGR_COALESCING_ENABLED_FORMAT,
598 bank_num,
599 &coalesc_enabled) == 0) &&
600 coalesc_enabled)
601 adf_get_coalesc_timer(bank, "Accelerator0", bank_num);
602 else
603 bank->irq_coalesc_timer = ADF_COALESCING_MIN_TIME;
604
605 for (i = 0; i < num_rings_per_bank; i++) {
606 csr_ops->write_csr_ring_config(csr_addr, bank_num, i, 0);
607 csr_ops->write_csr_ring_base(csr_addr, bank_num, i, 0);
608 ring = &bank->rings[i];
609 if (hw_data->tx_rings_mask & (1 << i)) {
610 ring->inflights =
611 kzalloc_node(sizeof(atomic_t),
612 M_WAITOK | M_ZERO,
613 dev_to_node(GET_DEV(accel_dev)));
614 } else {
615 if (i < hw_data->tx_rx_gap) {
616 device_printf(GET_DEV(accel_dev),
617 "Invalid tx rings mask config\n");
618 goto err;
619 }
620 tx_ring = &bank->rings[i - hw_data->tx_rx_gap];
621 ring->inflights = tx_ring->inflights;
622 }
623 }
624
625 if (adf_bank_debugfs_add(bank)) {
626 device_printf(GET_DEV(accel_dev),
627 "Failed to add bank debugfs entry\n");
628 goto err;
629 }
630
631 csr_ops->write_csr_int_flag(csr_addr, bank_num, irq_mask);
632 csr_ops->write_csr_int_srcsel(csr_addr, bank_num);
633 return 0;
634 err:
635 for (i = 0; i < num_rings_per_bank; i++) {
636 ring = &bank->rings[i];
637 if (hw_data->tx_rings_mask & (1 << i)) {
638 kfree(ring->inflights);
639 ring->inflights = NULL;
640 }
641 }
642 kfree(bank->rings);
643 return ENOMEM;
644 }
645
646 /**
647 * adf_init_etr_data() - Initialize transport rings for acceleration device
648 * @accel_dev: Pointer to acceleration device.
649 *
650 * Function initializes the communications channels (rings) to the
651 * acceleration device accel_dev.
652 * To be used by QAT device specific drivers.
653 *
654 * Return: 0 on success, error code otherwise.
655 */
656 int
657 adf_init_etr_data(struct adf_accel_dev *accel_dev)
658 {
659 struct adf_etr_data *etr_data;
660 struct adf_hw_device_data *hw_data = accel_dev->hw_device;
661 struct resource *csr_addr;
662 u32 size;
663 u32 num_banks = 0;
664 int i, ret;
665
666 etr_data = kzalloc_node(sizeof(*etr_data),
667 M_WAITOK | M_ZERO,
668 dev_to_node(GET_DEV(accel_dev)));
669
670 num_banks = GET_MAX_BANKS(accel_dev);
671 size = num_banks * sizeof(struct adf_etr_bank_data);
672 etr_data->banks = kzalloc_node(size,
673 M_WAITOK | M_ZERO,
674 dev_to_node(GET_DEV(accel_dev)));
675
676 accel_dev->transport = etr_data;
677 i = hw_data->get_etr_bar_id(hw_data);
678 csr_addr = accel_dev->accel_pci_dev.pci_bars[i].virt_addr;
679
680 etr_data->debug =
681 SYSCTL_ADD_NODE(&accel_dev->sysctl_ctx,
682 SYSCTL_CHILDREN(
683 device_get_sysctl_tree(GET_DEV(accel_dev))),
684 OID_AUTO,
685 "transport",
686 CTLFLAG_RD,
687 NULL,
688 "Transport parameters");
689 if (!etr_data->debug) {
690 device_printf(GET_DEV(accel_dev),
691 "Unable to create transport debugfs entry\n");
692 ret = ENOENT;
693 goto err_bank_all;
694 }
695
696 for (i = 0; i < num_banks; i++) {
697 ret =
698 adf_init_bank(accel_dev, &etr_data->banks[i], i, csr_addr);
699 if (ret)
700 goto err_bank_all;
701 }
702
703 return 0;
704
705 err_bank_all:
706 kfree(etr_data->banks);
707 kfree(etr_data);
708 accel_dev->transport = NULL;
709 return ret;
710 }
711
712 static void
713 cleanup_bank(struct adf_etr_bank_data *bank)
714 {
715 u32 i;
716 struct adf_accel_dev *accel_dev = bank->accel_dev;
717 struct adf_hw_device_data *hw_data = accel_dev->hw_device;
718 u8 num_rings_per_bank = hw_data->num_rings_per_bank;
719
720 for (i = 0; i < num_rings_per_bank; i++) {
721 struct adf_accel_dev *accel_dev = bank->accel_dev;
722 struct adf_hw_device_data *hw_data = accel_dev->hw_device;
723 struct adf_etr_ring_data *ring = &bank->rings[i];
724
725 if (bank->ring_mask & (1 << i))
726 adf_cleanup_ring(ring);
727
728 if (hw_data->tx_rings_mask & (1 << i)) {
729 kfree(ring->inflights);
730 ring->inflights = NULL;
731 }
732 }
733 kfree(bank->rings);
734 adf_bank_debugfs_rm(bank);
735 mtx_destroy(&bank->lock);
736 explicit_bzero(bank, sizeof(*bank));
737 }
738
739 static void
740 adf_cleanup_etr_handles(struct adf_accel_dev *accel_dev)
741 {
742 struct adf_etr_data *etr_data = accel_dev->transport;
743 u32 i, num_banks = GET_MAX_BANKS(accel_dev);
744
745 for (i = 0; i < num_banks; i++)
746 cleanup_bank(&etr_data->banks[i]);
747 }
748
749 /**
750 * adf_cleanup_etr_data() - Clear transport rings for acceleration device
751 * @accel_dev: Pointer to acceleration device.
752 *
753 * Function is the clears the communications channels (rings) of the
754 * acceleration device accel_dev.
755 * To be used by QAT device specific drivers.
756 *
757 * Return: void
758 */
759 void
760 adf_cleanup_etr_data(struct adf_accel_dev *accel_dev)
761 {
762 struct adf_etr_data *etr_data = accel_dev->transport;
763
764 if (etr_data) {
765 adf_cleanup_etr_handles(accel_dev);
766 kfree(etr_data->banks);
767 kfree(etr_data);
768 accel_dev->transport = NULL;
769 }
770 }
Cache object: 1b18eff1379062f63a341a952e36e3cb
|