drivers/net/liquidio/lio_ethdev.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2017 Cavium, Inc
   3  */
   4
   5 #include <rte_string_fns.h>
   6 #include <ethdev_driver.h>
   7 #include <ethdev_pci.h>
   8 #include <rte_cycles.h>
   9 #include <rte_malloc.h>
  10 #include <rte_alarm.h>
  11 #include <rte_ether.h>
  12
  13 #include "lio_logs.h"
  14 #include "lio_23xx_vf.h"
  15 #include "lio_ethdev.h"
  16 #include "lio_rxtx.h"
  17
  18 /* Default RSS key in use */
  19 static uint8_t lio_rss_key[40] = {
  20         0x6D, 0x5A, 0x56, 0xDA, 0x25, 0x5B, 0x0E, 0xC2,
  21         0x41, 0x67, 0x25, 0x3D, 0x43, 0xA3, 0x8F, 0xB0,
  22         0xD0, 0xCA, 0x2B, 0xCB, 0xAE, 0x7B, 0x30, 0xB4,
  23         0x77, 0xCB, 0x2D, 0xA3, 0x80, 0x30, 0xF2, 0x0C,
  24         0x6A, 0x42, 0xB7, 0x3B, 0xBE, 0xAC, 0x01, 0xFA,
  25 };
  26
  27 static const struct rte_eth_desc_lim lio_rx_desc_lim = {
  28         .nb_max         = CN23XX_MAX_OQ_DESCRIPTORS,
  29         .nb_min         = CN23XX_MIN_OQ_DESCRIPTORS,
  30         .nb_align       = 1,
  31 };
  32
  33 static const struct rte_eth_desc_lim lio_tx_desc_lim = {
  34         .nb_max         = CN23XX_MAX_IQ_DESCRIPTORS,
  35         .nb_min         = CN23XX_MIN_IQ_DESCRIPTORS,
  36         .nb_align       = 1,
  37 };
  38
  39 /* Wait for control command to reach nic. */
  40 static uint16_t
  41 lio_wait_for_ctrl_cmd(struct lio_device *lio_dev,
  42                       struct lio_dev_ctrl_cmd *ctrl_cmd)
  43 {
  44         uint16_t timeout = LIO_MAX_CMD_TIMEOUT;
  45
  46         while ((ctrl_cmd->cond == 0) && --timeout) {
  47                 lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
  48                 rte_delay_ms(1);
  49         }
  50
  51         return !timeout;
  52 }
  53
  54 /**
  55  * \brief Send Rx control command
  56  * @param eth_dev Pointer to the structure rte_eth_dev
  57  * @param start_stop whether to start or stop
  58  */
  59 static int
  60 lio_send_rx_ctrl_cmd(struct rte_eth_dev *eth_dev, int start_stop)
  61 {
  62         struct lio_device *lio_dev = LIO_DEV(eth_dev);
  63         struct lio_dev_ctrl_cmd ctrl_cmd;
  64         struct lio_ctrl_pkt ctrl_pkt;
  65
  66         /* flush added to prevent cmd failure
  67          * incase the queue is full
  68          */
  69         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
  70
  71         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
  72         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
  73
  74         ctrl_cmd.eth_dev = eth_dev;
  75         ctrl_cmd.cond = 0;
  76
  77         ctrl_pkt.ncmd.s.cmd = LIO_CMD_RX_CTL;
  78         ctrl_pkt.ncmd.s.param1 = start_stop;
  79         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
  80
  81         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
  82                 lio_dev_err(lio_dev, "Failed to send RX Control message\n");
  83                 return -1;
  84         }
  85
  86         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd)) {
  87                 lio_dev_err(lio_dev, "RX Control command timed out\n");
  88                 return -1;
  89         }
  90
  91         return 0;
  92 }
  93
  94 /* store statistics names and its offset in stats structure */
  95 struct rte_lio_xstats_name_off {
  96         char name[RTE_ETH_XSTATS_NAME_SIZE];
  97         unsigned int offset;
  98 };
  99
 100 static const struct rte_lio_xstats_name_off rte_lio_stats_strings[] = {
 101         {"rx_pkts", offsetof(struct octeon_rx_stats, total_rcvd)},
 102         {"rx_bytes", offsetof(struct octeon_rx_stats, bytes_rcvd)},
 103         {"rx_broadcast_pkts", offsetof(struct octeon_rx_stats, total_bcst)},
 104         {"rx_multicast_pkts", offsetof(struct octeon_rx_stats, total_mcst)},
 105         {"rx_flow_ctrl_pkts", offsetof(struct octeon_rx_stats, ctl_rcvd)},
 106         {"rx_fifo_err", offsetof(struct octeon_rx_stats, fifo_err)},
 107         {"rx_dmac_drop", offsetof(struct octeon_rx_stats, dmac_drop)},
 108         {"rx_fcs_err", offsetof(struct octeon_rx_stats, fcs_err)},
 109         {"rx_jabber_err", offsetof(struct octeon_rx_stats, jabber_err)},
 110         {"rx_l2_err", offsetof(struct octeon_rx_stats, l2_err)},
 111         {"rx_vxlan_pkts", offsetof(struct octeon_rx_stats, fw_rx_vxlan)},
 112         {"rx_vxlan_err", offsetof(struct octeon_rx_stats, fw_rx_vxlan_err)},
 113         {"rx_lro_pkts", offsetof(struct octeon_rx_stats, fw_lro_pkts)},
 114         {"tx_pkts", (offsetof(struct octeon_tx_stats, total_pkts_sent)) +
 115                                                 sizeof(struct octeon_rx_stats)},
 116         {"tx_bytes", (offsetof(struct octeon_tx_stats, total_bytes_sent)) +
 117                                                 sizeof(struct octeon_rx_stats)},
 118         {"tx_broadcast_pkts",
 119                 (offsetof(struct octeon_tx_stats, bcast_pkts_sent)) +
 120                         sizeof(struct octeon_rx_stats)},
 121         {"tx_multicast_pkts",
 122                 (offsetof(struct octeon_tx_stats, mcast_pkts_sent)) +
 123                         sizeof(struct octeon_rx_stats)},
 124         {"tx_flow_ctrl_pkts", (offsetof(struct octeon_tx_stats, ctl_sent)) +
 125                                                 sizeof(struct octeon_rx_stats)},
 126         {"tx_fifo_err", (offsetof(struct octeon_tx_stats, fifo_err)) +
 127                                                 sizeof(struct octeon_rx_stats)},
 128         {"tx_total_collisions", (offsetof(struct octeon_tx_stats,
 129                                           total_collisions)) +
 130                                                 sizeof(struct octeon_rx_stats)},
 131         {"tx_tso", (offsetof(struct octeon_tx_stats, fw_tso)) +
 132                                                 sizeof(struct octeon_rx_stats)},
 133         {"tx_vxlan_pkts", (offsetof(struct octeon_tx_stats, fw_tx_vxlan)) +
 134                                                 sizeof(struct octeon_rx_stats)},
 135 };
 136
 137 #define LIO_NB_XSTATS   RTE_DIM(rte_lio_stats_strings)
 138
 139 /* Get hw stats of the port */
 140 static int
 141 lio_dev_xstats_get(struct rte_eth_dev *eth_dev, struct rte_eth_xstat *xstats,
 142                    unsigned int n)
 143 {
 144         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 145         uint16_t timeout = LIO_MAX_CMD_TIMEOUT;
 146         struct octeon_link_stats *hw_stats;
 147         struct lio_link_stats_resp *resp;
 148         struct lio_soft_command *sc;
 149         uint32_t resp_size;
 150         unsigned int i;
 151         int retval;
 152
 153         if (!lio_dev->intf_open) {
 154                 lio_dev_err(lio_dev, "Port %d down\n",
 155                             lio_dev->port_id);
 156                 return -EINVAL;
 157         }
 158
 159         if (n < LIO_NB_XSTATS)
 160                 return LIO_NB_XSTATS;
 161
 162         resp_size = sizeof(struct lio_link_stats_resp);
 163         sc = lio_alloc_soft_command(lio_dev, 0, resp_size, 0);
 164         if (sc == NULL)
 165                 return -ENOMEM;
 166
 167         resp = (struct lio_link_stats_resp *)sc->virtrptr;
 168         lio_prepare_soft_command(lio_dev, sc, LIO_OPCODE,
 169                                  LIO_OPCODE_PORT_STATS, 0, 0, 0);
 170
 171         /* Setting wait time in seconds */
 172         sc->wait_time = LIO_MAX_CMD_TIMEOUT / 1000;
 173
 174         retval = lio_send_soft_command(lio_dev, sc);
 175         if (retval == LIO_IQ_SEND_FAILED) {
 176                 lio_dev_err(lio_dev, "failed to get port stats from firmware. status: %x\n",
 177                             retval);
 178                 goto get_stats_fail;
 179         }
 180
 181         while ((*sc->status_word == LIO_COMPLETION_WORD_INIT) && --timeout) {
 182                 lio_flush_iq(lio_dev, lio_dev->instr_queue[sc->iq_no]);
 183                 lio_process_ordered_list(lio_dev);
 184                 rte_delay_ms(1);
 185         }
 186
 187         retval = resp->status;
 188         if (retval) {
 189                 lio_dev_err(lio_dev, "failed to get port stats from firmware\n");
 190                 goto get_stats_fail;
 191         }
 192
 193         lio_swap_8B_data((uint64_t *)(&resp->link_stats),
 194                          sizeof(struct octeon_link_stats) >> 3);
 195
 196         hw_stats = &resp->link_stats;
 197
 198         for (i = 0; i < LIO_NB_XSTATS; i++) {
 199                 xstats[i].id = i;
 200                 xstats[i].value =
 201                     *(uint64_t *)(((char *)hw_stats) +
 202                                         rte_lio_stats_strings[i].offset);
 203         }
 204
 205         lio_free_soft_command(sc);
 206
 207         return LIO_NB_XSTATS;
 208
 209 get_stats_fail:
 210         lio_free_soft_command(sc);
 211
 212         return -1;
 213 }
 214
 215 static int
 216 lio_dev_xstats_get_names(struct rte_eth_dev *eth_dev,
 217                          struct rte_eth_xstat_name *xstats_names,
 218                          unsigned limit __rte_unused)
 219 {
 220         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 221         unsigned int i;
 222
 223         if (!lio_dev->intf_open) {
 224                 lio_dev_err(lio_dev, "Port %d down\n",
 225                             lio_dev->port_id);
 226                 return -EINVAL;
 227         }
 228
 229         if (xstats_names == NULL)
 230                 return LIO_NB_XSTATS;
 231
 232         /* Note: limit checked in rte_eth_xstats_names() */
 233
 234         for (i = 0; i < LIO_NB_XSTATS; i++) {
 235                 snprintf(xstats_names[i].name, sizeof(xstats_names[i].name),
 236                          "%s", rte_lio_stats_strings[i].name);
 237         }
 238
 239         return LIO_NB_XSTATS;
 240 }
 241
 242 /* Reset hw stats for the port */
 243 static int
 244 lio_dev_xstats_reset(struct rte_eth_dev *eth_dev)
 245 {
 246         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 247         struct lio_dev_ctrl_cmd ctrl_cmd;
 248         struct lio_ctrl_pkt ctrl_pkt;
 249         int ret;
 250
 251         if (!lio_dev->intf_open) {
 252                 lio_dev_err(lio_dev, "Port %d down\n",
 253                             lio_dev->port_id);
 254                 return -EINVAL;
 255         }
 256
 257         /* flush added to prevent cmd failure
 258          * incase the queue is full
 259          */
 260         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
 261
 262         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
 263         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
 264
 265         ctrl_cmd.eth_dev = eth_dev;
 266         ctrl_cmd.cond = 0;
 267
 268         ctrl_pkt.ncmd.s.cmd = LIO_CMD_CLEAR_STATS;
 269         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
 270
 271         ret = lio_send_ctrl_pkt(lio_dev, &ctrl_pkt);
 272         if (ret != 0) {
 273                 lio_dev_err(lio_dev, "Failed to send clear stats command\n");
 274                 return ret;
 275         }
 276
 277         ret = lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd);
 278         if (ret != 0) {
 279                 lio_dev_err(lio_dev, "Clear stats command timed out\n");
 280                 return ret;
 281         }
 282
 283         /* clear stored per queue stats */
 284         RTE_FUNC_PTR_OR_ERR_RET(*eth_dev->dev_ops->stats_reset, 0);
 285         return (*eth_dev->dev_ops->stats_reset)(eth_dev);
 286 }
 287
 288 /* Retrieve the device statistics (# packets in/out, # bytes in/out, etc */
 289 static int
 290 lio_dev_stats_get(struct rte_eth_dev *eth_dev,
 291                   struct rte_eth_stats *stats)
 292 {
 293         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 294         struct lio_droq_stats *oq_stats;
 295         struct lio_iq_stats *iq_stats;
 296         struct lio_instr_queue *txq;
 297         struct lio_droq *droq;
 298         int i, iq_no, oq_no;
 299         uint64_t bytes = 0;
 300         uint64_t pkts = 0;
 301         uint64_t drop = 0;
 302
 303         for (i = 0; i < eth_dev->data->nb_tx_queues; i++) {
 304                 iq_no = lio_dev->linfo.txpciq[i].s.q_no;
 305                 txq = lio_dev->instr_queue[iq_no];
 306                 if (txq != NULL) {
 307                         iq_stats = &txq->stats;
 308                         pkts += iq_stats->tx_done;
 309                         drop += iq_stats->tx_dropped;
 310                         bytes += iq_stats->tx_tot_bytes;
 311                 }
 312         }
 313
 314         stats->opackets = pkts;
 315         stats->obytes = bytes;
 316         stats->oerrors = drop;
 317
 318         pkts = 0;
 319         drop = 0;
 320         bytes = 0;
 321
 322         for (i = 0; i < eth_dev->data->nb_rx_queues; i++) {
 323                 oq_no = lio_dev->linfo.rxpciq[i].s.q_no;
 324                 droq = lio_dev->droq[oq_no];
 325                 if (droq != NULL) {
 326                         oq_stats = &droq->stats;
 327                         pkts += oq_stats->rx_pkts_received;
 328                         drop += (oq_stats->rx_dropped +
 329                                         oq_stats->dropped_toomany +
 330                                         oq_stats->dropped_nomem);
 331                         bytes += oq_stats->rx_bytes_received;
 332                 }
 333         }
 334         stats->ibytes = bytes;
 335         stats->ipackets = pkts;
 336         stats->ierrors = drop;
 337
 338         return 0;
 339 }
 340
 341 static int
 342 lio_dev_stats_reset(struct rte_eth_dev *eth_dev)
 343 {
 344         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 345         struct lio_droq_stats *oq_stats;
 346         struct lio_iq_stats *iq_stats;
 347         struct lio_instr_queue *txq;
 348         struct lio_droq *droq;
 349         int i, iq_no, oq_no;
 350
 351         for (i = 0; i < eth_dev->data->nb_tx_queues; i++) {
 352                 iq_no = lio_dev->linfo.txpciq[i].s.q_no;
 353                 txq = lio_dev->instr_queue[iq_no];
 354                 if (txq != NULL) {
 355                         iq_stats = &txq->stats;
 356                         memset(iq_stats, 0, sizeof(struct lio_iq_stats));
 357                 }
 358         }
 359
 360         for (i = 0; i < eth_dev->data->nb_rx_queues; i++) {
 361                 oq_no = lio_dev->linfo.rxpciq[i].s.q_no;
 362                 droq = lio_dev->droq[oq_no];
 363                 if (droq != NULL) {
 364                         oq_stats = &droq->stats;
 365                         memset(oq_stats, 0, sizeof(struct lio_droq_stats));
 366                 }
 367         }
 368
 369         return 0;
 370 }
 371
 372 static int
 373 lio_dev_info_get(struct rte_eth_dev *eth_dev,
 374                  struct rte_eth_dev_info *devinfo)
 375 {
 376         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 377         struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
 378
 379         switch (pci_dev->id.subsystem_device_id) {
 380         /* CN23xx 10G cards */
 381         case PCI_SUBSYS_DEV_ID_CN2350_210:
 382         case PCI_SUBSYS_DEV_ID_CN2360_210:
 383         case PCI_SUBSYS_DEV_ID_CN2350_210SVPN3:
 384         case PCI_SUBSYS_DEV_ID_CN2360_210SVPN3:
 385         case PCI_SUBSYS_DEV_ID_CN2350_210SVPT:
 386         case PCI_SUBSYS_DEV_ID_CN2360_210SVPT:
 387                 devinfo->speed_capa = ETH_LINK_SPEED_10G;
 388                 break;
 389         /* CN23xx 25G cards */
 390         case PCI_SUBSYS_DEV_ID_CN2350_225:
 391         case PCI_SUBSYS_DEV_ID_CN2360_225:
 392                 devinfo->speed_capa = ETH_LINK_SPEED_25G;
 393                 break;
 394         default:
 395                 devinfo->speed_capa = ETH_LINK_SPEED_10G;
 396                 lio_dev_err(lio_dev,
 397                             "Unknown CN23XX subsystem device id. Setting 10G as default link speed.\n");
 398                 return -EINVAL;
 399         }
 400
 401         devinfo->max_rx_queues = lio_dev->max_rx_queues;
 402         devinfo->max_tx_queues = lio_dev->max_tx_queues;
 403
 404         devinfo->min_rx_bufsize = LIO_MIN_RX_BUF_SIZE;
 405         devinfo->max_rx_pktlen = LIO_MAX_RX_PKTLEN;
 406
 407         devinfo->max_mac_addrs = 1;
 408
 409         devinfo->rx_offload_capa = (DEV_RX_OFFLOAD_IPV4_CKSUM           |
 410                                     DEV_RX_OFFLOAD_UDP_CKSUM            |
 411                                     DEV_RX_OFFLOAD_TCP_CKSUM            |
 412                                     DEV_RX_OFFLOAD_VLAN_STRIP           |
 413                                     DEV_RX_OFFLOAD_RSS_HASH);
 414         devinfo->tx_offload_capa = (DEV_TX_OFFLOAD_IPV4_CKSUM           |
 415                                     DEV_TX_OFFLOAD_UDP_CKSUM            |
 416                                     DEV_TX_OFFLOAD_TCP_CKSUM            |
 417                                     DEV_TX_OFFLOAD_OUTER_IPV4_CKSUM);
 418
 419         devinfo->rx_desc_lim = lio_rx_desc_lim;
 420         devinfo->tx_desc_lim = lio_tx_desc_lim;
 421
 422         devinfo->reta_size = LIO_RSS_MAX_TABLE_SZ;
 423         devinfo->hash_key_size = LIO_RSS_MAX_KEY_SZ;
 424         devinfo->flow_type_rss_offloads = (ETH_RSS_IPV4                 |
 425                                            ETH_RSS_NONFRAG_IPV4_TCP     |
 426                                            ETH_RSS_IPV6                 |
 427                                            ETH_RSS_NONFRAG_IPV6_TCP     |
 428                                            ETH_RSS_IPV6_EX              |
 429                                            ETH_RSS_IPV6_TCP_EX);
 430         return 0;
 431 }
 432
 433 static int
 434 lio_dev_mtu_set(struct rte_eth_dev *eth_dev, uint16_t mtu)
 435 {
 436         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 437         uint16_t pf_mtu = lio_dev->linfo.link.s.mtu;
 438         struct lio_dev_ctrl_cmd ctrl_cmd;
 439         struct lio_ctrl_pkt ctrl_pkt;
 440
 441         PMD_INIT_FUNC_TRACE();
 442
 443         if (!lio_dev->intf_open) {
 444                 lio_dev_err(lio_dev, "Port %d down, can't set MTU\n",
 445                             lio_dev->port_id);
 446                 return -EINVAL;
 447         }
 448
 449         /* check if VF MTU is within allowed range.
 450          * New value should not exceed PF MTU.
 451          */
 452         if (mtu < RTE_ETHER_MIN_MTU || mtu > pf_mtu) {
 453                 lio_dev_err(lio_dev, "VF MTU should be >= %d and <= %d\n",
 454                             RTE_ETHER_MIN_MTU, pf_mtu);
 455                 return -EINVAL;
 456         }
 457
 458         /* flush added to prevent cmd failure
 459          * incase the queue is full
 460          */
 461         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
 462
 463         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
 464         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
 465
 466         ctrl_cmd.eth_dev = eth_dev;
 467         ctrl_cmd.cond = 0;
 468
 469         ctrl_pkt.ncmd.s.cmd = LIO_CMD_CHANGE_MTU;
 470         ctrl_pkt.ncmd.s.param1 = mtu;
 471         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
 472
 473         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
 474                 lio_dev_err(lio_dev, "Failed to send command to change MTU\n");
 475                 return -1;
 476         }
 477
 478         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd)) {
 479                 lio_dev_err(lio_dev, "Command to change MTU timed out\n");
 480                 return -1;
 481         }
 482
 483         if (mtu > RTE_ETHER_MTU)
 484                 eth_dev->data->dev_conf.rxmode.offloads |=
 485                         DEV_RX_OFFLOAD_JUMBO_FRAME;
 486         else
 487                 eth_dev->data->dev_conf.rxmode.offloads &=
 488                         ~DEV_RX_OFFLOAD_JUMBO_FRAME;
 489
 490         return 0;
 491 }
 492
 493 static int
 494 lio_dev_rss_reta_update(struct rte_eth_dev *eth_dev,
 495                         struct rte_eth_rss_reta_entry64 *reta_conf,
 496                         uint16_t reta_size)
 497 {
 498         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 499         struct lio_rss_ctx *rss_state = &lio_dev->rss_state;
 500         struct lio_rss_set *rss_param;
 501         struct lio_dev_ctrl_cmd ctrl_cmd;
 502         struct lio_ctrl_pkt ctrl_pkt;
 503         int i, j, index;
 504
 505         if (!lio_dev->intf_open) {
 506                 lio_dev_err(lio_dev, "Port %d down, can't update reta\n",
 507                             lio_dev->port_id);
 508                 return -EINVAL;
 509         }
 510
 511         if (reta_size != LIO_RSS_MAX_TABLE_SZ) {
 512                 lio_dev_err(lio_dev,
 513                             "The size of hash lookup table configured (%d) doesn't match the number hardware can supported (%d)\n",
 514                             reta_size, LIO_RSS_MAX_TABLE_SZ);
 515                 return -EINVAL;
 516         }
 517
 518         /* flush added to prevent cmd failure
 519          * incase the queue is full
 520          */
 521         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
 522
 523         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
 524         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
 525
 526         rss_param = (struct lio_rss_set *)&ctrl_pkt.udd[0];
 527
 528         ctrl_cmd.eth_dev = eth_dev;
 529         ctrl_cmd.cond = 0;
 530
 531         ctrl_pkt.ncmd.s.cmd = LIO_CMD_SET_RSS;
 532         ctrl_pkt.ncmd.s.more = sizeof(struct lio_rss_set) >> 3;
 533         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
 534
 535         rss_param->param.flags = 0xF;
 536         rss_param->param.flags &= ~LIO_RSS_PARAM_ITABLE_UNCHANGED;
 537         rss_param->param.itablesize = LIO_RSS_MAX_TABLE_SZ;
 538
 539         for (i = 0; i < (reta_size / RTE_RETA_GROUP_SIZE); i++) {
 540                 for (j = 0; j < RTE_RETA_GROUP_SIZE; j++) {
 541                         if ((reta_conf[i].mask) & ((uint64_t)1 << j)) {
 542                                 index = (i * RTE_RETA_GROUP_SIZE) + j;
 543                                 rss_state->itable[index] = reta_conf[i].reta[j];
 544                         }
 545                 }
 546         }
 547
 548         rss_state->itable_size = LIO_RSS_MAX_TABLE_SZ;
 549         memcpy(rss_param->itable, rss_state->itable, rss_state->itable_size);
 550
 551         lio_swap_8B_data((uint64_t *)rss_param, LIO_RSS_PARAM_SIZE >> 3);
 552
 553         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
 554                 lio_dev_err(lio_dev, "Failed to set rss hash\n");
 555                 return -1;
 556         }
 557
 558         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd)) {
 559                 lio_dev_err(lio_dev, "Set rss hash timed out\n");
 560                 return -1;
 561         }
 562
 563         return 0;
 564 }
 565
 566 static int
 567 lio_dev_rss_reta_query(struct rte_eth_dev *eth_dev,
 568                        struct rte_eth_rss_reta_entry64 *reta_conf,
 569                        uint16_t reta_size)
 570 {
 571         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 572         struct lio_rss_ctx *rss_state = &lio_dev->rss_state;
 573         int i, num;
 574
 575         if (reta_size != LIO_RSS_MAX_TABLE_SZ) {
 576                 lio_dev_err(lio_dev,
 577                             "The size of hash lookup table configured (%d) doesn't match the number hardware can supported (%d)\n",
 578                             reta_size, LIO_RSS_MAX_TABLE_SZ);
 579                 return -EINVAL;
 580         }
 581
 582         num = reta_size / RTE_RETA_GROUP_SIZE;
 583
 584         for (i = 0; i < num; i++) {
 585                 memcpy(reta_conf->reta,
 586                        &rss_state->itable[i * RTE_RETA_GROUP_SIZE],
 587                        RTE_RETA_GROUP_SIZE);
 588                 reta_conf++;
 589         }
 590
 591         return 0;
 592 }
 593
 594 static int
 595 lio_dev_rss_hash_conf_get(struct rte_eth_dev *eth_dev,
 596                           struct rte_eth_rss_conf *rss_conf)
 597 {
 598         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 599         struct lio_rss_ctx *rss_state = &lio_dev->rss_state;
 600         uint8_t *hash_key = NULL;
 601         uint64_t rss_hf = 0;
 602
 603         if (rss_state->hash_disable) {
 604                 lio_dev_info(lio_dev, "RSS disabled in nic\n");
 605                 rss_conf->rss_hf = 0;
 606                 return 0;
 607         }
 608
 609         /* Get key value */
 610         hash_key = rss_conf->rss_key;
 611         if (hash_key != NULL)
 612                 memcpy(hash_key, rss_state->hash_key, rss_state->hash_key_size);
 613
 614         if (rss_state->ip)
 615                 rss_hf |= ETH_RSS_IPV4;
 616         if (rss_state->tcp_hash)
 617                 rss_hf |= ETH_RSS_NONFRAG_IPV4_TCP;
 618         if (rss_state->ipv6)
 619                 rss_hf |= ETH_RSS_IPV6;
 620         if (rss_state->ipv6_tcp_hash)
 621                 rss_hf |= ETH_RSS_NONFRAG_IPV6_TCP;
 622         if (rss_state->ipv6_ex)
 623                 rss_hf |= ETH_RSS_IPV6_EX;
 624         if (rss_state->ipv6_tcp_ex_hash)
 625                 rss_hf |= ETH_RSS_IPV6_TCP_EX;
 626
 627         rss_conf->rss_hf = rss_hf;
 628
 629         return 0;
 630 }
 631
 632 static int
 633 lio_dev_rss_hash_update(struct rte_eth_dev *eth_dev,
 634                         struct rte_eth_rss_conf *rss_conf)
 635 {
 636         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 637         struct lio_rss_ctx *rss_state = &lio_dev->rss_state;
 638         struct lio_rss_set *rss_param;
 639         struct lio_dev_ctrl_cmd ctrl_cmd;
 640         struct lio_ctrl_pkt ctrl_pkt;
 641
 642         if (!lio_dev->intf_open) {
 643                 lio_dev_err(lio_dev, "Port %d down, can't update hash\n",
 644                             lio_dev->port_id);
 645                 return -EINVAL;
 646         }
 647
 648         /* flush added to prevent cmd failure
 649          * incase the queue is full
 650          */
 651         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
 652
 653         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
 654         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
 655
 656         rss_param = (struct lio_rss_set *)&ctrl_pkt.udd[0];
 657
 658         ctrl_cmd.eth_dev = eth_dev;
 659         ctrl_cmd.cond = 0;
 660
 661         ctrl_pkt.ncmd.s.cmd = LIO_CMD_SET_RSS;
 662         ctrl_pkt.ncmd.s.more = sizeof(struct lio_rss_set) >> 3;
 663         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
 664
 665         rss_param->param.flags = 0xF;
 666
 667         if (rss_conf->rss_key) {
 668                 rss_param->param.flags &= ~LIO_RSS_PARAM_HASH_KEY_UNCHANGED;
 669                 rss_state->hash_key_size = LIO_RSS_MAX_KEY_SZ;
 670                 rss_param->param.hashkeysize = LIO_RSS_MAX_KEY_SZ;
 671                 memcpy(rss_state->hash_key, rss_conf->rss_key,
 672                        rss_state->hash_key_size);
 673                 memcpy(rss_param->key, rss_state->hash_key,
 674                        rss_state->hash_key_size);
 675         }
 676
 677         if ((rss_conf->rss_hf & LIO_RSS_OFFLOAD_ALL) == 0) {
 678                 /* Can't disable rss through hash flags,
 679                  * if it is enabled by default during init
 680                  */
 681                 if (!rss_state->hash_disable)
 682                         return -EINVAL;
 683
 684                 /* This is for --disable-rss during testpmd launch */
 685                 rss_param->param.flags |= LIO_RSS_PARAM_DISABLE_RSS;
 686         } else {
 687                 uint32_t hashinfo = 0;
 688
 689                 /* Can't enable rss if disabled by default during init */
 690                 if (rss_state->hash_disable)
 691                         return -EINVAL;
 692
 693                 if (rss_conf->rss_hf & ETH_RSS_IPV4) {
 694                         hashinfo |= LIO_RSS_HASH_IPV4;
 695                         rss_state->ip = 1;
 696                 } else {
 697                         rss_state->ip = 0;
 698                 }
 699
 700                 if (rss_conf->rss_hf & ETH_RSS_NONFRAG_IPV4_TCP) {
 701                         hashinfo |= LIO_RSS_HASH_TCP_IPV4;
 702                         rss_state->tcp_hash = 1;
 703                 } else {
 704                         rss_state->tcp_hash = 0;
 705                 }
 706
 707                 if (rss_conf->rss_hf & ETH_RSS_IPV6) {
 708                         hashinfo |= LIO_RSS_HASH_IPV6;
 709                         rss_state->ipv6 = 1;
 710                 } else {
 711                         rss_state->ipv6 = 0;
 712                 }
 713
 714                 if (rss_conf->rss_hf & ETH_RSS_NONFRAG_IPV6_TCP) {
 715                         hashinfo |= LIO_RSS_HASH_TCP_IPV6;
 716                         rss_state->ipv6_tcp_hash = 1;
 717                 } else {
 718                         rss_state->ipv6_tcp_hash = 0;
 719                 }
 720
 721                 if (rss_conf->rss_hf & ETH_RSS_IPV6_EX) {
 722                         hashinfo |= LIO_RSS_HASH_IPV6_EX;
 723                         rss_state->ipv6_ex = 1;
 724                 } else {
 725                         rss_state->ipv6_ex = 0;
 726                 }
 727
 728                 if (rss_conf->rss_hf & ETH_RSS_IPV6_TCP_EX) {
 729                         hashinfo |= LIO_RSS_HASH_TCP_IPV6_EX;
 730                         rss_state->ipv6_tcp_ex_hash = 1;
 731                 } else {
 732                         rss_state->ipv6_tcp_ex_hash = 0;
 733                 }
 734
 735                 rss_param->param.flags &= ~LIO_RSS_PARAM_HASH_INFO_UNCHANGED;
 736                 rss_param->param.hashinfo = hashinfo;
 737         }
 738
 739         lio_swap_8B_data((uint64_t *)rss_param, LIO_RSS_PARAM_SIZE >> 3);
 740
 741         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
 742                 lio_dev_err(lio_dev, "Failed to set rss hash\n");
 743                 return -1;
 744         }
 745
 746         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd)) {
 747                 lio_dev_err(lio_dev, "Set rss hash timed out\n");
 748                 return -1;
 749         }
 750
 751         return 0;
 752 }
 753
 754 /**
 755  * Add vxlan dest udp port for an interface.
 756  *
 757  * @param eth_dev
 758  *  Pointer to the structure rte_eth_dev
 759  * @param udp_tnl
 760  *  udp tunnel conf
 761  *
 762  * @return
 763  *  On success return 0
 764  *  On failure return -1
 765  */
 766 static int
 767 lio_dev_udp_tunnel_add(struct rte_eth_dev *eth_dev,
 768                        struct rte_eth_udp_tunnel *udp_tnl)
 769 {
 770         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 771         struct lio_dev_ctrl_cmd ctrl_cmd;
 772         struct lio_ctrl_pkt ctrl_pkt;
 773
 774         if (udp_tnl == NULL)
 775                 return -EINVAL;
 776
 777         if (udp_tnl->prot_type != RTE_TUNNEL_TYPE_VXLAN) {
 778                 lio_dev_err(lio_dev, "Unsupported tunnel type\n");
 779                 return -1;
 780         }
 781
 782         /* flush added to prevent cmd failure
 783          * incase the queue is full
 784          */
 785         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
 786
 787         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
 788         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
 789
 790         ctrl_cmd.eth_dev = eth_dev;
 791         ctrl_cmd.cond = 0;
 792
 793         ctrl_pkt.ncmd.s.cmd = LIO_CMD_VXLAN_PORT_CONFIG;
 794         ctrl_pkt.ncmd.s.param1 = udp_tnl->udp_port;
 795         ctrl_pkt.ncmd.s.more = LIO_CMD_VXLAN_PORT_ADD;
 796         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
 797
 798         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
 799                 lio_dev_err(lio_dev, "Failed to send VXLAN_PORT_ADD command\n");
 800                 return -1;
 801         }
 802
 803         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd)) {
 804                 lio_dev_err(lio_dev, "VXLAN_PORT_ADD command timed out\n");
 805                 return -1;
 806         }
 807
 808         return 0;
 809 }
 810
 811 /**
 812  * Remove vxlan dest udp port for an interface.
 813  *
 814  * @param eth_dev
 815  *  Pointer to the structure rte_eth_dev
 816  * @param udp_tnl
 817  *  udp tunnel conf
 818  *
 819  * @return
 820  *  On success return 0
 821  *  On failure return -1
 822  */
 823 static int
 824 lio_dev_udp_tunnel_del(struct rte_eth_dev *eth_dev,
 825                        struct rte_eth_udp_tunnel *udp_tnl)
 826 {
 827         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 828         struct lio_dev_ctrl_cmd ctrl_cmd;
 829         struct lio_ctrl_pkt ctrl_pkt;
 830
 831         if (udp_tnl == NULL)
 832                 return -EINVAL;
 833
 834         if (udp_tnl->prot_type != RTE_TUNNEL_TYPE_VXLAN) {
 835                 lio_dev_err(lio_dev, "Unsupported tunnel type\n");
 836                 return -1;
 837         }
 838
 839         /* flush added to prevent cmd failure
 840          * incase the queue is full
 841          */
 842         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
 843
 844         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
 845         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
 846
 847         ctrl_cmd.eth_dev = eth_dev;
 848         ctrl_cmd.cond = 0;
 849
 850         ctrl_pkt.ncmd.s.cmd = LIO_CMD_VXLAN_PORT_CONFIG;
 851         ctrl_pkt.ncmd.s.param1 = udp_tnl->udp_port;
 852         ctrl_pkt.ncmd.s.more = LIO_CMD_VXLAN_PORT_DEL;
 853         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
 854
 855         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
 856                 lio_dev_err(lio_dev, "Failed to send VXLAN_PORT_DEL command\n");
 857                 return -1;
 858         }
 859
 860         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd)) {
 861                 lio_dev_err(lio_dev, "VXLAN_PORT_DEL command timed out\n");
 862                 return -1;
 863         }
 864
 865         return 0;
 866 }
 867
 868 static int
 869 lio_dev_vlan_filter_set(struct rte_eth_dev *eth_dev, uint16_t vlan_id, int on)
 870 {
 871         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 872         struct lio_dev_ctrl_cmd ctrl_cmd;
 873         struct lio_ctrl_pkt ctrl_pkt;
 874
 875         if (lio_dev->linfo.vlan_is_admin_assigned)
 876                 return -EPERM;
 877
 878         /* flush added to prevent cmd failure
 879          * incase the queue is full
 880          */
 881         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
 882
 883         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
 884         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
 885
 886         ctrl_cmd.eth_dev = eth_dev;
 887         ctrl_cmd.cond = 0;
 888
 889         ctrl_pkt.ncmd.s.cmd = on ?
 890                         LIO_CMD_ADD_VLAN_FILTER : LIO_CMD_DEL_VLAN_FILTER;
 891         ctrl_pkt.ncmd.s.param1 = vlan_id;
 892         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
 893
 894         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
 895                 lio_dev_err(lio_dev, "Failed to %s VLAN port\n",
 896                             on ? "add" : "remove");
 897                 return -1;
 898         }
 899
 900         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd)) {
 901                 lio_dev_err(lio_dev, "Command to %s VLAN port timed out\n",
 902                             on ? "add" : "remove");
 903                 return -1;
 904         }
 905
 906         return 0;
 907 }
 908
 909 static uint64_t
 910 lio_hweight64(uint64_t w)
 911 {
 912         uint64_t res = w - ((w >> 1) & 0x5555555555555555ul);
 913
 914         res =
 915             (res & 0x3333333333333333ul) + ((res >> 2) & 0x3333333333333333ul);
 916         res = (res + (res >> 4)) & 0x0F0F0F0F0F0F0F0Ful;
 917         res = res + (res >> 8);
 918         res = res + (res >> 16);
 919
 920         return (res + (res >> 32)) & 0x00000000000000FFul;
 921 }
 922
 923 static int
 924 lio_dev_link_update(struct rte_eth_dev *eth_dev,
 925                     int wait_to_complete __rte_unused)
 926 {
 927         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 928         struct rte_eth_link link;
 929
 930         /* Initialize */
 931         memset(&link, 0, sizeof(link));
 932         link.link_status = ETH_LINK_DOWN;
 933         link.link_speed = ETH_SPEED_NUM_NONE;
 934         link.link_duplex = ETH_LINK_HALF_DUPLEX;
 935         link.link_autoneg = ETH_LINK_AUTONEG;
 936
 937         /* Return what we found */
 938         if (lio_dev->linfo.link.s.link_up == 0) {
 939                 /* Interface is down */
 940                 return rte_eth_linkstatus_set(eth_dev, &link);
 941         }
 942
 943         link.link_status = ETH_LINK_UP; /* Interface is up */
 944         link.link_duplex = ETH_LINK_FULL_DUPLEX;
 945         switch (lio_dev->linfo.link.s.speed) {
 946         case LIO_LINK_SPEED_10000:
 947                 link.link_speed = ETH_SPEED_NUM_10G;
 948                 break;
 949         case LIO_LINK_SPEED_25000:
 950                 link.link_speed = ETH_SPEED_NUM_25G;
 951                 break;
 952         default:
 953                 link.link_speed = ETH_SPEED_NUM_NONE;
 954                 link.link_duplex = ETH_LINK_HALF_DUPLEX;
 955         }
 956
 957         return rte_eth_linkstatus_set(eth_dev, &link);
 958 }
 959
 960 /**
 961  * \brief Net device enable, disable allmulticast
 962  * @param eth_dev Pointer to the structure rte_eth_dev
 963  *
 964  * @return
 965  *  On success return 0
 966  *  On failure return negative errno
 967  */
 968 static int
 969 lio_change_dev_flag(struct rte_eth_dev *eth_dev)
 970 {
 971         struct lio_device *lio_dev = LIO_DEV(eth_dev);
 972         struct lio_dev_ctrl_cmd ctrl_cmd;
 973         struct lio_ctrl_pkt ctrl_pkt;
 974
 975         /* flush added to prevent cmd failure
 976          * incase the queue is full
 977          */
 978         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
 979
 980         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
 981         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
 982
 983         ctrl_cmd.eth_dev = eth_dev;
 984         ctrl_cmd.cond = 0;
 985
 986         /* Create a ctrl pkt command to be sent to core app. */
 987         ctrl_pkt.ncmd.s.cmd = LIO_CMD_CHANGE_DEVFLAGS;
 988         ctrl_pkt.ncmd.s.param1 = lio_dev->ifflags;
 989         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
 990
 991         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
 992                 lio_dev_err(lio_dev, "Failed to send change flag message\n");
 993                 return -EAGAIN;
 994         }
 995
 996         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd)) {
 997                 lio_dev_err(lio_dev, "Change dev flag command timed out\n");
 998                 return -ETIMEDOUT;
 999         }
