drivers/net/mvpp2/mrvl_ethdev.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2017-2021 Marvell International Ltd.
   3  * Copyright(c) 2017-2021 Semihalf.
   4  * All rights reserved.
   5  */
   6
   7 #include <rte_string_fns.h>
   8 #include <ethdev_driver.h>
   9 #include <rte_kvargs.h>
  10 #include <rte_log.h>
  11 #include <rte_malloc.h>
  12 #include <rte_bus_vdev.h>
  13
  14 #include <fcntl.h>
  15 #include <linux/ethtool.h>
  16 #include <linux/sockios.h>
  17 #include <net/if.h>
  18 #include <net/if_arp.h>
  19 #include <sys/ioctl.h>
  20 #include <sys/socket.h>
  21 #include <sys/stat.h>
  22 #include <sys/types.h>
  23
  24 #include <rte_mvep_common.h>
  25 #include "mrvl_ethdev.h"
  26 #include "mrvl_qos.h"
  27 #include "mrvl_flow.h"
  28 #include "mrvl_mtr.h"
  29 #include "mrvl_tm.h"
  30
  31 /* bitmask with reserved hifs */
  32 #define MRVL_MUSDK_HIFS_RESERVED 0x0F
  33 /* bitmask with reserved bpools */
  34 #define MRVL_MUSDK_BPOOLS_RESERVED 0x07
  35 /* bitmask with reserved kernel RSS tables */
  36 #define MRVL_MUSDK_RSS_RESERVED 0x0F
  37 /* maximum number of available hifs */
  38 #define MRVL_MUSDK_HIFS_MAX 9
  39
  40 /* prefetch shift */
  41 #define MRVL_MUSDK_PREFETCH_SHIFT 2
  42
  43 /* TCAM has 25 entries reserved for uc/mc filter entries
  44  * + 1 for primary mac address
  45  */
  46 #define MRVL_MAC_ADDRS_MAX (1 + 25)
  47 #define MRVL_MATCH_LEN 16
  48 #define MRVL_PKT_EFFEC_OFFS (MRVL_PKT_OFFS + MV_MH_SIZE)
  49 /* Maximum allowable packet size */
  50 #define MRVL_PKT_SIZE_MAX (10240 - MV_MH_SIZE)
  51
  52 #define MRVL_IFACE_NAME_ARG "iface"
  53 #define MRVL_CFG_ARG "cfg"
  54
  55 #define MRVL_ARP_LENGTH 28
  56
  57 #define MRVL_COOKIE_ADDR_INVALID ~0ULL
  58 #define MRVL_COOKIE_HIGH_ADDR_MASK 0xffffff0000000000
  59
  60 /** Port Rx offload capabilities */
  61 #define MRVL_RX_OFFLOADS (DEV_RX_OFFLOAD_VLAN_FILTER | \
  62                           DEV_RX_OFFLOAD_JUMBO_FRAME | \
  63                           DEV_RX_OFFLOAD_CHECKSUM)
  64
  65 /** Port Tx offloads capabilities */
  66 #define MRVL_TX_OFFLOAD_CHECKSUM (DEV_TX_OFFLOAD_IPV4_CKSUM | \
  67                                   DEV_TX_OFFLOAD_UDP_CKSUM  | \
  68                                   DEV_TX_OFFLOAD_TCP_CKSUM)
  69 #define MRVL_TX_OFFLOADS (MRVL_TX_OFFLOAD_CHECKSUM | \
  70                           DEV_TX_OFFLOAD_MULTI_SEGS)
  71
  72 #define MRVL_TX_PKT_OFFLOADS (PKT_TX_IP_CKSUM | \
  73                               PKT_TX_TCP_CKSUM | \
  74                               PKT_TX_UDP_CKSUM)
  75
  76 static const char * const valid_args[] = {
  77         MRVL_IFACE_NAME_ARG,
  78         MRVL_CFG_ARG,
  79         NULL
  80 };
  81
  82 static int used_hifs = MRVL_MUSDK_HIFS_RESERVED;
  83 static struct pp2_hif *hifs[RTE_MAX_LCORE];
  84 static int used_bpools[PP2_NUM_PKT_PROC] = {
  85         [0 ... PP2_NUM_PKT_PROC - 1] = MRVL_MUSDK_BPOOLS_RESERVED
  86 };
  87
  88 static struct pp2_bpool *mrvl_port_to_bpool_lookup[RTE_MAX_ETHPORTS];
  89 static int mrvl_port_bpool_size[PP2_NUM_PKT_PROC][PP2_BPOOL_NUM_POOLS][RTE_MAX_LCORE];
  90 static uint64_t cookie_addr_high = MRVL_COOKIE_ADDR_INVALID;
  91 static int dummy_pool_id[PP2_NUM_PKT_PROC];
  92 struct pp2_bpool *dummy_pool[PP2_NUM_PKT_PROC] = {0};
  93
  94 struct mrvl_ifnames {
  95         const char *names[PP2_NUM_ETH_PPIO * PP2_NUM_PKT_PROC];
  96         int idx;
  97 };
  98
  99 /*
 100  * To use buffer harvesting based on loopback port shadow queue structure
 101  * was introduced for buffers information bookkeeping.
 102  *
 103  * Before sending the packet, related buffer information (pp2_buff_inf) is
 104  * stored in shadow queue. After packet is transmitted no longer used
 105  * packet buffer is released back to it's original hardware pool,
 106  * on condition it originated from interface.
 107  * In case it  was generated by application itself i.e: mbuf->port field is
 108  * 0xff then its released to software mempool.
 109  */
 110 struct mrvl_shadow_txq {
 111         int head;           /* write index - used when sending buffers */
 112         int tail;           /* read index - used when releasing buffers */
 113         u16 size;           /* queue occupied size */
 114         u16 num_to_release; /* number of descriptors sent, that can be
 115                              * released
 116                              */
 117         struct buff_release_entry ent[MRVL_PP2_TX_SHADOWQ_SIZE]; /* q entries */
 118 };
 119
 120 struct mrvl_rxq {
 121         struct mrvl_priv *priv;
 122         struct rte_mempool *mp;
 123         int queue_id;
 124         int port_id;
 125         int cksum_enabled;
 126         uint64_t bytes_recv;
 127         uint64_t drop_mac;
 128 };
 129
 130 struct mrvl_txq {
 131         struct mrvl_priv *priv;
 132         int queue_id;
 133         int port_id;
 134         uint64_t bytes_sent;
 135         struct mrvl_shadow_txq shadow_txqs[RTE_MAX_LCORE];
 136         int tx_deferred_start;
 137 };
 138
 139 static int mrvl_lcore_first;
 140 static int mrvl_lcore_last;
 141 static int mrvl_dev_num;
 142
 143 static int mrvl_fill_bpool(struct mrvl_rxq *rxq, int num);
 144 static inline void mrvl_free_sent_buffers(struct pp2_ppio *ppio,
 145                         struct pp2_hif *hif, unsigned int core_id,
 146                         struct mrvl_shadow_txq *sq, int qid, int force);
 147
 148 static uint16_t mrvl_tx_pkt_burst(void *txq, struct rte_mbuf **tx_pkts,
 149                                   uint16_t nb_pkts);
 150 static uint16_t mrvl_tx_sg_pkt_burst(void *txq, struct rte_mbuf **tx_pkts,
 151                                      uint16_t nb_pkts);
 152 static int rte_pmd_mrvl_remove(struct rte_vdev_device *vdev);
 153 static void mrvl_deinit_pp2(void);
 154 static void mrvl_deinit_hifs(void);
 155
 156 static int
 157 mrvl_mac_addr_add(struct rte_eth_dev *dev, struct rte_ether_addr *mac_addr,
 158                   uint32_t index, uint32_t vmdq __rte_unused);
 159 static int
 160 mrvl_mac_addr_set(struct rte_eth_dev *dev, struct rte_ether_addr *mac_addr);
 161 static int
 162 mrvl_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on);
 163 static int mrvl_promiscuous_enable(struct rte_eth_dev *dev);
 164 static int mrvl_allmulticast_enable(struct rte_eth_dev *dev);
 165 static int
 166 mrvl_flow_ctrl_set(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf);
 167
 168 #define MRVL_XSTATS_TBL_ENTRY(name) { \
 169         #name, offsetof(struct pp2_ppio_statistics, name),      \
 170         sizeof(((struct pp2_ppio_statistics *)0)->name)         \
 171 }
 172
 173 /* Table with xstats data */
 174 static struct {
 175         const char *name;
 176         unsigned int offset;
 177         unsigned int size;
 178 } mrvl_xstats_tbl[] = {
 179         MRVL_XSTATS_TBL_ENTRY(rx_bytes),
 180         MRVL_XSTATS_TBL_ENTRY(rx_packets),
 181         MRVL_XSTATS_TBL_ENTRY(rx_unicast_packets),
 182         MRVL_XSTATS_TBL_ENTRY(rx_errors),
 183         MRVL_XSTATS_TBL_ENTRY(rx_fullq_dropped),
 184         MRVL_XSTATS_TBL_ENTRY(rx_bm_dropped),
 185         MRVL_XSTATS_TBL_ENTRY(rx_early_dropped),
 186         MRVL_XSTATS_TBL_ENTRY(rx_fifo_dropped),
 187         MRVL_XSTATS_TBL_ENTRY(rx_cls_dropped),
 188         MRVL_XSTATS_TBL_ENTRY(tx_bytes),
 189         MRVL_XSTATS_TBL_ENTRY(tx_packets),
 190         MRVL_XSTATS_TBL_ENTRY(tx_unicast_packets),
 191         MRVL_XSTATS_TBL_ENTRY(tx_errors)
 192 };
 193
 194 static inline int
 195 mrvl_reserve_bit(int *bitmap, int max)
 196 {
 197         int n = sizeof(*bitmap) * 8 - __builtin_clz(*bitmap);
 198
 199         if (n >= max)
 200                 return -1;
 201
 202         *bitmap |= 1 << n;
 203
 204         return n;
 205 }
 206
 207 static int
 208 mrvl_pp2_fixup_init(void)
 209 {
 210         struct pp2_bpool_params bpool_params;
 211         char                    name[15];
 212         int                     err, i;
 213
 214         memset(dummy_pool, 0, sizeof(dummy_pool));
 215         for (i = 0; i < pp2_get_num_inst(); i++) {
 216                 dummy_pool_id[i] = mrvl_reserve_bit(&used_bpools[i],
 217                                              PP2_BPOOL_NUM_POOLS);
 218                 if (dummy_pool_id[i] < 0) {
 219                         MRVL_LOG(ERR, "Can't find free pool\n");
 220                         return -1;
 221                 }
 222
 223                 memset(name, 0, sizeof(name));
 224                 snprintf(name, sizeof(name), "pool-%d:%d", i, dummy_pool_id[i]);
 225                 memset(&bpool_params, 0, sizeof(bpool_params));
 226                 bpool_params.match = name;
 227                 bpool_params.buff_len = MRVL_PKT_OFFS;
 228                 bpool_params.dummy_short_pool = 1;
 229                 err = pp2_bpool_init(&bpool_params, &dummy_pool[i]);
 230                 if (err != 0 || !dummy_pool[i]) {
 231                         MRVL_LOG(ERR, "BPool init failed!\n");
 232                         used_bpools[i] &= ~(1 << dummy_pool_id[i]);
 233                         return -1;
 234                 }
 235         }
 236
 237         return 0;
 238 }
 239
 240 /**
 241  * Initialize packet processor.
 242  *
 243  * @return
 244  *   0 on success, negative error value otherwise.
 245  */
 246 static int
 247 mrvl_init_pp2(void)
 248 {
 249         struct pp2_init_params  init_params;
 250         int                     err;
 251
 252         memset(&init_params, 0, sizeof(init_params));
 253         init_params.hif_reserved_map = MRVL_MUSDK_HIFS_RESERVED;
 254         init_params.bm_pool_reserved_map = MRVL_MUSDK_BPOOLS_RESERVED;
 255         init_params.rss_tbl_reserved_map = MRVL_MUSDK_RSS_RESERVED;
 256         if (mrvl_cfg && mrvl_cfg->pp2_cfg.prs_udfs.num_udfs)
 257                 memcpy(&init_params.prs_udfs, &mrvl_cfg->pp2_cfg.prs_udfs,
 258                        sizeof(struct pp2_parse_udfs));
 259         err = pp2_init(&init_params);
 260         if (err != 0) {
 261                 MRVL_LOG(ERR, "PP2 init failed");
 262                 return -1;
 263         }
 264
 265         err = mrvl_pp2_fixup_init();
 266         if (err != 0) {
 267                 MRVL_LOG(ERR, "PP2 fixup init failed");
 268                 return -1;
 269         }
 270
 271         return 0;
 272 }
 273
 274 static void
 275 mrvl_pp2_fixup_deinit(void)
 276 {
 277         int i;
 278
 279         for (i = 0; i < PP2_NUM_PKT_PROC; i++) {
 280                 if (!dummy_pool[i])
 281                         continue;
 282                 pp2_bpool_deinit(dummy_pool[i]);
 283                 used_bpools[i] &= ~(1 << dummy_pool_id[i]);
 284         }
 285 }
 286
 287 /**
 288  * Deinitialize packet processor.
 289  *
 290  * @return
 291  *   0 on success, negative error value otherwise.
 292  */
 293 static void
 294 mrvl_deinit_pp2(void)
 295 {
 296         mrvl_pp2_fixup_deinit();
 297         pp2_deinit();
 298 }
 299
 300 static inline void
 301 mrvl_fill_shadowq(struct mrvl_shadow_txq *sq, struct rte_mbuf *buf)
 302 {
 303         sq->ent[sq->head].buff.cookie = (uint64_t)buf;
 304         sq->ent[sq->head].buff.addr = buf ?
 305                 rte_mbuf_data_iova_default(buf) : 0;
 306
 307         sq->ent[sq->head].bpool =
 308                 (unlikely(!buf || buf->port >= RTE_MAX_ETHPORTS ||
 309                  buf->refcnt > 1)) ? NULL :
 310                  mrvl_port_to_bpool_lookup[buf->port];
 311
 312         sq->head = (sq->head + 1) & MRVL_PP2_TX_SHADOWQ_MASK;
 313         sq->size++;
 314 }
 315
 316 /**
 317  * Deinitialize per-lcore MUSDK hardware interfaces (hifs).
 318  */
 319 static void
 320 mrvl_deinit_hifs(void)
 321 {
 322         int i;
 323
 324         for (i = mrvl_lcore_first; i <= mrvl_lcore_last; i++) {
 325                 if (hifs[i])
 326                         pp2_hif_deinit(hifs[i]);
 327         }
 328         used_hifs = MRVL_MUSDK_HIFS_RESERVED;
 329         memset(hifs, 0, sizeof(hifs));
 330 }
 331
 332 static inline void
 333 mrvl_fill_desc(struct pp2_ppio_desc *desc, struct rte_mbuf *buf)
 334 {
 335         pp2_ppio_outq_desc_reset(desc);
 336         pp2_ppio_outq_desc_set_phys_addr(desc, rte_pktmbuf_iova(buf));
 337         pp2_ppio_outq_desc_set_pkt_offset(desc, 0);
 338         pp2_ppio_outq_desc_set_pkt_len(desc, rte_pktmbuf_data_len(buf));
 339 }
 340
 341 static inline int
 342 mrvl_get_bpool_size(int pp2_id, int pool_id)
 343 {
 344         int i;
 345         int size = 0;
 346
 347         for (i = mrvl_lcore_first; i <= mrvl_lcore_last; i++)
 348                 size += mrvl_port_bpool_size[pp2_id][pool_id][i];
 349
 350         return size;
 351 }
 352
 353 static int
 354 mrvl_init_hif(int core_id)
 355 {
 356         struct pp2_hif_params params;
 357         char match[MRVL_MATCH_LEN];
 358         int ret;
 359
 360         ret = mrvl_reserve_bit(&used_hifs, MRVL_MUSDK_HIFS_MAX);
 361         if (ret < 0) {
 362                 MRVL_LOG(ERR, "Failed to allocate hif %d", core_id);
 363                 return ret;
 364         }
 365
 366         snprintf(match, sizeof(match), "hif-%d", ret);
 367         memset(&params, 0, sizeof(params));
 368         params.match = match;
 369         params.out_size = MRVL_PP2_AGGR_TXQD_MAX;
 370         ret = pp2_hif_init(&params, &hifs[core_id]);
 371         if (ret) {
 372                 MRVL_LOG(ERR, "Failed to initialize hif %d", core_id);
 373                 return ret;
 374         }
 375
 376         return 0;
 377 }
 378
 379 static inline struct pp2_hif*
 380 mrvl_get_hif(struct mrvl_priv *priv, int core_id)
 381 {
 382         int ret;
 383
 384         if (likely(hifs[core_id] != NULL))
 385                 return hifs[core_id];
 386
 387         rte_spinlock_lock(&priv->lock);
 388
 389         ret = mrvl_init_hif(core_id);
 390         if (ret < 0) {
 391                 MRVL_LOG(ERR, "Failed to allocate hif %d", core_id);
 392                 goto out;
 393         }
 394
 395         if (core_id < mrvl_lcore_first)
 396                 mrvl_lcore_first = core_id;
 397
 398         if (core_id > mrvl_lcore_last)
 399                 mrvl_lcore_last = core_id;
 400 out:
 401         rte_spinlock_unlock(&priv->lock);
 402
 403         return hifs[core_id];
 404 }
 405
 406 /**
 407  * Set tx burst function according to offload flag
 408  *
 409  * @param dev
 410  *   Pointer to Ethernet device structure.
 411  */
 412 static void
 413 mrvl_set_tx_function(struct rte_eth_dev *dev)
 414 {
 415         struct mrvl_priv *priv = dev->data->dev_private;
 416
 417         /* Use a simple Tx queue (no offloads, no multi segs) if possible */
 418         if (priv->multiseg) {
 419                 RTE_LOG(INFO, PMD, "Using multi-segment tx callback\n");
 420                 dev->tx_pkt_burst = mrvl_tx_sg_pkt_burst;
 421         } else {
 422                 RTE_LOG(INFO, PMD, "Using single-segment tx callback\n");
 423                 dev->tx_pkt_burst = mrvl_tx_pkt_burst;
 424         }
 425 }
 426
 427 /**
 428  * Configure rss based on dpdk rss configuration.
 429  *
 430  * @param priv
 431  *   Pointer to private structure.
 432  * @param rss_conf
 433  *   Pointer to RSS configuration.
 434  *
 435  * @return
 436  *   0 on success, negative error value otherwise.
 437  */
 438 static int
 439 mrvl_configure_rss(struct mrvl_priv *priv, struct rte_eth_rss_conf *rss_conf)
 440 {
 441         if (rss_conf->rss_key)
 442                 MRVL_LOG(WARNING, "Changing hash key is not supported");
 443
 444         if (rss_conf->rss_hf == 0) {
 445                 priv->ppio_params.inqs_params.hash_type = PP2_PPIO_HASH_T_NONE;
 446         } else if (rss_conf->rss_hf & ETH_RSS_IPV4) {
 447                 priv->ppio_params.inqs_params.hash_type =
 448                         PP2_PPIO_HASH_T_2_TUPLE;
 449         } else if (rss_conf->rss_hf & ETH_RSS_NONFRAG_IPV4_TCP) {
 450                 priv->ppio_params.inqs_params.hash_type =
 451                         PP2_PPIO_HASH_T_5_TUPLE;
 452                 priv->rss_hf_tcp = 1;
 453         } else if (rss_conf->rss_hf & ETH_RSS_NONFRAG_IPV4_UDP) {
 454                 priv->ppio_params.inqs_params.hash_type =
 455                         PP2_PPIO_HASH_T_5_TUPLE;
 456                 priv->rss_hf_tcp = 0;
 457         } else {
 458                 return -EINVAL;
 459         }
 460
 461         return 0;
 462 }
 463
 464 /**
 465  * Ethernet device configuration.
 466  *
 467  * Prepare the driver for a given number of TX and RX queues and
 468  * configure RSS.
 469  *
 470  * @param dev
 471  *   Pointer to Ethernet device structure.
 472  *
 473  * @return
 474  *   0 on success, negative error value otherwise.
 475  */
 476 static int
 477 mrvl_dev_configure(struct rte_eth_dev *dev)
 478 {
 479         struct mrvl_priv *priv = dev->data->dev_private;
 480         int ret;
 481
 482         if (priv->ppio) {
 483                 MRVL_LOG(INFO, "Device reconfiguration is not supported");
 484                 return -EINVAL;
 485         }
 486
 487         if (dev->data->dev_conf.rxmode.mq_mode != ETH_MQ_RX_NONE &&
 488             dev->data->dev_conf.rxmode.mq_mode != ETH_MQ_RX_RSS) {
 489                 MRVL_LOG(INFO, "Unsupported rx multi queue mode %d",
 490                         dev->data->dev_conf.rxmode.mq_mode);
 491                 return -EINVAL;
 492         }
 493
 494         if (dev->data->dev_conf.rxmode.split_hdr_size) {
 495                 MRVL_LOG(INFO, "Split headers not supported");
 496                 return -EINVAL;
 497         }
 498
 499         if (dev->data->dev_conf.rxmode.offloads & DEV_RX_OFFLOAD_JUMBO_FRAME) {
 500                 dev->data->mtu = dev->data->dev_conf.rxmode.max_rx_pkt_len -
 501                                  MRVL_PP2_ETH_HDRS_LEN;
 502                 if (dev->data->mtu > priv->max_mtu) {
 503                         MRVL_LOG(ERR, "inherit MTU %u from max_rx_pkt_len %u is larger than max_mtu %u\n",
 504                                  dev->data->mtu,
 505                                  dev->data->dev_conf.rxmode.max_rx_pkt_len,
 506                                  priv->max_mtu);
 507                         return -EINVAL;
 508                 }
 509         }
 510
 511         if (dev->data->dev_conf.txmode.offloads & DEV_TX_OFFLOAD_MULTI_SEGS)
 512                 priv->multiseg = 1;
 513
 514         ret = mrvl_configure_rxqs(priv, dev->data->port_id,
 515                                   dev->data->nb_rx_queues);
 516         if (ret < 0)
 517                 return ret;
 518
 519         ret = mrvl_configure_txqs(priv, dev->data->port_id,
 520                                   dev->data->nb_tx_queues);
 521         if (ret < 0)
 522                 return ret;
 523
 524         priv->ppio_params.outqs_params.num_outqs = dev->data->nb_tx_queues;
 525         priv->ppio_params.maintain_stats = 1;
 526         priv->nb_rx_queues = dev->data->nb_rx_queues;
 527
 528         ret = mrvl_tm_init(dev);
 529         if (ret < 0)
 530                 return ret;
 531
 532         if (dev->data->nb_rx_queues == 1 &&
 533             dev->data->dev_conf.rxmode.mq_mode == ETH_MQ_RX_RSS) {
 534                 MRVL_LOG(WARNING, "Disabling hash for 1 rx queue");
 535                 priv->ppio_params.inqs_params.hash_type = PP2_PPIO_HASH_T_NONE;
 536
 537                 return 0;
 538         }
 539
 540         return mrvl_configure_rss(priv,
 541                         &dev->data->dev_conf.rx_adv_conf.rss_conf);
 542 }
 543
 544 /**
 545  * DPDK callback to change the MTU.
 546  *
 547  * Setting the MTU affects hardware MRU (packets larger than the MRU
 548  * will be dropped).
 549  *
 550  * @param dev
 551  *   Pointer to Ethernet device structure.
 552  * @param mtu
 553  *   New MTU.
 554  *
 555  * @return
 556  *   0 on success, negative error value otherwise.
 557  */
 558 static int
 559 mrvl_mtu_set(struct rte_eth_dev *dev, uint16_t mtu)
 560 {
 561         struct mrvl_priv *priv = dev->data->dev_private;
 562         uint16_t mru;
 563         uint16_t mbuf_data_size = 0; /* SW buffer size */
 564         int ret;
 565
 566         mru = MRVL_PP2_MTU_TO_MRU(mtu);
 567         /*
 568          * min_rx_buf_size is equal to mbuf data size
 569          * if pmd didn't set it differently
 570          */
 571         mbuf_data_size = dev->data->min_rx_buf_size - RTE_PKTMBUF_HEADROOM;
 572         /* Prevent PMD from:
 573          * - setting mru greater than the mbuf size resulting in
 574          * hw and sw buffer size mismatch
 575          * - setting mtu that requires the support of scattered packets
 576          * when this feature has not been enabled/supported so far
 577          * (TODO check scattered_rx flag here once scattered RX is supported).
 578          */
 579         if (mru - RTE_ETHER_CRC_LEN + MRVL_PKT_OFFS > mbuf_data_size) {
 580                 mru = mbuf_data_size + RTE_ETHER_CRC_LEN - MRVL_PKT_OFFS;
 581                 mtu = MRVL_PP2_MRU_TO_MTU(mru);
 582                 MRVL_LOG(WARNING, "MTU too big, max MTU possible limitted "
 583                         "by current mbuf size: %u. Set MTU to %u, MRU to %u",
 584                         mbuf_data_size, mtu, mru);
 585         }
 586
 587         if (mtu < RTE_ETHER_MIN_MTU || mru > MRVL_PKT_SIZE_MAX) {
 588                 MRVL_LOG(ERR, "Invalid MTU [%u] or MRU [%u]", mtu, mru);
 589                 return -EINVAL;
 590         }
 591
 592         dev->data->mtu = mtu;
 593         dev->data->dev_conf.rxmode.max_rx_pkt_len = mru - MV_MH_SIZE;
 594
 595         if (!priv->ppio)
 596                 return 0;
 597
 598         ret = pp2_ppio_set_mru(priv->ppio, mru);
 599         if (ret) {
 600                 MRVL_LOG(ERR, "Failed to change MRU");
 601                 return ret;
 602         }
 603
 604         ret = pp2_ppio_set_mtu(priv->ppio, mtu);
 605         if (ret) {
 606                 MRVL_LOG(ERR, "Failed to change MTU");
 607                 return ret;
 608         }
 609
 610         return 0;
 611 }
 612
 613 /**
 614  * DPDK callback to bring the link up.
 615  *
 616  * @param dev
 617  *   Pointer to Ethernet device structure.
 618  *
 619  * @return
 620  *   0 on success, negative error value otherwise.
 621  */
 622 static int
 623 mrvl_dev_set_link_up(struct rte_eth_dev *dev)
 624 {
 625         struct mrvl_priv *priv = dev->data->dev_private;
 626         int ret;
 627
 628         if (!priv->ppio) {
 629                 dev->data->dev_link.link_status = ETH_LINK_UP;
 630                 return 0;
 631         }
 632
 633         ret = pp2_ppio_enable(priv->ppio);
 634         if (ret)
 635                 return ret;
 636
 637         /*
 638          * mtu/mru can be updated if pp2_ppio_enable() was called at least once
 639          * as pp2_ppio_enable() changes port->t_mode from default 0 to
 640          * PP2_TRAFFIC_INGRESS_EGRESS.
 641          *
 642          * Set mtu to default DPDK value here.
 643          */
 644         ret = mrvl_mtu_set(dev, dev->data->mtu);
 645         if (ret) {
 646                 pp2_ppio_disable(priv->ppio);
 647                 return ret;
 648         }
 649
 650         dev->data->dev_link.link_status = ETH_LINK_UP;
 651         return 0;
 652 }
 653
 654 /**
 655  * DPDK callback to bring the link down.
 656  *
 657  * @param dev
 658  *   Pointer to Ethernet device structure.
 659  *
 660  * @return
 661  *   0 on success, negative error value otherwise.
 662  */
 663 static int
 664 mrvl_dev_set_link_down(struct rte_eth_dev *dev)
 665 {
 666         struct mrvl_priv *priv = dev->data->dev_private;
 667         int ret;
 668
 669         if (!priv->ppio) {
 670                 dev->data->dev_link.link_status = ETH_LINK_DOWN;
 671                 return 0;
 672         }
 673         ret = pp2_ppio_disable(priv->ppio);
 674         if (ret)
 675                 return ret;
 676
 677         dev->data->dev_link.link_status = ETH_LINK_DOWN;
 678         return 0;
 679 }
 680
 681 /**
 682  * DPDK callback to start tx queue.
 683  *
 684  * @param dev
 685  *   Pointer to Ethernet device structure.
 686  * @param queue_id
 687  *   Transmit queue index.
 688  *
 689  * @return
 690  *   0 on success, negative error value otherwise.
 691  */
 692 static int
 693 mrvl_tx_queue_start(struct rte_eth_dev *dev, uint16_t queue_id)
 694 {
 695         struct mrvl_priv *priv = dev->data->dev_private;
 696         int ret;
 697
 698         if (!priv)
 699                 return -EPERM;
 700
 701         /* passing 1 enables given tx queue */
 702         ret = pp2_ppio_set_outq_state(priv->ppio, queue_id, 1);
 703         if (ret) {
 704                 MRVL_LOG(ERR, "Failed to start txq %d", queue_id);
 705                 return ret;
 706         }
 707
 708         dev->data->tx_queue_state[queue_id] = RTE_ETH_QUEUE_STATE_STARTED;
 709
 710         return 0;
 711 }
 712
 713 /**
 714  * DPDK callback to stop tx queue.
 715  *
 716  * @param dev
 717  *   Pointer to Ethernet device structure.
 718  * @param queue_id
 719  *   Transmit queue index.
 720  *
 721  * @return
 722  *   0 on success, negative error value otherwise.
 723  */
 724 static int
 725 mrvl_tx_queue_stop(struct rte_eth_dev *dev, uint16_t queue_id)
 726 {
 727         struct mrvl_priv *priv = dev->data->dev_private;
 728         int ret;
 729
 730         if (!priv->ppio)
 731                 return -EPERM;
 732
 733         /* passing 0 disables given tx queue */
 734         ret = pp2_ppio_set_outq_state(priv->ppio, queue_id, 0);
 735         if (ret) {
 736                 MRVL_LOG(ERR, "Failed to stop txq %d", queue_id);
 737                 return ret;
 738         }
 739
 740         dev->data->tx_queue_state[queue_id] = RTE_ETH_QUEUE_STATE_STOPPED;
 741
 742         return 0;
 743 }
 744
 745 /**
 746  * Populate VLAN Filter configuration.
 747  *
 748  * @param dev
 749  *   Pointer to Ethernet device structure.
 750  * @param on
 751  *   Toggle filter.
 752  *
 753  * @return
 754  *   0 on success, negative error value otherwise.
 755  */
 756 static int mrvl_populate_vlan_table(struct rte_eth_dev *dev, int on)
 757 {
 758         uint32_t j;
 759         int ret;
 760         struct rte_vlan_filter_conf *vfc;
 761
 762         vfc = &dev->data->vlan_filter_conf;
 763         for (j = 0; j < RTE_DIM(vfc->ids); j++) {
 764                 uint64_t vlan;
 765                 uint64_t vbit;
 766                 uint64_t ids = vfc->ids[j];
 767
 768                 if (ids == 0)
 769                         continue;
 770
 771                 while (ids) {
 772                         vlan = 64 * j;
 773                         /* count trailing zeroes */
 774                         vbit = ~ids & (ids - 1);
 775                         /* clear least significant bit set */
 776                         ids ^= (ids ^ (ids - 1)) ^ vbit;
 777                         for (; vbit; vlan++)
 778                                 vbit >>= 1;
 779                         ret = mrvl_vlan_filter_set(dev, vlan, on);
 780                         if (ret) {
 781                                 MRVL_LOG(ERR, "Failed to setup VLAN filter\n");
 782                                 return ret;
 783                         }
 784                 }
 785         }
 786
 787         return 0;
 788 }
 789
 790 /**
 791  * DPDK callback to start the device.
 792  *
 793  * @param dev
 794  *   Pointer to Ethernet device structure.
 795  *
 796  * @return
 797  *   0 on success, negative errno value on failure.
 798  */
 799 static int
 800 mrvl_dev_start(struct rte_eth_dev *dev)
 801 {
 802         struct mrvl_priv *priv = dev->data->dev_private;
 803         char match[MRVL_MATCH_LEN];
 804         int ret = 0, i, def_init_size;
 805         struct rte_ether_addr *mac_addr;
 806
 807         if (priv->ppio)
 808                 return mrvl_dev_set_link_up(dev);
 809
 810         snprintf(match, sizeof(match), "ppio-%d:%d",
 811                  priv->pp_id, priv->ppio_id);
 812         priv->ppio_params.match = match;
 813         priv->ppio_params.eth_start_hdr = PP2_PPIO_HDR_ETH;
 814         priv->forward_bad_frames = 0;
 815         priv->fill_bpool_buffs = MRVL_BURST_SIZE;
 816
 817         if (mrvl_cfg) {
 818                 priv->ppio_params.eth_start_hdr =
 819                         mrvl_cfg->port[dev->data->port_id].eth_start_hdr;
 820                 priv->forward_bad_frames =
 821                         mrvl_cfg->port[dev->data->port_id].forward_bad_frames;
 822                 priv->fill_bpool_buffs =
 823                         mrvl_cfg->port[dev->data->port_id].fill_bpool_buffs;
 824         }
 825
 826         /*
 827          * Calculate the minimum bpool size for refill feature as follows:
 828          * 2 default burst sizes multiply by number of rx queues.
 829          * If the bpool size will be below this value, new buffers will
 830          * be added to the pool.
 831          */
 832         priv->bpool_min_size = priv->nb_rx_queues * MRVL_BURST_SIZE * 2;
 833
 834         /* In case initial bpool size configured in queues setup is
 835          * smaller than minimum size add more buffers
 836          */
 837         def_init_size = priv->bpool_min_size + MRVL_BURST_SIZE * 2;
 838         if (priv->bpool_init_size < def_init_size) {
 839                 int buffs_to_add = def_init_size - priv->bpool_init_size;
 840
 841                 priv->bpool_init_size += buffs_to_add;
 842                 ret = mrvl_fill_bpool(dev->data->rx_queues[0], buffs_to_add);
 843                 if (ret)
 844                         MRVL_LOG(ERR, "Failed to add buffers to bpool");
 845         }
 846
 847         /*
 848          * Calculate the maximum bpool size for refill feature as follows:
 849          * maximum number of descriptors in rx queue multiply by number
 850          * of rx queues plus minimum bpool size.
 851          * In case the bpool size will exceed this value, superfluous buffers
 852          * will be removed
 853          */
 854         priv->bpool_max_size = (priv->nb_rx_queues * MRVL_PP2_RXD_MAX) +
 855                                 priv->bpool_min_size;
 856
 857         ret = pp2_ppio_init(&priv->ppio_params, &priv->ppio);
 858         if (ret) {
 859                 MRVL_LOG(ERR, "Failed to init ppio");
 860                 return ret;
 861         }
 862
 863         /*
 864          * In case there are some some stale uc/mc mac addresses flush them
 865          * here. It cannot be done during mrvl_dev_close() as port information
 866          * is already gone at that point (due to pp2_ppio_deinit() in
 867          * mrvl_dev_stop()).
 868          */
 869         if (!priv->uc_mc_flushed) {
 870                 ret = pp2_ppio_flush_mac_addrs(priv->ppio, 1, 1);
 871                 if (ret) {
 872                         MRVL_LOG(ERR,
 873                                 "Failed to flush uc/mc filter list");
 874                         goto out;
 875                 }
 876                 priv->uc_mc_flushed = 1;
 877         }
 878
 879         ret = mrvl_mtu_set(dev, dev->data->mtu);
 880         if (ret)
 881                 MRVL_LOG(ERR, "Failed to set MTU to %d", dev->data->mtu);
 882
 883         if (!rte_is_zero_ether_addr(&dev->data->mac_addrs[0]))
 884                 mrvl_mac_addr_set(dev, &dev->data->mac_addrs[0]);
 885
 886         for (i = 1; i < MRVL_MAC_ADDRS_MAX; i++) {
 887                 mac_addr = &dev->data->mac_addrs[i];
 888
 889                 /* skip zero address */
 890                 if (rte_is_zero_ether_addr(mac_addr))
 891                         continue;
 892
 893                 mrvl_mac_addr_add(dev, mac_addr, i, 0);
 894         }
 895
 896         if (dev->data->all_multicast == 1)
 897                 mrvl_allmulticast_enable(dev);
 898
 899         if (dev->data->dev_conf.rxmode.offloads & DEV_RX_OFFLOAD_VLAN_FILTER) {
 900                 ret = mrvl_populate_vlan_table(dev, 1);
 901                 if (ret) {
 902                         MRVL_LOG(ERR, "Failed to populate VLAN table");
 903                         goto out;
 904                 }
 905         }
 906
 907         /* For default QoS config, don't start classifier. */
 908         if (mrvl_cfg  &&
 909             mrvl_cfg->port[dev->data->port_id].use_qos_global_defaults == 0) {
 910                 ret = mrvl_start_qos_mapping(priv);
 911                 if (ret) {
 912                         MRVL_LOG(ERR, "Failed to setup QoS mapping");
 913                         goto out;
 914                 }
 915         }
 916
 917         ret = pp2_ppio_set_loopback(priv->ppio, dev->data->dev_conf.lpbk_mode);
 918         if (ret) {
 919                 MRVL_LOG(ERR, "Failed to set loopback");
 920                 goto out;
 921         }
 922
 923         if (dev->data->promiscuous == 1)
 924                 mrvl_promiscuous_enable(dev);
 925
 926         if (priv->flow_ctrl) {
 927                 ret = mrvl_flow_ctrl_set(dev, &priv->fc_conf);
 928                 if (ret) {
 929                         MRVL_LOG(ERR, "Failed to configure flow control");
 930                         goto out;
 931                 }
 932                 priv->flow_ctrl = 0;
 933         }
 934
 935         if (dev->data->dev_link.link_status == ETH_LINK_UP) {
 936                 ret = mrvl_dev_set_link_up(dev);
 937                 if (ret) {
 938                         MRVL_LOG(ERR, "Failed to set link up");
 939                         dev->data->dev_link.link_status = ETH_LINK_DOWN;
 940                         goto out;
 941                 }
 942         }
 943
 944         /* start tx queues */
 945         for (i = 0; i < dev->data->nb_tx_queues; i++) {
 946                 struct mrvl_txq *txq = dev->data->tx_queues[i];
 947
 948                 dev->data->tx_queue_state[i] = RTE_ETH_QUEUE_STATE_STARTED;
 949
 950                 if (!txq->tx_deferred_start)
 951                         continue;
 952
 953                 /*
 954                  * All txqs are started by default. Stop them
 955                  * so that tx_deferred_start works as expected.
 956                  */
 957                 ret = mrvl_tx_queue_stop(dev, i);
 958                 if (ret)
 959                         goto out;
 960         }
 961
 962         mrvl_flow_init(dev);
 963         mrvl_mtr_init(dev);
 964         mrvl_set_tx_function(dev);
 965
 966         return 0;
 967 out:
 968         MRVL_LOG(ERR, "Failed to start device");
 969         pp2_ppio_deinit(priv->ppio);
 970         return ret;
 971 }
 972
 973 /**
 974  * Flush receive queues.
 975  *
 976  * @param dev
 977  *   Pointer to Ethernet device structure.
 978  */
 979 static void
 980 mrvl_flush_rx_queues(struct rte_eth_dev *dev)
 981 {
 982         int i;
 983
 984         MRVL_LOG(INFO, "Flushing rx queues");
 985         for (i = 0; i < dev->data->nb_rx_queues; i++) {
 986                 int ret, num;
 987
 988                 do {
 989                         struct mrvl_rxq *q = dev->data->rx_queues[i];
 990                         struct pp2_ppio_desc descs[MRVL_PP2_RXD_MAX];
 991
 992                         num = MRVL_PP2_RXD_MAX;
 993                         ret = pp2_ppio_recv(q->priv->ppio,
 994                                             q->priv->rxq_map[q->queue_id].tc,
 995                                             q->priv->rxq_map[q->queue_id].inq,
 996                                             descs, (uint16_t *)&num);
 997                 } while (ret == 0 && num);
 998         }
 999 }
