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 651a863212SIra Weiny ib_get_device_fw_str(priv->ca, drvinfo->fw_version, 661a863212SIra Weiny sizeof(drvinfo->fw_version)); 674b48680bSYan Burman 68db97ed0aSBart Van Assche strlcpy(drvinfo->bus_info, dev_name(priv->ca->dev.parent), 694b48680bSYan Burman sizeof(drvinfo->bus_info)); 704b48680bSYan Burman 714b48680bSYan Burman strlcpy(drvinfo->version, ipoib_driver_version, 724b48680bSYan Burman sizeof(drvinfo->version)); 734b48680bSYan Burman 744b48680bSYan Burman strlcpy(drvinfo->driver, "ib_ipoib", sizeof(drvinfo->driver)); 7582c24c18SEli Cohen } 7682c24c18SEli Cohen 7728d52b3cSEli Cohen static int ipoib_get_coalesce(struct net_device *dev, 7828d52b3cSEli Cohen struct ethtool_coalesce *coal) 7928d52b3cSEli Cohen { 80c1048affSErez Shitrit struct ipoib_dev_priv *priv = ipoib_priv(dev); 8128d52b3cSEli Cohen 8228d52b3cSEli Cohen coal->rx_coalesce_usecs = priv->ethtool.coalesce_usecs; 8328d52b3cSEli Cohen coal->rx_max_coalesced_frames = priv->ethtool.max_coalesced_frames; 8428d52b3cSEli Cohen 8528d52b3cSEli Cohen return 0; 8628d52b3cSEli Cohen } 8728d52b3cSEli Cohen 8828d52b3cSEli Cohen static int ipoib_set_coalesce(struct net_device *dev, 8928d52b3cSEli Cohen struct ethtool_coalesce *coal) 9028d52b3cSEli Cohen { 91c1048affSErez Shitrit struct ipoib_dev_priv *priv = ipoib_priv(dev); 9228d52b3cSEli Cohen int ret; 9328d52b3cSEli Cohen 9428d52b3cSEli Cohen /* 95757bebb3SOr Gerlitz * These values are saved in the private data and returned 96757bebb3SOr Gerlitz * when ipoib_get_coalesce() is called 9728d52b3cSEli Cohen */ 9828d52b3cSEli Cohen if (coal->rx_coalesce_usecs > 0xffff || 9928d52b3cSEli Cohen coal->rx_max_coalesced_frames > 0xffff) 10028d52b3cSEli Cohen return -EINVAL; 10128d52b3cSEli Cohen 102f56bcd80SEli Cohen ret = ib_modify_cq(priv->recv_cq, coal->rx_max_coalesced_frames, 10328d52b3cSEli Cohen coal->rx_coalesce_usecs); 10428d52b3cSEli Cohen if (ret && ret != -ENOSYS) { 10528d52b3cSEli Cohen ipoib_warn(priv, "failed modifying CQ (%d)\n", ret); 10628d52b3cSEli Cohen return ret; 10728d52b3cSEli Cohen } 10828d52b3cSEli Cohen 10928d52b3cSEli Cohen priv->ethtool.coalesce_usecs = coal->rx_coalesce_usecs; 11028d52b3cSEli Cohen priv->ethtool.max_coalesced_frames = coal->rx_max_coalesced_frames; 11128d52b3cSEli Cohen 11228d52b3cSEli Cohen return 0; 11328d52b3cSEli Cohen } 114e3614bc9SHans Westgaard Ry static void ipoib_get_ethtool_stats(struct net_device *dev, 115e3614bc9SHans Westgaard Ry struct ethtool_stats __always_unused *stats, 116e3614bc9SHans Westgaard Ry u64 *data) 117e3614bc9SHans Westgaard Ry { 118e3614bc9SHans Westgaard Ry int i; 119e3614bc9SHans Westgaard Ry struct net_device_stats *net_stats = &dev->stats; 120e3614bc9SHans Westgaard Ry u8 *p = (u8 *)net_stats; 121e3614bc9SHans Westgaard Ry 122e3614bc9SHans Westgaard Ry for (i = 0; i < IPOIB_GLOBAL_STATS_LEN; i++) 123e3614bc9SHans Westgaard Ry data[i] = *(u64 *)(p + ipoib_gstrings_stats[i].stat_offset); 124e3614bc9SHans Westgaard Ry 125e3614bc9SHans Westgaard Ry } 126e3614bc9SHans Westgaard Ry static void ipoib_get_strings(struct net_device __always_unused *dev, 127e3614bc9SHans Westgaard Ry u32 stringset, u8 *data) 128e3614bc9SHans Westgaard Ry { 129e3614bc9SHans Westgaard Ry u8 *p = data; 130e3614bc9SHans Westgaard Ry int i; 131e3614bc9SHans Westgaard Ry 132e3614bc9SHans Westgaard Ry switch (stringset) { 133e3614bc9SHans Westgaard Ry case ETH_SS_STATS: 134e3614bc9SHans Westgaard Ry for (i = 0; i < IPOIB_GLOBAL_STATS_LEN; i++) { 135e3614bc9SHans Westgaard Ry memcpy(p, ipoib_gstrings_stats[i].stat_string, 136e3614bc9SHans Westgaard Ry ETH_GSTRING_LEN); 137e3614bc9SHans Westgaard Ry p += ETH_GSTRING_LEN; 138e3614bc9SHans Westgaard Ry } 139e3614bc9SHans Westgaard Ry break; 140e3614bc9SHans Westgaard Ry case ETH_SS_TEST: 141e3614bc9SHans Westgaard Ry default: 142e3614bc9SHans Westgaard Ry break; 143e3614bc9SHans Westgaard Ry } 144e3614bc9SHans Westgaard Ry } 145e3614bc9SHans Westgaard Ry static int ipoib_get_sset_count(struct net_device __always_unused *dev, 146e3614bc9SHans Westgaard Ry int sset) 147e3614bc9SHans Westgaard Ry { 148e3614bc9SHans Westgaard Ry switch (sset) { 149e3614bc9SHans Westgaard Ry case ETH_SS_STATS: 150e3614bc9SHans Westgaard Ry return IPOIB_GLOBAL_STATS_LEN; 151e3614bc9SHans Westgaard Ry case ETH_SS_TEST: 152e3614bc9SHans Westgaard Ry default: 153e3614bc9SHans Westgaard Ry break; 154e3614bc9SHans Westgaard Ry } 155e3614bc9SHans Westgaard Ry return -EOPNOTSUPP; 156e3614bc9SHans Westgaard Ry } 15728d52b3cSEli Cohen 1580d7e2d21SZhu Yanjun /* Return lane speed in unit of 1e6 bit/sec */ 1590d7e2d21SZhu Yanjun static inline int ib_speed_enum_to_int(int speed) 1600d7e2d21SZhu Yanjun { 1610d7e2d21SZhu Yanjun switch (speed) { 1620d7e2d21SZhu Yanjun case IB_SPEED_SDR: 1630d7e2d21SZhu Yanjun return SPEED_2500; 1640d7e2d21SZhu Yanjun case IB_SPEED_DDR: 1650d7e2d21SZhu Yanjun return SPEED_5000; 1660d7e2d21SZhu Yanjun case IB_SPEED_QDR: 1670d7e2d21SZhu Yanjun case IB_SPEED_FDR10: 1680d7e2d21SZhu Yanjun return SPEED_10000; 1690d7e2d21SZhu Yanjun case IB_SPEED_FDR: 1700d7e2d21SZhu Yanjun return SPEED_14000; 1710d7e2d21SZhu Yanjun case IB_SPEED_EDR: 1720d7e2d21SZhu Yanjun return SPEED_25000; 1730d7e2d21SZhu Yanjun } 1740d7e2d21SZhu Yanjun 1750d7e2d21SZhu Yanjun return SPEED_UNKNOWN; 1760d7e2d21SZhu Yanjun } 1770d7e2d21SZhu Yanjun 1780d7e2d21SZhu Yanjun static int ipoib_get_link_ksettings(struct net_device *netdev, 1790d7e2d21SZhu Yanjun struct ethtool_link_ksettings *cmd) 1800d7e2d21SZhu Yanjun { 1810d7e2d21SZhu Yanjun struct ipoib_dev_priv *priv = netdev_priv(netdev); 1820d7e2d21SZhu Yanjun struct ib_port_attr attr; 1830d7e2d21SZhu Yanjun int ret, speed, width; 1840d7e2d21SZhu Yanjun 1850d7e2d21SZhu Yanjun if (!netif_carrier_ok(netdev)) { 1860d7e2d21SZhu Yanjun cmd->base.speed = SPEED_UNKNOWN; 1870d7e2d21SZhu Yanjun cmd->base.duplex = DUPLEX_UNKNOWN; 1880d7e2d21SZhu Yanjun return 0; 1890d7e2d21SZhu Yanjun } 1900d7e2d21SZhu Yanjun 1910d7e2d21SZhu Yanjun ret = ib_query_port(priv->ca, priv->port, &attr); 1920d7e2d21SZhu Yanjun if (ret < 0) 1930d7e2d21SZhu Yanjun return -EINVAL; 1940d7e2d21SZhu Yanjun 1950d7e2d21SZhu Yanjun speed = ib_speed_enum_to_int(attr.active_speed); 1960d7e2d21SZhu Yanjun width = ib_width_enum_to_int(attr.active_width); 1970d7e2d21SZhu Yanjun 1980d7e2d21SZhu Yanjun if (speed < 0 || width < 0) 1990d7e2d21SZhu Yanjun return -EINVAL; 2000d7e2d21SZhu Yanjun 2010d7e2d21SZhu Yanjun /* Except the following are set, the other members of 2020d7e2d21SZhu Yanjun * the struct ethtool_link_settings are initialized to 2030d7e2d21SZhu Yanjun * zero in the function __ethtool_get_link_ksettings. 2040d7e2d21SZhu Yanjun */ 2050d7e2d21SZhu Yanjun cmd->base.speed = speed * width; 2060d7e2d21SZhu Yanjun cmd->base.duplex = DUPLEX_FULL; 2070d7e2d21SZhu Yanjun 2080d7e2d21SZhu Yanjun cmd->base.phy_address = 0xFF; 2090d7e2d21SZhu Yanjun 2100d7e2d21SZhu Yanjun cmd->base.autoneg = AUTONEG_ENABLE; 2110d7e2d21SZhu Yanjun cmd->base.port = PORT_OTHER; 2120d7e2d21SZhu Yanjun 2130d7e2d21SZhu Yanjun return 0; 2140d7e2d21SZhu Yanjun } 2150d7e2d21SZhu Yanjun 21682c24c18SEli Cohen static const struct ethtool_ops ipoib_ethtool_ops = { 2170d7e2d21SZhu Yanjun .get_link_ksettings = ipoib_get_link_ksettings, 21882c24c18SEli Cohen .get_drvinfo = ipoib_get_drvinfo, 21928d52b3cSEli Cohen .get_coalesce = ipoib_get_coalesce, 22028d52b3cSEli Cohen .set_coalesce = ipoib_set_coalesce, 221e3614bc9SHans Westgaard Ry .get_strings = ipoib_get_strings, 222e3614bc9SHans Westgaard Ry .get_ethtool_stats = ipoib_get_ethtool_stats, 223e3614bc9SHans Westgaard Ry .get_sset_count = ipoib_get_sset_count, 22482c24c18SEli Cohen }; 22582c24c18SEli Cohen 22682c24c18SEli Cohen void ipoib_set_ethtool_ops(struct net_device *dev) 22782c24c18SEli Cohen { 2287ad24ea4SWilfried Klaebe dev->ethtool_ops = &ipoib_ethtool_ops; 22982c24c18SEli Cohen } 230