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