lib/librte_pmd_ixgbe/ixgbe_ethdev.c

   1 /*-
   2  *   BSD LICENSE
   3  *
   4  *   Copyright(c) 2010-2013 Intel Corporation. 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 Intel Corporation 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 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
  35 #include <sys/queue.h>
  36 #include <stdio.h>
  37 #include <errno.h>
  38 #include <stdint.h>
  39 #include <string.h>
  40 #include <unistd.h>
  41 #include <stdarg.h>
  42 #include <inttypes.h>
  43 #include <rte_byteorder.h>
  44 #include <rte_common.h>
  45 #include <rte_cycles.h>
  46
  47 #include <rte_interrupts.h>
  48 #include <rte_log.h>
  49 #include <rte_debug.h>
  50 #include <rte_pci.h>
  51 #include <rte_atomic.h>
  52 #include <rte_branch_prediction.h>
  53 #include <rte_memory.h>
  54 #include <rte_memzone.h>
  55 #include <rte_tailq.h>
  56 #include <rte_eal.h>
  57 #include <rte_alarm.h>
  58 #include <rte_ether.h>
  59 #include <rte_ethdev.h>
  60 #include <rte_atomic.h>
  61 #include <rte_malloc.h>
  62
  63 #include "ixgbe_logs.h"
  64 #include "ixgbe/ixgbe_api.h"
  65 #include "ixgbe/ixgbe_vf.h"
  66 #include "ixgbe/ixgbe_common.h"
  67 #include "ixgbe_ethdev.h"
  68
  69 /*
  70  * High threshold controlling when to start sending XOFF frames. Must be at
  71  * least 8 bytes less than receive packet buffer size. This value is in units
  72  * of 1024 bytes.
  73  */
  74 #define IXGBE_FC_HI    0x80
  75
  76 /*
  77  * Low threshold controlling when to start sending XON frames. This value is
  78  * in units of 1024 bytes.
  79  */
  80 #define IXGBE_FC_LO    0x40
  81
  82 /* Timer value included in XOFF frames. */
  83 #define IXGBE_FC_PAUSE 0x680
  84
  85 #define IXGBE_LINK_DOWN_CHECK_TIMEOUT 4000 /* ms */
  86 #define IXGBE_LINK_UP_CHECK_TIMEOUT   1000 /* ms */
  87
  88 #define IXGBEVF_PMD_NAME "rte_ixgbevf_pmd" /* PMD name */
  89
  90 #define IXGBE_QUEUE_STAT_COUNTERS (sizeof(hw_stats->qprc) / sizeof(hw_stats->qprc[0]))
  91
  92 static int eth_ixgbe_dev_init(struct eth_driver *eth_drv,
  93                 struct rte_eth_dev *eth_dev);
  94 static int  ixgbe_dev_configure(struct rte_eth_dev *dev);
  95 static int  ixgbe_dev_start(struct rte_eth_dev *dev);
  96 static void ixgbe_dev_stop(struct rte_eth_dev *dev);
  97 static void ixgbe_dev_close(struct rte_eth_dev *dev);
  98 static void ixgbe_dev_promiscuous_enable(struct rte_eth_dev *dev);
  99 static void ixgbe_dev_promiscuous_disable(struct rte_eth_dev *dev);
 100 static void ixgbe_dev_allmulticast_enable(struct rte_eth_dev *dev);
 101 static void ixgbe_dev_allmulticast_disable(struct rte_eth_dev *dev);
 102 static int ixgbe_dev_link_update(struct rte_eth_dev *dev,
 103                                 int wait_to_complete);
 104 static void ixgbe_dev_stats_get(struct rte_eth_dev *dev,
 105                                 struct rte_eth_stats *stats);
 106 static void ixgbe_dev_stats_reset(struct rte_eth_dev *dev);
 107 static int ixgbe_dev_queue_stats_mapping_set(struct rte_eth_dev *eth_dev,
 108                                              uint16_t queue_id,
 109                                              uint8_t stat_idx,
 110                                              uint8_t is_rx);
 111 static void ixgbe_dev_info_get(struct rte_eth_dev *dev,
 112                                 struct rte_eth_dev_info *dev_info);
 113 static int ixgbe_vlan_filter_set(struct rte_eth_dev *dev,
 114                 uint16_t vlan_id, int on);
 115 static void ixgbe_vlan_tpid_set(struct rte_eth_dev *dev, uint16_t tpid_id);
 116 static void ixgbe_vlan_hw_strip_bitmap_set(struct rte_eth_dev *dev,
 117                 uint16_t queue, bool on);
 118 static void ixgbe_vlan_strip_queue_set(struct rte_eth_dev *dev, uint16_t queue,
 119                 int on);
 120 static void ixgbe_vlan_offload_set(struct rte_eth_dev *dev, int mask);
 121 static void ixgbe_vlan_hw_strip_enable(struct rte_eth_dev *dev, uint16_t queue);
 122 static void ixgbe_vlan_hw_strip_disable(struct rte_eth_dev *dev, uint16_t queue);
 123 static void ixgbe_vlan_hw_extend_enable(struct rte_eth_dev *dev);
 124 static void ixgbe_vlan_hw_extend_disable(struct rte_eth_dev *dev);
 125
 126 static int ixgbe_dev_led_on(struct rte_eth_dev *dev);
 127 static int ixgbe_dev_led_off(struct rte_eth_dev *dev);
 128 static int  ixgbe_flow_ctrl_set(struct rte_eth_dev *dev,
 129                 struct rte_eth_fc_conf *fc_conf);
 130 static int ixgbe_priority_flow_ctrl_set(struct rte_eth_dev *dev,
 131                 struct rte_eth_pfc_conf *pfc_conf);
 132 static int ixgbe_dev_rss_reta_update(struct rte_eth_dev *dev,
 133                 struct rte_eth_rss_reta *reta_conf);
 134 static int ixgbe_dev_rss_reta_query(struct rte_eth_dev *dev,
 135                 struct rte_eth_rss_reta *reta_conf);
 136 static void ixgbe_dev_link_status_print(struct rte_eth_dev *dev);
 137 static int ixgbe_dev_lsc_interrupt_setup(struct rte_eth_dev *dev);
 138 static int ixgbe_dev_interrupt_get_status(struct rte_eth_dev *dev);
 139 static int ixgbe_dev_interrupt_action(struct rte_eth_dev *dev);
 140 static void ixgbe_dev_interrupt_handler(struct rte_intr_handle *handle,
 141                 void *param);
 142 static void ixgbe_dev_interrupt_delayed_handler(void *param);
 143 static void ixgbe_add_rar(struct rte_eth_dev *dev, struct ether_addr *mac_addr,
 144                 uint32_t index, uint32_t pool);
 145 static void ixgbe_remove_rar(struct rte_eth_dev *dev, uint32_t index);
 146 static void ixgbe_dcb_init(struct ixgbe_hw *hw,struct ixgbe_dcb_config *dcb_config);
 147
 148 /* For Virtual Function support */
 149 static int eth_ixgbevf_dev_init(struct eth_driver *eth_drv,
 150                 struct rte_eth_dev *eth_dev);
 151 static int  ixgbevf_dev_configure(struct rte_eth_dev *dev);
 152 static int  ixgbevf_dev_start(struct rte_eth_dev *dev);
 153 static void ixgbevf_dev_stop(struct rte_eth_dev *dev);
 154 static void ixgbevf_dev_close(struct rte_eth_dev *dev);
 155 static void ixgbevf_intr_disable(struct ixgbe_hw *hw);
 156 static void ixgbevf_dev_stats_get(struct rte_eth_dev *dev,
 157                 struct rte_eth_stats *stats);
 158 static void ixgbevf_dev_stats_reset(struct rte_eth_dev *dev);
 159 static int ixgbevf_vlan_filter_set(struct rte_eth_dev *dev,
 160                 uint16_t vlan_id, int on);
 161 static void ixgbevf_vlan_strip_queue_set(struct rte_eth_dev *dev,
 162                 uint16_t queue, int on);
 163 static void ixgbevf_vlan_offload_set(struct rte_eth_dev *dev, int mask);
 164 static void ixgbevf_set_vfta_all(struct rte_eth_dev *dev, bool on);
 165
 166 /*
 167  * Define VF Stats MACRO for Non "cleared on read" register
 168  */
 169 #define UPDATE_VF_STAT(reg, last, cur)                          \
 170 {                                                               \
 171         u32 latest = IXGBE_READ_REG(hw, reg);                   \
 172         cur += latest - last;                                   \
 173         last = latest;                                          \
 174 }
 175
 176 #define UPDATE_VF_STAT_36BIT(lsb, msb, last, cur)                \
 177 {                                                                \
 178         u64 new_lsb = IXGBE_READ_REG(hw, lsb);                   \
 179         u64 new_msb = IXGBE_READ_REG(hw, msb);                   \
 180         u64 latest = ((new_msb << 32) | new_lsb);                \
 181         cur += (0x1000000000LL + latest - last) & 0xFFFFFFFFFLL; \
 182         last = latest;                                           \
 183 }
 184
 185 #define IXGBE_SET_HWSTRIP(h, q) do{\
 186                 uint32_t idx = (q) / (sizeof ((h)->bitmap[0]) * NBBY); \
 187                 uint32_t bit = (q) % (sizeof ((h)->bitmap[0]) * NBBY); \
 188                 (h)->bitmap[idx] |= 1 << bit;\
 189         }while(0)
 190
 191 #define IXGBE_CLEAR_HWSTRIP(h, q) do{\
 192                 uint32_t idx = (q) / (sizeof ((h)->bitmap[0]) * NBBY); \
 193                 uint32_t bit = (q) % (sizeof ((h)->bitmap[0]) * NBBY); \
 194                 (h)->bitmap[idx] &= ~(1 << bit);\
 195         }while(0)
 196
 197 #define IXGBE_GET_HWSTRIP(h, q, r) do{\
 198                 uint32_t idx = (q) / (sizeof ((h)->bitmap[0]) * NBBY); \
 199                 uint32_t bit = (q) % (sizeof ((h)->bitmap[0]) * NBBY); \
 200                 (r) = (h)->bitmap[idx] >> bit & 1;\
 201         }while(0)
 202
 203 /*
 204  * The set of PCI devices this driver supports
 205  */
 206 static struct rte_pci_id pci_id_ixgbe_map[] = {
 207
 208 #define RTE_PCI_DEV_ID_DECL_IXGBE(vend, dev) {RTE_PCI_DEVICE(vend, dev)},
 209 #include "rte_pci_dev_ids.h"
 210
 211 { .vendor_id = 0, /* sentinel */ },
 212 };
 213
 214
 215 /*
 216  * The set of PCI devices this driver supports (for 82599 VF)
 217  */
 218 static struct rte_pci_id pci_id_ixgbevf_map[] = {
 219
 220 #define RTE_PCI_DEV_ID_DECL_IXGBEVF(vend, dev) {RTE_PCI_DEVICE(vend, dev)},
 221 #include "rte_pci_dev_ids.h"
 222 { .vendor_id = 0, /* sentinel */ },
 223
 224 };
 225
 226 static struct eth_dev_ops ixgbe_eth_dev_ops = {
 227         .dev_configure        = ixgbe_dev_configure,
 228         .dev_start            = ixgbe_dev_start,
 229         .dev_stop             = ixgbe_dev_stop,
 230         .dev_close            = ixgbe_dev_close,
 231         .promiscuous_enable   = ixgbe_dev_promiscuous_enable,
 232         .promiscuous_disable  = ixgbe_dev_promiscuous_disable,
 233         .allmulticast_enable  = ixgbe_dev_allmulticast_enable,
 234         .allmulticast_disable = ixgbe_dev_allmulticast_disable,
 235         .link_update          = ixgbe_dev_link_update,
 236         .stats_get            = ixgbe_dev_stats_get,
 237         .stats_reset          = ixgbe_dev_stats_reset,
 238         .queue_stats_mapping_set = ixgbe_dev_queue_stats_mapping_set,
 239         .dev_infos_get        = ixgbe_dev_info_get,
 240         .vlan_filter_set      = ixgbe_vlan_filter_set,
 241         .vlan_tpid_set        = ixgbe_vlan_tpid_set,
 242         .vlan_offload_set     = ixgbe_vlan_offload_set,
 243         .vlan_strip_queue_set = ixgbe_vlan_strip_queue_set,
 244         .rx_queue_setup       = ixgbe_dev_rx_queue_setup,
 245         .rx_queue_release     = ixgbe_dev_rx_queue_release,
 246         .rx_queue_count       = ixgbe_dev_rx_queue_count,
 247         .rx_descriptor_done   = ixgbe_dev_rx_descriptor_done,
 248         .tx_queue_setup       = ixgbe_dev_tx_queue_setup,
 249         .tx_queue_release     = ixgbe_dev_tx_queue_release,
 250         .dev_led_on           = ixgbe_dev_led_on,
 251         .dev_led_off          = ixgbe_dev_led_off,
 252         .flow_ctrl_set        = ixgbe_flow_ctrl_set,
 253         .priority_flow_ctrl_set = ixgbe_priority_flow_ctrl_set,
 254         .mac_addr_add         = ixgbe_add_rar,
 255         .mac_addr_remove      = ixgbe_remove_rar,
 256         .fdir_add_signature_filter    = ixgbe_fdir_add_signature_filter,
 257         .fdir_update_signature_filter = ixgbe_fdir_update_signature_filter,
 258         .fdir_remove_signature_filter = ixgbe_fdir_remove_signature_filter,
 259         .fdir_infos_get               = ixgbe_fdir_info_get,
 260         .fdir_add_perfect_filter      = ixgbe_fdir_add_perfect_filter,
 261         .fdir_update_perfect_filter   = ixgbe_fdir_update_perfect_filter,
 262         .fdir_remove_perfect_filter   = ixgbe_fdir_remove_perfect_filter,
 263         .fdir_set_masks               = ixgbe_fdir_set_masks,
 264         .reta_update          = ixgbe_dev_rss_reta_update,
 265         .reta_query           = ixgbe_dev_rss_reta_query,
 266 };
 267
 268 /*
 269  * dev_ops for virtual function, bare necessities for basic vf
 270  * operation have been implemented
 271  */
 272 static struct eth_dev_ops ixgbevf_eth_dev_ops = {
 273
 274         .dev_configure        = ixgbevf_dev_configure,
 275         .dev_start            = ixgbevf_dev_start,
 276         .dev_stop             = ixgbevf_dev_stop,
 277         .link_update          = ixgbe_dev_link_update,
 278         .stats_get            = ixgbevf_dev_stats_get,
 279         .stats_reset          = ixgbevf_dev_stats_reset,
 280         .dev_close            = ixgbevf_dev_close,
 281         .dev_infos_get        = ixgbe_dev_info_get,
 282         .vlan_filter_set      = ixgbevf_vlan_filter_set,
 283         .vlan_strip_queue_set = ixgbevf_vlan_strip_queue_set,
 284         .vlan_offload_set     = ixgbevf_vlan_offload_set,
 285         .rx_queue_setup       = ixgbe_dev_rx_queue_setup,
 286         .rx_queue_release     = ixgbe_dev_rx_queue_release,
 287         .tx_queue_setup       = ixgbe_dev_tx_queue_setup,
 288         .tx_queue_release     = ixgbe_dev_tx_queue_release,
 289 };
 290
 291 /**
 292  * Atomically reads the link status information from global
 293  * structure rte_eth_dev.
 294  *
 295  * @param dev
 296  *   - Pointer to the structure rte_eth_dev to read from.
 297  *   - Pointer to the buffer to be saved with the link status.
 298  *
 299  * @return
 300  *   - On success, zero.
 301  *   - On failure, negative value.
 302  */
 303 static inline int
 304 rte_ixgbe_dev_atomic_read_link_status(struct rte_eth_dev *dev,
 305                                 struct rte_eth_link *link)
 306 {
 307         struct rte_eth_link *dst = link;
 308         struct rte_eth_link *src = &(dev->data->dev_link);
 309
 310         if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst,
 311                                         *(uint64_t *)src) == 0)
 312                 return -1;
 313
 314         return 0;
 315 }
 316
 317 /**
 318  * Atomically writes the link status information into global
 319  * structure rte_eth_dev.
 320  *
 321  * @param dev
 322  *   - Pointer to the structure rte_eth_dev to read from.
 323  *   - Pointer to the buffer to be saved with the link status.
 324  *
 325  * @return
 326  *   - On success, zero.
 327  *   - On failure, negative value.
 328  */
 329 static inline int
 330 rte_ixgbe_dev_atomic_write_link_status(struct rte_eth_dev *dev,
 331                                 struct rte_eth_link *link)
 332 {
 333         struct rte_eth_link *dst = &(dev->data->dev_link);
 334         struct rte_eth_link *src = link;
 335
 336         if (rte_atomic64_cmpset((uint64_t *)dst, *(uint64_t *)dst,
 337                                         *(uint64_t *)src) == 0)
 338                 return -1;
 339
 340         return 0;
 341 }
 342
 343 /*
 344  * This function is the same as ixgbe_is_sfp() in ixgbe/ixgbe.h.
 345  */
 346 static inline int
 347 ixgbe_is_sfp(struct ixgbe_hw *hw)
 348 {
 349         switch (hw->phy.type) {
 350         case ixgbe_phy_sfp_avago:
 351         case ixgbe_phy_sfp_ftl:
 352         case ixgbe_phy_sfp_intel:
 353         case ixgbe_phy_sfp_unknown:
 354         case ixgbe_phy_sfp_passive_tyco:
 355         case ixgbe_phy_sfp_passive_unknown:
 356                 return 1;
 357         default:
 358                 return 0;
 359         }
 360 }
 361
 362 static inline int32_t
 363 ixgbe_pf_reset_hw(struct ixgbe_hw *hw)
 364 {
 365         uint32_t ctrl_ext;
 366         int32_t status;
 367
 368         status = ixgbe_reset_hw(hw);
 369
 370         ctrl_ext = IXGBE_READ_REG(hw, IXGBE_CTRL_EXT);
 371         /* Set PF Reset Done bit so PF/VF Mail Ops can work */
 372         ctrl_ext |= IXGBE_CTRL_EXT_PFRSTD;
 373         IXGBE_WRITE_REG(hw, IXGBE_CTRL_EXT, ctrl_ext);
 374         IXGBE_WRITE_FLUSH(hw);
 375
 376         return status;
 377 }
 378
 379 static inline void
 380 ixgbe_enable_intr(struct rte_eth_dev *dev)
 381 {
 382         struct ixgbe_interrupt *intr =
 383                 IXGBE_DEV_PRIVATE_TO_INTR(dev->data->dev_private);
 384         struct ixgbe_hw *hw =
 385                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 386
 387         IXGBE_WRITE_REG(hw, IXGBE_EIMS, intr->mask);
 388         IXGBE_WRITE_FLUSH(hw);
 389 }
 390
 391 /*
 392  * This function is based on ixgbe_disable_intr() in ixgbe/ixgbe.h.
 393  */
 394 static void
 395 ixgbe_disable_intr(struct ixgbe_hw *hw)
 396 {
 397         PMD_INIT_FUNC_TRACE();
 398
 399         if (hw->mac.type == ixgbe_mac_82598EB) {
 400                 IXGBE_WRITE_REG(hw, IXGBE_EIMC, ~0);
 401         } else {
 402                 IXGBE_WRITE_REG(hw, IXGBE_EIMC, 0xFFFF0000);
 403                 IXGBE_WRITE_REG(hw, IXGBE_EIMC_EX(0), ~0);
 404                 IXGBE_WRITE_REG(hw, IXGBE_EIMC_EX(1), ~0);
 405         }
 406         IXGBE_WRITE_FLUSH(hw);
 407 }
 408
 409 /*
 410  * This function resets queue statistics mapping registers.
 411  * From Niantic datasheet, Initialization of Statistics section:
 412  * "...if software requires the queue counters, the RQSMR and TQSM registers
 413  * must be re-programmed following a device reset.
 414  */
 415 static void
 416 ixgbe_reset_qstat_mappings(struct ixgbe_hw *hw)
 417 {
 418         uint32_t i;
 419
 420         for(i = 0; i != IXGBE_NB_STAT_MAPPING_REGS; i++) {
 421                 IXGBE_WRITE_REG(hw, IXGBE_RQSMR(i), 0);
 422                 IXGBE_WRITE_REG(hw, IXGBE_TQSM(i), 0);
 423         }
 424 }
 425
 426
 427 static int
 428 ixgbe_dev_queue_stats_mapping_set(struct rte_eth_dev *eth_dev,
 429                                   uint16_t queue_id,
 430                                   uint8_t stat_idx,
 431                                   uint8_t is_rx)
 432 {
 433 #define QSM_REG_NB_BITS_PER_QMAP_FIELD 8
 434 #define NB_QMAP_FIELDS_PER_QSM_REG 4
 435 #define QMAP_FIELD_RESERVED_BITS_MASK 0x0f
 436
 437         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
 438         struct ixgbe_stat_mapping_registers *stat_mappings =
 439                 IXGBE_DEV_PRIVATE_TO_STAT_MAPPINGS(eth_dev->data->dev_private);
 440         uint32_t qsmr_mask = 0;
 441         uint32_t clearing_mask = QMAP_FIELD_RESERVED_BITS_MASK;
 442         uint32_t q_map;
 443         uint8_t n, offset;
 444
 445         if ((hw->mac.type != ixgbe_mac_82599EB) && (hw->mac.type != ixgbe_mac_X540))
 446                 return -ENOSYS;
 447
 448         PMD_INIT_LOG(INFO, "Setting port %d, %s queue_id %d to stat index %d\n",
 449                      (int)(eth_dev->data->port_id), is_rx ? "RX" : "TX", queue_id, stat_idx);
 450
 451         n = (uint8_t)(queue_id / NB_QMAP_FIELDS_PER_QSM_REG);
 452         if (n >= IXGBE_NB_STAT_MAPPING_REGS) {
 453                 PMD_INIT_LOG(ERR, "Nb of stat mapping registers exceeded\n");
 454                 return -EIO;
 455         }
 456         offset = (uint8_t)(queue_id % NB_QMAP_FIELDS_PER_QSM_REG);
 457
 458         /* Now clear any previous stat_idx set */
 459         clearing_mask <<= (QSM_REG_NB_BITS_PER_QMAP_FIELD * offset);
 460         if (!is_rx)
 461                 stat_mappings->tqsm[n] &= ~clearing_mask;
 462         else
 463                 stat_mappings->rqsmr[n] &= ~clearing_mask;
 464
 465         q_map = (uint32_t)stat_idx;
 466         q_map &= QMAP_FIELD_RESERVED_BITS_MASK;
 467         qsmr_mask = q_map << (QSM_REG_NB_BITS_PER_QMAP_FIELD * offset);
 468         if (!is_rx)
 469                 stat_mappings->tqsm[n] |= qsmr_mask;
 470         else
 471                 stat_mappings->rqsmr[n] |= qsmr_mask;
 472
 473         PMD_INIT_LOG(INFO, "Set port %d, %s queue_id %d to stat index %d\n"
 474                      "%s[%d] = 0x%08x\n",
 475                      (int)(eth_dev->data->port_id), is_rx ? "RX" : "TX", queue_id, stat_idx,
 476                      is_rx ? "RQSMR" : "TQSM",n, is_rx ? stat_mappings->rqsmr[n] : stat_mappings->tqsm[n]);
 477
 478         /* Now write the mapping in the appropriate register */
 479         if (is_rx) {
 480                 PMD_INIT_LOG(INFO, "Write 0x%x to RX IXGBE stat mapping reg:%d\n",
 481                              stat_mappings->rqsmr[n], n);
 482                 IXGBE_WRITE_REG(hw, IXGBE_RQSMR(n), stat_mappings->rqsmr[n]);
 483         }
 484         else {
 485                 PMD_INIT_LOG(INFO, "Write 0x%x to TX IXGBE stat mapping reg:%d\n",
 486                              stat_mappings->tqsm[n], n);
 487                 IXGBE_WRITE_REG(hw, IXGBE_TQSM(n), stat_mappings->tqsm[n]);
 488         }
 489         return 0;
 490 }
 491
 492 static void
 493 ixgbe_restore_statistics_mapping(struct rte_eth_dev * dev)
 494 {
 495         struct ixgbe_stat_mapping_registers *stat_mappings =
 496                 IXGBE_DEV_PRIVATE_TO_STAT_MAPPINGS(dev->data->dev_private);
 497         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 498         int i;
 499
 500         /* write whatever was in stat mapping table to the NIC */
 501         for (i = 0; i < IXGBE_NB_STAT_MAPPING_REGS; i++) {
 502                 /* rx */
 503                 IXGBE_WRITE_REG(hw, IXGBE_RQSMR(i), stat_mappings->rqsmr[i]);
 504
 505                 /* tx */
 506                 IXGBE_WRITE_REG(hw, IXGBE_TQSM(i), stat_mappings->tqsm[i]);
 507         }
 508 }
 509
 510 static void
 511 ixgbe_dcb_init(struct ixgbe_hw *hw,struct ixgbe_dcb_config *dcb_config)
 512 {
 513         uint8_t i;
 514         struct ixgbe_dcb_tc_config *tc;
 515         uint8_t dcb_max_tc = IXGBE_DCB_MAX_TRAFFIC_CLASS;
 516
 517         dcb_config->num_tcs.pg_tcs = dcb_max_tc;
 518         dcb_config->num_tcs.pfc_tcs = dcb_max_tc;
 519         for (i = 0; i < dcb_max_tc; i++) {
 520                 tc = &dcb_config->tc_config[i];
 521                 tc->path[IXGBE_DCB_TX_CONFIG].bwg_id = i;
 522                 tc->path[IXGBE_DCB_TX_CONFIG].bwg_percent =
 523                                  (uint8_t)(100/dcb_max_tc + (i & 1));
 524                 tc->path[IXGBE_DCB_RX_CONFIG].bwg_id = i;
 525                 tc->path[IXGBE_DCB_RX_CONFIG].bwg_percent =
 526                                  (uint8_t)(100/dcb_max_tc + (i & 1));
 527                 tc->pfc = ixgbe_dcb_pfc_disabled;
 528         }
 529
 530         /* Initialize default user to priority mapping, UPx->TC0 */
 531         tc = &dcb_config->tc_config[0];
 532         tc->path[IXGBE_DCB_TX_CONFIG].up_to_tc_bitmap = 0xFF;
 533         tc->path[IXGBE_DCB_RX_CONFIG].up_to_tc_bitmap = 0xFF;
 534         for (i = 0; i< IXGBE_DCB_MAX_BW_GROUP; i++) {
 535                 dcb_config->bw_percentage[IXGBE_DCB_TX_CONFIG][i] = 100;
 536                 dcb_config->bw_percentage[IXGBE_DCB_RX_CONFIG][i] = 100;
 537         }
 538         dcb_config->rx_pba_cfg = ixgbe_dcb_pba_equal;
 539         dcb_config->pfc_mode_enable = false;
 540         dcb_config->vt_mode = true;
 541         dcb_config->round_robin_enable = false;
 542         /* support all DCB capabilities in 82599 */
 543         dcb_config->support.capabilities = 0xFF;
 544
 545         /*we only support 4 Tcs for X540*/
 546         if (hw->mac.type == ixgbe_mac_X540) {
 547                 dcb_config->num_tcs.pg_tcs = 4;
 548                 dcb_config->num_tcs.pfc_tcs = 4;
 549         }
 550 }
 551
 552 /*
 553  * This function is based on code in ixgbe_attach() in ixgbe/ixgbe.c.
 554  * It returns 0 on success.
 555  */
 556 static int
 557 eth_ixgbe_dev_init(__attribute__((unused)) struct eth_driver *eth_drv,
 558                      struct rte_eth_dev *eth_dev)
 559 {
 560         struct rte_pci_device *pci_dev;
 561         struct ixgbe_hw *hw =
 562                 IXGBE_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
 563         struct ixgbe_vfta * shadow_vfta =
 564                 IXGBE_DEV_PRIVATE_TO_VFTA(eth_dev->data->dev_private);
 565         struct ixgbe_hwstrip *hwstrip =
 566                 IXGBE_DEV_PRIVATE_TO_HWSTRIP_BITMAP(eth_dev->data->dev_private);
 567         struct ixgbe_dcb_config *dcb_config =
 568                 IXGBE_DEV_PRIVATE_TO_DCB_CFG(eth_dev->data->dev_private);
 569         uint32_t ctrl_ext;
 570         uint16_t csum;
 571         int diag, i;
 572
 573         PMD_INIT_FUNC_TRACE();
 574
 575         eth_dev->dev_ops = &ixgbe_eth_dev_ops;
 576         eth_dev->rx_pkt_burst = &ixgbe_recv_pkts;
 577         eth_dev->tx_pkt_burst = &ixgbe_xmit_pkts;
 578
 579         /* for secondary processes, we don't initialise any further as primary
 580          * has already done this work. Only check we don't need a different
 581          * RX function */
 582         if (rte_eal_process_type() != RTE_PROC_PRIMARY){
 583                 if (eth_dev->data->scattered_rx)
 584                         eth_dev->rx_pkt_burst = ixgbe_recv_scattered_pkts;
 585                 return 0;
 586         }
 587         pci_dev = eth_dev->pci_dev;
 588
 589         /* Vendor and Device ID need to be set before init of shared code */
 590         hw->device_id = pci_dev->id.device_id;
 591         hw->vendor_id = pci_dev->id.vendor_id;
 592         hw->hw_addr = (void *)pci_dev->mem_resource[0].addr;
 593 #ifdef RTE_LIBRTE_IXGBE_ALLOW_UNSUPPORTED_SFP
 594         hw->allow_unsupported_sfp = 1;
 595 #endif
 596
 597         /* Initialize the shared code */
 598         diag = ixgbe_init_shared_code(hw);
 599         if (diag != IXGBE_SUCCESS) {
 600                 PMD_INIT_LOG(ERR, "Shared code init failed: %d", diag);
 601                 return -EIO;
 602         }
 603
 604         /* Initialize DCB configuration*/
 605         memset(dcb_config, 0, sizeof(struct ixgbe_dcb_config));
 606         ixgbe_dcb_init(hw,dcb_config);
 607         /* Get Hardware Flow Control setting */
 608         hw->fc.requested_mode = ixgbe_fc_full;
 609         hw->fc.current_mode = ixgbe_fc_full;
 610         hw->fc.pause_time = IXGBE_FC_PAUSE;
 611         for (i = 0; i < IXGBE_DCB_MAX_TRAFFIC_CLASS; i++) {
 612                 hw->fc.low_water[i] = IXGBE_FC_LO;
 613                 hw->fc.high_water[i] = IXGBE_FC_HI;
 614         }
 615         hw->fc.send_xon = 1;
 616
 617         /* Make sure we have a good EEPROM before we read from it */
 618         diag = ixgbe_validate_eeprom_checksum(hw, &csum);
 619         if (diag != IXGBE_SUCCESS) {
 620                 PMD_INIT_LOG(ERR, "The EEPROM checksum is not valid: %d", diag);
 621                 return -EIO;
 622         }
 623
 624         diag = ixgbe_init_hw(hw);
 625
 626         /*
 627          * Devices with copper phys will fail to initialise if ixgbe_init_hw()
 628          * is called too soon after the kernel driver unbinding/binding occurs.
 629          * The failure occurs in ixgbe_identify_phy_generic() for all devices,
 630          * but for non-copper devies, ixgbe_identify_sfp_module_generic() is
 631          * also called. See ixgbe_identify_phy_82599(). The reason for the
 632          * failure is not known, and only occuts when virtualisation features
 633          * are disabled in the bios. A delay of 100ms  was found to be enough by
 634          * trial-and-error, and is doubled to be safe.
 635          */
 636         if (diag && (hw->mac.ops.get_media_type(hw) == ixgbe_media_type_copper)) {
 637                 rte_delay_ms(200);
 638                 diag = ixgbe_init_hw(hw);
 639         }
 640
 641         if (diag == IXGBE_ERR_EEPROM_VERSION) {
 642                 PMD_INIT_LOG(ERR, "This device is a pre-production adapter/"
 643                     "LOM.  Please be aware there may be issues associated "
 644                     "with your hardware.\n If you are experiencing problems "
 645                     "please contact your Intel or hardware representative "
 646                     "who provided you with this hardware.\n");
 647         } else if (diag == IXGBE_ERR_SFP_NOT_SUPPORTED)
 648                 PMD_INIT_LOG(ERR, "Unsupported SFP+ Module\n");
 649         if (diag) {
 650                 PMD_INIT_LOG(ERR, "Hardware Initialization Failure: %d", diag);
 651                 return -EIO;
 652         }
 653
 654         /* disable interrupt */
 655         ixgbe_disable_intr(hw);
 656
 657         /* pick up the PCI bus settings for reporting later */
 658         ixgbe_get_bus_info(hw);
 659
 660         /* reset mappings for queue statistics hw counters*/
 661         ixgbe_reset_qstat_mappings(hw);
 662
 663         /* Allocate memory for storing MAC addresses */
 664         eth_dev->data->mac_addrs = rte_zmalloc("ixgbe", ETHER_ADDR_LEN *
 665                         hw->mac.num_rar_entries, 0);
 666         if (eth_dev->data->mac_addrs == NULL) {
 667                 PMD_INIT_LOG(ERR,
 668                         "Failed to allocate %d bytes needed to store MAC addresses",
 669                         ETHER_ADDR_LEN * hw->mac.num_rar_entries);
 670                 return -ENOMEM;
 671         }
 672         /* Copy the permanent MAC address */
 673         ether_addr_copy((struct ether_addr *) hw->mac.perm_addr,
 674                         &eth_dev->data->mac_addrs[0]);
 675
 676         /* initialize the vfta */
 677         memset(shadow_vfta, 0, sizeof(*shadow_vfta));
 678
 679         /* initialize the hw strip bitmap*/
 680         memset(hwstrip, 0, sizeof(*hwstrip));
 681
 682         /* initialize PF if max_vfs not zero */
 683         ixgbe_pf_host_init(eth_dev);
 684
 685         ctrl_ext = IXGBE_READ_REG(hw, IXGBE_CTRL_EXT);
 686         /* let hardware know driver is loaded */
 687         ctrl_ext |= IXGBE_CTRL_EXT_DRV_LOAD;
 688         /* Set PF Reset Done bit so PF/VF Mail Ops can work */
 689         ctrl_ext |= IXGBE_CTRL_EXT_PFRSTD;
 690         IXGBE_WRITE_REG(hw, IXGBE_CTRL_EXT, ctrl_ext);
 691         IXGBE_WRITE_FLUSH(hw);
 692
 693         if (ixgbe_is_sfp(hw) && hw->phy.sfp_type != ixgbe_sfp_type_not_present)
 694                 PMD_INIT_LOG(DEBUG,
 695                              "MAC: %d, PHY: %d, SFP+: %d<n",
 696                              (int) hw->mac.type, (int) hw->phy.type,
 697                              (int) hw->phy.sfp_type);
 698         else
 699                 PMD_INIT_LOG(DEBUG, "MAC: %d, PHY: %d\n",
 700                              (int) hw->mac.type, (int) hw->phy.type);
 701
 702         PMD_INIT_LOG(DEBUG, "port %d vendorID=0x%x deviceID=0x%x",
 703                         eth_dev->data->port_id, pci_dev->id.vendor_id,
 704                         pci_dev->id.device_id);
 705
 706         rte_intr_callback_register(&(pci_dev->intr_handle),
 707                 ixgbe_dev_interrupt_handler, (void *)eth_dev);
 708
 709         /* enable uio intr after callback register */
 710         rte_intr_enable(&(pci_dev->intr_handle));
 711
 712         /* enable support intr */
 713         ixgbe_enable_intr(eth_dev);
 714
 715         return 0;
 716 }
 717
 718 /*
 719  * Virtual Function device init
 720  */
 721 static int
 722 eth_ixgbevf_dev_init(__attribute__((unused)) struct eth_driver *eth_drv,
 723                      struct rte_eth_dev *eth_dev)
 724 {
 725         struct rte_pci_device *pci_dev;
 726         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(eth_dev->data->dev_private);
 727         int diag;
 728         struct ixgbe_vfta * shadow_vfta =
 729                 IXGBE_DEV_PRIVATE_TO_VFTA(eth_dev->data->dev_private);
 730         struct ixgbe_hwstrip *hwstrip =
 731                 IXGBE_DEV_PRIVATE_TO_HWSTRIP_BITMAP(eth_dev->data->dev_private);
 732
 733         PMD_INIT_LOG(DEBUG, "eth_ixgbevf_dev_init");
 734
 735         eth_dev->dev_ops = &ixgbevf_eth_dev_ops;
 736         pci_dev = eth_dev->pci_dev;
 737
 738         hw->device_id = pci_dev->id.device_id;
 739         hw->vendor_id = pci_dev->id.vendor_id;
 740         hw->hw_addr = (void *)pci_dev->mem_resource[0].addr;
 741
 742         /* initialize the vfta */
 743         memset(shadow_vfta, 0, sizeof(*shadow_vfta));
 744
 745         /* initialize the hw strip bitmap*/
 746         memset(hwstrip, 0, sizeof(*hwstrip));
 747
 748         /* Initialize the shared code */
 749         diag = ixgbe_init_shared_code(hw);
 750         if (diag != IXGBE_SUCCESS) {
 751                 PMD_INIT_LOG(ERR, "Shared code init failed for ixgbevf: %d", diag);
 752                 return -EIO;
 753         }
 754
 755         /* init_mailbox_params */
 756         hw->mbx.ops.init_params(hw);
 757
 758         /* Disable the interrupts for VF */
 759         ixgbevf_intr_disable(hw);
 760
 761         hw->mac.num_rar_entries = hw->mac.max_rx_queues;
 762         diag = hw->mac.ops.reset_hw(hw);
 763
 764         if (diag != IXGBE_SUCCESS) {
 765                 PMD_INIT_LOG(ERR, "VF Initialization Failure: %d", diag);
 766                         RTE_LOG(ERR, PMD, "\tThe MAC address is not valid.\n"
 767                                         "\tThe most likely cause of this error is that the VM host\n"
 768                                         "\thas not assigned a valid MAC address to this VF device.\n"
 769                                         "\tPlease consult the DPDK Release Notes (FAQ section) for\n"
 770                                         "\ta possible solution to this problem.\n");
 771                 return (diag);
 772         }
 773
 774         /* Allocate memory for storing MAC addresses */
 775         eth_dev->data->mac_addrs = rte_zmalloc("ixgbevf", ETHER_ADDR_LEN *
 776                         hw->mac.num_rar_entries, 0);
 777         if (eth_dev->data->mac_addrs == NULL) {
 778                 PMD_INIT_LOG(ERR,
 779                         "Failed to allocate %d bytes needed to store MAC addresses",
 780                         ETHER_ADDR_LEN * hw->mac.num_rar_entries);
 781                 return -ENOMEM;
 782         }
 783
 784         /* Copy the permanent MAC address */
 785         ether_addr_copy((struct ether_addr *) hw->mac.perm_addr,
 786                         &eth_dev->data->mac_addrs[0]);
 787
 788         /* reset the hardware with the new settings */
 789         diag = hw->mac.ops.start_hw(hw);
 790         switch (diag) {
 791                 case  0:
 792                         break;
 793
 794                 default:
 795                         PMD_INIT_LOG(ERR, "VF Initialization Failure: %d", diag);
 796                         return (-EIO);
 797         }
 798
 799         PMD_INIT_LOG(DEBUG, "\nport %d vendorID=0x%x deviceID=0x%x mac.type=%s\n",
 800                          eth_dev->data->port_id, pci_dev->id.vendor_id, pci_dev->id.device_id,
 801                          "ixgbe_mac_82599_vf");
 802
 803         return 0;
 804 }
 805
 806 static struct eth_driver rte_ixgbe_pmd = {
 807         {
 808                 .name = "rte_ixgbe_pmd",
 809                 .id_table = pci_id_ixgbe_map,
 810 #ifdef RTE_EAL_UNBIND_PORTS
 811                 .drv_flags = RTE_PCI_DRV_NEED_IGB_UIO,
 812 #endif
 813         },
 814         .eth_dev_init = eth_ixgbe_dev_init,
 815         .dev_private_size = sizeof(struct ixgbe_adapter),
 816 };
 817
 818 /*
 819  * virtual function driver struct
 820  */
 821 static struct eth_driver rte_ixgbevf_pmd = {
 822         {
 823                 .name = "rte_ixgbevf_pmd",
 824                 .id_table = pci_id_ixgbevf_map,
 825 #ifdef RTE_EAL_UNBIND_PORTS
 826                 .drv_flags = RTE_PCI_DRV_NEED_IGB_UIO,
 827 #endif
 828         },
 829         .eth_dev_init = eth_ixgbevf_dev_init,
 830         .dev_private_size = sizeof(struct ixgbe_adapter),
 831 };
 832
 833 /*
 834  * Driver initialization routine.
 835  * Invoked once at EAL init time.
 836  * Register itself as the [Poll Mode] Driver of PCI IXGBE devices.
 837  */
 838 int
 839 rte_ixgbe_pmd_init(void)
 840 {
 841         PMD_INIT_FUNC_TRACE();
 842
 843         rte_eth_driver_register(&rte_ixgbe_pmd);
 844         return 0;
 845 }
 846
 847 /*
 848  * VF Driver initialization routine.
 849  * Invoked one at EAL init time.
 850  * Register itself as the [Virtual Poll Mode] Driver of PCI niantic devices.
 851  */
 852 int
 853 rte_ixgbevf_pmd_init(void)
 854 {
 855         DEBUGFUNC("rte_ixgbevf_pmd_init");
 856
 857         rte_eth_driver_register(&rte_ixgbevf_pmd);
 858         return (0);
 859 }
 860
 861 static int
 862 ixgbe_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on)
 863 {
 864         struct ixgbe_hw *hw =
 865                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 866         struct ixgbe_vfta * shadow_vfta =
 867                 IXGBE_DEV_PRIVATE_TO_VFTA(dev->data->dev_private);
 868         uint32_t vfta;
 869         uint32_t vid_idx;
 870         uint32_t vid_bit;
 871
 872         vid_idx = (uint32_t) ((vlan_id >> 5) & 0x7F);
 873         vid_bit = (uint32_t) (1 << (vlan_id & 0x1F));
 874         vfta = IXGBE_READ_REG(hw, IXGBE_VFTA(vid_idx));
 875         if (on)
 876                 vfta |= vid_bit;
 877         else
 878                 vfta &= ~vid_bit;
 879         IXGBE_WRITE_REG(hw, IXGBE_VFTA(vid_idx), vfta);
 880
 881         /* update local VFTA copy */
 882         shadow_vfta->vfta[vid_idx] = vfta;
 883
 884         return 0;
 885 }
 886
 887 static void
 888 ixgbe_vlan_strip_queue_set(struct rte_eth_dev *dev, uint16_t queue, int on)
 889 {
 890         if (on)
 891                 ixgbe_vlan_hw_strip_enable(dev, queue);
 892         else
 893                 ixgbe_vlan_hw_strip_disable(dev, queue);
 894 }
 895
 896 static void
 897 ixgbe_vlan_tpid_set(struct rte_eth_dev *dev, uint16_t tpid)
 898 {
 899         struct ixgbe_hw *hw =
 900                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 901
 902         /* Only the high 16-bits is valid */
 903         IXGBE_WRITE_REG(hw, IXGBE_EXVET, tpid << 16);
 904 }
 905
 906 void
 907 ixgbe_vlan_hw_filter_disable(struct rte_eth_dev *dev)
 908 {
 909         struct ixgbe_hw *hw =
 910                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 911         uint32_t vlnctrl;
 912
 913         PMD_INIT_FUNC_TRACE();
 914
 915         /* Filter Table Disable */
 916         vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
 917         vlnctrl &= ~IXGBE_VLNCTRL_VFE;
 918
 919         IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
 920 }
 921
 922 void
 923 ixgbe_vlan_hw_filter_enable(struct rte_eth_dev *dev)
 924 {
 925         struct ixgbe_hw *hw =
 926                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 927         struct ixgbe_vfta * shadow_vfta =
 928                 IXGBE_DEV_PRIVATE_TO_VFTA(dev->data->dev_private);
 929         uint32_t vlnctrl;
 930         uint16_t i;
 931
 932         PMD_INIT_FUNC_TRACE();
 933
 934         /* Filter Table Enable */
 935         vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
 936         vlnctrl &= ~IXGBE_VLNCTRL_CFIEN;
 937         vlnctrl |= IXGBE_VLNCTRL_VFE;
 938
 939         IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
 940
 941         /* write whatever is in local vfta copy */
 942         for (i = 0; i < IXGBE_VFTA_SIZE; i++)
 943                 IXGBE_WRITE_REG(hw, IXGBE_VFTA(i), shadow_vfta->vfta[i]);
 944 }
 945
 946 static void
 947 ixgbe_vlan_hw_strip_bitmap_set(struct rte_eth_dev *dev, uint16_t queue, bool on)
 948 {
 949         struct ixgbe_hwstrip *hwstrip =
 950                 IXGBE_DEV_PRIVATE_TO_HWSTRIP_BITMAP(dev->data->dev_private);
 951
 952         if(queue >= IXGBE_MAX_RX_QUEUE_NUM)
 953                 return;
 954
 955         if (on)
 956                 IXGBE_SET_HWSTRIP(hwstrip, queue);
 957         else
 958                 IXGBE_CLEAR_HWSTRIP(hwstrip, queue);
 959 }
 960
 961 static void
 962 ixgbe_vlan_hw_strip_disable(struct rte_eth_dev *dev, uint16_t queue)
 963 {
 964         struct ixgbe_hw *hw =
 965                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 966         uint32_t ctrl;
 967
 968         PMD_INIT_FUNC_TRACE();
 969
 970         if (hw->mac.type == ixgbe_mac_82598EB) {
 971                 /* No queue level support */
 972                 PMD_INIT_LOG(INFO, "82598EB not support queue level hw strip");
 973                 return;
 974         }
 975         else {
 976                 /* Other 10G NIC, the VLAN strip can be setup per queue in RXDCTL */
 977                 ctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(queue));
 978                 ctrl &= ~IXGBE_RXDCTL_VME;
 979                 IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(queue), ctrl);
 980         }
 981         /* record those setting for HW strip per queue */
 982         ixgbe_vlan_hw_strip_bitmap_set(dev, queue, 0);
 983 }
 984
 985 static void
 986 ixgbe_vlan_hw_strip_enable(struct rte_eth_dev *dev, uint16_t queue)
 987 {
 988         struct ixgbe_hw *hw =
 989                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
 990         uint32_t ctrl;
 991
 992         PMD_INIT_FUNC_TRACE();
 993
 994         if (hw->mac.type == ixgbe_mac_82598EB) {
 995                 /* No queue level supported */
 996                 PMD_INIT_LOG(INFO, "82598EB not support queue level hw strip");
 997                 return;
 998         }
 999         else {
1000                 /* Other 10G NIC, the VLAN strip can be setup per queue in RXDCTL */
1001                 ctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(queue));
1002                 ctrl |= IXGBE_RXDCTL_VME;
1003                 IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(queue), ctrl);
1004         }
1005         /* record those setting for HW strip per queue */
1006         ixgbe_vlan_hw_strip_bitmap_set(dev, queue, 1);
1007 }
1008
1009 void
1010 ixgbe_vlan_hw_strip_disable_all(struct rte_eth_dev *dev)
1011 {
1012         struct ixgbe_hw *hw =
1013                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1014         uint32_t ctrl;
1015         uint16_t i;
1016
1017         PMD_INIT_FUNC_TRACE();
1018
1019         if (hw->mac.type == ixgbe_mac_82598EB) {
1020                 ctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
1021                 ctrl &= ~IXGBE_VLNCTRL_VME;
1022                 IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, ctrl);
1023         }
1024         else {
1025                 /* Other 10G NIC, the VLAN strip can be setup per queue in RXDCTL */
1026                 for (i = 0; i < dev->data->nb_rx_queues; i++) {
1027                         ctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(i));
1028                         ctrl &= ~IXGBE_RXDCTL_VME;
1029                         IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(i), ctrl);
1030
1031                         /* record those setting for HW strip per queue */
1032                         ixgbe_vlan_hw_strip_bitmap_set(dev, i, 0);
1033                 }
1034         }
1035 }
1036
1037 void
1038 ixgbe_vlan_hw_strip_enable_all(struct rte_eth_dev *dev)
1039 {
1040         struct ixgbe_hw *hw =
1041                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1042         uint32_t ctrl;
1043         uint16_t i;
1044
1045         PMD_INIT_FUNC_TRACE();
1046
1047         if (hw->mac.type == ixgbe_mac_82598EB) {
1048                 ctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
1049                 ctrl |= IXGBE_VLNCTRL_VME;
1050                 IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, ctrl);
1051         }
1052         else {
1053                 /* Other 10G NIC, the VLAN strip can be setup per queue in RXDCTL */
1054                 for (i = 0; i < dev->data->nb_rx_queues; i++) {
1055                         ctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(i));
1056                         ctrl |= IXGBE_RXDCTL_VME;
1057                         IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(i), ctrl);
1058
1059                         /* record those setting for HW strip per queue */
1060                         ixgbe_vlan_hw_strip_bitmap_set(dev, i, 1);
1061                 }
1062         }
1063 }
1064
1065 static void
1066 ixgbe_vlan_hw_extend_disable(struct rte_eth_dev *dev)
1067 {
1068         struct ixgbe_hw *hw =
1069                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1070         uint32_t ctrl;
1071
1072         PMD_INIT_FUNC_TRACE();
1073
1074         /* DMATXCTRL: Geric Double VLAN Disable */
1075         ctrl = IXGBE_READ_REG(hw, IXGBE_DMATXCTL);
1076         ctrl &= ~IXGBE_DMATXCTL_GDV;
1077         IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL, ctrl);
1078
1079         /* CTRL_EXT: Global Double VLAN Disable */
1080         ctrl = IXGBE_READ_REG(hw, IXGBE_CTRL_EXT);
1081         ctrl &= ~IXGBE_EXTENDED_VLAN;
1082         IXGBE_WRITE_REG(hw, IXGBE_CTRL_EXT, ctrl);
1083
1084 }
1085
1086 static void
1087 ixgbe_vlan_hw_extend_enable(struct rte_eth_dev *dev)
1088 {
1089         struct ixgbe_hw *hw =
1090                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1091         uint32_t ctrl;
1092
1093         PMD_INIT_FUNC_TRACE();
1094
1095         /* DMATXCTRL: Geric Double VLAN Enable */
1096         ctrl  = IXGBE_READ_REG(hw, IXGBE_DMATXCTL);
1097         ctrl |= IXGBE_DMATXCTL_GDV;
1098         IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL, ctrl);
1099
1100         /* CTRL_EXT: Global Double VLAN Enable */
1101         ctrl  = IXGBE_READ_REG(hw, IXGBE_CTRL_EXT);
1102         ctrl |= IXGBE_EXTENDED_VLAN;
1103         IXGBE_WRITE_REG(hw, IXGBE_CTRL_EXT, ctrl);
1104
1105         /*
1106          * VET EXT field in the EXVET register = 0x8100 by default
1107          * So no need to change. Same to VT field of DMATXCTL register
1108          */
1109 }
1110
1111 static void
1112 ixgbe_vlan_offload_set(struct rte_eth_dev *dev, int mask)
1113 {
1114         if(mask & ETH_VLAN_STRIP_MASK){
1115                 if (dev->data->dev_conf.rxmode.hw_vlan_strip)
1116                         ixgbe_vlan_hw_strip_enable_all(dev);
1117                 else
1118                         ixgbe_vlan_hw_strip_disable_all(dev);
1119         }
1120
1121         if(mask & ETH_VLAN_FILTER_MASK){
1122                 if (dev->data->dev_conf.rxmode.hw_vlan_filter)
1123                         ixgbe_vlan_hw_filter_enable(dev);
1124                 else
1125                         ixgbe_vlan_hw_filter_disable(dev);
1126         }
1127
1128         if(mask & ETH_VLAN_EXTEND_MASK){
1129                 if (dev->data->dev_conf.rxmode.hw_vlan_extend)
1130                         ixgbe_vlan_hw_extend_enable(dev);
1131                 else
1132                         ixgbe_vlan_hw_extend_disable(dev);
1133         }
1134 }
1135
1136 static int
1137 ixgbe_dev_configure(struct rte_eth_dev *dev)
1138 {
1139         struct ixgbe_interrupt *intr =
1140                 IXGBE_DEV_PRIVATE_TO_INTR(dev->data->dev_private);
1141
1142         PMD_INIT_FUNC_TRACE();
1143
1144         /* set flag to update link status after init */
1145         intr->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
1146
1147         return 0;
1148 }
1149
1150 /*
1151  * Configure device link speed and setup link.
1152  * It returns 0 on success.
1153  */
1154 static int
1155 ixgbe_dev_start(struct rte_eth_dev *dev)
1156 {
1157         struct ixgbe_hw *hw =
1158                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1159         int err, link_up = 0, negotiate = 0;
1160         uint32_t speed = 0;
1161         int mask = 0;
1162         int status;
1163
1164         PMD_INIT_FUNC_TRACE();
1165
1166         /* IXGBE devices don't support half duplex */
1167         if ((dev->data->dev_conf.link_duplex != ETH_LINK_AUTONEG_DUPLEX) &&
1168                         (dev->data->dev_conf.link_duplex != ETH_LINK_FULL_DUPLEX)) {
1169                 PMD_INIT_LOG(ERR, "Invalid link_duplex (%u) for port %u\n",
1170                                 dev->data->dev_conf.link_duplex,
1171                                 dev->data->port_id);
1172                 return -EINVAL;
1173         }
1174
1175         /* stop adapter */
1176         hw->adapter_stopped = FALSE;
1177         ixgbe_stop_adapter(hw);
1178
1179         /* reinitialize adapter
1180          * this calls reset and start */
1181         status = ixgbe_pf_reset_hw(hw);
1182         if (status != 0)
1183                 return -1;
1184         hw->mac.ops.start_hw(hw);
1185
1186         /* configure PF module if SRIOV enabled */
1187         ixgbe_pf_host_configure(dev);
1188
1189         /* initialize transmission unit */
1190         ixgbe_dev_tx_init(dev);
1191
1192         /* This can fail when allocating mbufs for descriptor rings */
1193         err = ixgbe_dev_rx_init(dev);
1194         if (err) {
1195                 PMD_INIT_LOG(ERR, "Unable to initialize RX hardware\n");
1196                 goto error;
1197         }
1198
1199         ixgbe_dev_rxtx_start(dev);
1200
1201         if (ixgbe_is_sfp(hw) && hw->phy.multispeed_fiber) {
1202                 err = hw->mac.ops.setup_sfp(hw);
1203                 if (err)
1204                         goto error;
1205         }
1206
1207         /* Turn on the laser */
1208         ixgbe_enable_tx_laser(hw);
1209
1210         err = ixgbe_check_link(hw, &speed, &link_up, 0);
1211         if (err)
1212                 goto error;
1213         err = ixgbe_get_link_capabilities(hw, &speed, &negotiate);
1214         if (err)
1215                 goto error;
1216
1217         switch(dev->data->dev_conf.link_speed) {
1218         case ETH_LINK_SPEED_AUTONEG:
1219                 speed = (hw->mac.type != ixgbe_mac_82598EB) ?
1220                                 IXGBE_LINK_SPEED_82599_AUTONEG :
1221                                 IXGBE_LINK_SPEED_82598_AUTONEG;
1222                 break;
1223         case ETH_LINK_SPEED_100:
1224                 /*
1225                  * Invalid for 82598 but error will be detected by
1226                  * ixgbe_setup_link()
1227                  */
1228                 speed = IXGBE_LINK_SPEED_100_FULL;
1229                 break;
1230         case ETH_LINK_SPEED_1000:
1231                 speed = IXGBE_LINK_SPEED_1GB_FULL;
1232                 break;
1233         case ETH_LINK_SPEED_10000:
1234                 speed = IXGBE_LINK_SPEED_10GB_FULL;
1235                 break;
1236         default:
1237                 PMD_INIT_LOG(ERR, "Invalid link_speed (%u) for port %u\n",
1238                                 dev->data->dev_conf.link_speed, dev->data->port_id);
1239                 goto error;
1240         }
1241
1242         err = ixgbe_setup_link(hw, speed, negotiate, link_up);
1243         if (err)
1244                 goto error;
1245
1246         /* check if lsc interrupt is enabled */
1247         if (dev->data->dev_conf.intr_conf.lsc != 0)
1248                 ixgbe_dev_lsc_interrupt_setup(dev);
1249
1250         /* resume enabled intr since hw reset */
1251         ixgbe_enable_intr(dev);
1252
1253         mask = ETH_VLAN_STRIP_MASK | ETH_VLAN_FILTER_MASK | \
1254                 ETH_VLAN_EXTEND_MASK;
1255         ixgbe_vlan_offload_set(dev, mask);
1256
1257         /* Configure DCB hw */
1258         ixgbe_configure_dcb(dev);
1259
1260         if (dev->data->dev_conf.fdir_conf.mode != RTE_FDIR_MODE_NONE) {
1261                 err = ixgbe_fdir_configure(dev);
1262                 if (err)
1263                         goto error;
1264         }
1265
1266         ixgbe_restore_statistics_mapping(dev);
1267
1268         return (0);
1269
1270 error:
1271         PMD_INIT_LOG(ERR, "failure in ixgbe_dev_start(): %d", err);
1272         ixgbe_dev_clear_queues(dev);
1273         return -EIO;
1274 }
1275
1276 /*
1277  * Stop device: disable rx and tx functions to allow for reconfiguring.
1278  */
1279 static void
1280 ixgbe_dev_stop(struct rte_eth_dev *dev)
1281 {
1282         struct rte_eth_link link;
1283         struct ixgbe_hw *hw =
1284                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1285
1286         PMD_INIT_FUNC_TRACE();
1287
1288         /* disable interrupts */
1289         ixgbe_disable_intr(hw);
1290
1291         /* reset the NIC */
1292         ixgbe_pf_reset_hw(hw);
1293         hw->adapter_stopped = FALSE;
1294
1295         /* stop adapter */
1296         ixgbe_stop_adapter(hw);
1297
1298         /* Turn off the laser */
1299         ixgbe_disable_tx_laser(hw);
1300
1301         ixgbe_dev_clear_queues(dev);
1302
1303         /* Clear recorded link status */
1304         memset(&link, 0, sizeof(link));
1305         rte_ixgbe_dev_atomic_write_link_status(dev, &link);
1306 }
1307
1308 /*
1309  * Reest and stop device.
1310  */
1311 static void
1312 ixgbe_dev_close(struct rte_eth_dev *dev)
1313 {
1314         struct ixgbe_hw *hw =
1315                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1316
1317         PMD_INIT_FUNC_TRACE();
1318
1319         ixgbe_pf_reset_hw(hw);
1320
1321         ixgbe_dev_stop(dev);
1322         hw->adapter_stopped = 1;
1323
1324         ixgbe_disable_pcie_master(hw);
1325
1326         /* reprogram the RAR[0] in case user changed it. */
1327         ixgbe_set_rar(hw, 0, hw->mac.addr, 0, IXGBE_RAH_AV);
1328 }
1329
1330 /*
1331  * This function is based on ixgbe_update_stats_counters() in ixgbe/ixgbe.c
1332  */
1333 static void
1334 ixgbe_dev_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
1335 {
1336         struct ixgbe_hw *hw =
1337                         IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1338         struct ixgbe_hw_stats *hw_stats =
1339                         IXGBE_DEV_PRIVATE_TO_STATS(dev->data->dev_private);
1340         uint32_t bprc, lxon, lxoff, total;
1341         uint64_t total_missed_rx, total_qbrc, total_qprc;
1342         unsigned i;
1343
1344         total_missed_rx = 0;
1345         total_qbrc = 0;
1346         total_qprc = 0;
1347
1348         hw_stats->crcerrs += IXGBE_READ_REG(hw, IXGBE_CRCERRS);
1349         hw_stats->illerrc += IXGBE_READ_REG(hw, IXGBE_ILLERRC);
1350         hw_stats->errbc += IXGBE_READ_REG(hw, IXGBE_ERRBC);
1351         hw_stats->mspdc += IXGBE_READ_REG(hw, IXGBE_MSPDC);
1352
1353         for (i = 0; i < 8; i++) {
1354                 uint32_t mp;
1355                 mp = IXGBE_READ_REG(hw, IXGBE_MPC(i));
1356                 /* global total per queue */
1357                 hw_stats->mpc[i] += mp;
1358                 /* Running comprehensive total for stats display */
1359                 total_missed_rx += hw_stats->mpc[i];
1360                 if (hw->mac.type == ixgbe_mac_82598EB)
1361                         hw_stats->rnbc[i] +=
1362                             IXGBE_READ_REG(hw, IXGBE_RNBC(i));
1363                 hw_stats->pxontxc[i] +=
1364                     IXGBE_READ_REG(hw, IXGBE_PXONTXC(i));
1365                 hw_stats->pxonrxc[i] +=
1366                     IXGBE_READ_REG(hw, IXGBE_PXONRXC(i));
1367                 hw_stats->pxofftxc[i] +=
1368                     IXGBE_READ_REG(hw, IXGBE_PXOFFTXC(i));
1369                 hw_stats->pxoffrxc[i] +=
1370                     IXGBE_READ_REG(hw, IXGBE_PXOFFRXC(i));
1371                 hw_stats->pxon2offc[i] +=
1372                     IXGBE_READ_REG(hw, IXGBE_PXON2OFFCNT(i));
1373         }
1374         for (i = 0; i < IXGBE_QUEUE_STAT_COUNTERS; i++) {
1375                 hw_stats->qprc[i] += IXGBE_READ_REG(hw, IXGBE_QPRC(i));
1376                 hw_stats->qptc[i] += IXGBE_READ_REG(hw, IXGBE_QPTC(i));
1377                 hw_stats->qbrc[i] += IXGBE_READ_REG(hw, IXGBE_QBRC_L(i));
1378                 hw_stats->qbrc[i] +=
1379                     ((uint64_t)IXGBE_READ_REG(hw, IXGBE_QBRC_H(i)) << 32);
1380                 hw_stats->qbtc[i] += IXGBE_READ_REG(hw, IXGBE_QBTC_L(i));
1381                 hw_stats->qbtc[i] +=
1382                     ((uint64_t)IXGBE_READ_REG(hw, IXGBE_QBTC_H(i)) << 32);
1383                 hw_stats->qprdc[i] += IXGBE_READ_REG(hw, IXGBE_QPRDC(i));
1384
1385                 total_qprc += hw_stats->qprc[i];
1386                 total_qbrc += hw_stats->qbrc[i];
1387         }
1388         hw_stats->mlfc += IXGBE_READ_REG(hw, IXGBE_MLFC);
1389         hw_stats->mrfc += IXGBE_READ_REG(hw, IXGBE_MRFC);
1390         hw_stats->rlec += IXGBE_READ_REG(hw, IXGBE_RLEC);
1391
1392         /* Note that gprc counts missed packets */
1393         hw_stats->gprc += IXGBE_READ_REG(hw, IXGBE_GPRC);
1394
1395         if (hw->mac.type != ixgbe_mac_82598EB) {
1396                 hw_stats->gorc += IXGBE_READ_REG(hw, IXGBE_GORCL);
1397                 hw_stats->gorc += ((u64)IXGBE_READ_REG(hw, IXGBE_GORCH) << 32);
1398                 hw_stats->gotc += IXGBE_READ_REG(hw, IXGBE_GOTCL);
1399                 hw_stats->gotc += ((u64)IXGBE_READ_REG(hw, IXGBE_GOTCH) << 32);
1400                 hw_stats->tor += IXGBE_READ_REG(hw, IXGBE_TORL);
1401                 hw_stats->tor += ((u64)IXGBE_READ_REG(hw, IXGBE_TORH) << 32);
1402                 hw_stats->lxonrxc += IXGBE_READ_REG(hw, IXGBE_LXONRXCNT);
1403                 hw_stats->lxoffrxc += IXGBE_READ_REG(hw, IXGBE_LXOFFRXCNT);
1404         } else {
1405                 hw_stats->lxonrxc += IXGBE_READ_REG(hw, IXGBE_LXONRXC);
1406                 hw_stats->lxoffrxc += IXGBE_READ_REG(hw, IXGBE_LXOFFRXC);
1407                 /* 82598 only has a counter in the high register */
1408                 hw_stats->gorc += IXGBE_READ_REG(hw, IXGBE_GORCH);
1409                 hw_stats->gotc += IXGBE_READ_REG(hw, IXGBE_GOTCH);
1410                 hw_stats->tor += IXGBE_READ_REG(hw, IXGBE_TORH);
1411         }
1412
1413         /*
1414          * Workaround: mprc hardware is incorrectly counting
1415          * broadcasts, so for now we subtract those.
1416          */
1417         bprc = IXGBE_READ_REG(hw, IXGBE_BPRC);
1418         hw_stats->bprc += bprc;
1419         hw_stats->mprc += IXGBE_READ_REG(hw, IXGBE_MPRC);
1420         if (hw->mac.type == ixgbe_mac_82598EB)
1421                 hw_stats->mprc -= bprc;
1422
1423         hw_stats->prc64 += IXGBE_READ_REG(hw, IXGBE_PRC64);
1424         hw_stats->prc127 += IXGBE_READ_REG(hw, IXGBE_PRC127);
1425         hw_stats->prc255 += IXGBE_READ_REG(hw, IXGBE_PRC255);
1426         hw_stats->prc511 += IXGBE_READ_REG(hw, IXGBE_PRC511);
1427         hw_stats->prc1023 += IXGBE_READ_REG(hw, IXGBE_PRC1023);
1428         hw_stats->prc1522 += IXGBE_READ_REG(hw, IXGBE_PRC1522);
1429
1430         lxon = IXGBE_READ_REG(hw, IXGBE_LXONTXC);
1431         hw_stats->lxontxc += lxon;
1432         lxoff = IXGBE_READ_REG(hw, IXGBE_LXOFFTXC);
1433         hw_stats->lxofftxc += lxoff;
1434         total = lxon + lxoff;
1435
1436         hw_stats->gptc += IXGBE_READ_REG(hw, IXGBE_GPTC);
1437         hw_stats->mptc += IXGBE_READ_REG(hw, IXGBE_MPTC);
1438         hw_stats->ptc64 += IXGBE_READ_REG(hw, IXGBE_PTC64);
1439         hw_stats->gptc -= total;
1440         hw_stats->mptc -= total;
1441         hw_stats->ptc64 -= total;
1442         hw_stats->gotc -= total * ETHER_MIN_LEN;
1443
1444         hw_stats->ruc += IXGBE_READ_REG(hw, IXGBE_RUC);
1445         hw_stats->rfc += IXGBE_READ_REG(hw, IXGBE_RFC);
1446         hw_stats->roc += IXGBE_READ_REG(hw, IXGBE_ROC);
1447         hw_stats->rjc += IXGBE_READ_REG(hw, IXGBE_RJC);
1448         hw_stats->mngprc += IXGBE_READ_REG(hw, IXGBE_MNGPRC);
1449         hw_stats->mngpdc += IXGBE_READ_REG(hw, IXGBE_MNGPDC);
1450         hw_stats->mngptc += IXGBE_READ_REG(hw, IXGBE_MNGPTC);
1451         hw_stats->tpr += IXGBE_READ_REG(hw, IXGBE_TPR);
1452         hw_stats->tpt += IXGBE_READ_REG(hw, IXGBE_TPT);
1453         hw_stats->ptc127 += IXGBE_READ_REG(hw, IXGBE_PTC127);
1454         hw_stats->ptc255 += IXGBE_READ_REG(hw, IXGBE_PTC255);
1455         hw_stats->ptc511 += IXGBE_READ_REG(hw, IXGBE_PTC511);
1456         hw_stats->ptc1023 += IXGBE_READ_REG(hw, IXGBE_PTC1023);
1457         hw_stats->ptc1522 += IXGBE_READ_REG(hw, IXGBE_PTC1522);
1458         hw_stats->bptc += IXGBE_READ_REG(hw, IXGBE_BPTC);
1459         hw_stats->xec += IXGBE_READ_REG(hw, IXGBE_XEC);
1460         hw_stats->fccrc += IXGBE_READ_REG(hw, IXGBE_FCCRC);
1461         hw_stats->fclast += IXGBE_READ_REG(hw, IXGBE_FCLAST);
1462         /* Only read FCOE on 82599 */
1463         if (hw->mac.type != ixgbe_mac_82598EB) {
1464                 hw_stats->fcoerpdc += IXGBE_READ_REG(hw, IXGBE_FCOERPDC);
1465                 hw_stats->fcoeprc += IXGBE_READ_REG(hw, IXGBE_FCOEPRC);
1466                 hw_stats->fcoeptc += IXGBE_READ_REG(hw, IXGBE_FCOEPTC);
1467                 hw_stats->fcoedwrc += IXGBE_READ_REG(hw, IXGBE_FCOEDWRC);
1468                 hw_stats->fcoedwtc += IXGBE_READ_REG(hw, IXGBE_FCOEDWTC);
1469         }
1470
1471         if (stats == NULL)
1472                 return;
1473
1474         /* Fill out the rte_eth_stats statistics structure */
1475         stats->ipackets = total_qprc;
1476         stats->ibytes = total_qbrc;
1477         stats->opackets = hw_stats->gptc;
1478         stats->obytes = hw_stats->gotc;
1479         stats->imcasts = hw_stats->mprc;
1480
1481         for (i = 0; i < IXGBE_QUEUE_STAT_COUNTERS; i++) {
1482                 stats->q_ipackets[i] = hw_stats->qprc[i];
1483                 stats->q_opackets[i] = hw_stats->qptc[i];
1484                 stats->q_ibytes[i] = hw_stats->qbrc[i];
1485                 stats->q_obytes[i] = hw_stats->qbtc[i];
1486                 stats->q_errors[i] = hw_stats->qprdc[i];
1487         }
1488
1489         /* Rx Errors */
1490         stats->ierrors = total_missed_rx + hw_stats->crcerrs +
1491                 hw_stats->rlec;
1492
1493         stats->oerrors  = 0;
1494
1495         /* Flow Director Stats registers */
1496         hw_stats->fdirmatch += IXGBE_READ_REG(hw, IXGBE_FDIRMATCH);
1497         hw_stats->fdirmiss += IXGBE_READ_REG(hw, IXGBE_FDIRMISS);
1498         stats->fdirmatch = hw_stats->fdirmatch;
1499         stats->fdirmiss = hw_stats->fdirmiss;
1500 }
1501
1502 static void
1503 ixgbe_dev_stats_reset(struct rte_eth_dev *dev)
1504 {
1505         struct ixgbe_hw_stats *stats =
1506                         IXGBE_DEV_PRIVATE_TO_STATS(dev->data->dev_private);
1507
1508         /* HW registers are cleared on read */
1509         ixgbe_dev_stats_get(dev, NULL);
1510
1511         /* Reset software totals */
1512         memset(stats, 0, sizeof(*stats));
1513 }
1514
1515 static void
1516 ixgbevf_dev_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
1517 {
1518         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1519         struct ixgbevf_hw_stats *hw_stats = (struct ixgbevf_hw_stats*)
1520                           IXGBE_DEV_PRIVATE_TO_STATS(dev->data->dev_private);
1521
1522         /* Good Rx packet, include VF loopback */
1523         UPDATE_VF_STAT(IXGBE_VFGPRC,
1524             hw_stats->last_vfgprc, hw_stats->vfgprc);
1525
1526         /* Good Rx octets, include VF loopback */
1527         UPDATE_VF_STAT_36BIT(IXGBE_VFGORC_LSB, IXGBE_VFGORC_MSB,
1528             hw_stats->last_vfgorc, hw_stats->vfgorc);
1529
1530         /* Good Tx packet, include VF loopback */
1531         UPDATE_VF_STAT(IXGBE_VFGPTC,
1532             hw_stats->last_vfgptc, hw_stats->vfgptc);
1533
1534         /* Good Tx octets, include VF loopback */
1535         UPDATE_VF_STAT_36BIT(IXGBE_VFGOTC_LSB, IXGBE_VFGOTC_MSB,
1536             hw_stats->last_vfgotc, hw_stats->vfgotc);
1537
1538         /* Rx Multicst Packet */
1539         UPDATE_VF_STAT(IXGBE_VFMPRC,
1540             hw_stats->last_vfmprc, hw_stats->vfmprc);
1541
1542         if (stats == NULL)
1543                 return;
1544
1545         memset(stats, 0, sizeof(*stats));
1546         stats->ipackets = hw_stats->vfgprc;
1547         stats->ibytes = hw_stats->vfgorc;
1548         stats->opackets = hw_stats->vfgptc;
1549         stats->obytes = hw_stats->vfgotc;
1550         stats->imcasts = hw_stats->vfmprc;
1551 }
1552
1553 static void
1554 ixgbevf_dev_stats_reset(struct rte_eth_dev *dev)
1555 {
1556         struct ixgbevf_hw_stats *hw_stats = (struct ixgbevf_hw_stats*)
1557                         IXGBE_DEV_PRIVATE_TO_STATS(dev->data->dev_private);
1558
1559         /* Sync HW register to the last stats */
1560         ixgbevf_dev_stats_get(dev, NULL);
1561
1562         /* reset HW current stats*/
1563         hw_stats->vfgprc = 0;
1564         hw_stats->vfgorc = 0;
1565         hw_stats->vfgptc = 0;
1566         hw_stats->vfgotc = 0;
1567         hw_stats->vfmprc = 0;
1568
1569 }
1570
1571 static void
1572 ixgbe_dev_info_get(struct rte_eth_dev *dev, struct rte_eth_dev_info *dev_info)
1573 {
1574         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1575
1576         dev_info->max_rx_queues = (uint16_t)hw->mac.max_rx_queues;
1577         dev_info->max_tx_queues = (uint16_t)hw->mac.max_tx_queues;
1578         dev_info->min_rx_bufsize = 1024; /* cf BSIZEPACKET in SRRCTL register */
1579         dev_info->max_rx_pktlen = 15872; /* includes CRC, cf MAXFRS register */
1580         dev_info->max_mac_addrs = hw->mac.num_rar_entries;
1581 }
1582
1583 /* return 0 means link status changed, -1 means not changed */
1584 static int
1585 ixgbe_dev_link_update(struct rte_eth_dev *dev, int wait_to_complete)
1586 {
1587         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1588         struct rte_eth_link link, old;
1589         ixgbe_link_speed link_speed;
1590         int link_up;
1591         int diag;
1592
1593         link.link_status = 0;
1594         link.link_speed = 0;
1595         link.link_duplex = 0;
1596         memset(&old, 0, sizeof(old));
1597         rte_ixgbe_dev_atomic_read_link_status(dev, &old);
1598
1599         /* check if it needs to wait to complete, if lsc interrupt is enabled */
1600         if (wait_to_complete == 0 || dev->data->dev_conf.intr_conf.lsc != 0)
1601                 diag = ixgbe_check_link(hw, &link_speed, &link_up, 0);
1602         else
1603                 diag = ixgbe_check_link(hw, &link_speed, &link_up, 1);
1604         if (diag != 0) {
1605                 link.link_speed = ETH_LINK_SPEED_100;
1606                 link.link_duplex = ETH_LINK_HALF_DUPLEX;
1607                 rte_ixgbe_dev_atomic_write_link_status(dev, &link);
1608                 if (link.link_status == old.link_status)
1609                         return -1;
1610                 return 0;
1611         }
1612
1613         if (link_up == 0) {
1614                 rte_ixgbe_dev_atomic_write_link_status(dev, &link);
1615                 if (link.link_status == old.link_status)
1616                         return -1;
1617                 return 0;
1618         }
1619         link.link_status = 1;
1620         link.link_duplex = ETH_LINK_FULL_DUPLEX;
1621
1622         switch (link_speed) {
1623         default:
1624         case IXGBE_LINK_SPEED_UNKNOWN:
1625                 link.link_duplex = ETH_LINK_HALF_DUPLEX;
1626                 link.link_speed = ETH_LINK_SPEED_100;
1627                 break;
1628
1629         case IXGBE_LINK_SPEED_100_FULL:
1630                 link.link_speed = ETH_LINK_SPEED_100;
1631                 break;
1632
1633         case IXGBE_LINK_SPEED_1GB_FULL:
1634                 link.link_speed = ETH_LINK_SPEED_1000;
1635                 break;
1636
1637         case IXGBE_LINK_SPEED_10GB_FULL:
1638                 link.link_speed = ETH_LINK_SPEED_10000;
1639                 break;
1640         }
1641         rte_ixgbe_dev_atomic_write_link_status(dev, &link);
1642
1643         if (link.link_status == old.link_status)
1644                 return -1;
1645
1646         return 0;
1647 }
1648
1649 static void
1650 ixgbe_dev_promiscuous_enable(struct rte_eth_dev *dev)
1651 {
1652         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1653         uint32_t fctrl;
1654
1655         fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
1656         fctrl |= (IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
1657         IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
1658 }
1659
1660 static void
1661 ixgbe_dev_promiscuous_disable(struct rte_eth_dev *dev)
1662 {
1663         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1664         uint32_t fctrl;
1665
1666         fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
1667         fctrl &= (~IXGBE_FCTRL_UPE);
1668         if (dev->data->all_multicast == 1)
1669                 fctrl |= IXGBE_FCTRL_MPE;
1670         else
1671                 fctrl &= (~IXGBE_FCTRL_MPE);
1672         IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
1673 }
1674
1675 static void
1676 ixgbe_dev_allmulticast_enable(struct rte_eth_dev *dev)
1677 {
1678         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1679         uint32_t fctrl;
1680
1681         fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
1682         fctrl |= IXGBE_FCTRL_MPE;
1683         IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
1684 }
1685
1686 static void
1687 ixgbe_dev_allmulticast_disable(struct rte_eth_dev *dev)
1688 {
1689         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1690         uint32_t fctrl;
1691
1692         if (dev->data->promiscuous == 1)
1693                 return; /* must remain in all_multicast mode */
1694
1695         fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
1696         fctrl &= (~IXGBE_FCTRL_MPE);
1697         IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
1698 }
1699
1700 /**
1701  * It clears the interrupt causes and enables the interrupt.
1702  * It will be called once only during nic initialized.
1703  *
1704  * @param dev
1705  *  Pointer to struct rte_eth_dev.
1706  *
1707  * @return
1708  *  - On success, zero.
1709  *  - On failure, a negative value.
1710  */
1711 static int
1712 ixgbe_dev_lsc_interrupt_setup(struct rte_eth_dev *dev)
1713 {
1714         struct ixgbe_interrupt *intr =
1715                 IXGBE_DEV_PRIVATE_TO_INTR(dev->data->dev_private);
1716
1717         ixgbe_dev_link_status_print(dev);
1718         intr->mask |= IXGBE_EICR_LSC;
1719
1720         return 0;
1721 }
1722
1723 /*
1724  * It reads ICR and sets flag (IXGBE_EICR_LSC) for the link_update.
1725  *
1726  * @param dev
1727  *  Pointer to struct rte_eth_dev.
1728  *
1729  * @return
1730  *  - On success, zero.
1731  *  - On failure, a negative value.
1732  */
1733 static int
1734 ixgbe_dev_interrupt_get_status(struct rte_eth_dev *dev)
1735 {
1736         uint32_t eicr;
1737         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1738         struct ixgbe_interrupt *intr =
1739                 IXGBE_DEV_PRIVATE_TO_INTR(dev->data->dev_private);
1740
1741         /* clear all cause mask */
1742         ixgbe_disable_intr(hw);
1743
1744         /* read-on-clear nic registers here */
1745         eicr = IXGBE_READ_REG(hw, IXGBE_EICR);
1746         PMD_DRV_LOG(INFO, "eicr %x", eicr);
1747
1748         intr->flags = 0;
1749         if (eicr & IXGBE_EICR_LSC) {
1750                 /* set flag for async link update */
1751                 intr->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
1752         }
1753
1754         if (eicr & IXGBE_EICR_MAILBOX)
1755                 intr->flags |= IXGBE_FLAG_MAILBOX;
1756
1757         return 0;
1758 }
1759
1760 /**
1761  * It gets and then prints the link status.
1762  *
1763  * @param dev
1764  *  Pointer to struct rte_eth_dev.
1765  *
1766  * @return
1767  *  - On success, zero.
1768  *  - On failure, a negative value.
1769  */
1770 static void
1771 ixgbe_dev_link_status_print(struct rte_eth_dev *dev)
1772 {
1773         struct rte_eth_link link;
1774
1775         memset(&link, 0, sizeof(link));
1776         rte_ixgbe_dev_atomic_read_link_status(dev, &link);
1777         if (link.link_status) {
1778                 PMD_INIT_LOG(INFO, "Port %d: Link Up - speed %u Mbps - %s",
1779                                         (int)(dev->data->port_id),
1780                                         (unsigned)link.link_speed,
1781                         link.link_duplex == ETH_LINK_FULL_DUPLEX ?
1782                                         "full-duplex" : "half-duplex");
1783         } else {
1784                 PMD_INIT_LOG(INFO, " Port %d: Link Down",
1785                                 (int)(dev->data->port_id));
1786         }
1787         PMD_INIT_LOG(INFO, "PCI Address: %04d:%02d:%02d:%d",
1788                                 dev->pci_dev->addr.domain,
1789                                 dev->pci_dev->addr.bus,
1790                                 dev->pci_dev->addr.devid,
1791                                 dev->pci_dev->addr.function);
1792 }
1793
1794 /*
1795  * It executes link_update after knowing an interrupt occured.
1796  *
1797  * @param dev
1798  *  Pointer to struct rte_eth_dev.
1799  *
1800  * @return
1801  *  - On success, zero.
1802  *  - On failure, a negative value.
1803  */
1804 static int
1805 ixgbe_dev_interrupt_action(struct rte_eth_dev *dev)
1806 {
1807         struct ixgbe_interrupt *intr =
1808                 IXGBE_DEV_PRIVATE_TO_INTR(dev->data->dev_private);
1809         int64_t timeout;
1810         struct rte_eth_link link;
1811         int intr_enable_delay = false;
1812
1813         PMD_DRV_LOG(DEBUG, "intr action type %d\n", intr->flags);
1814
1815         if (intr->flags & IXGBE_FLAG_MAILBOX) {
1816                 ixgbe_pf_mbx_process(dev);
1817                 intr->flags &= ~IXGBE_FLAG_MAILBOX;
1818         }
1819
1820         if (intr->flags & IXGBE_FLAG_NEED_LINK_UPDATE) {
1821                 /* get the link status before link update, for predicting later */
1822                 memset(&link, 0, sizeof(link));
1823                 rte_ixgbe_dev_atomic_read_link_status(dev, &link);
1824
1825                 ixgbe_dev_link_update(dev, 0);
1826
1827                 /* likely to up */
1828                 if (!link.link_status)
1829                         /* handle it 1 sec later, wait it being stable */
1830                         timeout = IXGBE_LINK_UP_CHECK_TIMEOUT;
1831                 /* likely to down */
1832                 else
1833                         /* handle it 4 sec later, wait it being stable */
1834                         timeout = IXGBE_LINK_DOWN_CHECK_TIMEOUT;
1835
1836                 ixgbe_dev_link_status_print(dev);
1837
1838                 intr_enable_delay = true;
1839         }
1840
1841         if (intr_enable_delay) {
1842                 if (rte_eal_alarm_set(timeout * 1000,
1843                                       ixgbe_dev_interrupt_delayed_handler, (void*)dev) < 0)
1844                         PMD_DRV_LOG(ERR, "Error setting alarm");
1845         } else {
1846                 PMD_DRV_LOG(DEBUG, "enable intr immediately");
1847                 ixgbe_enable_intr(dev);
1848                 rte_intr_enable(&(dev->pci_dev->intr_handle));
1849         }
1850
1851
1852         return 0;
1853 }
1854
1855 /**
1856  * Interrupt handler which shall be registered for alarm callback for delayed
1857  * handling specific interrupt to wait for the stable nic state. As the
1858  * NIC interrupt state is not stable for ixgbe after link is just down,
1859  * it needs to wait 4 seconds to get the stable status.
1860  *
1861  * @param handle
1862  *  Pointer to interrupt handle.
1863  * @param param
1864  *  The address of parameter (struct rte_eth_dev *) regsitered before.
1865  *
1866  * @return
1867  *  void
1868  */
1869 static void
1870 ixgbe_dev_interrupt_delayed_handler(void *param)
1871 {
1872         struct rte_eth_dev *dev = (struct rte_eth_dev *)param;
1873         struct ixgbe_interrupt *intr =
1874                 IXGBE_DEV_PRIVATE_TO_INTR(dev->data->dev_private);
1875         struct ixgbe_hw *hw =
1876                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1877         uint32_t eicr;
1878
1879         eicr = IXGBE_READ_REG(hw, IXGBE_EICR);
1880         if (eicr & IXGBE_EICR_MAILBOX)
1881                 ixgbe_pf_mbx_process(dev);
1882
1883         if (intr->flags & IXGBE_FLAG_NEED_LINK_UPDATE) {
1884                 ixgbe_dev_link_update(dev, 0);
1885                 intr->flags &= ~IXGBE_FLAG_NEED_LINK_UPDATE;
1886                 ixgbe_dev_link_status_print(dev);
1887                 _rte_eth_dev_callback_process(dev, RTE_ETH_EVENT_INTR_LSC);
1888         }
1889
1890         PMD_DRV_LOG(DEBUG, "enable intr in delayed handler S[%08x]\n", eicr);
1891         ixgbe_enable_intr(dev);
1892         rte_intr_enable(&(dev->pci_dev->intr_handle));
1893 }
1894
1895 /**
1896  * Interrupt handler triggered by NIC  for handling
1897  * specific interrupt.
1898  *
1899  * @param handle
1900  *  Pointer to interrupt handle.
1901  * @param param
1902  *  The address of parameter (struct rte_eth_dev *) regsitered before.
1903  *
1904  * @return
1905  *  void
1906  */
1907 static void
1908 ixgbe_dev_interrupt_handler(__rte_unused struct rte_intr_handle *handle,
1909                                                         void *param)
1910 {
1911         struct rte_eth_dev *dev = (struct rte_eth_dev *)param;
1912         ixgbe_dev_interrupt_get_status(dev);
1913         ixgbe_dev_interrupt_action(dev);
1914 }
1915
1916 static int
1917 ixgbe_dev_led_on(struct rte_eth_dev *dev)
1918 {
1919         struct ixgbe_hw *hw;
1920
1921         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1922         return (ixgbe_led_on(hw, 0) == IXGBE_SUCCESS ? 0 : -ENOTSUP);
1923 }
1924
1925 static int
1926 ixgbe_dev_led_off(struct rte_eth_dev *dev)
1927 {
1928         struct ixgbe_hw *hw;
1929
1930         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1931         return (ixgbe_led_off(hw, 0) == IXGBE_SUCCESS ? 0 : -ENOTSUP);
1932 }
1933
1934 static int
1935 ixgbe_flow_ctrl_set(struct rte_eth_dev *dev, struct rte_eth_fc_conf *fc_conf)
1936 {
1937         struct ixgbe_hw *hw;
1938         int err;
1939         uint32_t rx_buf_size;
1940         uint32_t max_high_water;
1941         enum ixgbe_fc_mode rte_fcmode_2_ixgbe_fcmode[] = {
1942                 ixgbe_fc_none,
1943                 ixgbe_fc_rx_pause,
1944                 ixgbe_fc_tx_pause,
1945                 ixgbe_fc_full
1946         };
1947
1948         PMD_INIT_FUNC_TRACE();
1949
1950         hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
1951         rx_buf_size = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(0));
1952         PMD_INIT_LOG(DEBUG, "Rx packet buffer size = 0x%x \n", rx_buf_size);
1953
1954         /*
1955          * At least reserve one Ethernet frame for watermark
1956          * high_water/low_water in kilo bytes for ixgbe
1957          */
1958         max_high_water = (rx_buf_size - ETHER_MAX_LEN) >> IXGBE_RXPBSIZE_SHIFT;
1959         if ((fc_conf->high_water > max_high_water) ||
1960                 (fc_conf->high_water < fc_conf->low_water)) {
1961                 PMD_INIT_LOG(ERR, "Invalid high/low water setup value in KB\n");
1962                 PMD_INIT_LOG(ERR, "High_water must <=  0x%x\n", max_high_water);
1963                 return (-EINVAL);
1964         }
1965
1966         hw->fc.requested_mode = rte_fcmode_2_ixgbe_fcmode[fc_conf->mode];
1967         hw->fc.pause_time     = fc_conf->pause_time;
1968         hw->fc.high_water[0]  = fc_conf->high_water;
1969         hw->fc.low_water[0]   = fc_conf->low_water;
1970         hw->fc.send_xon       = fc_conf->send_xon;
1971
1972         err = ixgbe_fc_enable(hw);
1973         /* Not negotiated is not an error case */
1974         if ((err == IXGBE_SUCCESS) || (err == IXGBE_ERR_FC_NOT_NEGOTIATED)) {
1975                 return 0;
1976         }
1977
1978         PMD_INIT_LOG(ERR, "ixgbe_fc_enable = 0x%x \n", err);
1979         return -EIO;
1980 }
1981
1982 /**
1983  *  ixgbe_pfc_enable_generic - Enable flow control
1984  *  @hw: pointer to hardware structure
1985  *  @tc_num: traffic class number
1986  *  Enable flow control according to the current settings.
1987  */
1988 static int
1989 ixgbe_dcb_pfc_enable_generic(struct ixgbe_hw *hw,uint8_t tc_num)
1990 {
1991         int ret_val = 0;
1992         uint32_t mflcn_reg, fccfg_reg;
1993         uint32_t reg;
1994         uint32_t fcrtl, fcrth;
1995         uint8_t i;
1996         uint8_t nb_rx_en;
1997
1998         /* Validate the water mark configuration */
1999         if (!hw->fc.pause_time) {
2000                 ret_val = IXGBE_ERR_INVALID_LINK_SETTINGS;
2001                 goto out;
2002         }
2003
2004         /* Low water mark of zero causes XOFF floods */
2005         if (hw->fc.current_mode & ixgbe_fc_tx_pause) {
2006                  /* High/Low water can not be 0 */
2007                 if( (!hw->fc.high_water[tc_num])|| (!hw->fc.low_water[tc_num])) {
2008                         PMD_INIT_LOG(ERR,"Invalid water mark configuration\n");
2009                         ret_val = IXGBE_ERR_INVALID_LINK_SETTINGS;
2010                         goto out;
2011                 }
2012
2013                 if(hw->fc.low_water[tc_num] >= hw->fc.high_water[tc_num]) {
2014                         PMD_INIT_LOG(ERR,"Invalid water mark configuration\n");
2015                         ret_val = IXGBE_ERR_INVALID_LINK_SETTINGS;
2016                         goto out;
2017                 }
2018         }
2019         /* Negotiate the fc mode to use */
2020         ixgbe_fc_autoneg(hw);
2021
2022         /* Disable any previous flow control settings */
2023         mflcn_reg = IXGBE_READ_REG(hw, IXGBE_MFLCN);
2024         mflcn_reg &= ~(IXGBE_MFLCN_RPFCE_SHIFT | IXGBE_MFLCN_RFCE|IXGBE_MFLCN_RPFCE);
2025
2026         fccfg_reg = IXGBE_READ_REG(hw, IXGBE_FCCFG);
2027         fccfg_reg &= ~(IXGBE_FCCFG_TFCE_802_3X | IXGBE_FCCFG_TFCE_PRIORITY);
2028
2029         switch (hw->fc.current_mode) {
2030         case ixgbe_fc_none:
2031                 /*
2032                  * If the count of enabled RX Priority Flow control >1,
2033                  * and the TX pause can not be disabled
2034                  */
2035                 nb_rx_en = 0;
2036                 for (i =0; i < IXGBE_DCB_MAX_TRAFFIC_CLASS; i++) {
2037                         reg = IXGBE_READ_REG(hw, IXGBE_FCRTH_82599(i));
2038                         if (reg & IXGBE_FCRTH_FCEN)
2039                                 nb_rx_en++;
2040                 }
2041                 if (nb_rx_en > 1)
2042                         fccfg_reg |=IXGBE_FCCFG_TFCE_PRIORITY;
2043                 break;
2044         case ixgbe_fc_rx_pause:
2045                 /*
2046                  * Rx Flow control is enabled and Tx Flow control is
2047                  * disabled by software override. Since there really
2048                  * isn't a way to advertise that we are capable of RX
2049                  * Pause ONLY, we will advertise that we support both
2050                  * symmetric and asymmetric Rx PAUSE.  Later, we will
2051                  * disable the adapter's ability to send PAUSE frames.
2052                  */
2053                 mflcn_reg |= IXGBE_MFLCN_RPFCE;
2054                 /*
2055                  * If the count of enabled RX Priority Flow control >1,
2056                  * and the TX pause can not be disabled
2057                  */
2058                 nb_rx_en = 0;
2059                 for (i =0; i < IXGBE_DCB_MAX_TRAFFIC_CLASS; i++) {
2060                         reg = IXGBE_READ_REG(hw, IXGBE_FCRTH_82599(i));
2061                         if (reg & IXGBE_FCRTH_FCEN)
2062                                 nb_rx_en++;
2063                 }
2064                 if (nb_rx_en > 1)
2065                         fccfg_reg |=IXGBE_FCCFG_TFCE_PRIORITY;
2066                 break;
2067         case ixgbe_fc_tx_pause:
2068                 /*
2069                  * Tx Flow control is enabled, and Rx Flow control is
2070                  * disabled by software override.
2071                  */
2072                 fccfg_reg |=IXGBE_FCCFG_TFCE_PRIORITY;
2073                 break;
2074         case ixgbe_fc_full:
2075                 /* Flow control (both Rx and Tx) is enabled by SW override. */
2076                 mflcn_reg |= IXGBE_MFLCN_RPFCE;
2077                 fccfg_reg |= IXGBE_FCCFG_TFCE_PRIORITY;
2078                 break;
2079         default:
2080                 DEBUGOUT("Flow control param set incorrectly\n");
2081                 ret_val = IXGBE_ERR_CONFIG;
2082                 goto out;
2083                 break;
2084         }
2085
2086         /* Set 802.3x based flow control settings. */
2087         mflcn_reg |= IXGBE_MFLCN_DPF;
2088         IXGBE_WRITE_REG(hw, IXGBE_MFLCN, mflcn_reg);
2089         IXGBE_WRITE_REG(hw, IXGBE_FCCFG, fccfg_reg);
2090
2091         /* Set up and enable Rx high/low water mark thresholds, enable XON. */
2092         if ((hw->fc.current_mode & ixgbe_fc_tx_pause) &&
2093                 hw->fc.high_water[tc_num]) {
2094                 fcrtl = (hw->fc.low_water[tc_num] << 10) | IXGBE_FCRTL_XONE;
2095                 IXGBE_WRITE_REG(hw, IXGBE_FCRTL_82599(tc_num), fcrtl);
2096                 fcrth = (hw->fc.high_water[tc_num] << 10) | IXGBE_FCRTH_FCEN;
2097         } else {
2098                 IXGBE_WRITE_REG(hw, IXGBE_FCRTL_82599(tc_num), 0);
2099                 /*
2100                  * In order to prevent Tx hangs when the internal Tx
2101                  * switch is enabled we must set the high water mark
2102                  * to the maximum FCRTH value.  This allows the Tx
2103                  * switch to function even under heavy Rx workloads.
2104                  */
2105                 fcrth = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(tc_num)) - 32;
2106         }
2107         IXGBE_WRITE_REG(hw, IXGBE_FCRTH_82599(tc_num), fcrth);
2108
2109         /* Configure pause time (2 TCs per register) */
2110         reg = hw->fc.pause_time * 0x00010001;
2111         for (i = 0; i < (IXGBE_DCB_MAX_TRAFFIC_CLASS / 2); i++)
2112                 IXGBE_WRITE_REG(hw, IXGBE_FCTTV(i), reg);
2113
2114         /* Configure flow control refresh threshold value */
2115         IXGBE_WRITE_REG(hw, IXGBE_FCRTV, hw->fc.pause_time / 2);
2116
2117 out:
2118         return ret_val;
2119 }
2120
2121 static int
2122 ixgbe_dcb_pfc_enable(struct rte_eth_dev *dev,uint8_t tc_num)
2123 {
2124         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2125         int32_t ret_val = IXGBE_NOT_IMPLEMENTED;
2126
2127         if(hw->mac.type != ixgbe_mac_82598EB) {
2128                 ret_val = ixgbe_dcb_pfc_enable_generic(hw,tc_num);
2129         }
2130         return ret_val;
2131 }
2132
2133 static int
2134 ixgbe_priority_flow_ctrl_set(struct rte_eth_dev *dev, struct rte_eth_pfc_conf *pfc_conf)
2135 {
2136         int err;
2137         uint32_t rx_buf_size;
2138         uint32_t max_high_water;
2139         uint8_t tc_num;
2140         uint8_t  map[IXGBE_DCB_MAX_USER_PRIORITY] = { 0 };
2141         struct ixgbe_hw *hw =
2142                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2143         struct ixgbe_dcb_config *dcb_config =
2144                 IXGBE_DEV_PRIVATE_TO_DCB_CFG(dev->data->dev_private);
2145
2146         enum ixgbe_fc_mode rte_fcmode_2_ixgbe_fcmode[] = {
2147                 ixgbe_fc_none,
2148                 ixgbe_fc_rx_pause,
2149                 ixgbe_fc_tx_pause,
2150                 ixgbe_fc_full
2151         };
2152
2153         PMD_INIT_FUNC_TRACE();
2154
2155         ixgbe_dcb_unpack_map_cee(dcb_config, IXGBE_DCB_RX_CONFIG, map);
2156         tc_num = map[pfc_conf->priority];
2157         rx_buf_size = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(tc_num));
2158         PMD_INIT_LOG(DEBUG, "Rx packet buffer size = 0x%x \n", rx_buf_size);
2159         /*
2160          * At least reserve one Ethernet frame for watermark
2161          * high_water/low_water in kilo bytes for ixgbe
2162          */
2163         max_high_water = (rx_buf_size - ETHER_MAX_LEN) >> IXGBE_RXPBSIZE_SHIFT;
2164         if ((pfc_conf->fc.high_water > max_high_water) ||
2165                 (pfc_conf->fc.high_water <= pfc_conf->fc.low_water)) {
2166                 PMD_INIT_LOG(ERR, "Invalid high/low water setup value in KB\n");
2167                 PMD_INIT_LOG(ERR, "High_water must <=  0x%x\n", max_high_water);
2168                 return (-EINVAL);
2169         }
2170
2171         hw->fc.requested_mode = rte_fcmode_2_ixgbe_fcmode[pfc_conf->fc.mode];
2172         hw->fc.pause_time = pfc_conf->fc.pause_time;
2173         hw->fc.send_xon = pfc_conf->fc.send_xon;
2174         hw->fc.low_water[tc_num] =  pfc_conf->fc.low_water;
2175         hw->fc.high_water[tc_num] = pfc_conf->fc.high_water;
2176
2177         err = ixgbe_dcb_pfc_enable(dev,tc_num);
2178
2179         /* Not negotiated is not an error case */
2180         if ((err == IXGBE_SUCCESS) || (err == IXGBE_ERR_FC_NOT_NEGOTIATED))
2181                 return 0;
2182
2183         PMD_INIT_LOG(ERR, "ixgbe_dcb_pfc_enable = 0x%x \n", err);
2184         return -EIO;
2185 }
2186
2187 static int
2188 ixgbe_dev_rss_reta_update(struct rte_eth_dev *dev,
2189                                 struct rte_eth_rss_reta *reta_conf)
2190 {
2191         uint8_t i,j,mask;
2192         uint32_t reta;
2193         struct ixgbe_hw *hw =
2194                         IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2195
2196         PMD_INIT_FUNC_TRACE();
2197         /*
2198         * Update Redirection Table RETA[n],n=0...31,The redirection table has
2199         * 128-entries in 32 registers
2200          */
2201         for(i = 0; i < ETH_RSS_RETA_NUM_ENTRIES; i += 4) {
2202                 if (i < ETH_RSS_RETA_NUM_ENTRIES/2)
2203                         mask = (uint8_t)((reta_conf->mask_lo >> i) & 0xF);
2204                 else
2205                         mask = (uint8_t)((reta_conf->mask_hi >>
2206                                 (i - ETH_RSS_RETA_NUM_ENTRIES/2)) & 0xF);
2207                 if (mask != 0) {
2208                         reta = 0;
2209                         if (mask != 0xF)
2210                                 reta = IXGBE_READ_REG(hw,IXGBE_RETA(i >> 2));
2211
2212                         for (j = 0; j < 4; j++) {
2213                                 if (mask & (0x1 << j)) {
2214                                         if (mask != 0xF)
2215                                                 reta &= ~(0xFF << 8 * j);
2216                                         reta |= reta_conf->reta[i + j] << 8*j;
2217                                 }
2218                         }
2219                         IXGBE_WRITE_REG(hw, IXGBE_RETA(i >> 2),reta);
2220                 }
2221         }
2222
2223         return 0;
2224 }
2225
2226 static int
2227 ixgbe_dev_rss_reta_query(struct rte_eth_dev *dev,
2228                                 struct rte_eth_rss_reta *reta_conf)
2229 {
2230         uint8_t i,j,mask;
2231         uint32_t reta;
2232         struct ixgbe_hw *hw =
2233                         IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2234
2235         PMD_INIT_FUNC_TRACE();
2236         /*
2237          * Read Redirection Table RETA[n],n=0...31,The redirection table has
2238          * 128-entries in 32 registers
2239          */
2240         for(i = 0; i < ETH_RSS_RETA_NUM_ENTRIES; i += 4) {
2241                 if (i < ETH_RSS_RETA_NUM_ENTRIES/2)
2242                         mask = (uint8_t)((reta_conf->mask_lo >> i) & 0xF);
2243                 else
2244                         mask = (uint8_t)((reta_conf->mask_hi >>
2245                                 (i - ETH_RSS_RETA_NUM_ENTRIES/2)) & 0xF);
2246
2247                 if (mask != 0) {
2248                         reta = IXGBE_READ_REG(hw,IXGBE_RETA(i >> 2));
2249                         for (j = 0; j < 4; j++) {
2250                                 if (mask & (0x1 << j))
2251                                         reta_conf->reta[i + j] =
2252                                                 (uint8_t)((reta >> 8 * j) & 0xFF);
2253                         }
2254                 }
2255         }
2256
2257         return 0;
2258 }
2259
2260 static void
2261 ixgbe_add_rar(struct rte_eth_dev *dev, struct ether_addr *mac_addr,
2262                                 uint32_t index, uint32_t pool)
2263 {
2264         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2265         uint32_t enable_addr = 1;
2266
2267         ixgbe_set_rar(hw, index, mac_addr->addr_bytes, pool, enable_addr);
2268 }
2269
2270 static void
2271 ixgbe_remove_rar(struct rte_eth_dev *dev, uint32_t index)
2272 {
2273         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2274
2275         ixgbe_clear_rar(hw, index);
2276 }
2277
2278 /*
2279  * Virtual Function operations
2280  */
2281 static void
2282 ixgbevf_intr_disable(struct ixgbe_hw *hw)
2283 {
2284         PMD_INIT_LOG(DEBUG, "ixgbevf_intr_disable");
2285
2286         /* Clear interrupt mask to stop from interrupts being generated */
2287         IXGBE_WRITE_REG(hw, IXGBE_VTEIMC, IXGBE_VF_IRQ_CLEAR_MASK);
2288
2289         IXGBE_WRITE_FLUSH(hw);
2290 }
2291
2292 static int
2293 ixgbevf_dev_configure(struct rte_eth_dev *dev)
2294 {
2295         struct rte_eth_conf* conf = &dev->data->dev_conf;
2296
2297         PMD_INIT_LOG(DEBUG, "\nConfigured Virtual Function port id: %d\n",
2298                 dev->data->port_id);
2299
2300         /*
2301          * VF has no ability to enable/disable HW CRC
2302          * Keep the persistent behavior the same as Host PF
2303          */
2304 #ifndef RTE_LIBRTE_IXGBE_PF_DISABLE_STRIP_CRC
2305         if (!conf->rxmode.hw_strip_crc) {
2306                 PMD_INIT_LOG(INFO, "VF can't disable HW CRC Strip\n");
2307                 conf->rxmode.hw_strip_crc = 1;
2308         }
2309 #else
2310         if (conf->rxmode.hw_strip_crc) {
2311                 PMD_INIT_LOG(INFO, "VF can't enable HW CRC Strip\n");
2312                 conf->rxmode.hw_strip_crc = 0;
2313         }
2314 #endif
2315
2316         return 0;
2317 }
2318
2319 static int
2320 ixgbevf_dev_start(struct rte_eth_dev *dev)
2321 {
2322         struct ixgbe_hw *hw =
2323                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2324         int err, mask = 0;
2325
2326         PMD_INIT_LOG(DEBUG, "ixgbevf_dev_start");
2327
2328         hw->mac.ops.reset_hw(hw);
2329
2330         ixgbevf_dev_tx_init(dev);
2331
2332         /* This can fail when allocating mbufs for descriptor rings */
2333         err = ixgbevf_dev_rx_init(dev);
2334         if (err) {
2335                 PMD_INIT_LOG(ERR, "Unable to initialize RX hardware (%d)\n", err);
2336                 ixgbe_dev_clear_queues(dev);
2337                 return err;
2338         }
2339
2340         /* Set vfta */
2341         ixgbevf_set_vfta_all(dev,1);
2342
2343         /* Set HW strip */
2344         mask = ETH_VLAN_STRIP_MASK | ETH_VLAN_FILTER_MASK | \
2345                 ETH_VLAN_EXTEND_MASK;
2346         ixgbevf_vlan_offload_set(dev, mask);
2347
2348         ixgbevf_dev_rxtx_start(dev);
2349
2350         return 0;
2351 }
2352
2353 static void
2354 ixgbevf_dev_stop(struct rte_eth_dev *dev)
2355 {
2356         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2357
2358         PMD_INIT_LOG(DEBUG, "ixgbevf_dev_stop");
2359
2360         hw->adapter_stopped = TRUE;
2361         ixgbe_stop_adapter(hw);
2362
2363         /*
2364           * Clear what we set, but we still keep shadow_vfta to
2365           * restore after device starts
2366           */
2367         ixgbevf_set_vfta_all(dev,0);
2368
2369         ixgbe_dev_clear_queues(dev);
2370 }
2371
2372 static void
2373 ixgbevf_dev_close(struct rte_eth_dev *dev)
2374 {
2375         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2376
2377         PMD_INIT_LOG(DEBUG, "ixgbevf_dev_close");
2378
2379         ixgbe_reset_hw(hw);
2380
2381         ixgbevf_dev_stop(dev);
2382
2383         /* reprogram the RAR[0] in case user changed it. */
2384         ixgbe_set_rar(hw, 0, hw->mac.addr, 0, IXGBE_RAH_AV);
2385 }
2386
2387 static void ixgbevf_set_vfta_all(struct rte_eth_dev *dev, bool on)
2388 {
2389         struct ixgbe_hw *hw = IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2390         struct ixgbe_vfta * shadow_vfta =
2391                 IXGBE_DEV_PRIVATE_TO_VFTA(dev->data->dev_private);
2392         int i = 0, j = 0, vfta = 0, mask = 1;
2393
2394         for (i = 0; i < IXGBE_VFTA_SIZE; i++){
2395                 vfta = shadow_vfta->vfta[i];
2396                 if(vfta){
2397                         mask = 1;
2398                         for (j = 0; j < 32; j++){
2399                                 if(vfta & mask)
2400                                         ixgbe_set_vfta(hw, (i<<5)+j, 0, on);
2401                                 mask<<=1;
2402                         }
2403                 }
2404         }
2405
2406 }
2407
2408 static int
2409 ixgbevf_vlan_filter_set(struct rte_eth_dev *dev, uint16_t vlan_id, int on)
2410 {
2411         struct ixgbe_hw *hw =
2412                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2413         struct ixgbe_vfta * shadow_vfta =
2414                 IXGBE_DEV_PRIVATE_TO_VFTA(dev->data->dev_private);
2415         uint32_t vid_idx = 0;
2416         uint32_t vid_bit = 0;
2417         int ret = 0;
2418
2419         PMD_INIT_FUNC_TRACE();
2420
2421         /* vind is not used in VF driver, set to 0, check ixgbe_set_vfta_vf */
2422         ret = ixgbe_set_vfta(hw, vlan_id, 0, !!on);
2423         if(ret){
2424                 PMD_INIT_LOG(ERR, "Unable to set VF vlan");
2425                 return ret;
2426         }
2427         vid_idx = (uint32_t) ((vlan_id >> 5) & 0x7F);
2428         vid_bit = (uint32_t) (1 << (vlan_id & 0x1F));
2429
2430         /* Save what we set and retore it after device reset */
2431         if (on)
2432                 shadow_vfta->vfta[vid_idx] |= vid_bit;
2433         else
2434                 shadow_vfta->vfta[vid_idx] &= ~vid_bit;
2435
2436         return 0;
2437 }
2438
2439 static void
2440 ixgbevf_vlan_strip_queue_set(struct rte_eth_dev *dev, uint16_t queue, int on)
2441 {
2442         struct ixgbe_hw *hw =
2443                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2444         uint32_t ctrl;
2445
2446         PMD_INIT_FUNC_TRACE();
2447
2448         if(queue >= hw->mac.max_rx_queues)
2449                 return;
2450
2451         ctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(queue));
2452         if(on)
2453                 ctrl |= IXGBE_RXDCTL_VME;
2454         else
2455                 ctrl &= ~IXGBE_RXDCTL_VME;
2456         IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(queue), ctrl);
2457
2458         ixgbe_vlan_hw_strip_bitmap_set( dev, queue, on);
2459 }
2460
2461 static void
2462 ixgbevf_vlan_offload_set(struct rte_eth_dev *dev, int mask)
2463 {
2464         struct ixgbe_hw *hw =
2465                 IXGBE_DEV_PRIVATE_TO_HW(dev->data->dev_private);
2466         uint16_t i;
2467         int on = 0;
2468
2469         /* VF function only support hw strip feature, others are not support */
2470         if(mask & ETH_VLAN_STRIP_MASK){
2471                 on = !!(dev->data->dev_conf.rxmode.hw_vlan_strip);
2472
2473                 for(i=0; i < hw->mac.max_rx_queues; i++)
2474                         ixgbevf_vlan_strip_queue_set(dev,i,on);
2475         }
2476 }