drivers/net/octeontx2/otx2_ethdev.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(C) 2019 Marvell International Ltd.
   3  */
   4
   5 #include <inttypes.h>
   6 #include <math.h>
   7
   8 #include <rte_ethdev_pci.h>
   9 #include <rte_io.h>
  10 #include <rte_malloc.h>
  11 #include <rte_mbuf.h>
  12 #include <rte_mbuf_pool_ops.h>
  13 #include <rte_mempool.h>
  14
  15 #include "otx2_ethdev.h"
  16
  17 static inline void
  18 otx2_eth_set_rx_function(struct rte_eth_dev *eth_dev)
  19 {
  20         RTE_SET_USED(eth_dev);
  21 }
  22
  23 static inline void
  24 otx2_eth_set_tx_function(struct rte_eth_dev *eth_dev)
  25 {
  26         RTE_SET_USED(eth_dev);
  27 }
  28
  29 static inline uint64_t
  30 nix_get_rx_offload_capa(struct otx2_eth_dev *dev)
  31 {
  32         uint64_t capa = NIX_RX_OFFLOAD_CAPA;
  33
  34         if (otx2_dev_is_vf(dev))
  35                 capa &= ~DEV_RX_OFFLOAD_TIMESTAMP;
  36
  37         return capa;
  38 }
  39
  40 static inline uint64_t
  41 nix_get_tx_offload_capa(struct otx2_eth_dev *dev)
  42 {
  43         RTE_SET_USED(dev);
  44
  45         return NIX_TX_OFFLOAD_CAPA;
  46 }
  47
  48 static const struct otx2_dev_ops otx2_dev_ops = {
  49         .link_status_update = otx2_eth_dev_link_status_update,
  50 };
  51
  52 static int
  53 nix_lf_alloc(struct otx2_eth_dev *dev, uint32_t nb_rxq, uint32_t nb_txq)
  54 {
  55         struct otx2_mbox *mbox = dev->mbox;
  56         struct nix_lf_alloc_req *req;
  57         struct nix_lf_alloc_rsp *rsp;
  58         int rc;
  59
  60         req = otx2_mbox_alloc_msg_nix_lf_alloc(mbox);
  61         req->rq_cnt = nb_rxq;
  62         req->sq_cnt = nb_txq;
  63         req->cq_cnt = nb_rxq;
  64         /* XQE_SZ should be in Sync with NIX_CQ_ENTRY_SZ */
  65         RTE_BUILD_BUG_ON(NIX_CQ_ENTRY_SZ != 128);
  66         req->xqe_sz = NIX_XQESZ_W16;
  67         req->rss_sz = dev->rss_info.rss_size;
  68         req->rss_grps = NIX_RSS_GRPS;
  69         req->npa_func = otx2_npa_pf_func_get();
  70         req->sso_func = otx2_sso_pf_func_get();
  71         req->rx_cfg = BIT_ULL(35 /* DIS_APAD */);
  72         if (dev->rx_offloads & (DEV_RX_OFFLOAD_TCP_CKSUM |
  73                          DEV_RX_OFFLOAD_UDP_CKSUM)) {
  74                 req->rx_cfg |= BIT_ULL(37 /* CSUM_OL4 */);
  75                 req->rx_cfg |= BIT_ULL(36 /* CSUM_IL4 */);
  76         }
  77
  78         rc = otx2_mbox_process_msg(mbox, (void *)&rsp);
  79         if (rc)
  80                 return rc;
  81
  82         dev->sqb_size = rsp->sqb_size;
  83         dev->tx_chan_base = rsp->tx_chan_base;
  84         dev->rx_chan_base = rsp->rx_chan_base;
  85         dev->rx_chan_cnt = rsp->rx_chan_cnt;
  86         dev->tx_chan_cnt = rsp->tx_chan_cnt;
  87         dev->lso_tsov4_idx = rsp->lso_tsov4_idx;
  88         dev->lso_tsov6_idx = rsp->lso_tsov6_idx;
  89         dev->lf_tx_stats = rsp->lf_tx_stats;
  90         dev->lf_rx_stats = rsp->lf_rx_stats;
  91         dev->cints = rsp->cints;
  92         dev->qints = rsp->qints;
  93         dev->npc_flow.channel = dev->rx_chan_base;
  94
  95         return 0;
  96 }
  97
  98 static int
  99 nix_lf_free(struct otx2_eth_dev *dev)
 100 {
 101         struct otx2_mbox *mbox = dev->mbox;
 102         struct nix_lf_free_req *req;
 103         struct ndc_sync_op *ndc_req;
 104         int rc;
 105
 106         /* Sync NDC-NIX for LF */
 107         ndc_req = otx2_mbox_alloc_msg_ndc_sync_op(mbox);
 108         ndc_req->nix_lf_tx_sync = 1;
 109         ndc_req->nix_lf_rx_sync = 1;
 110         rc = otx2_mbox_process(mbox);
 111         if (rc)
 112                 otx2_err("Error on NDC-NIX-[TX, RX] LF sync, rc %d", rc);
 113
 114         req = otx2_mbox_alloc_msg_nix_lf_free(mbox);
 115         /* Let AF driver free all this nix lf's
 116          * NPC entries allocated using NPC MBOX.
 117          */
 118         req->flags = 0;
 119
 120         return otx2_mbox_process(mbox);
 121 }
 122
 123 static inline void
 124 nix_rx_queue_reset(struct otx2_eth_rxq *rxq)
 125 {
 126         rxq->head = 0;
 127         rxq->available = 0;
 128 }
 129
 130 static inline uint32_t
 131 nix_qsize_to_val(enum nix_q_size_e qsize)
 132 {
 133         return (16UL << (qsize * 2));
 134 }
 135
 136 static inline enum nix_q_size_e
 137 nix_qsize_clampup_get(struct otx2_eth_dev *dev, uint32_t val)
 138 {
 139         int i;
 140
 141         if (otx2_ethdev_fixup_is_min_4k_q(dev))
 142                 i = nix_q_size_4K;
 143         else
 144                 i = nix_q_size_16;
 145
 146         for (; i < nix_q_size_max; i++)
 147                 if (val <= nix_qsize_to_val(i))
 148                         break;
 149
 150         if (i >= nix_q_size_max)
 151                 i = nix_q_size_max - 1;
 152
 153         return i;
 154 }
 155
 156 static int
 157 nix_cq_rq_init(struct rte_eth_dev *eth_dev, struct otx2_eth_dev *dev,
 158                uint16_t qid, struct otx2_eth_rxq *rxq, struct rte_mempool *mp)
 159 {
 160         struct otx2_mbox *mbox = dev->mbox;
 161         const struct rte_memzone *rz;
 162         uint32_t ring_size, cq_size;
 163         struct nix_aq_enq_req *aq;
 164         uint16_t first_skip;
 165         int rc;
 166
 167         cq_size = rxq->qlen;
 168         ring_size = cq_size * NIX_CQ_ENTRY_SZ;
 169         rz = rte_eth_dma_zone_reserve(eth_dev, "cq", qid, ring_size,
 170                                       NIX_CQ_ALIGN, dev->node);
 171         if (rz == NULL) {
 172                 otx2_err("Failed to allocate mem for cq hw ring");
 173                 rc = -ENOMEM;
 174                 goto fail;
 175         }
 176         memset(rz->addr, 0, rz->len);
 177         rxq->desc = (uintptr_t)rz->addr;
 178         rxq->qmask = cq_size - 1;
 179
 180         aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
 181         aq->qidx = qid;
 182         aq->ctype = NIX_AQ_CTYPE_CQ;
 183         aq->op = NIX_AQ_INSTOP_INIT;
 184
 185         aq->cq.ena = 1;
 186         aq->cq.caching = 1;
 187         aq->cq.qsize = rxq->qsize;
 188         aq->cq.base = rz->iova;
 189         aq->cq.avg_level = 0xff;
 190         aq->cq.cq_err_int_ena = BIT(NIX_CQERRINT_CQE_FAULT);
 191         aq->cq.cq_err_int_ena |= BIT(NIX_CQERRINT_DOOR_ERR);
 192
 193         /* Many to one reduction */
 194         aq->cq.qint_idx = qid % dev->qints;
 195
 196         if (otx2_ethdev_fixup_is_limit_cq_full(dev)) {
 197                 uint16_t min_rx_drop;
 198                 const float rx_cq_skid = 1024 * 256;
 199
 200                 min_rx_drop = ceil(rx_cq_skid / (float)cq_size);
 201                 aq->cq.drop = min_rx_drop;
 202                 aq->cq.drop_ena = 1;
 203         }
 204
 205         rc = otx2_mbox_process(mbox);
 206         if (rc) {
 207                 otx2_err("Failed to init cq context");
 208                 goto fail;
 209         }
 210
 211         aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
 212         aq->qidx = qid;
 213         aq->ctype = NIX_AQ_CTYPE_RQ;
 214         aq->op = NIX_AQ_INSTOP_INIT;
 215
 216         aq->rq.sso_ena = 0;
 217         aq->rq.cq = qid; /* RQ to CQ 1:1 mapped */
 218         aq->rq.spb_ena = 0;
 219         aq->rq.lpb_aura = npa_lf_aura_handle_to_aura(mp->pool_id);
 220         first_skip = (sizeof(struct rte_mbuf));
 221         first_skip += RTE_PKTMBUF_HEADROOM;
 222         first_skip += rte_pktmbuf_priv_size(mp);
 223         rxq->data_off = first_skip;
 224
 225         first_skip /= 8; /* Expressed in number of dwords */
 226         aq->rq.first_skip = first_skip;
 227         aq->rq.later_skip = (sizeof(struct rte_mbuf) / 8);
 228         aq->rq.flow_tagw = 32; /* 32-bits */
 229         aq->rq.lpb_sizem1 = rte_pktmbuf_data_room_size(mp);
 230         aq->rq.lpb_sizem1 += rte_pktmbuf_priv_size(mp);
 231         aq->rq.lpb_sizem1 += sizeof(struct rte_mbuf);
 232         aq->rq.lpb_sizem1 /= 8;
 233         aq->rq.lpb_sizem1 -= 1; /* Expressed in size minus one */
 234         aq->rq.ena = 1;
 235         aq->rq.pb_caching = 0x2; /* First cache aligned block to LLC */
 236         aq->rq.xqe_imm_size = 0; /* No pkt data copy to CQE */
 237         aq->rq.rq_int_ena = 0;
 238         /* Many to one reduction */
 239         aq->rq.qint_idx = qid % dev->qints;
 240
 241         if (otx2_ethdev_fixup_is_limit_cq_full(dev))
 242                 aq->rq.xqe_drop_ena = 1;
 243
 244         rc = otx2_mbox_process(mbox);
 245         if (rc) {
 246                 otx2_err("Failed to init rq context");
 247                 goto fail;
 248         }
 249
 250         return 0;
 251 fail:
 252         return rc;
 253 }
 254
 255 static int
 256 nix_rq_enb_dis(struct rte_eth_dev *eth_dev,
 257                struct otx2_eth_rxq *rxq, const bool enb)
 258 {
 259         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
 260         struct otx2_mbox *mbox = dev->mbox;
 261         struct nix_aq_enq_req *aq;
 262
 263         /* Pkts will be dropped silently if RQ is disabled */
 264         aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
 265         aq->qidx = rxq->rq;
 266         aq->ctype = NIX_AQ_CTYPE_RQ;
 267         aq->op = NIX_AQ_INSTOP_WRITE;
 268
 269         aq->rq.ena = enb;
 270         aq->rq_mask.ena = ~(aq->rq_mask.ena);
 271
 272         return otx2_mbox_process(mbox);
 273 }
 274
 275 static int
 276 nix_cq_rq_uninit(struct rte_eth_dev *eth_dev, struct otx2_eth_rxq *rxq)
 277 {
 278         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
 279         struct otx2_mbox *mbox = dev->mbox;
 280         struct nix_aq_enq_req *aq;
 281         int rc;
 282
 283         /* RQ is already disabled */
 284         /* Disable CQ */
 285         aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
 286         aq->qidx = rxq->rq;
 287         aq->ctype = NIX_AQ_CTYPE_CQ;
 288         aq->op = NIX_AQ_INSTOP_WRITE;
 289
 290         aq->cq.ena = 0;
 291         aq->cq_mask.ena = ~(aq->cq_mask.ena);
 292
 293         rc = otx2_mbox_process(mbox);
 294         if (rc < 0) {
 295                 otx2_err("Failed to disable cq context");
 296                 return rc;
 297         }
 298
 299         return 0;
 300 }
 301
 302 static inline int
 303 nix_get_data_off(struct otx2_eth_dev *dev)
 304 {
 305         RTE_SET_USED(dev);
 306
 307         return 0;
 308 }
 309
 310 uint64_t
 311 otx2_nix_rxq_mbuf_setup(struct otx2_eth_dev *dev, uint16_t port_id)
 312 {
 313         struct rte_mbuf mb_def;
 314         uint64_t *tmp;
 315
 316         RTE_BUILD_BUG_ON(offsetof(struct rte_mbuf, data_off) % 8 != 0);
 317         RTE_BUILD_BUG_ON(offsetof(struct rte_mbuf, refcnt) -
 318                                 offsetof(struct rte_mbuf, data_off) != 2);
 319         RTE_BUILD_BUG_ON(offsetof(struct rte_mbuf, nb_segs) -
 320                                 offsetof(struct rte_mbuf, data_off) != 4);
 321         RTE_BUILD_BUG_ON(offsetof(struct rte_mbuf, port) -
 322                                 offsetof(struct rte_mbuf, data_off) != 6);
 323         mb_def.nb_segs = 1;
 324         mb_def.data_off = RTE_PKTMBUF_HEADROOM + nix_get_data_off(dev);
 325         mb_def.port = port_id;
 326         rte_mbuf_refcnt_set(&mb_def, 1);
 327
 328         /* Prevent compiler reordering: rearm_data covers previous fields */
 329         rte_compiler_barrier();
 330         tmp = (uint64_t *)&mb_def.rearm_data;
 331
 332         return *tmp;
 333 }
 334
 335 static void
 336 otx2_nix_rx_queue_release(void *rx_queue)
 337 {
 338         struct otx2_eth_rxq *rxq = rx_queue;
 339
 340         if (!rxq)
 341                 return;
 342
 343         otx2_nix_dbg("Releasing rxq %u", rxq->rq);
 344         nix_cq_rq_uninit(rxq->eth_dev, rxq);
 345         rte_free(rx_queue);
 346 }
 347
 348 static int
 349 otx2_nix_rx_queue_setup(struct rte_eth_dev *eth_dev, uint16_t rq,
 350                         uint16_t nb_desc, unsigned int socket,
 351                         const struct rte_eth_rxconf *rx_conf,
 352                         struct rte_mempool *mp)
 353 {
 354         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
 355         struct rte_mempool_ops *ops;
 356         struct otx2_eth_rxq *rxq;
 357         const char *platform_ops;
 358         enum nix_q_size_e qsize;
 359         uint64_t offloads;
 360         int rc;
 361
 362         rc = -EINVAL;
 363
 364         /* Compile time check to make sure all fast path elements in a CL */
 365         RTE_BUILD_BUG_ON(offsetof(struct otx2_eth_rxq, slow_path_start) >= 128);
 366
 367         /* Sanity checks */
 368         if (rx_conf->rx_deferred_start == 1) {
 369                 otx2_err("Deferred Rx start is not supported");
 370                 goto fail;
 371         }
 372
 373         platform_ops = rte_mbuf_platform_mempool_ops();
 374         /* This driver needs octeontx2_npa mempool ops to work */
 375         ops = rte_mempool_get_ops(mp->ops_index);
 376         if (strncmp(ops->name, platform_ops, RTE_MEMPOOL_OPS_NAMESIZE)) {
 377                 otx2_err("mempool ops should be of octeontx2_npa type");
 378                 goto fail;
 379         }
 380
 381         if (mp->pool_id == 0) {
 382                 otx2_err("Invalid pool_id");
 383                 goto fail;
 384         }
 385
 386         /* Free memory prior to re-allocation if needed */
 387         if (eth_dev->data->rx_queues[rq] != NULL) {
 388                 otx2_nix_dbg("Freeing memory prior to re-allocation %d", rq);
 389                 otx2_nix_rx_queue_release(eth_dev->data->rx_queues[rq]);
 390                 eth_dev->data->rx_queues[rq] = NULL;
 391         }
 392
 393         offloads = rx_conf->offloads | eth_dev->data->dev_conf.rxmode.offloads;
 394         dev->rx_offloads |= offloads;
 395
 396         /* Find the CQ queue size */
 397         qsize = nix_qsize_clampup_get(dev, nb_desc);
 398         /* Allocate rxq memory */
 399         rxq = rte_zmalloc_socket("otx2 rxq", sizeof(*rxq), OTX2_ALIGN, socket);
 400         if (rxq == NULL) {
 401                 otx2_err("Failed to allocate rq=%d", rq);
 402                 rc = -ENOMEM;
 403                 goto fail;
 404         }
 405
 406         rxq->eth_dev = eth_dev;
 407         rxq->rq = rq;
 408         rxq->cq_door = dev->base + NIX_LF_CQ_OP_DOOR;
 409         rxq->cq_status = (int64_t *)(dev->base + NIX_LF_CQ_OP_STATUS);
 410         rxq->wdata = (uint64_t)rq << 32;
 411         rxq->aura = npa_lf_aura_handle_to_aura(mp->pool_id);
 412         rxq->mbuf_initializer = otx2_nix_rxq_mbuf_setup(dev,
 413                                                         eth_dev->data->port_id);
 414         rxq->offloads = offloads;
 415         rxq->pool = mp;
 416         rxq->qlen = nix_qsize_to_val(qsize);
 417         rxq->qsize = qsize;
 418
 419         /* Alloc completion queue */
 420         rc = nix_cq_rq_init(eth_dev, dev, rq, rxq, mp);
 421         if (rc) {
 422                 otx2_err("Failed to allocate rxq=%u", rq);
 423                 goto free_rxq;
 424         }
 425
 426         rxq->qconf.socket_id = socket;
 427         rxq->qconf.nb_desc = nb_desc;
 428         rxq->qconf.mempool = mp;
 429         memcpy(&rxq->qconf.conf.rx, rx_conf, sizeof(struct rte_eth_rxconf));
 430
 431         nix_rx_queue_reset(rxq);
 432         otx2_nix_dbg("rq=%d pool=%s qsize=%d nb_desc=%d->%d",
 433                      rq, mp->name, qsize, nb_desc, rxq->qlen);
 434
 435         eth_dev->data->rx_queues[rq] = rxq;
 436         eth_dev->data->rx_queue_state[rq] = RTE_ETH_QUEUE_STATE_STOPPED;
 437         return 0;
 438
 439 free_rxq:
 440         otx2_nix_rx_queue_release(rxq);
 441 fail:
 442         return rc;
 443 }
 444
 445 static inline uint8_t
 446 nix_sq_max_sqe_sz(struct otx2_eth_txq *txq)
 447 {
 448         /*
 449          * Maximum three segments can be supported with W8, Choose
 450          * NIX_MAXSQESZ_W16 for multi segment offload.
 451          */
 452         if (txq->offloads & DEV_TX_OFFLOAD_MULTI_SEGS)
 453                 return NIX_MAXSQESZ_W16;
 454         else
 455                 return NIX_MAXSQESZ_W8;
 456 }
 457
 458 static int
 459 nix_sq_init(struct otx2_eth_txq *txq)
 460 {
 461         struct otx2_eth_dev *dev = txq->dev;
 462         struct otx2_mbox *mbox = dev->mbox;
 463         struct nix_aq_enq_req *sq;
 464
 465         if (txq->sqb_pool->pool_id == 0)
 466                 return -EINVAL;
 467
 468         sq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
 469         sq->qidx = txq->sq;
 470         sq->ctype = NIX_AQ_CTYPE_SQ;
 471         sq->op = NIX_AQ_INSTOP_INIT;
 472         sq->sq.max_sqe_size = nix_sq_max_sqe_sz(txq);
 473
 474         sq->sq.default_chan = dev->tx_chan_base;
 475         sq->sq.sqe_stype = NIX_STYPE_STF;
 476         sq->sq.ena = 1;
 477         if (sq->sq.max_sqe_size == NIX_MAXSQESZ_W8)
 478                 sq->sq.sqe_stype = NIX_STYPE_STP;
 479         sq->sq.sqb_aura =
 480                 npa_lf_aura_handle_to_aura(txq->sqb_pool->pool_id);
 481         sq->sq.sq_int_ena = BIT(NIX_SQINT_LMT_ERR);
 482         sq->sq.sq_int_ena |= BIT(NIX_SQINT_SQB_ALLOC_FAIL);
 483         sq->sq.sq_int_ena |= BIT(NIX_SQINT_SEND_ERR);
 484         sq->sq.sq_int_ena |= BIT(NIX_SQINT_MNQ_ERR);
 485
 486         /* Many to one reduction */
 487         sq->sq.qint_idx = txq->sq % dev->qints;
 488
 489         return otx2_mbox_process(mbox);
 490 }
 491
 492 static int
 493 nix_sq_uninit(struct otx2_eth_txq *txq)
 494 {
 495         struct otx2_eth_dev *dev = txq->dev;
 496         struct otx2_mbox *mbox = dev->mbox;
 497         struct ndc_sync_op *ndc_req;
 498         struct nix_aq_enq_rsp *rsp;
 499         struct nix_aq_enq_req *aq;
 500         uint16_t sqes_per_sqb;
 501         void *sqb_buf;
 502         int rc, count;
 503
 504         otx2_nix_dbg("Cleaning up sq %u", txq->sq);
 505
 506         aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
 507         aq->qidx = txq->sq;
 508         aq->ctype = NIX_AQ_CTYPE_SQ;
 509         aq->op = NIX_AQ_INSTOP_READ;
 510
 511         rc = otx2_mbox_process_msg(mbox, (void *)&rsp);
 512         if (rc)
 513                 return rc;
 514
 515         /* Check if sq is already cleaned up */
 516         if (!rsp->sq.ena)
 517                 return 0;
 518
 519         /* Disable sq */
 520         aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
 521         aq->qidx = txq->sq;
 522         aq->ctype = NIX_AQ_CTYPE_SQ;
 523         aq->op = NIX_AQ_INSTOP_WRITE;
 524
 525         aq->sq_mask.ena = ~aq->sq_mask.ena;
 526         aq->sq.ena = 0;
 527
 528         rc = otx2_mbox_process(mbox);
 529         if (rc)
 530                 return rc;
 531
 532         /* Read SQ and free sqb's */
 533         aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
 534         aq->qidx = txq->sq;
 535         aq->ctype = NIX_AQ_CTYPE_SQ;
 536         aq->op = NIX_AQ_INSTOP_READ;
 537
 538         rc = otx2_mbox_process_msg(mbox, (void *)&rsp);
 539         if (rc)
 540                 return rc;
 541
 542         if (aq->sq.smq_pend)
 543                 otx2_err("SQ has pending sqe's");
 544
 545         count = aq->sq.sqb_count;
 546         sqes_per_sqb = 1 << txq->sqes_per_sqb_log2;
 547         /* Free SQB's that are used */
 548         sqb_buf = (void *)rsp->sq.head_sqb;
 549         while (count) {
 550                 void *next_sqb;
 551
 552                 next_sqb = *(void **)((uintptr_t)sqb_buf + ((sqes_per_sqb - 1) *
 553                                       nix_sq_max_sqe_sz(txq)));
 554                 npa_lf_aura_op_free(txq->sqb_pool->pool_id, 1,
 555                                     (uint64_t)sqb_buf);
 556                 sqb_buf = next_sqb;
 557                 count--;
 558         }
 559
 560         /* Free next to use sqb */
 561         if (rsp->sq.next_sqb)
 562                 npa_lf_aura_op_free(txq->sqb_pool->pool_id, 1,
 563                                     rsp->sq.next_sqb);
 564
 565         /* Sync NDC-NIX-TX for LF */
 566         ndc_req = otx2_mbox_alloc_msg_ndc_sync_op(mbox);
 567         ndc_req->nix_lf_tx_sync = 1;
 568         rc = otx2_mbox_process(mbox);
 569         if (rc)
 570                 otx2_err("Error on NDC-NIX-TX LF sync, rc %d", rc);
 571
 572         return rc;
 573 }
 574
 575 static int
 576 nix_sqb_aura_limit_cfg(struct rte_mempool *mp, uint16_t nb_sqb_bufs)
 577 {
 578         struct otx2_npa_lf *npa_lf = otx2_intra_dev_get_cfg()->npa_lf;
 579         struct npa_aq_enq_req *aura_req;
 580
 581         aura_req = otx2_mbox_alloc_msg_npa_aq_enq(npa_lf->mbox);
 582         aura_req->aura_id = npa_lf_aura_handle_to_aura(mp->pool_id);
 583         aura_req->ctype = NPA_AQ_CTYPE_AURA;
 584         aura_req->op = NPA_AQ_INSTOP_WRITE;
 585
 586         aura_req->aura.limit = nb_sqb_bufs;
 587         aura_req->aura_mask.limit = ~(aura_req->aura_mask.limit);
 588
 589         return otx2_mbox_process(npa_lf->mbox);
 590 }
 591
 592 static int
 593 nix_alloc_sqb_pool(int port, struct otx2_eth_txq *txq, uint16_t nb_desc)
 594 {
 595         struct otx2_eth_dev *dev = txq->dev;
 596         uint16_t sqes_per_sqb, nb_sqb_bufs;
 597         char name[RTE_MEMPOOL_NAMESIZE];
 598         struct rte_mempool_objsz sz;
 599         struct npa_aura_s *aura;
 600         uint32_t tmp, blk_sz;
 601
 602         aura = (struct npa_aura_s *)((uintptr_t)txq->fc_mem + OTX2_ALIGN);
 603         snprintf(name, sizeof(name), "otx2_sqb_pool_%d_%d", port, txq->sq);
 604         blk_sz = dev->sqb_size;
 605
 606         if (nix_sq_max_sqe_sz(txq) == NIX_MAXSQESZ_W16)
 607                 sqes_per_sqb = (dev->sqb_size / 8) / 16;
 608         else
 609                 sqes_per_sqb = (dev->sqb_size / 8) / 8;
 610
 611         nb_sqb_bufs = nb_desc / sqes_per_sqb;
 612         /* Clamp up to devarg passed SQB count */
 613         nb_sqb_bufs =  RTE_MIN(dev->max_sqb_count, RTE_MAX(NIX_MIN_SQB,
 614                               nb_sqb_bufs + NIX_SQB_LIST_SPACE));
 615
 616         txq->sqb_pool = rte_mempool_create_empty(name, NIX_MAX_SQB, blk_sz,
 617                                                  0, 0, dev->node,
 618                                                  MEMPOOL_F_NO_SPREAD);
 619         txq->nb_sqb_bufs = nb_sqb_bufs;
 620         txq->sqes_per_sqb_log2 = (uint16_t)rte_log2_u32(sqes_per_sqb);
 621         txq->nb_sqb_bufs_adj = nb_sqb_bufs -
 622                 RTE_ALIGN_MUL_CEIL(nb_sqb_bufs, sqes_per_sqb) / sqes_per_sqb;
 623         txq->nb_sqb_bufs_adj =
 624                 (NIX_SQB_LOWER_THRESH * txq->nb_sqb_bufs_adj) / 100;
 625
 626         if (txq->sqb_pool == NULL) {
 627                 otx2_err("Failed to allocate sqe mempool");
 628                 goto fail;
 629         }
 630
 631         memset(aura, 0, sizeof(*aura));
 632         aura->fc_ena = 1;
 633         aura->fc_addr = txq->fc_iova;
 634         aura->fc_hyst_bits = 0; /* Store count on all updates */
 635         if (rte_mempool_set_ops_byname(txq->sqb_pool, "octeontx2_npa", aura)) {
 636                 otx2_err("Failed to set ops for sqe mempool");
 637                 goto fail;
 638         }
 639         if (rte_mempool_populate_default(txq->sqb_pool) < 0) {
 640                 otx2_err("Failed to populate sqe mempool");
 641                 goto fail;
 642         }
 643
 644         tmp = rte_mempool_calc_obj_size(blk_sz, MEMPOOL_F_NO_SPREAD, &sz);
 645         if (dev->sqb_size != sz.elt_size) {
 646                 otx2_err("sqe pool block size is not expected %d != %d",
 647                          dev->sqb_size, tmp);
 648                 goto fail;
 649         }
 650
 651         nix_sqb_aura_limit_cfg(txq->sqb_pool, txq->nb_sqb_bufs);
 652
 653         return 0;
 654 fail:
 655         return -ENOMEM;
 656 }
 657
 658 void
 659 otx2_nix_form_default_desc(struct otx2_eth_txq *txq)
 660 {
 661         struct nix_send_ext_s *send_hdr_ext;
 662         struct nix_send_hdr_s *send_hdr;
 663         struct nix_send_mem_s *send_mem;
 664         union nix_send_sg_s *sg;
 665
 666         /* Initialize the fields based on basic single segment packet */
 667         memset(&txq->cmd, 0, sizeof(txq->cmd));
 668
 669         if (txq->dev->tx_offload_flags & NIX_TX_NEED_EXT_HDR) {
 670                 send_hdr = (struct nix_send_hdr_s *)&txq->cmd[0];
 671                 /* 2(HDR) + 2(EXT_HDR) + 1(SG) + 1(IOVA) = 6/2 - 1 = 2 */
 672                 send_hdr->w0.sizem1 = 2;
 673
 674                 send_hdr_ext = (struct nix_send_ext_s *)&txq->cmd[2];
 675                 send_hdr_ext->w0.subdc = NIX_SUBDC_EXT;
 676                 if (txq->dev->tx_offload_flags & NIX_TX_OFFLOAD_TSTAMP_F) {
 677                         /* Default: one seg packet would have:
 678                          * 2(HDR) + 2(EXT) + 1(SG) + 1(IOVA) + 2(MEM)
 679                          * => 8/2 - 1 = 3
 680                          */
 681                         send_hdr->w0.sizem1 = 3;
 682                         send_hdr_ext->w0.tstmp = 1;
 683
 684                         /* To calculate the offset for send_mem,
 685                          * send_hdr->w0.sizem1 * 2
 686                          */
 687                         send_mem = (struct nix_send_mem_s *)(txq->cmd +
 688                                                 (send_hdr->w0.sizem1 << 1));
 689                         send_mem->subdc = NIX_SUBDC_MEM;
 690                         send_mem->dsz = 0x0;
 691                         send_mem->wmem = 0x1;
 692                         send_mem->alg = NIX_SENDMEMALG_SETTSTMP;
 693                 }
 694                 sg = (union nix_send_sg_s *)&txq->cmd[4];
 695         } else {
 696                 send_hdr = (struct nix_send_hdr_s *)&txq->cmd[0];
 697                 /* 2(HDR) + 1(SG) + 1(IOVA) = 4/2 - 1 = 1 */
 698                 send_hdr->w0.sizem1 = 1;
 699                 sg = (union nix_send_sg_s *)&txq->cmd[2];
 700         }
 701
 702         send_hdr->w0.sq = txq->sq;
 703         sg->subdc = NIX_SUBDC_SG;
 704         sg->segs = 1;
 705         sg->ld_type = NIX_SENDLDTYPE_LDD;
 706
 707         rte_smp_wmb();
 708 }
 709
 710 static void
 711 otx2_nix_tx_queue_release(void *_txq)
 712 {
 713         struct otx2_eth_txq *txq = _txq;
 714
 715         if (!txq)
 716                 return;
 717
 718         otx2_nix_dbg("Releasing txq %u", txq->sq);
 719
 720         /* Free sqb's and disable sq */
 721         nix_sq_uninit(txq);
 722
 723         if (txq->sqb_pool) {
 724                 rte_mempool_free(txq->sqb_pool);
 725                 txq->sqb_pool = NULL;
 726         }
 727         rte_free(txq);
 728 }
 729
 730
 731 static int
 732 otx2_nix_tx_queue_setup(struct rte_eth_dev *eth_dev, uint16_t sq,
 733                         uint16_t nb_desc, unsigned int socket_id,
 734                         const struct rte_eth_txconf *tx_conf)
 735 {
 736         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
 737         const struct rte_memzone *fc;
 738         struct otx2_eth_txq *txq;
 739         uint64_t offloads;
 740         int rc;
 741
 742         rc = -EINVAL;
 743
 744         /* Compile time check to make sure all fast path elements in a CL */
 745         RTE_BUILD_BUG_ON(offsetof(struct otx2_eth_txq, slow_path_start) >= 128);
 746
 747         if (tx_conf->tx_deferred_start) {
 748                 otx2_err("Tx deferred start is not supported");
 749                 goto fail;
 750         }
 751
 752         /* Free memory prior to re-allocation if needed. */
 753         if (eth_dev->data->tx_queues[sq] != NULL) {
 754                 otx2_nix_dbg("Freeing memory prior to re-allocation %d", sq);
 755                 otx2_nix_tx_queue_release(eth_dev->data->tx_queues[sq]);
 756                 eth_dev->data->tx_queues[sq] = NULL;
 757         }
 758
 759         /* Find the expected offloads for this queue */
 760         offloads = tx_conf->offloads | eth_dev->data->dev_conf.txmode.offloads;
 761
 762         /* Allocating tx queue data structure */
 763         txq = rte_zmalloc_socket("otx2_ethdev TX queue", sizeof(*txq),
 764                                  OTX2_ALIGN, socket_id);
 765         if (txq == NULL) {
 766                 otx2_err("Failed to alloc txq=%d", sq);
 767                 rc = -ENOMEM;
 768                 goto fail;
 769         }
 770         txq->sq = sq;
 771         txq->dev = dev;
 772         txq->sqb_pool = NULL;
 773         txq->offloads = offloads;
 774         dev->tx_offloads |= offloads;
 775
 776         /*
 777          * Allocate memory for flow control updates from HW.
 778          * Alloc one cache line, so that fits all FC_STYPE modes.
 779          */
 780         fc = rte_eth_dma_zone_reserve(eth_dev, "fcmem", sq,
 781                                       OTX2_ALIGN + sizeof(struct npa_aura_s),
 782                                       OTX2_ALIGN, dev->node);
 783         if (fc == NULL) {
 784                 otx2_err("Failed to allocate mem for fcmem");
 785                 rc = -ENOMEM;
 786                 goto free_txq;
 787         }
 788         txq->fc_iova = fc->iova;
 789         txq->fc_mem = fc->addr;
 790
 791         /* Initialize the aura sqb pool */
 792         rc = nix_alloc_sqb_pool(eth_dev->data->port_id, txq, nb_desc);
 793         if (rc) {
 794                 otx2_err("Failed to alloc sqe pool rc=%d", rc);
 795                 goto free_txq;
 796         }
 797
 798         /* Initialize the SQ */
 799         rc = nix_sq_init(txq);
 800         if (rc) {
 801                 otx2_err("Failed to init sq=%d context", sq);
 802                 goto free_txq;
 803         }
 804
 805         txq->fc_cache_pkts = 0;
 806         txq->io_addr = dev->base + NIX_LF_OP_SENDX(0);
 807         /* Evenly distribute LMT slot for each sq */
 808         txq->lmt_addr = (void *)(dev->lmt_addr + ((sq & LMT_SLOT_MASK) << 12));
 809
 810         txq->qconf.socket_id = socket_id;
 811         txq->qconf.nb_desc = nb_desc;
 812         memcpy(&txq->qconf.conf.tx, tx_conf, sizeof(struct rte_eth_txconf));
 813
 814         otx2_nix_form_default_desc(txq);
 815
 816         otx2_nix_dbg("sq=%d fc=%p offload=0x%" PRIx64 " sqb=0x%" PRIx64 ""
 817                      " lmt_addr=%p nb_sqb_bufs=%d sqes_per_sqb_log2=%d", sq,
 818                      fc->addr, offloads, txq->sqb_pool->pool_id, txq->lmt_addr,
 819                      txq->nb_sqb_bufs, txq->sqes_per_sqb_log2);
 820         eth_dev->data->tx_queues[sq] = txq;
 821         eth_dev->data->tx_queue_state[sq] = RTE_ETH_QUEUE_STATE_STOPPED;
 822         return 0;
 823
 824 free_txq:
 825         otx2_nix_tx_queue_release(txq);
 826 fail:
 827         return rc;
 828 }
 829
 830 static int
 831 nix_store_queue_cfg_and_then_release(struct rte_eth_dev *eth_dev)
 832 {
 833         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
 834         struct otx2_eth_qconf *tx_qconf = NULL;
 835         struct otx2_eth_qconf *rx_qconf = NULL;
 836         struct otx2_eth_txq **txq;
 837         struct otx2_eth_rxq **rxq;
 838         int i, nb_rxq, nb_txq;
 839
 840         nb_rxq = RTE_MIN(dev->configured_nb_rx_qs, eth_dev->data->nb_rx_queues);
 841         nb_txq = RTE_MIN(dev->configured_nb_tx_qs, eth_dev->data->nb_tx_queues);
 842
 843         tx_qconf = malloc(nb_txq * sizeof(*tx_qconf));
 844         if (tx_qconf == NULL) {
 845                 otx2_err("Failed to allocate memory for tx_qconf");
 846                 goto fail;
 847         }
 848
 849         rx_qconf = malloc(nb_rxq * sizeof(*rx_qconf));
 850         if (rx_qconf == NULL) {
 851                 otx2_err("Failed to allocate memory for rx_qconf");
 852                 goto fail;
 853         }
 854
 855         txq = (struct otx2_eth_txq **)eth_dev->data->tx_queues;
 856         for (i = 0; i < nb_txq; i++) {
 857                 if (txq[i] == NULL) {
 858                         otx2_err("txq[%d] is already released", i);
 859                         goto fail;
 860                 }
 861                 memcpy(&tx_qconf[i], &txq[i]->qconf, sizeof(*tx_qconf));
 862                 otx2_nix_tx_queue_release(txq[i]);
 863                 eth_dev->data->tx_queues[i] = NULL;
 864         }
 865
 866         rxq = (struct otx2_eth_rxq **)eth_dev->data->rx_queues;
 867         for (i = 0; i < nb_rxq; i++) {
 868                 if (rxq[i] == NULL) {
 869                         otx2_err("rxq[%d] is already released", i);
 870                         goto fail;
 871                 }
 872                 memcpy(&rx_qconf[i], &rxq[i]->qconf, sizeof(*rx_qconf));
 873                 otx2_nix_rx_queue_release(rxq[i]);
 874                 eth_dev->data->rx_queues[i] = NULL;
 875         }
 876
 877         dev->tx_qconf = tx_qconf;
 878         dev->rx_qconf = rx_qconf;
 879         return 0;
 880
 881 fail:
 882         if (tx_qconf)
 883                 free(tx_qconf);
 884         if (rx_qconf)
 885                 free(rx_qconf);
 886
 887         return -ENOMEM;
 888 }
 889
 890 static int
 891 nix_restore_queue_cfg(struct rte_eth_dev *eth_dev)
 892 {
 893         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
 894         struct otx2_eth_qconf *tx_qconf = dev->tx_qconf;
 895         struct otx2_eth_qconf *rx_qconf = dev->rx_qconf;
 896         struct otx2_eth_txq **txq;
 897         struct otx2_eth_rxq **rxq;
 898         int rc, i, nb_rxq, nb_txq;
 899
 900         nb_rxq = RTE_MIN(dev->configured_nb_rx_qs, eth_dev->data->nb_rx_queues);
 901         nb_txq = RTE_MIN(dev->configured_nb_tx_qs, eth_dev->data->nb_tx_queues);
 902
 903         rc = -ENOMEM;
 904         /* Setup tx & rx queues with previous configuration so
 905          * that the queues can be functional in cases like ports
 906          * are started without re configuring queues.
 907          *
 908          * Usual re config sequence is like below:
 909          * port_configure() {
 910          *      if(reconfigure) {
 911          *              queue_release()
 912          *              queue_setup()
 913          *      }
 914          *      queue_configure() {
 915          *              queue_release()
 916          *              queue_setup()
 917          *      }
 918          * }
 919          * port_start()
 920          *
 921          * In some application's control path, queue_configure() would
 922          * NOT be invoked for TXQs/RXQs in port_configure().
 923          * In such cases, queues can be functional after start as the
 924          * queues are already setup in port_configure().
 925          */
 926         for (i = 0; i < nb_txq; i++) {
 927                 rc = otx2_nix_tx_queue_setup(eth_dev, i, tx_qconf[i].nb_desc,
 928                                              tx_qconf[i].socket_id,
 929                                              &tx_qconf[i].conf.tx);
 930                 if (rc) {
 931                         otx2_err("Failed to setup tx queue rc=%d", rc);
 932                         txq = (struct otx2_eth_txq **)eth_dev->data->tx_queues;
 933                         for (i -= 1; i >= 0; i--)
 934                                 otx2_nix_tx_queue_release(txq[i]);
 935                         goto fail;
 936                 }
 937         }
 938
 939         free(tx_qconf); tx_qconf = NULL;
 940
 941         for (i = 0; i < nb_rxq; i++) {
 942                 rc = otx2_nix_rx_queue_setup(eth_dev, i, rx_qconf[i].nb_desc,
 943                                              rx_qconf[i].socket_id,
 944                                              &rx_qconf[i].conf.rx,
 945                                              rx_qconf[i].mempool);
 946                 if (rc) {
 947                         otx2_err("Failed to setup rx queue rc=%d", rc);
 948                         rxq = (struct otx2_eth_rxq **)eth_dev->data->rx_queues;
 949                         for (i -= 1; i >= 0; i--)
 950                                 otx2_nix_rx_queue_release(rxq[i]);
 951                         goto release_tx_queues;
 952                 }
 953         }
 954
 955         free(rx_qconf); rx_qconf = NULL;
 956
 957         return 0;
 958
 959 release_tx_queues:
 960         txq = (struct otx2_eth_txq **)eth_dev->data->tx_queues;
 961         for (i = 0; i < eth_dev->data->nb_tx_queues; i++)
 962                 otx2_nix_tx_queue_release(txq[i]);
 963 fail:
 964         if (tx_qconf)
 965                 free(tx_qconf);
 966         if (rx_qconf)
 967                 free(rx_qconf);
 968
 969         return rc;
 970 }
 971
 972 static uint16_t
 973 nix_eth_nop_burst(void *queue, struct rte_mbuf **mbufs, uint16_t pkts)
 974 {
 975         RTE_SET_USED(queue);
 976         RTE_SET_USED(mbufs);
 977         RTE_SET_USED(pkts);
 978
 979         return 0;
 980 }
 981
 982 static void
 983 nix_set_nop_rxtx_function(struct rte_eth_dev *eth_dev)
 984 {
 985         /* These dummy functions are required for supporting
 986          * some applications which reconfigure queues without
 987          * stopping tx burst and rx burst threads(eg kni app)
 988          * When the queues context is saved, txq/rxqs are released
 989          * which caused app crash since rx/tx burst is still
 990          * on different lcores
 991          */
 992         eth_dev->tx_pkt_burst = nix_eth_nop_burst;
 993         eth_dev->rx_pkt_burst = nix_eth_nop_burst;
 994         rte_mb();
 995 }
 996
 997 static int
 998 otx2_nix_configure(struct rte_eth_dev *eth_dev)
 999 {
1000         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
1001         struct rte_eth_dev_data *data = eth_dev->data;
1002         struct rte_eth_conf *conf = &data->dev_conf;
1003         struct rte_eth_rxmode *rxmode = &conf->rxmode;
1004         struct rte_eth_txmode *txmode = &conf->txmode;
1005         char ea_fmt[RTE_ETHER_ADDR_FMT_SIZE];
1006         struct rte_ether_addr *ea;
1007         uint8_t nb_rxq, nb_txq;
1008         int rc;
1009
1010         rc = -EINVAL;
1011
1012         /* Sanity checks */
1013         if (rte_eal_has_hugepages() == 0) {
1014                 otx2_err("Huge page is not configured");
1015                 goto fail;
1016         }
1017
1018         if (rte_eal_iova_mode() != RTE_IOVA_VA) {
1019                 otx2_err("iova mode should be va");
1020                 goto fail;
1021         }
1022
1023         if (conf->link_speeds & ETH_LINK_SPEED_FIXED) {
1024                 otx2_err("Setting link speed/duplex not supported");
1025                 goto fail;
1026         }
1027
1028         if (conf->dcb_capability_en == 1) {
1029                 otx2_err("dcb enable is not supported");
1030                 goto fail;
1031         }
1032
1033         if (conf->fdir_conf.mode != RTE_FDIR_MODE_NONE) {
1034                 otx2_err("Flow director is not supported");
1035                 goto fail;
1036         }
1037
1038         if (rxmode->mq_mode != ETH_MQ_RX_NONE &&
1039             rxmode->mq_mode != ETH_MQ_RX_RSS) {
1040                 otx2_err("Unsupported mq rx mode %d", rxmode->mq_mode);
1041                 goto fail;
1042         }
1043
1044         if (txmode->mq_mode != ETH_MQ_TX_NONE) {
1045                 otx2_err("Unsupported mq tx mode %d", txmode->mq_mode);
1046                 goto fail;
1047         }
1048
1049         /* Free the resources allocated from the previous configure */
1050         if (dev->configured == 1) {
1051                 oxt2_nix_unregister_queue_irqs(eth_dev);
1052                 nix_set_nop_rxtx_function(eth_dev);
1053                 rc = nix_store_queue_cfg_and_then_release(eth_dev);
1054                 if (rc)
1055                         goto fail;
1056                 nix_lf_free(dev);
1057         }
1058
1059         if (otx2_dev_is_A0(dev) &&
1060             (txmode->offloads & DEV_TX_OFFLOAD_SCTP_CKSUM) &&
1061             ((txmode->offloads & DEV_TX_OFFLOAD_OUTER_IPV4_CKSUM) ||
1062             (txmode->offloads & DEV_TX_OFFLOAD_OUTER_UDP_CKSUM))) {
1063                 otx2_err("Outer IP and SCTP checksum unsupported");
1064                 rc = -EINVAL;
1065                 goto fail;
1066         }
1067
1068         dev->rx_offloads = rxmode->offloads;
1069         dev->tx_offloads = txmode->offloads;
1070         dev->rss_info.rss_grps = NIX_RSS_GRPS;
1071
1072         nb_rxq = RTE_MAX(data->nb_rx_queues, 1);
1073         nb_txq = RTE_MAX(data->nb_tx_queues, 1);
1074
1075         /* Alloc a nix lf */
1076         rc = nix_lf_alloc(dev, nb_rxq, nb_txq);
1077         if (rc) {
1078                 otx2_err("Failed to init nix_lf rc=%d", rc);
1079                 goto fail;
1080         }
1081
1082         /* Configure RSS */
1083         rc = otx2_nix_rss_config(eth_dev);
1084         if (rc) {
1085                 otx2_err("Failed to configure rss rc=%d", rc);
1086                 goto free_nix_lf;
1087         }
1088
1089         /* Register queue IRQs */
1090         rc = oxt2_nix_register_queue_irqs(eth_dev);
1091         if (rc) {
1092                 otx2_err("Failed to register queue interrupts rc=%d", rc);
1093                 goto free_nix_lf;
1094         }
1095
1096         /*
1097          * Restore queue config when reconfigure followed by
1098          * reconfigure and no queue configure invoked from application case.
1099          */
1100         if (dev->configured == 1) {
1101                 rc = nix_restore_queue_cfg(eth_dev);
1102                 if (rc)
1103                         goto free_nix_lf;
1104         }
1105
1106         /* Update the mac address */
1107         ea = eth_dev->data->mac_addrs;
1108         memcpy(ea, dev->mac_addr, RTE_ETHER_ADDR_LEN);
1109         if (rte_is_zero_ether_addr(ea))
1110                 rte_eth_random_addr((uint8_t *)ea);
1111
1112         rte_ether_format_addr(ea_fmt, RTE_ETHER_ADDR_FMT_SIZE, ea);
1113
1114         otx2_nix_dbg("Configured port%d mac=%s nb_rxq=%d nb_txq=%d"
1115                 " rx_offloads=0x%" PRIx64 " tx_offloads=0x%" PRIx64 ""
1116                 " rx_flags=0x%x tx_flags=0x%x",
1117                 eth_dev->data->port_id, ea_fmt, nb_rxq,
1118                 nb_txq, dev->rx_offloads, dev->tx_offloads,
1119                 dev->rx_offload_flags, dev->tx_offload_flags);
1120
1121         /* All good */
1122         dev->configured = 1;
1123         dev->configured_nb_rx_qs = data->nb_rx_queues;
1124         dev->configured_nb_tx_qs = data->nb_tx_queues;
1125         return 0;
1126
1127 free_nix_lf:
1128         rc = nix_lf_free(dev);
1129 fail:
1130         return rc;
1131 }
1132
1133 int
1134 otx2_nix_tx_queue_start(struct rte_eth_dev *eth_dev, uint16_t qidx)
1135 {
1136         struct rte_eth_dev_data *data = eth_dev->data;
1137
1138         if (data->tx_queue_state[qidx] == RTE_ETH_QUEUE_STATE_STARTED)
1139                 return 0;
1140
1141         data->tx_queue_state[qidx] = RTE_ETH_QUEUE_STATE_STARTED;
1142         return 0;
1143 }
1144
1145 int
1146 otx2_nix_tx_queue_stop(struct rte_eth_dev *eth_dev, uint16_t qidx)
1147 {
1148         struct rte_eth_dev_data *data = eth_dev->data;
1149
1150         if (data->tx_queue_state[qidx] == RTE_ETH_QUEUE_STATE_STOPPED)
1151                 return 0;
1152
1153         data->tx_queue_state[qidx] = RTE_ETH_QUEUE_STATE_STOPPED;
1154         return 0;
1155 }
1156
1157 static int
1158 otx2_nix_rx_queue_start(struct rte_eth_dev *eth_dev, uint16_t qidx)
1159 {
1160         struct otx2_eth_rxq *rxq = eth_dev->data->rx_queues[qidx];
1161         struct rte_eth_dev_data *data = eth_dev->data;
1162         int rc;
1163
1164         if (data->rx_queue_state[qidx] == RTE_ETH_QUEUE_STATE_STARTED)
1165                 return 0;
1166
1167         rc = nix_rq_enb_dis(rxq->eth_dev, rxq, true);
1168         if (rc) {
1169                 otx2_err("Failed to enable rxq=%u, rc=%d", qidx, rc);
1170                 goto done;
1171         }
1172
1173         data->rx_queue_state[qidx] = RTE_ETH_QUEUE_STATE_STARTED;
1174
1175 done:
1176         return rc;
1177 }
1178
1179 static int
1180 otx2_nix_rx_queue_stop(struct rte_eth_dev *eth_dev, uint16_t qidx)
1181 {
1182         struct otx2_eth_rxq *rxq = eth_dev->data->rx_queues[qidx];
1183         struct rte_eth_dev_data *data = eth_dev->data;
1184         int rc;
1185
1186         if (data->rx_queue_state[qidx] == RTE_ETH_QUEUE_STATE_STOPPED)
1187                 return 0;
1188
1189         rc = nix_rq_enb_dis(rxq->eth_dev, rxq, false);
1190         if (rc) {
1191                 otx2_err("Failed to disable rxq=%u, rc=%d", qidx, rc);
1192                 goto done;
1193         }
1194
1195         data->rx_queue_state[qidx] = RTE_ETH_QUEUE_STATE_STOPPED;
1196
1197 done:
1198         return rc;
1199 }
1200
1201 /* Initialize and register driver with DPDK Application */
1202 static const struct eth_dev_ops otx2_eth_dev_ops = {
1203         .dev_infos_get            = otx2_nix_info_get,
1204         .dev_configure            = otx2_nix_configure,
1205         .link_update              = otx2_nix_link_update,
1206         .tx_queue_setup           = otx2_nix_tx_queue_setup,
1207         .tx_queue_release         = otx2_nix_tx_queue_release,
1208         .rx_queue_setup           = otx2_nix_rx_queue_setup,
1209         .rx_queue_release         = otx2_nix_rx_queue_release,
1210         .tx_queue_start           = otx2_nix_tx_queue_start,
1211         .tx_queue_stop            = otx2_nix_tx_queue_stop,
1212         .rx_queue_start           = otx2_nix_rx_queue_start,
1213         .rx_queue_stop            = otx2_nix_rx_queue_stop,
1214         .stats_get                = otx2_nix_dev_stats_get,
1215         .stats_reset              = otx2_nix_dev_stats_reset,
1216         .get_reg                  = otx2_nix_dev_get_reg,
1217         .mac_addr_add             = otx2_nix_mac_addr_add,
1218         .mac_addr_remove          = otx2_nix_mac_addr_del,
1219         .mac_addr_set             = otx2_nix_mac_addr_set,
1220         .promiscuous_enable       = otx2_nix_promisc_enable,
1221         .promiscuous_disable      = otx2_nix_promisc_disable,
1222         .allmulticast_enable      = otx2_nix_allmulticast_enable,
1223         .allmulticast_disable     = otx2_nix_allmulticast_disable,
1224         .queue_stats_mapping_set  = otx2_nix_queue_stats_mapping,
1225         .reta_update              = otx2_nix_dev_reta_update,
1226         .reta_query               = otx2_nix_dev_reta_query,
1227         .rss_hash_update          = otx2_nix_rss_hash_update,
1228         .rss_hash_conf_get        = otx2_nix_rss_hash_conf_get,
1229         .xstats_get               = otx2_nix_xstats_get,
1230         .xstats_get_names         = otx2_nix_xstats_get_names,
1231         .xstats_reset             = otx2_nix_xstats_reset,
1232         .xstats_get_by_id         = otx2_nix_xstats_get_by_id,
1233         .xstats_get_names_by_id   = otx2_nix_xstats_get_names_by_id,
1234 };
1235
1236 static inline int
1237 nix_lf_attach(struct otx2_eth_dev *dev)
1238 {
1239         struct otx2_mbox *mbox = dev->mbox;
1240         struct rsrc_attach_req *req;
1241
1242         /* Attach NIX(lf) */
1243         req = otx2_mbox_alloc_msg_attach_resources(mbox);
1244         req->modify = true;
1245         req->nixlf = true;
1246
1247         return otx2_mbox_process(mbox);
1248 }
1249
1250 static inline int
1251 nix_lf_get_msix_offset(struct otx2_eth_dev *dev)
1252 {
1253         struct otx2_mbox *mbox = dev->mbox;
1254         struct msix_offset_rsp *msix_rsp;
1255         int rc;
1256
1257         /* Get NPA and NIX MSIX vector offsets */
1258         otx2_mbox_alloc_msg_msix_offset(mbox);
1259
1260         rc = otx2_mbox_process_msg(mbox, (void *)&msix_rsp);
1261
1262         dev->nix_msixoff = msix_rsp->nix_msixoff;
1263
1264         return rc;
1265 }
1266
1267 static inline int
1268 otx2_eth_dev_lf_detach(struct otx2_mbox *mbox)
1269 {
1270         struct rsrc_detach_req *req;
1271
1272         req = otx2_mbox_alloc_msg_detach_resources(mbox);
1273
1274         /* Detach all except npa lf */
1275         req->partial = true;
1276         req->nixlf = true;
1277         req->sso = true;
1278         req->ssow = true;
1279         req->timlfs = true;
1280         req->cptlfs = true;
1281
1282         return otx2_mbox_process(mbox);
1283 }
1284
1285 static int
1286 otx2_eth_dev_init(struct rte_eth_dev *eth_dev)
1287 {
1288         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
1289         struct rte_pci_device *pci_dev;
1290         int rc, max_entries;
1291
1292         eth_dev->dev_ops = &otx2_eth_dev_ops;
1293
1294         /* For secondary processes, the primary has done all the work */
1295         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
1296                 /* Setup callbacks for secondary process */
1297                 otx2_eth_set_tx_function(eth_dev);
1298                 otx2_eth_set_rx_function(eth_dev);
1299                 return 0;
1300         }
1301
1302         pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
1303
1304         rte_eth_copy_pci_info(eth_dev, pci_dev);
1305         eth_dev->data->dev_flags |= RTE_ETH_DEV_CLOSE_REMOVE;
1306
1307         /* Zero out everything after OTX2_DEV to allow proper dev_reset() */
1308         memset(&dev->otx2_eth_dev_data_start, 0, sizeof(*dev) -
1309                 offsetof(struct otx2_eth_dev, otx2_eth_dev_data_start));
1310
1311         /* Parse devargs string */
1312         rc = otx2_ethdev_parse_devargs(eth_dev->device->devargs, dev);
1313         if (rc) {
1314                 otx2_err("Failed to parse devargs rc=%d", rc);
1315                 goto error;
1316         }
1317
1318         if (!dev->mbox_active) {
1319                 /* Initialize the base otx2_dev object
1320                  * only if already present
1321                  */
1322                 rc = otx2_dev_init(pci_dev, dev);
1323                 if (rc) {
1324                         otx2_err("Failed to initialize otx2_dev rc=%d", rc);
1325                         goto error;
1326                 }
1327         }
1328         /* Device generic callbacks */
1329         dev->ops = &otx2_dev_ops;
1330         dev->eth_dev = eth_dev;
1331
1332         /* Grab the NPA LF if required */
1333         rc = otx2_npa_lf_init(pci_dev, dev);
1334         if (rc)
1335                 goto otx2_dev_uninit;
1336
1337         dev->configured = 0;
1338         dev->drv_inited = true;
1339         dev->base = dev->bar2 + (RVU_BLOCK_ADDR_NIX0 << 20);
1340         dev->lmt_addr = dev->bar2 + (RVU_BLOCK_ADDR_LMT << 20);
1341
1342         /* Attach NIX LF */
1343         rc = nix_lf_attach(dev);
1344         if (rc)
1345                 goto otx2_npa_uninit;
1346
1347         /* Get NIX MSIX offset */
1348         rc = nix_lf_get_msix_offset(dev);
1349         if (rc)
1350                 goto otx2_npa_uninit;
1351
1352         /* Register LF irq handlers */
1353         rc = otx2_nix_register_irqs(eth_dev);
1354         if (rc)
1355                 goto mbox_detach;
1356
1357         /* Get maximum number of supported MAC entries */
1358         max_entries = otx2_cgx_mac_max_entries_get(dev);
1359         if (max_entries < 0) {
1360                 otx2_err("Failed to get max entries for mac addr");
1361                 rc = -ENOTSUP;
1362                 goto unregister_irq;
1363         }
1364
1365         /* For VFs, returned max_entries will be 0. But to keep default MAC
1366          * address, one entry must be allocated. So setting up to 1.
1367          */
1368         if (max_entries == 0)
1369                 max_entries = 1;
1370
1371         eth_dev->data->mac_addrs = rte_zmalloc("mac_addr", max_entries *
1372                                                RTE_ETHER_ADDR_LEN, 0);
1373         if (eth_dev->data->mac_addrs == NULL) {
1374                 otx2_err("Failed to allocate memory for mac addr");
1375                 rc = -ENOMEM;
1376                 goto unregister_irq;
1377         }
1378
1379         dev->max_mac_entries = max_entries;
1380
1381         rc = otx2_nix_mac_addr_get(eth_dev, dev->mac_addr);
1382         if (rc)
1383                 goto free_mac_addrs;
1384
1385         /* Update the mac address */
1386         memcpy(eth_dev->data->mac_addrs, dev->mac_addr, RTE_ETHER_ADDR_LEN);
1387
1388         /* Also sync same MAC address to CGX table */
1389         otx2_cgx_mac_addr_set(eth_dev, &eth_dev->data->mac_addrs[0]);
1390
1391         dev->tx_offload_capa = nix_get_tx_offload_capa(dev);
1392         dev->rx_offload_capa = nix_get_rx_offload_capa(dev);
1393
1394         if (otx2_dev_is_A0(dev)) {
1395                 dev->hwcap |= OTX2_FIXUP_F_MIN_4K_Q;
1396                 dev->hwcap |= OTX2_FIXUP_F_LIMIT_CQ_FULL;
1397         }
1398
1399         otx2_nix_dbg("Port=%d pf=%d vf=%d ver=%s msix_off=%d hwcap=0x%" PRIx64
1400                      " rxoffload_capa=0x%" PRIx64 " txoffload_capa=0x%" PRIx64,
1401                      eth_dev->data->port_id, dev->pf, dev->vf,
1402                      OTX2_ETH_DEV_PMD_VERSION, dev->nix_msixoff, dev->hwcap,
1403                      dev->rx_offload_capa, dev->tx_offload_capa);
1404         return 0;
1405
1406 free_mac_addrs:
1407         rte_free(eth_dev->data->mac_addrs);
1408 unregister_irq:
1409         otx2_nix_unregister_irqs(eth_dev);
1410 mbox_detach:
1411         otx2_eth_dev_lf_detach(dev->mbox);
1412 otx2_npa_uninit:
1413         otx2_npa_lf_fini();
1414 otx2_dev_uninit:
1415         otx2_dev_fini(pci_dev, dev);
1416 error:
1417         otx2_err("Failed to init nix eth_dev rc=%d", rc);
1418         return rc;
1419 }
1420
1421 static int
1422 otx2_eth_dev_uninit(struct rte_eth_dev *eth_dev, bool mbox_close)
1423 {
1424         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
1425         struct rte_pci_device *pci_dev;
1426         int rc, i;
1427
1428         /* Nothing to be done for secondary processes */
1429         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
1430                 return 0;
1431
1432         /* Free up SQs */
1433         for (i = 0; i < eth_dev->data->nb_tx_queues; i++) {
1434                 otx2_nix_tx_queue_release(eth_dev->data->tx_queues[i]);
1435                 eth_dev->data->tx_queues[i] = NULL;
1436         }
1437         eth_dev->data->nb_tx_queues = 0;
1438
1439         /* Free up RQ's and CQ's */
1440         for (i = 0; i < eth_dev->data->nb_rx_queues; i++) {
1441                 otx2_nix_rx_queue_release(eth_dev->data->rx_queues[i]);
1442                 eth_dev->data->rx_queues[i] = NULL;
1443         }
1444         eth_dev->data->nb_rx_queues = 0;
1445
1446         /* Unregister queue irqs */
1447         oxt2_nix_unregister_queue_irqs(eth_dev);
1448
1449         rc = nix_lf_free(dev);
1450         if (rc)
1451                 otx2_err("Failed to free nix lf, rc=%d", rc);
1452
1453         rc = otx2_npa_lf_fini();
1454         if (rc)
1455                 otx2_err("Failed to cleanup npa lf, rc=%d", rc);
1456
1457         rte_free(eth_dev->data->mac_addrs);
1458         eth_dev->data->mac_addrs = NULL;
1459         dev->drv_inited = false;
1460
1461         pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
1462         otx2_nix_unregister_irqs(eth_dev);
1463
1464         rc = otx2_eth_dev_lf_detach(dev->mbox);
1465         if (rc)
1466                 otx2_err("Failed to detach resources, rc=%d", rc);
1467
1468         /* Check if mbox close is needed */
1469         if (!mbox_close)
1470                 return 0;
1471
1472         if (otx2_npa_lf_active(dev) || otx2_dev_active_vfs(dev)) {
1473                 /* Will be freed later by PMD */
1474                 eth_dev->data->dev_private = NULL;
1475                 return 0;
1476         }
1477
1478         otx2_dev_fini(pci_dev, dev);
1479         return 0;
1480 }
1481
1482 static int
1483 nix_remove(struct rte_pci_device *pci_dev)
1484 {
1485         struct rte_eth_dev *eth_dev;
1486         struct otx2_idev_cfg *idev;
1487         struct otx2_dev *otx2_dev;
1488         int rc;
1489
1490         eth_dev = rte_eth_dev_allocated(pci_dev->device.name);
1491         if (eth_dev) {
1492                 /* Cleanup eth dev */
1493                 rc = otx2_eth_dev_uninit(eth_dev, true);
1494                 if (rc)
1495                         return rc;
1496
1497                 rte_eth_dev_pci_release(eth_dev);
1498         }
1499
1500         /* Nothing to be done for secondary processes */
1501         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
1502                 return 0;
1503
1504         /* Check for common resources */
1505         idev = otx2_intra_dev_get_cfg();
1506         if (!idev || !idev->npa_lf || idev->npa_lf->pci_dev != pci_dev)
1507                 return 0;
1508
1509         otx2_dev = container_of(idev->npa_lf, struct otx2_dev, npalf);
1510
1511         if (otx2_npa_lf_active(otx2_dev) || otx2_dev_active_vfs(otx2_dev))
1512                 goto exit;
1513
1514         /* Safe to cleanup mbox as no more users */
1515         otx2_dev_fini(pci_dev, otx2_dev);
1516         rte_free(otx2_dev);
1517         return 0;
1518
1519 exit:
1520         otx2_info("%s: common resource in use by other devices", pci_dev->name);
1521         return -EAGAIN;
1522 }
1523
1524 static int
1525 nix_probe(struct rte_pci_driver *pci_drv, struct rte_pci_device *pci_dev)
1526 {
1527         int rc;
1528
1529         RTE_SET_USED(pci_drv);
1530
1531         rc = rte_eth_dev_pci_generic_probe(pci_dev, sizeof(struct otx2_eth_dev),
1532                                            otx2_eth_dev_init);
1533
1534         /* On error on secondary, recheck if port exists in primary or
1535          * in mid of detach state.
1536          */
1537         if (rte_eal_process_type() != RTE_PROC_PRIMARY && rc)
1538                 if (!rte_eth_dev_allocated(pci_dev->device.name))
1539                         return 0;
1540         return rc;
1541 }
1542
1543 static const struct rte_pci_id pci_nix_map[] = {
1544         {
1545                 RTE_PCI_DEVICE(PCI_VENDOR_ID_CAVIUM, PCI_DEVID_OCTEONTX2_RVU_PF)
1546         },
1547         {
1548                 RTE_PCI_DEVICE(PCI_VENDOR_ID_CAVIUM, PCI_DEVID_OCTEONTX2_RVU_VF)
1549         },
1550         {
1551                 RTE_PCI_DEVICE(PCI_VENDOR_ID_CAVIUM,
1552                                PCI_DEVID_OCTEONTX2_RVU_AF_VF)
1553         },
1554         {
1555                 .vendor_id = 0,
1556         },
1557 };
1558
1559 static struct rte_pci_driver pci_nix = {
1560         .id_table = pci_nix_map,
1561         .drv_flags = RTE_PCI_DRV_NEED_MAPPING | RTE_PCI_DRV_IOVA_AS_VA |
1562                         RTE_PCI_DRV_INTR_LSC,
1563         .probe = nix_probe,
1564         .remove = nix_remove,
1565 };
1566
1567 RTE_PMD_REGISTER_PCI(net_octeontx2, pci_nix);
1568 RTE_PMD_REGISTER_PCI_TABLE(net_octeontx2, pci_nix_map);
1569 RTE_PMD_REGISTER_KMOD_DEP(net_octeontx2, "vfio-pci");