drivers/net/liquidio/lio_ethdev.c

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