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),
554829d964SAlex Vesker IPOIB_NETDEV_STAT(tx_dropped),
564829d964SAlex Vesker IPOIB_NETDEV_STAT(multicast),
57e3614bc9SHans Westgaard Ry };
58e3614bc9SHans Westgaard Ry
59e3614bc9SHans Westgaard Ry #define IPOIB_GLOBAL_STATS_LEN ARRAY_SIZE(ipoib_gstrings_stats)
60e3614bc9SHans Westgaard Ry
ipoib_get_drvinfo(struct net_device * netdev,struct ethtool_drvinfo * drvinfo)6182c24c18SEli Cohen static void ipoib_get_drvinfo(struct net_device *netdev,
6282c24c18SEli Cohen struct ethtool_drvinfo *drvinfo)
6382c24c18SEli Cohen {
64c1048affSErez Shitrit struct ipoib_dev_priv *priv = ipoib_priv(netdev);
654b48680bSYan Burman
669abb0d1bSLeon Romanovsky ib_get_device_fw_str(priv->ca, drvinfo->fw_version);
674b48680bSYan Burman
68*2c34bb6dSWolfram Sang strscpy(drvinfo->bus_info, dev_name(priv->ca->dev.parent),
694b48680bSYan Burman sizeof(drvinfo->bus_info));
704b48680bSYan Burman
71*2c34bb6dSWolfram Sang strscpy(drvinfo->driver, "ib_ipoib", sizeof(drvinfo->driver));
7282c24c18SEli Cohen }
7382c24c18SEli Cohen
ipoib_get_coalesce(struct net_device * dev,struct ethtool_coalesce * coal,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)7428d52b3cSEli Cohen static int ipoib_get_coalesce(struct net_device *dev,
75f3ccfda1SYufeng Mo struct ethtool_coalesce *coal,
76f3ccfda1SYufeng Mo struct kernel_ethtool_coalesce *kernel_coal,
77f3ccfda1SYufeng Mo struct netlink_ext_ack *extack)
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
ipoib_set_coalesce(struct net_device * dev,struct ethtool_coalesce * coal,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)8728d52b3cSEli Cohen static int ipoib_set_coalesce(struct net_device *dev,
88f3ccfda1SYufeng Mo struct ethtool_coalesce *coal,
89f3ccfda1SYufeng Mo struct kernel_ethtool_coalesce *kernel_coal,
90f3ccfda1SYufeng Mo struct netlink_ext_ack *extack)
9128d52b3cSEli Cohen {
92c1048affSErez Shitrit struct ipoib_dev_priv *priv = ipoib_priv(dev);
9328d52b3cSEli Cohen int ret;
9428d52b3cSEli Cohen
9528d52b3cSEli Cohen /*
96757bebb3SOr Gerlitz * These values are saved in the private data and returned
97757bebb3SOr Gerlitz * when ipoib_get_coalesce() is called
9828d52b3cSEli Cohen */
9928d52b3cSEli Cohen if (coal->rx_coalesce_usecs > 0xffff ||
10028d52b3cSEli Cohen coal->rx_max_coalesced_frames > 0xffff)
10128d52b3cSEli Cohen return -EINVAL;
10228d52b3cSEli Cohen
1034190b4e9SLeon Romanovsky ret = rdma_set_cq_moderation(priv->recv_cq,
1044190b4e9SLeon Romanovsky coal->rx_max_coalesced_frames,
10528d52b3cSEli Cohen coal->rx_coalesce_usecs);
10626e551c5SKamal Heib if (ret && ret != -EOPNOTSUPP) {
10728d52b3cSEli Cohen ipoib_warn(priv, "failed modifying CQ (%d)\n", ret);
10828d52b3cSEli Cohen return ret;
10928d52b3cSEli Cohen }
11028d52b3cSEli Cohen
11128d52b3cSEli Cohen priv->ethtool.coalesce_usecs = coal->rx_coalesce_usecs;
11228d52b3cSEli Cohen priv->ethtool.max_coalesced_frames = coal->rx_max_coalesced_frames;
11328d52b3cSEli Cohen
11428d52b3cSEli Cohen return 0;
11528d52b3cSEli Cohen }
ipoib_get_ethtool_stats(struct net_device * dev,struct ethtool_stats __always_unused * stats,u64 * data)116e3614bc9SHans Westgaard Ry static void ipoib_get_ethtool_stats(struct net_device *dev,
117e3614bc9SHans Westgaard Ry struct ethtool_stats __always_unused *stats,
118e3614bc9SHans Westgaard Ry u64 *data)
119e3614bc9SHans Westgaard Ry {
120e3614bc9SHans Westgaard Ry int i;
121e3614bc9SHans Westgaard Ry struct net_device_stats *net_stats = &dev->stats;
122e3614bc9SHans Westgaard Ry u8 *p = (u8 *)net_stats;
123e3614bc9SHans Westgaard Ry
124e3614bc9SHans Westgaard Ry for (i = 0; i < IPOIB_GLOBAL_STATS_LEN; i++)
125e3614bc9SHans Westgaard Ry data[i] = *(u64 *)(p + ipoib_gstrings_stats[i].stat_offset);
126e3614bc9SHans Westgaard Ry
127e3614bc9SHans Westgaard Ry }
ipoib_get_strings(struct net_device __always_unused * dev,u32 stringset,u8 * data)128e3614bc9SHans Westgaard Ry static void ipoib_get_strings(struct net_device __always_unused *dev,
129e3614bc9SHans Westgaard Ry u32 stringset, u8 *data)
130e3614bc9SHans Westgaard Ry {
131e3614bc9SHans Westgaard Ry u8 *p = data;
132e3614bc9SHans Westgaard Ry int i;
133e3614bc9SHans Westgaard Ry
134e3614bc9SHans Westgaard Ry switch (stringset) {
135e3614bc9SHans Westgaard Ry case ETH_SS_STATS:
136e3614bc9SHans Westgaard Ry for (i = 0; i < IPOIB_GLOBAL_STATS_LEN; i++) {
137e3614bc9SHans Westgaard Ry memcpy(p, ipoib_gstrings_stats[i].stat_string,
138e3614bc9SHans Westgaard Ry ETH_GSTRING_LEN);
139e3614bc9SHans Westgaard Ry p += ETH_GSTRING_LEN;
140e3614bc9SHans Westgaard Ry }
141e3614bc9SHans Westgaard Ry break;
142e3614bc9SHans Westgaard Ry default:
143e3614bc9SHans Westgaard Ry break;
144e3614bc9SHans Westgaard Ry }
145e3614bc9SHans Westgaard Ry }
ipoib_get_sset_count(struct net_device __always_unused * dev,int sset)146e3614bc9SHans Westgaard Ry static int ipoib_get_sset_count(struct net_device __always_unused *dev,
147e3614bc9SHans Westgaard Ry int sset)
148e3614bc9SHans Westgaard Ry {
149e3614bc9SHans Westgaard Ry switch (sset) {
150e3614bc9SHans Westgaard Ry case ETH_SS_STATS:
151e3614bc9SHans Westgaard Ry return IPOIB_GLOBAL_STATS_LEN;
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 */
ib_speed_enum_to_int(int speed)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;
173235b6ac3SMeir Lichtinger case IB_SPEED_HDR:
174235b6ac3SMeir Lichtinger return SPEED_50000;
175235b6ac3SMeir Lichtinger case IB_SPEED_NDR:
176235b6ac3SMeir Lichtinger return SPEED_100000;
1770d7e2d21SZhu Yanjun }
1780d7e2d21SZhu Yanjun
1790d7e2d21SZhu Yanjun return SPEED_UNKNOWN;
1800d7e2d21SZhu Yanjun }
1810d7e2d21SZhu Yanjun
ipoib_get_link_ksettings(struct net_device * netdev,struct ethtool_link_ksettings * cmd)1820d7e2d21SZhu Yanjun static int ipoib_get_link_ksettings(struct net_device *netdev,
1830d7e2d21SZhu Yanjun struct ethtool_link_ksettings *cmd)
1840d7e2d21SZhu Yanjun {
1858c490669SHonggang Li struct ipoib_dev_priv *priv = ipoib_priv(netdev);
1860d7e2d21SZhu Yanjun struct ib_port_attr attr;
1870d7e2d21SZhu Yanjun int ret, speed, width;
1880d7e2d21SZhu Yanjun
1890d7e2d21SZhu Yanjun if (!netif_carrier_ok(netdev)) {
1900d7e2d21SZhu Yanjun cmd->base.speed = SPEED_UNKNOWN;
1910d7e2d21SZhu Yanjun cmd->base.duplex = DUPLEX_UNKNOWN;
1920d7e2d21SZhu Yanjun return 0;
1930d7e2d21SZhu Yanjun }
1940d7e2d21SZhu Yanjun
1950d7e2d21SZhu Yanjun ret = ib_query_port(priv->ca, priv->port, &attr);
1960d7e2d21SZhu Yanjun if (ret < 0)
1970d7e2d21SZhu Yanjun return -EINVAL;
1980d7e2d21SZhu Yanjun
1990d7e2d21SZhu Yanjun speed = ib_speed_enum_to_int(attr.active_speed);
2000d7e2d21SZhu Yanjun width = ib_width_enum_to_int(attr.active_width);
2010d7e2d21SZhu Yanjun
2020d7e2d21SZhu Yanjun if (speed < 0 || width < 0)
2030d7e2d21SZhu Yanjun return -EINVAL;
2040d7e2d21SZhu Yanjun
2050d7e2d21SZhu Yanjun /* Except the following are set, the other members of
2060d7e2d21SZhu Yanjun * the struct ethtool_link_settings are initialized to
2070d7e2d21SZhu Yanjun * zero in the function __ethtool_get_link_ksettings.
2080d7e2d21SZhu Yanjun */
2090d7e2d21SZhu Yanjun cmd->base.speed = speed * width;
2100d7e2d21SZhu Yanjun cmd->base.duplex = DUPLEX_FULL;
2110d7e2d21SZhu Yanjun
2120d7e2d21SZhu Yanjun cmd->base.phy_address = 0xFF;
2130d7e2d21SZhu Yanjun
2140d7e2d21SZhu Yanjun cmd->base.autoneg = AUTONEG_ENABLE;
2150d7e2d21SZhu Yanjun cmd->base.port = PORT_OTHER;
2160d7e2d21SZhu Yanjun
2170d7e2d21SZhu Yanjun return 0;
2180d7e2d21SZhu Yanjun }
2190d7e2d21SZhu Yanjun
22082c24c18SEli Cohen static const struct ethtool_ops ipoib_ethtool_ops = {
221524250a3SJakub Kicinski .supported_coalesce_params = ETHTOOL_COALESCE_RX_USECS |
222524250a3SJakub Kicinski ETHTOOL_COALESCE_RX_MAX_FRAMES,
2230d7e2d21SZhu Yanjun .get_link_ksettings = ipoib_get_link_ksettings,
22482c24c18SEli Cohen .get_drvinfo = ipoib_get_drvinfo,
22528d52b3cSEli Cohen .get_coalesce = ipoib_get_coalesce,
22628d52b3cSEli Cohen .set_coalesce = ipoib_set_coalesce,
227e3614bc9SHans Westgaard Ry .get_strings = ipoib_get_strings,
228e3614bc9SHans Westgaard Ry .get_ethtool_stats = ipoib_get_ethtool_stats,
229e3614bc9SHans Westgaard Ry .get_sset_count = ipoib_get_sset_count,
230633fbb06SKamal Heib .get_link = ethtool_op_get_link,
23182c24c18SEli Cohen };
23282c24c18SEli Cohen
ipoib_set_ethtool_ops(struct net_device * dev)23382c24c18SEli Cohen void ipoib_set_ethtool_ops(struct net_device *dev)
23482c24c18SEli Cohen {
2357ad24ea4SWilfried Klaebe dev->ethtool_ops = &ipoib_ethtool_ops;
23682c24c18SEli Cohen }
237