drivers/net/sfc/sfc_ef10_essb_rx.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  *
   3  * Copyright (c) 2017-2018 Solarflare Communications Inc.
   4  * All rights reserved.
   5  *
   6  * This software was jointly developed between OKTET Labs (under contract
   7  * for Solarflare) and Solarflare Communications, Inc.
   8  */
   9
  10 /* EF10 equal stride packed stream receive native datapath implementation */
  11
  12 #include <stdbool.h>
  13
  14 #include <rte_byteorder.h>
  15 #include <rte_mbuf_ptype.h>
  16 #include <rte_mbuf.h>
  17 #include <rte_io.h>
  18
  19 #include "efx.h"
  20 #include "efx_types.h"
  21 #include "efx_regs.h"
  22 #include "efx_regs_ef10.h"
  23
  24 #include "sfc_tweak.h"
  25 #include "sfc_dp_rx.h"
  26 #include "sfc_kvargs.h"
  27 #include "sfc_ef10.h"
  28
  29 /* Tunnels are not supported */
  30 #define SFC_EF10_RX_EV_ENCAP_SUPPORT    0
  31 #include "sfc_ef10_rx_ev.h"
  32
  33 #define sfc_ef10_essb_rx_err(dpq, ...) \
  34         SFC_DP_LOG(SFC_KVARG_DATAPATH_EF10_ESSB, ERR, dpq, __VA_ARGS__)
  35
  36 #define sfc_ef10_essb_rx_info(dpq, ...) \
  37         SFC_DP_LOG(SFC_KVARG_DATAPATH_EF10_ESSB, INFO, dpq, __VA_ARGS__)
  38
  39 /*
  40  * Fake length for RXQ descriptors in equal stride super-buffer mode
  41  * to make hardware happy.
  42  */
  43 #define SFC_EF10_ESSB_RX_FAKE_BUF_SIZE  32
  44
  45 /**
  46  * Minimum number of Rx buffers the datapath allows to use.
  47  *
  48  * Each HW Rx descriptor has many Rx buffers. The number of buffers
  49  * in one HW Rx descriptor is equal to size of contiguous block
  50  * provided by Rx buffers memory pool. The contiguous block size
  51  * depends on CONFIG_RTE_DRIVER_MEMPOOL_BUCKET_SIZE_KB and rte_mbuf
  52  * data size specified on the memory pool creation. Typical rte_mbuf
  53  * data size is about 2k which makes a bit less than 32 buffers in
  54  * contiguous block with default bucket size equal to 64k.
  55  * Since HW Rx descriptors are pushed by 8 (see SFC_EF10_RX_WPTR_ALIGN),
  56  * it makes about 256 as required minimum. Double it in advertised
  57  * minimum to allow for at least 2 refill blocks.
  58  */
  59 #define SFC_EF10_ESSB_RX_DESCS_MIN      512
  60
  61 /**
  62  * Number of Rx buffers should be aligned to.
  63  *
  64  * There are no extra requirements on alignment since actual number of
  65  * pushed Rx buffers will be multiple by contiguous block size which
  66  * is unknown beforehand.
  67  */
  68 #define SFC_EF10_ESSB_RX_DESCS_ALIGN    1
  69
  70 /**
  71  * Maximum number of descriptors/buffers in the Rx ring.
  72  * It should guarantee that corresponding event queue never overfill.
  73  */
  74 #define SFC_EF10_ESSB_RXQ_LIMIT(_nevs) \
  75         ((_nevs) - 1 /* head must not step on tail */ - \
  76          (SFC_EF10_EV_PER_CACHE_LINE - 1) /* max unused EvQ entries */ - \
  77          1 /* Rx error */ - 1 /* flush */)
  78
  79 struct sfc_ef10_essb_rx_sw_desc {
  80         struct rte_mbuf                 *first_mbuf;
  81 };
  82
  83 struct sfc_ef10_essb_rxq {
  84         /* Used on data path */
  85         unsigned int                    flags;
  86 #define SFC_EF10_ESSB_RXQ_STARTED       0x1
  87 #define SFC_EF10_ESSB_RXQ_NOT_RUNNING   0x2
  88 #define SFC_EF10_ESSB_RXQ_EXCEPTION     0x4
  89         unsigned int                    rxq_ptr_mask;
  90         unsigned int                    block_size;
  91         unsigned int                    buf_stride;
  92         unsigned int                    bufs_ptr;
  93         unsigned int                    completed;
  94         unsigned int                    pending_id;
  95         unsigned int                    bufs_pending;
  96         unsigned int                    left_in_completed;
  97         unsigned int                    left_in_pending;
  98         unsigned int                    evq_read_ptr;
  99         unsigned int                    evq_ptr_mask;
 100         efx_qword_t                     *evq_hw_ring;
 101         struct sfc_ef10_essb_rx_sw_desc *sw_ring;
 102         uint16_t                        port_id;
 103
 104         /* Used on refill */
 105         unsigned int                    added;
 106         unsigned int                    max_fill_level;
 107         unsigned int                    refill_threshold;
 108         struct rte_mempool              *refill_mb_pool;
 109         efx_qword_t                     *rxq_hw_ring;
 110         volatile void                   *doorbell;
 111
 112         /* Datapath receive queue anchor */
 113         struct sfc_dp_rxq               dp;
 114 };
 115
 116 static inline struct sfc_ef10_essb_rxq *
 117 sfc_ef10_essb_rxq_by_dp_rxq(struct sfc_dp_rxq *dp_rxq)
 118 {
 119         return container_of(dp_rxq, struct sfc_ef10_essb_rxq, dp);
 120 }
 121
 122 static struct rte_mbuf *
 123 sfc_ef10_essb_next_mbuf(const struct sfc_ef10_essb_rxq *rxq,
 124                         struct rte_mbuf *mbuf)
 125 {
 126         return (struct rte_mbuf *)((uintptr_t)mbuf + rxq->buf_stride);
 127 }
 128
 129 static struct rte_mbuf *
 130 sfc_ef10_essb_mbuf_by_index(const struct sfc_ef10_essb_rxq *rxq,
 131                             struct rte_mbuf *mbuf, unsigned int idx)
 132 {
 133         return (struct rte_mbuf *)((uintptr_t)mbuf + idx * rxq->buf_stride);
 134 }
 135
 136 static struct rte_mbuf *
 137 sfc_ef10_essb_maybe_next_completed(struct sfc_ef10_essb_rxq *rxq)
 138 {
 139         const struct sfc_ef10_essb_rx_sw_desc *rxd;
 140
 141         if (rxq->left_in_completed != 0) {
 142                 rxd = &rxq->sw_ring[rxq->completed & rxq->rxq_ptr_mask];
 143                 return sfc_ef10_essb_mbuf_by_index(rxq, rxd->first_mbuf,
 144                                 rxq->block_size - rxq->left_in_completed);
 145         } else {
 146                 rxq->completed++;
 147                 rxd = &rxq->sw_ring[rxq->completed & rxq->rxq_ptr_mask];
 148                 rxq->left_in_completed = rxq->block_size;
 149                 return rxd->first_mbuf;
 150         }
 151 }
 152
 153 static void
 154 sfc_ef10_essb_rx_qrefill(struct sfc_ef10_essb_rxq *rxq)
 155 {
 156         const unsigned int rxq_ptr_mask = rxq->rxq_ptr_mask;
 157         unsigned int free_space;
 158         unsigned int bulks;
 159         void *mbuf_blocks[SFC_EF10_RX_WPTR_ALIGN];
 160         unsigned int added = rxq->added;
 161
 162         free_space = rxq->max_fill_level - (added - rxq->completed);
 163
 164         if (free_space < rxq->refill_threshold)
 165                 return;
 166
 167         bulks = free_space / RTE_DIM(mbuf_blocks);
 168         /* refill_threshold guarantees that bulks is positive */
 169         SFC_ASSERT(bulks > 0);
 170
 171         do {
 172                 unsigned int id;
 173                 unsigned int i;
 174
 175                 if (unlikely(rte_mempool_get_contig_blocks(rxq->refill_mb_pool,
 176                                 mbuf_blocks, RTE_DIM(mbuf_blocks)) < 0)) {
 177                         struct rte_eth_dev_data *dev_data =
 178                                 rte_eth_devices[rxq->port_id].data;
 179
 180                         /*
 181                          * It is hardly a safe way to increment counter
 182                          * from different contexts, but all PMDs do it.
 183                          */
 184                         dev_data->rx_mbuf_alloc_failed += RTE_DIM(mbuf_blocks);
 185                         /* Return if we have posted nothing yet */
 186                         if (added == rxq->added)
 187                                 return;
 188                         /* Push posted */
 189                         break;
 190                 }
 191
 192                 for (i = 0, id = added & rxq_ptr_mask;
 193                      i < RTE_DIM(mbuf_blocks);
 194                      ++i, ++id) {
 195                         struct rte_mbuf *m = mbuf_blocks[i];
 196                         struct sfc_ef10_essb_rx_sw_desc *rxd;
 197
 198                         SFC_ASSERT((id & ~rxq_ptr_mask) == 0);
 199                         rxd = &rxq->sw_ring[id];
 200                         rxd->first_mbuf = m;
 201
 202                         /* RX_KER_BYTE_CNT is ignored by firmware */
 203                         EFX_POPULATE_QWORD_2(rxq->rxq_hw_ring[id],
 204                                              ESF_DZ_RX_KER_BYTE_CNT,
 205                                              SFC_EF10_ESSB_RX_FAKE_BUF_SIZE,
 206                                              ESF_DZ_RX_KER_BUF_ADDR,
 207                                              rte_mbuf_data_iova_default(m));
 208                 }
 209
 210                 added += RTE_DIM(mbuf_blocks);
 211
 212         } while (--bulks > 0);
 213
 214         SFC_ASSERT(rxq->added != added);
 215         rxq->added = added;
 216         sfc_ef10_rx_qpush(rxq->doorbell, added, rxq_ptr_mask);
 217 }
 218
 219 static bool
 220 sfc_ef10_essb_rx_event_get(struct sfc_ef10_essb_rxq *rxq, efx_qword_t *rx_ev)
 221 {
 222         *rx_ev = rxq->evq_hw_ring[rxq->evq_read_ptr & rxq->evq_ptr_mask];
 223
 224         if (!sfc_ef10_ev_present(*rx_ev))
 225                 return false;
 226
 227         if (unlikely(EFX_QWORD_FIELD(*rx_ev, FSF_AZ_EV_CODE) !=
 228                      FSE_AZ_EV_CODE_RX_EV)) {
 229                 /*
 230                  * Do not move read_ptr to keep the event for exception
 231                  * handling
 232                  */
 233                 rxq->flags |= SFC_EF10_ESSB_RXQ_EXCEPTION;
 234                 sfc_ef10_essb_rx_err(&rxq->dp.dpq,
 235                                      "RxQ exception at EvQ read ptr %#x",
 236                                      rxq->evq_read_ptr);
 237                 return false;
 238         }
 239
 240         rxq->evq_read_ptr++;
 241         return true;
 242 }
 243
 244 static void
 245 sfc_ef10_essb_rx_process_ev(struct sfc_ef10_essb_rxq *rxq, efx_qword_t rx_ev)
 246 {
 247         unsigned int ready;
 248
 249         ready = (EFX_QWORD_FIELD(rx_ev, ESF_DZ_RX_DSC_PTR_LBITS) -
 250                  rxq->bufs_ptr) &
 251                 EFX_MASK32(ESF_DZ_RX_DSC_PTR_LBITS);
 252
 253         rxq->bufs_ptr += ready;
 254         rxq->bufs_pending += ready;
 255
 256         SFC_ASSERT(ready > 0);
 257         do {
 258                 const struct sfc_ef10_essb_rx_sw_desc *rxd;
 259                 struct rte_mbuf *m;
 260                 unsigned int todo_bufs;
 261                 struct rte_mbuf *m0;
 262
 263                 rxd = &rxq->sw_ring[rxq->pending_id];
 264                 m = sfc_ef10_essb_mbuf_by_index(rxq, rxd->first_mbuf,
 265                         rxq->block_size - rxq->left_in_pending);
 266
 267                 if (ready < rxq->left_in_pending) {
 268                         todo_bufs = ready;
 269                         ready = 0;
 270                         rxq->left_in_pending -= todo_bufs;
 271                 } else {
 272                         todo_bufs = rxq->left_in_pending;
 273                         ready -= todo_bufs;
 274                         rxq->left_in_pending = rxq->block_size;
 275                         if (rxq->pending_id != rxq->rxq_ptr_mask)
 276                                 rxq->pending_id++;
 277                         else
 278                                 rxq->pending_id = 0;
 279                 }
 280
 281                 SFC_ASSERT(todo_bufs > 0);
 282                 --todo_bufs;
 283
 284                 sfc_ef10_rx_ev_to_offloads(rx_ev, m, ~0ull);
 285
 286                 /* Prefetch pseudo-header */
 287                 rte_prefetch0((uint8_t *)m->buf_addr + RTE_PKTMBUF_HEADROOM);
 288
 289                 m0 = m;
 290                 while (todo_bufs-- > 0) {
 291                         m = sfc_ef10_essb_next_mbuf(rxq, m);
 292                         m->ol_flags = m0->ol_flags;
 293                         m->packet_type = m0->packet_type;
 294                         /* Prefetch pseudo-header */
 295                         rte_prefetch0((uint8_t *)m->buf_addr +
 296                                       RTE_PKTMBUF_HEADROOM);
 297                 }
 298         } while (ready > 0);
 299 }
 300
 301 static unsigned int
 302 sfc_ef10_essb_rx_get_pending(struct sfc_ef10_essb_rxq *rxq,
 303                              struct rte_mbuf **rx_pkts, uint16_t nb_pkts)
 304 {
 305         unsigned int n_rx_pkts = 0;
 306         unsigned int todo_bufs;
 307         struct rte_mbuf *m;
 308
 309         while ((todo_bufs = RTE_MIN(nb_pkts - n_rx_pkts,
 310                                     rxq->bufs_pending)) > 0) {
 311                 m = sfc_ef10_essb_maybe_next_completed(rxq);
 312
 313                 todo_bufs = RTE_MIN(todo_bufs, rxq->left_in_completed);
 314
 315                 rxq->bufs_pending -= todo_bufs;
 316                 rxq->left_in_completed -= todo_bufs;
 317
 318                 SFC_ASSERT(todo_bufs > 0);
 319                 todo_bufs--;
 320
 321                 do {
 322                         const efx_qword_t *qwordp;
 323                         uint16_t pkt_len;
 324
 325                         /* Buffers to be discarded have 0 in packet type */
 326                         if (unlikely(m->packet_type == 0)) {
 327                                 rte_mempool_put(rxq->refill_mb_pool, m);
 328                                 goto next_buf;
 329                         }
 330
 331                         rx_pkts[n_rx_pkts++] = m;
 332
 333                         /* Parse pseudo-header */
 334                         qwordp = (const efx_qword_t *)
 335                                 ((uint8_t *)m->buf_addr + RTE_PKTMBUF_HEADROOM);
 336                         pkt_len =
 337                                 EFX_QWORD_FIELD(*qwordp,
 338                                                 ES_EZ_ESSB_RX_PREFIX_DATA_LEN);
 339
 340                         m->data_off = RTE_PKTMBUF_HEADROOM +
 341                                 ES_EZ_ESSB_RX_PREFIX_LEN;
 342                         m->port = rxq->port_id;
 343
 344                         rte_pktmbuf_pkt_len(m) = pkt_len;
 345                         rte_pktmbuf_data_len(m) = pkt_len;
 346
 347                         m->ol_flags |=
 348                                 (PKT_RX_RSS_HASH *
 349                                  !!EFX_TEST_QWORD_BIT(*qwordp,
 350                                         ES_EZ_ESSB_RX_PREFIX_HASH_VALID_LBN)) |
 351                                 (PKT_RX_FDIR_ID *
 352                                  !!EFX_TEST_QWORD_BIT(*qwordp,
 353                                         ES_EZ_ESSB_RX_PREFIX_MARK_VALID_LBN)) |
 354                                 (PKT_RX_FDIR *
 355                                  !!EFX_TEST_QWORD_BIT(*qwordp,
 356                                         ES_EZ_ESSB_RX_PREFIX_MATCH_FLAG_LBN));
 357
 358                         /* EFX_QWORD_FIELD converts little-endian to CPU */
 359                         m->hash.rss =
 360                                 EFX_QWORD_FIELD(*qwordp,
 361                                                 ES_EZ_ESSB_RX_PREFIX_HASH);
 362                         m->hash.fdir.hi =
 363                                 EFX_QWORD_FIELD(*qwordp,
 364                                                 ES_EZ_ESSB_RX_PREFIX_MARK);
 365
 366 next_buf:
 367                         m = sfc_ef10_essb_next_mbuf(rxq, m);
 368                 } while (todo_bufs-- > 0);
 369         }
 370
 371         return n_rx_pkts;
 372 }
 373
 374
 375 static uint16_t
 376 sfc_ef10_essb_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
 377                         uint16_t nb_pkts)
 378 {
 379         struct sfc_ef10_essb_rxq *rxq = sfc_ef10_essb_rxq_by_dp_rxq(rx_queue);
 380         const unsigned int evq_old_read_ptr = rxq->evq_read_ptr;
 381         uint16_t n_rx_pkts;
 382         efx_qword_t rx_ev;
 383
 384         if (unlikely(rxq->flags & (SFC_EF10_ESSB_RXQ_NOT_RUNNING |
 385                                    SFC_EF10_ESSB_RXQ_EXCEPTION)))
 386                 return 0;
 387
 388         n_rx_pkts = sfc_ef10_essb_rx_get_pending(rxq, rx_pkts, nb_pkts);
 389
 390         while (n_rx_pkts != nb_pkts &&
 391                sfc_ef10_essb_rx_event_get(rxq, &rx_ev)) {
 392                 /*
 393                  * DROP_EVENT is an internal to the NIC, software should
 394                  * never see it and, therefore, may ignore it.
 395                  */
 396
 397                 sfc_ef10_essb_rx_process_ev(rxq, rx_ev);
 398                 n_rx_pkts += sfc_ef10_essb_rx_get_pending(rxq,
 399                                                           rx_pkts + n_rx_pkts,
 400                                                           nb_pkts - n_rx_pkts);
 401         }
 402
 403         sfc_ef10_ev_qclear(rxq->evq_hw_ring, rxq->evq_ptr_mask,
 404                            evq_old_read_ptr, rxq->evq_read_ptr);
 405
 406         /* It is not a problem if we refill in the case of exception */
 407         sfc_ef10_essb_rx_qrefill(rxq);
 408
 409         return n_rx_pkts;
 410 }
 411
 412 static sfc_dp_rx_qdesc_npending_t sfc_ef10_essb_rx_qdesc_npending;
 413 static unsigned int
 414 sfc_ef10_essb_rx_qdesc_npending(struct sfc_dp_rxq *dp_rxq)
 415 {
 416         struct sfc_ef10_essb_rxq *rxq = sfc_ef10_essb_rxq_by_dp_rxq(dp_rxq);
 417         const unsigned int evq_old_read_ptr = rxq->evq_read_ptr;
 418         efx_qword_t rx_ev;
 419
 420         if (unlikely(rxq->flags & (SFC_EF10_ESSB_RXQ_NOT_RUNNING |
 421                                    SFC_EF10_ESSB_RXQ_EXCEPTION)))
 422                 return rxq->bufs_pending;
 423
 424         while (sfc_ef10_essb_rx_event_get(rxq, &rx_ev)) {
 425                 /*
 426                  * DROP_EVENT is an internal to the NIC, software should
 427                  * never see it and, therefore, may ignore it.
 428                  */
 429                 sfc_ef10_essb_rx_process_ev(rxq, rx_ev);
 430         }
 431
 432         sfc_ef10_ev_qclear(rxq->evq_hw_ring, rxq->evq_ptr_mask,
 433                            evq_old_read_ptr, rxq->evq_read_ptr);
 434
 435         return rxq->bufs_pending;
 436 }
 437
 438 static sfc_dp_rx_qdesc_status_t sfc_ef10_essb_rx_qdesc_status;
 439 static int
 440 sfc_ef10_essb_rx_qdesc_status(struct sfc_dp_rxq *dp_rxq, uint16_t offset)
 441 {
 442         struct sfc_ef10_essb_rxq *rxq = sfc_ef10_essb_rxq_by_dp_rxq(dp_rxq);
 443         unsigned int pending = sfc_ef10_essb_rx_qdesc_npending(dp_rxq);
 444
 445         if (offset < pending)
 446                 return RTE_ETH_RX_DESC_DONE;
 447
 448         if (offset < (rxq->added - rxq->completed) * rxq->block_size +
 449                      rxq->left_in_completed - rxq->block_size)
 450                 return RTE_ETH_RX_DESC_AVAIL;
 451
 452         return RTE_ETH_RX_DESC_UNAVAIL;
 453 }
 454
 455 static sfc_dp_rx_get_dev_info_t sfc_ef10_essb_rx_get_dev_info;
 456 static void
 457 sfc_ef10_essb_rx_get_dev_info(struct rte_eth_dev_info *dev_info)
 458 {
 459         /*
 460          * Number of descriptors just defines maximum number of pushed
 461          * descriptors (fill level).
 462          */
 463         dev_info->rx_desc_lim.nb_min = SFC_EF10_ESSB_RX_DESCS_MIN;
 464         dev_info->rx_desc_lim.nb_align = SFC_EF10_ESSB_RX_DESCS_ALIGN;
 465 }
 466
 467 static sfc_dp_rx_pool_ops_supported_t sfc_ef10_essb_rx_pool_ops_supported;
 468 static int
 469 sfc_ef10_essb_rx_pool_ops_supported(const char *pool)
 470 {
 471         SFC_ASSERT(pool != NULL);
 472
 473         if (strcmp(pool, "bucket") == 0)
 474                 return 0;
 475
 476         return -ENOTSUP;
 477 }
 478
 479 static sfc_dp_rx_qsize_up_rings_t sfc_ef10_essb_rx_qsize_up_rings;
 480 static int
 481 sfc_ef10_essb_rx_qsize_up_rings(uint16_t nb_rx_desc,
 482                                 struct rte_mempool *mb_pool,
 483                                 unsigned int *rxq_entries,
 484                                 unsigned int *evq_entries,
 485                                 unsigned int *rxq_max_fill_level)
 486 {
 487         int rc;
 488         struct rte_mempool_info mp_info;
 489         unsigned int nb_hw_rx_desc;
 490         unsigned int max_events;
 491
 492         rc = rte_mempool_ops_get_info(mb_pool, &mp_info);
 493         if (rc != 0)
 494                 return -rc;
 495         if (mp_info.contig_block_size == 0)
 496                 return EINVAL;
 497
 498         /*
 499          * Calculate required number of hardware Rx descriptors each
 500          * carrying contig block size Rx buffers.
 501          * It cannot be less than Rx write pointer alignment plus 1
 502          * in order to avoid cases when the ring is guaranteed to be
 503          * empty.
 504          */
 505         nb_hw_rx_desc = RTE_MAX(SFC_DIV_ROUND_UP(nb_rx_desc,
 506                                                  mp_info.contig_block_size),
 507                                 SFC_EF10_RX_WPTR_ALIGN + 1);
 508         if (nb_hw_rx_desc <= EFX_RXQ_MINNDESCS) {
 509                 *rxq_entries = EFX_RXQ_MINNDESCS;
 510         } else {
 511                 *rxq_entries = rte_align32pow2(nb_hw_rx_desc);
 512                 if (*rxq_entries > EFX_RXQ_MAXNDESCS)
 513                         return EINVAL;
 514         }
 515
 516         max_events = RTE_ALIGN_FLOOR(nb_hw_rx_desc, SFC_EF10_RX_WPTR_ALIGN) *
 517                 mp_info.contig_block_size +
 518                 (SFC_EF10_EV_PER_CACHE_LINE - 1) /* max unused EvQ entries */ +
 519                 1 /* Rx error */ + 1 /* flush */ + 1 /* head-tail space */;
 520
 521         *evq_entries = rte_align32pow2(max_events);
 522         *evq_entries = RTE_MAX(*evq_entries, (unsigned int)EFX_EVQ_MINNEVS);
 523         *evq_entries = RTE_MIN(*evq_entries, (unsigned int)EFX_EVQ_MAXNEVS);
 524
 525         /*
 526          * May be even maximum event queue size is insufficient to handle
 527          * so many Rx descriptors. If so, we should limit Rx queue fill level.
 528          */
 529         *rxq_max_fill_level = RTE_MIN(nb_rx_desc,
 530                                       SFC_EF10_ESSB_RXQ_LIMIT(*evq_entries));
 531         return 0;
 532 }
 533
 534 static sfc_dp_rx_qcreate_t sfc_ef10_essb_rx_qcreate;
 535 static int
 536 sfc_ef10_essb_rx_qcreate(uint16_t port_id, uint16_t queue_id,
 537                          const struct rte_pci_addr *pci_addr, int socket_id,
 538                          const struct sfc_dp_rx_qcreate_info *info,
 539                          struct sfc_dp_rxq **dp_rxqp)
 540 {
 541         struct rte_mempool * const mp = info->refill_mb_pool;
 542         struct rte_mempool_info mp_info;
 543         struct sfc_ef10_essb_rxq *rxq;
 544         int rc;
 545
 546         rc = rte_mempool_ops_get_info(mp, &mp_info);
 547         if (rc != 0) {
 548                 /* Positive errno is used in the driver */
 549                 rc = -rc;
 550                 goto fail_get_contig_block_size;
 551         }
 552
 553         /* Check if the mempool provides block dequeue */
 554         rc = EINVAL;
 555         if (mp_info.contig_block_size == 0)
 556                 goto fail_no_block_dequeue;
 557
 558         rc = ENOMEM;
 559         rxq = rte_zmalloc_socket("sfc-ef10-rxq", sizeof(*rxq),
 560                                  RTE_CACHE_LINE_SIZE, socket_id);
 561         if (rxq == NULL)
 562                 goto fail_rxq_alloc;
 563
 564         sfc_dp_queue_init(&rxq->dp.dpq, port_id, queue_id, pci_addr);
 565
 566         rc = ENOMEM;
 567         rxq->sw_ring = rte_calloc_socket("sfc-ef10-rxq-sw_ring",
 568                                          info->rxq_entries,
 569                                          sizeof(*rxq->sw_ring),
 570                                          RTE_CACHE_LINE_SIZE, socket_id);
 571         if (rxq->sw_ring == NULL)
 572                 goto fail_desc_alloc;
 573
 574         rxq->block_size = mp_info.contig_block_size;
 575         rxq->buf_stride = mp->header_size + mp->elt_size + mp->trailer_size;
 576         rxq->rxq_ptr_mask = info->rxq_entries - 1;
 577         rxq->evq_ptr_mask = info->evq_entries - 1;
 578         rxq->evq_hw_ring = info->evq_hw_ring;
 579         rxq->port_id = port_id;
 580
 581         rxq->max_fill_level = info->max_fill_level / mp_info.contig_block_size;
 582         rxq->refill_threshold =
 583                 RTE_MAX(info->refill_threshold / mp_info.contig_block_size,
 584                         SFC_EF10_RX_WPTR_ALIGN);
 585         rxq->refill_mb_pool = mp;
 586         rxq->rxq_hw_ring = info->rxq_hw_ring;
 587
 588         rxq->doorbell = (volatile uint8_t *)info->mem_bar +
 589                         ER_DZ_RX_DESC_UPD_REG_OFST +
 590                         (info->hw_index << info->vi_window_shift);
 591
 592         sfc_ef10_essb_rx_info(&rxq->dp.dpq,
 593                               "block size is %u, buf stride is %u",
 594                               rxq->block_size, rxq->buf_stride);
 595         sfc_ef10_essb_rx_info(&rxq->dp.dpq,
 596                               "max fill level is %u descs (%u bufs), "
 597                               "refill threashold %u descs (%u bufs)",
 598                               rxq->max_fill_level,
 599                               rxq->max_fill_level * rxq->block_size,
 600                               rxq->refill_threshold,
 601                               rxq->refill_threshold * rxq->block_size);
 602
 603         *dp_rxqp = &rxq->dp;
 604         return 0;
 605
 606 fail_desc_alloc:
 607         rte_free(rxq);
 608
 609 fail_rxq_alloc:
 610 fail_no_block_dequeue:
 611 fail_get_contig_block_size:
 612         return rc;
 613 }
 614
 615 static sfc_dp_rx_qdestroy_t sfc_ef10_essb_rx_qdestroy;
 616 static void
 617 sfc_ef10_essb_rx_qdestroy(struct sfc_dp_rxq *dp_rxq)
 618 {
 619         struct sfc_ef10_essb_rxq *rxq = sfc_ef10_essb_rxq_by_dp_rxq(dp_rxq);
 620
 621         rte_free(rxq->sw_ring);
 622         rte_free(rxq);
 623 }
 624
 625 static sfc_dp_rx_qstart_t sfc_ef10_essb_rx_qstart;
 626 static int
 627 sfc_ef10_essb_rx_qstart(struct sfc_dp_rxq *dp_rxq, unsigned int evq_read_ptr)
 628 {
 629         struct sfc_ef10_essb_rxq *rxq = sfc_ef10_essb_rxq_by_dp_rxq(dp_rxq);
 630
 631         rxq->evq_read_ptr = evq_read_ptr;
 632
 633         /* Initialize before refill */
 634         rxq->completed = rxq->pending_id = rxq->added = 0;
 635         rxq->left_in_completed = rxq->left_in_pending = rxq->block_size;
 636         rxq->bufs_ptr = UINT_MAX;
 637         rxq->bufs_pending = 0;
 638
 639         sfc_ef10_essb_rx_qrefill(rxq);
 640
 641         rxq->flags |= SFC_EF10_ESSB_RXQ_STARTED;
 642         rxq->flags &=
 643                 ~(SFC_EF10_ESSB_RXQ_NOT_RUNNING | SFC_EF10_ESSB_RXQ_EXCEPTION);
 644
 645         return 0;
 646 }
 647
 648 static sfc_dp_rx_qstop_t sfc_ef10_essb_rx_qstop;
 649 static void
 650 sfc_ef10_essb_rx_qstop(struct sfc_dp_rxq *dp_rxq, unsigned int *evq_read_ptr)
 651 {
 652         struct sfc_ef10_essb_rxq *rxq = sfc_ef10_essb_rxq_by_dp_rxq(dp_rxq);
 653
 654         rxq->flags |= SFC_EF10_ESSB_RXQ_NOT_RUNNING;
 655
 656         *evq_read_ptr = rxq->evq_read_ptr;
 657 }
 658
 659 static sfc_dp_rx_qrx_ev_t sfc_ef10_essb_rx_qrx_ev;
 660 static bool
 661 sfc_ef10_essb_rx_qrx_ev(struct sfc_dp_rxq *dp_rxq, __rte_unused unsigned int id)
 662 {
 663         __rte_unused struct sfc_ef10_essb_rxq *rxq;
 664
 665         rxq = sfc_ef10_essb_rxq_by_dp_rxq(dp_rxq);
 666         SFC_ASSERT(rxq->flags & SFC_EF10_ESSB_RXQ_NOT_RUNNING);
 667
 668         /*
 669          * It is safe to ignore Rx event since we free all mbufs on
 670          * queue purge anyway.
 671          */
 672
 673         return false;
 674 }
 675
 676 static sfc_dp_rx_qpurge_t sfc_ef10_essb_rx_qpurge;
 677 static void
 678 sfc_ef10_essb_rx_qpurge(struct sfc_dp_rxq *dp_rxq)
 679 {
 680         struct sfc_ef10_essb_rxq *rxq = sfc_ef10_essb_rxq_by_dp_rxq(dp_rxq);
 681         unsigned int i;
 682         const struct sfc_ef10_essb_rx_sw_desc *rxd;
 683         struct rte_mbuf *m;
 684
 685         for (i = rxq->completed; i != rxq->added; ++i) {
 686                 rxd = &rxq->sw_ring[i & rxq->rxq_ptr_mask];
 687                 m = sfc_ef10_essb_mbuf_by_index(rxq, rxd->first_mbuf,
 688                                 rxq->block_size - rxq->left_in_completed);
 689                 while (rxq->left_in_completed > 0) {
 690                         rte_mempool_put(rxq->refill_mb_pool, m);
 691                         m = sfc_ef10_essb_next_mbuf(rxq, m);
 692                         rxq->left_in_completed--;
 693                 }
 694                 rxq->left_in_completed = rxq->block_size;
 695         }
 696
 697         rxq->flags &= ~SFC_EF10_ESSB_RXQ_STARTED;
 698 }
 699
 700 struct sfc_dp_rx sfc_ef10_essb_rx = {
 701         .dp = {
 702                 .name           = SFC_KVARG_DATAPATH_EF10_ESSB,
 703                 .type           = SFC_DP_RX,
 704                 .hw_fw_caps     = SFC_DP_HW_FW_CAP_EF10 |
 705                                   SFC_DP_HW_FW_CAP_RX_ES_SUPER_BUFFER,
 706         },
 707         .features               = SFC_DP_RX_FEAT_FLOW_FLAG |
 708                                   SFC_DP_RX_FEAT_FLOW_MARK |
 709                                   SFC_DP_RX_FEAT_CHECKSUM,
 710         .get_dev_info           = sfc_ef10_essb_rx_get_dev_info,
 711         .pool_ops_supported     = sfc_ef10_essb_rx_pool_ops_supported,
 712         .qsize_up_rings         = sfc_ef10_essb_rx_qsize_up_rings,
 713         .qcreate                = sfc_ef10_essb_rx_qcreate,
 714         .qdestroy               = sfc_ef10_essb_rx_qdestroy,
 715         .qstart                 = sfc_ef10_essb_rx_qstart,
 716         .qstop                  = sfc_ef10_essb_rx_qstop,
 717         .qrx_ev                 = sfc_ef10_essb_rx_qrx_ev,
 718         .qpurge                 = sfc_ef10_essb_rx_qpurge,
 719         .supported_ptypes_get   = sfc_ef10_supported_ptypes_get,
 720         .qdesc_npending         = sfc_ef10_essb_rx_qdesc_npending,
 721         .qdesc_status           = sfc_ef10_essb_rx_qdesc_status,
 722         .pkt_burst              = sfc_ef10_essb_recv_pkts,
 723 };