drivers/net/liquidio/lio_ethdev.c

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