1000
1001         return 0;
1002 }
1003
1004 static int
1005 lio_dev_promiscuous_enable(struct rte_eth_dev *eth_dev)
1006 {
1007         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1008
1009         if (strcmp(lio_dev->firmware_version, LIO_VF_TRUST_MIN_VERSION) < 0) {
1010                 lio_dev_err(lio_dev, "Require firmware version >= %s\n",
1011                             LIO_VF_TRUST_MIN_VERSION);
1012                 return -EAGAIN;
1013         }
1014
1015         if (!lio_dev->intf_open) {
1016                 lio_dev_err(lio_dev, "Port %d down, can't enable promiscuous\n",
1017                             lio_dev->port_id);
1018                 return -EAGAIN;
1019         }
1020
1021         lio_dev->ifflags |= LIO_IFFLAG_PROMISC;
1022         return lio_change_dev_flag(eth_dev);
1023 }
1024
1025 static int
1026 lio_dev_promiscuous_disable(struct rte_eth_dev *eth_dev)
1027 {
1028         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1029
1030         if (strcmp(lio_dev->firmware_version, LIO_VF_TRUST_MIN_VERSION) < 0) {
1031                 lio_dev_err(lio_dev, "Require firmware version >= %s\n",
1032                             LIO_VF_TRUST_MIN_VERSION);
1033                 return -EAGAIN;
1034         }
1035
1036         if (!lio_dev->intf_open) {
1037                 lio_dev_err(lio_dev, "Port %d down, can't disable promiscuous\n",
1038                             lio_dev->port_id);
1039                 return -EAGAIN;
1040         }
1041
1042         lio_dev->ifflags &= ~LIO_IFFLAG_PROMISC;
1043         return lio_change_dev_flag(eth_dev);
1044 }
1045
1046 static int
1047 lio_dev_allmulticast_enable(struct rte_eth_dev *eth_dev)
1048 {
1049         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1050
1051         if (!lio_dev->intf_open) {
1052                 lio_dev_err(lio_dev, "Port %d down, can't enable multicast\n",
1053                             lio_dev->port_id);
1054                 return -EAGAIN;
1055         }
1056
1057         lio_dev->ifflags |= LIO_IFFLAG_ALLMULTI;
1058         return lio_change_dev_flag(eth_dev);
1059 }
1060
1061 static int
1062 lio_dev_allmulticast_disable(struct rte_eth_dev *eth_dev)
1063 {
1064         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1065
1066         if (!lio_dev->intf_open) {
1067                 lio_dev_err(lio_dev, "Port %d down, can't disable multicast\n",
1068                             lio_dev->port_id);
1069                 return -EAGAIN;
1070         }
1071
1072         lio_dev->ifflags &= ~LIO_IFFLAG_ALLMULTI;
1073         return lio_change_dev_flag(eth_dev);
1074 }
1075
1076 static void
1077 lio_dev_rss_configure(struct rte_eth_dev *eth_dev)
1078 {
1079         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1080         struct lio_rss_ctx *rss_state = &lio_dev->rss_state;
1081         struct rte_eth_rss_reta_entry64 reta_conf[8];
1082         struct rte_eth_rss_conf rss_conf;
1083         uint16_t i;
1084
1085         /* Configure the RSS key and the RSS protocols used to compute
1086          * the RSS hash of input packets.
1087          */
1088         rss_conf = eth_dev->data->dev_conf.rx_adv_conf.rss_conf;
1089         if ((rss_conf.rss_hf & LIO_RSS_OFFLOAD_ALL) == 0) {
1090                 rss_state->hash_disable = 1;
1091                 lio_dev_rss_hash_update(eth_dev, &rss_conf);
1092                 return;
1093         }
1094
1095         if (rss_conf.rss_key == NULL)
1096                 rss_conf.rss_key = lio_rss_key; /* Default hash key */
1097
1098         lio_dev_rss_hash_update(eth_dev, &rss_conf);
1099
1100         memset(reta_conf, 0, sizeof(reta_conf));
1101         for (i = 0; i < LIO_RSS_MAX_TABLE_SZ; i++) {
1102                 uint8_t q_idx, conf_idx, reta_idx;
1103
1104                 q_idx = (uint8_t)((eth_dev->data->nb_rx_queues > 1) ?
1105                                   i % eth_dev->data->nb_rx_queues : 0);
1106                 conf_idx = i / RTE_RETA_GROUP_SIZE;
1107                 reta_idx = i % RTE_RETA_GROUP_SIZE;
1108                 reta_conf[conf_idx].reta[reta_idx] = q_idx;
1109                 reta_conf[conf_idx].mask |= ((uint64_t)1 << reta_idx);
1110         }
1111
1112         lio_dev_rss_reta_update(eth_dev, reta_conf, LIO_RSS_MAX_TABLE_SZ);
1113 }
1114
1115 static void
1116 lio_dev_mq_rx_configure(struct rte_eth_dev *eth_dev)
1117 {
1118         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1119         struct lio_rss_ctx *rss_state = &lio_dev->rss_state;
1120         struct rte_eth_rss_conf rss_conf;
1121
1122         switch (eth_dev->data->dev_conf.rxmode.mq_mode) {
1123         case ETH_MQ_RX_RSS:
1124                 lio_dev_rss_configure(eth_dev);
1125                 break;
1126         case ETH_MQ_RX_NONE:
1127         /* if mq_mode is none, disable rss mode. */
1128         default:
1129                 memset(&rss_conf, 0, sizeof(rss_conf));
1130                 rss_state->hash_disable = 1;
1131                 lio_dev_rss_hash_update(eth_dev, &rss_conf);
1132         }
1133 }
1134
1135 /**
1136  * Setup our receive queue/ringbuffer. This is the
1137  * queue the Octeon uses to send us packets and
1138  * responses. We are given a memory pool for our
1139  * packet buffers that are used to populate the receive
1140  * queue.
1141  *
1142  * @param eth_dev
1143  *    Pointer to the structure rte_eth_dev
1144  * @param q_no
1145  *    Queue number
1146  * @param num_rx_descs
1147  *    Number of entries in the queue
1148  * @param socket_id
1149  *    Where to allocate memory
1150  * @param rx_conf
1151  *    Pointer to the struction rte_eth_rxconf
1152  * @param mp
1153  *    Pointer to the packet pool
1154  *
1155  * @return
1156  *    - On success, return 0
1157  *    - On failure, return -1
1158  */
1159 static int
1160 lio_dev_rx_queue_setup(struct rte_eth_dev *eth_dev, uint16_t q_no,
1161                        uint16_t num_rx_descs, unsigned int socket_id,
1162                        const struct rte_eth_rxconf *rx_conf __rte_unused,
1163                        struct rte_mempool *mp)
1164 {
1165         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1166         struct rte_pktmbuf_pool_private *mbp_priv;
1167         uint32_t fw_mapped_oq;
1168         uint16_t buf_size;
1169
1170         if (q_no >= lio_dev->nb_rx_queues) {
1171                 lio_dev_err(lio_dev, "Invalid rx queue number %u\n", q_no);
1172                 return -EINVAL;
1173         }
1174
1175         lio_dev_dbg(lio_dev, "setting up rx queue %u\n", q_no);
1176
1177         fw_mapped_oq = lio_dev->linfo.rxpciq[q_no].s.q_no;
1178
1179         /* Free previous allocation if any */
1180         if (eth_dev->data->rx_queues[q_no] != NULL) {
1181                 lio_dev_rx_queue_release(eth_dev, q_no);
1182                 eth_dev->data->rx_queues[q_no] = NULL;
1183         }
1184
1185         mbp_priv = rte_mempool_get_priv(mp);
1186         buf_size = mbp_priv->mbuf_data_room_size - RTE_PKTMBUF_HEADROOM;
1187
1188         if (lio_setup_droq(lio_dev, fw_mapped_oq, num_rx_descs, buf_size, mp,
1189                            socket_id)) {
1190                 lio_dev_err(lio_dev, "droq allocation failed\n");
1191                 return -1;
1192         }
1193
1194         eth_dev->data->rx_queues[q_no] = lio_dev->droq[fw_mapped_oq];
1195
1196         return 0;
1197 }
1198
1199 /**
1200  * Release the receive queue/ringbuffer. Called by
1201  * the upper layers.
1202  *
1203  * @param eth_dev
1204  *    Pointer to Ethernet device structure.
1205  * @param q_no
1206  *    Receive queue index.
1207  *
1208  * @return
1209  *    - nothing
1210  */
1211 void
1212 lio_dev_rx_queue_release(struct rte_eth_dev *dev, uint16_t q_no)
1213 {
1214         struct lio_droq *droq = dev->data->rx_queues[q_no];
1215         int oq_no;
1216
1217         if (droq) {
1218                 oq_no = droq->q_no;
1219                 lio_delete_droq_queue(droq->lio_dev, oq_no);
1220         }
1221 }
1222
1223 /**
1224  * Allocate and initialize SW ring. Initialize associated HW registers.
1225  *
1226  * @param eth_dev
1227  *   Pointer to structure rte_eth_dev
1228  *
1229  * @param q_no
1230  *   Queue number
1231  *
1232  * @param num_tx_descs
1233  *   Number of ringbuffer descriptors
1234  *
1235  * @param socket_id
1236  *   NUMA socket id, used for memory allocations
1237  *
1238  * @param tx_conf
1239  *   Pointer to the structure rte_eth_txconf
1240  *
1241  * @return
1242  *   - On success, return 0
1243  *   - On failure, return -errno value
1244  */
1245 static int
1246 lio_dev_tx_queue_setup(struct rte_eth_dev *eth_dev, uint16_t q_no,
1247                        uint16_t num_tx_descs, unsigned int socket_id,
1248                        const struct rte_eth_txconf *tx_conf __rte_unused)
1249 {
1250         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1251         int fw_mapped_iq = lio_dev->linfo.txpciq[q_no].s.q_no;
1252         int retval;
1253
1254         if (q_no >= lio_dev->nb_tx_queues) {
1255                 lio_dev_err(lio_dev, "Invalid tx queue number %u\n", q_no);
1256                 return -EINVAL;
1257         }
1258
1259         lio_dev_dbg(lio_dev, "setting up tx queue %u\n", q_no);
1260
1261         /* Free previous allocation if any */
1262         if (eth_dev->data->tx_queues[q_no] != NULL) {
1263                 lio_dev_tx_queue_release(eth_dev, q_no);
1264                 eth_dev->data->tx_queues[q_no] = NULL;
1265         }
1266
1267         retval = lio_setup_iq(lio_dev, q_no, lio_dev->linfo.txpciq[q_no],
1268                               num_tx_descs, lio_dev, socket_id);
1269
1270         if (retval) {
1271                 lio_dev_err(lio_dev, "Runtime IQ(TxQ) creation failed.\n");
1272                 return retval;
1273         }
1274
1275         retval = lio_setup_sglists(lio_dev, q_no, fw_mapped_iq,
1276                                 lio_dev->instr_queue[fw_mapped_iq]->nb_desc,
1277                                 socket_id);
1278
1279         if (retval) {
1280                 lio_delete_instruction_queue(lio_dev, fw_mapped_iq);
1281                 return retval;
1282         }
1283
1284         eth_dev->data->tx_queues[q_no] = lio_dev->instr_queue[fw_mapped_iq];
1285
1286         return 0;
1287 }
1288
1289 /**
1290  * Release the transmit queue/ringbuffer. Called by
1291  * the upper layers.
1292  *
1293  * @param eth_dev
1294  *    Pointer to Ethernet device structure.
1295  * @param q_no
1296  *   Transmit queue index.
1297  *
1298  * @return
1299  *    - nothing
1300  */
1301 void
1302 lio_dev_tx_queue_release(struct rte_eth_dev *dev, uint16_t q_no)
1303 {
1304         struct lio_instr_queue *tq = dev->data->tx_queues[q_no];
1305         uint32_t fw_mapped_iq_no;
1306
1307
1308         if (tq) {
1309                 /* Free sg_list */
1310                 lio_delete_sglist(tq);
1311
1312                 fw_mapped_iq_no = tq->txpciq.s.q_no;
1313                 lio_delete_instruction_queue(tq->lio_dev, fw_mapped_iq_no);
1314         }
1315 }
1316
1317 /**
1318  * Api to check link state.
1319  */
1320 static void
1321 lio_dev_get_link_status(struct rte_eth_dev *eth_dev)
1322 {
1323         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1324         uint16_t timeout = LIO_MAX_CMD_TIMEOUT;
1325         struct lio_link_status_resp *resp;
1326         union octeon_link_status *ls;
1327         struct lio_soft_command *sc;
1328         uint32_t resp_size;
1329
1330         if (!lio_dev->intf_open)
1331                 return;
1332
1333         resp_size = sizeof(struct lio_link_status_resp);
1334         sc = lio_alloc_soft_command(lio_dev, 0, resp_size, 0);
1335         if (sc == NULL)
1336                 return;
1337
1338         resp = (struct lio_link_status_resp *)sc->virtrptr;
1339         lio_prepare_soft_command(lio_dev, sc, LIO_OPCODE,
1340                                  LIO_OPCODE_INFO, 0, 0, 0);
1341
1342         /* Setting wait time in seconds */
1343         sc->wait_time = LIO_MAX_CMD_TIMEOUT / 1000;
1344
1345         if (lio_send_soft_command(lio_dev, sc) == LIO_IQ_SEND_FAILED)
1346                 goto get_status_fail;
1347
1348         while ((*sc->status_word == LIO_COMPLETION_WORD_INIT) && --timeout) {
1349                 lio_flush_iq(lio_dev, lio_dev->instr_queue[sc->iq_no]);
1350                 rte_delay_ms(1);
1351         }
1352
1353         if (resp->status)
1354                 goto get_status_fail;
1355
1356         ls = &resp->link_info.link;
1357
1358         lio_swap_8B_data((uint64_t *)ls, sizeof(union octeon_link_status) >> 3);
1359
1360         if (lio_dev->linfo.link.link_status64 != ls->link_status64) {
1361                 if (ls->s.mtu < eth_dev->data->mtu) {
1362                         lio_dev_info(lio_dev, "Lowered VF MTU to %d as PF MTU dropped\n",
1363                                      ls->s.mtu);
1364                         eth_dev->data->mtu = ls->s.mtu;
1365                 }
1366                 lio_dev->linfo.link.link_status64 = ls->link_status64;
1367                 lio_dev_link_update(eth_dev, 0);
1368         }
1369
1370         lio_free_soft_command(sc);
1371
1372         return;
1373
1374 get_status_fail:
1375         lio_free_soft_command(sc);
1376 }
1377
1378 /* This function will be invoked every LSC_TIMEOUT ns (100ms)
1379  * and will update link state if it changes.
1380  */
1381 static void
1382 lio_sync_link_state_check(void *eth_dev)
1383 {
1384         struct lio_device *lio_dev =
1385                 (((struct rte_eth_dev *)eth_dev)->data->dev_private);
1386
1387         if (lio_dev->port_configured)
1388                 lio_dev_get_link_status(eth_dev);
1389
1390         /* Schedule periodic link status check.
1391          * Stop check if interface is close and start again while opening.
1392          */
1393         if (lio_dev->intf_open)
1394                 rte_eal_alarm_set(LIO_LSC_TIMEOUT, lio_sync_link_state_check,
1395                                   eth_dev);
1396 }
1397
1398 static int
1399 lio_dev_start(struct rte_eth_dev *eth_dev)
1400 {
1401         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1402         uint16_t timeout = LIO_MAX_CMD_TIMEOUT;
1403         int ret = 0;
1404
1405         lio_dev_info(lio_dev, "Starting port %d\n", eth_dev->data->port_id);
1406
1407         if (lio_dev->fn_list.enable_io_queues(lio_dev))
1408                 return -1;
1409
1410         if (lio_send_rx_ctrl_cmd(eth_dev, 1))
1411                 return -1;
1412
1413         /* Ready for link status updates */
1414         lio_dev->intf_open = 1;
1415         rte_mb();
1416
1417         /* Configure RSS if device configured with multiple RX queues. */
1418         lio_dev_mq_rx_configure(eth_dev);
1419
1420         /* Before update the link info,
1421          * must set linfo.link.link_status64 to 0.
1422          */
1423         lio_dev->linfo.link.link_status64 = 0;
1424
1425         /* start polling for lsc */
1426         ret = rte_eal_alarm_set(LIO_LSC_TIMEOUT,
1427                                 lio_sync_link_state_check,
1428                                 eth_dev);
1429         if (ret) {
1430                 lio_dev_err(lio_dev,
1431                             "link state check handler creation failed\n");
1432                 goto dev_lsc_handle_error;
1433         }
1434
1435         while ((lio_dev->linfo.link.link_status64 == 0) && (--timeout))
1436                 rte_delay_ms(1);
1437
1438         if (lio_dev->linfo.link.link_status64 == 0) {
1439                 ret = -1;
1440                 goto dev_mtu_set_error;
1441         }
1442
1443         ret = lio_dev_mtu_set(eth_dev, eth_dev->data->mtu);
1444         if (ret != 0)
1445                 goto dev_mtu_set_error;
1446
1447         return 0;
1448
1449 dev_mtu_set_error:
1450         rte_eal_alarm_cancel(lio_sync_link_state_check, eth_dev);
1451
1452 dev_lsc_handle_error:
1453         lio_dev->intf_open = 0;
1454         lio_send_rx_ctrl_cmd(eth_dev, 0);
1455
1456         return ret;
1457 }
1458
1459 /* Stop device and disable input/output functions */
1460 static int
1461 lio_dev_stop(struct rte_eth_dev *eth_dev)
1462 {
1463         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1464
1465         lio_dev_info(lio_dev, "Stopping port %d\n", eth_dev->data->port_id);
1466         eth_dev->data->dev_started = 0;
1467         lio_dev->intf_open = 0;
1468         rte_mb();
1469
1470         /* Cancel callback if still running. */
1471         rte_eal_alarm_cancel(lio_sync_link_state_check, eth_dev);
1472
1473         lio_send_rx_ctrl_cmd(eth_dev, 0);
1474
1475         lio_wait_for_instr_fetch(lio_dev);
1476
1477         /* Clear recorded link status */
1478         lio_dev->linfo.link.link_status64 = 0;
1479
1480         return 0;
1481 }
1482
1483 static int
1484 lio_dev_set_link_up(struct rte_eth_dev *eth_dev)
1485 {
1486         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1487
1488         if (!lio_dev->intf_open) {
1489                 lio_dev_info(lio_dev, "Port is stopped, Start the port first\n");
1490                 return 0;
1491         }
1492
1493         if (lio_dev->linfo.link.s.link_up) {
1494                 lio_dev_info(lio_dev, "Link is already UP\n");
1495                 return 0;
1496         }
1497
1498         if (lio_send_rx_ctrl_cmd(eth_dev, 1)) {
1499                 lio_dev_err(lio_dev, "Unable to set Link UP\n");
1500                 return -1;
1501         }
1502
1503         lio_dev->linfo.link.s.link_up = 1;
1504         eth_dev->data->dev_link.link_status = ETH_LINK_UP;
1505
1506         return 0;
1507 }
1508
1509 static int
1510 lio_dev_set_link_down(struct rte_eth_dev *eth_dev)
1511 {
1512         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1513
1514         if (!lio_dev->intf_open) {
1515                 lio_dev_info(lio_dev, "Port is stopped, Start the port first\n");
1516                 return 0;
1517         }
1518
1519         if (!lio_dev->linfo.link.s.link_up) {
1520                 lio_dev_info(lio_dev, "Link is already DOWN\n");
1521                 return 0;
1522         }
1523
1524         lio_dev->linfo.link.s.link_up = 0;
1525         eth_dev->data->dev_link.link_status = ETH_LINK_DOWN;
1526
1527         if (lio_send_rx_ctrl_cmd(eth_dev, 0)) {
1528                 lio_dev->linfo.link.s.link_up = 1;
1529                 eth_dev->data->dev_link.link_status = ETH_LINK_UP;
1530                 lio_dev_err(lio_dev, "Unable to set Link Down\n");
1531                 return -1;
1532         }
1533
1534         return 0;
1535 }
1536
1537 /**
1538  * Reset and stop the device. This occurs on the first
1539  * call to this routine. Subsequent calls will simply
1540  * return. NB: This will require the NIC to be rebooted.
1541  *
1542  * @param eth_dev
1543  *    Pointer to the structure rte_eth_dev
1544  *
1545  * @return
1546  *    - nothing
1547  */
1548 static int
1549 lio_dev_close(struct rte_eth_dev *eth_dev)
1550 {
1551         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1552         int ret = 0;
1553
1554         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
1555                 return 0;
1556
1557         lio_dev_info(lio_dev, "closing port %d\n", eth_dev->data->port_id);
1558
1559         if (lio_dev->intf_open)
1560                 ret = lio_dev_stop(eth_dev);
1561
1562         /* Reset ioq regs */
1563         lio_dev->fn_list.setup_device_regs(lio_dev);
1564
1565         if (lio_dev->pci_dev->kdrv == RTE_PCI_KDRV_IGB_UIO) {
1566                 cn23xx_vf_ask_pf_to_do_flr(lio_dev);
1567                 rte_delay_ms(LIO_PCI_FLR_WAIT);
1568         }
1569
1570         /* lio_free_mbox */
1571         lio_dev->fn_list.free_mbox(lio_dev);
1572
1573         /* Free glist resources */
1574         rte_free(lio_dev->glist_head);
1575         rte_free(lio_dev->glist_lock);
1576         lio_dev->glist_head = NULL;
1577         lio_dev->glist_lock = NULL;
1578
1579         lio_dev->port_configured = 0;
1580
1581          /* Delete all queues */
1582         lio_dev_clear_queues(eth_dev);
1583
1584         return ret;
1585 }
1586
1587 /**
1588  * Enable tunnel rx checksum verification from firmware.
1589  */
1590 static void
1591 lio_enable_hw_tunnel_rx_checksum(struct rte_eth_dev *eth_dev)
1592 {
1593         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1594         struct lio_dev_ctrl_cmd ctrl_cmd;
1595         struct lio_ctrl_pkt ctrl_pkt;
1596
1597         /* flush added to prevent cmd failure
1598          * incase the queue is full
1599          */
1600         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
1601
1602         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
1603         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
1604
1605         ctrl_cmd.eth_dev = eth_dev;
1606         ctrl_cmd.cond = 0;
1607
1608         ctrl_pkt.ncmd.s.cmd = LIO_CMD_TNL_RX_CSUM_CTL;
1609         ctrl_pkt.ncmd.s.param1 = LIO_CMD_RXCSUM_ENABLE;
1610         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
1611
1612         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
1613                 lio_dev_err(lio_dev, "Failed to send TNL_RX_CSUM command\n");
1614                 return;
1615         }
1616
1617         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd))
1618                 lio_dev_err(lio_dev, "TNL_RX_CSUM command timed out\n");
1619 }
1620
1621 /**
1622  * Enable checksum calculation for inner packet in a tunnel.
1623  */
1624 static void
1625 lio_enable_hw_tunnel_tx_checksum(struct rte_eth_dev *eth_dev)
1626 {
1627         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1628         struct lio_dev_ctrl_cmd ctrl_cmd;
1629         struct lio_ctrl_pkt ctrl_pkt;
1630
1631         /* flush added to prevent cmd failure
1632          * incase the queue is full
1633          */
1634         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
1635
1636         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
1637         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
1638
1639         ctrl_cmd.eth_dev = eth_dev;
1640         ctrl_cmd.cond = 0;
1641
1642         ctrl_pkt.ncmd.s.cmd = LIO_CMD_TNL_TX_CSUM_CTL;
1643         ctrl_pkt.ncmd.s.param1 = LIO_CMD_TXCSUM_ENABLE;
1644         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
1645
1646         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
1647                 lio_dev_err(lio_dev, "Failed to send TNL_TX_CSUM command\n");
1648                 return;
1649         }
1650
1651         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd))
1652                 lio_dev_err(lio_dev, "TNL_TX_CSUM command timed out\n");
1653 }
1654
1655 static int
1656 lio_send_queue_count_update(struct rte_eth_dev *eth_dev, int num_txq,
1657                             int num_rxq)
1658 {
1659         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1660         struct lio_dev_ctrl_cmd ctrl_cmd;
1661         struct lio_ctrl_pkt ctrl_pkt;
1662
1663         if (strcmp(lio_dev->firmware_version, LIO_Q_RECONF_MIN_VERSION) < 0) {
1664                 lio_dev_err(lio_dev, "Require firmware version >= %s\n",
1665                             LIO_Q_RECONF_MIN_VERSION);
1666                 return -ENOTSUP;
1667         }
1668
1669         /* flush added to prevent cmd failure
1670          * incase the queue is full
1671          */
1672         lio_flush_iq(lio_dev, lio_dev->instr_queue[0]);
1673
1674         memset(&ctrl_pkt, 0, sizeof(struct lio_ctrl_pkt));
1675         memset(&ctrl_cmd, 0, sizeof(struct lio_dev_ctrl_cmd));
1676
1677         ctrl_cmd.eth_dev = eth_dev;
1678         ctrl_cmd.cond = 0;
1679
1680         ctrl_pkt.ncmd.s.cmd = LIO_CMD_QUEUE_COUNT_CTL;
1681         ctrl_pkt.ncmd.s.param1 = num_txq;
1682         ctrl_pkt.ncmd.s.param2 = num_rxq;
1683         ctrl_pkt.ctrl_cmd = &ctrl_cmd;
1684
1685         if (lio_send_ctrl_pkt(lio_dev, &ctrl_pkt)) {
1686                 lio_dev_err(lio_dev, "Failed to send queue count control command\n");
1687                 return -1;
1688         }
1689
1690         if (lio_wait_for_ctrl_cmd(lio_dev, &ctrl_cmd)) {
1691                 lio_dev_err(lio_dev, "Queue count control command timed out\n");
1692                 return -1;
1693         }
1694
1695         return 0;
1696 }
1697
1698 static int
1699 lio_reconf_queues(struct rte_eth_dev *eth_dev, int num_txq, int num_rxq)
1700 {
1701         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1702         int ret;
1703
1704         if (lio_dev->nb_rx_queues != num_rxq ||
1705             lio_dev->nb_tx_queues != num_txq) {
1706                 if (lio_send_queue_count_update(eth_dev, num_txq, num_rxq))
1707                         return -1;
1708                 lio_dev->nb_rx_queues = num_rxq;
1709                 lio_dev->nb_tx_queues = num_txq;
1710         }
1711
1712         if (lio_dev->intf_open) {
1713                 ret = lio_dev_stop(eth_dev);
1714                 if (ret != 0)
1715                         return ret;
1716         }
1717
1718         /* Reset ioq registers */
1719         if (lio_dev->fn_list.setup_device_regs(lio_dev)) {
1720                 lio_dev_err(lio_dev, "Failed to configure device registers\n");
1721                 return -1;
1722         }
1723
1724         return 0;
1725 }
1726
1727 static int
1728 lio_dev_configure(struct rte_eth_dev *eth_dev)
1729 {
1730         struct lio_device *lio_dev = LIO_DEV(eth_dev);
1731         uint16_t timeout = LIO_MAX_CMD_TIMEOUT;
1732         int retval, num_iqueues, num_oqueues;
1733         uint8_t mac[RTE_ETHER_ADDR_LEN], i;
1734         struct lio_if_cfg_resp *resp;
1735         struct lio_soft_command *sc;
1736         union lio_if_cfg if_cfg;
1737         uint32_t resp_size;
1738
1739         PMD_INIT_FUNC_TRACE();
1740
1741         if (eth_dev->data->dev_conf.rxmode.mq_mode & ETH_MQ_RX_RSS_FLAG)
1742                 eth_dev->data->dev_conf.rxmode.offloads |=
1743                         DEV_RX_OFFLOAD_RSS_HASH;
1744
1745         /* Inform firmware about change in number of queues to use.
1746          * Disable IO queues and reset registers for re-configuration.
1747          */
1748         if (lio_dev->port_configured)
1749                 return lio_reconf_queues(eth_dev,
1750                                          eth_dev->data->nb_tx_queues,
1751                                          eth_dev->data->nb_rx_queues);
1752
1753         lio_dev->nb_rx_queues = eth_dev->data->nb_rx_queues;
1754         lio_dev->nb_tx_queues = eth_dev->data->nb_tx_queues;
1755
1756         /* Set max number of queues which can be re-configured. */
1757         lio_dev->max_rx_queues = eth_dev->data->nb_rx_queues;
1758         lio_dev->max_tx_queues = eth_dev->data->nb_tx_queues;
1759
1760         resp_size = sizeof(struct lio_if_cfg_resp);
1761         sc = lio_alloc_soft_command(lio_dev, 0, resp_size, 0);
1762         if (sc == NULL)
1763                 return -ENOMEM;
1764
1765         resp = (struct lio_if_cfg_resp *)sc->virtrptr;
1766
1767         /* Firmware doesn't have capability to reconfigure the queues,
1768          * Claim all queues, and use as many required
1769          */
1770         if_cfg.if_cfg64 = 0;
1771         if_cfg.s.num_iqueues = lio_dev->nb_tx_queues;
1772         if_cfg.s.num_oqueues = lio_dev->nb_rx_queues;
1773         if_cfg.s.base_queue = 0;
1774
1775         if_cfg.s.gmx_port_id = lio_dev->pf_num;
1776
1777         lio_prepare_soft_command(lio_dev, sc, LIO_OPCODE,
1778                                  LIO_OPCODE_IF_CFG, 0,
1779                                  if_cfg.if_cfg64, 0);
1780
1781         /* Setting wait time in seconds */
1782         sc->wait_time = LIO_MAX_CMD_TIMEOUT / 1000;
1783
1784         retval = lio_send_soft_command(lio_dev, sc);
1785         if (retval == LIO_IQ_SEND_FAILED) {
1786                 lio_dev_err(lio_dev, "iq/oq config failed status: %x\n",
1787                             retval);
1788                 /* Soft instr is freed by driver in case of failure. */
1789                 goto nic_config_fail;
1790         }
1791
1792         /* Sleep on a wait queue till the cond flag indicates that the
1793          * response arrived or timed-out.
1794          */
1795         while ((*sc->status_word == LIO_COMPLETION_WORD_INIT) && --timeout) {
1796                 lio_flush_iq(lio_dev, lio_dev->instr_queue[sc->iq_no]);
1797                 lio_process_ordered_list(lio_dev);
1798                 rte_delay_ms(1);
1799         }
1800
1801         retval = resp->status;
1802         if (retval) {
1803                 lio_dev_err(lio_dev, "iq/oq config failed\n");
1804                 goto nic_config_fail;
1805         }
1806
1807         strlcpy(lio_dev->firmware_version,
1808                 resp->cfg_info.lio_firmware_version, LIO_FW_VERSION_LENGTH);
1809
1810         lio_swap_8B_data((uint64_t *)(&resp->cfg_info),
1811                          sizeof(struct octeon_if_cfg_info) >> 3);
1812
1813         num_iqueues = lio_hweight64(resp->cfg_info.iqmask);
1814         num_oqueues = lio_hweight64(resp->cfg_info.oqmask);
1815
1816         if (!(num_iqueues) || !(num_oqueues)) {
1817                 lio_dev_err(lio_dev,
1818                             "Got bad iqueues (%016lx) or oqueues (%016lx) from firmware.\n",
1819                             (unsigned long)resp->cfg_info.iqmask,
1820                             (unsigned long)resp->cfg_info.oqmask);
1821                 goto nic_config_fail;
1822         }
1823
1824         lio_dev_dbg(lio_dev,
1825                     "interface %d, iqmask %016lx, oqmask %016lx, numiqueues %d, numoqueues %d\n",
1826                     eth_dev->data->port_id,
1827                     (unsigned long)resp->cfg_info.iqmask,
1828                     (unsigned long)resp->cfg_info.oqmask,
1829                     num_iqueues, num_oqueues);
1830
1831         lio_dev->linfo.num_rxpciq = num_oqueues;
1832         lio_dev->linfo.num_txpciq = num_iqueues;
1833
1834         for (i = 0; i < num_oqueues; i++) {
1835                 lio_dev->linfo.rxpciq[i].rxpciq64 =
1836                     resp->cfg_info.linfo.rxpciq[i].rxpciq64;
1837                 lio_dev_dbg(lio_dev, "index %d OQ %d\n",
1838                             i, lio_dev->linfo.rxpciq[i].s.q_no);
1839         }
1840
1841         for (i = 0; i < num_iqueues; i++) {
1842                 lio_dev->linfo.txpciq[i].txpciq64 =
1843                     resp->cfg_info.linfo.txpciq[i].txpciq64;
1844                 lio_dev_dbg(lio_dev, "index %d IQ %d\n",
1845                             i, lio_dev->linfo.txpciq[i].s.q_no);
1846         }
1847
1848         lio_dev->linfo.hw_addr = resp->cfg_info.linfo.hw_addr;
1849         lio_dev->linfo.gmxport = resp->cfg_info.linfo.gmxport;
1850         lio_dev->linfo.link.link_status64 =
1851                         resp->cfg_info.linfo.link.link_status64;
1852
1853         /* 64-bit swap required on LE machines */
1854         lio_swap_8B_data(&lio_dev->linfo.hw_addr, 1);
1855         for (i = 0; i < RTE_ETHER_ADDR_LEN; i++)
1856                 mac[i] = *((uint8_t *)(((uint8_t *)&lio_dev->linfo.hw_addr) +
1857                                        2 + i));
1858
1859         /* Copy the permanent MAC address */
1860         rte_ether_addr_copy((struct rte_ether_addr *)mac,
1861                         &eth_dev->data->mac_addrs[0]);
1862
1863         /* enable firmware checksum support for tunnel packets */
1864         lio_enable_hw_tunnel_rx_checksum(eth_dev);
1865         lio_enable_hw_tunnel_tx_checksum(eth_dev);
1866
1867         lio_dev->glist_lock =
1868             rte_zmalloc(NULL, sizeof(*lio_dev->glist_lock) * num_iqueues, 0);
1869         if (lio_dev->glist_lock == NULL)
1870                 return -ENOMEM;
1871
1872         lio_dev->glist_head =
1873                 rte_zmalloc(NULL, sizeof(*lio_dev->glist_head) * num_iqueues,
1874                             0);
1875         if (lio_dev->glist_head == NULL) {
1876                 rte_free(lio_dev->glist_lock);
1877                 lio_dev->glist_lock = NULL;
1878                 return -ENOMEM;
1879         }
1880
1881         lio_dev_link_update(eth_dev, 0);
1882
1883         lio_dev->port_configured = 1;
1884
1885         lio_free_soft_command(sc);
1886
1887         /* Reset ioq regs */
1888         lio_dev->fn_list.setup_device_regs(lio_dev);
1889
1890         /* Free iq_0 used during init */
1891         lio_free_instr_queue0(lio_dev);
1892
1893         return 0;
1894
1895 nic_config_fail:
1896         lio_dev_err(lio_dev, "Failed retval %d\n", retval);
1897         lio_free_soft_command(sc);
1898         lio_free_instr_queue0(lio_dev);
1899
1900         return -ENODEV;
1901 }
1902
1903 /* Define our ethernet definitions */
1904 static const struct eth_dev_ops liovf_eth_dev_ops = {
1905         .dev_configure          = lio_dev_configure,
1906         .dev_start              = lio_dev_start,
1907         .dev_stop               = lio_dev_stop,
1908         .dev_set_link_up        = lio_dev_set_link_up,
1909         .dev_set_link_down      = lio_dev_set_link_down,
1910         .dev_close              = lio_dev_close,
1911         .promiscuous_enable     = lio_dev_promiscuous_enable,
1912         .promiscuous_disable    = lio_dev_promiscuous_disable,
1913         .allmulticast_enable    = lio_dev_allmulticast_enable,
1914         .allmulticast_disable   = lio_dev_allmulticast_disable,
1915         .link_update            = lio_dev_link_update,
1916         .stats_get              = lio_dev_stats_get,
1917         .xstats_get             = lio_dev_xstats_get,
1918         .xstats_get_names       = lio_dev_xstats_get_names,
1919         .stats_reset            = lio_dev_stats_reset,
1920         .xstats_reset           = lio_dev_xstats_reset,
1921         .dev_infos_get          = lio_dev_info_get,
1922         .vlan_filter_set        = lio_dev_vlan_filter_set,
1923         .rx_queue_setup         = lio_dev_rx_queue_setup,
1924         .rx_queue_release       = lio_dev_rx_queue_release,
1925         .tx_queue_setup         = lio_dev_tx_queue_setup,
1926         .tx_queue_release       = lio_dev_tx_queue_release,
1927         .reta_update            = lio_dev_rss_reta_update,
1928         .reta_query             = lio_dev_rss_reta_query,
1929         .rss_hash_conf_get      = lio_dev_rss_hash_conf_get,
1930         .rss_hash_update        = lio_dev_rss_hash_update,
1931         .udp_tunnel_port_add    = lio_dev_udp_tunnel_add,
1932         .udp_tunnel_port_del    = lio_dev_udp_tunnel_del,
1933         .mtu_set                = lio_dev_mtu_set,
1934 };
1935
1936 static void
1937 lio_check_pf_hs_response(void *lio_dev)
1938 {
1939         struct lio_device *dev = lio_dev;
1940
1941         /* check till response arrives */
1942         if (dev->pfvf_hsword.coproc_tics_per_us)
1943                 return;
1944
1945         cn23xx_vf_handle_mbox(dev);
1946
1947         rte_eal_alarm_set(1, lio_check_pf_hs_response, lio_dev);
1948 }
1949
1950 /**
1951  * \brief Identify the LIO device and to map the BAR address space
1952  * @param lio_dev lio device
1953  */
1954 static int
1955 lio_chip_specific_setup(struct lio_device *lio_dev)
1956 {
1957         struct rte_pci_device *pdev = lio_dev->pci_dev;
1958         uint32_t dev_id = pdev->id.device_id;
1959         const char *s;
1960         int ret = 1;
1961
1962         switch (dev_id) {
1963         case LIO_CN23XX_VF_VID:
1964                 lio_dev->chip_id = LIO_CN23XX_VF_VID;
1965                 ret = cn23xx_vf_setup_device(lio_dev);
1966                 s = "CN23XX VF";
1967                 break;
1968         default:
1969                 s = "?";
1970                 lio_dev_err(lio_dev, "Unsupported Chip\n");
1971         }
1972
1973         if (!ret)
1974                 lio_dev_info(lio_dev, "DEVICE : %s\n", s);
1975
1976         return ret;
1977 }
1978
1979 static int
1980 lio_first_time_init(struct lio_device *lio_dev,
1981                     struct rte_pci_device *pdev)
1982 {
1983         int dpdk_queues;
1984
1985         PMD_INIT_FUNC_TRACE();
1986
1987         /* set dpdk specific pci device pointer */
1988         lio_dev->pci_dev = pdev;
1989
1990         /* Identify the LIO type and set device ops */
1991         if (lio_chip_specific_setup(lio_dev)) {
1992                 lio_dev_err(lio_dev, "Chip specific setup failed\n");
1993                 return -1;
1994         }
1995
1996         /* Initialize soft command buffer pool */
1997         if (lio_setup_sc_buffer_pool(lio_dev)) {
1998                 lio_dev_err(lio_dev, "sc buffer pool allocation failed\n");
1999                 return -1;
2000         }
2001
2002         /* Initialize lists to manage the requests of different types that
2003          * arrive from applications for this lio device.
2004          */
2005         lio_setup_response_list(lio_dev);
2006
2007         if (lio_dev->fn_list.setup_mbox(lio_dev)) {
2008                 lio_dev_err(lio_dev, "Mailbox setup failed\n");
2009                 goto error;
2010         }
2011
2012         /* Check PF response */
2013         lio_check_pf_hs_response((void *)lio_dev);
2014
2015         /* Do handshake and exit if incompatible PF driver */
2016         if (cn23xx_pfvf_handshake(lio_dev))
2017                 goto error;
2018
2019         /* Request and wait for device reset. */
2020         if (pdev->kdrv == RTE_PCI_KDRV_IGB_UIO) {
2021                 cn23xx_vf_ask_pf_to_do_flr(lio_dev);
2022                 /* FLR wait time doubled as a precaution. */
2023                 rte_delay_ms(LIO_PCI_FLR_WAIT * 2);
2024         }
2025
2026         if (lio_dev->fn_list.setup_device_regs(lio_dev)) {
2027                 lio_dev_err(lio_dev, "Failed to configure device registers\n");
2028                 goto error;
2029         }
2030
2031         if (lio_setup_instr_queue0(lio_dev)) {
2032                 lio_dev_err(lio_dev, "Failed to setup instruction queue 0\n");
2033                 goto error;
2034         }
2035
2036         dpdk_queues = (int)lio_dev->sriov_info.rings_per_vf;
2037
2038         lio_dev->max_tx_queues = dpdk_queues;
2039         lio_dev->max_rx_queues = dpdk_queues;
2040
2041         /* Enable input and output queues for this device */
2042         if (lio_dev->fn_list.enable_io_queues(lio_dev))
2043                 goto error;
2044
2045         return 0;
2046
2047 error:
2048         lio_free_sc_buffer_pool(lio_dev);
2049         if (lio_dev->mbox[0])
2050                 lio_dev->fn_list.free_mbox(lio_dev);
2051         if (lio_dev->instr_queue[0])
2052                 lio_free_instr_queue0(lio_dev);
2053
2054         return -1;
2055 }
2056
2057 static int
2058 lio_eth_dev_uninit(struct rte_eth_dev *eth_dev)
2059 {
2060         struct lio_device *lio_dev = LIO_DEV(eth_dev);
2061
2062         PMD_INIT_FUNC_TRACE();
2063
2064         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
2065                 return 0;
2066
2067         /* lio_free_sc_buffer_pool */
2068         lio_free_sc_buffer_pool(lio_dev);
2069
2070         return 0;
2071 }
2072
2073 static int
2074 lio_eth_dev_init(struct rte_eth_dev *eth_dev)
2075 {
2076         struct rte_pci_device *pdev = RTE_ETH_DEV_TO_PCI(eth_dev);
2077         struct lio_device *lio_dev = LIO_DEV(eth_dev);
2078
2079         PMD_INIT_FUNC_TRACE();
2080
2081         eth_dev->rx_pkt_burst = &lio_dev_recv_pkts;
2082         eth_dev->tx_pkt_burst = &lio_dev_xmit_pkts;
2083
2084         /* Primary does the initialization. */
2085         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
2086                 return 0;
2087
2088         rte_eth_copy_pci_info(eth_dev, pdev);
2089
2090         if (pdev->mem_resource[0].addr) {
2091                 lio_dev->hw_addr = pdev->mem_resource[0].addr;
2092         } else {
2093                 PMD_INIT_LOG(ERR, "ERROR: Failed to map BAR0\n");
2094                 return -ENODEV;
2095         }
2096
2097         lio_dev->eth_dev = eth_dev;
2098         /* set lio device print string */
2099         snprintf(lio_dev->dev_string, sizeof(lio_dev->dev_string),
2100                  "%s[%02x:%02x.%x]", pdev->driver->driver.name,
2101                  pdev->addr.bus, pdev->addr.devid, pdev->addr.function);
2102
2103         lio_dev->port_id = eth_dev->data->port_id;
2104
2105         if (lio_first_time_init(lio_dev, pdev)) {
2106                 lio_dev_err(lio_dev, "Device init failed\n");
2107                 return -EINVAL;
2108         }
2109
2110         eth_dev->dev_ops = &liovf_eth_dev_ops;
2111         eth_dev->data->mac_addrs = rte_zmalloc("lio", RTE_ETHER_ADDR_LEN, 0);
2112         if (eth_dev->data->mac_addrs == NULL) {
2113                 lio_dev_err(lio_dev,
2114                             "MAC addresses memory allocation failed\n");
2115                 eth_dev->dev_ops = NULL;
2116                 eth_dev->rx_pkt_burst = NULL;
2117                 eth_dev->tx_pkt_burst = NULL;
2118                 return -ENOMEM;
2119         }
2120
2121         rte_atomic64_set(&lio_dev->status, LIO_DEV_RUNNING);
2122         rte_wmb();
2123
2124         lio_dev->port_configured = 0;
2125         /* Always allow unicast packets */
2126         lio_dev->ifflags |= LIO_IFFLAG_UNICAST;
2127
2128         return 0;
2129 }
2130
2131 static int
2132 lio_eth_dev_pci_probe(struct rte_pci_driver *pci_drv __rte_unused,
2133                       struct rte_pci_device *pci_dev)
2134 {
2135         return rte_eth_dev_pci_generic_probe(pci_dev, sizeof(struct lio_device),
2136                         lio_eth_dev_init);
2137 }
2138
2139 static int
2140 lio_eth_dev_pci_remove(struct rte_pci_device *pci_dev)
2141 {
2142         return rte_eth_dev_pci_generic_remove(pci_dev,
2143                                               lio_eth_dev_uninit);
2144 }
2145
2146 /* Set of PCI devices this driver supports */
2147 static const struct rte_pci_id pci_id_liovf_map[] = {
2148         { RTE_PCI_DEVICE(PCI_VENDOR_ID_CAVIUM, LIO_CN23XX_VF_VID) },
2149         { .vendor_id = 0, /* sentinel */ }
2150 };
2151
2152 static struct rte_pci_driver rte_liovf_pmd = {
2153         .id_table       = pci_id_liovf_map,
2154         .drv_flags      = RTE_PCI_DRV_NEED_MAPPING,
2155         .probe          = lio_eth_dev_pci_probe,
2156         .remove         = lio_eth_dev_pci_remove,
2157 };
2158
2159 RTE_PMD_REGISTER_PCI(net_liovf, rte_liovf_pmd);
2160 RTE_PMD_REGISTER_PCI_TABLE(net_liovf, pci_id_liovf_map);
2161 RTE_PMD_REGISTER_KMOD_DEP(net_liovf, "* igb_uio | vfio-pci");
2162 RTE_LOG_REGISTER_SUFFIX(lio_logtype_init, init, NOTICE);
2163 RTE_LOG_REGISTER_SUFFIX(lio_logtype_driver, driver, NOTICE);