178ee8d1cSJulian Grajkowski /* SPDX-License-Identifier: BSD-3-Clause */
278ee8d1cSJulian Grajkowski /* Copyright(c) 2007-2022 Intel Corporation */
378ee8d1cSJulian Grajkowski #include "qat_freebsd.h"
478ee8d1cSJulian Grajkowski #include "adf_cfg.h"
578ee8d1cSJulian Grajkowski #include "adf_common_drv.h"
678ee8d1cSJulian Grajkowski #include "adf_accel_devices.h"
778ee8d1cSJulian Grajkowski #include "icp_qat_uclo.h"
878ee8d1cSJulian Grajkowski #include "icp_qat_fw.h"
978ee8d1cSJulian Grajkowski #include "icp_qat_fw_init_admin.h"
1078ee8d1cSJulian Grajkowski #include "adf_cfg_strings.h"
1178ee8d1cSJulian Grajkowski #include "adf_transport_access_macros.h"
1278ee8d1cSJulian Grajkowski #include "adf_transport_internal.h"
1378ee8d1cSJulian Grajkowski #include <linux/delay.h>
1478ee8d1cSJulian Grajkowski #include "adf_accel_devices.h"
1578ee8d1cSJulian Grajkowski #include "adf_transport_internal.h"
1678ee8d1cSJulian Grajkowski #include "adf_transport_access_macros.h"
1778ee8d1cSJulian Grajkowski #include "adf_cfg.h"
1878ee8d1cSJulian Grajkowski #include "adf_common_drv.h"
1978ee8d1cSJulian Grajkowski
2078ee8d1cSJulian Grajkowski #define QAT_RING_ALIGNMENT 64
2178ee8d1cSJulian Grajkowski
2278ee8d1cSJulian Grajkowski static inline u32
adf_modulo(u32 data,u32 shift)2378ee8d1cSJulian Grajkowski adf_modulo(u32 data, u32 shift)
2478ee8d1cSJulian Grajkowski {
2578ee8d1cSJulian Grajkowski u32 div = data >> shift;
2678ee8d1cSJulian Grajkowski u32 mult = div << shift;
2778ee8d1cSJulian Grajkowski
2878ee8d1cSJulian Grajkowski return data - mult;
2978ee8d1cSJulian Grajkowski }
3078ee8d1cSJulian Grajkowski
3178ee8d1cSJulian Grajkowski static inline int
adf_check_ring_alignment(u64 addr,u64 size)3278ee8d1cSJulian Grajkowski adf_check_ring_alignment(u64 addr, u64 size)
3378ee8d1cSJulian Grajkowski {
3478ee8d1cSJulian Grajkowski if (((size - 1) & addr) != 0)
3578ee8d1cSJulian Grajkowski return EFAULT;
3678ee8d1cSJulian Grajkowski return 0;
3778ee8d1cSJulian Grajkowski }
3878ee8d1cSJulian Grajkowski
3978ee8d1cSJulian Grajkowski static int
adf_verify_ring_size(u32 msg_size,u32 msg_num)4078ee8d1cSJulian Grajkowski adf_verify_ring_size(u32 msg_size, u32 msg_num)
4178ee8d1cSJulian Grajkowski {
4278ee8d1cSJulian Grajkowski int i = ADF_MIN_RING_SIZE;
4378ee8d1cSJulian Grajkowski
4478ee8d1cSJulian Grajkowski for (; i <= ADF_MAX_RING_SIZE; i++)
4578ee8d1cSJulian Grajkowski if ((msg_size * msg_num) == ADF_SIZE_TO_RING_SIZE_IN_BYTES(i))
4678ee8d1cSJulian Grajkowski return i;
4778ee8d1cSJulian Grajkowski
4878ee8d1cSJulian Grajkowski return ADF_DEFAULT_RING_SIZE;
4978ee8d1cSJulian Grajkowski }
5078ee8d1cSJulian Grajkowski
5178ee8d1cSJulian Grajkowski static int
adf_reserve_ring(struct adf_etr_bank_data * bank,u32 ring)5278ee8d1cSJulian Grajkowski adf_reserve_ring(struct adf_etr_bank_data *bank, u32 ring)
5378ee8d1cSJulian Grajkowski {
5478ee8d1cSJulian Grajkowski mtx_lock(&bank->lock);
5578ee8d1cSJulian Grajkowski if (bank->ring_mask & (1 << ring)) {
5678ee8d1cSJulian Grajkowski mtx_unlock(&bank->lock);
5778ee8d1cSJulian Grajkowski return EFAULT;
5878ee8d1cSJulian Grajkowski }
5978ee8d1cSJulian Grajkowski bank->ring_mask |= (1 << ring);
6078ee8d1cSJulian Grajkowski mtx_unlock(&bank->lock);
6178ee8d1cSJulian Grajkowski return 0;
6278ee8d1cSJulian Grajkowski }
6378ee8d1cSJulian Grajkowski
6478ee8d1cSJulian Grajkowski static void
adf_unreserve_ring(struct adf_etr_bank_data * bank,u32 ring)6578ee8d1cSJulian Grajkowski adf_unreserve_ring(struct adf_etr_bank_data *bank, u32 ring)
6678ee8d1cSJulian Grajkowski {
6778ee8d1cSJulian Grajkowski mtx_lock(&bank->lock);
6878ee8d1cSJulian Grajkowski bank->ring_mask &= ~(1 << ring);
6978ee8d1cSJulian Grajkowski mtx_unlock(&bank->lock);
7078ee8d1cSJulian Grajkowski }
7178ee8d1cSJulian Grajkowski
7278ee8d1cSJulian Grajkowski static void
adf_enable_ring_irq(struct adf_etr_bank_data * bank,u32 ring)7378ee8d1cSJulian Grajkowski adf_enable_ring_irq(struct adf_etr_bank_data *bank, u32 ring)
7478ee8d1cSJulian Grajkowski {
75a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(bank->accel_dev);
76*266b0663SKrzysztof Zdziarski u32 enable_int_col_mask = 0;
77*266b0663SKrzysztof Zdziarski
78*266b0663SKrzysztof Zdziarski if (csr_ops->get_int_col_ctl_enable_mask)
79*266b0663SKrzysztof Zdziarski enable_int_col_mask = csr_ops->get_int_col_ctl_enable_mask();
80a977168cSMichal Gulbicki
8178ee8d1cSJulian Grajkowski mtx_lock(&bank->lock);
8278ee8d1cSJulian Grajkowski bank->irq_mask |= (1 << ring);
8378ee8d1cSJulian Grajkowski mtx_unlock(&bank->lock);
84a977168cSMichal Gulbicki csr_ops->write_csr_int_col_en(bank->csr_addr,
85a977168cSMichal Gulbicki bank->bank_number,
86a977168cSMichal Gulbicki bank->irq_mask);
87a977168cSMichal Gulbicki csr_ops->write_csr_int_col_ctl(bank->csr_addr,
8878ee8d1cSJulian Grajkowski bank->bank_number,
89*266b0663SKrzysztof Zdziarski bank->irq_coalesc_timer |
90*266b0663SKrzysztof Zdziarski enable_int_col_mask);
9178ee8d1cSJulian Grajkowski }
9278ee8d1cSJulian Grajkowski
9378ee8d1cSJulian Grajkowski static void
adf_disable_ring_irq(struct adf_etr_bank_data * bank,u32 ring)9478ee8d1cSJulian Grajkowski adf_disable_ring_irq(struct adf_etr_bank_data *bank, u32 ring)
9578ee8d1cSJulian Grajkowski {
96a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(bank->accel_dev);
97a977168cSMichal Gulbicki
9878ee8d1cSJulian Grajkowski mtx_lock(&bank->lock);
9978ee8d1cSJulian Grajkowski bank->irq_mask &= ~(1 << ring);
10078ee8d1cSJulian Grajkowski mtx_unlock(&bank->lock);
101a977168cSMichal Gulbicki csr_ops->write_csr_int_col_en(bank->csr_addr,
102a977168cSMichal Gulbicki bank->bank_number,
103a977168cSMichal Gulbicki bank->irq_mask);
10478ee8d1cSJulian Grajkowski }
10578ee8d1cSJulian Grajkowski
10678ee8d1cSJulian Grajkowski int
adf_send_message(struct adf_etr_ring_data * ring,u32 * msg)10778ee8d1cSJulian Grajkowski adf_send_message(struct adf_etr_ring_data *ring, u32 *msg)
10878ee8d1cSJulian Grajkowski {
109a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(ring->bank->accel_dev);
11078ee8d1cSJulian Grajkowski u32 msg_size = 0;
11178ee8d1cSJulian Grajkowski
11278ee8d1cSJulian Grajkowski if (atomic_add_return(1, ring->inflights) > ring->max_inflights) {
11378ee8d1cSJulian Grajkowski atomic_dec(ring->inflights);
11478ee8d1cSJulian Grajkowski return EAGAIN;
11578ee8d1cSJulian Grajkowski }
11678ee8d1cSJulian Grajkowski
11778ee8d1cSJulian Grajkowski msg_size = ADF_MSG_SIZE_TO_BYTES(ring->msg_size);
11878ee8d1cSJulian Grajkowski mtx_lock(&ring->lock);
11978ee8d1cSJulian Grajkowski memcpy((void *)((uintptr_t)ring->base_addr + ring->tail),
12078ee8d1cSJulian Grajkowski msg,
12178ee8d1cSJulian Grajkowski msg_size);
12278ee8d1cSJulian Grajkowski
12378ee8d1cSJulian Grajkowski ring->tail = adf_modulo(ring->tail + msg_size,
12478ee8d1cSJulian Grajkowski ADF_RING_SIZE_MODULO(ring->ring_size));
12578ee8d1cSJulian Grajkowski
126a977168cSMichal Gulbicki csr_ops->write_csr_ring_tail(ring->bank->csr_addr,
12778ee8d1cSJulian Grajkowski ring->bank->bank_number,
12878ee8d1cSJulian Grajkowski ring->ring_number,
12978ee8d1cSJulian Grajkowski ring->tail);
13078ee8d1cSJulian Grajkowski ring->csr_tail_offset = ring->tail;
13178ee8d1cSJulian Grajkowski mtx_unlock(&ring->lock);
13278ee8d1cSJulian Grajkowski return 0;
13378ee8d1cSJulian Grajkowski }
13478ee8d1cSJulian Grajkowski
13578ee8d1cSJulian Grajkowski int
adf_handle_response(struct adf_etr_ring_data * ring,u32 quota)13678ee8d1cSJulian Grajkowski adf_handle_response(struct adf_etr_ring_data *ring, u32 quota)
13778ee8d1cSJulian Grajkowski {
138a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(ring->bank->accel_dev);
13978ee8d1cSJulian Grajkowski u32 msg_counter = 0;
14078ee8d1cSJulian Grajkowski u32 *msg = (u32 *)((uintptr_t)ring->base_addr + ring->head);
14178ee8d1cSJulian Grajkowski
14278ee8d1cSJulian Grajkowski if (!quota)
14378ee8d1cSJulian Grajkowski quota = ADF_NO_RESPONSE_QUOTA;
14478ee8d1cSJulian Grajkowski
14578ee8d1cSJulian Grajkowski while ((*msg != ADF_RING_EMPTY_SIG) && (msg_counter < quota)) {
14678ee8d1cSJulian Grajkowski ring->callback((u32 *)msg);
14778ee8d1cSJulian Grajkowski atomic_dec(ring->inflights);
14878ee8d1cSJulian Grajkowski *msg = ADF_RING_EMPTY_SIG;
149*266b0663SKrzysztof Zdziarski ring->head =
150*266b0663SKrzysztof Zdziarski adf_modulo(ring->head +
151*266b0663SKrzysztof Zdziarski ADF_MSG_SIZE_TO_BYTES(ring->msg_size),
15278ee8d1cSJulian Grajkowski ADF_RING_SIZE_MODULO(ring->ring_size));
15378ee8d1cSJulian Grajkowski msg_counter++;
15478ee8d1cSJulian Grajkowski msg = (u32 *)((uintptr_t)ring->base_addr + ring->head);
15578ee8d1cSJulian Grajkowski }
15678ee8d1cSJulian Grajkowski if (msg_counter > 0)
157a977168cSMichal Gulbicki csr_ops->write_csr_ring_head(ring->bank->csr_addr,
15878ee8d1cSJulian Grajkowski ring->bank->bank_number,
15978ee8d1cSJulian Grajkowski ring->ring_number,
16078ee8d1cSJulian Grajkowski ring->head);
16178ee8d1cSJulian Grajkowski return msg_counter;
16278ee8d1cSJulian Grajkowski }
16378ee8d1cSJulian Grajkowski
16478ee8d1cSJulian Grajkowski int
adf_poll_bank(u32 accel_id,u32 bank_num,u32 quota)16578ee8d1cSJulian Grajkowski adf_poll_bank(u32 accel_id, u32 bank_num, u32 quota)
16678ee8d1cSJulian Grajkowski {
16778ee8d1cSJulian Grajkowski int num_resp;
16878ee8d1cSJulian Grajkowski struct adf_accel_dev *accel_dev;
16978ee8d1cSJulian Grajkowski struct adf_etr_data *trans_data;
17078ee8d1cSJulian Grajkowski struct adf_etr_bank_data *bank;
17178ee8d1cSJulian Grajkowski struct adf_etr_ring_data *ring;
172a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops;
17378ee8d1cSJulian Grajkowski u32 rings_not_empty;
17478ee8d1cSJulian Grajkowski u32 ring_num;
17578ee8d1cSJulian Grajkowski u32 resp_total = 0;
17678ee8d1cSJulian Grajkowski u32 num_rings_per_bank;
17778ee8d1cSJulian Grajkowski
17878ee8d1cSJulian Grajkowski /* Find the accel device associated with the accelId
17978ee8d1cSJulian Grajkowski * passed in.
18078ee8d1cSJulian Grajkowski */
18178ee8d1cSJulian Grajkowski accel_dev = adf_devmgr_get_dev_by_id(accel_id);
18278ee8d1cSJulian Grajkowski if (!accel_dev) {
18378ee8d1cSJulian Grajkowski pr_err("There is no device with id: %d\n", accel_id);
18478ee8d1cSJulian Grajkowski return EINVAL;
18578ee8d1cSJulian Grajkowski }
18678ee8d1cSJulian Grajkowski
187a977168cSMichal Gulbicki csr_ops = GET_CSR_OPS(accel_dev);
18878ee8d1cSJulian Grajkowski trans_data = accel_dev->transport;
18978ee8d1cSJulian Grajkowski bank = &trans_data->banks[bank_num];
19078ee8d1cSJulian Grajkowski mtx_lock(&bank->lock);
19178ee8d1cSJulian Grajkowski
19278ee8d1cSJulian Grajkowski /* Read the ring status CSR to determine which rings are empty. */
193a977168cSMichal Gulbicki rings_not_empty =
194a977168cSMichal Gulbicki csr_ops->read_csr_e_stat(bank->csr_addr, bank->bank_number);
19578ee8d1cSJulian Grajkowski /* Complement to find which rings have data to be processed. */
19678ee8d1cSJulian Grajkowski rings_not_empty = (~rings_not_empty) & bank->ring_mask;
19778ee8d1cSJulian Grajkowski
19878ee8d1cSJulian Grajkowski /* Return RETRY if the bank polling rings
19978ee8d1cSJulian Grajkowski * are all empty.
20078ee8d1cSJulian Grajkowski */
20178ee8d1cSJulian Grajkowski if (!(rings_not_empty & bank->ring_mask)) {
20278ee8d1cSJulian Grajkowski mtx_unlock(&bank->lock);
20378ee8d1cSJulian Grajkowski return EAGAIN;
20478ee8d1cSJulian Grajkowski }
20578ee8d1cSJulian Grajkowski
20678ee8d1cSJulian Grajkowski /*
20778ee8d1cSJulian Grajkowski * Loop over all rings within this bank.
20878ee8d1cSJulian Grajkowski * The ring structure is global to all
20978ee8d1cSJulian Grajkowski * rings hence while we loop over all rings in the
21078ee8d1cSJulian Grajkowski * bank we use ring_number to get the global ring.
21178ee8d1cSJulian Grajkowski */
21278ee8d1cSJulian Grajkowski num_rings_per_bank = accel_dev->hw_device->num_rings_per_bank;
21378ee8d1cSJulian Grajkowski for (ring_num = 0; ring_num < num_rings_per_bank; ring_num++) {
21478ee8d1cSJulian Grajkowski ring = &bank->rings[ring_num];
21578ee8d1cSJulian Grajkowski
21678ee8d1cSJulian Grajkowski /* And with polling ring mask.
21778ee8d1cSJulian Grajkowski * If the there is no data on this ring
21878ee8d1cSJulian Grajkowski * move to the next one.
21978ee8d1cSJulian Grajkowski */
22078ee8d1cSJulian Grajkowski if (!(rings_not_empty & (1 << ring->ring_number)))
22178ee8d1cSJulian Grajkowski continue;
22278ee8d1cSJulian Grajkowski
22378ee8d1cSJulian Grajkowski /* Poll the ring. */
22478ee8d1cSJulian Grajkowski num_resp = adf_handle_response(ring, quota);
22578ee8d1cSJulian Grajkowski resp_total += num_resp;
22678ee8d1cSJulian Grajkowski }
22778ee8d1cSJulian Grajkowski
22878ee8d1cSJulian Grajkowski mtx_unlock(&bank->lock);
22978ee8d1cSJulian Grajkowski /* Return SUCCESS if there's any response message
23078ee8d1cSJulian Grajkowski * returned.
23178ee8d1cSJulian Grajkowski */
23278ee8d1cSJulian Grajkowski if (resp_total)
23378ee8d1cSJulian Grajkowski return 0;
23478ee8d1cSJulian Grajkowski return EAGAIN;
23578ee8d1cSJulian Grajkowski }
23678ee8d1cSJulian Grajkowski
23778ee8d1cSJulian Grajkowski int
adf_poll_all_banks(u32 accel_id,u32 quota)23878ee8d1cSJulian Grajkowski adf_poll_all_banks(u32 accel_id, u32 quota)
23978ee8d1cSJulian Grajkowski {
24078ee8d1cSJulian Grajkowski int status = EAGAIN;
24178ee8d1cSJulian Grajkowski struct adf_accel_dev *accel_dev;
24278ee8d1cSJulian Grajkowski struct adf_etr_data *trans_data;
24378ee8d1cSJulian Grajkowski struct adf_etr_bank_data *bank;
24478ee8d1cSJulian Grajkowski u32 bank_num;
24578ee8d1cSJulian Grajkowski u32 stat_total = 0;
24678ee8d1cSJulian Grajkowski
24778ee8d1cSJulian Grajkowski /* Find the accel device associated with the accelId
24878ee8d1cSJulian Grajkowski * passed in.
24978ee8d1cSJulian Grajkowski */
25078ee8d1cSJulian Grajkowski accel_dev = adf_devmgr_get_dev_by_id(accel_id);
25178ee8d1cSJulian Grajkowski if (!accel_dev) {
25278ee8d1cSJulian Grajkowski pr_err("There is no device with id: %d\n", accel_id);
25378ee8d1cSJulian Grajkowski return EINVAL;
25478ee8d1cSJulian Grajkowski }
25578ee8d1cSJulian Grajkowski
25678ee8d1cSJulian Grajkowski /* Loop over banks and call adf_poll_bank */
25778ee8d1cSJulian Grajkowski trans_data = accel_dev->transport;
25878ee8d1cSJulian Grajkowski for (bank_num = 0; bank_num < GET_MAX_BANKS(accel_dev); bank_num++) {
25978ee8d1cSJulian Grajkowski bank = &trans_data->banks[bank_num];
26078ee8d1cSJulian Grajkowski /* if there are no polling rings on this bank
26178ee8d1cSJulian Grajkowski * continue to the next bank number.
26278ee8d1cSJulian Grajkowski */
26378ee8d1cSJulian Grajkowski if (bank->ring_mask == 0)
26478ee8d1cSJulian Grajkowski continue;
26578ee8d1cSJulian Grajkowski status = adf_poll_bank(accel_id, bank_num, quota);
26678ee8d1cSJulian Grajkowski /* The successful status should be AGAIN or 0 */
26778ee8d1cSJulian Grajkowski if (status == 0)
26878ee8d1cSJulian Grajkowski stat_total++;
26978ee8d1cSJulian Grajkowski else if (status != EAGAIN)
27078ee8d1cSJulian Grajkowski return status;
27178ee8d1cSJulian Grajkowski }
27278ee8d1cSJulian Grajkowski
27378ee8d1cSJulian Grajkowski /* Return SUCCESS if adf_poll_bank returned SUCCESS
27478ee8d1cSJulian Grajkowski * at any stage. adf_poll_bank cannot
27578ee8d1cSJulian Grajkowski * return fail in the above case.
27678ee8d1cSJulian Grajkowski */
27778ee8d1cSJulian Grajkowski if (stat_total)
27878ee8d1cSJulian Grajkowski return 0;
27978ee8d1cSJulian Grajkowski
28078ee8d1cSJulian Grajkowski return EAGAIN;
28178ee8d1cSJulian Grajkowski }
28278ee8d1cSJulian Grajkowski
28378ee8d1cSJulian Grajkowski static void
adf_configure_tx_ring(struct adf_etr_ring_data * ring)28478ee8d1cSJulian Grajkowski adf_configure_tx_ring(struct adf_etr_ring_data *ring)
28578ee8d1cSJulian Grajkowski {
286a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(ring->bank->accel_dev);
28778ee8d1cSJulian Grajkowski u32 ring_config = BUILD_RING_CONFIG(ring->ring_size);
28878ee8d1cSJulian Grajkowski
289a977168cSMichal Gulbicki csr_ops->write_csr_ring_config(ring->bank->csr_addr,
29078ee8d1cSJulian Grajkowski ring->bank->bank_number,
29178ee8d1cSJulian Grajkowski ring->ring_number,
29278ee8d1cSJulian Grajkowski ring_config);
29378ee8d1cSJulian Grajkowski }
29478ee8d1cSJulian Grajkowski
29578ee8d1cSJulian Grajkowski static void
adf_configure_rx_ring(struct adf_etr_ring_data * ring)29678ee8d1cSJulian Grajkowski adf_configure_rx_ring(struct adf_etr_ring_data *ring)
29778ee8d1cSJulian Grajkowski {
298a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(ring->bank->accel_dev);
29978ee8d1cSJulian Grajkowski u32 ring_config = BUILD_RESP_RING_CONFIG(ring->ring_size,
30078ee8d1cSJulian Grajkowski ADF_RING_NEAR_WATERMARK_512,
30178ee8d1cSJulian Grajkowski ADF_RING_NEAR_WATERMARK_0);
30278ee8d1cSJulian Grajkowski
303a977168cSMichal Gulbicki csr_ops->write_csr_ring_config(ring->bank->csr_addr,
30478ee8d1cSJulian Grajkowski ring->bank->bank_number,
30578ee8d1cSJulian Grajkowski ring->ring_number,
30678ee8d1cSJulian Grajkowski ring_config);
30778ee8d1cSJulian Grajkowski }
30878ee8d1cSJulian Grajkowski
30978ee8d1cSJulian Grajkowski static int
adf_init_ring(struct adf_etr_ring_data * ring)31078ee8d1cSJulian Grajkowski adf_init_ring(struct adf_etr_ring_data *ring)
31178ee8d1cSJulian Grajkowski {
31278ee8d1cSJulian Grajkowski struct adf_etr_bank_data *bank = ring->bank;
31378ee8d1cSJulian Grajkowski struct adf_accel_dev *accel_dev = bank->accel_dev;
31478ee8d1cSJulian Grajkowski struct adf_hw_device_data *hw_data = accel_dev->hw_device;
315a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(accel_dev);
31678ee8d1cSJulian Grajkowski u64 ring_base;
31778ee8d1cSJulian Grajkowski u32 ring_size_bytes = ADF_SIZE_TO_RING_SIZE_IN_BYTES(ring->ring_size);
31878ee8d1cSJulian Grajkowski
31978ee8d1cSJulian Grajkowski ring_size_bytes = ADF_RING_SIZE_BYTES_MIN(ring_size_bytes);
32078ee8d1cSJulian Grajkowski int ret;
32178ee8d1cSJulian Grajkowski
32278ee8d1cSJulian Grajkowski ret = bus_dma_mem_create(&ring->dma_mem,
32378ee8d1cSJulian Grajkowski accel_dev->dma_tag,
32478ee8d1cSJulian Grajkowski ring_size_bytes,
32578ee8d1cSJulian Grajkowski BUS_SPACE_MAXADDR,
32678ee8d1cSJulian Grajkowski ring_size_bytes,
32778ee8d1cSJulian Grajkowski M_WAITOK | M_ZERO);
32878ee8d1cSJulian Grajkowski if (ret)
32978ee8d1cSJulian Grajkowski return ret;
33078ee8d1cSJulian Grajkowski ring->base_addr = ring->dma_mem.dma_vaddr;
33178ee8d1cSJulian Grajkowski ring->dma_addr = ring->dma_mem.dma_baddr;
33278ee8d1cSJulian Grajkowski
33378ee8d1cSJulian Grajkowski memset(ring->base_addr, 0x7F, ring_size_bytes);
33478ee8d1cSJulian Grajkowski /* The base_addr has to be aligned to the size of the buffer */
33578ee8d1cSJulian Grajkowski if (adf_check_ring_alignment(ring->dma_addr, ring_size_bytes)) {
33678ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev), "Ring address not aligned\n");
33778ee8d1cSJulian Grajkowski bus_dma_mem_free(&ring->dma_mem);
33878ee8d1cSJulian Grajkowski ring->base_addr = NULL;
33978ee8d1cSJulian Grajkowski return EFAULT;
34078ee8d1cSJulian Grajkowski }
34178ee8d1cSJulian Grajkowski
34278ee8d1cSJulian Grajkowski if (hw_data->tx_rings_mask & (1 << ring->ring_number))
34378ee8d1cSJulian Grajkowski adf_configure_tx_ring(ring);
34478ee8d1cSJulian Grajkowski else
34578ee8d1cSJulian Grajkowski adf_configure_rx_ring(ring);
34678ee8d1cSJulian Grajkowski
347a977168cSMichal Gulbicki ring_base =
348a977168cSMichal Gulbicki csr_ops->build_csr_ring_base_addr(ring->dma_addr, ring->ring_size);
349a977168cSMichal Gulbicki csr_ops->write_csr_ring_base(ring->bank->csr_addr,
35078ee8d1cSJulian Grajkowski ring->bank->bank_number,
35178ee8d1cSJulian Grajkowski ring->ring_number,
35278ee8d1cSJulian Grajkowski ring_base);
35378ee8d1cSJulian Grajkowski mtx_init(&ring->lock, "adf bank", NULL, MTX_DEF);
35478ee8d1cSJulian Grajkowski return 0;
35578ee8d1cSJulian Grajkowski }
35678ee8d1cSJulian Grajkowski
35778ee8d1cSJulian Grajkowski static void
adf_cleanup_ring(struct adf_etr_ring_data * ring)35878ee8d1cSJulian Grajkowski adf_cleanup_ring(struct adf_etr_ring_data *ring)
35978ee8d1cSJulian Grajkowski {
36078ee8d1cSJulian Grajkowski u32 ring_size_bytes = ADF_SIZE_TO_RING_SIZE_IN_BYTES(ring->ring_size);
36178ee8d1cSJulian Grajkowski ring_size_bytes = ADF_RING_SIZE_BYTES_MIN(ring_size_bytes);
36278ee8d1cSJulian Grajkowski
36378ee8d1cSJulian Grajkowski if (ring->base_addr) {
36478ee8d1cSJulian Grajkowski explicit_bzero(ring->base_addr, ring_size_bytes);
36578ee8d1cSJulian Grajkowski bus_dma_mem_free(&ring->dma_mem);
36678ee8d1cSJulian Grajkowski }
36778ee8d1cSJulian Grajkowski mtx_destroy(&ring->lock);
36878ee8d1cSJulian Grajkowski }
36978ee8d1cSJulian Grajkowski
37078ee8d1cSJulian Grajkowski int
adf_create_ring(struct adf_accel_dev * accel_dev,const char * section,u32 bank_num,u32 num_msgs,u32 msg_size,const char * ring_name,adf_callback_fn callback,int poll_mode,struct adf_etr_ring_data ** ring_ptr)37178ee8d1cSJulian Grajkowski adf_create_ring(struct adf_accel_dev *accel_dev,
37278ee8d1cSJulian Grajkowski const char *section,
37378ee8d1cSJulian Grajkowski u32 bank_num,
37478ee8d1cSJulian Grajkowski u32 num_msgs,
37578ee8d1cSJulian Grajkowski u32 msg_size,
37678ee8d1cSJulian Grajkowski const char *ring_name,
37778ee8d1cSJulian Grajkowski adf_callback_fn callback,
37878ee8d1cSJulian Grajkowski int poll_mode,
37978ee8d1cSJulian Grajkowski struct adf_etr_ring_data **ring_ptr)
38078ee8d1cSJulian Grajkowski {
38178ee8d1cSJulian Grajkowski struct adf_etr_data *transport_data = accel_dev->transport;
38278ee8d1cSJulian Grajkowski struct adf_etr_bank_data *bank;
38378ee8d1cSJulian Grajkowski struct adf_etr_ring_data *ring;
38478ee8d1cSJulian Grajkowski char val[ADF_CFG_MAX_VAL_LEN_IN_BYTES];
38578ee8d1cSJulian Grajkowski u32 ring_num;
38678ee8d1cSJulian Grajkowski int ret;
38778ee8d1cSJulian Grajkowski u8 num_rings_per_bank = accel_dev->hw_device->num_rings_per_bank;
38878ee8d1cSJulian Grajkowski
38978ee8d1cSJulian Grajkowski if (bank_num >= GET_MAX_BANKS(accel_dev)) {
39078ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev), "Invalid bank number\n");
39178ee8d1cSJulian Grajkowski return EFAULT;
39278ee8d1cSJulian Grajkowski }
39378ee8d1cSJulian Grajkowski if (msg_size > ADF_MSG_SIZE_TO_BYTES(ADF_MAX_MSG_SIZE)) {
39478ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev), "Invalid msg size\n");
39578ee8d1cSJulian Grajkowski return EFAULT;
39678ee8d1cSJulian Grajkowski }
39778ee8d1cSJulian Grajkowski if (ADF_MAX_INFLIGHTS(adf_verify_ring_size(msg_size, num_msgs),
39878ee8d1cSJulian Grajkowski ADF_BYTES_TO_MSG_SIZE(msg_size)) < 2) {
39978ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev),
40078ee8d1cSJulian Grajkowski "Invalid ring size for given msg size\n");
40178ee8d1cSJulian Grajkowski return EFAULT;
40278ee8d1cSJulian Grajkowski }
40378ee8d1cSJulian Grajkowski if (adf_cfg_get_param_value(accel_dev, section, ring_name, val)) {
40478ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev),
40578ee8d1cSJulian Grajkowski "Section %s, no such entry : %s\n",
40678ee8d1cSJulian Grajkowski section,
40778ee8d1cSJulian Grajkowski ring_name);
40878ee8d1cSJulian Grajkowski return EFAULT;
40978ee8d1cSJulian Grajkowski }
41078ee8d1cSJulian Grajkowski if (compat_strtouint(val, 10, &ring_num)) {
41178ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev), "Can't get ring number\n");
41278ee8d1cSJulian Grajkowski return EFAULT;
41378ee8d1cSJulian Grajkowski }
41478ee8d1cSJulian Grajkowski if (ring_num >= num_rings_per_bank) {
41578ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev), "Invalid ring number\n");
41678ee8d1cSJulian Grajkowski return EFAULT;
41778ee8d1cSJulian Grajkowski }
41878ee8d1cSJulian Grajkowski
41978ee8d1cSJulian Grajkowski bank = &transport_data->banks[bank_num];
42078ee8d1cSJulian Grajkowski if (adf_reserve_ring(bank, ring_num)) {
42178ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev),
42278ee8d1cSJulian Grajkowski "Ring %d, %s already exists.\n",
42378ee8d1cSJulian Grajkowski ring_num,
42478ee8d1cSJulian Grajkowski ring_name);
42578ee8d1cSJulian Grajkowski return EFAULT;
42678ee8d1cSJulian Grajkowski }
42778ee8d1cSJulian Grajkowski ring = &bank->rings[ring_num];
42878ee8d1cSJulian Grajkowski ring->ring_number = ring_num;
42978ee8d1cSJulian Grajkowski ring->bank = bank;
43078ee8d1cSJulian Grajkowski ring->callback = callback;
43178ee8d1cSJulian Grajkowski ring->msg_size = ADF_BYTES_TO_MSG_SIZE(msg_size);
43278ee8d1cSJulian Grajkowski ring->ring_size = adf_verify_ring_size(msg_size, num_msgs);
43378ee8d1cSJulian Grajkowski ring->max_inflights =
43478ee8d1cSJulian Grajkowski ADF_MAX_INFLIGHTS(ring->ring_size, ring->msg_size);
43578ee8d1cSJulian Grajkowski ring->head = 0;
43678ee8d1cSJulian Grajkowski ring->tail = 0;
43778ee8d1cSJulian Grajkowski ring->csr_tail_offset = 0;
43878ee8d1cSJulian Grajkowski ret = adf_init_ring(ring);
43978ee8d1cSJulian Grajkowski if (ret)
44078ee8d1cSJulian Grajkowski goto err;
44178ee8d1cSJulian Grajkowski
44278ee8d1cSJulian Grajkowski /* Enable HW arbitration for the given ring */
44378ee8d1cSJulian Grajkowski adf_update_ring_arb(ring);
44478ee8d1cSJulian Grajkowski
44578ee8d1cSJulian Grajkowski if (adf_ring_debugfs_add(ring, ring_name)) {
44678ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev),
44778ee8d1cSJulian Grajkowski "Couldn't add ring debugfs entry\n");
44878ee8d1cSJulian Grajkowski ret = EFAULT;
44978ee8d1cSJulian Grajkowski goto err;
45078ee8d1cSJulian Grajkowski }
45178ee8d1cSJulian Grajkowski
45278ee8d1cSJulian Grajkowski /* Enable interrupts if needed */
45378ee8d1cSJulian Grajkowski if (callback && !poll_mode)
45478ee8d1cSJulian Grajkowski adf_enable_ring_irq(bank, ring->ring_number);
45578ee8d1cSJulian Grajkowski *ring_ptr = ring;
45678ee8d1cSJulian Grajkowski return 0;
45778ee8d1cSJulian Grajkowski err:
45878ee8d1cSJulian Grajkowski adf_cleanup_ring(ring);
45978ee8d1cSJulian Grajkowski adf_unreserve_ring(bank, ring_num);
46078ee8d1cSJulian Grajkowski adf_update_ring_arb(ring);
46178ee8d1cSJulian Grajkowski return ret;
46278ee8d1cSJulian Grajkowski }
46378ee8d1cSJulian Grajkowski
46478ee8d1cSJulian Grajkowski void
adf_remove_ring(struct adf_etr_ring_data * ring)46578ee8d1cSJulian Grajkowski adf_remove_ring(struct adf_etr_ring_data *ring)
46678ee8d1cSJulian Grajkowski {
46778ee8d1cSJulian Grajkowski struct adf_etr_bank_data *bank = ring->bank;
468a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(bank->accel_dev);
46978ee8d1cSJulian Grajkowski
47078ee8d1cSJulian Grajkowski /* Disable interrupts for the given ring */
47178ee8d1cSJulian Grajkowski adf_disable_ring_irq(bank, ring->ring_number);
47278ee8d1cSJulian Grajkowski
47378ee8d1cSJulian Grajkowski /* Clear PCI config space */
474a977168cSMichal Gulbicki csr_ops->write_csr_ring_config(bank->csr_addr,
47578ee8d1cSJulian Grajkowski bank->bank_number,
47678ee8d1cSJulian Grajkowski ring->ring_number,
47778ee8d1cSJulian Grajkowski 0);
478a977168cSMichal Gulbicki csr_ops->write_csr_ring_base(bank->csr_addr,
47978ee8d1cSJulian Grajkowski bank->bank_number,
48078ee8d1cSJulian Grajkowski ring->ring_number,
48178ee8d1cSJulian Grajkowski 0);
48278ee8d1cSJulian Grajkowski adf_ring_debugfs_rm(ring);
48378ee8d1cSJulian Grajkowski adf_unreserve_ring(bank, ring->ring_number);
48478ee8d1cSJulian Grajkowski /* Disable HW arbitration for the given ring */
48578ee8d1cSJulian Grajkowski adf_update_ring_arb(ring);
48678ee8d1cSJulian Grajkowski adf_cleanup_ring(ring);
48778ee8d1cSJulian Grajkowski }
48878ee8d1cSJulian Grajkowski
48978ee8d1cSJulian Grajkowski static void
adf_ring_response_handler(struct adf_etr_bank_data * bank)49078ee8d1cSJulian Grajkowski adf_ring_response_handler(struct adf_etr_bank_data *bank)
49178ee8d1cSJulian Grajkowski {
49278ee8d1cSJulian Grajkowski struct adf_accel_dev *accel_dev = bank->accel_dev;
49378ee8d1cSJulian Grajkowski struct adf_hw_device_data *hw_data = accel_dev->hw_device;
494a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(accel_dev);
49578ee8d1cSJulian Grajkowski u8 num_rings_per_bank = hw_data->num_rings_per_bank;
49678ee8d1cSJulian Grajkowski u32 empty_rings, i;
49778ee8d1cSJulian Grajkowski
498a977168cSMichal Gulbicki empty_rings =
499a977168cSMichal Gulbicki csr_ops->read_csr_e_stat(bank->csr_addr, bank->bank_number);
50078ee8d1cSJulian Grajkowski empty_rings = ~empty_rings & bank->irq_mask;
50178ee8d1cSJulian Grajkowski
50278ee8d1cSJulian Grajkowski for (i = 0; i < num_rings_per_bank; ++i) {
50378ee8d1cSJulian Grajkowski if (empty_rings & (1 << i))
50478ee8d1cSJulian Grajkowski adf_handle_response(&bank->rings[i], 0);
50578ee8d1cSJulian Grajkowski }
50678ee8d1cSJulian Grajkowski }
50778ee8d1cSJulian Grajkowski
50878ee8d1cSJulian Grajkowski void
adf_response_handler(uintptr_t bank_addr)50978ee8d1cSJulian Grajkowski adf_response_handler(uintptr_t bank_addr)
51078ee8d1cSJulian Grajkowski {
51178ee8d1cSJulian Grajkowski struct adf_etr_bank_data *bank = (void *)bank_addr;
512a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(bank->accel_dev);
51378ee8d1cSJulian Grajkowski
51478ee8d1cSJulian Grajkowski /* Handle all the responses and re-enable IRQs */
51578ee8d1cSJulian Grajkowski adf_ring_response_handler(bank);
516a977168cSMichal Gulbicki csr_ops->write_csr_int_flag_and_col(bank->csr_addr,
51778ee8d1cSJulian Grajkowski bank->bank_number,
51878ee8d1cSJulian Grajkowski bank->irq_mask);
51978ee8d1cSJulian Grajkowski }
52078ee8d1cSJulian Grajkowski
52178ee8d1cSJulian Grajkowski static inline int
adf_get_cfg_int(struct adf_accel_dev * accel_dev,const char * section,const char * format,u32 key,u32 * value)52278ee8d1cSJulian Grajkowski adf_get_cfg_int(struct adf_accel_dev *accel_dev,
52378ee8d1cSJulian Grajkowski const char *section,
52478ee8d1cSJulian Grajkowski const char *format,
52578ee8d1cSJulian Grajkowski u32 key,
52678ee8d1cSJulian Grajkowski u32 *value)
52778ee8d1cSJulian Grajkowski {
52878ee8d1cSJulian Grajkowski char key_buf[ADF_CFG_MAX_KEY_LEN_IN_BYTES];
52978ee8d1cSJulian Grajkowski char val_buf[ADF_CFG_MAX_VAL_LEN_IN_BYTES];
53078ee8d1cSJulian Grajkowski
53178ee8d1cSJulian Grajkowski snprintf(key_buf, ADF_CFG_MAX_KEY_LEN_IN_BYTES, format, key);
53278ee8d1cSJulian Grajkowski
53378ee8d1cSJulian Grajkowski if (adf_cfg_get_param_value(accel_dev, section, key_buf, val_buf))
53478ee8d1cSJulian Grajkowski return EFAULT;
53578ee8d1cSJulian Grajkowski
53678ee8d1cSJulian Grajkowski if (compat_strtouint(val_buf, 10, value))
53778ee8d1cSJulian Grajkowski return EFAULT;
53878ee8d1cSJulian Grajkowski return 0;
53978ee8d1cSJulian Grajkowski }
54078ee8d1cSJulian Grajkowski
54178ee8d1cSJulian Grajkowski static void
adf_get_coalesc_timer(struct adf_etr_bank_data * bank,const char * section,u32 bank_num_in_accel)54278ee8d1cSJulian Grajkowski adf_get_coalesc_timer(struct adf_etr_bank_data *bank,
54378ee8d1cSJulian Grajkowski const char *section,
54478ee8d1cSJulian Grajkowski u32 bank_num_in_accel)
54578ee8d1cSJulian Grajkowski {
54678ee8d1cSJulian Grajkowski struct adf_accel_dev *accel_dev = bank->accel_dev;
54778ee8d1cSJulian Grajkowski struct adf_hw_device_data *hw_data = accel_dev->hw_device;
54878ee8d1cSJulian Grajkowski u32 coalesc_timer = ADF_COALESCING_DEF_TIME;
54978ee8d1cSJulian Grajkowski
55078ee8d1cSJulian Grajkowski adf_get_cfg_int(accel_dev,
55178ee8d1cSJulian Grajkowski section,
55278ee8d1cSJulian Grajkowski ADF_ETRMGR_COALESCE_TIMER_FORMAT,
55378ee8d1cSJulian Grajkowski bank_num_in_accel,
55478ee8d1cSJulian Grajkowski &coalesc_timer);
55578ee8d1cSJulian Grajkowski
55678ee8d1cSJulian Grajkowski if (hw_data->get_clock_speed)
55778ee8d1cSJulian Grajkowski bank->irq_coalesc_timer =
55878ee8d1cSJulian Grajkowski (coalesc_timer *
55978ee8d1cSJulian Grajkowski (hw_data->get_clock_speed(hw_data) / USEC_PER_SEC)) /
56078ee8d1cSJulian Grajkowski NSEC_PER_USEC;
56178ee8d1cSJulian Grajkowski else
56278ee8d1cSJulian Grajkowski bank->irq_coalesc_timer = coalesc_timer;
56378ee8d1cSJulian Grajkowski
56478ee8d1cSJulian Grajkowski if (bank->irq_coalesc_timer > ADF_COALESCING_MAX_TIME)
56578ee8d1cSJulian Grajkowski bank->irq_coalesc_timer = ADF_COALESCING_MAX_TIME;
56678ee8d1cSJulian Grajkowski else if (bank->irq_coalesc_timer < ADF_COALESCING_MIN_TIME)
56778ee8d1cSJulian Grajkowski bank->irq_coalesc_timer = ADF_COALESCING_MIN_TIME;
56878ee8d1cSJulian Grajkowski }
56978ee8d1cSJulian Grajkowski
57078ee8d1cSJulian Grajkowski static int
adf_init_bank(struct adf_accel_dev * accel_dev,struct adf_etr_bank_data * bank,u32 bank_num,struct resource * csr_addr)57178ee8d1cSJulian Grajkowski adf_init_bank(struct adf_accel_dev *accel_dev,
57278ee8d1cSJulian Grajkowski struct adf_etr_bank_data *bank,
57378ee8d1cSJulian Grajkowski u32 bank_num,
57478ee8d1cSJulian Grajkowski struct resource *csr_addr)
57578ee8d1cSJulian Grajkowski {
57678ee8d1cSJulian Grajkowski struct adf_hw_device_data *hw_data = accel_dev->hw_device;
577a977168cSMichal Gulbicki struct adf_hw_csr_ops *csr_ops = &hw_data->csr_info.csr_ops;
57878ee8d1cSJulian Grajkowski struct adf_etr_ring_data *ring;
57978ee8d1cSJulian Grajkowski struct adf_etr_ring_data *tx_ring;
58078ee8d1cSJulian Grajkowski u32 i, coalesc_enabled = 0;
58178ee8d1cSJulian Grajkowski u8 num_rings_per_bank = hw_data->num_rings_per_bank;
582a977168cSMichal Gulbicki u32 irq_mask = BIT(num_rings_per_bank) - 1;
58378ee8d1cSJulian Grajkowski u32 size = 0;
58478ee8d1cSJulian Grajkowski
58578ee8d1cSJulian Grajkowski explicit_bzero(bank, sizeof(*bank));
58678ee8d1cSJulian Grajkowski bank->bank_number = bank_num;
58778ee8d1cSJulian Grajkowski bank->csr_addr = csr_addr;
58878ee8d1cSJulian Grajkowski bank->accel_dev = accel_dev;
58978ee8d1cSJulian Grajkowski mtx_init(&bank->lock, "adf bank", NULL, MTX_DEF);
59078ee8d1cSJulian Grajkowski
59178ee8d1cSJulian Grajkowski /* Allocate the rings in the bank */
59278ee8d1cSJulian Grajkowski size = num_rings_per_bank * sizeof(struct adf_etr_ring_data);
59378ee8d1cSJulian Grajkowski bank->rings = kzalloc_node(size,
59478ee8d1cSJulian Grajkowski M_WAITOK | M_ZERO,
59578ee8d1cSJulian Grajkowski dev_to_node(GET_DEV(accel_dev)));
59678ee8d1cSJulian Grajkowski
59778ee8d1cSJulian Grajkowski /* Enable IRQ coalescing always. This will allow to use
59878ee8d1cSJulian Grajkowski * the optimised flag and coalesc register.
59978ee8d1cSJulian Grajkowski * If it is disabled in the config file just use min time value */
60078ee8d1cSJulian Grajkowski if ((adf_get_cfg_int(accel_dev,
60178ee8d1cSJulian Grajkowski "Accelerator0",
60278ee8d1cSJulian Grajkowski ADF_ETRMGR_COALESCING_ENABLED_FORMAT,
60378ee8d1cSJulian Grajkowski bank_num,
60478ee8d1cSJulian Grajkowski &coalesc_enabled) == 0) &&
60578ee8d1cSJulian Grajkowski coalesc_enabled)
60678ee8d1cSJulian Grajkowski adf_get_coalesc_timer(bank, "Accelerator0", bank_num);
60778ee8d1cSJulian Grajkowski else
60878ee8d1cSJulian Grajkowski bank->irq_coalesc_timer = ADF_COALESCING_MIN_TIME;
60978ee8d1cSJulian Grajkowski
61078ee8d1cSJulian Grajkowski for (i = 0; i < num_rings_per_bank; i++) {
611a977168cSMichal Gulbicki csr_ops->write_csr_ring_config(csr_addr, bank_num, i, 0);
612a977168cSMichal Gulbicki csr_ops->write_csr_ring_base(csr_addr, bank_num, i, 0);
61378ee8d1cSJulian Grajkowski ring = &bank->rings[i];
61478ee8d1cSJulian Grajkowski if (hw_data->tx_rings_mask & (1 << i)) {
61578ee8d1cSJulian Grajkowski ring->inflights =
61678ee8d1cSJulian Grajkowski kzalloc_node(sizeof(atomic_t),
61778ee8d1cSJulian Grajkowski M_WAITOK | M_ZERO,
61878ee8d1cSJulian Grajkowski dev_to_node(GET_DEV(accel_dev)));
61978ee8d1cSJulian Grajkowski } else {
62078ee8d1cSJulian Grajkowski if (i < hw_data->tx_rx_gap) {
62178ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev),
62278ee8d1cSJulian Grajkowski "Invalid tx rings mask config\n");
62378ee8d1cSJulian Grajkowski goto err;
62478ee8d1cSJulian Grajkowski }
62578ee8d1cSJulian Grajkowski tx_ring = &bank->rings[i - hw_data->tx_rx_gap];
62678ee8d1cSJulian Grajkowski ring->inflights = tx_ring->inflights;
62778ee8d1cSJulian Grajkowski }
62878ee8d1cSJulian Grajkowski }
62978ee8d1cSJulian Grajkowski
63078ee8d1cSJulian Grajkowski if (adf_bank_debugfs_add(bank)) {
63178ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev),
63278ee8d1cSJulian Grajkowski "Failed to add bank debugfs entry\n");
63378ee8d1cSJulian Grajkowski goto err;
63478ee8d1cSJulian Grajkowski }
63578ee8d1cSJulian Grajkowski
636a977168cSMichal Gulbicki csr_ops->write_csr_int_flag(csr_addr, bank_num, irq_mask);
637a977168cSMichal Gulbicki csr_ops->write_csr_int_srcsel(csr_addr, bank_num);
63878ee8d1cSJulian Grajkowski return 0;
63978ee8d1cSJulian Grajkowski err:
64078ee8d1cSJulian Grajkowski for (i = 0; i < num_rings_per_bank; i++) {
64178ee8d1cSJulian Grajkowski ring = &bank->rings[i];
64278ee8d1cSJulian Grajkowski if (hw_data->tx_rings_mask & (1 << i)) {
64378ee8d1cSJulian Grajkowski kfree(ring->inflights);
64478ee8d1cSJulian Grajkowski ring->inflights = NULL;
64578ee8d1cSJulian Grajkowski }
64678ee8d1cSJulian Grajkowski }
64778ee8d1cSJulian Grajkowski kfree(bank->rings);
64878ee8d1cSJulian Grajkowski return ENOMEM;
64978ee8d1cSJulian Grajkowski }
65078ee8d1cSJulian Grajkowski
65178ee8d1cSJulian Grajkowski /**
65278ee8d1cSJulian Grajkowski * adf_init_etr_data() - Initialize transport rings for acceleration device
65378ee8d1cSJulian Grajkowski * @accel_dev: Pointer to acceleration device.
65478ee8d1cSJulian Grajkowski *
65578ee8d1cSJulian Grajkowski * Function initializes the communications channels (rings) to the
65678ee8d1cSJulian Grajkowski * acceleration device accel_dev.
65778ee8d1cSJulian Grajkowski * To be used by QAT device specific drivers.
65878ee8d1cSJulian Grajkowski *
65978ee8d1cSJulian Grajkowski * Return: 0 on success, error code otherwise.
66078ee8d1cSJulian Grajkowski */
66178ee8d1cSJulian Grajkowski int
adf_init_etr_data(struct adf_accel_dev * accel_dev)66278ee8d1cSJulian Grajkowski adf_init_etr_data(struct adf_accel_dev *accel_dev)
66378ee8d1cSJulian Grajkowski {
66478ee8d1cSJulian Grajkowski struct adf_etr_data *etr_data;
66578ee8d1cSJulian Grajkowski struct adf_hw_device_data *hw_data = accel_dev->hw_device;
66678ee8d1cSJulian Grajkowski struct resource *csr_addr;
66778ee8d1cSJulian Grajkowski u32 size;
66878ee8d1cSJulian Grajkowski u32 num_banks = 0;
66978ee8d1cSJulian Grajkowski int i, ret;
67078ee8d1cSJulian Grajkowski
67178ee8d1cSJulian Grajkowski etr_data = kzalloc_node(sizeof(*etr_data),
67278ee8d1cSJulian Grajkowski M_WAITOK | M_ZERO,
67378ee8d1cSJulian Grajkowski dev_to_node(GET_DEV(accel_dev)));
67478ee8d1cSJulian Grajkowski
67578ee8d1cSJulian Grajkowski num_banks = GET_MAX_BANKS(accel_dev);
67678ee8d1cSJulian Grajkowski size = num_banks * sizeof(struct adf_etr_bank_data);
67778ee8d1cSJulian Grajkowski etr_data->banks = kzalloc_node(size,
67878ee8d1cSJulian Grajkowski M_WAITOK | M_ZERO,
67978ee8d1cSJulian Grajkowski dev_to_node(GET_DEV(accel_dev)));
68078ee8d1cSJulian Grajkowski
68178ee8d1cSJulian Grajkowski accel_dev->transport = etr_data;
68278ee8d1cSJulian Grajkowski i = hw_data->get_etr_bar_id(hw_data);
68378ee8d1cSJulian Grajkowski csr_addr = accel_dev->accel_pci_dev.pci_bars[i].virt_addr;
68478ee8d1cSJulian Grajkowski
68578ee8d1cSJulian Grajkowski etr_data->debug =
68678ee8d1cSJulian Grajkowski SYSCTL_ADD_NODE(&accel_dev->sysctl_ctx,
68778ee8d1cSJulian Grajkowski SYSCTL_CHILDREN(
68878ee8d1cSJulian Grajkowski device_get_sysctl_tree(GET_DEV(accel_dev))),
68978ee8d1cSJulian Grajkowski OID_AUTO,
69078ee8d1cSJulian Grajkowski "transport",
69178ee8d1cSJulian Grajkowski CTLFLAG_RD,
69278ee8d1cSJulian Grajkowski NULL,
69378ee8d1cSJulian Grajkowski "Transport parameters");
69478ee8d1cSJulian Grajkowski if (!etr_data->debug) {
69578ee8d1cSJulian Grajkowski device_printf(GET_DEV(accel_dev),
69678ee8d1cSJulian Grajkowski "Unable to create transport debugfs entry\n");
69778ee8d1cSJulian Grajkowski ret = ENOENT;
69878ee8d1cSJulian Grajkowski goto err_bank_all;
69978ee8d1cSJulian Grajkowski }
70078ee8d1cSJulian Grajkowski
70178ee8d1cSJulian Grajkowski for (i = 0; i < num_banks; i++) {
70278ee8d1cSJulian Grajkowski ret =
70378ee8d1cSJulian Grajkowski adf_init_bank(accel_dev, &etr_data->banks[i], i, csr_addr);
70478ee8d1cSJulian Grajkowski if (ret)
70578ee8d1cSJulian Grajkowski goto err_bank_all;
70678ee8d1cSJulian Grajkowski }
70778ee8d1cSJulian Grajkowski
70878ee8d1cSJulian Grajkowski return 0;
70978ee8d1cSJulian Grajkowski
71078ee8d1cSJulian Grajkowski err_bank_all:
71178ee8d1cSJulian Grajkowski kfree(etr_data->banks);
71278ee8d1cSJulian Grajkowski kfree(etr_data);
71378ee8d1cSJulian Grajkowski accel_dev->transport = NULL;
71478ee8d1cSJulian Grajkowski return ret;
71578ee8d1cSJulian Grajkowski }
71678ee8d1cSJulian Grajkowski
71778ee8d1cSJulian Grajkowski static void
cleanup_bank(struct adf_etr_bank_data * bank)71878ee8d1cSJulian Grajkowski cleanup_bank(struct adf_etr_bank_data *bank)
71978ee8d1cSJulian Grajkowski {
72078ee8d1cSJulian Grajkowski u32 i;
72178ee8d1cSJulian Grajkowski struct adf_accel_dev *accel_dev = bank->accel_dev;
72278ee8d1cSJulian Grajkowski struct adf_hw_device_data *hw_data = accel_dev->hw_device;
72378ee8d1cSJulian Grajkowski u8 num_rings_per_bank = hw_data->num_rings_per_bank;
72478ee8d1cSJulian Grajkowski
72578ee8d1cSJulian Grajkowski for (i = 0; i < num_rings_per_bank; i++) {
72678ee8d1cSJulian Grajkowski struct adf_accel_dev *accel_dev = bank->accel_dev;
72778ee8d1cSJulian Grajkowski struct adf_hw_device_data *hw_data = accel_dev->hw_device;
72878ee8d1cSJulian Grajkowski struct adf_etr_ring_data *ring = &bank->rings[i];
72978ee8d1cSJulian Grajkowski
73078ee8d1cSJulian Grajkowski if (bank->ring_mask & (1 << i))
73178ee8d1cSJulian Grajkowski adf_cleanup_ring(ring);
73278ee8d1cSJulian Grajkowski
73378ee8d1cSJulian Grajkowski if (hw_data->tx_rings_mask & (1 << i)) {
73478ee8d1cSJulian Grajkowski kfree(ring->inflights);
73578ee8d1cSJulian Grajkowski ring->inflights = NULL;
73678ee8d1cSJulian Grajkowski }
73778ee8d1cSJulian Grajkowski }
73878ee8d1cSJulian Grajkowski kfree(bank->rings);
73978ee8d1cSJulian Grajkowski adf_bank_debugfs_rm(bank);
74078ee8d1cSJulian Grajkowski mtx_destroy(&bank->lock);
74178ee8d1cSJulian Grajkowski explicit_bzero(bank, sizeof(*bank));
74278ee8d1cSJulian Grajkowski }
74378ee8d1cSJulian Grajkowski
74478ee8d1cSJulian Grajkowski static void
adf_cleanup_etr_handles(struct adf_accel_dev * accel_dev)74578ee8d1cSJulian Grajkowski adf_cleanup_etr_handles(struct adf_accel_dev *accel_dev)
74678ee8d1cSJulian Grajkowski {
74778ee8d1cSJulian Grajkowski struct adf_etr_data *etr_data = accel_dev->transport;
74878ee8d1cSJulian Grajkowski u32 i, num_banks = GET_MAX_BANKS(accel_dev);
74978ee8d1cSJulian Grajkowski
75078ee8d1cSJulian Grajkowski for (i = 0; i < num_banks; i++)
75178ee8d1cSJulian Grajkowski cleanup_bank(&etr_data->banks[i]);
75278ee8d1cSJulian Grajkowski }
75378ee8d1cSJulian Grajkowski
75478ee8d1cSJulian Grajkowski /**
75578ee8d1cSJulian Grajkowski * adf_cleanup_etr_data() - Clear transport rings for acceleration device
75678ee8d1cSJulian Grajkowski * @accel_dev: Pointer to acceleration device.
75778ee8d1cSJulian Grajkowski *
75878ee8d1cSJulian Grajkowski * Function is the clears the communications channels (rings) of the
75978ee8d1cSJulian Grajkowski * acceleration device accel_dev.
76078ee8d1cSJulian Grajkowski * To be used by QAT device specific drivers.
76178ee8d1cSJulian Grajkowski *
76278ee8d1cSJulian Grajkowski * Return: void
76378ee8d1cSJulian Grajkowski */
76478ee8d1cSJulian Grajkowski void
adf_cleanup_etr_data(struct adf_accel_dev * accel_dev)76578ee8d1cSJulian Grajkowski adf_cleanup_etr_data(struct adf_accel_dev *accel_dev)
76678ee8d1cSJulian Grajkowski {
76778ee8d1cSJulian Grajkowski struct adf_etr_data *etr_data = accel_dev->transport;
76878ee8d1cSJulian Grajkowski
76978ee8d1cSJulian Grajkowski if (etr_data) {
77078ee8d1cSJulian Grajkowski adf_cleanup_etr_handles(accel_dev);
77178ee8d1cSJulian Grajkowski kfree(etr_data->banks);
77278ee8d1cSJulian Grajkowski kfree(etr_data);
77378ee8d1cSJulian Grajkowski accel_dev->transport = NULL;
77478ee8d1cSJulian Grajkowski }
77578ee8d1cSJulian Grajkowski }
776