1000
1001 /**
1002  * Flush transmit shadow queues.
1003  *
1004  * @param dev
1005  *   Pointer to Ethernet device structure.
1006  */
1007 static void
1008 mrvl_flush_tx_shadow_queues(struct rte_eth_dev *dev)
1009 {
1010         int i, j;
1011         struct mrvl_txq *txq;
1012
1013         MRVL_LOG(INFO, "Flushing tx shadow queues");
1014         for (i = 0; i < dev->data->nb_tx_queues; i++) {
1015                 txq = (struct mrvl_txq *)dev->data->tx_queues[i];
1016
1017                 for (j = 0; j < RTE_MAX_LCORE; j++) {
1018                         struct mrvl_shadow_txq *sq;
1019
1020                         if (!hifs[j])
1021                                 continue;
1022
1023                         sq = &txq->shadow_txqs[j];
1024                         mrvl_free_sent_buffers(txq->priv->ppio,
1025                                 hifs[j], j, sq, txq->queue_id, 1);
1026                         while (sq->tail != sq->head) {
1027                                 uint64_t addr = cookie_addr_high |
1028                                         sq->ent[sq->tail].buff.cookie;
1029                                 rte_pktmbuf_free(
1030                                         (struct rte_mbuf *)addr);
1031                                 sq->tail = (sq->tail + 1) &
1032                                             MRVL_PP2_TX_SHADOWQ_MASK;
1033                         }
1034                         memset(sq, 0, sizeof(*sq));
1035                 }
1036         }
1037 }
1038
1039 /**
1040  * Flush hardware bpool (buffer-pool).
1041  *
1042  * @param dev
1043  *   Pointer to Ethernet device structure.
1044  */
1045 static void
1046 mrvl_flush_bpool(struct rte_eth_dev *dev)
1047 {
1048         struct mrvl_priv *priv = dev->data->dev_private;
1049         struct pp2_hif *hif;
1050         uint32_t num;
1051         int ret;
1052         unsigned int core_id = rte_lcore_id();
1053
1054         if (core_id == LCORE_ID_ANY)
1055                 core_id = rte_get_main_lcore();
1056
1057         hif = mrvl_get_hif(priv, core_id);
1058
1059         ret = pp2_bpool_get_num_buffs(priv->bpool, &num);
1060         if (ret) {
1061                 MRVL_LOG(ERR, "Failed to get bpool buffers number");
1062                 return;
1063         }
1064
1065         while (num--) {
1066                 struct pp2_buff_inf inf;
1067                 uint64_t addr;
1068
1069                 ret = pp2_bpool_get_buff(hif, priv->bpool, &inf);
1070                 if (ret)
1071                         break;
1072
1073                 addr = cookie_addr_high | inf.cookie;
1074                 rte_pktmbuf_free((struct rte_mbuf *)addr);
1075         }
1076 }
1077
1078 /**
1079  * DPDK callback to stop the device.
1080  *
1081  * @param dev
1082  *   Pointer to Ethernet device structure.
1083  */
1084 static int
1085 mrvl_dev_stop(struct rte_eth_dev *dev)
1086 {
1087         return mrvl_dev_set_link_down(dev);
1088 }
1089
1090 /**
1091  * DPDK callback to close the device.
1092  *
1093  * @param dev
1094  *   Pointer to Ethernet device structure.
1095  */
1096 static int
1097 mrvl_dev_close(struct rte_eth_dev *dev)
1098 {
1099         struct mrvl_priv *priv = dev->data->dev_private;
1100         size_t i;
1101
1102         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
1103                 return 0;
1104
1105         mrvl_flush_rx_queues(dev);
1106         mrvl_flush_tx_shadow_queues(dev);
1107         mrvl_flow_deinit(dev);
1108         mrvl_mtr_deinit(dev);
1109
1110         for (i = 0; i < priv->ppio_params.inqs_params.num_tcs; ++i) {
1111                 struct pp2_ppio_tc_params *tc_params =
1112                         &priv->ppio_params.inqs_params.tcs_params[i];
1113
1114                 if (tc_params->inqs_params) {
1115                         rte_free(tc_params->inqs_params);
1116                         tc_params->inqs_params = NULL;
1117                 }
1118         }
1119
1120         if (priv->cls_tbl) {
1121                 pp2_cls_tbl_deinit(priv->cls_tbl);
1122                 priv->cls_tbl = NULL;
1123         }
1124
1125         if (priv->qos_tbl) {
1126                 pp2_cls_qos_tbl_deinit(priv->qos_tbl);
1127                 priv->qos_tbl = NULL;
1128         }
1129
1130         mrvl_flush_bpool(dev);
1131         mrvl_tm_deinit(dev);
1132
1133         if (priv->ppio) {
1134                 pp2_ppio_deinit(priv->ppio);
1135                 priv->ppio = NULL;
1136         }
1137
1138         /* policer must be released after ppio deinitialization */
1139         if (priv->default_policer) {
1140                 pp2_cls_plcr_deinit(priv->default_policer);
1141                 priv->default_policer = NULL;
1142         }
1143
1144
1145         if (priv->bpool) {
1146                 pp2_bpool_deinit(priv->bpool);
1147                 used_bpools[priv->pp_id] &= ~(1 << priv->bpool_bit);
1148                 priv->bpool = NULL;
1149         }
1150
1151         mrvl_dev_num--;
1152
1153         if (mrvl_dev_num == 0) {
1154                 MRVL_LOG(INFO, "Perform MUSDK deinit");
1155                 mrvl_deinit_hifs();
1156                 mrvl_deinit_pp2();
1157                 rte_mvep_deinit(MVEP_MOD_T_PP2);
1158         }
1159
1160         return 0;
1161 }
1162
1163 /**
1164  * DPDK callback to retrieve physical link information.
1165  *
1166  * @param dev
1167  *   Pointer to Ethernet device structure.
1168  * @param wait_to_complete
1169  *   Wait for request completion (ignored).
1170  *
1171  * @return
1172  *   0 on success, negative error value otherwise.
1173  */
1174 static int
1175 mrvl_link_update(struct rte_eth_dev *dev, int wait_to_complete __rte_unused)
1176 {
1177         /*
1178          * TODO
1179          * once MUSDK provides necessary API use it here
1180          */
1181         struct mrvl_priv *priv = dev->data->dev_private;
1182         struct ethtool_cmd edata;
1183         struct ifreq req;
1184         int ret, fd, link_up;
1185
1186         if (!priv->ppio)
1187                 return -EPERM;
1188
1189         edata.cmd = ETHTOOL_GSET;
1190
1191         strcpy(req.ifr_name, dev->data->name);
1192         req.ifr_data = (void *)&edata;
1193
1194         fd = socket(AF_INET, SOCK_DGRAM, 0);
1195         if (fd == -1)
1196                 return -EFAULT;
1197
1198         ret = ioctl(fd, SIOCETHTOOL, &req);
1199         if (ret == -1) {
1200                 close(fd);
1201                 return -EFAULT;
1202         }
1203
1204         close(fd);
1205
1206         switch (ethtool_cmd_speed(&edata)) {
1207         case SPEED_10:
1208                 dev->data->dev_link.link_speed = ETH_SPEED_NUM_10M;
1209                 break;
1210         case SPEED_100:
1211                 dev->data->dev_link.link_speed = ETH_SPEED_NUM_100M;
1212                 break;
1213         case SPEED_1000:
1214                 dev->data->dev_link.link_speed = ETH_SPEED_NUM_1G;
1215                 break;
1216         case SPEED_2500:
1217                 dev->data->dev_link.link_speed = ETH_SPEED_NUM_2_5G;
1218                 break;
1219         case SPEED_10000:
1220                 dev->data->dev_link.link_speed = ETH_SPEED_NUM_10G;
1221                 break;
1222         default:
1223                 dev->data->dev_link.link_speed = ETH_SPEED_NUM_NONE;
1224         }
1225
1226         dev->data->dev_link.link_duplex = edata.duplex ? ETH_LINK_FULL_DUPLEX :
1227                                                          ETH_LINK_HALF_DUPLEX;
1228         dev->data->dev_link.link_autoneg = edata.autoneg ? ETH_LINK_AUTONEG :
1229                                                            ETH_LINK_FIXED;
1230         pp2_ppio_get_link_state(priv->ppio, &link_up);
1231         dev->data->dev_link.link_status = link_up ? ETH_LINK_UP : ETH_LINK_DOWN;
1232
1233         return 0;
1234 }
1235
1236 /**
1237  * DPDK callback to enable promiscuous mode.
1238  *
1239  * @param dev
1240  *   Pointer to Ethernet device structure.
1241  *
1242  * @return
1243  *   0 on success, negative error value otherwise.
1244  */
1245 static int
1246 mrvl_promiscuous_enable(struct rte_eth_dev *dev)
1247 {
1248         struct mrvl_priv *priv = dev->data->dev_private;
1249         int ret;
1250
1251         if (priv->isolated)
1252                 return -ENOTSUP;
1253
1254         if (!priv->ppio)
1255                 return 0;
1256
1257         ret = pp2_ppio_set_promisc(priv->ppio, 1);
1258         if (ret) {
1259                 MRVL_LOG(ERR, "Failed to enable promiscuous mode");
1260                 return -EAGAIN;
1261         }
1262
1263         return 0;
1264 }
1265
1266 /**
1267  * DPDK callback to enable allmulti mode.
1268  *
1269  * @param dev
1270  *   Pointer to Ethernet device structure.
1271  *
1272  * @return
1273  *   0 on success, negative error value otherwise.
1274  */
1275 static int
1276 mrvl_allmulticast_enable(struct rte_eth_dev *dev)
1277 {
1278         struct mrvl_priv *priv = dev->data->dev_private;
1279         int ret;
1280
1281         if (priv->isolated)
1282                 return -ENOTSUP;
1283
1284         if (!priv->ppio)
1285                 return 0;
1286
1287         ret = pp2_ppio_set_mc_promisc(priv->ppio, 1);
1288         if (ret) {
1289                 MRVL_LOG(ERR, "Failed enable all-multicast mode");
1290                 return -EAGAIN;
1291         }
1292
1293         return 0;
1294 }
1295
1296 /**
1297  * DPDK callback to disable promiscuous mode.
1298  *
1299  * @param dev
1300  *   Pointer to Ethernet device structure.
1301  *
1302  * @return
1303  *   0 on success, negative error value otherwise.
1304  */
1305 static int
1306 mrvl_promiscuous_disable(struct rte_eth_dev *dev)
1307 {
1308         struct mrvl_priv *priv = dev->data->dev_private;
1309         int ret;
1310
1311         if (priv->isolated)
1312                 return -ENOTSUP;
1313
1314         if (!priv->ppio)
1315                 return 0;
1316
1317         ret = pp2_ppio_set_promisc(priv->ppio, 0);
1318         if (ret) {
1319                 MRVL_LOG(ERR, "Failed to disable promiscuous mode");
1320                 return -EAGAIN;
1321         }
1322
1323         return 0;
1324 }
1325
1326 /**
1327  * DPDK callback to disable allmulticast mode.
1328  *
1329  * @param dev
1330  *   Pointer to Ethernet device structure.
1331  *
1332  * @return
1333  *   0 on success, negative error value otherwise.
1334  */
1335 static int
1336 mrvl_allmulticast_disable(struct rte_eth_dev *dev)
1337 {
1338         struct mrvl_priv *priv = dev->data->dev_private;
1339         int ret;
1340
1341         if (priv->isolated)
1342                 return -ENOTSUP;
1343
1344         if (!priv->ppio)
1345                 return 0;
1346
1347         ret = pp2_ppio_set_mc_promisc(priv->ppio, 0);
1348         if (ret) {
1349                 MRVL_LOG(ERR, "Failed to disable all-multicast mode");
1350                 return -EAGAIN;
1351         }
1352
1353         return 0;
1354 }
1355
1356 /**
1357  * DPDK callback to remove a MAC address.
1358  *
1359  * @param dev
1360  *   Pointer to Ethernet device structure.
1361  * @param index
1362  *   MAC address index.
1363  */
1364 static void
1365 mrvl_mac_addr_remove(struct rte_eth_dev *dev, uint32_t index)
1366 {
1367         struct mrvl_priv *priv = dev->data->dev_private;
1368         char buf[RTE_ETHER_ADDR_FMT_SIZE];
1369         int ret;
1370
1371         if (priv->isolated)
1372                 return;
1373
1374         if (!priv->ppio)
1375                 return;
1376
1377         ret = pp2_ppio_remove_mac_addr(priv->ppio,
1378                                        dev->data->mac_addrs[index].addr_bytes);
1379         if (ret) {
1380                 rte_ether_format_addr(buf, sizeof(buf),
1381                                   &dev->data->mac_addrs[index]);
1382                 MRVL_LOG(ERR, "Failed to remove mac %s", buf);
1383         }
1384 }
1385
1386 /**
1387  * DPDK callback to add a MAC address.
1388  *
1389  * @param dev
1390  *   Pointer to Ethernet device structure.
1391  * @param mac_addr
1392  *   MAC address to register.
1393  * @param index
1394  *   MAC address index.
1395  * @param vmdq
1396  *   VMDq pool index to associate address with (unused).
1397  *
1398  * @return
1399  *   0 on success, negative error value otherwise.
1400  */
1401 static int
1402 mrvl_mac_addr_add(struct rte_eth_dev *dev, struct rte_ether_addr *mac_addr,
1403                   uint32_t index, uint32_t vmdq __rte_unused)
1404 {
1405         struct mrvl_priv *priv = dev->data->dev_private;
1406         char buf[RTE_ETHER_ADDR_FMT_SIZE];
1407         int ret;
1408
1409         if (priv->isolated)
1410                 return -ENOTSUP;
1411
1412         if (!priv->ppio)
1413                 return 0;
1414
1415         if (index == 0)
1416                 /* For setting index 0, mrvl_mac_addr_set() should be used.*/
1417                 return -1;
1418
1419         /*
1420          * Maximum number of uc addresses can be tuned via kernel module mvpp2x
1421          * parameter uc_filter_max. Maximum number of mc addresses is then
1422          * MRVL_MAC_ADDRS_MAX - uc_filter_max. Currently it defaults to 4 and
1423          * 21 respectively.
1424          *
1425          * If more than uc_filter_max uc addresses were added to filter list
1426          * then NIC will switch to promiscuous mode automatically.
1427          *
1428          * If more than MRVL_MAC_ADDRS_MAX - uc_filter_max number mc addresses
1429          * were added to filter list then NIC will switch to all-multicast mode
1430          * automatically.
1431          */
1432         ret = pp2_ppio_add_mac_addr(priv->ppio, mac_addr->addr_bytes);
1433         if (ret) {
1434                 rte_ether_format_addr(buf, sizeof(buf), mac_addr);
1435                 MRVL_LOG(ERR, "Failed to add mac %s", buf);
1436                 return -1;
1437         }
1438
1439         return 0;
1440 }
1441
1442 /**
1443  * DPDK callback to set the primary MAC address.
1444  *
1445  * @param dev
1446  *   Pointer to Ethernet device structure.
1447  * @param mac_addr
1448  *   MAC address to register.
1449  *
1450  * @return
1451  *   0 on success, negative error value otherwise.
1452  */
1453 static int
1454 mrvl_mac_addr_set(struct rte_eth_dev *dev, struct rte_ether_addr *mac_addr)
1455 {
1456         struct mrvl_priv *priv = dev->data->dev_private;
1457         int ret;
1458
1459         if (priv->isolated)
1460                 return -ENOTSUP;
1461
1462         if (!priv->ppio)
1463                 return 0;
1464
1465         ret = pp2_ppio_set_mac_addr(priv->ppio, mac_addr->addr_bytes);
1466         if (ret) {
1467                 char buf[RTE_ETHER_ADDR_FMT_SIZE];
1468                 rte_ether_format_addr(buf, sizeof(buf), mac_addr);
1469                 MRVL_LOG(ERR, "Failed to set mac to %s", buf);
1470         }
1471
1472         return ret;
1473 }
1474
1475 /**
1476  * DPDK callback to get device statistics.
1477  *
1478  * @param dev
1479  *   Pointer to Ethernet device structure.
1480  * @param stats
1481  *   Stats structure output buffer.
1482  *
1483  * @return
1484  *   0 on success, negative error value otherwise.
1485  */
1486 static int
1487 mrvl_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
1488 {
1489         struct mrvl_priv *priv = dev->data->dev_private;
1490         struct pp2_ppio_statistics ppio_stats;
1491         uint64_t drop_mac = 0;
1492         unsigned int i, idx, ret;
1493
1494         if (!priv->ppio)
1495                 return -EPERM;
1496
1497         for (i = 0; i < dev->data->nb_rx_queues; i++) {
1498                 struct mrvl_rxq *rxq = dev->data->rx_queues[i];
1499                 struct pp2_ppio_inq_statistics rx_stats;
1500
1501                 if (!rxq)
1502                         continue;
1503
1504                 idx = rxq->queue_id;
1505                 if (unlikely(idx >= RTE_ETHDEV_QUEUE_STAT_CNTRS)) {
1506                         MRVL_LOG(ERR,
1507                                 "rx queue %d stats out of range (0 - %d)",
1508                                 idx, RTE_ETHDEV_QUEUE_STAT_CNTRS - 1);
1509                         continue;
1510                 }
1511
1512                 ret = pp2_ppio_inq_get_statistics(priv->ppio,
1513                                                   priv->rxq_map[idx].tc,
1514                                                   priv->rxq_map[idx].inq,
1515                                                   &rx_stats, 0);
1516                 if (unlikely(ret)) {
1517                         MRVL_LOG(ERR,
1518                                 "Failed to update rx queue %d stats", idx);
1519                         break;
1520                 }
1521
1522                 stats->q_ibytes[idx] = rxq->bytes_recv;
1523                 stats->q_ipackets[idx] = rx_stats.enq_desc - rxq->drop_mac;
1524                 stats->q_errors[idx] = rx_stats.drop_early +
1525                                        rx_stats.drop_fullq +
1526                                        rx_stats.drop_bm +
1527                                        rxq->drop_mac;
1528                 stats->ibytes += rxq->bytes_recv;
1529                 drop_mac += rxq->drop_mac;
1530         }
1531
1532         for (i = 0; i < dev->data->nb_tx_queues; i++) {
1533                 struct mrvl_txq *txq = dev->data->tx_queues[i];
1534                 struct pp2_ppio_outq_statistics tx_stats;
1535
1536                 if (!txq)
1537                         continue;
1538
1539                 idx = txq->queue_id;
1540                 if (unlikely(idx >= RTE_ETHDEV_QUEUE_STAT_CNTRS)) {
1541                         MRVL_LOG(ERR,
1542                                 "tx queue %d stats out of range (0 - %d)",
1543                                 idx, RTE_ETHDEV_QUEUE_STAT_CNTRS - 1);
1544                 }
1545
1546                 ret = pp2_ppio_outq_get_statistics(priv->ppio, idx,
1547                                                    &tx_stats, 0);
1548                 if (unlikely(ret)) {
1549                         MRVL_LOG(ERR,
1550                                 "Failed to update tx queue %d stats", idx);
1551                         break;
1552                 }
1553
1554                 stats->q_opackets[idx] = tx_stats.deq_desc;
1555                 stats->q_obytes[idx] = txq->bytes_sent;
1556                 stats->obytes += txq->bytes_sent;
1557         }
1558
1559         ret = pp2_ppio_get_statistics(priv->ppio, &ppio_stats, 0);
1560         if (unlikely(ret)) {
1561                 MRVL_LOG(ERR, "Failed to update port statistics");
1562                 return ret;
1563         }
1564
1565         stats->ipackets += ppio_stats.rx_packets - drop_mac;
1566         stats->opackets += ppio_stats.tx_packets;
1567         stats->imissed += ppio_stats.rx_fullq_dropped +
1568                           ppio_stats.rx_bm_dropped +
1569                           ppio_stats.rx_early_dropped +
1570                           ppio_stats.rx_fifo_dropped +
1571                           ppio_stats.rx_cls_dropped;
1572         stats->ierrors = drop_mac;
1573
1574         return 0;
1575 }
1576
1577 /**
1578  * DPDK callback to clear device statistics.
1579  *
1580  * @param dev
1581  *   Pointer to Ethernet device structure.
1582  *
1583  * @return
1584  *   0 on success, negative error value otherwise.
1585  */
1586 static int
1587 mrvl_stats_reset(struct rte_eth_dev *dev)
1588 {
1589         struct mrvl_priv *priv = dev->data->dev_private;
1590         int i;
1591
1592         if (!priv->ppio)
1593                 return 0;
1594
1595         for (i = 0; i < dev->data->nb_rx_queues; i++) {
1596                 struct mrvl_rxq *rxq = dev->data->rx_queues[i];
1597
1598                 pp2_ppio_inq_get_statistics(priv->ppio, priv->rxq_map[i].tc,
1599                                             priv->rxq_map[i].inq, NULL, 1);
1600                 rxq->bytes_recv = 0;
1601                 rxq->drop_mac = 0;
1602         }
1603
1604         for (i = 0; i < dev->data->nb_tx_queues; i++) {
1605                 struct mrvl_txq *txq = dev->data->tx_queues[i];
1606
1607                 pp2_ppio_outq_get_statistics(priv->ppio, i, NULL, 1);
1608                 txq->bytes_sent = 0;
1609         }
1610
1611         return pp2_ppio_get_statistics(priv->ppio, NULL, 1);
1612 }
1613
1614 /**
1615  * DPDK callback to get extended statistics.
1616  *
1617  * @param dev
1618  *   Pointer to Ethernet device structure.
1619  * @param stats
1620  *   Pointer to xstats table.
1621  * @param n
1622  *   Number of entries in xstats table.
1623  * @return
1624  *   Negative value on error, number of read xstats otherwise.
1625  */
1626 static int
1627 mrvl_xstats_get(struct rte_eth_dev *dev,
1628                 struct rte_eth_xstat *stats, unsigned int n)
1629 {
1630         struct mrvl_priv *priv = dev->data->dev_private;
1631         struct pp2_ppio_statistics ppio_stats;
1632         unsigned int i;
1633
1634         if (!stats)
1635                 return 0;
1636
1637         pp2_ppio_get_statistics(priv->ppio, &ppio_stats, 0);
1638         for (i = 0; i < n && i < RTE_DIM(mrvl_xstats_tbl); i++) {
1639                 uint64_t val;
1640
1641                 if (mrvl_xstats_tbl[i].size == sizeof(uint32_t))
1642                         val = *(uint32_t *)((uint8_t *)&ppio_stats +
1643                                             mrvl_xstats_tbl[i].offset);
1644                 else if (mrvl_xstats_tbl[i].size == sizeof(uint64_t))
1645                         val = *(uint64_t *)((uint8_t *)&ppio_stats +
1646                                             mrvl_xstats_tbl[i].offset);
1647                 else
1648                         return -EINVAL;
1649
1650                 stats[i].id = i;
1651                 stats[i].value = val;
1652         }
1653
1654         return n;
1655 }
1656
1657 /**
1658  * DPDK callback to reset extended statistics.
1659  *
1660  * @param dev
1661  *   Pointer to Ethernet device structure.
1662  *
1663  * @return
1664  *   0 on success, negative error value otherwise.
1665  */
1666 static int
1667 mrvl_xstats_reset(struct rte_eth_dev *dev)
1668 {
1669         return mrvl_stats_reset(dev);
1670 }
1671
1672 /**
1673  * DPDK callback to get extended statistics names.
1674  *
1675  * @param dev (unused)
1676  *   Pointer to Ethernet device structure.
1677  * @param xstats_names
1678  *   Pointer to xstats names table.
1679  * @param size
1680  *   Size of the xstats names table.
1681  * @return
1682  *   Number of read names.
1683  */
1684 static int
1685 mrvl_xstats_get_names(struct rte_eth_dev *dev __rte_unused,
1686                       struct rte_eth_xstat_name *xstats_names,
1687                       unsigned int size)
1688 {
1689         unsigned int i;
1690
1691         if (!xstats_names)
1692                 return RTE_DIM(mrvl_xstats_tbl);
1693
1694         for (i = 0; i < size && i < RTE_DIM(mrvl_xstats_tbl); i++)
1695                 strlcpy(xstats_names[i].name, mrvl_xstats_tbl[i].name,
1696                         RTE_ETH_XSTATS_NAME_SIZE);
1697
1698         return size;
1699 }
1700
1701 /**
1702  * DPDK callback to get information about the device.
1703  *
1704  * @param dev
1705  *   Pointer to Ethernet device structure (unused).
1706  * @param info
1707  *   Info structure output buffer.
1708  */
1709 static int
1710 mrvl_dev_infos_get(struct rte_eth_dev *dev,
1711                    struct rte_eth_dev_info *info)
1712 {
1713         struct mrvl_priv *priv = dev->data->dev_private;
1714
1715         info->speed_capa = ETH_LINK_SPEED_10M |
1716                            ETH_LINK_SPEED_100M |
1717                            ETH_LINK_SPEED_1G |
1718                            ETH_LINK_SPEED_2_5G |
1719                            ETH_LINK_SPEED_10G;
1720
1721         info->max_rx_queues = MRVL_PP2_RXQ_MAX;
1722         info->max_tx_queues = MRVL_PP2_TXQ_MAX;
1723         info->max_mac_addrs = MRVL_MAC_ADDRS_MAX;
1724
1725         info->rx_desc_lim.nb_max = MRVL_PP2_RXD_MAX;
1726         info->rx_desc_lim.nb_min = MRVL_PP2_RXD_MIN;
1727         info->rx_desc_lim.nb_align = MRVL_PP2_RXD_ALIGN;
1728
1729         info->tx_desc_lim.nb_max = MRVL_PP2_TXD_MAX;
1730         info->tx_desc_lim.nb_min = MRVL_PP2_TXD_MIN;
1731         info->tx_desc_lim.nb_align = MRVL_PP2_TXD_ALIGN;
1732
1733         info->rx_offload_capa = MRVL_RX_OFFLOADS;
1734         info->rx_queue_offload_capa = MRVL_RX_OFFLOADS;
1735
1736         info->tx_offload_capa = MRVL_TX_OFFLOADS;
1737         info->tx_queue_offload_capa = MRVL_TX_OFFLOADS;
1738
1739         info->flow_type_rss_offloads = ETH_RSS_IPV4 |
1740                                        ETH_RSS_NONFRAG_IPV4_TCP |
1741                                        ETH_RSS_NONFRAG_IPV4_UDP;
1742
1743         /* By default packets are dropped if no descriptors are available */
1744         info->default_rxconf.rx_drop_en = 1;
1745
1746         info->max_rx_pktlen = MRVL_PKT_SIZE_MAX;
1747         info->max_mtu = priv->max_mtu;
1748
1749         return 0;
1750 }
1751
1752 /**
1753  * Return supported packet types.
1754  *
1755  * @param dev
1756  *   Pointer to Ethernet device structure (unused).
1757  *
1758  * @return
1759  *   Const pointer to the table with supported packet types.
1760  */
1761 static const uint32_t *
1762 mrvl_dev_supported_ptypes_get(struct rte_eth_dev *dev __rte_unused)
1763 {
1764         static const uint32_t ptypes[] = {
1765                 RTE_PTYPE_L2_ETHER,
1766                 RTE_PTYPE_L2_ETHER_VLAN,
1767                 RTE_PTYPE_L2_ETHER_QINQ,
1768                 RTE_PTYPE_L3_IPV4,
1769                 RTE_PTYPE_L3_IPV4_EXT,
1770                 RTE_PTYPE_L3_IPV4_EXT_UNKNOWN,
1771                 RTE_PTYPE_L3_IPV6,
1772                 RTE_PTYPE_L3_IPV6_EXT,
1773                 RTE_PTYPE_L2_ETHER_ARP,
1774                 RTE_PTYPE_L4_TCP,
1775                 RTE_PTYPE_L4_UDP
1776         };
1777
1778         return ptypes;
1779 }
1780
1781 /**
1782  * DPDK callback to get information about specific receive queue.
1783  *
1784  * @param dev
1785  *   Pointer to Ethernet device structure.
1786  * @param rx_queue_id
1787  *   Receive queue index.
1788  * @param qinfo
1789  *   Receive queue information structure.
1790  */
1791 static void mrvl_rxq_info_get(struct rte_eth_dev *dev, uint16_t rx_queue_id,
1792                               struct rte_eth_rxq_info *qinfo)
1793 {
1794         struct mrvl_rxq *q = dev->data->rx_queues[rx_queue_id];
1795         struct mrvl_priv *priv = dev->data->dev_private;
1796         int inq = priv->rxq_map[rx_queue_id].inq;
1797         int tc = priv->rxq_map[rx_queue_id].tc;
1798         struct pp2_ppio_tc_params *tc_params =
1799                 &priv->ppio_params.inqs_params.tcs_params[tc];
1800
1801         qinfo->mp = q->mp;
1802         qinfo->nb_desc = tc_params->inqs_params[inq].size;
1803 }
1804
1805 /**
1806  * DPDK callback to get information about specific transmit queue.
1807  *
1808  * @param dev
1809  *   Pointer to Ethernet device structure.
1810  * @param tx_queue_id
1811  *   Transmit queue index.
1812  * @param qinfo
1813  *   Transmit queue information structure.
1814  */
1815 static void mrvl_txq_info_get(struct rte_eth_dev *dev, uint16_t tx_queue_id,
1816                               struct rte_eth_txq_info *qinfo)
1817 {
1818         struct mrvl_priv *priv = dev->data->dev_private;
1819         struct mrvl_txq *txq = dev->data->tx_queues[tx_queue_id];
1820
1821         qinfo->nb_desc =
1822                 priv->ppio_params.outqs_params.outqs_params[tx_queue_id].size;
1823         qinfo->conf.tx_deferred_start = txq->tx_deferred_start;
1824 }
1825
1826 /**
1827  * DPDK callback to Configure a VLAN filter.
1828  *
1829  * @param dev
1830  *   Pointer to Ethernet device structure.
1831  * @param vlan_id
1832  *   VLAN ID to filter.
1833  * @param on
1834  *   Toggle filter.
1835  *
1836  * @return
1837  *   0 on success, negative error value otherwise.
1838  */
1839 static int
1840 mrvl_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on)
1841 {
1842         struct mrvl_priv *priv = dev->data->dev_private;
1843
1844         if (priv->isolated)
1845                 return -ENOTSUP;
1846
1847         if (!priv->ppio)
1848                 return 0;
1849
1850         return on ? pp2_ppio_add_vlan(priv->ppio, vlan_id) :
1851                     pp2_ppio_remove_vlan(priv->ppio, vlan_id);
1852 }
1853
1854 /**
1855  * DPDK callback to Configure VLAN offload.
1856  *
1857  * @param dev
1858  *   Pointer to Ethernet device structure.
1859  * @param mask
1860  *   VLAN offload mask.
1861  *
1862  * @return
1863  *   0 on success, negative error value otherwise.
1864  */
1865 static int mrvl_vlan_offload_set(struct rte_eth_dev *dev, int mask)
1866 {
1867         uint64_t rx_offloads = dev->data->dev_conf.rxmode.offloads;
1868         int ret;
1869
1870         if (mask & ETH_VLAN_STRIP_MASK)
1871                 MRVL_LOG(ERR, "VLAN stripping is not supported\n");
1872
1873         if (mask & ETH_VLAN_FILTER_MASK) {
1874                 if (rx_offloads & DEV_RX_OFFLOAD_VLAN_FILTER)
1875                         ret = mrvl_populate_vlan_table(dev, 1);
1876                 else
1877                         ret = mrvl_populate_vlan_table(dev, 0);
1878
1879                 if (ret)
1880                         return ret;
1881         }
1882
1883         if (mask & ETH_VLAN_EXTEND_MASK)
1884                 MRVL_LOG(ERR, "Extend VLAN not supported\n");
1885
1886         return 0;
1887 }
1888
1889 /**
1890  * Release buffers to hardware bpool (buffer-pool)
1891  *
1892  * @param rxq
1893  *   Receive queue pointer.
1894  * @param num
1895  *   Number of buffers to release to bpool.
1896  *
1897  * @return
1898  *   0 on success, negative error value otherwise.
1899  */
1900 static int
1901 mrvl_fill_bpool(struct mrvl_rxq *rxq, int num)
1902 {
1903         struct buff_release_entry entries[num];
1904         struct rte_mbuf *mbufs[num];
1905         int i, ret;
1906         unsigned int core_id;
1907         struct pp2_hif *hif;
1908         struct pp2_bpool *bpool;
1909
1910         core_id = rte_lcore_id();
1911         if (core_id == LCORE_ID_ANY)
1912                 core_id = rte_get_main_lcore();
1913
1914         hif = mrvl_get_hif(rxq->priv, core_id);
1915         if (!hif)
1916                 return -1;
1917
1918         bpool = rxq->priv->bpool;
1919
1920         ret = rte_pktmbuf_alloc_bulk(rxq->mp, mbufs, num);
1921         if (ret)
1922                 return ret;
1923
1924         if (cookie_addr_high == MRVL_COOKIE_ADDR_INVALID)
1925                 cookie_addr_high =
1926                         (uint64_t)mbufs[0] & MRVL_COOKIE_HIGH_ADDR_MASK;
1927
1928         for (i = 0; i < num; i++) {
1929                 if (((uint64_t)mbufs[i] & MRVL_COOKIE_HIGH_ADDR_MASK)
1930                         != cookie_addr_high) {
1931                         MRVL_LOG(ERR,
1932                                 "mbuf virtual addr high is out of range "
1933                                 "0x%x instead of 0x%x\n",
1934                                 (uint32_t)((uint64_t)mbufs[i] >> 32),
1935                                 (uint32_t)(cookie_addr_high >> 32));
1936                         goto out;
1937                 }
1938
1939                 entries[i].buff.addr =
1940                         rte_mbuf_data_iova_default(mbufs[i]);
1941                 entries[i].buff.cookie = (uintptr_t)mbufs[i];
1942                 entries[i].bpool = bpool;
1943         }
1944
1945         pp2_bpool_put_buffs(hif, entries, (uint16_t *)&i);
1946         mrvl_port_bpool_size[bpool->pp2_id][bpool->id][core_id] += i;
1947
1948         if (i != num)
1949                 goto out;
1950
1951         return 0;
1952 out:
1953         for (; i < num; i++)
1954                 rte_pktmbuf_free(mbufs[i]);
1955
1956         return -1;
1957 }
1958
1959 /**
1960  * DPDK callback to configure the receive queue.
1961  *
1962  * @param dev
1963  *   Pointer to Ethernet device structure.
1964  * @param idx
1965  *   RX queue index.
1966  * @param desc
1967  *   Number of descriptors to configure in queue.
1968  * @param socket
1969  *   NUMA socket on which memory must be allocated.
1970  * @param conf
1971  *   Thresholds parameters.
1972  * @param mp
1973  *   Memory pool for buffer allocations.
1974  *
1975  * @return
1976  *   0 on success, negative error value otherwise.
1977  */
1978 static int
1979 mrvl_rx_queue_setup(struct rte_eth_dev *dev, uint16_t idx, uint16_t desc,
1980                     unsigned int socket,
1981                     const struct rte_eth_rxconf *conf,
1982                     struct rte_mempool *mp)
1983 {
1984         struct mrvl_priv *priv = dev->data->dev_private;
1985         struct mrvl_rxq *rxq;
1986         uint32_t frame_size, buf_size = rte_pktmbuf_data_room_size(mp);
1987         uint32_t max_rx_pkt_len = dev->data->dev_conf.rxmode.max_rx_pkt_len;
1988         int ret, tc, inq;
1989         uint64_t offloads;
1990
1991         offloads = conf->offloads | dev->data->dev_conf.rxmode.offloads;
1992
1993         if (priv->rxq_map[idx].tc == MRVL_UNKNOWN_TC) {
1994                 /*
1995                  * Unknown TC mapping, mapping will not have a correct queue.
1996                  */
1997                 MRVL_LOG(ERR, "Unknown TC mapping for queue %hu eth%hhu",
1998                         idx, priv->ppio_id);
1999                 return -EFAULT;
2000         }
2001
2002         frame_size = buf_size - RTE_PKTMBUF_HEADROOM -
2003                      MRVL_PKT_EFFEC_OFFS + RTE_ETHER_CRC_LEN;
2004         if (frame_size < max_rx_pkt_len) {
2005                 MRVL_LOG(WARNING,
2006                         "Mbuf size must be increased to %u bytes to hold up "
2007                         "to %u bytes of data.",
2008                         buf_size + max_rx_pkt_len - frame_size,
2009                         max_rx_pkt_len);
2010                 dev->data->dev_conf.rxmode.max_rx_pkt_len = frame_size;
2011                 MRVL_LOG(INFO, "Setting max rx pkt len to %u",
2012                         dev->data->dev_conf.rxmode.max_rx_pkt_len);
2013         }
2014
2015         if (dev->data->rx_queues[idx]) {
2016                 rte_free(dev->data->rx_queues[idx]);
2017                 dev->data->rx_queues[idx] = NULL;
2018         }
2019
2020         rxq = rte_zmalloc_socket("rxq", sizeof(*rxq), 0, socket);
2021         if (!rxq)
2022                 return -ENOMEM;
2023
2024         rxq->priv = priv;
2025         rxq->mp = mp;
2026         rxq->cksum_enabled = offloads & DEV_RX_OFFLOAD_IPV4_CKSUM;
2027         rxq->queue_id = idx;
2028         rxq->port_id = dev->data->port_id;
2029         mrvl_port_to_bpool_lookup[rxq->port_id] = priv->bpool;
2030
2031         tc = priv->rxq_map[rxq->queue_id].tc,
2032         inq = priv->rxq_map[rxq->queue_id].inq;
2033         priv->ppio_params.inqs_params.tcs_params[tc].inqs_params[inq].size =
2034                 desc;
2035
2036         ret = mrvl_fill_bpool(rxq, desc);
2037         if (ret) {
2038                 rte_free(rxq);
2039                 return ret;
2040         }
2041
2042         priv->bpool_init_size += desc;
2043
2044         dev->data->rx_queues[idx] = rxq;
2045
2046         return 0;
2047 }
2048
2049 /**
2050  * DPDK callback to release the receive queue.
2051  *
2052  * @param rxq
2053  *   Generic receive queue pointer.
2054  */
2055 static void
2056 mrvl_rx_queue_release(void *rxq)
2057 {
2058         struct mrvl_rxq *q = rxq;
2059         struct pp2_ppio_tc_params *tc_params;
2060         int i, num, tc, inq;
2061         struct pp2_hif *hif;
2062         unsigned int core_id = rte_lcore_id();
2063
2064         if (core_id == LCORE_ID_ANY)
2065                 core_id = rte_get_main_lcore();
2066
2067         if (!q)
2068                 return;
2069
2070         hif = mrvl_get_hif(q->priv, core_id);
2071
2072         if (!hif)
2073                 return;
2074
2075         tc = q->priv->rxq_map[q->queue_id].tc;
2076         inq = q->priv->rxq_map[q->queue_id].inq;
2077         tc_params = &q->priv->ppio_params.inqs_params.tcs_params[tc];
2078         num = tc_params->inqs_params[inq].size;
2079         for (i = 0; i < num; i++) {
2080                 struct pp2_buff_inf inf;
2081                 uint64_t addr;
2082
2083                 pp2_bpool_get_buff(hif, q->priv->bpool, &inf);
2084                 addr = cookie_addr_high | inf.cookie;
2085                 rte_pktmbuf_free((struct rte_mbuf *)addr);
2086         }
2087
2088         rte_free(q);
2089 }
2090
2091 /**
2092  * DPDK callback to configure the transmit queue.
2093  *
2094  * @param dev
2095  *   Pointer to Ethernet device structure.
2096  * @param idx
2097  *   Transmit queue index.
2098  * @param desc
2099  *   Number of descriptors to configure in the queue.
2100  * @param socket
2101  *   NUMA socket on which memory must be allocated.
2102  * @param conf
2103  *   Tx queue configuration parameters.
2104  *
2105  * @return
2106  *   0 on success, negative error value otherwise.
2107  */
2108 static int
2109 mrvl_tx_queue_setup(struct rte_eth_dev *dev, uint16_t idx, uint16_t desc,
2110                     unsigned int socket,
2111                     const struct rte_eth_txconf *conf)
2112 {
2113         struct mrvl_priv *priv = dev->data->dev_private;
2114         struct mrvl_txq *txq;
2115
2116         if (dev->data->tx_queues[idx]) {
2117                 rte_free(dev->data->tx_queues[idx]);
2118                 dev->data->tx_queues[idx] = NULL;
2119         }
2120
2121         txq = rte_zmalloc_socket("txq", sizeof(*txq), 0, socket);
2122         if (!txq)
2123                 return -ENOMEM;
2124
2125         txq->priv = priv;
2126         txq->queue_id = idx;
2127         txq->port_id = dev->data->port_id;
2128         txq->tx_deferred_start = conf->tx_deferred_start;
2129         dev->data->tx_queues[idx] = txq;
2130
2131         priv->ppio_params.outqs_params.outqs_params[idx].size = desc;
2132
2133         return 0;
2134 }
2135
2136 /**
2137  * DPDK callback to release the transmit queue.
2138  *
2139  * @param txq
2140  *   Generic transmit queue pointer.
2141  */
2142 static void
2143 mrvl_tx_queue_release(void *txq)
2144 {
2145         struct mrvl_txq *q = txq;
2146
2147         if (!q)
2148                 return;
2149
2150         rte_free(q);
2151 }
2152
2153 /**
2154  * DPDK callback to get flow control configuration.
2155  *
2156  * @param dev
2157  *  Pointer to Ethernet device structure.
2158  * @param fc_conf
2159  *  Pointer to the flow control configuration.
2160  *
2161  * @return
2162  *  0 on success, negative error value otherwise.
2163  */
2164 static int
2165 mrvl_flow_ctrl_get(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
2166 {
2167         struct mrvl_priv *priv = dev->data->dev_private;
2168         int ret, en;
2169
2170         if (!priv->ppio) {
2171                 memcpy(fc_conf, &priv->fc_conf, sizeof(struct rte_eth_fc_conf));
2172                 return 0;
2173         }
2174
2175         fc_conf->autoneg = 1;
2176         ret = pp2_ppio_get_rx_pause(priv->ppio, &en);
2177         if (ret) {
2178                 MRVL_LOG(ERR, "Failed to read rx pause state");
2179                 return ret;
2180         }
2181
2182         fc_conf->mode = en ? RTE_FC_RX_PAUSE : RTE_FC_NONE;
2183
2184         ret = pp2_ppio_get_tx_pause(priv->ppio, &en);
2185         if (ret) {
2186                 MRVL_LOG(ERR, "Failed to read tx pause state");
2187                 return ret;
2188         }
2189
2190         if (en) {
2191                 if (fc_conf->mode == RTE_FC_NONE)
2192                         fc_conf->mode = RTE_FC_TX_PAUSE;
2193                 else
2194                         fc_conf->mode = RTE_FC_FULL;
2195         }
2196
2197         return 0;
2198 }
2199
2200 /**
2201  * DPDK callback to set flow control configuration.
2202  *
2203  * @param dev
2204  *  Pointer to Ethernet device structure.
2205  * @param fc_conf
2206  *  Pointer to the flow control configuration.
2207  *
2208  * @return
2209  *  0 on success, negative error value otherwise.
2210  */
2211 static int
2212 mrvl_flow_ctrl_set(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
2213 {
2214         struct mrvl_priv *priv = dev->data->dev_private;
2215         struct pp2_ppio_tx_pause_params mrvl_pause_params;
2216         int ret;
2217         int rx_en, tx_en;
2218
2219         if (fc_conf->high_water ||
2220             fc_conf->low_water ||
2221             fc_conf->pause_time ||
2222             fc_conf->mac_ctrl_frame_fwd) {
2223                 MRVL_LOG(ERR, "Flowctrl parameter is not supported");
2224
2225                 return -EINVAL;
2226         }
2227
2228         if (fc_conf->autoneg == 0) {
2229                 MRVL_LOG(ERR, "Flowctrl Autoneg disable is not supported");
2230                 return -EINVAL;
2231         }
2232
2233         if (!priv->ppio) {
2234                 memcpy(&priv->fc_conf, fc_conf, sizeof(struct rte_eth_fc_conf));
2235                 priv->flow_ctrl = 1;
2236                 return 0;
2237         }
2238
2239         switch (fc_conf->mode) {
2240         case RTE_FC_FULL:
2241                 rx_en = 1;
2242                 tx_en = 1;
2243                 break;
2244         case RTE_FC_TX_PAUSE:
2245                 rx_en = 0;
2246                 tx_en = 1;
2247                 break;
2248         case RTE_FC_RX_PAUSE:
2249                 rx_en = 1;
2250                 tx_en = 0;
2251                 break;
2252         case RTE_FC_NONE:
2253                 rx_en = 0;
2254                 tx_en = 0;
2255                 break;
2256         default:
2257                 MRVL_LOG(ERR, "Incorrect Flow control flag (%d)",
2258                          fc_conf->mode);
2259                 return -EINVAL;
2260         }
2261
2262         /* Set RX flow control */
2263         ret = pp2_ppio_set_rx_pause(priv->ppio, rx_en);
2264         if (ret) {
2265                 MRVL_LOG(ERR, "Failed to change RX flowctrl");
2266                 return ret;
2267         }
2268
2269         /* Set TX flow control */
2270         mrvl_pause_params.en = tx_en;
2271         /* all inqs participate in xon/xoff decision */
2272         mrvl_pause_params.use_tc_pause_inqs = 0;
2273         ret = pp2_ppio_set_tx_pause(priv->ppio, &mrvl_pause_params);
2274         if (ret) {
2275                 MRVL_LOG(ERR, "Failed to change TX flowctrl");
2276                 return ret;
2277         }
2278
2279         return 0;
2280 }
2281
2282 /**
2283  * Update RSS hash configuration
2284  *
2285  * @param dev
2286  *   Pointer to Ethernet device structure.
2287  * @param rss_conf
2288  *   Pointer to RSS configuration.
2289  *
2290  * @return
2291  *   0 on success, negative error value otherwise.
2292  */
2293 static int
2294 mrvl_rss_hash_update(struct rte_eth_dev *dev,
2295                      struct rte_eth_rss_conf *rss_conf)
2296 {
2297         struct mrvl_priv *priv = dev->data->dev_private;
2298
2299         if (priv->isolated)
2300                 return -ENOTSUP;
2301
2302         return mrvl_configure_rss(priv, rss_conf);
2303 }
2304
2305 /**
2306  * DPDK callback to get RSS hash configuration.
2307  *
2308  * @param dev
2309  *   Pointer to Ethernet device structure.
2310  * @rss_conf
2311  *   Pointer to RSS configuration.
2312  *
2313  * @return
2314  *   Always 0.
2315  */
2316 static int
2317 mrvl_rss_hash_conf_get(struct rte_eth_dev *dev,
2318                        struct rte_eth_rss_conf *rss_conf)
2319 {
2320         struct mrvl_priv *priv = dev->data->dev_private;
2321         enum pp2_ppio_hash_type hash_type =
2322                 priv->ppio_params.inqs_params.hash_type;
2323
2324         rss_conf->rss_key = NULL;
2325
2326         if (hash_type == PP2_PPIO_HASH_T_NONE)
2327                 rss_conf->rss_hf = 0;
2328         else if (hash_type == PP2_PPIO_HASH_T_2_TUPLE)
2329                 rss_conf->rss_hf = ETH_RSS_IPV4;
2330         else if (hash_type == PP2_PPIO_HASH_T_5_TUPLE && priv->rss_hf_tcp)
2331                 rss_conf->rss_hf = ETH_RSS_NONFRAG_IPV4_TCP;
2332         else if (hash_type == PP2_PPIO_HASH_T_5_TUPLE && !priv->rss_hf_tcp)
2333                 rss_conf->rss_hf = ETH_RSS_NONFRAG_IPV4_UDP;
2334
2335         return 0;
2336 }
2337
2338 /**
2339  * DPDK callback to get rte_flow callbacks.
2340  *
2341  * @param dev
2342  *   Pointer to the device structure.
2343  * @param ops
2344  *   Pointer to pass the flow ops.
2345  *
2346  * @return
2347  *   0 on success, negative error value otherwise.
2348  */
2349 static int
2350 mrvl_eth_flow_ops_get(struct rte_eth_dev *dev __rte_unused,
2351                       const struct rte_flow_ops **ops)
2352 {
2353         *ops = &mrvl_flow_ops;
2354         return 0;
2355 }
2356
2357 /**
2358  * DPDK callback to get rte_mtr callbacks.
2359  *
2360  * @param dev
2361  *   Pointer to the device structure.
2362  * @param ops
2363  *   Pointer to pass the mtr ops.
2364  *
2365  * @return
2366  *   Always 0.
2367  */
2368 static int
2369 mrvl_mtr_ops_get(struct rte_eth_dev *dev __rte_unused, void *ops)
2370 {
2371         *(const void **)ops = &mrvl_mtr_ops;
2372
2373         return 0;
2374 }
2375
2376 /**
2377  * DPDK callback to get rte_tm callbacks.
2378  *
2379  * @param dev
2380  *   Pointer to the device structure.
2381  * @param ops
2382  *   Pointer to pass the tm ops.
2383  *
2384  * @return
2385  *   Always 0.
2386  */
2387 static int
2388 mrvl_tm_ops_get(struct rte_eth_dev *dev __rte_unused, void *ops)
2389 {
2390         *(const void **)ops = &mrvl_tm_ops;
2391
2392         return 0;
2393 }
2394
2395 static const struct eth_dev_ops mrvl_ops = {
2396         .dev_configure = mrvl_dev_configure,
2397         .dev_start = mrvl_dev_start,
2398         .dev_stop = mrvl_dev_stop,
2399         .dev_set_link_up = mrvl_dev_set_link_up,
2400         .dev_set_link_down = mrvl_dev_set_link_down,
2401         .dev_close = mrvl_dev_close,
2402         .link_update = mrvl_link_update,
2403         .promiscuous_enable = mrvl_promiscuous_enable,
2404         .allmulticast_enable = mrvl_allmulticast_enable,
2405         .promiscuous_disable = mrvl_promiscuous_disable,
2406         .allmulticast_disable = mrvl_allmulticast_disable,
2407         .mac_addr_remove = mrvl_mac_addr_remove,
2408         .mac_addr_add = mrvl_mac_addr_add,
2409         .mac_addr_set = mrvl_mac_addr_set,
2410         .mtu_set = mrvl_mtu_set,
2411         .stats_get = mrvl_stats_get,
2412         .stats_reset = mrvl_stats_reset,
2413         .xstats_get = mrvl_xstats_get,
2414         .xstats_reset = mrvl_xstats_reset,
2415         .xstats_get_names = mrvl_xstats_get_names,
2416         .dev_infos_get = mrvl_dev_infos_get,
2417         .dev_supported_ptypes_get = mrvl_dev_supported_ptypes_get,
2418         .rxq_info_get = mrvl_rxq_info_get,
2419         .txq_info_get = mrvl_txq_info_get,
2420         .vlan_filter_set = mrvl_vlan_filter_set,
2421         .vlan_offload_set = mrvl_vlan_offload_set,
2422         .tx_queue_start = mrvl_tx_queue_start,
2423         .tx_queue_stop = mrvl_tx_queue_stop,
2424         .rx_queue_setup = mrvl_rx_queue_setup,
2425         .rx_queue_release = mrvl_rx_queue_release,
2426         .tx_queue_setup = mrvl_tx_queue_setup,
2427         .tx_queue_release = mrvl_tx_queue_release,
2428         .flow_ctrl_get = mrvl_flow_ctrl_get,
2429         .flow_ctrl_set = mrvl_flow_ctrl_set,
2430         .rss_hash_update = mrvl_rss_hash_update,
2431         .rss_hash_conf_get = mrvl_rss_hash_conf_get,
2432         .flow_ops_get = mrvl_eth_flow_ops_get,
2433         .mtr_ops_get = mrvl_mtr_ops_get,
2434         .tm_ops_get = mrvl_tm_ops_get,
2435 };
2436
2437 /**
2438  * Return packet type information and l3/l4 offsets.
2439  *
2440  * @param desc
2441  *   Pointer to the received packet descriptor.
2442  * @param l3_offset
2443  *   l3 packet offset.
2444  * @param l4_offset
2445  *   l4 packet offset.
2446  *
2447  * @return
2448  *   Packet type information.
2449  */
2450 static inline uint64_t
2451 mrvl_desc_to_packet_type_and_offset(struct pp2_ppio_desc *desc,
2452                                     uint8_t *l3_offset, uint8_t *l4_offset)
2453 {
2454         enum pp2_inq_l3_type l3_type;
2455         enum pp2_inq_l4_type l4_type;
2456         enum pp2_inq_vlan_tag vlan_tag;
2457         uint64_t packet_type;
2458
2459         pp2_ppio_inq_desc_get_l3_info(desc, &l3_type, l3_offset);
2460         pp2_ppio_inq_desc_get_l4_info(desc, &l4_type, l4_offset);
2461         pp2_ppio_inq_desc_get_vlan_tag(desc, &vlan_tag);
2462
2463         packet_type = RTE_PTYPE_L2_ETHER;
2464
2465         switch (vlan_tag) {
2466         case PP2_INQ_VLAN_TAG_SINGLE:
2467                 packet_type |= RTE_PTYPE_L2_ETHER_VLAN;
2468                 break;
2469         case PP2_INQ_VLAN_TAG_DOUBLE:
2470         case PP2_INQ_VLAN_TAG_TRIPLE:
2471                 packet_type |= RTE_PTYPE_L2_ETHER_QINQ;
2472                 break;
2473         default:
2474                 break;
2475         }
2476
2477         switch (l3_type) {
2478         case PP2_INQ_L3_TYPE_IPV4_NO_OPTS:
2479                 packet_type |= RTE_PTYPE_L3_IPV4;
2480                 break;
2481         case PP2_INQ_L3_TYPE_IPV4_OK:
2482                 packet_type |= RTE_PTYPE_L3_IPV4_EXT;
2483                 break;
2484         case PP2_INQ_L3_TYPE_IPV4_TTL_ZERO:
2485                 packet_type |= RTE_PTYPE_L3_IPV4_EXT_UNKNOWN;
2486                 break;
2487         case PP2_INQ_L3_TYPE_IPV6_NO_EXT:
2488                 packet_type |= RTE_PTYPE_L3_IPV6;
2489                 break;
2490         case PP2_INQ_L3_TYPE_IPV6_EXT:
2491                 packet_type |= RTE_PTYPE_L3_IPV6_EXT;
2492                 break;
2493         case PP2_INQ_L3_TYPE_ARP:
2494                 packet_type |= RTE_PTYPE_L2_ETHER_ARP;
2495                 /*
2496                  * In case of ARP l4_offset is set to wrong value.
2497                  * Set it to proper one so that later on mbuf->l3_len can be
2498                  * calculated subtracting l4_offset and l3_offset.
2499                  */
2500                 *l4_offset = *l3_offset + MRVL_ARP_LENGTH;
2501                 break;
2502         default:
2503                 break;
2504         }
2505
2506         switch (l4_type) {
2507         case PP2_INQ_L4_TYPE_TCP:
2508                 packet_type |= RTE_PTYPE_L4_TCP;
2509                 break;
2510         case PP2_INQ_L4_TYPE_UDP:
2511                 packet_type |= RTE_PTYPE_L4_UDP;
2512                 break;
2513         default:
2514                 break;
2515         }
2516
2517         return packet_type;
2518 }
2519
2520 /**
2521  * Get offload information from the received packet descriptor.
2522  *
2523  * @param desc
2524  *   Pointer to the received packet descriptor.
2525  *
2526  * @return
2527  *   Mbuf offload flags.
2528  */
2529 static inline uint64_t
2530 mrvl_desc_to_ol_flags(struct pp2_ppio_desc *desc, uint64_t packet_type)
2531 {
2532         uint64_t flags = 0;
2533         enum pp2_inq_desc_status status;
2534
2535         if (RTE_ETH_IS_IPV4_HDR(packet_type)) {
2536                 status = pp2_ppio_inq_desc_get_l3_pkt_error(desc);
2537                 if (unlikely(status != PP2_DESC_ERR_OK))
2538                         flags |= PKT_RX_IP_CKSUM_BAD;
2539                 else
2540                         flags |= PKT_RX_IP_CKSUM_GOOD;
2541         }
2542
2543         if (((packet_type & RTE_PTYPE_L4_UDP) == RTE_PTYPE_L4_UDP) ||
2544             ((packet_type & RTE_PTYPE_L4_TCP) == RTE_PTYPE_L4_TCP)) {
2545                 status = pp2_ppio_inq_desc_get_l4_pkt_error(desc);
2546                 if (unlikely(status != PP2_DESC_ERR_OK))
2547                         flags |= PKT_RX_L4_CKSUM_BAD;
2548                 else
2549                         flags |= PKT_RX_L4_CKSUM_GOOD;
2550         }
2551
2552         return flags;
2553 }
2554
2555 /**
2556  * DPDK callback for receive.
2557  *
2558  * @param rxq
2559  *   Generic pointer to the receive queue.
2560  * @param rx_pkts
2561  *   Array to store received packets.
2562  * @param nb_pkts
2563  *   Maximum number of packets in array.
2564  *
2565  * @return
2566  *   Number of packets successfully received.
2567  */
2568 static uint16_t
2569 mrvl_rx_pkt_burst(void *rxq, struct rte_mbuf **rx_pkts, uint16_t nb_pkts)
2570 {
2571         struct mrvl_rxq *q = rxq;
2572         struct pp2_ppio_desc descs[nb_pkts];
2573         struct pp2_bpool *bpool;
2574         int i, ret, rx_done = 0;
2575         int num;
2576         struct pp2_hif *hif;
2577         unsigned int core_id = rte_lcore_id();
2578
2579         hif = mrvl_get_hif(q->priv, core_id);
2580
2581         if (unlikely(!q->priv->ppio || !hif))
2582                 return 0;
2583
2584         bpool = q->priv->bpool;
2585
2586         ret = pp2_ppio_recv(q->priv->ppio, q->priv->rxq_map[q->queue_id].tc,
2587                             q->priv->rxq_map[q->queue_id].inq, descs, &nb_pkts);
2588         if (unlikely(ret < 0))
2589                 return 0;
2590
2591         mrvl_port_bpool_size[bpool->pp2_id][bpool->id][core_id] -= nb_pkts;
2592
2593         for (i = 0; i < nb_pkts; i++) {
2594                 struct rte_mbuf *mbuf;
2595                 uint8_t l3_offset, l4_offset;
2596                 enum pp2_inq_desc_status status;
2597                 uint64_t addr;
2598
2599                 if (likely(nb_pkts - i > MRVL_MUSDK_PREFETCH_SHIFT)) {
2600                         struct pp2_ppio_desc *pref_desc;
2601                         u64 pref_addr;
2602
2603                         pref_desc = &descs[i + MRVL_MUSDK_PREFETCH_SHIFT];
2604                         pref_addr = cookie_addr_high |
2605                                     pp2_ppio_inq_desc_get_cookie(pref_desc);
2606                         rte_mbuf_prefetch_part1((struct rte_mbuf *)(pref_addr));
2607                         rte_mbuf_prefetch_part2((struct rte_mbuf *)(pref_addr));
2608                 }
2609
2610                 addr = cookie_addr_high |
2611                        pp2_ppio_inq_desc_get_cookie(&descs[i]);
2612                 mbuf = (struct rte_mbuf *)addr;
2613                 rte_pktmbuf_reset(mbuf);
2614
2615                 /* drop packet in case of mac, overrun or resource error */
2616                 status = pp2_ppio_inq_desc_get_l2_pkt_error(&descs[i]);
2617                 if ((unlikely(status != PP2_DESC_ERR_OK)) &&
2618                         !(q->priv->forward_bad_frames)) {
2619                         struct pp2_buff_inf binf = {
2620                                 .addr = rte_mbuf_data_iova_default(mbuf),
2621                                 .cookie = (uint64_t)mbuf,
2622                         };
2623
2624                         pp2_bpool_put_buff(hif, bpool, &binf);
2625                         mrvl_port_bpool_size
2626                                 [bpool->pp2_id][bpool->id][core_id]++;
2627                         q->drop_mac++;
2628                         continue;
2629                 }
2630
2631                 mbuf->data_off += MRVL_PKT_EFFEC_OFFS;
2632                 mbuf->pkt_len = pp2_ppio_inq_desc_get_pkt_len(&descs[i]);
2633                 mbuf->data_len = mbuf->pkt_len;
2634                 mbuf->port = q->port_id;
2635                 mbuf->packet_type =
2636                         mrvl_desc_to_packet_type_and_offset(&descs[i],
2637                                                             &l3_offset,
2638                                                             &l4_offset);
2639                 mbuf->l2_len = l3_offset;
2640                 mbuf->l3_len = l4_offset - l3_offset;
2641
2642                 if (likely(q->cksum_enabled))
2643                         mbuf->ol_flags =
2644                                 mrvl_desc_to_ol_flags(&descs[i],
2645                                                       mbuf->packet_type);
2646
2647                 rx_pkts[rx_done++] = mbuf;
2648                 q->bytes_recv += mbuf->pkt_len;
2649         }
2650
2651         if (rte_spinlock_trylock(&q->priv->lock) == 1) {
2652                 num = mrvl_get_bpool_size(bpool->pp2_id, bpool->id);
2653
2654                 if (unlikely(num <= q->priv->bpool_min_size ||
2655                              (!rx_done && num < q->priv->bpool_init_size))) {
2656                         mrvl_fill_bpool(q, q->priv->fill_bpool_buffs);
2657                 } else if (unlikely(num > q->priv->bpool_max_size)) {
2658                         int i;
2659                         int pkt_to_remove = num - q->priv->bpool_init_size;
2660                         struct rte_mbuf *mbuf;
2661                         struct pp2_buff_inf buff;
2662
2663                         for (i = 0; i < pkt_to_remove; i++) {
2664                                 ret = pp2_bpool_get_buff(hif, bpool, &buff);
2665                                 if (ret)
2666                                         break;
2667                                 mbuf = (struct rte_mbuf *)
2668                                         (cookie_addr_high | buff.cookie);
2669                                 rte_pktmbuf_free(mbuf);
2670                         }
2671                         mrvl_port_bpool_size
2672                                 [bpool->pp2_id][bpool->id][core_id] -= i;
2673                 }
2674                 rte_spinlock_unlock(&q->priv->lock);
2675         }
2676
2677         return rx_done;
2678 }
2679
2680 /**
2681  * Prepare offload information.
2682  *
2683  * @param ol_flags
2684  *   Offload flags.
2685  * @param l3_type
2686  *   Pointer to the pp2_ouq_l3_type structure.
2687  * @param l4_type
2688  *   Pointer to the pp2_outq_l4_type structure.
2689  * @param gen_l3_cksum
2690  *   Will be set to 1 in case l3 checksum is computed.
2691  * @param l4_cksum
2692  *   Will be set to 1 in case l4 checksum is computed.
2693  */
2694 static inline void
2695 mrvl_prepare_proto_info(uint64_t ol_flags,
2696                         enum pp2_outq_l3_type *l3_type,
2697                         enum pp2_outq_l4_type *l4_type,
2698                         int *gen_l3_cksum,
2699                         int *gen_l4_cksum)
2700 {
2701         /*
2702          * Based on ol_flags prepare information
2703          * for pp2_ppio_outq_desc_set_proto_info() which setups descriptor
2704          * for offloading.
2705          * in most of the checksum cases ipv4 must be set, so this is the
2706          * default value
2707          */
2708         *l3_type = PP2_OUTQ_L3_TYPE_IPV4;
2709         *gen_l3_cksum = ol_flags & PKT_TX_IP_CKSUM ? 1 : 0;
2710
2711         if (ol_flags & PKT_TX_IPV6) {
2712                 *l3_type = PP2_OUTQ_L3_TYPE_IPV6;
2713                 /* no checksum for ipv6 header */
2714                 *gen_l3_cksum = 0;
2715         }
2716
2717         if ((ol_flags & PKT_TX_L4_MASK) == PKT_TX_TCP_CKSUM) {
2718                 *l4_type = PP2_OUTQ_L4_TYPE_TCP;
2719                 *gen_l4_cksum = 1;
2720         } else if ((ol_flags & PKT_TX_L4_MASK) ==  PKT_TX_UDP_CKSUM) {
2721                 *l4_type = PP2_OUTQ_L4_TYPE_UDP;
2722                 *gen_l4_cksum = 1;
2723         } else {
2724                 *l4_type = PP2_OUTQ_L4_TYPE_OTHER;
2725                 /* no checksum for other type */
2726                 *gen_l4_cksum = 0;
2727         }
2728 }
2729
2730 /**
2731  * Release already sent buffers to bpool (buffer-pool).
2732  *
2733  * @param ppio
2734  *   Pointer to the port structure.
2735  * @param hif
2736  *   Pointer to the MUSDK hardware interface.
2737  * @param sq
2738  *   Pointer to the shadow queue.
2739  * @param qid
2740  *   Queue id number.
2741  * @param force
2742  *   Force releasing packets.
2743  */
2744 static inline void
2745 mrvl_free_sent_buffers(struct pp2_ppio *ppio, struct pp2_hif *hif,
2746                        unsigned int core_id, struct mrvl_shadow_txq *sq,
2747                        int qid, int force)
2748 {
2749         struct buff_release_entry *entry;
2750         uint16_t nb_done = 0, num = 0, skip_bufs = 0;
2751         int i;
2752
2753         pp2_ppio_get_num_outq_done(ppio, hif, qid, &nb_done);
2754
2755         sq->num_to_release += nb_done;
2756
2757         if (likely(!force &&
2758                    sq->num_to_release < MRVL_PP2_BUF_RELEASE_BURST_SIZE))
2759                 return;
2760
2761         nb_done = sq->num_to_release;
2762         sq->num_to_release = 0;
2763
2764         for (i = 0; i < nb_done; i++) {
2765                 entry = &sq->ent[sq->tail + num];
2766                 if (unlikely(!entry->buff.addr)) {
2767                         MRVL_LOG(ERR,
2768                                 "Shadow memory @%d: cookie(%lx), pa(%lx)!",
2769                                 sq->tail, (u64)entry->buff.cookie,
2770                                 (u64)entry->buff.addr);
2771                         skip_bufs = 1;
2772                         goto skip;
2773                 }
2774
2775                 if (unlikely(!entry->bpool)) {
2776                         struct rte_mbuf *mbuf;
2777
2778                         mbuf = (struct rte_mbuf *)entry->buff.cookie;
2779                         rte_pktmbuf_free(mbuf);
2780                         skip_bufs = 1;
2781                         goto skip;
2782                 }
2783
2784                 mrvl_port_bpool_size
2785                         [entry->bpool->pp2_id][entry->bpool->id][core_id]++;
2786                 num++;
2787                 if (unlikely(sq->tail + num == MRVL_PP2_TX_SHADOWQ_SIZE))
2788                         goto skip;
2789                 continue;
2790 skip:
2791                 if (likely(num))
2792                         pp2_bpool_put_buffs(hif, &sq->ent[sq->tail], &num);
2793                 num += skip_bufs;
2794                 sq->tail = (sq->tail + num) & MRVL_PP2_TX_SHADOWQ_MASK;
2795                 sq->size -= num;
2796                 num = 0;
2797                 skip_bufs = 0;
2798         }
2799
2800         if (likely(num)) {
2801                 pp2_bpool_put_buffs(hif, &sq->ent[sq->tail], &num);
2802                 sq->tail = (sq->tail + num) & MRVL_PP2_TX_SHADOWQ_MASK;
2803                 sq->size -= num;
2804         }
2805 }
2806
2807 /**
2808  * DPDK callback for transmit.
2809  *
2810  * @param txq
2811  *   Generic pointer transmit queue.
2812  * @param tx_pkts
2813  *   Packets to transmit.
2814  * @param nb_pkts
2815  *   Number of packets in array.
2816  *
2817  * @return
2818  *   Number of packets successfully transmitted.
2819  */
2820 static uint16_t
2821 mrvl_tx_pkt_burst(void *txq, struct rte_mbuf **tx_pkts, uint16_t nb_pkts)
2822 {
2823         struct mrvl_txq *q = txq;
2824         struct mrvl_shadow_txq *sq;
2825         struct pp2_hif *hif;
2826         struct pp2_ppio_desc descs[nb_pkts];
2827         unsigned int core_id = rte_lcore_id();
2828         int i, bytes_sent = 0;
2829         uint16_t num, sq_free_size;
2830         uint64_t addr;
2831
2832         hif = mrvl_get_hif(q->priv, core_id);
2833         sq = &q->shadow_txqs[core_id];
2834
2835         if (unlikely(!q->priv->ppio || !hif))
2836                 return 0;
2837
2838         if (sq->size)
2839                 mrvl_free_sent_buffers(q->priv->ppio, hif, core_id,
2840                                        sq, q->queue_id, 0);
2841
2842         sq_free_size = MRVL_PP2_TX_SHADOWQ_SIZE - sq->size - 1;
2843         if (unlikely(nb_pkts > sq_free_size))
2844                 nb_pkts = sq_free_size;
2845
2846         for (i = 0; i < nb_pkts; i++) {
2847                 struct rte_mbuf *mbuf = tx_pkts[i];
2848                 int gen_l3_cksum, gen_l4_cksum;
2849                 enum pp2_outq_l3_type l3_type;
2850                 enum pp2_outq_l4_type l4_type;
2851
2852                 if (likely(nb_pkts - i > MRVL_MUSDK_PREFETCH_SHIFT)) {
2853                         struct rte_mbuf *pref_pkt_hdr;
2854
2855                         pref_pkt_hdr = tx_pkts[i + MRVL_MUSDK_PREFETCH_SHIFT];
2856                         rte_mbuf_prefetch_part1(pref_pkt_hdr);
2857                         rte_mbuf_prefetch_part2(pref_pkt_hdr);
2858                 }
2859
2860                 mrvl_fill_shadowq(sq, mbuf);
2861                 mrvl_fill_desc(&descs[i], mbuf);
2862
2863                 bytes_sent += rte_pktmbuf_pkt_len(mbuf);
2864                 /*
2865                  * in case unsupported ol_flags were passed
2866                  * do not update descriptor offload information
2867                  */
2868                 if (!(mbuf->ol_flags & MRVL_TX_PKT_OFFLOADS))
2869                         continue;
2870                 mrvl_prepare_proto_info(mbuf->ol_flags, &l3_type, &l4_type,
2871                                         &gen_l3_cksum, &gen_l4_cksum);
2872
2873                 pp2_ppio_outq_desc_set_proto_info(&descs[i], l3_type, l4_type,
2874                                                   mbuf->l2_len,
2875                                                   mbuf->l2_len + mbuf->l3_len,
2876                                                   gen_l3_cksum, gen_l4_cksum);
2877         }
2878
2879         num = nb_pkts;
2880         pp2_ppio_send(q->priv->ppio, hif, q->queue_id, descs, &nb_pkts);
2881         /* number of packets that were not sent */
2882         if (unlikely(num > nb_pkts)) {
2883                 for (i = nb_pkts; i < num; i++) {
2884                         sq->head = (MRVL_PP2_TX_SHADOWQ_SIZE + sq->head - 1) &
2885                                 MRVL_PP2_TX_SHADOWQ_MASK;
2886                         addr = sq->ent[sq->head].buff.cookie;
2887                         bytes_sent -=
2888                                 rte_pktmbuf_pkt_len((struct rte_mbuf *)addr);
2889                 }
2890                 sq->size -= num - nb_pkts;
2891         }
2892
2893         q->bytes_sent += bytes_sent;
2894
2895         return nb_pkts;
2896 }
2897
2898 /** DPDK callback for S/G transmit.
2899  *
2900  * @param txq
2901  *   Generic pointer transmit queue.
2902  * @param tx_pkts
2903  *   Packets to transmit.
2904  * @param nb_pkts
2905  *   Number of packets in array.
2906  *
2907  * @return
2908  *   Number of packets successfully transmitted.
2909  */
2910 static uint16_t
2911 mrvl_tx_sg_pkt_burst(void *txq, struct rte_mbuf **tx_pkts,
2912                      uint16_t nb_pkts)
2913 {
2914         struct mrvl_txq *q = txq;
2915         struct mrvl_shadow_txq *sq;
2916         struct pp2_hif *hif;
2917         struct pp2_ppio_desc descs[nb_pkts * PP2_PPIO_DESC_NUM_FRAGS];
2918         struct pp2_ppio_sg_pkts pkts;
2919         uint8_t frags[nb_pkts];
2920         unsigned int core_id = rte_lcore_id();
2921         int i, j, bytes_sent = 0;
2922         int tail, tail_first;
2923         uint16_t num, sq_free_size;
2924         uint16_t nb_segs, total_descs = 0;
2925         uint64_t addr;
2926
2927         hif = mrvl_get_hif(q->priv, core_id);
2928         sq = &q->shadow_txqs[core_id];
2929         pkts.frags = frags;
2930         pkts.num = 0;
2931
2932         if (unlikely(!q->priv->ppio || !hif))
2933                 return 0;
2934
2935         if (sq->size)
2936                 mrvl_free_sent_buffers(q->priv->ppio, hif, core_id,
2937                                        sq, q->queue_id, 0);
2938
2939         /* Save shadow queue free size */
2940         sq_free_size = MRVL_PP2_TX_SHADOWQ_SIZE - sq->size - 1;
2941
2942         tail = 0;
2943         for (i = 0; i < nb_pkts; i++) {
2944                 struct rte_mbuf *mbuf = tx_pkts[i];
2945                 struct rte_mbuf *seg = NULL;
2946                 int gen_l3_cksum, gen_l4_cksum;
2947                 enum pp2_outq_l3_type l3_type;
2948                 enum pp2_outq_l4_type l4_type;
2949
2950                 nb_segs = mbuf->nb_segs;
2951                 tail_first = tail;
2952                 total_descs += nb_segs;
2953
2954                 /*
2955                  * Check if total_descs does not exceed
2956                  * shadow queue free size
2957                  */
2958                 if (unlikely(total_descs > sq_free_size)) {
2959                         total_descs -= nb_segs;
2960                         break;
2961                 }
2962
2963                 /* Check if nb_segs does not exceed the max nb of desc per
2964                  * fragmented packet
2965                  */
2966                 if (nb_segs > PP2_PPIO_DESC_NUM_FRAGS) {
2967                         total_descs -= nb_segs;
2968                         RTE_LOG(ERR, PMD,
2969                                 "Too many segments. Packet won't be sent.\n");
2970                         break;
2971                 }
2972
2973                 if (likely(nb_pkts - i > MRVL_MUSDK_PREFETCH_SHIFT)) {
2974                         struct rte_mbuf *pref_pkt_hdr;
2975
2976                         pref_pkt_hdr = tx_pkts[i + MRVL_MUSDK_PREFETCH_SHIFT];
2977                         rte_mbuf_prefetch_part1(pref_pkt_hdr);
2978                         rte_mbuf_prefetch_part2(pref_pkt_hdr);
2979                 }
2980
2981                 pkts.frags[pkts.num] = nb_segs;
2982                 pkts.num++;
2983
2984                 seg = mbuf;
2985                 for (j = 0; j < nb_segs - 1; j++) {
2986                         /* For the subsequent segments, set shadow queue
2987                          * buffer to NULL
2988                          */
2989                         mrvl_fill_shadowq(sq, NULL);
2990                         mrvl_fill_desc(&descs[tail], seg);
2991
2992                         tail++;
2993                         seg = seg->next;
2994                 }
2995                 /* Put first mbuf info in last shadow queue entry */
2996                 mrvl_fill_shadowq(sq, mbuf);
2997                 /* Update descriptor with last segment */
2998                 mrvl_fill_desc(&descs[tail++], seg);
2999
3000                 bytes_sent += rte_pktmbuf_pkt_len(mbuf);
3001                 /* In case unsupported ol_flags were passed
3002                  * do not update descriptor offload information
3003                  */
3004                 if (!(mbuf->ol_flags & MRVL_TX_PKT_OFFLOADS))
3005                         continue;
3006                 mrvl_prepare_proto_info(mbuf->ol_flags, &l3_type, &l4_type,
3007                                         &gen_l3_cksum, &gen_l4_cksum);
3008
3009                 pp2_ppio_outq_desc_set_proto_info(&descs[tail_first], l3_type,
3010                                                   l4_type, mbuf->l2_len,
3011                                                   mbuf->l2_len + mbuf->l3_len,
3012                                                   gen_l3_cksum, gen_l4_cksum);
3013         }
3014
3015         num = total_descs;
3016         pp2_ppio_send_sg(q->priv->ppio, hif, q->queue_id, descs,
3017                          &total_descs, &pkts);
3018         /* number of packets that were not sent */
3019         if (unlikely(num > total_descs)) {
3020                 for (i = total_descs; i < num; i++) {
3021                         sq->head = (MRVL_PP2_TX_SHADOWQ_SIZE + sq->head - 1) &
3022                                 MRVL_PP2_TX_SHADOWQ_MASK;
3023
3024                         addr = sq->ent[sq->head].buff.cookie;
3025                         if (addr)
3026                                 bytes_sent -=
3027                                         rte_pktmbuf_pkt_len((struct rte_mbuf *)
3028                                                 (cookie_addr_high | addr));
3029                 }
3030                 sq->size -= num - total_descs;
3031                 nb_pkts = pkts.num;
3032         }
3033
3034         q->bytes_sent += bytes_sent;
3035
3036         return nb_pkts;
3037 }
3038
3039 /**
3040  * Create private device structure.
3041  *
3042  * @param dev_name
3043  *   Pointer to the port name passed in the initialization parameters.
3044  *
3045  * @return
3046  *   Pointer to the newly allocated private device structure.
3047  */
3048 static struct mrvl_priv *
3049 mrvl_priv_create(const char *dev_name)
3050 {
3051         struct pp2_bpool_params bpool_params;
3052         char match[MRVL_MATCH_LEN];
3053         struct mrvl_priv *priv;
3054         uint16_t max_frame_size;
3055         int ret, bpool_bit;
3056
3057         priv = rte_zmalloc_socket(dev_name, sizeof(*priv), 0, rte_socket_id());
3058         if (!priv)
3059                 return NULL;
3060
3061         ret = pp2_netdev_get_ppio_info((char *)(uintptr_t)dev_name,
3062                                        &priv->pp_id, &priv->ppio_id);
3063         if (ret)
3064                 goto out_free_priv;
3065
3066         ret = pp2_ppio_get_l4_cksum_max_frame_size(priv->pp_id, priv->ppio_id,
3067                                                    &max_frame_size);
3068         if (ret)
3069                 goto out_free_priv;
3070
3071         priv->max_mtu = max_frame_size + RTE_ETHER_CRC_LEN -
3072                 MRVL_PP2_ETH_HDRS_LEN;
3073
3074         bpool_bit = mrvl_reserve_bit(&used_bpools[priv->pp_id],
3075                                      PP2_BPOOL_NUM_POOLS);
3076         if (bpool_bit < 0)
3077                 goto out_free_priv;
3078         priv->bpool_bit = bpool_bit;
3079
3080         snprintf(match, sizeof(match), "pool-%d:%d", priv->pp_id,
3081                  priv->bpool_bit);
3082         memset(&bpool_params, 0, sizeof(bpool_params));
3083         bpool_params.match = match;
3084         bpool_params.buff_len = MRVL_PKT_SIZE_MAX + MRVL_PKT_EFFEC_OFFS;
3085         ret = pp2_bpool_init(&bpool_params, &priv->bpool);
3086         if (ret)
3087                 goto out_clear_bpool_bit;
3088
3089         priv->ppio_params.type = PP2_PPIO_T_NIC;
3090         rte_spinlock_init(&priv->lock);
3091
3092         return priv;
3093 out_clear_bpool_bit:
3094         used_bpools[priv->pp_id] &= ~(1 << priv->bpool_bit);
3095 out_free_priv:
3096         rte_free(priv);
3097         return NULL;
3098 }
3099
3100 /**
3101  * Create device representing Ethernet port.
3102  *
3103  * @param name
3104  *   Pointer to the port's name.
3105  *
3106  * @return
3107  *   0 on success, negative error value otherwise.
3108  */
3109 static int
3110 mrvl_eth_dev_create(struct rte_vdev_device *vdev, const char *name)
3111 {
3112         int ret, fd = socket(AF_INET, SOCK_DGRAM, 0);
3113         struct rte_eth_dev *eth_dev;
3114         struct mrvl_priv *priv;
3115         struct ifreq req;
3116
3117         eth_dev = rte_eth_dev_allocate(name);
3118         if (!eth_dev)
3119                 return -ENOMEM;
3120
3121         priv = mrvl_priv_create(name);
3122         if (!priv) {
3123                 ret = -ENOMEM;
3124                 goto out_free;
3125         }
3126         eth_dev->data->dev_private = priv;
3127
3128         eth_dev->data->mac_addrs =
3129                 rte_zmalloc("mac_addrs",
3130                             RTE_ETHER_ADDR_LEN * MRVL_MAC_ADDRS_MAX, 0);
3131         if (!eth_dev->data->mac_addrs) {
3132                 MRVL_LOG(ERR, "Failed to allocate space for eth addrs");
3133                 ret = -ENOMEM;
3134                 goto out_free;
3135         }
3136
3137         memset(&req, 0, sizeof(req));
3138         strcpy(req.ifr_name, name);
3139         ret = ioctl(fd, SIOCGIFHWADDR, &req);
3140         if (ret)
3141                 goto out_free;
3142
3143         memcpy(eth_dev->data->mac_addrs[0].addr_bytes,
3144                req.ifr_addr.sa_data, RTE_ETHER_ADDR_LEN);
3145
3146         eth_dev->device = &vdev->device;
3147         eth_dev->rx_pkt_burst = mrvl_rx_pkt_burst;
3148         mrvl_set_tx_function(eth_dev);
3149         eth_dev->dev_ops = &mrvl_ops;
3150         eth_dev->data->dev_flags |= RTE_ETH_DEV_AUTOFILL_QUEUE_XSTATS;
3151
3152         eth_dev->data->dev_link.link_status = ETH_LINK_UP;
3153
3154         rte_eth_dev_probing_finish(eth_dev);
3155         return 0;
3156 out_free:
3157         rte_eth_dev_release_port(eth_dev);
3158
3159         return ret;
3160 }
3161
3162 /**
3163  * Callback used by rte_kvargs_process() during argument parsing.
3164  *
3165  * @param key
3166  *   Pointer to the parsed key (unused).
3167  * @param value
3168  *   Pointer to the parsed value.
3169  * @param extra_args
3170  *   Pointer to the extra arguments which contains address of the
3171  *   table of pointers to parsed interface names.
3172  *
3173  * @return
3174  *   Always 0.
3175  */
3176 static int
3177 mrvl_get_ifnames(const char *key __rte_unused, const char *value,
3178                  void *extra_args)
3179 {
3180         struct mrvl_ifnames *ifnames = extra_args;
3181
3182         ifnames->names[ifnames->idx++] = value;
3183
3184         return 0;
3185 }
3186
3187 /**
3188  * DPDK callback to register the virtual device.
3189  *
3190  * @param vdev
3191  *   Pointer to the virtual device.
3192  *
3193  * @return
3194  *   0 on success, negative error value otherwise.
3195  */
3196 static int
3197 rte_pmd_mrvl_probe(struct rte_vdev_device *vdev)
3198 {
3199         struct rte_kvargs *kvlist;
3200         struct mrvl_ifnames ifnames;
3201         int ret = -EINVAL;
3202         uint32_t i, ifnum, cfgnum;
3203         const char *params;
3204
3205         params = rte_vdev_device_args(vdev);
3206         if (!params)
3207                 return -EINVAL;
3208
3209         kvlist = rte_kvargs_parse(params, valid_args);
3210         if (!kvlist)
3211                 return -EINVAL;
3212
3213         ifnum = rte_kvargs_count(kvlist, MRVL_IFACE_NAME_ARG);
3214         if (ifnum > RTE_DIM(ifnames.names))
3215                 goto out_free_kvlist;
3216
3217         ifnames.idx = 0;
3218         rte_kvargs_process(kvlist, MRVL_IFACE_NAME_ARG,
3219                            mrvl_get_ifnames, &ifnames);
3220
3221
3222         /*
3223          * The below system initialization should be done only once,
3224          * on the first provided configuration file
3225          */
3226         if (!mrvl_cfg) {
3227                 cfgnum = rte_kvargs_count(kvlist, MRVL_CFG_ARG);
3228                 MRVL_LOG(INFO, "Parsing config file!");
3229                 if (cfgnum > 1) {
3230                         MRVL_LOG(ERR, "Cannot handle more than one config file!");
3231                         goto out_free_kvlist;
3232                 } else if (cfgnum == 1) {
3233                         rte_kvargs_process(kvlist, MRVL_CFG_ARG,
3234                                            mrvl_get_cfg, &mrvl_cfg);
3235                 }
3236         }
3237
3238         if (mrvl_dev_num)
3239                 goto init_devices;
3240
3241         MRVL_LOG(INFO, "Perform MUSDK initializations");
3242
3243         ret = rte_mvep_init(MVEP_MOD_T_PP2, kvlist);
3244         if (ret)
3245                 goto out_free_kvlist;
3246
3247         ret = mrvl_init_pp2();
3248         if (ret) {
3249                 MRVL_LOG(ERR, "Failed to init PP!");
3250                 rte_mvep_deinit(MVEP_MOD_T_PP2);
3251                 goto out_free_kvlist;
3252         }
3253
3254         memset(mrvl_port_bpool_size, 0, sizeof(mrvl_port_bpool_size));
3255         memset(mrvl_port_to_bpool_lookup, 0, sizeof(mrvl_port_to_bpool_lookup));
3256
3257         mrvl_lcore_first = RTE_MAX_LCORE;
3258         mrvl_lcore_last = 0;
3259
3260 init_devices:
3261         for (i = 0; i < ifnum; i++) {
3262                 MRVL_LOG(INFO, "Creating %s", ifnames.names[i]);
3263                 ret = mrvl_eth_dev_create(vdev, ifnames.names[i]);
3264                 if (ret)
3265                         goto out_cleanup;
3266                 mrvl_dev_num++;
3267         }
3268
3269         rte_kvargs_free(kvlist);
3270
3271         return 0;
3272 out_cleanup:
3273         rte_pmd_mrvl_remove(vdev);
3274
3275 out_free_kvlist:
3276         rte_kvargs_free(kvlist);
3277
3278         return ret;
3279 }
3280
3281 /**
3282  * DPDK callback to remove virtual device.
3283  *
3284  * @param vdev
3285  *   Pointer to the removed virtual device.
3286  *
3287  * @return
3288  *   0 on success, negative error value otherwise.
3289  */
3290 static int
3291 rte_pmd_mrvl_remove(struct rte_vdev_device *vdev)
3292 {
3293         uint16_t port_id;
3294         int ret = 0;
3295
3296         RTE_ETH_FOREACH_DEV(port_id) {
3297                 if (rte_eth_devices[port_id].device != &vdev->device)
3298                         continue;
3299                 ret |= rte_eth_dev_close(port_id);
3300         }
3301
3302         return ret == 0 ? 0 : -EIO;
3303 }
3304
3305 static struct rte_vdev_driver pmd_mrvl_drv = {
3306         .probe = rte_pmd_mrvl_probe,
3307         .remove = rte_pmd_mrvl_remove,
3308 };
3309
3310 RTE_PMD_REGISTER_VDEV(net_mvpp2, pmd_mrvl_drv);
3311 RTE_PMD_REGISTER_ALIAS(net_mvpp2, eth_mvpp2);
3312 RTE_LOG_REGISTER_DEFAULT(mrvl_logtype, NOTICE);