drivers/net/octeontx/octeontx_ethdev.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2017 Cavium, Inc
   3  */
   4
   5 #include <stdio.h>
   6 #include <stdarg.h>
   7 #include <stdbool.h>
   8 #include <stdint.h>
   9 #include <string.h>
  10 #include <unistd.h>
  11
  12 #include <rte_alarm.h>
  13 #include <rte_branch_prediction.h>
  14 #include <rte_debug.h>
  15 #include <rte_devargs.h>
  16 #include <rte_dev.h>
  17 #include <rte_kvargs.h>
  18 #include <rte_malloc.h>
  19 #include <rte_mbuf_pool_ops.h>
  20 #include <rte_prefetch.h>
  21 #include <rte_bus_vdev.h>
  22
  23 #include "octeontx_ethdev.h"
  24 #include "octeontx_rxtx.h"
  25 #include "octeontx_logs.h"
  26
  27 struct evdev_priv_data {
  28         OFFLOAD_FLAGS; /*Sequence should not be changed */
  29 } __rte_cache_aligned;
  30
  31 struct octeontx_vdev_init_params {
  32         uint8_t nr_port;
  33 };
  34
  35 uint16_t
  36 rte_octeontx_pchan_map[OCTEONTX_MAX_BGX_PORTS][OCTEONTX_MAX_LMAC_PER_BGX];
  37
  38 enum octeontx_link_speed {
  39         OCTEONTX_LINK_SPEED_SGMII,
  40         OCTEONTX_LINK_SPEED_XAUI,
  41         OCTEONTX_LINK_SPEED_RXAUI,
  42         OCTEONTX_LINK_SPEED_10G_R,
  43         OCTEONTX_LINK_SPEED_40G_R,
  44         OCTEONTX_LINK_SPEED_RESERVE1,
  45         OCTEONTX_LINK_SPEED_QSGMII,
  46         OCTEONTX_LINK_SPEED_RESERVE2
  47 };
  48
  49 int otx_net_logtype_mbox;
  50 int otx_net_logtype_init;
  51 int otx_net_logtype_driver;
  52
  53 RTE_INIT(otx_net_init_log)
  54 {
  55         otx_net_logtype_mbox = rte_log_register("pmd.net.octeontx.mbox");
  56         if (otx_net_logtype_mbox >= 0)
  57                 rte_log_set_level(otx_net_logtype_mbox, RTE_LOG_NOTICE);
  58
  59         otx_net_logtype_init = rte_log_register("pmd.net.octeontx.init");
  60         if (otx_net_logtype_init >= 0)
  61                 rte_log_set_level(otx_net_logtype_init, RTE_LOG_NOTICE);
  62
  63         otx_net_logtype_driver = rte_log_register("pmd.net.octeontx.driver");
  64         if (otx_net_logtype_driver >= 0)
  65                 rte_log_set_level(otx_net_logtype_driver, RTE_LOG_NOTICE);
  66 }
  67
  68 /* Parse integer from integer argument */
  69 static int
  70 parse_integer_arg(const char *key __rte_unused,
  71                 const char *value, void *extra_args)
  72 {
  73         int *i = (int *)extra_args;
  74
  75         *i = atoi(value);
  76         if (*i < 0) {
  77                 octeontx_log_err("argument has to be positive.");
  78                 return -1;
  79         }
  80
  81         return 0;
  82 }
  83
  84 static int
  85 octeontx_parse_vdev_init_params(struct octeontx_vdev_init_params *params,
  86                                 struct rte_vdev_device *dev)
  87 {
  88         struct rte_kvargs *kvlist = NULL;
  89         int ret = 0;
  90
  91         static const char * const octeontx_vdev_valid_params[] = {
  92                 OCTEONTX_VDEV_NR_PORT_ARG,
  93                 NULL
  94         };
  95
  96         const char *input_args = rte_vdev_device_args(dev);
  97         if (params == NULL)
  98                 return -EINVAL;
  99
 100
 101         if (input_args) {
 102                 kvlist = rte_kvargs_parse(input_args,
 103                                 octeontx_vdev_valid_params);
 104                 if (kvlist == NULL)
 105                         return -1;
 106
 107                 ret = rte_kvargs_process(kvlist,
 108                                         OCTEONTX_VDEV_NR_PORT_ARG,
 109                                         &parse_integer_arg,
 110                                         &params->nr_port);
 111                 if (ret < 0)
 112                         goto free_kvlist;
 113         }
 114
 115 free_kvlist:
 116         rte_kvargs_free(kvlist);
 117         return ret;
 118 }
 119
 120 static int
 121 octeontx_port_open(struct octeontx_nic *nic)
 122 {
 123         octeontx_mbox_bgx_port_conf_t bgx_port_conf;
 124         int res;
 125
 126         res = 0;
 127         memset(&bgx_port_conf, 0x0, sizeof(bgx_port_conf));
 128         PMD_INIT_FUNC_TRACE();
 129
 130         res = octeontx_bgx_port_open(nic->port_id, &bgx_port_conf);
 131         if (res < 0) {
 132                 octeontx_log_err("failed to open port %d", res);
 133                 return res;
 134         }
 135
 136         nic->node = bgx_port_conf.node;
 137         nic->port_ena = bgx_port_conf.enable;
 138         nic->base_ichan = bgx_port_conf.base_chan;
 139         nic->base_ochan = bgx_port_conf.base_chan;
 140         nic->num_ichans = bgx_port_conf.num_chans;
 141         nic->num_ochans = bgx_port_conf.num_chans;
 142         nic->bgx_mtu = bgx_port_conf.mtu;
 143         nic->bpen = bgx_port_conf.bpen;
 144         nic->fcs_strip = bgx_port_conf.fcs_strip;
 145         nic->bcast_mode = bgx_port_conf.bcast_mode;
 146         nic->mcast_mode = bgx_port_conf.mcast_mode;
 147         nic->speed      = bgx_port_conf.mode;
 148
 149         memcpy(&nic->mac_addr[0], &bgx_port_conf.macaddr[0],
 150                 RTE_ETHER_ADDR_LEN);
 151
 152         octeontx_log_dbg("port opened %d", nic->port_id);
 153         return res;
 154 }
 155
 156 static void
 157 octeontx_port_close(struct octeontx_nic *nic)
 158 {
 159         PMD_INIT_FUNC_TRACE();
 160
 161         octeontx_bgx_port_close(nic->port_id);
 162         octeontx_log_dbg("port closed %d", nic->port_id);
 163 }
 164
 165 static int
 166 octeontx_port_start(struct octeontx_nic *nic)
 167 {
 168         PMD_INIT_FUNC_TRACE();
 169
 170         return octeontx_bgx_port_start(nic->port_id);
 171 }
 172
 173 static int
 174 octeontx_port_stop(struct octeontx_nic *nic)
 175 {
 176         PMD_INIT_FUNC_TRACE();
 177
 178         return octeontx_bgx_port_stop(nic->port_id);
 179 }
 180
 181 static int
 182 octeontx_port_promisc_set(struct octeontx_nic *nic, int en)
 183 {
 184         struct rte_eth_dev *dev;
 185         int res;
 186
 187         res = 0;
 188         PMD_INIT_FUNC_TRACE();
 189         dev = nic->dev;
 190
 191         res = octeontx_bgx_port_promisc_set(nic->port_id, en);
 192         if (res < 0) {
 193                 octeontx_log_err("failed to set promiscuous mode %d",
 194                                 nic->port_id);
 195                 return res;
 196         }
 197
 198         /* Set proper flag for the mode */
 199         dev->data->promiscuous = (en != 0) ? 1 : 0;
 200
 201         octeontx_log_dbg("port %d : promiscuous mode %s",
 202                         nic->port_id, en ? "set" : "unset");
 203
 204         return 0;
 205 }
 206
 207 static int
 208 octeontx_port_stats(struct octeontx_nic *nic, struct rte_eth_stats *stats)
 209 {
 210         octeontx_mbox_bgx_port_stats_t bgx_stats;
 211         int res;
 212
 213         PMD_INIT_FUNC_TRACE();
 214
 215         res = octeontx_bgx_port_stats(nic->port_id, &bgx_stats);
 216         if (res < 0) {
 217                 octeontx_log_err("failed to get port stats %d", nic->port_id);
 218                 return res;
 219         }
 220
 221         stats->ipackets = bgx_stats.rx_packets;
 222         stats->ibytes = bgx_stats.rx_bytes;
 223         stats->imissed = bgx_stats.rx_dropped;
 224         stats->ierrors = bgx_stats.rx_errors;
 225         stats->opackets = bgx_stats.tx_packets;
 226         stats->obytes = bgx_stats.tx_bytes;
 227         stats->oerrors = bgx_stats.tx_errors;
 228
 229         octeontx_log_dbg("port%d stats inpkts=%" PRIx64 " outpkts=%" PRIx64 "",
 230                         nic->port_id, stats->ipackets, stats->opackets);
 231
 232         return 0;
 233 }
 234
 235 static int
 236 octeontx_port_stats_clr(struct octeontx_nic *nic)
 237 {
 238         PMD_INIT_FUNC_TRACE();
 239
 240         return octeontx_bgx_port_stats_clr(nic->port_id);
 241 }
 242
 243 static inline void
 244 devconf_set_default_sane_values(struct rte_event_dev_config *dev_conf,
 245                                 struct rte_event_dev_info *info)
 246 {
 247         memset(dev_conf, 0, sizeof(struct rte_event_dev_config));
 248         dev_conf->dequeue_timeout_ns = info->min_dequeue_timeout_ns;
 249
 250         dev_conf->nb_event_ports = info->max_event_ports;
 251         dev_conf->nb_event_queues = info->max_event_queues;
 252
 253         dev_conf->nb_event_queue_flows = info->max_event_queue_flows;
 254         dev_conf->nb_event_port_dequeue_depth =
 255                         info->max_event_port_dequeue_depth;
 256         dev_conf->nb_event_port_enqueue_depth =
 257                         info->max_event_port_enqueue_depth;
 258         dev_conf->nb_event_port_enqueue_depth =
 259                         info->max_event_port_enqueue_depth;
 260         dev_conf->nb_events_limit =
 261                         info->max_num_events;
 262 }
 263
 264 static uint16_t
 265 octeontx_tx_offload_flags(struct rte_eth_dev *eth_dev)
 266 {
 267         struct octeontx_nic *nic = octeontx_pmd_priv(eth_dev);
 268         uint16_t flags = 0;
 269
 270         if (!(nic->tx_offloads & DEV_TX_OFFLOAD_MBUF_FAST_FREE))
 271                 flags |= OCCTX_TX_OFFLOAD_MBUF_NOFF_F;
 272
 273         if (nic->tx_offloads & DEV_TX_OFFLOAD_MULTI_SEGS)
 274                 flags |= OCCTX_TX_MULTI_SEG_F;
 275
 276         return flags;
 277 }
 278
 279 static uint16_t
 280 octeontx_rx_offload_flags(struct rte_eth_dev *eth_dev)
 281 {
 282         struct octeontx_nic *nic = octeontx_pmd_priv(eth_dev);
 283         struct rte_eth_dev_data *data = eth_dev->data;
 284         struct rte_eth_conf *conf = &data->dev_conf;
 285         struct rte_eth_rxmode *rxmode = &conf->rxmode;
 286         uint16_t flags = 0;
 287
 288         if (rxmode->mq_mode == ETH_MQ_RX_RSS)
 289                 flags |= OCCTX_RX_OFFLOAD_RSS_F;
 290
 291         if (nic->rx_offloads & DEV_RX_OFFLOAD_SCATTER) {
 292                 flags |= OCCTX_RX_MULTI_SEG_F;
 293                 eth_dev->data->scattered_rx = 1;
 294                 /* If scatter mode is enabled, TX should also be in multi
 295                  * seg mode, else memory leak will occur
 296                  */
 297                 nic->tx_offloads |= DEV_TX_OFFLOAD_MULTI_SEGS;
 298         }
 299
 300         return flags;
 301 }
 302
 303 static int
 304 octeontx_dev_configure(struct rte_eth_dev *dev)
 305 {
 306         struct rte_eth_dev_data *data = dev->data;
 307         struct rte_eth_conf *conf = &data->dev_conf;
 308         struct rte_eth_rxmode *rxmode = &conf->rxmode;
 309         struct rte_eth_txmode *txmode = &conf->txmode;
 310         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 311         int ret;
 312
 313         PMD_INIT_FUNC_TRACE();
 314         RTE_SET_USED(conf);
 315
 316         if (!rte_eal_has_hugepages()) {
 317                 octeontx_log_err("huge page is not configured");
 318                 return -EINVAL;
 319         }
 320
 321         if (txmode->mq_mode) {
 322                 octeontx_log_err("tx mq_mode DCB or VMDq not supported");
 323                 return -EINVAL;
 324         }
 325
 326         if (rxmode->mq_mode != ETH_MQ_RX_NONE &&
 327                 rxmode->mq_mode != ETH_MQ_RX_RSS) {
 328                 octeontx_log_err("unsupported rx qmode %d", rxmode->mq_mode);
 329                 return -EINVAL;
 330         }
 331
 332         if (!(txmode->offloads & DEV_TX_OFFLOAD_MT_LOCKFREE)) {
 333                 PMD_INIT_LOG(NOTICE, "cant disable lockfree tx");
 334                 txmode->offloads |= DEV_TX_OFFLOAD_MT_LOCKFREE;
 335         }
 336
 337         if (conf->link_speeds & ETH_LINK_SPEED_FIXED) {
 338                 octeontx_log_err("setting link speed/duplex not supported");
 339                 return -EINVAL;
 340         }
 341
 342         if (conf->dcb_capability_en) {
 343                 octeontx_log_err("DCB enable not supported");
 344                 return -EINVAL;
 345         }
 346
 347         if (conf->fdir_conf.mode != RTE_FDIR_MODE_NONE) {
 348                 octeontx_log_err("flow director not supported");
 349                 return -EINVAL;
 350         }
 351
 352         nic->num_tx_queues = dev->data->nb_tx_queues;
 353
 354         ret = octeontx_pko_channel_open(nic->pko_vfid * PKO_VF_NUM_DQ,
 355                                         nic->num_tx_queues,
 356                                         nic->base_ochan);
 357         if (ret) {
 358                 octeontx_log_err("failed to open channel %d no-of-txq %d",
 359                            nic->base_ochan, nic->num_tx_queues);
 360                 return -EFAULT;
 361         }
 362
 363         ret = octeontx_dev_vlan_offload_init(dev);
 364         if (ret) {
 365                 octeontx_log_err("failed to initialize vlan offload");
 366                 return -EFAULT;
 367         }
 368
 369         nic->pki.classifier_enable = false;
 370         nic->pki.hash_enable = true;
 371         nic->pki.initialized = false;
 372
 373         nic->rx_offloads |= rxmode->offloads;
 374         nic->tx_offloads |= txmode->offloads;
 375         nic->rx_offload_flags |= octeontx_rx_offload_flags(dev);
 376         nic->tx_offload_flags |= octeontx_tx_offload_flags(dev);
 377
 378         return 0;
 379 }
 380
 381 static void
 382 octeontx_dev_close(struct rte_eth_dev *dev)
 383 {
 384         struct octeontx_txq *txq = NULL;
 385         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 386         unsigned int i;
 387         int ret;
 388
 389         PMD_INIT_FUNC_TRACE();
 390
 391         rte_event_dev_close(nic->evdev);
 392
 393         octeontx_dev_vlan_offload_fini(dev);
 394
 395         ret = octeontx_pko_channel_close(nic->base_ochan);
 396         if (ret < 0) {
 397                 octeontx_log_err("failed to close channel %d VF%d %d %d",
 398                              nic->base_ochan, nic->port_id, nic->num_tx_queues,
 399                              ret);
 400         }
 401         /* Free txq resources for this port */
 402         for (i = 0; i < nic->num_tx_queues; i++) {
 403                 txq = dev->data->tx_queues[i];
 404                 if (!txq)
 405                         continue;
 406
 407                 rte_free(txq);
 408         }
 409
 410         /* Free MAC address table */
 411         rte_free(dev->data->mac_addrs);
 412         dev->data->mac_addrs = NULL;
 413
 414         dev->tx_pkt_burst = NULL;
 415         dev->rx_pkt_burst = NULL;
 416 }
 417
 418 static int
 419 octeontx_dev_mtu_set(struct rte_eth_dev *eth_dev, uint16_t mtu)
 420 {
 421         uint32_t buffsz, frame_size = mtu + OCCTX_L2_OVERHEAD;
 422         struct octeontx_nic *nic = octeontx_pmd_priv(eth_dev);
 423         struct rte_eth_dev_data *data = eth_dev->data;
 424         int rc = 0;
 425
 426         /* Check if MTU is within the allowed range */
 427         if (frame_size < OCCTX_MIN_FRS || frame_size > OCCTX_MAX_FRS)
 428                 return -EINVAL;
 429
 430         buffsz = data->min_rx_buf_size - RTE_PKTMBUF_HEADROOM;
 431
 432         /* Refuse MTU that requires the support of scattered packets
 433          * when this feature has not been enabled before.
 434          */
 435         if (data->dev_started && frame_size > buffsz &&
 436             !(nic->rx_offloads & DEV_RX_OFFLOAD_SCATTER)) {
 437                 octeontx_log_err("Scatter mode is disabled");
 438                 return -EINVAL;
 439         }
 440
 441         /* Check <seg size> * <max_seg>  >= max_frame */
 442         if ((nic->rx_offloads & DEV_RX_OFFLOAD_SCATTER) &&
 443             (frame_size > buffsz * OCCTX_RX_NB_SEG_MAX))
 444                 return -EINVAL;
 445
 446         rc = octeontx_pko_send_mtu(nic->port_id, frame_size);
 447         if (rc)
 448                 return rc;
 449
 450         rc = octeontx_bgx_port_mtu_set(nic->port_id, frame_size);
 451         if (rc)
 452                 return rc;
 453
 454         if (frame_size > RTE_ETHER_MAX_LEN)
 455                 nic->rx_offloads |= DEV_RX_OFFLOAD_JUMBO_FRAME;
 456         else
 457                 nic->rx_offloads &= ~DEV_RX_OFFLOAD_JUMBO_FRAME;
 458
 459         /* Update max_rx_pkt_len */
 460         data->dev_conf.rxmode.max_rx_pkt_len = frame_size;
 461         octeontx_log_info("Received pkt beyond  maxlen %d will be dropped",
 462                           frame_size);
 463
 464         return rc;
 465 }
 466
 467 static int
 468 octeontx_recheck_rx_offloads(struct octeontx_rxq *rxq)
 469 {
 470         struct rte_eth_dev *eth_dev = rxq->eth_dev;
 471         struct octeontx_nic *nic = octeontx_pmd_priv(eth_dev);
 472         struct rte_eth_dev_data *data = eth_dev->data;
 473         struct rte_pktmbuf_pool_private *mbp_priv;
 474         struct evdev_priv_data *evdev_priv;
 475         struct rte_eventdev *dev;
 476         uint32_t buffsz;
 477
 478         /* Get rx buffer size */
 479         mbp_priv = rte_mempool_get_priv(rxq->pool);
 480         buffsz = mbp_priv->mbuf_data_room_size - RTE_PKTMBUF_HEADROOM;
 481
 482         /* Setup scatter mode if needed by jumbo */
 483         if (data->dev_conf.rxmode.max_rx_pkt_len > buffsz) {
 484                 nic->rx_offloads |= DEV_RX_OFFLOAD_SCATTER;
 485                 nic->rx_offload_flags |= octeontx_rx_offload_flags(eth_dev);
 486                 nic->tx_offload_flags |= octeontx_tx_offload_flags(eth_dev);
 487         }
 488
 489         /* Sharing offload flags via eventdev priv region */
 490         dev = &rte_eventdevs[rxq->evdev];
 491         evdev_priv = dev->data->dev_private;
 492         evdev_priv->rx_offload_flags = nic->rx_offload_flags;
 493         evdev_priv->tx_offload_flags = nic->tx_offload_flags;
 494
 495         /* Setup MTU based on max_rx_pkt_len */
 496         nic->mtu = data->dev_conf.rxmode.max_rx_pkt_len - OCCTX_L2_OVERHEAD;
 497
 498         return 0;
 499 }
 500
 501 static int
 502 octeontx_dev_start(struct rte_eth_dev *dev)
 503 {
 504         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 505         struct octeontx_rxq *rxq;
 506         int ret = 0, i;
 507
 508         PMD_INIT_FUNC_TRACE();
 509         /* Rechecking if any new offload set to update
 510          * rx/tx burst function pointer accordingly.
 511          */
 512         for (i = 0; i < dev->data->nb_rx_queues; i++) {
 513                 rxq = dev->data->rx_queues[i];
 514                 octeontx_recheck_rx_offloads(rxq);
 515         }
 516
 517         /* Setting up the mtu based on max_rx_pkt_len */
 518         ret = octeontx_dev_mtu_set(dev, nic->mtu);
 519         if (ret) {
 520                 octeontx_log_err("Failed to set default MTU size %d", ret);
 521                 goto error;
 522         }
 523
 524         /*
 525          * Tx start
 526          */
 527         octeontx_set_tx_function(dev);
 528         ret = octeontx_pko_channel_start(nic->base_ochan);
 529         if (ret < 0) {
 530                 octeontx_log_err("fail to conf VF%d no. txq %d chan %d ret %d",
 531                            nic->port_id, nic->num_tx_queues, nic->base_ochan,
 532                            ret);
 533                 goto error;
 534         }
 535
 536         /*
 537          * Rx start
 538          */
 539         dev->rx_pkt_burst = octeontx_recv_pkts;
 540         ret = octeontx_pki_port_start(nic->port_id);
 541         if (ret < 0) {
 542                 octeontx_log_err("fail to start Rx on port %d", nic->port_id);
 543                 goto channel_stop_error;
 544         }
 545
 546         /*
 547          * Start port
 548          */
 549         ret = octeontx_port_start(nic);
 550         if (ret < 0) {
 551                 octeontx_log_err("failed start port %d", ret);
 552                 goto pki_port_stop_error;
 553         }
 554
 555         PMD_TX_LOG(DEBUG, "pko: start channel %d no.of txq %d port %d",
 556                         nic->base_ochan, nic->num_tx_queues, nic->port_id);
 557
 558         ret = rte_event_dev_start(nic->evdev);
 559         if (ret < 0) {
 560                 octeontx_log_err("failed to start evdev: ret (%d)", ret);
 561                 goto pki_port_stop_error;
 562         }
 563
 564         /* Success */
 565         return ret;
 566
 567 pki_port_stop_error:
 568         octeontx_pki_port_stop(nic->port_id);
 569 channel_stop_error:
 570         octeontx_pko_channel_stop(nic->base_ochan);
 571 error:
 572         return ret;
 573 }
 574
 575 static void
 576 octeontx_dev_stop(struct rte_eth_dev *dev)
 577 {
 578         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 579         int ret;
 580
 581         PMD_INIT_FUNC_TRACE();
 582
 583         rte_event_dev_stop(nic->evdev);
 584
 585         ret = octeontx_port_stop(nic);
 586         if (ret < 0) {
 587                 octeontx_log_err("failed to req stop port %d res=%d",
 588                                         nic->port_id, ret);
 589                 return;
 590         }
 591
 592         ret = octeontx_pki_port_stop(nic->port_id);
 593         if (ret < 0) {
 594                 octeontx_log_err("failed to stop pki port %d res=%d",
 595                                         nic->port_id, ret);
 596                 return;
 597         }
 598
 599         ret = octeontx_pko_channel_stop(nic->base_ochan);
 600         if (ret < 0) {
 601                 octeontx_log_err("failed to stop channel %d VF%d %d %d",
 602                              nic->base_ochan, nic->port_id, nic->num_tx_queues,
 603                              ret);
 604                 return;
 605         }
 606 }
 607
 608 static int
 609 octeontx_dev_promisc_enable(struct rte_eth_dev *dev)
 610 {
 611         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 612
 613         PMD_INIT_FUNC_TRACE();
 614         return octeontx_port_promisc_set(nic, 1);
 615 }
 616
 617 static int
 618 octeontx_dev_promisc_disable(struct rte_eth_dev *dev)
 619 {
 620         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 621
 622         PMD_INIT_FUNC_TRACE();
 623         return octeontx_port_promisc_set(nic, 0);
 624 }
 625
 626 static int
 627 octeontx_port_link_status(struct octeontx_nic *nic)
 628 {
 629         int res;
 630
 631         PMD_INIT_FUNC_TRACE();
 632         res = octeontx_bgx_port_link_status(nic->port_id);
 633         if (res < 0) {
 634                 octeontx_log_err("failed to get port %d link status",
 635                                 nic->port_id);
 636                 return res;
 637         }
 638
 639         nic->link_up = (uint8_t)res;
 640         octeontx_log_dbg("port %d link status %d", nic->port_id, nic->link_up);
 641
 642         return res;
 643 }
 644
 645 /*
 646  * Return 0 means link status changed, -1 means not changed
 647  */
 648 static int
 649 octeontx_dev_link_update(struct rte_eth_dev *dev,
 650                          int wait_to_complete __rte_unused)
 651 {
 652         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 653         struct rte_eth_link link;
 654         int res;
 655
 656         PMD_INIT_FUNC_TRACE();
 657
 658         res = octeontx_port_link_status(nic);
 659         if (res < 0) {
 660                 octeontx_log_err("failed to request link status %d", res);
 661                 return res;
 662         }
 663
 664         link.link_status = nic->link_up;
 665
 666         switch (nic->speed) {
 667         case OCTEONTX_LINK_SPEED_SGMII:
 668                 link.link_speed = ETH_SPEED_NUM_1G;
 669                 break;
 670
 671         case OCTEONTX_LINK_SPEED_XAUI:
 672                 link.link_speed = ETH_SPEED_NUM_10G;
 673                 break;
 674
 675         case OCTEONTX_LINK_SPEED_RXAUI:
 676         case OCTEONTX_LINK_SPEED_10G_R:
 677                 link.link_speed = ETH_SPEED_NUM_10G;
 678                 break;
 679         case OCTEONTX_LINK_SPEED_QSGMII:
 680                 link.link_speed = ETH_SPEED_NUM_5G;
 681                 break;
 682         case OCTEONTX_LINK_SPEED_40G_R:
 683                 link.link_speed = ETH_SPEED_NUM_40G;
 684                 break;
 685
 686         case OCTEONTX_LINK_SPEED_RESERVE1:
 687         case OCTEONTX_LINK_SPEED_RESERVE2:
 688         default:
 689                 link.link_speed = ETH_SPEED_NUM_NONE;
 690                 octeontx_log_err("incorrect link speed %d", nic->speed);
 691                 break;
 692         }
 693
 694         link.link_duplex = ETH_LINK_FULL_DUPLEX;
 695         link.link_autoneg = ETH_LINK_AUTONEG;
 696
 697         return rte_eth_linkstatus_set(dev, &link);
 698 }
 699
 700 static int
 701 octeontx_dev_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
 702 {
 703         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 704
 705         PMD_INIT_FUNC_TRACE();
 706         return octeontx_port_stats(nic, stats);
 707 }
 708
 709 static int
 710 octeontx_dev_stats_reset(struct rte_eth_dev *dev)
 711 {
 712         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 713
 714         PMD_INIT_FUNC_TRACE();
 715         return octeontx_port_stats_clr(nic);
 716 }
 717
 718 static void
 719 octeontx_dev_mac_addr_del(struct rte_eth_dev *dev, uint32_t index)
 720 {
 721         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 722         int ret;
 723
 724         ret = octeontx_bgx_port_mac_del(nic->port_id, index);
 725         if (ret != 0)
 726                 octeontx_log_err("failed to del MAC address filter on port %d",
 727                                  nic->port_id);
 728 }
 729
 730 static int
 731 octeontx_dev_mac_addr_add(struct rte_eth_dev *dev,
 732                           struct rte_ether_addr *mac_addr,
 733                           uint32_t index,
 734                           __rte_unused uint32_t vmdq)
 735 {
 736         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 737         int ret;
 738
 739         ret = octeontx_bgx_port_mac_add(nic->port_id, mac_addr->addr_bytes,
 740                                         index);
 741         if (ret < 0) {
 742                 octeontx_log_err("failed to add MAC address filter on port %d",
 743                                  nic->port_id);
 744                 return ret;
 745         }
 746
 747         return 0;
 748 }
 749
 750 static int
 751 octeontx_dev_default_mac_addr_set(struct rte_eth_dev *dev,
 752                                         struct rte_ether_addr *addr)
 753 {
 754         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 755         int ret;
 756
 757         ret = octeontx_bgx_port_mac_set(nic->port_id, addr->addr_bytes);
 758         if (ret == 0) {
 759                 /* Update same mac address to BGX CAM table */
 760                 ret = octeontx_bgx_port_mac_add(nic->port_id, addr->addr_bytes,
 761                                                 0);
 762         }
 763         if (ret < 0) {
 764                 octeontx_log_err("failed to set MAC address on port %d",
 765                                  nic->port_id);
 766         }
 767
 768         return ret;
 769 }
 770
 771 static int
 772 octeontx_dev_info(struct rte_eth_dev *dev,
 773                 struct rte_eth_dev_info *dev_info)
 774 {
 775         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 776
 777         /* Autonegotiation may be disabled */
 778         dev_info->speed_capa = ETH_LINK_SPEED_FIXED;
 779         dev_info->speed_capa |= ETH_LINK_SPEED_10M | ETH_LINK_SPEED_100M |
 780                         ETH_LINK_SPEED_1G | ETH_LINK_SPEED_10G |
 781                         ETH_LINK_SPEED_40G;
 782
 783         /* Min/Max MTU supported */
 784         dev_info->min_rx_bufsize = OCCTX_MIN_FRS;
 785         dev_info->max_rx_pktlen = OCCTX_MAX_FRS;
 786         dev_info->max_mtu = dev_info->max_rx_pktlen - OCCTX_L2_OVERHEAD;
 787         dev_info->min_mtu = dev_info->min_rx_bufsize - OCCTX_L2_OVERHEAD;
 788
 789         dev_info->max_mac_addrs =
 790                                 octeontx_bgx_port_mac_entries_get(nic->port_id);
 791         dev_info->max_rx_pktlen = PKI_MAX_PKTLEN;
 792         dev_info->max_rx_queues = 1;
 793         dev_info->max_tx_queues = PKO_MAX_NUM_DQ;
 794         dev_info->min_rx_bufsize = 0;
 795
 796         dev_info->default_rxconf = (struct rte_eth_rxconf) {
 797                 .rx_free_thresh = 0,
 798                 .rx_drop_en = 0,
 799                 .offloads = OCTEONTX_RX_OFFLOADS,
 800         };
 801
 802         dev_info->default_txconf = (struct rte_eth_txconf) {
 803                 .tx_free_thresh = 0,
 804                 .offloads = OCTEONTX_TX_OFFLOADS,
 805         };
 806
 807         dev_info->rx_offload_capa = OCTEONTX_RX_OFFLOADS;
 808         dev_info->tx_offload_capa = OCTEONTX_TX_OFFLOADS;
 809         dev_info->rx_queue_offload_capa = OCTEONTX_RX_OFFLOADS;
 810         dev_info->tx_queue_offload_capa = OCTEONTX_TX_OFFLOADS;
 811
 812         return 0;
 813 }
 814
 815 static void
 816 octeontx_dq_info_getter(octeontx_dq_t *dq, void *out)
 817 {
 818         ((octeontx_dq_t *)out)->lmtline_va = dq->lmtline_va;
 819         ((octeontx_dq_t *)out)->ioreg_va = dq->ioreg_va;
 820         ((octeontx_dq_t *)out)->fc_status_va = dq->fc_status_va;
 821 }
 822
 823 static int
 824 octeontx_vf_start_tx_queue(struct rte_eth_dev *dev, struct octeontx_nic *nic,
 825                                 uint16_t qidx)
 826 {
 827         struct octeontx_txq *txq;
 828         int res;
 829
 830         PMD_INIT_FUNC_TRACE();
 831
 832         if (dev->data->tx_queue_state[qidx] == RTE_ETH_QUEUE_STATE_STARTED)
 833                 return 0;
 834
 835         txq = dev->data->tx_queues[qidx];
 836
 837         res = octeontx_pko_channel_query_dqs(nic->base_ochan,
 838                                                 &txq->dq,
 839                                                 sizeof(octeontx_dq_t),
 840                                                 txq->queue_id,
 841                                                 octeontx_dq_info_getter);
 842         if (res < 0) {
 843                 res = -EFAULT;
 844                 goto close_port;
 845         }
 846
 847         dev->data->tx_queue_state[qidx] = RTE_ETH_QUEUE_STATE_STARTED;
 848         return res;
 849
 850 close_port:
 851         (void)octeontx_port_stop(nic);
 852         octeontx_pko_channel_stop(nic->base_ochan);
 853         octeontx_pko_channel_close(nic->base_ochan);
 854         dev->data->tx_queue_state[qidx] = RTE_ETH_QUEUE_STATE_STOPPED;
 855         return res;
 856 }
 857
 858 static int
 859 octeontx_dev_tx_queue_start(struct rte_eth_dev *dev, uint16_t qidx)
 860 {
 861         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 862
 863         PMD_INIT_FUNC_TRACE();
 864         qidx = qidx % PKO_VF_NUM_DQ;
 865         return octeontx_vf_start_tx_queue(dev, nic, qidx);
 866 }
 867
 868 static inline int
 869 octeontx_vf_stop_tx_queue(struct rte_eth_dev *dev, struct octeontx_nic *nic,
 870                           uint16_t qidx)
 871 {
 872         int ret = 0;
 873
 874         RTE_SET_USED(nic);
 875         PMD_INIT_FUNC_TRACE();
 876
 877         if (dev->data->tx_queue_state[qidx] == RTE_ETH_QUEUE_STATE_STOPPED)
 878                 return 0;
 879
 880         dev->data->tx_queue_state[qidx] = RTE_ETH_QUEUE_STATE_STOPPED;
 881         return ret;
 882 }
 883
 884 static int
 885 octeontx_dev_tx_queue_stop(struct rte_eth_dev *dev, uint16_t qidx)
 886 {
 887         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 888
 889         PMD_INIT_FUNC_TRACE();
 890         qidx = qidx % PKO_VF_NUM_DQ;
 891
 892         return octeontx_vf_stop_tx_queue(dev, nic, qidx);
 893 }
 894
 895 static void
 896 octeontx_dev_tx_queue_release(void *tx_queue)
 897 {
 898         struct octeontx_txq *txq = tx_queue;
 899         int res;
 900
 901         PMD_INIT_FUNC_TRACE();
 902
 903         if (txq) {
 904                 res = octeontx_dev_tx_queue_stop(txq->eth_dev, txq->queue_id);
 905                 if (res < 0)
 906                         octeontx_log_err("failed stop tx_queue(%d)\n",
 907                                    txq->queue_id);
 908
 909                 rte_free(txq);
 910         }
 911 }
 912
 913 static int
 914 octeontx_dev_tx_queue_setup(struct rte_eth_dev *dev, uint16_t qidx,
 915                             uint16_t nb_desc, unsigned int socket_id,
 916                             const struct rte_eth_txconf *tx_conf __rte_unused)
 917 {
 918         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 919         struct octeontx_txq *txq = NULL;
 920         uint16_t dq_num;
 921         int res = 0;
 922
 923         RTE_SET_USED(nb_desc);
 924         RTE_SET_USED(socket_id);
 925
 926         dq_num = (nic->pko_vfid * PKO_VF_NUM_DQ) + qidx;
 927
 928         /* Socket id check */
 929         if (socket_id != (unsigned int)SOCKET_ID_ANY &&
 930                         socket_id != (unsigned int)nic->node)
 931                 PMD_TX_LOG(INFO, "socket_id expected %d, configured %d",
 932                                                 socket_id, nic->node);
 933
 934         /* Free memory prior to re-allocation if needed. */
 935         if (dev->data->tx_queues[qidx] != NULL) {
 936                 PMD_TX_LOG(DEBUG, "freeing memory prior to re-allocation %d",
 937                                 qidx);
 938                 octeontx_dev_tx_queue_release(dev->data->tx_queues[qidx]);
 939                 dev->data->tx_queues[qidx] = NULL;
 940         }
 941
 942         /* Allocating tx queue data structure */
 943         txq = rte_zmalloc_socket("ethdev TX queue", sizeof(struct octeontx_txq),
 944                                  RTE_CACHE_LINE_SIZE, nic->node);
 945         if (txq == NULL) {
 946                 octeontx_log_err("failed to allocate txq=%d", qidx);
 947                 res = -ENOMEM;
 948                 goto err;
 949         }
 950
 951         txq->eth_dev = dev;
 952         txq->queue_id = dq_num;
 953         dev->data->tx_queues[qidx] = txq;
 954         dev->data->tx_queue_state[qidx] = RTE_ETH_QUEUE_STATE_STOPPED;
 955
 956         res = octeontx_pko_channel_query_dqs(nic->base_ochan,
 957                                                 &txq->dq,
 958                                                 sizeof(octeontx_dq_t),
 959                                                 txq->queue_id,
 960                                                 octeontx_dq_info_getter);
 961         if (res < 0) {
 962                 res = -EFAULT;
 963                 goto err;
 964         }
 965
 966         PMD_TX_LOG(DEBUG, "[%d]:[%d] txq=%p nb_desc=%d lmtline=%p ioreg_va=%p fc_status_va=%p",
 967                         qidx, txq->queue_id, txq, nb_desc, txq->dq.lmtline_va,
 968                         txq->dq.ioreg_va,
 969                         txq->dq.fc_status_va);
 970
 971         return res;
 972
 973 err:
 974         if (txq)
 975                 rte_free(txq);
 976
 977         return res;
 978 }
 979
 980 static int
 981 octeontx_dev_rx_queue_setup(struct rte_eth_dev *dev, uint16_t qidx,
 982                                 uint16_t nb_desc, unsigned int socket_id,
 983                                 const struct rte_eth_rxconf *rx_conf,
 984                                 struct rte_mempool *mb_pool)
 985 {
 986         struct octeontx_nic *nic = octeontx_pmd_priv(dev);
 987         struct rte_mempool_ops *mp_ops = NULL;
 988         struct octeontx_rxq *rxq = NULL;
 989         pki_pktbuf_cfg_t pktbuf_conf;
 990         pki_hash_cfg_t pki_hash;
 991         pki_qos_cfg_t pki_qos;
 992         uintptr_t pool;
 993         int ret, port;
 994         uint16_t gaura;
 995         unsigned int ev_queues = (nic->ev_queues * nic->port_id) + qidx;
 996         unsigned int ev_ports = (nic->ev_ports * nic->port_id) + qidx;
 997
 998         RTE_SET_USED(nb_desc);
 999
1000         memset(&pktbuf_conf, 0, sizeof(pktbuf_conf));
1001         memset(&pki_hash, 0, sizeof(pki_hash));
1002         memset(&pki_qos, 0, sizeof(pki_qos));
1003
1004         mp_ops = rte_mempool_get_ops(mb_pool->ops_index);
1005         if (strcmp(mp_ops->name, "octeontx_fpavf")) {
1006                 octeontx_log_err("failed to find octeontx_fpavf mempool");
1007                 return -ENOTSUP;
1008         }
1009
1010         /* Handle forbidden configurations */
1011         if (nic->pki.classifier_enable) {
1012                 octeontx_log_err("cannot setup queue %d. "
1013                                         "Classifier option unsupported", qidx);
1014                 return -EINVAL;
1015         }
1016
1017         port = nic->port_id;
1018
1019         /* Rx deferred start is not supported */
1020         if (rx_conf->rx_deferred_start) {
1021                 octeontx_log_err("rx deferred start not supported");
1022                 return -EINVAL;
1023         }
1024
1025         /* Verify queue index */
1026         if (qidx >= dev->data->nb_rx_queues) {
1027                 octeontx_log_err("QID %d not supporteded (0 - %d available)\n",
1028                                 qidx, (dev->data->nb_rx_queues - 1));
1029                 return -ENOTSUP;
1030         }
1031
1032         /* Socket id check */
1033         if (socket_id != (unsigned int)SOCKET_ID_ANY &&
1034                         socket_id != (unsigned int)nic->node)
1035                 PMD_RX_LOG(INFO, "socket_id expected %d, configured %d",
1036                                                 socket_id, nic->node);
1037
1038         /* Allocating rx queue data structure */
1039         rxq = rte_zmalloc_socket("ethdev RX queue", sizeof(struct octeontx_rxq),
1040                                  RTE_CACHE_LINE_SIZE, nic->node);
1041         if (rxq == NULL) {
1042                 octeontx_log_err("failed to allocate rxq=%d", qidx);
1043                 return -ENOMEM;
1044         }
1045
1046         if (!nic->pki.initialized) {
1047                 pktbuf_conf.port_type = 0;
1048                 pki_hash.port_type = 0;
1049                 pki_qos.port_type = 0;
1050
1051                 pktbuf_conf.mmask.f_wqe_skip = 1;
1052                 pktbuf_conf.mmask.f_first_skip = 1;
1053                 pktbuf_conf.mmask.f_later_skip = 1;
1054                 pktbuf_conf.mmask.f_mbuff_size = 1;
1055                 pktbuf_conf.mmask.f_cache_mode = 1;
1056
1057                 pktbuf_conf.wqe_skip = OCTTX_PACKET_WQE_SKIP;
1058                 pktbuf_conf.first_skip = OCTTX_PACKET_FIRST_SKIP(mb_pool);
1059                 pktbuf_conf.later_skip = OCTTX_PACKET_LATER_SKIP;
1060                 pktbuf_conf.mbuff_size = (mb_pool->elt_size -
1061                                         RTE_PKTMBUF_HEADROOM -
1062                                         rte_pktmbuf_priv_size(mb_pool) -
1063                                         sizeof(struct rte_mbuf));
1064
1065                 pktbuf_conf.cache_mode = PKI_OPC_MODE_STF2_STT;
1066
1067                 ret = octeontx_pki_port_pktbuf_config(port, &pktbuf_conf);
1068                 if (ret != 0) {
1069                         octeontx_log_err("fail to configure pktbuf for port %d",
1070                                         port);
1071                         rte_free(rxq);
1072                         return ret;
1073                 }
1074                 PMD_RX_LOG(DEBUG, "Port %d Rx pktbuf configured:\n"
1075                                 "\tmbuf_size:\t0x%0x\n"
1076                                 "\twqe_skip:\t0x%0x\n"
1077                                 "\tfirst_skip:\t0x%0x\n"
1078                                 "\tlater_skip:\t0x%0x\n"
1079                                 "\tcache_mode:\t%s\n",
1080                                 port,
1081                                 pktbuf_conf.mbuff_size,
1082                                 pktbuf_conf.wqe_skip,
1083                                 pktbuf_conf.first_skip,
1084                                 pktbuf_conf.later_skip,
1085                                 (pktbuf_conf.cache_mode ==
1086                                                 PKI_OPC_MODE_STT) ?
1087                                 "STT" :
1088                                 (pktbuf_conf.cache_mode ==
1089                                                 PKI_OPC_MODE_STF) ?
1090                                 "STF" :
1091                                 (pktbuf_conf.cache_mode ==
1092                                                 PKI_OPC_MODE_STF1_STT) ?
1093                                 "STF1_STT" : "STF2_STT");
1094
1095                 if (nic->pki.hash_enable) {
1096                         pki_hash.tag_dlc = 1;
1097                         pki_hash.tag_slc = 1;
1098                         pki_hash.tag_dlf = 1;
1099                         pki_hash.tag_slf = 1;
1100                         pki_hash.tag_prt = 1;
1101                         octeontx_pki_port_hash_config(port, &pki_hash);
1102                 }
1103
1104                 pool = (uintptr_t)mb_pool->pool_id;
1105
1106                 /* Get the gaura Id */
1107                 gaura = octeontx_fpa_bufpool_gaura(pool);
1108
1109                 pki_qos.qpg_qos = PKI_QPG_QOS_NONE;
1110                 pki_qos.num_entry = 1;
1111                 pki_qos.drop_policy = 0;
1112                 pki_qos.tag_type = 0L;
1113                 pki_qos.qos_entry[0].port_add = 0;
1114                 pki_qos.qos_entry[0].gaura = gaura;
1115                 pki_qos.qos_entry[0].ggrp_ok = ev_queues;
1116                 pki_qos.qos_entry[0].ggrp_bad = ev_queues;
1117                 pki_qos.qos_entry[0].grptag_bad = 0;
1118                 pki_qos.qos_entry[0].grptag_ok = 0;
1119
1120                 ret = octeontx_pki_port_create_qos(port, &pki_qos);
1121                 if (ret < 0) {
1122                         octeontx_log_err("failed to create QOS port=%d, q=%d",
1123                                         port, qidx);
1124                         rte_free(rxq);
1125                         return ret;
1126                 }
1127                 nic->pki.initialized = true;
1128         }
1129
1130         rxq->port_id = nic->port_id;
1131         rxq->eth_dev = dev;
1132         rxq->queue_id = qidx;
1133         rxq->evdev = nic->evdev;
1134         rxq->ev_queues = ev_queues;
1135         rxq->ev_ports = ev_ports;
1136         rxq->pool = mb_pool;
1137
1138         octeontx_recheck_rx_offloads(rxq);
1139         dev->data->rx_queues[qidx] = rxq;
1140         dev->data->rx_queue_state[qidx] = RTE_ETH_QUEUE_STATE_STOPPED;
1141         return 0;
1142 }
1143
1144 static void
1145 octeontx_dev_rx_queue_release(void *rxq)
1146 {
1147         rte_free(rxq);
1148 }
1149
1150 static const uint32_t *
1151 octeontx_dev_supported_ptypes_get(struct rte_eth_dev *dev)
1152 {
1153         static const uint32_t ptypes[] = {
1154                 RTE_PTYPE_L3_IPV4,
1155                 RTE_PTYPE_L3_IPV4_EXT,
1156                 RTE_PTYPE_L3_IPV6,
1157                 RTE_PTYPE_L3_IPV6_EXT,
1158                 RTE_PTYPE_L4_TCP,
1159                 RTE_PTYPE_L4_UDP,
1160                 RTE_PTYPE_L4_FRAG,
1161                 RTE_PTYPE_UNKNOWN
1162         };
1163
1164         if (dev->rx_pkt_burst == octeontx_recv_pkts)
1165                 return ptypes;
1166
1167         return NULL;
1168 }
1169
1170 static int
1171 octeontx_pool_ops(struct rte_eth_dev *dev, const char *pool)
1172 {
1173         RTE_SET_USED(dev);
1174
1175         if (!strcmp(pool, "octeontx_fpavf"))
1176                 return 0;
1177
1178         return -ENOTSUP;
1179 }
1180
1181 /* Initialize and register driver with DPDK Application */
1182 static const struct eth_dev_ops octeontx_dev_ops = {
1183         .dev_configure           = octeontx_dev_configure,
1184         .dev_infos_get           = octeontx_dev_info,
1185         .dev_close               = octeontx_dev_close,
1186         .dev_start               = octeontx_dev_start,
1187         .dev_stop                = octeontx_dev_stop,
1188         .promiscuous_enable      = octeontx_dev_promisc_enable,
1189         .promiscuous_disable     = octeontx_dev_promisc_disable,
1190         .link_update             = octeontx_dev_link_update,
1191         .stats_get               = octeontx_dev_stats_get,
1192         .stats_reset             = octeontx_dev_stats_reset,
1193         .mac_addr_remove         = octeontx_dev_mac_addr_del,
1194         .mac_addr_add            = octeontx_dev_mac_addr_add,
1195         .mac_addr_set            = octeontx_dev_default_mac_addr_set,
1196         .vlan_offload_set        = octeontx_dev_vlan_offload_set,
1197         .vlan_filter_set         = octeontx_dev_vlan_filter_set,
1198         .tx_queue_start          = octeontx_dev_tx_queue_start,
1199         .tx_queue_stop           = octeontx_dev_tx_queue_stop,
1200         .tx_queue_setup          = octeontx_dev_tx_queue_setup,
1201         .tx_queue_release        = octeontx_dev_tx_queue_release,
1202         .rx_queue_setup          = octeontx_dev_rx_queue_setup,
1203         .rx_queue_release        = octeontx_dev_rx_queue_release,
1204         .dev_supported_ptypes_get = octeontx_dev_supported_ptypes_get,
1205         .mtu_set                 = octeontx_dev_mtu_set,
1206         .pool_ops_supported      = octeontx_pool_ops,
1207 };
1208
1209 /* Create Ethdev interface per BGX LMAC ports */
1210 static int
1211 octeontx_create(struct rte_vdev_device *dev, int port, uint8_t evdev,
1212                         int socket_id)
1213 {
1214         int res;
1215         size_t pko_vfid;
1216         char octtx_name[OCTEONTX_MAX_NAME_LEN];
1217         struct octeontx_nic *nic = NULL;
1218         struct rte_eth_dev *eth_dev = NULL;
1219         struct rte_eth_dev_data *data;
1220         const char *name = rte_vdev_device_name(dev);
1221         int max_entries;
1222
1223         PMD_INIT_FUNC_TRACE();
1224
1225         sprintf(octtx_name, "%s_%d", name, port);
1226         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
1227                 eth_dev = rte_eth_dev_attach_secondary(octtx_name);
1228                 if (eth_dev == NULL)
1229                         return -ENODEV;
1230
1231                 eth_dev->dev_ops = &octeontx_dev_ops;
1232                 eth_dev->device = &dev->device;
1233                 octeontx_set_tx_function(eth_dev);
1234                 eth_dev->rx_pkt_burst = octeontx_recv_pkts;
1235                 rte_eth_dev_probing_finish(eth_dev);
1236                 return 0;
1237         }
1238
1239         /* Reserve an ethdev entry */
1240         eth_dev = rte_eth_dev_allocate(octtx_name);
1241         if (eth_dev == NULL) {
1242                 octeontx_log_err("failed to allocate rte_eth_dev");
1243                 res = -ENOMEM;
1244                 goto err;
1245         }
1246         data = eth_dev->data;
1247
1248         nic = rte_zmalloc_socket(octtx_name, sizeof(*nic), 0, socket_id);
1249         if (nic == NULL) {
1250                 octeontx_log_err("failed to allocate nic structure");
1251                 res = -ENOMEM;
1252                 goto err;
1253         }
1254         data->dev_private = nic;
1255         pko_vfid = octeontx_pko_get_vfid();
1256
1257         if (pko_vfid == SIZE_MAX) {
1258                 octeontx_log_err("failed to get pko vfid");
1259                 res = -ENODEV;
1260                 goto err;
1261         }
1262
1263         nic->pko_vfid = pko_vfid;
1264         nic->port_id = port;
1265         nic->evdev = evdev;
1266
1267         res = octeontx_port_open(nic);
1268         if (res < 0)
1269                 goto err;
1270
1271         /* Rx side port configuration */
1272         res = octeontx_pki_port_open(port);
1273         if (res != 0) {
1274                 octeontx_log_err("failed to open PKI port %d", port);
1275                 res = -ENODEV;
1276                 goto err;
1277         }
1278
1279         eth_dev->device = &dev->device;
1280         eth_dev->intr_handle = NULL;
1281         eth_dev->data->kdrv = RTE_KDRV_NONE;
1282         eth_dev->data->numa_node = dev->device.numa_node;
1283
1284         data->port_id = eth_dev->data->port_id;
1285
1286         nic->ev_queues = 1;
1287         nic->ev_ports = 1;
1288
1289         data->dev_link.link_status = ETH_LINK_DOWN;
1290         data->dev_started = 0;
1291         data->promiscuous = 0;
1292         data->all_multicast = 0;
1293         data->scattered_rx = 0;
1294
1295         /* Get maximum number of supported MAC entries */
1296         max_entries = octeontx_bgx_port_mac_entries_get(nic->port_id);
1297         if (max_entries < 0) {
1298                 octeontx_log_err("Failed to get max entries for mac addr");
1299                 res = -ENOTSUP;
1300                 goto err;
1301         }
1302
1303         data->mac_addrs = rte_zmalloc_socket(octtx_name, max_entries *
1304                                              RTE_ETHER_ADDR_LEN, 0,
1305                                                         socket_id);
1306         if (data->mac_addrs == NULL) {
1307                 octeontx_log_err("failed to allocate memory for mac_addrs");
1308                 res = -ENOMEM;
1309                 goto err;
1310         }
1311
1312         eth_dev->dev_ops = &octeontx_dev_ops;
1313
1314         /* Finally save ethdev pointer to the NIC structure */
1315         nic->dev = eth_dev;
1316
1317         if (nic->port_id != data->port_id) {
1318                 octeontx_log_err("eth_dev->port_id (%d) is diff to orig (%d)",
1319                                 data->port_id, nic->port_id);
1320                 res = -EINVAL;
1321                 goto free_mac_addrs;
1322         }
1323
1324         /* Update port_id mac to eth_dev */
1325         memcpy(data->mac_addrs, nic->mac_addr, RTE_ETHER_ADDR_LEN);
1326
1327         /* Update same mac address to BGX CAM table at index 0 */
1328         octeontx_bgx_port_mac_add(nic->port_id, nic->mac_addr, 0);
1329
1330         PMD_INIT_LOG(DEBUG, "ethdev info: ");
1331         PMD_INIT_LOG(DEBUG, "port %d, port_ena %d ochan %d num_ochan %d tx_q %d",
1332                                 nic->port_id, nic->port_ena,
1333                                 nic->base_ochan, nic->num_ochans,
1334                                 nic->num_tx_queues);
1335         PMD_INIT_LOG(DEBUG, "speed %d mtu %d", nic->speed, nic->bgx_mtu);
1336
1337         rte_octeontx_pchan_map[(nic->base_ochan >> 8) & 0x7]
1338                 [(nic->base_ochan >> 4) & 0xF] = data->port_id;
1339
1340         rte_eth_dev_probing_finish(eth_dev);
1341         return data->port_id;
1342
1343 free_mac_addrs:
1344         rte_free(data->mac_addrs);
1345 err:
1346         if (nic)
1347                 octeontx_port_close(nic);
1348
1349         rte_eth_dev_release_port(eth_dev);
1350
1351         return res;
1352 }
1353
1354 /* Un initialize octeontx device */
1355 static int
1356 octeontx_remove(struct rte_vdev_device *dev)
1357 {
1358         char octtx_name[OCTEONTX_MAX_NAME_LEN];
1359         struct rte_eth_dev *eth_dev = NULL;
1360         struct octeontx_nic *nic = NULL;
1361         int i;
1362
1363         if (dev == NULL)
1364                 return -EINVAL;
1365
1366         for (i = 0; i < OCTEONTX_VDEV_DEFAULT_MAX_NR_PORT; i++) {
1367                 sprintf(octtx_name, "eth_octeontx_%d", i);
1368
1369                 /* reserve an ethdev entry */
1370                 eth_dev = rte_eth_dev_allocated(octtx_name);
1371                 if (eth_dev == NULL)
1372                         return -ENODEV;
1373
1374                 if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
1375                         rte_eth_dev_release_port(eth_dev);
1376                         continue;
1377                 }
1378
1379                 nic = octeontx_pmd_priv(eth_dev);
1380                 rte_event_dev_stop(nic->evdev);
1381                 PMD_INIT_LOG(INFO, "Closing octeontx device %s", octtx_name);
1382
1383                 rte_eth_dev_release_port(eth_dev);
1384                 rte_event_dev_close(nic->evdev);
1385         }
1386
1387         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
1388                 return 0;
1389
1390         /* Free FC resource */
1391         octeontx_pko_fc_free();
1392
1393         return 0;
1394 }
1395
1396 /* Initialize octeontx device */
1397 static int
1398 octeontx_probe(struct rte_vdev_device *dev)
1399 {
1400         const char *dev_name;
1401         static int probe_once;
1402         uint8_t socket_id, qlist;
1403         int tx_vfcnt, port_id, evdev, qnum, pnum, res, i;
1404         struct rte_event_dev_config dev_conf;
1405         const char *eventdev_name = "event_octeontx";
1406         struct rte_event_dev_info info;
1407         struct rte_eth_dev *eth_dev;
1408
1409         struct octeontx_vdev_init_params init_params = {
1410                 OCTEONTX_VDEV_DEFAULT_MAX_NR_PORT
1411         };
1412
1413         dev_name = rte_vdev_device_name(dev);
1414
1415         if (rte_eal_process_type() == RTE_PROC_SECONDARY &&
1416             strlen(rte_vdev_device_args(dev)) == 0) {
1417                 eth_dev = rte_eth_dev_attach_secondary(dev_name);
1418                 if (!eth_dev) {
1419                         PMD_INIT_LOG(ERR, "Failed to probe %s", dev_name);
1420                         return -1;
1421                 }
1422                 /* TODO: request info from primary to set up Rx and Tx */
1423                 eth_dev->dev_ops = &octeontx_dev_ops;
1424                 eth_dev->device = &dev->device;
1425                 rte_eth_dev_probing_finish(eth_dev);
1426                 return 0;
1427         }
1428
1429         res = octeontx_parse_vdev_init_params(&init_params, dev);
1430         if (res < 0)
1431                 return -EINVAL;
1432
1433         if (init_params.nr_port > OCTEONTX_VDEV_DEFAULT_MAX_NR_PORT) {
1434                 octeontx_log_err("nr_port (%d) > max (%d)", init_params.nr_port,
1435                                 OCTEONTX_VDEV_DEFAULT_MAX_NR_PORT);
1436                 return -ENOTSUP;
1437         }
1438
1439         PMD_INIT_LOG(DEBUG, "initializing %s pmd", dev_name);
1440
1441         socket_id = rte_socket_id();
1442
1443         tx_vfcnt = octeontx_pko_vf_count();
1444
1445         if (tx_vfcnt < init_params.nr_port) {
1446                 octeontx_log_err("not enough PKO (%d) for port number (%d)",
1447                                 tx_vfcnt, init_params.nr_port);
1448                 return -EINVAL;
1449         }
1450         evdev = rte_event_dev_get_dev_id(eventdev_name);
1451         if (evdev < 0) {
1452                 octeontx_log_err("eventdev %s not found", eventdev_name);
1453                 return -ENODEV;
1454         }
1455
1456         res = rte_event_dev_info_get(evdev, &info);
1457         if (res < 0) {
1458                 octeontx_log_err("failed to eventdev info %d", res);
1459                 return -EINVAL;
1460         }
1461
1462         PMD_INIT_LOG(DEBUG, "max_queue %d max_port %d",
1463                         info.max_event_queues, info.max_event_ports);
1464
1465         if (octeontx_pko_init_fc(tx_vfcnt))
1466                 return -ENOMEM;
1467
1468         devconf_set_default_sane_values(&dev_conf, &info);
1469         res = rte_event_dev_configure(evdev, &dev_conf);
1470         if (res < 0)
1471                 goto parse_error;
1472
1473         rte_event_dev_attr_get(evdev, RTE_EVENT_DEV_ATTR_PORT_COUNT,
1474                         (uint32_t *)&pnum);
1475         rte_event_dev_attr_get(evdev, RTE_EVENT_DEV_ATTR_QUEUE_COUNT,
1476                         (uint32_t *)&qnum);
1477         if (pnum < qnum) {
1478                 octeontx_log_err("too few event ports (%d) for event_q(%d)",
1479                                 pnum, qnum);
1480                 res = -EINVAL;
1481                 goto parse_error;
1482         }
1483
1484         /* Enable all queues available */
1485         for (i = 0; i < qnum; i++) {
1486                 res = rte_event_queue_setup(evdev, i, NULL);
1487                 if (res < 0) {
1488                         octeontx_log_err("failed to setup event_q(%d): res %d",
1489                                         i, res);
1490                         goto parse_error;
1491                 }
1492         }
1493
1494         /* Enable all ports available */
1495         for (i = 0; i < pnum; i++) {
1496                 res = rte_event_port_setup(evdev, i, NULL);
1497                 if (res < 0) {
1498                         res = -ENODEV;
1499                         octeontx_log_err("failed to setup ev port(%d) res=%d",
1500                                                 i, res);
1501                         goto parse_error;
1502                 }
1503         }
1504
1505         /*
1506          * Do 1:1 links for ports & queues. All queues would be mapped to
1507          * one port. If there are more ports than queues, then some ports
1508          * won't be linked to any queue.
1509          */
1510         for (i = 0; i < qnum; i++) {
1511                 /* Link one queue to one event port */
1512                 qlist = i;
1513                 res = rte_event_port_link(evdev, i, &qlist, NULL, 1);
1514                 if (res < 0) {
1515                         res = -ENODEV;
1516                         octeontx_log_err("failed to link port (%d): res=%d",
1517                                         i, res);
1518                         goto parse_error;
1519                 }
1520         }
1521
1522         /* Create ethdev interface */
1523         for (i = 0; i < init_params.nr_port; i++) {
1524                 port_id = octeontx_create(dev, i, evdev, socket_id);
1525                 if (port_id < 0) {
1526                         octeontx_log_err("failed to create device %s",
1527                                         dev_name);
1528                         res = -ENODEV;
1529                         goto parse_error;
1530                 }
1531
1532                 PMD_INIT_LOG(INFO, "created ethdev %s for port %d", dev_name,
1533                                         port_id);
1534         }
1535
1536         if (probe_once) {
1537                 octeontx_log_err("interface %s not supported", dev_name);
1538                 octeontx_remove(dev);
1539                 res = -ENOTSUP;
1540                 goto parse_error;
1541         }
1542         rte_mbuf_set_platform_mempool_ops("octeontx_fpavf");
1543         probe_once = 1;
1544
1545         return 0;
1546
1547 parse_error:
1548         octeontx_pko_fc_free();
1549         return res;
1550 }
1551
1552 static struct rte_vdev_driver octeontx_pmd_drv = {
1553         .probe = octeontx_probe,
1554         .remove = octeontx_remove,
1555 };
1556
1557 RTE_PMD_REGISTER_VDEV(OCTEONTX_PMD, octeontx_pmd_drv);
1558 RTE_PMD_REGISTER_ALIAS(OCTEONTX_PMD, eth_octeontx);
1559 RTE_PMD_REGISTER_PARAM_STRING(OCTEONTX_PMD, "nr_port=<int> ");