drivers/net/netxen/netxen_nic_ethtool.c

   1 /*
   2  * Copyright (C) 2003 - 2006 NetXen, Inc.
   3  * All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or
   6  * modify it under the terms of the GNU General Public License
   7  * as published by the Free Software Foundation; either version 2
   8  * of the License, or (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful, but
  11  * WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 59 Temple Place - Suite 330, Boston,
  18  * MA  02111-1307, USA.
  19  *
  20  * The full GNU General Public License is included in this distribution
  21  * in the file called LICENSE.
  22  *
  23  * Contact Information:
  24  *    info@netxen.com
  25  * NetXen,
  26  * 3965 Freedom Circle, Fourth floor,
  27  * Santa Clara, CA 95054
  28  *
  29  *
  30  * ethtool support for netxen nic
  31  *
  32  */
  33
  34 #include <linux/types.h>
  35 #include <asm/uaccess.h>
  36 #include <linux/pci.h>
  37 #include <asm/io.h>
  38 #include <linux/netdevice.h>
  39 #include <linux/ethtool.h>
  40 #include <linux/version.h>
  41
  42 #include "netxen_nic_hw.h"
  43 #include "netxen_nic.h"
  44 #include "netxen_nic_phan_reg.h"
  45 #include "netxen_nic_ioctl.h"
  46
  47 struct netxen_nic_stats {
  48         char stat_string[ETH_GSTRING_LEN];
  49         int sizeof_stat;
  50         int stat_offset;
  51 };
  52
  53 #define NETXEN_NIC_STAT(m) sizeof(((struct netxen_port *)0)->m), \
  54                         offsetof(struct netxen_port, m)
  55
  56 static const struct netxen_nic_stats netxen_nic_gstrings_stats[] = {
  57         {"rcvd_bad_skb", NETXEN_NIC_STAT(stats.rcvdbadskb)},
  58         {"xmit_called", NETXEN_NIC_STAT(stats.xmitcalled)},
  59         {"xmited_frames", NETXEN_NIC_STAT(stats.xmitedframes)},
  60         {"xmit_finished", NETXEN_NIC_STAT(stats.xmitfinished)},
  61         {"bad_skb_len", NETXEN_NIC_STAT(stats.badskblen)},
  62         {"no_cmd_desc", NETXEN_NIC_STAT(stats.nocmddescriptor)},
  63         {"polled", NETXEN_NIC_STAT(stats.polled)},
  64         {"uphappy", NETXEN_NIC_STAT(stats.uphappy)},
  65         {"updropped", NETXEN_NIC_STAT(stats.updropped)},
  66         {"uplcong", NETXEN_NIC_STAT(stats.uplcong)},
  67         {"uphcong", NETXEN_NIC_STAT(stats.uphcong)},
  68         {"upmcong", NETXEN_NIC_STAT(stats.upmcong)},
  69         {"updunno", NETXEN_NIC_STAT(stats.updunno)},
  70         {"skb_freed", NETXEN_NIC_STAT(stats.skbfreed)},
  71         {"tx_dropped", NETXEN_NIC_STAT(stats.txdropped)},
  72         {"tx_null_skb", NETXEN_NIC_STAT(stats.txnullskb)},
  73         {"csummed", NETXEN_NIC_STAT(stats.csummed)},
  74         {"no_rcv", NETXEN_NIC_STAT(stats.no_rcv)},
  75         {"rx_bytes", NETXEN_NIC_STAT(stats.rxbytes)},
  76         {"tx_bytes", NETXEN_NIC_STAT(stats.txbytes)},
  77 };
  78
  79 #define NETXEN_NIC_STATS_LEN    \
  80         sizeof(netxen_nic_gstrings_stats) / sizeof(struct netxen_nic_stats)
  81
  82 static const char netxen_nic_gstrings_test[][ETH_GSTRING_LEN] = {
  83         "Register_Test_offline", "EEPROM_Test_offline",
  84         "Interrupt_Test_offline", "Loopback_Test_offline",
  85         "Link_Test_on_offline"
  86 };
  87
  88 #define NETXEN_NIC_TEST_LEN sizeof(netxen_nic_gstrings_test) / ETH_GSTRING_LEN
  89
  90 #define NETXEN_NIC_REGS_COUNT 42
  91 #define NETXEN_NIC_REGS_LEN (NETXEN_NIC_REGS_COUNT * sizeof(__le32))
  92 #define NETXEN_MAX_EEPROM_LEN   1024
  93
  94 static int netxen_nic_get_eeprom_len(struct net_device *dev)
  95 {
  96         struct netxen_port *port = netdev_priv(dev);
  97         struct netxen_adapter *adapter = port->adapter;
  98         int n;
  99
 100         if ((netxen_rom_fast_read(adapter, 0, &n) == 0)
 101             && (n & NETXEN_ROM_ROUNDUP)) {
 102                 n &= ~NETXEN_ROM_ROUNDUP;
 103                 if (n < NETXEN_MAX_EEPROM_LEN)
 104                         return n;
 105         }
 106         return 0;
 107 }
 108
 109 static void
 110 netxen_nic_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *drvinfo)
 111 {
 112         struct netxen_port *port = netdev_priv(dev);
 113         struct netxen_adapter *adapter = port->adapter;
 114         uint32_t fw_major = 0;
 115         uint32_t fw_minor = 0;
 116         uint32_t fw_build = 0;
 117
 118         strncpy(drvinfo->driver, "netxen_nic", 32);
 119         strncpy(drvinfo->version, NETXEN_NIC_LINUX_VERSIONID, 32);
 120         fw_major = readl(NETXEN_CRB_NORMALIZE(adapter,
 121                                               NETXEN_FW_VERSION_MAJOR));
 122         fw_minor = readl(NETXEN_CRB_NORMALIZE(adapter,
 123                                               NETXEN_FW_VERSION_MINOR));
 124         fw_build = readl(NETXEN_CRB_NORMALIZE(adapter, NETXEN_FW_VERSION_SUB));
 125         sprintf(drvinfo->fw_version, "%d.%d.%d", fw_major, fw_minor, fw_build);
 126
 127         strncpy(drvinfo->bus_info, pci_name(port->pdev), 32);
 128         drvinfo->n_stats = NETXEN_NIC_STATS_LEN;
 129         drvinfo->testinfo_len = NETXEN_NIC_TEST_LEN;
 130         drvinfo->regdump_len = NETXEN_NIC_REGS_LEN;
 131         drvinfo->eedump_len = netxen_nic_get_eeprom_len(dev);
 132 }
 133
 134 static int
 135 netxen_nic_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
 136 {
 137         struct netxen_port *port = netdev_priv(dev);
 138         struct netxen_adapter *adapter = port->adapter;
 139
 140         /* read which mode */
 141         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
 142                 ecmd->supported = (SUPPORTED_10baseT_Half |
 143                                    SUPPORTED_10baseT_Full |
 144                                    SUPPORTED_100baseT_Half |
 145                                    SUPPORTED_100baseT_Full |
 146                                    SUPPORTED_1000baseT_Half |
 147                                    SUPPORTED_1000baseT_Full |
 148                                    SUPPORTED_TP |
 149                                    SUPPORTED_MII | SUPPORTED_Autoneg);
 150
 151                 ecmd->advertising = (ADVERTISED_100baseT_Half |
 152                                      ADVERTISED_100baseT_Full |
 153                                      ADVERTISED_1000baseT_Half |
 154                                      ADVERTISED_1000baseT_Full |
 155                                      ADVERTISED_TP |
 156                                      ADVERTISED_MII | ADVERTISED_Autoneg);
 157
 158                 ecmd->port = PORT_TP;
 159
 160                 if (netif_running(dev)) {
 161                         ecmd->speed = port->link_speed;
 162                         ecmd->duplex = port->link_duplex;
 163                 } else
 164                         return -EIO;    /* link absent */
 165
 166                 ecmd->phy_address = port->portnum;
 167                 ecmd->transceiver = XCVR_EXTERNAL;
 168
 169                 /* get autoneg settings */
 170                 ecmd->autoneg = port->link_autoneg;
 171                 return 0;
 172         }
 173
 174         if (adapter->ahw.board_type == NETXEN_NIC_XGBE) {
 175                 ecmd->supported = (SUPPORTED_TP |
 176                                    SUPPORTED_1000baseT_Full |
 177                                    SUPPORTED_10000baseT_Full);
 178                 ecmd->advertising = (ADVERTISED_TP |
 179                                      ADVERTISED_1000baseT_Full |
 180                                      ADVERTISED_10000baseT_Full);
 181                 ecmd->port = PORT_TP;
 182
 183                 ecmd->speed = SPEED_10000;
 184                 ecmd->duplex = DUPLEX_FULL;
 185                 ecmd->phy_address = port->portnum;
 186                 ecmd->transceiver = XCVR_EXTERNAL;
 187                 ecmd->autoneg = AUTONEG_DISABLE;
 188                 return 0;
 189         }
 190
 191         return -EIO;
 192 }
 193
 194 static int
 195 netxen_nic_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
 196 {
 197         struct netxen_port *port = netdev_priv(dev);
 198         struct netxen_adapter *adapter = port->adapter;
 199         __le32 status;
 200
 201         /* read which mode */
 202         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
 203                 /* autonegotiation */
 204                 if (adapter->ops->phy_write
 205                     && adapter->ops->phy_write(adapter, port->portnum,
 206                                                NETXEN_NIU_GB_MII_MGMT_ADDR_AUTONEG,
 207                                                (__le32) ecmd->autoneg) != 0)
 208                         return -EIO;
 209                 else
 210                         port->link_autoneg = ecmd->autoneg;
 211
 212                 if (adapter->ops->phy_read
 213                     && adapter->ops->phy_read(adapter, port->portnum,
 214                                               NETXEN_NIU_GB_MII_MGMT_ADDR_PHY_STATUS,
 215                                               &status) != 0)
 216                         return -EIO;
 217
 218                 /* speed */
 219                 switch (ecmd->speed) {
 220                 case SPEED_10:
 221                         netxen_set_phy_speed(status, 0);
 222                         break;
 223                 case SPEED_100:
 224                         netxen_set_phy_speed(status, 1);
 225                         break;
 226                 case SPEED_1000:
 227                         netxen_set_phy_speed(status, 2);
 228                         break;
 229                 }
 230                 /* set duplex mode */
 231                 if (ecmd->duplex == DUPLEX_HALF)
 232                         netxen_clear_phy_duplex(status);
 233                 if (ecmd->duplex == DUPLEX_FULL)
 234                         netxen_set_phy_duplex(status);
 235                 if (adapter->ops->phy_write
 236                     && adapter->ops->phy_write(adapter, port->portnum,
 237                                                NETXEN_NIU_GB_MII_MGMT_ADDR_PHY_STATUS,
 238                                                *((int *)&status)) != 0)
 239                         return -EIO;
 240                 else {
 241                         port->link_speed = ecmd->speed;
 242                         port->link_duplex = ecmd->duplex;
 243                 }
 244         } else
 245                 return -EOPNOTSUPP;
 246
 247         if (netif_running(dev)) {
 248                 dev->stop(dev);
 249                 dev->open(dev);
 250         }
 251         return 0;
 252 }
 253
 254 static int netxen_nic_get_regs_len(struct net_device *dev)
 255 {
 256         return NETXEN_NIC_REGS_LEN;
 257 }
 258
 259 struct netxen_niu_regs {
 260         __le32 reg[NETXEN_NIC_REGS_COUNT];
 261 };
 262
 263 static struct netxen_niu_regs niu_registers[] = {
 264         {
 265          /* GB Mode */
 266          {
 267           NETXEN_NIU_GB_SERDES_RESET,
 268           NETXEN_NIU_GB0_MII_MODE,
 269           NETXEN_NIU_GB1_MII_MODE,
 270           NETXEN_NIU_GB2_MII_MODE,
 271           NETXEN_NIU_GB3_MII_MODE,
 272           NETXEN_NIU_GB0_GMII_MODE,
 273           NETXEN_NIU_GB1_GMII_MODE,
 274           NETXEN_NIU_GB2_GMII_MODE,
 275           NETXEN_NIU_GB3_GMII_MODE,
 276           NETXEN_NIU_REMOTE_LOOPBACK,
 277           NETXEN_NIU_GB0_HALF_DUPLEX,
 278           NETXEN_NIU_GB1_HALF_DUPLEX,
 279           NETXEN_NIU_RESET_SYS_FIFOS,
 280           NETXEN_NIU_GB_CRC_DROP,
 281           NETXEN_NIU_GB_DROP_WRONGADDR,
 282           NETXEN_NIU_TEST_MUX_CTL,
 283
 284           NETXEN_NIU_GB_MAC_CONFIG_0(0),
 285           NETXEN_NIU_GB_MAC_CONFIG_1(0),
 286           NETXEN_NIU_GB_HALF_DUPLEX_CTRL(0),
 287           NETXEN_NIU_GB_MAX_FRAME_SIZE(0),
 288           NETXEN_NIU_GB_TEST_REG(0),
 289           NETXEN_NIU_GB_MII_MGMT_CONFIG(0),
 290           NETXEN_NIU_GB_MII_MGMT_COMMAND(0),
 291           NETXEN_NIU_GB_MII_MGMT_ADDR(0),
 292           NETXEN_NIU_GB_MII_MGMT_CTRL(0),
 293           NETXEN_NIU_GB_MII_MGMT_STATUS(0),
 294           NETXEN_NIU_GB_MII_MGMT_INDICATE(0),
 295           NETXEN_NIU_GB_INTERFACE_CTRL(0),
 296           NETXEN_NIU_GB_INTERFACE_STATUS(0),
 297           NETXEN_NIU_GB_STATION_ADDR_0(0),
 298           NETXEN_NIU_GB_STATION_ADDR_1(0),
 299           -1,
 300           }
 301          },
 302         {
 303          /* XG Mode */
 304          {
 305           NETXEN_NIU_XG_SINGLE_TERM,
 306           NETXEN_NIU_XG_DRIVE_HI,
 307           NETXEN_NIU_XG_DRIVE_LO,
 308           NETXEN_NIU_XG_DTX,
 309           NETXEN_NIU_XG_DEQ,
 310           NETXEN_NIU_XG_WORD_ALIGN,
 311           NETXEN_NIU_XG_RESET,
 312           NETXEN_NIU_XG_POWER_DOWN,
 313           NETXEN_NIU_XG_RESET_PLL,
 314           NETXEN_NIU_XG_SERDES_LOOPBACK,
 315           NETXEN_NIU_XG_DO_BYTE_ALIGN,
 316           NETXEN_NIU_XG_TX_ENABLE,
 317           NETXEN_NIU_XG_RX_ENABLE,
 318           NETXEN_NIU_XG_STATUS,
 319           NETXEN_NIU_XG_PAUSE_THRESHOLD,
 320           NETXEN_NIU_XGE_CONFIG_0,
 321           NETXEN_NIU_XGE_CONFIG_1,
 322           NETXEN_NIU_XGE_IPG,
 323           NETXEN_NIU_XGE_STATION_ADDR_0_HI,
 324           NETXEN_NIU_XGE_STATION_ADDR_0_1,
 325           NETXEN_NIU_XGE_STATION_ADDR_1_LO,
 326           NETXEN_NIU_XGE_STATUS,
 327           NETXEN_NIU_XGE_MAX_FRAME_SIZE,
 328           NETXEN_NIU_XGE_PAUSE_FRAME_VALUE,
 329           NETXEN_NIU_XGE_TX_BYTE_CNT,
 330           NETXEN_NIU_XGE_TX_FRAME_CNT,
 331           NETXEN_NIU_XGE_RX_BYTE_CNT,
 332           NETXEN_NIU_XGE_RX_FRAME_CNT,
 333           NETXEN_NIU_XGE_AGGR_ERROR_CNT,
 334           NETXEN_NIU_XGE_MULTICAST_FRAME_CNT,
 335           NETXEN_NIU_XGE_UNICAST_FRAME_CNT,
 336           NETXEN_NIU_XGE_CRC_ERROR_CNT,
 337           NETXEN_NIU_XGE_OVERSIZE_FRAME_ERR,
 338           NETXEN_NIU_XGE_UNDERSIZE_FRAME_ERR,
 339           NETXEN_NIU_XGE_LOCAL_ERROR_CNT,
 340           NETXEN_NIU_XGE_REMOTE_ERROR_CNT,
 341           NETXEN_NIU_XGE_CONTROL_CHAR_CNT,
 342           NETXEN_NIU_XGE_PAUSE_FRAME_CNT,
 343           -1,
 344           }
 345          }
 346 };
 347
 348 static void
 349 netxen_nic_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *p)
 350 {
 351         struct netxen_port *port = netdev_priv(dev);
 352         struct netxen_adapter *adapter = port->adapter;
 353         __le32 mode, *regs_buff = p;
 354         void __iomem *addr;
 355         int i, window;
 356
 357         memset(p, 0, NETXEN_NIC_REGS_LEN);
 358         regs->version = (1 << 24) | (adapter->ahw.revision_id << 16) |
 359             (port->pdev)->device;
 360         /* which mode */
 361         NETXEN_NIC_LOCKED_READ_REG(NETXEN_NIU_MODE, &regs_buff[0]);
 362         mode = regs_buff[0];
 363
 364         /* Common registers to all the modes */
 365         NETXEN_NIC_LOCKED_READ_REG(NETXEN_NIU_STRAP_VALUE_SAVE_HIGHER,
 366                                    &regs_buff[2]);
 367         /* GB/XGB Mode */
 368         mode = (mode / 2) - 1;
 369         window = 0;
 370         if (mode <= 1) {
 371                 for (i = 3; niu_registers[mode].reg[i - 3] != -1; i++) {
 372                         /* GB: port specific registers */
 373                         if (mode == 0 && i >= 19)
 374                                 window = port->portnum * 0x10000;
 375
 376                         NETXEN_NIC_LOCKED_READ_REG(niu_registers[mode].
 377                                                    reg[i - 3] + window,
 378                                                    &regs_buff[i]);
 379                 }
 380
 381         }
 382 }
 383
 384 static void
 385 netxen_nic_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
 386 {
 387         wol->supported = WAKE_UCAST | WAKE_MCAST | WAKE_BCAST | WAKE_MAGIC;
 388         wol->wolopts = 0;       /* options can be added depending upon the mode */
 389 }
 390
 391 static u32 netxen_nic_get_link(struct net_device *dev)
 392 {
 393         struct netxen_port *port = netdev_priv(dev);
 394         struct netxen_adapter *adapter = port->adapter;
 395         __le32 status;
 396
 397         /* read which mode */
 398         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
 399                 if (adapter->ops->phy_read
 400                     && adapter->ops->phy_read(adapter, port->portnum,
 401                                               NETXEN_NIU_GB_MII_MGMT_ADDR_PHY_STATUS,
 402                                               &status) != 0)
 403                         return -EIO;
 404                 else
 405                         return (netxen_get_phy_link(status));
 406         } else if (adapter->ahw.board_type == NETXEN_NIC_XGBE) {
 407                 int val = readl(NETXEN_CRB_NORMALIZE(adapter, CRB_XG_STATE));
 408                 return val == XG_LINK_UP;
 409         }
 410         return -EIO;
 411 }
 412
 413 static int
 414 netxen_nic_get_eeprom(struct net_device *dev, struct ethtool_eeprom *eeprom,
 415                       u8 * bytes)
 416 {
 417         struct netxen_port *port = netdev_priv(dev);
 418         struct netxen_adapter *adapter = port->adapter;
 419         int offset;
 420
 421         if (eeprom->len == 0)
 422                 return -EINVAL;
 423
 424         eeprom->magic = (port->pdev)->vendor | ((port->pdev)->device << 16);
 425         for (offset = 0; offset < eeprom->len; offset++)
 426                 if (netxen_rom_fast_read
 427                     (adapter, (8 * offset) + 8, (int *)eeprom->data) == -1)
 428                         return -EIO;
 429         return 0;
 430 }
 431
 432 static void
 433 netxen_nic_get_ringparam(struct net_device *dev, struct ethtool_ringparam *ring)
 434 {
 435         struct netxen_port *port = netdev_priv(dev);
 436         struct netxen_adapter *adapter = port->adapter;
 437         int i, j;
 438
 439         ring->rx_pending = 0;
 440         for (i = 0; i < MAX_RCV_CTX; ++i) {
 441                 for (j = 0; j < NUM_RCV_DESC_RINGS; j++)
 442                         ring->rx_pending +=
 443                             adapter->recv_ctx[i].rcv_desc[j].rcv_pending;
 444         }
 445
 446         ring->rx_max_pending = adapter->max_rx_desc_count;
 447         ring->tx_max_pending = adapter->max_tx_desc_count;
 448         ring->rx_mini_max_pending = 0;
 449         ring->rx_mini_pending = 0;
 450         ring->rx_jumbo_max_pending = 0;
 451         ring->rx_jumbo_pending = 0;
 452 }
 453
 454 static void
 455 netxen_nic_get_pauseparam(struct net_device *dev,
 456                           struct ethtool_pauseparam *pause)
 457 {
 458         struct netxen_port *port = netdev_priv(dev);
 459         struct netxen_adapter *adapter = port->adapter;
 460         __le32 val;
 461
 462         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
 463                 /* get flow control settings */
 464                 netxen_nic_read_w0(adapter,
 465                                    NETXEN_NIU_GB_MAC_CONFIG_0(port->portnum),
 466                                    (u32 *) & val);
 467                 pause->rx_pause = netxen_gb_get_rx_flowctl(val);
 468                 pause->tx_pause = netxen_gb_get_tx_flowctl(val);
 469                 /* get autoneg settings */
 470                 pause->autoneg = port->link_autoneg;
 471         }
 472 }
 473
 474 static int
 475 netxen_nic_set_pauseparam(struct net_device *dev,
 476                           struct ethtool_pauseparam *pause)
 477 {
 478         struct netxen_port *port = netdev_priv(dev);
 479         struct netxen_adapter *adapter = port->adapter;
 480         __le32 val;
 481         unsigned int autoneg;
 482
 483         /* read mode */
 484         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
 485                 /* set flow control */
 486                 netxen_nic_read_w0(adapter,
 487                                    NETXEN_NIU_GB_MAC_CONFIG_0(port->portnum),
 488                                    (u32 *) & val);
 489                 if (pause->tx_pause)
 490                         netxen_gb_tx_flowctl(val);
 491                 else
 492                         netxen_gb_unset_tx_flowctl(val);
 493                 if (pause->rx_pause)
 494                         netxen_gb_rx_flowctl(val);
 495                 else
 496                         netxen_gb_unset_rx_flowctl(val);
 497
 498                 netxen_nic_write_w0(adapter,
 499                                     NETXEN_NIU_GB_MAC_CONFIG_0(port->portnum),
 500                                     *(u32 *) (&val));
 501                 /* set autoneg */
 502                 autoneg = pause->autoneg;
 503                 if (adapter->ops->phy_write
 504                     && adapter->ops->phy_write(adapter, port->portnum,
 505                                                NETXEN_NIU_GB_MII_MGMT_ADDR_AUTONEG,
 506                                                (__le32) autoneg) != 0)
 507                         return -EIO;
 508                 else {
 509                         port->link_autoneg = pause->autoneg;
 510                         return 0;
 511                 }
 512         } else
 513                 return -EOPNOTSUPP;
 514 }
 515
 516 static int netxen_nic_reg_test(struct net_device *dev)
 517 {
 518         struct netxen_port *port = netdev_priv(dev);
 519         struct netxen_adapter *adapter = port->adapter;
 520         u32 data_read, data_written, save;
 521         __le32 mode;
 522
 523         /*
 524          * first test the "Read Only" registers by writing which mode
 525          */
 526         netxen_nic_read_w0(adapter, NETXEN_NIU_MODE, &mode);
 527         if (netxen_get_niu_enable_ge(mode)) {   /* GB Mode */
 528                 netxen_nic_read_w0(adapter,
 529                                    NETXEN_NIU_GB_MII_MGMT_STATUS(port->portnum),
 530                                    &data_read);
 531
 532                 save = data_read;
 533                 if (data_read)
 534                         data_written = data_read & 0xDEADBEEF;
 535                 else
 536                         data_written = 0xDEADBEEF;
 537                 netxen_nic_write_w0(adapter,
 538                                     NETXEN_NIU_GB_MII_MGMT_STATUS(port->
 539                                                                   portnum),
 540                                     data_written);
 541                 netxen_nic_read_w0(adapter,
 542                                    NETXEN_NIU_GB_MII_MGMT_STATUS(port->portnum),
 543                                    &data_read);
 544
 545                 if (data_written == data_read) {
 546                         netxen_nic_write_w0(adapter,
 547                                             NETXEN_NIU_GB_MII_MGMT_STATUS(port->
 548                                                                           portnum),
 549                                             save);
 550
 551                         return 0;
 552                 }
 553
 554                 /* netxen_niu_gb_mii_mgmt_indicators is read only */
 555                 netxen_nic_read_w0(adapter,
 556                                    NETXEN_NIU_GB_MII_MGMT_INDICATE(port->
 557                                                                    portnum),
 558                                    &data_read);
 559
 560                 save = data_read;
 561                 if (data_read)
 562                         data_written = data_read & 0xDEADBEEF;
 563                 else
 564                         data_written = 0xDEADBEEF;
 565                 netxen_nic_write_w0(adapter,
 566                                     NETXEN_NIU_GB_MII_MGMT_INDICATE(port->
 567                                                                     portnum),
 568                                     data_written);
 569
 570                 netxen_nic_read_w0(adapter,
 571                                    NETXEN_NIU_GB_MII_MGMT_INDICATE(port->
 572                                                                    portnum),
 573                                    &data_read);
 574
 575                 if (data_written == data_read) {
 576                         netxen_nic_write_w0(adapter,
 577                                             NETXEN_NIU_GB_MII_MGMT_INDICATE
 578                                             (port->portnum), save);
 579                         return 0;
 580                 }
 581
 582                 /* netxen_niu_gb_interface_status is read only */
 583                 netxen_nic_read_w0(adapter,
 584                                    NETXEN_NIU_GB_INTERFACE_STATUS(port->
 585                                                                   portnum),
 586                                    &data_read);
 587
 588                 save = data_read;
 589                 if (data_read)
 590                         data_written = data_read & 0xDEADBEEF;
 591                 else
 592                         data_written = 0xDEADBEEF;
 593                 netxen_nic_write_w0(adapter,
 594                                     NETXEN_NIU_GB_INTERFACE_STATUS(port->
 595                                                                    portnum),
 596                                     data_written);
 597
 598                 netxen_nic_read_w0(adapter,
 599                                    NETXEN_NIU_GB_INTERFACE_STATUS(port->
 600                                                                   portnum),
 601                                    &data_read);
 602
 603                 if (data_written == data_read) {
 604                         netxen_nic_write_w0(adapter,
 605                                             NETXEN_NIU_GB_INTERFACE_STATUS
 606                                             (port->portnum), save);
 607
 608                         return 0;
 609                 }
 610         }                       /* GB Mode */
 611         return 1;
 612 }
 613
 614 static int netxen_nic_diag_test_count(struct net_device *dev)
 615 {
 616         return NETXEN_NIC_TEST_LEN;
 617 }
 618
 619 static void
 620 netxen_nic_diag_test(struct net_device *dev, struct ethtool_test *eth_test,
 621                      u64 * data)
 622 {
 623         if (eth_test->flags == ETH_TEST_FL_OFFLINE) {   /* offline tests */
 624                 /* link test */
 625                 if (!(data[4] = (u64) netxen_nic_get_link(dev)))
 626                         eth_test->flags |= ETH_TEST_FL_FAILED;
 627
 628                 if (netif_running(dev))
 629                         dev->stop(dev);
 630
 631                 /* register tests */
 632                 if (!(data[0] = netxen_nic_reg_test(dev)))
 633                         eth_test->flags |= ETH_TEST_FL_FAILED;
 634                 /* other tests pass as of now */
 635                 data[1] = data[2] = data[3] = 1;
 636                 if (netif_running(dev))
 637                         dev->open(dev);
 638         } else {                /* online tests */
 639                 /* link test */
 640                 if (!(data[4] = (u64) netxen_nic_get_link(dev)))
 641                         eth_test->flags |= ETH_TEST_FL_FAILED;
 642
 643                 /* other tests pass by default */
 644                 data[0] = data[1] = data[2] = data[3] = 1;
 645         }
 646 }
 647
 648 static void
 649 netxen_nic_get_strings(struct net_device *dev, u32 stringset, u8 * data)
 650 {
 651         int index;
 652
 653         switch (stringset) {
 654         case ETH_SS_TEST:
 655                 memcpy(data, *netxen_nic_gstrings_test,
 656                        NETXEN_NIC_TEST_LEN * ETH_GSTRING_LEN);
 657                 break;
 658         case ETH_SS_STATS:
 659                 for (index = 0; index < NETXEN_NIC_STATS_LEN; index++) {
 660                         memcpy(data + index * ETH_GSTRING_LEN,
 661                                netxen_nic_gstrings_stats[index].stat_string,
 662                                ETH_GSTRING_LEN);
 663                 }
 664                 break;
 665         }
 666 }
 667
 668 static int netxen_nic_get_stats_count(struct net_device *dev)
 669 {
 670         return NETXEN_NIC_STATS_LEN;
 671 }
 672
 673 static void
 674 netxen_nic_get_ethtool_stats(struct net_device *dev,
 675                              struct ethtool_stats *stats, u64 * data)
 676 {
 677         struct netxen_port *port = netdev_priv(dev);
 678         int index;
 679
 680         for (index = 0; index < NETXEN_NIC_STATS_LEN; index++) {
 681                 char *p =
 682                     (char *)port + netxen_nic_gstrings_stats[index].stat_offset;
 683                 data[index] =
 684                     (netxen_nic_gstrings_stats[index].sizeof_stat ==
 685                      sizeof(u64)) ? *(u64 *) p : *(u32 *) p;
 686         }
 687
 688 }
 689
 690 struct ethtool_ops netxen_nic_ethtool_ops = {
 691         .get_settings = netxen_nic_get_settings,
 692         .set_settings = netxen_nic_set_settings,
 693         .get_drvinfo = netxen_nic_get_drvinfo,
 694         .get_regs_len = netxen_nic_get_regs_len,
 695         .get_regs = netxen_nic_get_regs,
 696         .get_wol = netxen_nic_get_wol,
 697         .get_link = netxen_nic_get_link,
 698         .get_eeprom_len = netxen_nic_get_eeprom_len,
 699         .get_eeprom = netxen_nic_get_eeprom,
 700         .get_ringparam = netxen_nic_get_ringparam,
 701         .get_pauseparam = netxen_nic_get_pauseparam,
 702         .set_pauseparam = netxen_nic_set_pauseparam,
 703         .get_tx_csum = ethtool_op_get_tx_csum,
 704         .set_tx_csum = ethtool_op_set_tx_csum,
 705         .get_sg = ethtool_op_get_sg,
 706         .set_sg = ethtool_op_set_sg,
 707         .get_tso = ethtool_op_get_tso,
 708         .set_tso = ethtool_op_set_tso,
 709         .self_test_count = netxen_nic_diag_test_count,
 710         .self_test = netxen_nic_diag_test,
 711         .get_strings = netxen_nic_get_strings,
 712         .get_stats_count = netxen_nic_get_stats_count,
 713         .get_ethtool_stats = netxen_nic_get_ethtool_stats,
 714         .get_perm_addr = ethtool_op_get_perm_addr,
 715 };