mirror of
https://github.com/physwizz/a155-U-u1.git
synced 2024-11-19 13:27:49 +00:00
613 lines
17 KiB
C
613 lines
17 KiB
C
// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
|
|
/*
|
|
* Copyright 2015-2020 Amazon.com, Inc. or its affiliates. All rights reserved.
|
|
*/
|
|
|
|
#include "ena_eth_com.h"
|
|
|
|
static struct ena_eth_io_rx_cdesc_base *ena_com_get_next_rx_cdesc(
|
|
struct ena_com_io_cq *io_cq)
|
|
{
|
|
struct ena_eth_io_rx_cdesc_base *cdesc;
|
|
u16 expected_phase, head_masked;
|
|
u16 desc_phase;
|
|
|
|
head_masked = io_cq->head & (io_cq->q_depth - 1);
|
|
expected_phase = io_cq->phase;
|
|
|
|
cdesc = (struct ena_eth_io_rx_cdesc_base *)(io_cq->cdesc_addr.virt_addr
|
|
+ (head_masked * io_cq->cdesc_entry_size_in_bytes));
|
|
|
|
desc_phase = (READ_ONCE(cdesc->status) &
|
|
ENA_ETH_IO_RX_CDESC_BASE_PHASE_MASK) >>
|
|
ENA_ETH_IO_RX_CDESC_BASE_PHASE_SHIFT;
|
|
|
|
if (desc_phase != expected_phase)
|
|
return NULL;
|
|
|
|
/* Make sure we read the rest of the descriptor after the phase bit
|
|
* has been read
|
|
*/
|
|
dma_rmb();
|
|
|
|
return cdesc;
|
|
}
|
|
|
|
static void *get_sq_desc_regular_queue(struct ena_com_io_sq *io_sq)
|
|
{
|
|
u16 tail_masked;
|
|
u32 offset;
|
|
|
|
tail_masked = io_sq->tail & (io_sq->q_depth - 1);
|
|
|
|
offset = tail_masked * io_sq->desc_entry_size;
|
|
|
|
return (void *)((uintptr_t)io_sq->desc_addr.virt_addr + offset);
|
|
}
|
|
|
|
static int ena_com_write_bounce_buffer_to_dev(struct ena_com_io_sq *io_sq,
|
|
u8 *bounce_buffer)
|
|
{
|
|
struct ena_com_llq_info *llq_info = &io_sq->llq_info;
|
|
|
|
u16 dst_tail_mask;
|
|
u32 dst_offset;
|
|
|
|
dst_tail_mask = io_sq->tail & (io_sq->q_depth - 1);
|
|
dst_offset = dst_tail_mask * llq_info->desc_list_entry_size;
|
|
|
|
if (is_llq_max_tx_burst_exists(io_sq)) {
|
|
if (unlikely(!io_sq->entries_in_tx_burst_left)) {
|
|
pr_err("Error: trying to send more packets than tx burst allows\n");
|
|
return -ENOSPC;
|
|
}
|
|
|
|
io_sq->entries_in_tx_burst_left--;
|
|
pr_debug("Decreasing entries_in_tx_burst_left of queue %d to %d\n",
|
|
io_sq->qid, io_sq->entries_in_tx_burst_left);
|
|
}
|
|
|
|
/* Make sure everything was written into the bounce buffer before
|
|
* writing the bounce buffer to the device
|
|
*/
|
|
wmb();
|
|
|
|
/* The line is completed. Copy it to dev */
|
|
__iowrite64_copy(io_sq->desc_addr.pbuf_dev_addr + dst_offset,
|
|
bounce_buffer, (llq_info->desc_list_entry_size) / 8);
|
|
|
|
io_sq->tail++;
|
|
|
|
/* Switch phase bit in case of wrap around */
|
|
if (unlikely((io_sq->tail & (io_sq->q_depth - 1)) == 0))
|
|
io_sq->phase ^= 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ena_com_write_header_to_bounce(struct ena_com_io_sq *io_sq,
|
|
u8 *header_src,
|
|
u16 header_len)
|
|
{
|
|
struct ena_com_llq_pkt_ctrl *pkt_ctrl = &io_sq->llq_buf_ctrl;
|
|
struct ena_com_llq_info *llq_info = &io_sq->llq_info;
|
|
u8 *bounce_buffer = pkt_ctrl->curr_bounce_buf;
|
|
u16 header_offset;
|
|
|
|
if (unlikely(io_sq->mem_queue_type == ENA_ADMIN_PLACEMENT_POLICY_HOST))
|
|
return 0;
|
|
|
|
header_offset =
|
|
llq_info->descs_num_before_header * io_sq->desc_entry_size;
|
|
|
|
if (unlikely((header_offset + header_len) >
|
|
llq_info->desc_list_entry_size)) {
|
|
pr_err("Trying to write header larger than llq entry can accommodate\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
if (unlikely(!bounce_buffer)) {
|
|
pr_err("Bounce buffer is NULL\n");
|
|
return -EFAULT;
|
|
}
|
|
|
|
memcpy(bounce_buffer + header_offset, header_src, header_len);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void *get_sq_desc_llq(struct ena_com_io_sq *io_sq)
|
|
{
|
|
struct ena_com_llq_pkt_ctrl *pkt_ctrl = &io_sq->llq_buf_ctrl;
|
|
u8 *bounce_buffer;
|
|
void *sq_desc;
|
|
|
|
bounce_buffer = pkt_ctrl->curr_bounce_buf;
|
|
|
|
if (unlikely(!bounce_buffer)) {
|
|
pr_err("Bounce buffer is NULL\n");
|
|
return NULL;
|
|
}
|
|
|
|
sq_desc = bounce_buffer + pkt_ctrl->idx * io_sq->desc_entry_size;
|
|
pkt_ctrl->idx++;
|
|
pkt_ctrl->descs_left_in_line--;
|
|
|
|
return sq_desc;
|
|
}
|
|
|
|
static int ena_com_close_bounce_buffer(struct ena_com_io_sq *io_sq)
|
|
{
|
|
struct ena_com_llq_pkt_ctrl *pkt_ctrl = &io_sq->llq_buf_ctrl;
|
|
struct ena_com_llq_info *llq_info = &io_sq->llq_info;
|
|
int rc;
|
|
|
|
if (unlikely(io_sq->mem_queue_type == ENA_ADMIN_PLACEMENT_POLICY_HOST))
|
|
return 0;
|
|
|
|
/* bounce buffer was used, so write it and get a new one */
|
|
if (pkt_ctrl->idx) {
|
|
rc = ena_com_write_bounce_buffer_to_dev(io_sq,
|
|
pkt_ctrl->curr_bounce_buf);
|
|
if (unlikely(rc))
|
|
return rc;
|
|
|
|
pkt_ctrl->curr_bounce_buf =
|
|
ena_com_get_next_bounce_buffer(&io_sq->bounce_buf_ctrl);
|
|
memset(io_sq->llq_buf_ctrl.curr_bounce_buf,
|
|
0x0, llq_info->desc_list_entry_size);
|
|
}
|
|
|
|
pkt_ctrl->idx = 0;
|
|
pkt_ctrl->descs_left_in_line = llq_info->descs_num_before_header;
|
|
return 0;
|
|
}
|
|
|
|
static void *get_sq_desc(struct ena_com_io_sq *io_sq)
|
|
{
|
|
if (io_sq->mem_queue_type == ENA_ADMIN_PLACEMENT_POLICY_DEV)
|
|
return get_sq_desc_llq(io_sq);
|
|
|
|
return get_sq_desc_regular_queue(io_sq);
|
|
}
|
|
|
|
static int ena_com_sq_update_llq_tail(struct ena_com_io_sq *io_sq)
|
|
{
|
|
struct ena_com_llq_pkt_ctrl *pkt_ctrl = &io_sq->llq_buf_ctrl;
|
|
struct ena_com_llq_info *llq_info = &io_sq->llq_info;
|
|
int rc;
|
|
|
|
if (!pkt_ctrl->descs_left_in_line) {
|
|
rc = ena_com_write_bounce_buffer_to_dev(io_sq,
|
|
pkt_ctrl->curr_bounce_buf);
|
|
if (unlikely(rc))
|
|
return rc;
|
|
|
|
pkt_ctrl->curr_bounce_buf =
|
|
ena_com_get_next_bounce_buffer(&io_sq->bounce_buf_ctrl);
|
|
memset(io_sq->llq_buf_ctrl.curr_bounce_buf,
|
|
0x0, llq_info->desc_list_entry_size);
|
|
|
|
pkt_ctrl->idx = 0;
|
|
if (unlikely(llq_info->desc_stride_ctrl == ENA_ADMIN_SINGLE_DESC_PER_ENTRY))
|
|
pkt_ctrl->descs_left_in_line = 1;
|
|
else
|
|
pkt_ctrl->descs_left_in_line =
|
|
llq_info->desc_list_entry_size / io_sq->desc_entry_size;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ena_com_sq_update_tail(struct ena_com_io_sq *io_sq)
|
|
{
|
|
if (io_sq->mem_queue_type == ENA_ADMIN_PLACEMENT_POLICY_DEV)
|
|
return ena_com_sq_update_llq_tail(io_sq);
|
|
|
|
io_sq->tail++;
|
|
|
|
/* Switch phase bit in case of wrap around */
|
|
if (unlikely((io_sq->tail & (io_sq->q_depth - 1)) == 0))
|
|
io_sq->phase ^= 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct ena_eth_io_rx_cdesc_base *
|
|
ena_com_rx_cdesc_idx_to_ptr(struct ena_com_io_cq *io_cq, u16 idx)
|
|
{
|
|
idx &= (io_cq->q_depth - 1);
|
|
return (struct ena_eth_io_rx_cdesc_base *)
|
|
((uintptr_t)io_cq->cdesc_addr.virt_addr +
|
|
idx * io_cq->cdesc_entry_size_in_bytes);
|
|
}
|
|
|
|
static u16 ena_com_cdesc_rx_pkt_get(struct ena_com_io_cq *io_cq,
|
|
u16 *first_cdesc_idx)
|
|
{
|
|
struct ena_eth_io_rx_cdesc_base *cdesc;
|
|
u16 count = 0, head_masked;
|
|
u32 last = 0;
|
|
|
|
do {
|
|
cdesc = ena_com_get_next_rx_cdesc(io_cq);
|
|
if (!cdesc)
|
|
break;
|
|
|
|
ena_com_cq_inc_head(io_cq);
|
|
count++;
|
|
last = (READ_ONCE(cdesc->status) &
|
|
ENA_ETH_IO_RX_CDESC_BASE_LAST_MASK) >>
|
|
ENA_ETH_IO_RX_CDESC_BASE_LAST_SHIFT;
|
|
} while (!last);
|
|
|
|
if (last) {
|
|
*first_cdesc_idx = io_cq->cur_rx_pkt_cdesc_start_idx;
|
|
count += io_cq->cur_rx_pkt_cdesc_count;
|
|
|
|
head_masked = io_cq->head & (io_cq->q_depth - 1);
|
|
|
|
io_cq->cur_rx_pkt_cdesc_count = 0;
|
|
io_cq->cur_rx_pkt_cdesc_start_idx = head_masked;
|
|
|
|
pr_debug("ENA q_id: %d packets were completed. first desc idx %u descs# %d\n",
|
|
io_cq->qid, *first_cdesc_idx, count);
|
|
} else {
|
|
io_cq->cur_rx_pkt_cdesc_count += count;
|
|
count = 0;
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
static int ena_com_create_meta(struct ena_com_io_sq *io_sq,
|
|
struct ena_com_tx_meta *ena_meta)
|
|
{
|
|
struct ena_eth_io_tx_meta_desc *meta_desc = NULL;
|
|
|
|
meta_desc = get_sq_desc(io_sq);
|
|
if (unlikely(!meta_desc))
|
|
return -EFAULT;
|
|
|
|
memset(meta_desc, 0x0, sizeof(struct ena_eth_io_tx_meta_desc));
|
|
|
|
meta_desc->len_ctrl |= ENA_ETH_IO_TX_META_DESC_META_DESC_MASK;
|
|
|
|
meta_desc->len_ctrl |= ENA_ETH_IO_TX_META_DESC_EXT_VALID_MASK;
|
|
|
|
/* bits 0-9 of the mss */
|
|
meta_desc->word2 |= ((u32)ena_meta->mss <<
|
|
ENA_ETH_IO_TX_META_DESC_MSS_LO_SHIFT) &
|
|
ENA_ETH_IO_TX_META_DESC_MSS_LO_MASK;
|
|
/* bits 10-13 of the mss */
|
|
meta_desc->len_ctrl |= ((ena_meta->mss >> 10) <<
|
|
ENA_ETH_IO_TX_META_DESC_MSS_HI_SHIFT) &
|
|
ENA_ETH_IO_TX_META_DESC_MSS_HI_MASK;
|
|
|
|
/* Extended meta desc */
|
|
meta_desc->len_ctrl |= ENA_ETH_IO_TX_META_DESC_ETH_META_TYPE_MASK;
|
|
meta_desc->len_ctrl |= ((u32)io_sq->phase <<
|
|
ENA_ETH_IO_TX_META_DESC_PHASE_SHIFT) &
|
|
ENA_ETH_IO_TX_META_DESC_PHASE_MASK;
|
|
|
|
meta_desc->len_ctrl |= ENA_ETH_IO_TX_META_DESC_FIRST_MASK;
|
|
meta_desc->len_ctrl |= ENA_ETH_IO_TX_META_DESC_META_STORE_MASK;
|
|
|
|
meta_desc->word2 |= ena_meta->l3_hdr_len &
|
|
ENA_ETH_IO_TX_META_DESC_L3_HDR_LEN_MASK;
|
|
meta_desc->word2 |= (ena_meta->l3_hdr_offset <<
|
|
ENA_ETH_IO_TX_META_DESC_L3_HDR_OFF_SHIFT) &
|
|
ENA_ETH_IO_TX_META_DESC_L3_HDR_OFF_MASK;
|
|
|
|
meta_desc->word2 |= ((u32)ena_meta->l4_hdr_len <<
|
|
ENA_ETH_IO_TX_META_DESC_L4_HDR_LEN_IN_WORDS_SHIFT) &
|
|
ENA_ETH_IO_TX_META_DESC_L4_HDR_LEN_IN_WORDS_MASK;
|
|
|
|
return ena_com_sq_update_tail(io_sq);
|
|
}
|
|
|
|
static int ena_com_create_and_store_tx_meta_desc(struct ena_com_io_sq *io_sq,
|
|
struct ena_com_tx_ctx *ena_tx_ctx,
|
|
bool *have_meta)
|
|
{
|
|
struct ena_com_tx_meta *ena_meta = &ena_tx_ctx->ena_meta;
|
|
|
|
/* When disable meta caching is set, don't bother to save the meta and
|
|
* compare it to the stored version, just create the meta
|
|
*/
|
|
if (io_sq->disable_meta_caching) {
|
|
if (unlikely(!ena_tx_ctx->meta_valid))
|
|
return -EINVAL;
|
|
|
|
*have_meta = true;
|
|
return ena_com_create_meta(io_sq, ena_meta);
|
|
}
|
|
|
|
if (ena_com_meta_desc_changed(io_sq, ena_tx_ctx)) {
|
|
*have_meta = true;
|
|
/* Cache the meta desc */
|
|
memcpy(&io_sq->cached_tx_meta, ena_meta,
|
|
sizeof(struct ena_com_tx_meta));
|
|
return ena_com_create_meta(io_sq, ena_meta);
|
|
}
|
|
|
|
*have_meta = false;
|
|
return 0;
|
|
}
|
|
|
|
static void ena_com_rx_set_flags(struct ena_com_rx_ctx *ena_rx_ctx,
|
|
struct ena_eth_io_rx_cdesc_base *cdesc)
|
|
{
|
|
ena_rx_ctx->l3_proto = cdesc->status &
|
|
ENA_ETH_IO_RX_CDESC_BASE_L3_PROTO_IDX_MASK;
|
|
ena_rx_ctx->l4_proto =
|
|
(cdesc->status & ENA_ETH_IO_RX_CDESC_BASE_L4_PROTO_IDX_MASK) >>
|
|
ENA_ETH_IO_RX_CDESC_BASE_L4_PROTO_IDX_SHIFT;
|
|
ena_rx_ctx->l3_csum_err =
|
|
!!((cdesc->status & ENA_ETH_IO_RX_CDESC_BASE_L3_CSUM_ERR_MASK) >>
|
|
ENA_ETH_IO_RX_CDESC_BASE_L3_CSUM_ERR_SHIFT);
|
|
ena_rx_ctx->l4_csum_err =
|
|
!!((cdesc->status & ENA_ETH_IO_RX_CDESC_BASE_L4_CSUM_ERR_MASK) >>
|
|
ENA_ETH_IO_RX_CDESC_BASE_L4_CSUM_ERR_SHIFT);
|
|
ena_rx_ctx->l4_csum_checked =
|
|
!!((cdesc->status & ENA_ETH_IO_RX_CDESC_BASE_L4_CSUM_CHECKED_MASK) >>
|
|
ENA_ETH_IO_RX_CDESC_BASE_L4_CSUM_CHECKED_SHIFT);
|
|
ena_rx_ctx->hash = cdesc->hash;
|
|
ena_rx_ctx->frag =
|
|
(cdesc->status & ENA_ETH_IO_RX_CDESC_BASE_IPV4_FRAG_MASK) >>
|
|
ENA_ETH_IO_RX_CDESC_BASE_IPV4_FRAG_SHIFT;
|
|
|
|
pr_debug("l3_proto %d l4_proto %d l3_csum_err %d l4_csum_err %d hash %d frag %d cdesc_status %x\n",
|
|
ena_rx_ctx->l3_proto, ena_rx_ctx->l4_proto,
|
|
ena_rx_ctx->l3_csum_err, ena_rx_ctx->l4_csum_err,
|
|
ena_rx_ctx->hash, ena_rx_ctx->frag, cdesc->status);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/***************************** API **********************************/
|
|
/*****************************************************************************/
|
|
|
|
int ena_com_prepare_tx(struct ena_com_io_sq *io_sq,
|
|
struct ena_com_tx_ctx *ena_tx_ctx,
|
|
int *nb_hw_desc)
|
|
{
|
|
struct ena_eth_io_tx_desc *desc = NULL;
|
|
struct ena_com_buf *ena_bufs = ena_tx_ctx->ena_bufs;
|
|
void *buffer_to_push = ena_tx_ctx->push_header;
|
|
u16 header_len = ena_tx_ctx->header_len;
|
|
u16 num_bufs = ena_tx_ctx->num_bufs;
|
|
u16 start_tail = io_sq->tail;
|
|
int i, rc;
|
|
bool have_meta;
|
|
u64 addr_hi;
|
|
|
|
WARN(io_sq->direction != ENA_COM_IO_QUEUE_DIRECTION_TX, "wrong Q type");
|
|
|
|
/* num_bufs +1 for potential meta desc */
|
|
if (unlikely(!ena_com_sq_have_enough_space(io_sq, num_bufs + 1))) {
|
|
pr_debug("Not enough space in the tx queue\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
if (unlikely(header_len > io_sq->tx_max_header_size)) {
|
|
pr_err("Header size is too large %d max header: %d\n",
|
|
header_len, io_sq->tx_max_header_size);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (unlikely(io_sq->mem_queue_type == ENA_ADMIN_PLACEMENT_POLICY_DEV &&
|
|
!buffer_to_push))
|
|
return -EINVAL;
|
|
|
|
rc = ena_com_write_header_to_bounce(io_sq, buffer_to_push, header_len);
|
|
if (unlikely(rc))
|
|
return rc;
|
|
|
|
rc = ena_com_create_and_store_tx_meta_desc(io_sq, ena_tx_ctx, &have_meta);
|
|
if (unlikely(rc)) {
|
|
pr_err("Failed to create and store tx meta desc\n");
|
|
return rc;
|
|
}
|
|
|
|
/* If the caller doesn't want to send packets */
|
|
if (unlikely(!num_bufs && !header_len)) {
|
|
rc = ena_com_close_bounce_buffer(io_sq);
|
|
*nb_hw_desc = io_sq->tail - start_tail;
|
|
return rc;
|
|
}
|
|
|
|
desc = get_sq_desc(io_sq);
|
|
if (unlikely(!desc))
|
|
return -EFAULT;
|
|
memset(desc, 0x0, sizeof(struct ena_eth_io_tx_desc));
|
|
|
|
/* Set first desc when we don't have meta descriptor */
|
|
if (!have_meta)
|
|
desc->len_ctrl |= ENA_ETH_IO_TX_DESC_FIRST_MASK;
|
|
|
|
desc->buff_addr_hi_hdr_sz |= ((u32)header_len <<
|
|
ENA_ETH_IO_TX_DESC_HEADER_LENGTH_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_HEADER_LENGTH_MASK;
|
|
desc->len_ctrl |= ((u32)io_sq->phase << ENA_ETH_IO_TX_DESC_PHASE_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_PHASE_MASK;
|
|
|
|
desc->len_ctrl |= ENA_ETH_IO_TX_DESC_COMP_REQ_MASK;
|
|
|
|
/* Bits 0-9 */
|
|
desc->meta_ctrl |= ((u32)ena_tx_ctx->req_id <<
|
|
ENA_ETH_IO_TX_DESC_REQ_ID_LO_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_REQ_ID_LO_MASK;
|
|
|
|
desc->meta_ctrl |= (ena_tx_ctx->df <<
|
|
ENA_ETH_IO_TX_DESC_DF_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_DF_MASK;
|
|
|
|
/* Bits 10-15 */
|
|
desc->len_ctrl |= ((ena_tx_ctx->req_id >> 10) <<
|
|
ENA_ETH_IO_TX_DESC_REQ_ID_HI_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_REQ_ID_HI_MASK;
|
|
|
|
if (ena_tx_ctx->meta_valid) {
|
|
desc->meta_ctrl |= (ena_tx_ctx->tso_enable <<
|
|
ENA_ETH_IO_TX_DESC_TSO_EN_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_TSO_EN_MASK;
|
|
desc->meta_ctrl |= ena_tx_ctx->l3_proto &
|
|
ENA_ETH_IO_TX_DESC_L3_PROTO_IDX_MASK;
|
|
desc->meta_ctrl |= (ena_tx_ctx->l4_proto <<
|
|
ENA_ETH_IO_TX_DESC_L4_PROTO_IDX_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_L4_PROTO_IDX_MASK;
|
|
desc->meta_ctrl |= (ena_tx_ctx->l3_csum_enable <<
|
|
ENA_ETH_IO_TX_DESC_L3_CSUM_EN_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_L3_CSUM_EN_MASK;
|
|
desc->meta_ctrl |= (ena_tx_ctx->l4_csum_enable <<
|
|
ENA_ETH_IO_TX_DESC_L4_CSUM_EN_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_L4_CSUM_EN_MASK;
|
|
desc->meta_ctrl |= (ena_tx_ctx->l4_csum_partial <<
|
|
ENA_ETH_IO_TX_DESC_L4_CSUM_PARTIAL_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_L4_CSUM_PARTIAL_MASK;
|
|
}
|
|
|
|
for (i = 0; i < num_bufs; i++) {
|
|
/* The first desc share the same desc as the header */
|
|
if (likely(i != 0)) {
|
|
rc = ena_com_sq_update_tail(io_sq);
|
|
if (unlikely(rc))
|
|
return rc;
|
|
|
|
desc = get_sq_desc(io_sq);
|
|
if (unlikely(!desc))
|
|
return -EFAULT;
|
|
|
|
memset(desc, 0x0, sizeof(struct ena_eth_io_tx_desc));
|
|
|
|
desc->len_ctrl |= ((u32)io_sq->phase <<
|
|
ENA_ETH_IO_TX_DESC_PHASE_SHIFT) &
|
|
ENA_ETH_IO_TX_DESC_PHASE_MASK;
|
|
}
|
|
|
|
desc->len_ctrl |= ena_bufs->len &
|
|
ENA_ETH_IO_TX_DESC_LENGTH_MASK;
|
|
|
|
addr_hi = ((ena_bufs->paddr &
|
|
GENMASK_ULL(io_sq->dma_addr_bits - 1, 32)) >> 32);
|
|
|
|
desc->buff_addr_lo = (u32)ena_bufs->paddr;
|
|
desc->buff_addr_hi_hdr_sz |= addr_hi &
|
|
ENA_ETH_IO_TX_DESC_ADDR_HI_MASK;
|
|
ena_bufs++;
|
|
}
|
|
|
|
/* set the last desc indicator */
|
|
desc->len_ctrl |= ENA_ETH_IO_TX_DESC_LAST_MASK;
|
|
|
|
rc = ena_com_sq_update_tail(io_sq);
|
|
if (unlikely(rc))
|
|
return rc;
|
|
|
|
rc = ena_com_close_bounce_buffer(io_sq);
|
|
|
|
*nb_hw_desc = io_sq->tail - start_tail;
|
|
return rc;
|
|
}
|
|
|
|
int ena_com_rx_pkt(struct ena_com_io_cq *io_cq,
|
|
struct ena_com_io_sq *io_sq,
|
|
struct ena_com_rx_ctx *ena_rx_ctx)
|
|
{
|
|
struct ena_com_rx_buf_info *ena_buf = &ena_rx_ctx->ena_bufs[0];
|
|
struct ena_eth_io_rx_cdesc_base *cdesc = NULL;
|
|
u16 q_depth = io_cq->q_depth;
|
|
u16 cdesc_idx = 0;
|
|
u16 nb_hw_desc;
|
|
u16 i = 0;
|
|
|
|
WARN(io_cq->direction != ENA_COM_IO_QUEUE_DIRECTION_RX, "wrong Q type");
|
|
|
|
nb_hw_desc = ena_com_cdesc_rx_pkt_get(io_cq, &cdesc_idx);
|
|
if (nb_hw_desc == 0) {
|
|
ena_rx_ctx->descs = nb_hw_desc;
|
|
return 0;
|
|
}
|
|
|
|
pr_debug("Fetch rx packet: queue %d completed desc: %d\n", io_cq->qid,
|
|
nb_hw_desc);
|
|
|
|
if (unlikely(nb_hw_desc > ena_rx_ctx->max_bufs)) {
|
|
pr_err("Too many RX cdescs (%d) > MAX(%d)\n", nb_hw_desc,
|
|
ena_rx_ctx->max_bufs);
|
|
return -ENOSPC;
|
|
}
|
|
|
|
cdesc = ena_com_rx_cdesc_idx_to_ptr(io_cq, cdesc_idx);
|
|
ena_rx_ctx->pkt_offset = cdesc->offset;
|
|
|
|
do {
|
|
ena_buf[i].len = cdesc->length;
|
|
ena_buf[i].req_id = cdesc->req_id;
|
|
if (unlikely(ena_buf[i].req_id >= q_depth))
|
|
return -EIO;
|
|
|
|
if (++i >= nb_hw_desc)
|
|
break;
|
|
|
|
cdesc = ena_com_rx_cdesc_idx_to_ptr(io_cq, cdesc_idx + i);
|
|
|
|
} while (1);
|
|
|
|
/* Update SQ head ptr */
|
|
io_sq->next_to_comp += nb_hw_desc;
|
|
|
|
pr_debug("[%s][QID#%d] Updating SQ head to: %d\n", __func__, io_sq->qid,
|
|
io_sq->next_to_comp);
|
|
|
|
/* Get rx flags from the last pkt */
|
|
ena_com_rx_set_flags(ena_rx_ctx, cdesc);
|
|
|
|
ena_rx_ctx->descs = nb_hw_desc;
|
|
return 0;
|
|
}
|
|
|
|
int ena_com_add_single_rx_desc(struct ena_com_io_sq *io_sq,
|
|
struct ena_com_buf *ena_buf,
|
|
u16 req_id)
|
|
{
|
|
struct ena_eth_io_rx_desc *desc;
|
|
|
|
WARN(io_sq->direction != ENA_COM_IO_QUEUE_DIRECTION_RX, "wrong Q type");
|
|
|
|
if (unlikely(!ena_com_sq_have_enough_space(io_sq, 1)))
|
|
return -ENOSPC;
|
|
|
|
desc = get_sq_desc(io_sq);
|
|
if (unlikely(!desc))
|
|
return -EFAULT;
|
|
|
|
memset(desc, 0x0, sizeof(struct ena_eth_io_rx_desc));
|
|
|
|
desc->length = ena_buf->len;
|
|
|
|
desc->ctrl = ENA_ETH_IO_RX_DESC_FIRST_MASK |
|
|
ENA_ETH_IO_RX_DESC_LAST_MASK |
|
|
(io_sq->phase & ENA_ETH_IO_RX_DESC_PHASE_MASK) |
|
|
ENA_ETH_IO_RX_DESC_COMP_REQ_MASK;
|
|
|
|
desc->req_id = req_id;
|
|
|
|
desc->buff_addr_lo = (u32)ena_buf->paddr;
|
|
desc->buff_addr_hi =
|
|
((ena_buf->paddr & GENMASK_ULL(io_sq->dma_addr_bits - 1, 32)) >> 32);
|
|
|
|
return ena_com_sq_update_tail(io_sq);
|
|
}
|
|
|
|
bool ena_com_cq_empty(struct ena_com_io_cq *io_cq)
|
|
{
|
|
struct ena_eth_io_rx_cdesc_base *cdesc;
|
|
|
|
cdesc = ena_com_get_next_rx_cdesc(io_cq);
|
|
if (cdesc)
|
|
return false;
|
|
else
|
|
return true;
|
|
}
|