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