drivers/net/ixgbevf/ethtool.c

   1 /*******************************************************************************
   2
   3   Intel 82599 Virtual Function driver
   4   Copyright(c) 1999 - 2009 Intel Corporation.
   5
   6   This program is free software; you can redistribute it and/or modify it
   7   under the terms and conditions of the GNU General Public License,
   8   version 2, as published by the Free Software Foundation.
   9
  10   This program is distributed in the hope it will be useful, but WITHOUT
  11   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  12   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  13   more details.
  14
  15   You should have received a copy of the GNU General Public License along with
  16   this program; if not, write to the Free Software Foundation, Inc.,
  17   51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  18
  19   The full GNU General Public License is included in this distribution in
  20   the file called "COPYING".
  21
  22   Contact Information:
  23   e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
  24   Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  25
  26 *******************************************************************************/
  27
  28 /* ethtool support for ixgbevf */
  29
  30 #include <linux/types.h>
  31 #include <linux/module.h>
  32 #include <linux/pci.h>
  33 #include <linux/netdevice.h>
  34 #include <linux/ethtool.h>
  35 #include <linux/vmalloc.h>
  36 #include <linux/if_vlan.h>
  37 #include <linux/uaccess.h>
  38
  39 #include "ixgbevf.h"
  40
  41 #define IXGBE_ALL_RAR_ENTRIES 16
  42
  43 #ifdef ETHTOOL_GSTATS
  44 struct ixgbe_stats {
  45         char stat_string[ETH_GSTRING_LEN];
  46         int sizeof_stat;
  47         int stat_offset;
  48         int base_stat_offset;
  49 };
  50
  51 #define IXGBEVF_STAT(m, b)  sizeof(((struct ixgbevf_adapter *)0)->m), \
  52                             offsetof(struct ixgbevf_adapter, m),      \
  53                             offsetof(struct ixgbevf_adapter, b)
  54 static struct ixgbe_stats ixgbe_gstrings_stats[] = {
  55         {"rx_packets", IXGBEVF_STAT(stats.vfgprc, stats.base_vfgprc)},
  56         {"tx_packets", IXGBEVF_STAT(stats.vfgptc, stats.base_vfgptc)},
  57         {"rx_bytes", IXGBEVF_STAT(stats.vfgorc, stats.base_vfgorc)},
  58         {"tx_bytes", IXGBEVF_STAT(stats.vfgotc, stats.base_vfgotc)},
  59         {"tx_busy", IXGBEVF_STAT(tx_busy, zero_base)},
  60         {"multicast", IXGBEVF_STAT(stats.vfmprc, stats.base_vfmprc)},
  61         {"rx_csum_offload_good", IXGBEVF_STAT(hw_csum_rx_good, zero_base)},
  62         {"rx_csum_offload_errors", IXGBEVF_STAT(hw_csum_rx_error, zero_base)},
  63         {"tx_csum_offload_ctxt", IXGBEVF_STAT(hw_csum_tx_good, zero_base)},
  64         {"rx_header_split", IXGBEVF_STAT(rx_hdr_split, zero_base)},
  65 };
  66
  67 #define IXGBE_QUEUE_STATS_LEN 0
  68 #define IXGBE_GLOBAL_STATS_LEN  ARRAY_SIZE(ixgbe_gstrings_stats)
  69
  70 #define IXGBEVF_STATS_LEN (IXGBE_GLOBAL_STATS_LEN + IXGBE_QUEUE_STATS_LEN)
  71 #endif /* ETHTOOL_GSTATS */
  72 #ifdef ETHTOOL_TEST
  73 static const char ixgbe_gstrings_test[][ETH_GSTRING_LEN] = {
  74         "Register test  (offline)",
  75         "Link test   (on/offline)"
  76 };
  77 #define IXGBE_TEST_LEN (sizeof(ixgbe_gstrings_test) / ETH_GSTRING_LEN)
  78 #endif /* ETHTOOL_TEST */
  79
  80 static int ixgbevf_get_settings(struct net_device *netdev,
  81                                 struct ethtool_cmd *ecmd)
  82 {
  83         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
  84         struct ixgbe_hw *hw = &adapter->hw;
  85         u32 link_speed = 0;
  86         bool link_up;
  87
  88         ecmd->supported = SUPPORTED_10000baseT_Full;
  89         ecmd->autoneg = AUTONEG_DISABLE;
  90         ecmd->transceiver = XCVR_DUMMY1;
  91         ecmd->port = -1;
  92
  93         hw->mac.ops.check_link(hw, &link_speed, &link_up, false);
  94
  95         if (link_up) {
  96                 ecmd->speed = (link_speed == IXGBE_LINK_SPEED_10GB_FULL) ?
  97                                SPEED_10000 : SPEED_1000;
  98                 ecmd->duplex = DUPLEX_FULL;
  99         } else {
 100                 ecmd->speed = -1;
 101                 ecmd->duplex = -1;
 102         }
 103
 104         return 0;
 105 }
 106
 107 static u32 ixgbevf_get_rx_csum(struct net_device *netdev)
 108 {
 109         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 110         return adapter->flags & IXGBE_FLAG_RX_CSUM_ENABLED;
 111 }
 112
 113 static int ixgbevf_set_rx_csum(struct net_device *netdev, u32 data)
 114 {
 115         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 116         if (data)
 117                 adapter->flags |= IXGBE_FLAG_RX_CSUM_ENABLED;
 118         else
 119                 adapter->flags &= ~IXGBE_FLAG_RX_CSUM_ENABLED;
 120
 121         if (netif_running(netdev)) {
 122                 if (!adapter->dev_closed)
 123                         ixgbevf_reinit_locked(adapter);
 124         } else {
 125                 ixgbevf_reset(adapter);
 126         }
 127
 128         return 0;
 129 }
 130
 131 static int ixgbevf_set_tso(struct net_device *netdev, u32 data)
 132 {
 133         if (data) {
 134                 netdev->features |= NETIF_F_TSO;
 135                 netdev->features |= NETIF_F_TSO6;
 136         } else {
 137                 netif_tx_stop_all_queues(netdev);
 138                 netdev->features &= ~NETIF_F_TSO;
 139                 netdev->features &= ~NETIF_F_TSO6;
 140                 netif_tx_start_all_queues(netdev);
 141         }
 142         return 0;
 143 }
 144
 145 static u32 ixgbevf_get_msglevel(struct net_device *netdev)
 146 {
 147         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 148         return adapter->msg_enable;
 149 }
 150
 151 static void ixgbevf_set_msglevel(struct net_device *netdev, u32 data)
 152 {
 153         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 154         adapter->msg_enable = data;
 155 }
 156
 157 #define IXGBE_GET_STAT(_A_, _R_) (_A_->stats._R_)
 158
 159 static char *ixgbevf_reg_names[] = {
 160         "IXGBE_VFCTRL",
 161         "IXGBE_VFSTATUS",
 162         "IXGBE_VFLINKS",
 163         "IXGBE_VFRXMEMWRAP",
 164         "IXGBE_VFRTIMER",
 165         "IXGBE_VTEICR",
 166         "IXGBE_VTEICS",
 167         "IXGBE_VTEIMS",
 168         "IXGBE_VTEIMC",
 169         "IXGBE_VTEIAC",
 170         "IXGBE_VTEIAM",
 171         "IXGBE_VTEITR",
 172         "IXGBE_VTIVAR",
 173         "IXGBE_VTIVAR_MISC",
 174         "IXGBE_VFRDBAL0",
 175         "IXGBE_VFRDBAL1",
 176         "IXGBE_VFRDBAH0",
 177         "IXGBE_VFRDBAH1",
 178         "IXGBE_VFRDLEN0",
 179         "IXGBE_VFRDLEN1",
 180         "IXGBE_VFRDH0",
 181         "IXGBE_VFRDH1",
 182         "IXGBE_VFRDT0",
 183         "IXGBE_VFRDT1",
 184         "IXGBE_VFRXDCTL0",
 185         "IXGBE_VFRXDCTL1",
 186         "IXGBE_VFSRRCTL0",
 187         "IXGBE_VFSRRCTL1",
 188         "IXGBE_VFPSRTYPE",
 189         "IXGBE_VFTDBAL0",
 190         "IXGBE_VFTDBAL1",
 191         "IXGBE_VFTDBAH0",
 192         "IXGBE_VFTDBAH1",
 193         "IXGBE_VFTDLEN0",
 194         "IXGBE_VFTDLEN1",
 195         "IXGBE_VFTDH0",
 196         "IXGBE_VFTDH1",
 197         "IXGBE_VFTDT0",
 198         "IXGBE_VFTDT1",
 199         "IXGBE_VFTXDCTL0",
 200         "IXGBE_VFTXDCTL1",
 201         "IXGBE_VFTDWBAL0",
 202         "IXGBE_VFTDWBAL1",
 203         "IXGBE_VFTDWBAH0",
 204         "IXGBE_VFTDWBAH1"
 205 };
 206
 207
 208 static int ixgbevf_get_regs_len(struct net_device *netdev)
 209 {
 210         return (ARRAY_SIZE(ixgbevf_reg_names)) * sizeof(u32);
 211 }
 212
 213 static void ixgbevf_get_regs(struct net_device *netdev,
 214                              struct ethtool_regs *regs,
 215                              void *p)
 216 {
 217         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 218         struct ixgbe_hw *hw = &adapter->hw;
 219         u32 *regs_buff = p;
 220         u32 regs_len = ixgbevf_get_regs_len(netdev);
 221         u8 i;
 222
 223         memset(p, 0, regs_len);
 224
 225         regs->version = (1 << 24) | hw->revision_id << 16 | hw->device_id;
 226
 227         /* General Registers */
 228         regs_buff[0] = IXGBE_READ_REG(hw, IXGBE_VFCTRL);
 229         regs_buff[1] = IXGBE_READ_REG(hw, IXGBE_VFSTATUS);
 230         regs_buff[2] = IXGBE_READ_REG(hw, IXGBE_VFLINKS);
 231         regs_buff[3] = IXGBE_READ_REG(hw, IXGBE_VFRXMEMWRAP);
 232         regs_buff[4] = IXGBE_READ_REG(hw, IXGBE_VFRTIMER);
 233
 234         /* Interrupt */
 235         /* don't read EICR because it can clear interrupt causes, instead
 236          * read EICS which is a shadow but doesn't clear EICR */
 237         regs_buff[5] = IXGBE_READ_REG(hw, IXGBE_VTEICS);
 238         regs_buff[6] = IXGBE_READ_REG(hw, IXGBE_VTEICS);
 239         regs_buff[7] = IXGBE_READ_REG(hw, IXGBE_VTEIMS);
 240         regs_buff[8] = IXGBE_READ_REG(hw, IXGBE_VTEIMC);
 241         regs_buff[9] = IXGBE_READ_REG(hw, IXGBE_VTEIAC);
 242         regs_buff[10] = IXGBE_READ_REG(hw, IXGBE_VTEIAM);
 243         regs_buff[11] = IXGBE_READ_REG(hw, IXGBE_VTEITR(0));
 244         regs_buff[12] = IXGBE_READ_REG(hw, IXGBE_VTIVAR(0));
 245         regs_buff[13] = IXGBE_READ_REG(hw, IXGBE_VTIVAR_MISC);
 246
 247         /* Receive DMA */
 248         for (i = 0; i < 2; i++)
 249                 regs_buff[14 + i] = IXGBE_READ_REG(hw, IXGBE_VFRDBAL(i));
 250         for (i = 0; i < 2; i++)
 251                 regs_buff[16 + i] = IXGBE_READ_REG(hw, IXGBE_VFRDBAH(i));
 252         for (i = 0; i < 2; i++)
 253                 regs_buff[18 + i] = IXGBE_READ_REG(hw, IXGBE_VFRDLEN(i));
 254         for (i = 0; i < 2; i++)
 255                 regs_buff[20 + i] = IXGBE_READ_REG(hw, IXGBE_VFRDH(i));
 256         for (i = 0; i < 2; i++)
 257                 regs_buff[22 + i] = IXGBE_READ_REG(hw, IXGBE_VFRDT(i));
 258         for (i = 0; i < 2; i++)
 259                 regs_buff[24 + i] = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(i));
 260         for (i = 0; i < 2; i++)
 261                 regs_buff[26 + i] = IXGBE_READ_REG(hw, IXGBE_VFSRRCTL(i));
 262
 263         /* Receive */
 264         regs_buff[28] = IXGBE_READ_REG(hw, IXGBE_VFPSRTYPE);
 265
 266         /* Transmit */
 267         for (i = 0; i < 2; i++)
 268                 regs_buff[29 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDBAL(i));
 269         for (i = 0; i < 2; i++)
 270                 regs_buff[31 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDBAH(i));
 271         for (i = 0; i < 2; i++)
 272                 regs_buff[33 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDLEN(i));
 273         for (i = 0; i < 2; i++)
 274                 regs_buff[35 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDH(i));
 275         for (i = 0; i < 2; i++)
 276                 regs_buff[37 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDT(i));
 277         for (i = 0; i < 2; i++)
 278                 regs_buff[39 + i] = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(i));
 279         for (i = 0; i < 2; i++)
 280                 regs_buff[41 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDWBAL(i));
 281         for (i = 0; i < 2; i++)
 282                 regs_buff[43 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDWBAH(i));
 283
 284         for (i = 0; i < ARRAY_SIZE(ixgbevf_reg_names); i++)
 285                 hw_dbg(hw, "%s\t%8.8x\n", ixgbevf_reg_names[i], regs_buff[i]);
 286 }
 287
 288 static void ixgbevf_get_drvinfo(struct net_device *netdev,
 289                                 struct ethtool_drvinfo *drvinfo)
 290 {
 291         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 292
 293         strlcpy(drvinfo->driver, ixgbevf_driver_name, 32);
 294         strlcpy(drvinfo->version, ixgbevf_driver_version, 32);
 295
 296         strlcpy(drvinfo->fw_version, "N/A", 4);
 297         strlcpy(drvinfo->bus_info, pci_name(adapter->pdev), 32);
 298 }
 299
 300 static void ixgbevf_get_ringparam(struct net_device *netdev,
 301                                   struct ethtool_ringparam *ring)
 302 {
 303         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 304         struct ixgbevf_ring *tx_ring = adapter->tx_ring;
 305         struct ixgbevf_ring *rx_ring = adapter->rx_ring;
 306
 307         ring->rx_max_pending = IXGBEVF_MAX_RXD;
 308         ring->tx_max_pending = IXGBEVF_MAX_TXD;
 309         ring->rx_mini_max_pending = 0;
 310         ring->rx_jumbo_max_pending = 0;
 311         ring->rx_pending = rx_ring->count;
 312         ring->tx_pending = tx_ring->count;
 313         ring->rx_mini_pending = 0;
 314         ring->rx_jumbo_pending = 0;
 315 }
 316
 317 static int ixgbevf_set_ringparam(struct net_device *netdev,
 318                                  struct ethtool_ringparam *ring)
 319 {
 320         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 321         struct ixgbevf_ring *tx_ring = NULL, *rx_ring = NULL;
 322         int i, err;
 323         u32 new_rx_count, new_tx_count;
 324         bool need_tx_update = false;
 325         bool need_rx_update = false;
 326
 327         if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending))
 328                 return -EINVAL;
 329
 330         new_rx_count = max(ring->rx_pending, (u32)IXGBEVF_MIN_RXD);
 331         new_rx_count = min(new_rx_count, (u32)IXGBEVF_MAX_RXD);
 332         new_rx_count = ALIGN(new_rx_count, IXGBE_REQ_RX_DESCRIPTOR_MULTIPLE);
 333
 334         new_tx_count = max(ring->tx_pending, (u32)IXGBEVF_MIN_TXD);
 335         new_tx_count = min(new_tx_count, (u32)IXGBEVF_MAX_TXD);
 336         new_tx_count = ALIGN(new_tx_count, IXGBE_REQ_TX_DESCRIPTOR_MULTIPLE);
 337
 338         if ((new_tx_count == adapter->tx_ring->count) &&
 339             (new_rx_count == adapter->rx_ring->count)) {
 340                 /* nothing to do */
 341                 return 0;
 342         }
 343
 344         while (test_and_set_bit(__IXGBEVF_RESETTING, &adapter->state))
 345                 msleep(1);
 346
 347         if (new_tx_count != adapter->tx_ring_count) {
 348                 tx_ring = kcalloc(adapter->num_tx_queues,
 349                                   sizeof(struct ixgbevf_ring), GFP_KERNEL);
 350                 if (!tx_ring) {
 351                         err = -ENOMEM;
 352                         goto err_setup;
 353                 }
 354                 memcpy(tx_ring, adapter->tx_ring,
 355                        adapter->num_tx_queues * sizeof(struct ixgbevf_ring));
 356                 for (i = 0; i < adapter->num_tx_queues; i++) {
 357                         tx_ring[i].count = new_tx_count;
 358                         err = ixgbevf_setup_tx_resources(adapter,
 359                                                          &tx_ring[i]);
 360                         if (err) {
 361                                 while (i) {
 362                                         i--;
 363                                         ixgbevf_free_tx_resources(adapter,
 364                                                                   &tx_ring[i]);
 365                                 }
 366                                 kfree(tx_ring);
 367                                 goto err_setup;
 368                         }
 369                         tx_ring[i].v_idx = adapter->tx_ring[i].v_idx;
 370                 }
 371                 need_tx_update = true;
 372         }
 373
 374         if (new_rx_count != adapter->rx_ring_count) {
 375                 rx_ring = kcalloc(adapter->num_rx_queues,
 376                                   sizeof(struct ixgbevf_ring), GFP_KERNEL);
 377                 if ((!rx_ring) && (need_tx_update)) {
 378                         err = -ENOMEM;
 379                         goto err_rx_setup;
 380                 }
 381                 memcpy(rx_ring, adapter->rx_ring,
 382                        adapter->num_rx_queues * sizeof(struct ixgbevf_ring));
 383                 for (i = 0; i < adapter->num_rx_queues; i++) {
 384                         rx_ring[i].count = new_rx_count;
 385                         err = ixgbevf_setup_rx_resources(adapter,
 386                                                          &rx_ring[i]);
 387                         if (err) {
 388                                 while (i) {
 389                                         i--;
 390                                         ixgbevf_free_rx_resources(adapter,
 391                                                                   &rx_ring[i]);
 392                                 }
 393                                 kfree(rx_ring);
 394                                 goto err_rx_setup;
 395                         }
 396                         rx_ring[i].v_idx = adapter->rx_ring[i].v_idx;
 397                 }
 398                 need_rx_update = true;
 399         }
 400
 401 err_rx_setup:
 402         /* if rings need to be updated, here's the place to do it in one shot */
 403         if (need_tx_update || need_rx_update) {
 404                 if (netif_running(netdev))
 405                         ixgbevf_down(adapter);
 406         }
 407
 408         /* tx */
 409         if (need_tx_update) {
 410                 kfree(adapter->tx_ring);
 411                 adapter->tx_ring = tx_ring;
 412                 tx_ring = NULL;
 413                 adapter->tx_ring_count = new_tx_count;
 414         }
 415
 416         /* rx */
 417         if (need_rx_update) {
 418                 kfree(adapter->rx_ring);
 419                 adapter->rx_ring = rx_ring;
 420                 rx_ring = NULL;
 421                 adapter->rx_ring_count = new_rx_count;
 422         }
 423
 424         /* success! */
 425         err = 0;
 426         if (netif_running(netdev))
 427                 ixgbevf_up(adapter);
 428
 429 err_setup:
 430         clear_bit(__IXGBEVF_RESETTING, &adapter->state);
 431         return err;
 432 }
 433
 434 static int ixgbevf_get_sset_count(struct net_device *dev, int stringset)
 435 {
 436        switch (stringset) {
 437        case ETH_SS_TEST:
 438                return IXGBE_TEST_LEN;
 439        case ETH_SS_STATS:
 440                return IXGBE_GLOBAL_STATS_LEN;
 441        default:
 442                return -EINVAL;
 443        }
 444 }
 445
 446 static void ixgbevf_get_ethtool_stats(struct net_device *netdev,
 447                                       struct ethtool_stats *stats, u64 *data)
 448 {
 449         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 450         int i;
 451
 452         ixgbevf_update_stats(adapter);
 453         for (i = 0; i < IXGBE_GLOBAL_STATS_LEN; i++) {
 454                 char *p = (char *)adapter +
 455                         ixgbe_gstrings_stats[i].stat_offset;
 456                 char *b = (char *)adapter +
 457                         ixgbe_gstrings_stats[i].base_stat_offset;
 458                 data[i] = ((ixgbe_gstrings_stats[i].sizeof_stat ==
 459                             sizeof(u64)) ? *(u64 *)p : *(u32 *)p) -
 460                           ((ixgbe_gstrings_stats[i].sizeof_stat ==
 461                             sizeof(u64)) ? *(u64 *)b : *(u32 *)b);
 462         }
 463 }
 464
 465 static void ixgbevf_get_strings(struct net_device *netdev, u32 stringset,
 466                                 u8 *data)
 467 {
 468         char *p = (char *)data;
 469         int i;
 470
 471         switch (stringset) {
 472         case ETH_SS_TEST:
 473                 memcpy(data, *ixgbe_gstrings_test,
 474                        IXGBE_TEST_LEN * ETH_GSTRING_LEN);
 475                 break;
 476         case ETH_SS_STATS:
 477                 for (i = 0; i < IXGBE_GLOBAL_STATS_LEN; i++) {
 478                         memcpy(p, ixgbe_gstrings_stats[i].stat_string,
 479                                ETH_GSTRING_LEN);
 480                         p += ETH_GSTRING_LEN;
 481                 }
 482                 break;
 483         }
 484 }
 485
 486 static int ixgbevf_link_test(struct ixgbevf_adapter *adapter, u64 *data)
 487 {
 488         struct ixgbe_hw *hw = &adapter->hw;
 489         bool link_up;
 490         u32 link_speed = 0;
 491         *data = 0;
 492
 493         hw->mac.ops.check_link(hw, &link_speed, &link_up, true);
 494         if (!link_up)
 495                 *data = 1;
 496
 497         return *data;
 498 }
 499
 500 /* ethtool register test data */
 501 struct ixgbevf_reg_test {
 502         u16 reg;
 503         u8  array_len;
 504         u8  test_type;
 505         u32 mask;
 506         u32 write;
 507 };
 508
 509 /* In the hardware, registers are laid out either singly, in arrays
 510  * spaced 0x40 bytes apart, or in contiguous tables.  We assume
 511  * most tests take place on arrays or single registers (handled
 512  * as a single-element array) and special-case the tables.
 513  * Table tests are always pattern tests.
 514  *
 515  * We also make provision for some required setup steps by specifying
 516  * registers to be written without any read-back testing.
 517  */
 518
 519 #define PATTERN_TEST    1
 520 #define SET_READ_TEST   2
 521 #define WRITE_NO_TEST   3
 522 #define TABLE32_TEST    4
 523 #define TABLE64_TEST_LO 5
 524 #define TABLE64_TEST_HI 6
 525
 526 /* default VF register test */
 527 static struct ixgbevf_reg_test reg_test_vf[] = {
 528         { IXGBE_VFRDBAL(0), 2, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFF80 },
 529         { IXGBE_VFRDBAH(0), 2, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
 530         { IXGBE_VFRDLEN(0), 2, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
 531         { IXGBE_VFRXDCTL(0), 2, WRITE_NO_TEST, 0, IXGBE_RXDCTL_ENABLE },
 532         { IXGBE_VFRDT(0), 2, PATTERN_TEST, 0x0000FFFF, 0x0000FFFF },
 533         { IXGBE_VFRXDCTL(0), 2, WRITE_NO_TEST, 0, 0 },
 534         { IXGBE_VFTDBAL(0), 2, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
 535         { IXGBE_VFTDBAH(0), 2, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
 536         { IXGBE_VFTDLEN(0), 2, PATTERN_TEST, 0x000FFF80, 0x000FFF80 },
 537         { 0, 0, 0, 0 }
 538 };
 539
 540 #define REG_PATTERN_TEST(R, M, W)                                             \
 541 {                                                                             \
 542         u32 pat, val, before;                                                 \
 543         const u32 _test[] = {0x5A5A5A5A, 0xA5A5A5A5, 0x00000000, 0xFFFFFFFF}; \
 544         for (pat = 0; pat < ARRAY_SIZE(_test); pat++) {                       \
 545                 before = readl(adapter->hw.hw_addr + R);                      \
 546                 writel((_test[pat] & W), (adapter->hw.hw_addr + R));          \
 547                 val = readl(adapter->hw.hw_addr + R);                         \
 548                 if (val != (_test[pat] & W & M)) {                            \
 549                         hw_dbg(&adapter->hw,                                  \
 550                         "pattern test reg %04X failed: got "                  \
 551                         "0x%08X expected 0x%08X\n",                           \
 552                         R, val, (_test[pat] & W & M));                        \
 553                         *data = R;                                            \
 554                         writel(before, adapter->hw.hw_addr + R);              \
 555                         return 1;                                             \
 556                 }                                                             \
 557                 writel(before, adapter->hw.hw_addr + R);                      \
 558         }                                                                     \
 559 }
 560
 561 #define REG_SET_AND_CHECK(R, M, W)                                            \
 562 {                                                                             \
 563         u32 val, before;                                                      \
 564         before = readl(adapter->hw.hw_addr + R);                              \
 565         writel((W & M), (adapter->hw.hw_addr + R));                           \
 566         val = readl(adapter->hw.hw_addr + R);                                 \
 567         if ((W & M) != (val & M)) {                                           \
 568                 printk(KERN_ERR "set/check reg %04X test failed: got 0x%08X " \
 569                                  "expected 0x%08X\n", R, (val & M), (W & M)); \
 570                 *data = R;                                                    \
 571                 writel(before, (adapter->hw.hw_addr + R));                    \
 572                 return 1;                                                     \
 573         }                                                                     \
 574         writel(before, (adapter->hw.hw_addr + R));                            \
 575 }
 576
 577 static int ixgbevf_reg_test(struct ixgbevf_adapter *adapter, u64 *data)
 578 {
 579         struct ixgbevf_reg_test *test;
 580         u32 i;
 581
 582         test = reg_test_vf;
 583
 584         /*
 585          * Perform the register test, looping through the test table
 586          * until we either fail or reach the null entry.
 587          */
 588         while (test->reg) {
 589                 for (i = 0; i < test->array_len; i++) {
 590                         switch (test->test_type) {
 591                         case PATTERN_TEST:
 592                                 REG_PATTERN_TEST(test->reg + (i * 0x40),
 593                                                 test->mask,
 594                                                 test->write);
 595                                 break;
 596                         case SET_READ_TEST:
 597                                 REG_SET_AND_CHECK(test->reg + (i * 0x40),
 598                                                 test->mask,
 599                                                 test->write);
 600                                 break;
 601                         case WRITE_NO_TEST:
 602                                 writel(test->write,
 603                                        (adapter->hw.hw_addr + test->reg)
 604                                        + (i * 0x40));
 605                                 break;
 606                         case TABLE32_TEST:
 607                                 REG_PATTERN_TEST(test->reg + (i * 4),
 608                                                 test->mask,
 609                                                 test->write);
 610                                 break;
 611                         case TABLE64_TEST_LO:
 612                                 REG_PATTERN_TEST(test->reg + (i * 8),
 613                                                 test->mask,
 614                                                 test->write);
 615                                 break;
 616                         case TABLE64_TEST_HI:
 617                                 REG_PATTERN_TEST((test->reg + 4) + (i * 8),
 618                                                 test->mask,
 619                                                 test->write);
 620                                 break;
 621                         }
 622                 }
 623                 test++;
 624         }
 625
 626         *data = 0;
 627         return *data;
 628 }
 629
 630 static void ixgbevf_diag_test(struct net_device *netdev,
 631                               struct ethtool_test *eth_test, u64 *data)
 632 {
 633         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 634         bool if_running = netif_running(netdev);
 635
 636         set_bit(__IXGBEVF_TESTING, &adapter->state);
 637         if (eth_test->flags == ETH_TEST_FL_OFFLINE) {
 638                 /* Offline tests */
 639
 640                 hw_dbg(&adapter->hw, "offline testing starting\n");
 641
 642                 /* Link test performed before hardware reset so autoneg doesn't
 643                  * interfere with test result */
 644                 if (ixgbevf_link_test(adapter, &data[1]))
 645                         eth_test->flags |= ETH_TEST_FL_FAILED;
 646
 647                 if (if_running)
 648                         /* indicate we're in test mode */
 649                         dev_close(netdev);
 650                 else
 651                         ixgbevf_reset(adapter);
 652
 653                 hw_dbg(&adapter->hw, "register testing starting\n");
 654                 if (ixgbevf_reg_test(adapter, &data[0]))
 655                         eth_test->flags |= ETH_TEST_FL_FAILED;
 656
 657                 ixgbevf_reset(adapter);
 658
 659                 clear_bit(__IXGBEVF_TESTING, &adapter->state);
 660                 if (if_running)
 661                         dev_open(netdev);
 662         } else {
 663                 hw_dbg(&adapter->hw, "online testing starting\n");
 664                 /* Online tests */
 665                 if (ixgbevf_link_test(adapter, &data[1]))
 666                         eth_test->flags |= ETH_TEST_FL_FAILED;
 667
 668                 /* Online tests aren't run; pass by default */
 669                 data[0] = 0;
 670
 671                 clear_bit(__IXGBEVF_TESTING, &adapter->state);
 672         }
 673         msleep_interruptible(4 * 1000);
 674 }
 675
 676 static int ixgbevf_nway_reset(struct net_device *netdev)
 677 {
 678         struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 679
 680         if (netif_running(netdev)) {
 681                 if (!adapter->dev_closed)
 682                         ixgbevf_reinit_locked(adapter);
 683         }
 684
 685         return 0;
 686 }
 687
 688 static struct ethtool_ops ixgbevf_ethtool_ops = {
 689         .get_settings           = ixgbevf_get_settings,
 690         .get_drvinfo            = ixgbevf_get_drvinfo,
 691         .get_regs_len           = ixgbevf_get_regs_len,
 692         .get_regs               = ixgbevf_get_regs,
 693         .nway_reset             = ixgbevf_nway_reset,
 694         .get_link               = ethtool_op_get_link,
 695         .get_ringparam          = ixgbevf_get_ringparam,
 696         .set_ringparam          = ixgbevf_set_ringparam,
 697         .get_rx_csum            = ixgbevf_get_rx_csum,
 698         .set_rx_csum            = ixgbevf_set_rx_csum,
 699         .get_tx_csum            = ethtool_op_get_tx_csum,
 700         .set_tx_csum            = ethtool_op_set_tx_ipv6_csum,
 701         .get_sg                 = ethtool_op_get_sg,
 702         .set_sg                 = ethtool_op_set_sg,
 703         .get_msglevel           = ixgbevf_get_msglevel,
 704         .set_msglevel           = ixgbevf_set_msglevel,
 705         .get_tso                = ethtool_op_get_tso,
 706         .set_tso                = ixgbevf_set_tso,
 707         .self_test              = ixgbevf_diag_test,
 708         .get_sset_count         = ixgbevf_get_sset_count,
 709         .get_strings            = ixgbevf_get_strings,
 710         .get_ethtool_stats      = ixgbevf_get_ethtool_stats,
 711 };
 712
 713 void ixgbevf_set_ethtool_ops(struct net_device *netdev)
 714 {
 715         SET_ETHTOOL_OPS(netdev, &ixgbevf_ethtool_ops);
 716 }