182c24c18SEli Cohen /* 282c24c18SEli Cohen * Copyright (c) 2007 Mellanox Technologies. All rights reserved. 382c24c18SEli Cohen * 482c24c18SEli Cohen * This software is available to you under a choice of one of two 582c24c18SEli Cohen * licenses. You may choose to be licensed under the terms of the GNU 682c24c18SEli Cohen * General Public License (GPL) Version 2, available from the file 782c24c18SEli Cohen * COPYING in the main directory of this source tree, or the 882c24c18SEli Cohen * OpenIB.org BSD license below: 982c24c18SEli Cohen * 1082c24c18SEli Cohen * Redistribution and use in source and binary forms, with or 1182c24c18SEli Cohen * without modification, are permitted provided that the following 1282c24c18SEli Cohen * conditions are met: 1382c24c18SEli Cohen * 1482c24c18SEli Cohen * - Redistributions of source code must retain the above 1582c24c18SEli Cohen * copyright notice, this list of conditions and the following 1682c24c18SEli Cohen * disclaimer. 1782c24c18SEli Cohen * 1882c24c18SEli Cohen * - Redistributions in binary form must reproduce the above 1982c24c18SEli Cohen * copyright notice, this list of conditions and the following 2082c24c18SEli Cohen * disclaimer in the documentation and/or other materials 2182c24c18SEli Cohen * provided with the distribution. 2282c24c18SEli Cohen * 2382c24c18SEli Cohen * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 2482c24c18SEli Cohen * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 2582c24c18SEli Cohen * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 2682c24c18SEli Cohen * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 2782c24c18SEli Cohen * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 2882c24c18SEli Cohen * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 2982c24c18SEli Cohen * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 3082c24c18SEli Cohen * SOFTWARE. 3182c24c18SEli Cohen */ 3282c24c18SEli Cohen 3382c24c18SEli Cohen #include <linux/kernel.h> 3482c24c18SEli Cohen #include <linux/ethtool.h> 3582c24c18SEli Cohen #include <linux/netdevice.h> 3682c24c18SEli Cohen 3782c24c18SEli Cohen #include "ipoib.h" 3882c24c18SEli Cohen 39e3614bc9SHans Westgaard Ry struct ipoib_stats { 40e3614bc9SHans Westgaard Ry char stat_string[ETH_GSTRING_LEN]; 41e3614bc9SHans Westgaard Ry int stat_offset; 42e3614bc9SHans Westgaard Ry }; 43e3614bc9SHans Westgaard Ry 44e3614bc9SHans Westgaard Ry #define IPOIB_NETDEV_STAT(m) { \ 45e3614bc9SHans Westgaard Ry .stat_string = #m, \ 46e3614bc9SHans Westgaard Ry .stat_offset = offsetof(struct rtnl_link_stats64, m) } 47e3614bc9SHans Westgaard Ry 48e3614bc9SHans Westgaard Ry static const struct ipoib_stats ipoib_gstrings_stats[] = { 49e3614bc9SHans Westgaard Ry IPOIB_NETDEV_STAT(rx_packets), 50e3614bc9SHans Westgaard Ry IPOIB_NETDEV_STAT(tx_packets), 51e3614bc9SHans Westgaard Ry IPOIB_NETDEV_STAT(rx_bytes), 52e3614bc9SHans Westgaard Ry IPOIB_NETDEV_STAT(tx_bytes), 53e3614bc9SHans Westgaard Ry IPOIB_NETDEV_STAT(tx_errors), 54e3614bc9SHans Westgaard Ry IPOIB_NETDEV_STAT(rx_dropped), 55e3614bc9SHans Westgaard Ry IPOIB_NETDEV_STAT(tx_dropped) 56e3614bc9SHans Westgaard Ry }; 57e3614bc9SHans Westgaard Ry 58e3614bc9SHans Westgaard Ry #define IPOIB_GLOBAL_STATS_LEN ARRAY_SIZE(ipoib_gstrings_stats) 59e3614bc9SHans Westgaard Ry 6082c24c18SEli Cohen static void ipoib_get_drvinfo(struct net_device *netdev, 6182c24c18SEli Cohen struct ethtool_drvinfo *drvinfo) 6282c24c18SEli Cohen { 63c1048affSErez Shitrit struct ipoib_dev_priv *priv = ipoib_priv(netdev); 644b48680bSYan Burman 659abb0d1bSLeon Romanovsky ib_get_device_fw_str(priv->ca, drvinfo->fw_version); 664b48680bSYan Burman 67db97ed0aSBart Van Assche strlcpy(drvinfo->bus_info, dev_name(priv->ca->dev.parent), 684b48680bSYan Burman sizeof(drvinfo->bus_info)); 694b48680bSYan Burman 704b48680bSYan Burman strlcpy(drvinfo->version, ipoib_driver_version, 714b48680bSYan Burman sizeof(drvinfo->version)); 724b48680bSYan Burman 734b48680bSYan Burman strlcpy(drvinfo->driver, "ib_ipoib", sizeof(drvinfo->driver)); 7482c24c18SEli Cohen } 7582c24c18SEli Cohen 7628d52b3cSEli Cohen static int ipoib_get_coalesce(struct net_device *dev, 7728d52b3cSEli Cohen struct ethtool_coalesce *coal) 7828d52b3cSEli Cohen { 79c1048affSErez Shitrit struct ipoib_dev_priv *priv = ipoib_priv(dev); 8028d52b3cSEli Cohen 8128d52b3cSEli Cohen coal->rx_coalesce_usecs = priv->ethtool.coalesce_usecs; 8228d52b3cSEli Cohen coal->rx_max_coalesced_frames = priv->ethtool.max_coalesced_frames; 8328d52b3cSEli Cohen 8428d52b3cSEli Cohen return 0; 8528d52b3cSEli Cohen } 8628d52b3cSEli Cohen 8728d52b3cSEli Cohen static int ipoib_set_coalesce(struct net_device *dev, 8828d52b3cSEli Cohen struct ethtool_coalesce *coal) 8928d52b3cSEli Cohen { 90c1048affSErez Shitrit struct ipoib_dev_priv *priv = ipoib_priv(dev); 9128d52b3cSEli Cohen int ret; 9228d52b3cSEli Cohen 9328d52b3cSEli Cohen /* 94757bebb3SOr Gerlitz * These values are saved in the private data and returned 95757bebb3SOr Gerlitz * when ipoib_get_coalesce() is called 9628d52b3cSEli Cohen */ 9728d52b3cSEli Cohen if (coal->rx_coalesce_usecs > 0xffff || 9828d52b3cSEli Cohen coal->rx_max_coalesced_frames > 0xffff) 9928d52b3cSEli Cohen return -EINVAL; 10028d52b3cSEli Cohen 101f56bcd80SEli Cohen ret = ib_modify_cq(priv->recv_cq, coal->rx_max_coalesced_frames, 10228d52b3cSEli Cohen coal->rx_coalesce_usecs); 10328d52b3cSEli Cohen if (ret && ret != -ENOSYS) { 10428d52b3cSEli Cohen ipoib_warn(priv, "failed modifying CQ (%d)\n", ret); 10528d52b3cSEli Cohen return ret; 10628d52b3cSEli Cohen } 10728d52b3cSEli Cohen 10828d52b3cSEli Cohen priv->ethtool.coalesce_usecs = coal->rx_coalesce_usecs; 10928d52b3cSEli Cohen priv->ethtool.max_coalesced_frames = coal->rx_max_coalesced_frames; 11028d52b3cSEli Cohen 11128d52b3cSEli Cohen return 0; 11228d52b3cSEli Cohen } 113e3614bc9SHans Westgaard Ry static void ipoib_get_ethtool_stats(struct net_device *dev, 114e3614bc9SHans Westgaard Ry struct ethtool_stats __always_unused *stats, 115e3614bc9SHans Westgaard Ry u64 *data) 116e3614bc9SHans Westgaard Ry { 117e3614bc9SHans Westgaard Ry int i; 118e3614bc9SHans Westgaard Ry struct net_device_stats *net_stats = &dev->stats; 119e3614bc9SHans Westgaard Ry u8 *p = (u8 *)net_stats; 120e3614bc9SHans Westgaard Ry 121e3614bc9SHans Westgaard Ry for (i = 0; i < IPOIB_GLOBAL_STATS_LEN; i++) 122e3614bc9SHans Westgaard Ry data[i] = *(u64 *)(p + ipoib_gstrings_stats[i].stat_offset); 123e3614bc9SHans Westgaard Ry 124e3614bc9SHans Westgaard Ry } 125e3614bc9SHans Westgaard Ry static void ipoib_get_strings(struct net_device __always_unused *dev, 126e3614bc9SHans Westgaard Ry u32 stringset, u8 *data) 127e3614bc9SHans Westgaard Ry { 128e3614bc9SHans Westgaard Ry u8 *p = data; 129e3614bc9SHans Westgaard Ry int i; 130e3614bc9SHans Westgaard Ry 131e3614bc9SHans Westgaard Ry switch (stringset) { 132e3614bc9SHans Westgaard Ry case ETH_SS_STATS: 133e3614bc9SHans Westgaard Ry for (i = 0; i < IPOIB_GLOBAL_STATS_LEN; i++) { 134e3614bc9SHans Westgaard Ry memcpy(p, ipoib_gstrings_stats[i].stat_string, 135e3614bc9SHans Westgaard Ry ETH_GSTRING_LEN); 136e3614bc9SHans Westgaard Ry p += ETH_GSTRING_LEN; 137e3614bc9SHans Westgaard Ry } 138e3614bc9SHans Westgaard Ry break; 139e3614bc9SHans Westgaard Ry case ETH_SS_TEST: 140e3614bc9SHans Westgaard Ry default: 141e3614bc9SHans Westgaard Ry break; 142e3614bc9SHans Westgaard Ry } 143e3614bc9SHans Westgaard Ry } 144e3614bc9SHans Westgaard Ry static int ipoib_get_sset_count(struct net_device __always_unused *dev, 145e3614bc9SHans Westgaard Ry int sset) 146e3614bc9SHans Westgaard Ry { 147e3614bc9SHans Westgaard Ry switch (sset) { 148e3614bc9SHans Westgaard Ry case ETH_SS_STATS: 149e3614bc9SHans Westgaard Ry return IPOIB_GLOBAL_STATS_LEN; 150e3614bc9SHans Westgaard Ry case ETH_SS_TEST: 151e3614bc9SHans Westgaard Ry default: 152e3614bc9SHans Westgaard Ry break; 153e3614bc9SHans Westgaard Ry } 154e3614bc9SHans Westgaard Ry return -EOPNOTSUPP; 155e3614bc9SHans Westgaard Ry } 15628d52b3cSEli Cohen 1570d7e2d21SZhu Yanjun /* Return lane speed in unit of 1e6 bit/sec */ 1580d7e2d21SZhu Yanjun static inline int ib_speed_enum_to_int(int speed) 1590d7e2d21SZhu Yanjun { 1600d7e2d21SZhu Yanjun switch (speed) { 1610d7e2d21SZhu Yanjun case IB_SPEED_SDR: 1620d7e2d21SZhu Yanjun return SPEED_2500; 1630d7e2d21SZhu Yanjun case IB_SPEED_DDR: 1640d7e2d21SZhu Yanjun return SPEED_5000; 1650d7e2d21SZhu Yanjun case IB_SPEED_QDR: 1660d7e2d21SZhu Yanjun case IB_SPEED_FDR10: 1670d7e2d21SZhu Yanjun return SPEED_10000; 1680d7e2d21SZhu Yanjun case IB_SPEED_FDR: 1690d7e2d21SZhu Yanjun return SPEED_14000; 1700d7e2d21SZhu Yanjun case IB_SPEED_EDR: 1710d7e2d21SZhu Yanjun return SPEED_25000; 1720d7e2d21SZhu Yanjun } 1730d7e2d21SZhu Yanjun 1740d7e2d21SZhu Yanjun return SPEED_UNKNOWN; 1750d7e2d21SZhu Yanjun } 1760d7e2d21SZhu Yanjun 1770d7e2d21SZhu Yanjun static int ipoib_get_link_ksettings(struct net_device *netdev, 1780d7e2d21SZhu Yanjun struct ethtool_link_ksettings *cmd) 1790d7e2d21SZhu Yanjun { 1808c490669SHonggang Li struct ipoib_dev_priv *priv = ipoib_priv(netdev); 1810d7e2d21SZhu Yanjun struct ib_port_attr attr; 1820d7e2d21SZhu Yanjun int ret, speed, width; 1830d7e2d21SZhu Yanjun 1840d7e2d21SZhu Yanjun if (!netif_carrier_ok(netdev)) { 1850d7e2d21SZhu Yanjun cmd->base.speed = SPEED_UNKNOWN; 1860d7e2d21SZhu Yanjun cmd->base.duplex = DUPLEX_UNKNOWN; 1870d7e2d21SZhu Yanjun return 0; 1880d7e2d21SZhu Yanjun } 1890d7e2d21SZhu Yanjun 1900d7e2d21SZhu Yanjun ret = ib_query_port(priv->ca, priv->port, &attr); 1910d7e2d21SZhu Yanjun if (ret < 0) 1920d7e2d21SZhu Yanjun return -EINVAL; 1930d7e2d21SZhu Yanjun 1940d7e2d21SZhu Yanjun speed = ib_speed_enum_to_int(attr.active_speed); 1950d7e2d21SZhu Yanjun width = ib_width_enum_to_int(attr.active_width); 1960d7e2d21SZhu Yanjun 1970d7e2d21SZhu Yanjun if (speed < 0 || width < 0) 1980d7e2d21SZhu Yanjun return -EINVAL; 1990d7e2d21SZhu Yanjun 2000d7e2d21SZhu Yanjun /* Except the following are set, the other members of 2010d7e2d21SZhu Yanjun * the struct ethtool_link_settings are initialized to 2020d7e2d21SZhu Yanjun * zero in the function __ethtool_get_link_ksettings. 2030d7e2d21SZhu Yanjun */ 2040d7e2d21SZhu Yanjun cmd->base.speed = speed * width; 2050d7e2d21SZhu Yanjun cmd->base.duplex = DUPLEX_FULL; 2060d7e2d21SZhu Yanjun 2070d7e2d21SZhu Yanjun cmd->base.phy_address = 0xFF; 2080d7e2d21SZhu Yanjun 2090d7e2d21SZhu Yanjun cmd->base.autoneg = AUTONEG_ENABLE; 2100d7e2d21SZhu Yanjun cmd->base.port = PORT_OTHER; 2110d7e2d21SZhu Yanjun 2120d7e2d21SZhu Yanjun return 0; 2130d7e2d21SZhu Yanjun } 2140d7e2d21SZhu Yanjun 21582c24c18SEli Cohen static const struct ethtool_ops ipoib_ethtool_ops = { 2160d7e2d21SZhu Yanjun .get_link_ksettings = ipoib_get_link_ksettings, 21782c24c18SEli Cohen .get_drvinfo = ipoib_get_drvinfo, 21828d52b3cSEli Cohen .get_coalesce = ipoib_get_coalesce, 21928d52b3cSEli Cohen .set_coalesce = ipoib_set_coalesce, 220e3614bc9SHans Westgaard Ry .get_strings = ipoib_get_strings, 221e3614bc9SHans Westgaard Ry .get_ethtool_stats = ipoib_get_ethtool_stats, 222e3614bc9SHans Westgaard Ry .get_sset_count = ipoib_get_sset_count, 22382c24c18SEli Cohen }; 22482c24c18SEli Cohen 22582c24c18SEli Cohen void ipoib_set_ethtool_ops(struct net_device *dev) 22682c24c18SEli Cohen { 2277ad24ea4SWilfried Klaebe dev->ethtool_ops = &ipoib_ethtool_ops; 22882c24c18SEli Cohen } 229