| /* |
| * Copyright (C) 2003 - 2006 NetXen, Inc. |
| * All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License |
| * as published by the Free Software Foundation; either version 2 |
| * of the License, or (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, but |
| * WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place - Suite 330, Boston, |
| * MA 02111-1307, USA. |
| * |
| * The full GNU General Public License is included in this distribution |
| * in the file called LICENSE. |
| * |
| * Contact Information: |
| * info@netxen.com |
| * NetXen, |
| * 3965 Freedom Circle, Fourth floor, |
| * Santa Clara, CA 95054 |
| * |
| * |
| * ethtool support for netxen nic |
| * |
| */ |
| |
| #include <linux/types.h> |
| #include <linux/delay.h> |
| #include <asm/uaccess.h> |
| #include <linux/pci.h> |
| #include <asm/io.h> |
| #include <linux/netdevice.h> |
| #include <linux/ethtool.h> |
| #include <linux/version.h> |
| |
| #include "netxen_nic_hw.h" |
| #include "netxen_nic.h" |
| #include "netxen_nic_phan_reg.h" |
| |
| struct netxen_nic_stats { |
| char stat_string[ETH_GSTRING_LEN]; |
| int sizeof_stat; |
| int stat_offset; |
| }; |
| |
| #define NETXEN_NIC_STAT(m) sizeof(((struct netxen_adapter *)0)->m), \ |
| offsetof(struct netxen_adapter, m) |
| |
| #define NETXEN_NIC_PORT_WINDOW 0x10000 |
| #define NETXEN_NIC_INVALID_DATA 0xDEADBEEF |
| |
| static const struct netxen_nic_stats netxen_nic_gstrings_stats[] = { |
| {"rcvd_bad_skb", NETXEN_NIC_STAT(stats.rcvdbadskb)}, |
| {"xmit_called", NETXEN_NIC_STAT(stats.xmitcalled)}, |
| {"xmited_frames", NETXEN_NIC_STAT(stats.xmitedframes)}, |
| {"xmit_finished", NETXEN_NIC_STAT(stats.xmitfinished)}, |
| {"bad_skb_len", NETXEN_NIC_STAT(stats.badskblen)}, |
| {"no_cmd_desc", NETXEN_NIC_STAT(stats.nocmddescriptor)}, |
| {"polled", NETXEN_NIC_STAT(stats.polled)}, |
| {"uphappy", NETXEN_NIC_STAT(stats.uphappy)}, |
| {"updropped", NETXEN_NIC_STAT(stats.updropped)}, |
| {"uplcong", NETXEN_NIC_STAT(stats.uplcong)}, |
| {"uphcong", NETXEN_NIC_STAT(stats.uphcong)}, |
| {"upmcong", NETXEN_NIC_STAT(stats.upmcong)}, |
| {"updunno", NETXEN_NIC_STAT(stats.updunno)}, |
| {"skb_freed", NETXEN_NIC_STAT(stats.skbfreed)}, |
| {"tx_dropped", NETXEN_NIC_STAT(stats.txdropped)}, |
| {"tx_null_skb", NETXEN_NIC_STAT(stats.txnullskb)}, |
| {"csummed", NETXEN_NIC_STAT(stats.csummed)}, |
| {"no_rcv", NETXEN_NIC_STAT(stats.no_rcv)}, |
| {"rx_bytes", NETXEN_NIC_STAT(stats.rxbytes)}, |
| {"tx_bytes", NETXEN_NIC_STAT(stats.txbytes)}, |
| }; |
| |
| #define NETXEN_NIC_STATS_LEN ARRAY_SIZE(netxen_nic_gstrings_stats) |
| |
| static const char netxen_nic_gstrings_test[][ETH_GSTRING_LEN] = { |
| "Register_Test_on_offline", |
| "Link_Test_on_offline" |
| }; |
| |
| #define NETXEN_NIC_TEST_LEN sizeof(netxen_nic_gstrings_test) / ETH_GSTRING_LEN |
| |
| #define NETXEN_NIC_REGS_COUNT 42 |
| #define NETXEN_NIC_REGS_LEN (NETXEN_NIC_REGS_COUNT * sizeof(__le32)) |
| #define NETXEN_MAX_EEPROM_LEN 1024 |
| |
| static int netxen_nic_get_eeprom_len(struct net_device *dev) |
| { |
| return FLASH_TOTAL_SIZE; |
| } |
| |
| static void |
| netxen_nic_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *drvinfo) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| u32 fw_major = 0; |
| u32 fw_minor = 0; |
| u32 fw_build = 0; |
| |
| strncpy(drvinfo->driver, netxen_nic_driver_name, 32); |
| strncpy(drvinfo->version, NETXEN_NIC_LINUX_VERSIONID, 32); |
| fw_major = readl(NETXEN_CRB_NORMALIZE(adapter, |
| NETXEN_FW_VERSION_MAJOR)); |
| fw_minor = readl(NETXEN_CRB_NORMALIZE(adapter, |
| NETXEN_FW_VERSION_MINOR)); |
| fw_build = readl(NETXEN_CRB_NORMALIZE(adapter, NETXEN_FW_VERSION_SUB)); |
| sprintf(drvinfo->fw_version, "%d.%d.%d", fw_major, fw_minor, fw_build); |
| |
| strncpy(drvinfo->bus_info, pci_name(adapter->pdev), 32); |
| drvinfo->n_stats = NETXEN_NIC_STATS_LEN; |
| drvinfo->testinfo_len = NETXEN_NIC_TEST_LEN; |
| drvinfo->regdump_len = NETXEN_NIC_REGS_LEN; |
| drvinfo->eedump_len = netxen_nic_get_eeprom_len(dev); |
| } |
| |
| static int |
| netxen_nic_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| struct netxen_board_info *boardinfo = &adapter->ahw.boardcfg; |
| |
| /* read which mode */ |
| if (adapter->ahw.board_type == NETXEN_NIC_GBE) { |
| ecmd->supported = (SUPPORTED_10baseT_Half | |
| SUPPORTED_10baseT_Full | |
| SUPPORTED_100baseT_Half | |
| SUPPORTED_100baseT_Full | |
| SUPPORTED_1000baseT_Half | |
| SUPPORTED_1000baseT_Full); |
| |
| ecmd->advertising = (ADVERTISED_100baseT_Half | |
| ADVERTISED_100baseT_Full | |
| ADVERTISED_1000baseT_Half | |
| ADVERTISED_1000baseT_Full); |
| |
| ecmd->port = PORT_TP; |
| |
| if (netif_running(dev)) { |
| ecmd->speed = adapter->link_speed; |
| ecmd->duplex = adapter->link_duplex; |
| } else |
| return -EIO; /* link absent */ |
| } else if (adapter->ahw.board_type == NETXEN_NIC_XGBE) { |
| ecmd->supported = (SUPPORTED_TP | |
| SUPPORTED_1000baseT_Full | |
| SUPPORTED_10000baseT_Full); |
| ecmd->advertising = (ADVERTISED_TP | |
| ADVERTISED_1000baseT_Full | |
| ADVERTISED_10000baseT_Full); |
| ecmd->port = PORT_TP; |
| |
| ecmd->speed = SPEED_10000; |
| ecmd->duplex = DUPLEX_FULL; |
| ecmd->autoneg = AUTONEG_DISABLE; |
| } else |
| return -EIO; |
| |
| ecmd->phy_address = adapter->portnum; |
| ecmd->transceiver = XCVR_EXTERNAL; |
| |
| switch ((netxen_brdtype_t) boardinfo->board_type) { |
| case NETXEN_BRDTYPE_P2_SB35_4G: |
| case NETXEN_BRDTYPE_P2_SB31_2G: |
| ecmd->supported |= SUPPORTED_Autoneg; |
| ecmd->advertising |= ADVERTISED_Autoneg; |
| case NETXEN_BRDTYPE_P2_SB31_10G_CX4: |
| ecmd->supported |= SUPPORTED_TP; |
| ecmd->advertising |= ADVERTISED_TP; |
| ecmd->port = PORT_TP; |
| ecmd->autoneg = (boardinfo->board_type == |
| NETXEN_BRDTYPE_P2_SB31_10G_CX4) ? |
| (AUTONEG_DISABLE) : (adapter->link_autoneg); |
| break; |
| case NETXEN_BRDTYPE_P2_SB31_10G_HMEZ: |
| case NETXEN_BRDTYPE_P2_SB31_10G_IMEZ: |
| ecmd->supported |= SUPPORTED_MII; |
| ecmd->advertising |= ADVERTISED_MII; |
| ecmd->port = PORT_FIBRE; |
| ecmd->autoneg = AUTONEG_DISABLE; |
| break; |
| case NETXEN_BRDTYPE_P2_SB31_10G: |
| ecmd->supported |= SUPPORTED_FIBRE; |
| ecmd->advertising |= ADVERTISED_FIBRE; |
| ecmd->port = PORT_FIBRE; |
| ecmd->autoneg = AUTONEG_DISABLE; |
| break; |
| default: |
| printk(KERN_ERR "netxen-nic: Unsupported board model %d\n", |
| (netxen_brdtype_t) boardinfo->board_type); |
| return -EIO; |
| } |
| |
| return 0; |
| } |
| |
| static int |
| netxen_nic_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| __u32 status; |
| |
| /* read which mode */ |
| if (adapter->ahw.board_type == NETXEN_NIC_GBE) { |
| /* autonegotiation */ |
| if (adapter->phy_write |
| && adapter->phy_write(adapter, adapter->portnum, |
| NETXEN_NIU_GB_MII_MGMT_ADDR_AUTONEG, |
| ecmd->autoneg) != 0) |
| return -EIO; |
| else |
| adapter->link_autoneg = ecmd->autoneg; |
| |
| if (adapter->phy_read |
| && adapter->phy_read(adapter, adapter->portnum, |
| NETXEN_NIU_GB_MII_MGMT_ADDR_PHY_STATUS, |
| &status) != 0) |
| return -EIO; |
| |
| /* speed */ |
| switch (ecmd->speed) { |
| case SPEED_10: |
| netxen_set_phy_speed(status, 0); |
| break; |
| case SPEED_100: |
| netxen_set_phy_speed(status, 1); |
| break; |
| case SPEED_1000: |
| netxen_set_phy_speed(status, 2); |
| break; |
| } |
| /* set duplex mode */ |
| if (ecmd->duplex == DUPLEX_HALF) |
| netxen_clear_phy_duplex(status); |
| if (ecmd->duplex == DUPLEX_FULL) |
| netxen_set_phy_duplex(status); |
| if (adapter->phy_write |
| && adapter->phy_write(adapter, adapter->portnum, |
| NETXEN_NIU_GB_MII_MGMT_ADDR_PHY_STATUS, |
| *((int *)&status)) != 0) |
| return -EIO; |
| else { |
| adapter->link_speed = ecmd->speed; |
| adapter->link_duplex = ecmd->duplex; |
| } |
| } else |
| return -EOPNOTSUPP; |
| |
| if (netif_running(dev)) { |
| dev->stop(dev); |
| dev->open(dev); |
| } |
| return 0; |
| } |
| |
| static int netxen_nic_get_regs_len(struct net_device *dev) |
| { |
| return NETXEN_NIC_REGS_LEN; |
| } |
| |
| struct netxen_niu_regs { |
| __u32 reg[NETXEN_NIC_REGS_COUNT]; |
| }; |
| |
| static struct netxen_niu_regs niu_registers[] = { |
| { |
| /* GB Mode */ |
| { |
| NETXEN_NIU_GB_SERDES_RESET, |
| NETXEN_NIU_GB0_MII_MODE, |
| NETXEN_NIU_GB1_MII_MODE, |
| NETXEN_NIU_GB2_MII_MODE, |
| NETXEN_NIU_GB3_MII_MODE, |
| NETXEN_NIU_GB0_GMII_MODE, |
| NETXEN_NIU_GB1_GMII_MODE, |
| NETXEN_NIU_GB2_GMII_MODE, |
| NETXEN_NIU_GB3_GMII_MODE, |
| NETXEN_NIU_REMOTE_LOOPBACK, |
| NETXEN_NIU_GB0_HALF_DUPLEX, |
| NETXEN_NIU_GB1_HALF_DUPLEX, |
| NETXEN_NIU_RESET_SYS_FIFOS, |
| NETXEN_NIU_GB_CRC_DROP, |
| NETXEN_NIU_GB_DROP_WRONGADDR, |
| NETXEN_NIU_TEST_MUX_CTL, |
| |
| NETXEN_NIU_GB_MAC_CONFIG_0(0), |
| NETXEN_NIU_GB_MAC_CONFIG_1(0), |
| NETXEN_NIU_GB_HALF_DUPLEX_CTRL(0), |
| NETXEN_NIU_GB_MAX_FRAME_SIZE(0), |
| NETXEN_NIU_GB_TEST_REG(0), |
| NETXEN_NIU_GB_MII_MGMT_CONFIG(0), |
| NETXEN_NIU_GB_MII_MGMT_COMMAND(0), |
| NETXEN_NIU_GB_MII_MGMT_ADDR(0), |
| NETXEN_NIU_GB_MII_MGMT_CTRL(0), |
| NETXEN_NIU_GB_MII_MGMT_STATUS(0), |
| NETXEN_NIU_GB_MII_MGMT_INDICATE(0), |
| NETXEN_NIU_GB_INTERFACE_CTRL(0), |
| NETXEN_NIU_GB_INTERFACE_STATUS(0), |
| NETXEN_NIU_GB_STATION_ADDR_0(0), |
| NETXEN_NIU_GB_STATION_ADDR_1(0), |
| -1, |
| } |
| }, |
| { |
| /* XG Mode */ |
| { |
| NETXEN_NIU_XG_SINGLE_TERM, |
| NETXEN_NIU_XG_DRIVE_HI, |
| NETXEN_NIU_XG_DRIVE_LO, |
| NETXEN_NIU_XG_DTX, |
| NETXEN_NIU_XG_DEQ, |
| NETXEN_NIU_XG_WORD_ALIGN, |
| NETXEN_NIU_XG_RESET, |
| NETXEN_NIU_XG_POWER_DOWN, |
| NETXEN_NIU_XG_RESET_PLL, |
| NETXEN_NIU_XG_SERDES_LOOPBACK, |
| NETXEN_NIU_XG_DO_BYTE_ALIGN, |
| NETXEN_NIU_XG_TX_ENABLE, |
| NETXEN_NIU_XG_RX_ENABLE, |
| NETXEN_NIU_XG_STATUS, |
| NETXEN_NIU_XG_PAUSE_THRESHOLD, |
| NETXEN_NIU_XGE_CONFIG_0, |
| NETXEN_NIU_XGE_CONFIG_1, |
| NETXEN_NIU_XGE_IPG, |
| NETXEN_NIU_XGE_STATION_ADDR_0_HI, |
| NETXEN_NIU_XGE_STATION_ADDR_0_1, |
| NETXEN_NIU_XGE_STATION_ADDR_1_LO, |
| NETXEN_NIU_XGE_STATUS, |
| NETXEN_NIU_XGE_MAX_FRAME_SIZE, |
| NETXEN_NIU_XGE_PAUSE_FRAME_VALUE, |
| NETXEN_NIU_XGE_TX_BYTE_CNT, |
| NETXEN_NIU_XGE_TX_FRAME_CNT, |
| NETXEN_NIU_XGE_RX_BYTE_CNT, |
| NETXEN_NIU_XGE_RX_FRAME_CNT, |
| NETXEN_NIU_XGE_AGGR_ERROR_CNT, |
| NETXEN_NIU_XGE_MULTICAST_FRAME_CNT, |
| NETXEN_NIU_XGE_UNICAST_FRAME_CNT, |
| NETXEN_NIU_XGE_CRC_ERROR_CNT, |
| NETXEN_NIU_XGE_OVERSIZE_FRAME_ERR, |
| NETXEN_NIU_XGE_UNDERSIZE_FRAME_ERR, |
| NETXEN_NIU_XGE_LOCAL_ERROR_CNT, |
| NETXEN_NIU_XGE_REMOTE_ERROR_CNT, |
| NETXEN_NIU_XGE_CONTROL_CHAR_CNT, |
| NETXEN_NIU_XGE_PAUSE_FRAME_CNT, |
| -1, |
| } |
| } |
| }; |
| |
| static void |
| netxen_nic_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *p) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| __u32 mode, *regs_buff = p; |
| void __iomem *addr; |
| int i, window; |
| |
| memset(p, 0, NETXEN_NIC_REGS_LEN); |
| regs->version = (1 << 24) | (adapter->ahw.revision_id << 16) | |
| (adapter->pdev)->device; |
| /* which mode */ |
| NETXEN_NIC_LOCKED_READ_REG(NETXEN_NIU_MODE, ®s_buff[0]); |
| mode = regs_buff[0]; |
| |
| /* Common registers to all the modes */ |
| NETXEN_NIC_LOCKED_READ_REG(NETXEN_NIU_STRAP_VALUE_SAVE_HIGHER, |
| ®s_buff[2]); |
| /* GB/XGB Mode */ |
| mode = (mode / 2) - 1; |
| window = 0; |
| if (mode <= 1) { |
| for (i = 3; niu_registers[mode].reg[i - 3] != -1; i++) { |
| /* GB: port specific registers */ |
| if (mode == 0 && i >= 19) |
| window = adapter->portnum * |
| NETXEN_NIC_PORT_WINDOW; |
| |
| NETXEN_NIC_LOCKED_READ_REG(niu_registers[mode]. |
| reg[i - 3] + window, |
| ®s_buff[i]); |
| } |
| |
| } |
| } |
| |
| static u32 netxen_nic_test_link(struct net_device *dev) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| __u32 status; |
| int val; |
| |
| /* read which mode */ |
| if (adapter->ahw.board_type == NETXEN_NIC_GBE) { |
| if (adapter->phy_read |
| && adapter->phy_read(adapter, adapter->portnum, |
| NETXEN_NIU_GB_MII_MGMT_ADDR_PHY_STATUS, |
| &status) != 0) |
| return -EIO; |
| else { |
| val = netxen_get_phy_link(status); |
| return !val; |
| } |
| } else if (adapter->ahw.board_type == NETXEN_NIC_XGBE) { |
| val = readl(NETXEN_CRB_NORMALIZE(adapter, CRB_XG_STATE)); |
| return (val == XG_LINK_UP) ? 0 : 1; |
| } |
| return -EIO; |
| } |
| |
| static int |
| netxen_nic_get_eeprom(struct net_device *dev, struct ethtool_eeprom *eeprom, |
| u8 * bytes) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| int offset; |
| int ret; |
| |
| if (eeprom->len == 0) |
| return -EINVAL; |
| |
| eeprom->magic = (adapter->pdev)->vendor | |
| ((adapter->pdev)->device << 16); |
| offset = eeprom->offset; |
| |
| ret = netxen_rom_fast_read_words(adapter, offset, bytes, |
| eeprom->len); |
| if (ret < 0) |
| return ret; |
| |
| return 0; |
| } |
| |
| static int |
| netxen_nic_set_eeprom(struct net_device *dev, struct ethtool_eeprom *eeprom, |
| u8 * bytes) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| int offset = eeprom->offset; |
| static int flash_start; |
| static int ready_to_flash; |
| int ret; |
| |
| if (flash_start == 0) { |
| netxen_halt_pegs(adapter); |
| ret = netxen_flash_unlock(adapter); |
| if (ret < 0) { |
| printk(KERN_ERR "%s: Flash unlock failed.\n", |
| netxen_nic_driver_name); |
| return ret; |
| } |
| printk(KERN_INFO "%s: flash unlocked. \n", |
| netxen_nic_driver_name); |
| last_schedule_time = jiffies; |
| ret = netxen_flash_erase_secondary(adapter); |
| if (ret != FLASH_SUCCESS) { |
| printk(KERN_ERR "%s: Flash erase failed.\n", |
| netxen_nic_driver_name); |
| return ret; |
| } |
| printk(KERN_INFO "%s: secondary flash erased successfully.\n", |
| netxen_nic_driver_name); |
| flash_start = 1; |
| return 0; |
| } |
| |
| if (offset == BOOTLD_START) { |
| ret = netxen_flash_erase_primary(adapter); |
| if (ret != FLASH_SUCCESS) { |
| printk(KERN_ERR "%s: Flash erase failed.\n", |
| netxen_nic_driver_name); |
| return ret; |
| } |
| |
| ret = netxen_rom_se(adapter, USER_START); |
| if (ret != FLASH_SUCCESS) |
| return ret; |
| ret = netxen_rom_se(adapter, FIXED_START); |
| if (ret != FLASH_SUCCESS) |
| return ret; |
| |
| printk(KERN_INFO "%s: primary flash erased successfully\n", |
| netxen_nic_driver_name); |
| |
| ret = netxen_backup_crbinit(adapter); |
| if (ret != FLASH_SUCCESS) { |
| printk(KERN_ERR "%s: CRBinit backup failed.\n", |
| netxen_nic_driver_name); |
| return ret; |
| } |
| printk(KERN_INFO "%s: CRBinit backup done.\n", |
| netxen_nic_driver_name); |
| ready_to_flash = 1; |
| } |
| |
| if (!ready_to_flash) { |
| printk(KERN_ERR "%s: Invalid write sequence, returning...\n", |
| netxen_nic_driver_name); |
| return -EINVAL; |
| } |
| |
| return netxen_rom_fast_write_words(adapter, offset, bytes, eeprom->len); |
| } |
| |
| static void |
| netxen_nic_get_ringparam(struct net_device *dev, struct ethtool_ringparam *ring) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| int i; |
| |
| ring->rx_pending = 0; |
| ring->rx_jumbo_pending = 0; |
| for (i = 0; i < MAX_RCV_CTX; ++i) { |
| ring->rx_pending += adapter->recv_ctx[i]. |
| rcv_desc[RCV_DESC_NORMAL_CTXID].rcv_pending; |
| ring->rx_jumbo_pending += adapter->recv_ctx[i]. |
| rcv_desc[RCV_DESC_JUMBO_CTXID].rcv_pending; |
| } |
| |
| ring->rx_max_pending = adapter->max_rx_desc_count; |
| ring->tx_max_pending = adapter->max_tx_desc_count; |
| ring->rx_jumbo_max_pending = adapter->max_jumbo_rx_desc_count; |
| ring->rx_mini_max_pending = 0; |
| ring->rx_mini_pending = 0; |
| ring->rx_jumbo_pending = 0; |
| } |
| |
| static void |
| netxen_nic_get_pauseparam(struct net_device *dev, |
| struct ethtool_pauseparam *pause) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| __u32 val; |
| |
| if (adapter->ahw.board_type == NETXEN_NIC_GBE) { |
| /* get flow control settings */ |
| netxen_nic_read_w0(adapter, |
| NETXEN_NIU_GB_MAC_CONFIG_0(adapter->portnum), |
| &val); |
| pause->rx_pause = netxen_gb_get_rx_flowctl(val); |
| pause->tx_pause = netxen_gb_get_tx_flowctl(val); |
| /* get autoneg settings */ |
| pause->autoneg = adapter->link_autoneg; |
| } |
| } |
| |
| static int |
| netxen_nic_set_pauseparam(struct net_device *dev, |
| struct ethtool_pauseparam *pause) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| __u32 val; |
| unsigned int autoneg; |
| |
| /* read mode */ |
| if (adapter->ahw.board_type == NETXEN_NIC_GBE) { |
| /* set flow control */ |
| netxen_nic_read_w0(adapter, |
| NETXEN_NIU_GB_MAC_CONFIG_0(adapter->portnum), |
| (u32 *) & val); |
| if (pause->tx_pause) |
| netxen_gb_tx_flowctl(val); |
| else |
| netxen_gb_unset_tx_flowctl(val); |
| if (pause->rx_pause) |
| netxen_gb_rx_flowctl(val); |
| else |
| netxen_gb_unset_rx_flowctl(val); |
| |
| netxen_nic_write_w0(adapter, |
| NETXEN_NIU_GB_MAC_CONFIG_0(adapter->portnum), |
| *&val); |
| /* set autoneg */ |
| autoneg = pause->autoneg; |
| if (adapter->phy_write |
| && adapter->phy_write(adapter, adapter->portnum, |
| NETXEN_NIU_GB_MII_MGMT_ADDR_AUTONEG, |
| autoneg) != 0) |
| return -EIO; |
| else { |
| adapter->link_autoneg = pause->autoneg; |
| return 0; |
| } |
| } else |
| return -EOPNOTSUPP; |
| } |
| |
| static int netxen_nic_reg_test(struct net_device *dev) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| u32 data_read, data_written; |
| |
| netxen_nic_read_w0(adapter, NETXEN_PCIX_PH_REG(0), &data_read); |
| if ((data_read & 0xffff) != PHAN_VENDOR_ID) |
| return 1; |
| |
| data_written = (u32)0xa5a5a5a5; |
| |
| netxen_nic_reg_write(adapter, CRB_SCRATCHPAD_TEST, data_written); |
| data_read = readl(NETXEN_CRB_NORMALIZE(adapter, CRB_SCRATCHPAD_TEST)); |
| if (data_written != data_read) |
| return 1; |
| |
| return 0; |
| } |
| |
| static int netxen_nic_diag_test_count(struct net_device *dev) |
| { |
| return NETXEN_NIC_TEST_LEN; |
| } |
| |
| static void |
| netxen_nic_diag_test(struct net_device *dev, struct ethtool_test *eth_test, |
| u64 * data) |
| { |
| if (eth_test->flags == ETH_TEST_FL_OFFLINE) { /* offline tests */ |
| /* link test */ |
| if ((data[1] = (u64) netxen_nic_test_link(dev))) |
| eth_test->flags |= ETH_TEST_FL_FAILED; |
| |
| /* register tests */ |
| if ((data[0] = netxen_nic_reg_test(dev))) |
| eth_test->flags |= ETH_TEST_FL_FAILED; |
| } else { /* online tests */ |
| /* register tests */ |
| if((data[0] = netxen_nic_reg_test(dev))) |
| eth_test->flags |= ETH_TEST_FL_FAILED; |
| |
| /* link test */ |
| if ((data[1] = (u64) netxen_nic_test_link(dev))) |
| eth_test->flags |= ETH_TEST_FL_FAILED; |
| } |
| } |
| |
| static void |
| netxen_nic_get_strings(struct net_device *dev, u32 stringset, u8 * data) |
| { |
| int index; |
| |
| switch (stringset) { |
| case ETH_SS_TEST: |
| memcpy(data, *netxen_nic_gstrings_test, |
| NETXEN_NIC_TEST_LEN * ETH_GSTRING_LEN); |
| break; |
| case ETH_SS_STATS: |
| for (index = 0; index < NETXEN_NIC_STATS_LEN; index++) { |
| memcpy(data + index * ETH_GSTRING_LEN, |
| netxen_nic_gstrings_stats[index].stat_string, |
| ETH_GSTRING_LEN); |
| } |
| break; |
| } |
| } |
| |
| static int netxen_nic_get_stats_count(struct net_device *dev) |
| { |
| return NETXEN_NIC_STATS_LEN; |
| } |
| |
| static void |
| netxen_nic_get_ethtool_stats(struct net_device *dev, |
| struct ethtool_stats *stats, u64 * data) |
| { |
| struct netxen_adapter *adapter = netdev_priv(dev); |
| int index; |
| |
| for (index = 0; index < NETXEN_NIC_STATS_LEN; index++) { |
| char *p = |
| (char *)adapter + |
| netxen_nic_gstrings_stats[index].stat_offset; |
| data[index] = |
| (netxen_nic_gstrings_stats[index].sizeof_stat == |
| sizeof(u64)) ? *(u64 *) p : *(u32 *) p; |
| } |
| } |
| |
| struct ethtool_ops netxen_nic_ethtool_ops = { |
| .get_settings = netxen_nic_get_settings, |
| .set_settings = netxen_nic_set_settings, |
| .get_drvinfo = netxen_nic_get_drvinfo, |
| .get_regs_len = netxen_nic_get_regs_len, |
| .get_regs = netxen_nic_get_regs, |
| .get_link = ethtool_op_get_link, |
| .get_eeprom_len = netxen_nic_get_eeprom_len, |
| .get_eeprom = netxen_nic_get_eeprom, |
| .set_eeprom = netxen_nic_set_eeprom, |
| .get_ringparam = netxen_nic_get_ringparam, |
| .get_pauseparam = netxen_nic_get_pauseparam, |
| .set_pauseparam = netxen_nic_set_pauseparam, |
| .get_tx_csum = ethtool_op_get_tx_csum, |
| .set_tx_csum = ethtool_op_set_tx_csum, |
| .get_sg = ethtool_op_get_sg, |
| .set_sg = ethtool_op_set_sg, |
| .get_tso = ethtool_op_get_tso, |
| .set_tso = ethtool_op_set_tso, |
| .self_test_count = netxen_nic_diag_test_count, |
| .self_test = netxen_nic_diag_test, |
| .get_strings = netxen_nic_get_strings, |
| .get_stats_count = netxen_nic_get_stats_count, |
| .get_ethtool_stats = netxen_nic_get_ethtool_stats, |
| .get_perm_addr = ethtool_op_get_perm_addr, |
| }; |