2 * linux/drivers/net/ethernet/ibm/ehea/ehea_ethtool.c
4 * eHEA ethernet device driver for IBM eServer System p
6 * (C) Copyright IBM Corp. 2006
9 * Christoph Raisch <raisch@de.ibm.com>
10 * Jan-Bernd Themann <themann@de.ibm.com>
11 * Thomas Klein <tklein@de.ibm.com>
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License as published by
16 * the Free Software Foundation; either version 2, or (at your option)
19 * This program is distributed in the hope that it will be useful,
20 * but WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22 * GNU General Public License for more details.
24 * You should have received a copy of the GNU General Public License
25 * along with this program; if not, write to the Free Software
26 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
29 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
32 #include "ehea_phyp.h"
34 static int ehea_get_link_ksettings(struct net_device *dev,
35 struct ethtool_link_ksettings *cmd)
37 struct ehea_port *port = netdev_priv(dev);
38 u32 supported, advertising;
42 ret = ehea_sense_port_attr(port);
47 if (netif_carrier_ok(dev)) {
48 switch (port->port_speed) {
65 cmd->base.duplex = port->full_duplex == 1 ?
66 DUPLEX_FULL : DUPLEX_HALF;
68 speed = SPEED_UNKNOWN;
69 cmd->base.duplex = DUPLEX_UNKNOWN;
71 cmd->base.speed = speed;
73 if (cmd->base.speed == SPEED_10000) {
74 supported = (SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE);
75 advertising = (ADVERTISED_10000baseT_Full | ADVERTISED_FIBRE);
76 cmd->base.port = PORT_FIBRE;
78 supported = (SUPPORTED_1000baseT_Full | SUPPORTED_100baseT_Full
79 | SUPPORTED_100baseT_Half | SUPPORTED_10baseT_Full
80 | SUPPORTED_10baseT_Half | SUPPORTED_Autoneg
82 advertising = (ADVERTISED_1000baseT_Full | ADVERTISED_Autoneg
84 cmd->base.port = PORT_TP;
87 cmd->base.autoneg = port->autoneg == 1 ?
88 AUTONEG_ENABLE : AUTONEG_DISABLE;
90 ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported,
92 ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.advertising,
98 static int ehea_set_link_ksettings(struct net_device *dev,
99 const struct ethtool_link_ksettings *cmd)
101 struct ehea_port *port = netdev_priv(dev);
105 if (cmd->base.autoneg == AUTONEG_ENABLE) {
106 sp = EHEA_SPEED_AUTONEG;
110 switch (cmd->base.speed) {
112 if (cmd->base.duplex == DUPLEX_FULL)
119 if (cmd->base.duplex == DUPLEX_FULL)
126 if (cmd->base.duplex == DUPLEX_FULL)
133 if (cmd->base.duplex == DUPLEX_FULL)
147 ret = ehea_set_portspeed(port, sp);
151 "Port speed successfully set: %dMbps %s Duplex\n",
153 port->full_duplex == 1 ? "Full" : "Half");
158 static int ehea_nway_reset(struct net_device *dev)
160 struct ehea_port *port = netdev_priv(dev);
163 ret = ehea_set_portspeed(port, EHEA_SPEED_AUTONEG);
166 netdev_info(port->netdev,
167 "Port speed successfully set: %dMbps %s Duplex\n",
169 port->full_duplex == 1 ? "Full" : "Half");
173 static void ehea_get_drvinfo(struct net_device *dev,
174 struct ethtool_drvinfo *info)
176 strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
177 strlcpy(info->version, DRV_VERSION, sizeof(info->version));
180 static u32 ehea_get_msglevel(struct net_device *dev)
182 struct ehea_port *port = netdev_priv(dev);
183 return port->msg_enable;
186 static void ehea_set_msglevel(struct net_device *dev, u32 value)
188 struct ehea_port *port = netdev_priv(dev);
189 port->msg_enable = value;
192 static const char ehea_ethtool_stats_keys[][ETH_GSTRING_LEN] = {
197 {"TCP cksum errors"},
199 {"Frame cksum errors"},
219 static void ehea_get_strings(struct net_device *dev, u32 stringset, u8 *data)
221 if (stringset == ETH_SS_STATS) {
222 memcpy(data, &ehea_ethtool_stats_keys,
223 sizeof(ehea_ethtool_stats_keys));
227 static int ehea_get_sset_count(struct net_device *dev, int sset)
231 return ARRAY_SIZE(ehea_ethtool_stats_keys);
237 static void ehea_get_ethtool_stats(struct net_device *dev,
238 struct ethtool_stats *stats, u64 *data)
241 struct ehea_port *port = netdev_priv(dev);
243 for (i = 0; i < ehea_get_sset_count(dev, ETH_SS_STATS); i++)
247 data[i++] = port->sig_comp_iv;
248 data[i++] = port->port_res[0].swqe_refill_th;
249 data[i++] = port->resets;
251 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
252 tmp += port->port_res[k].p_stats.poll_receive_errors;
255 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
256 tmp += port->port_res[k].p_stats.err_tcp_cksum;
259 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
260 tmp += port->port_res[k].p_stats.err_ip_cksum;
263 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
264 tmp += port->port_res[k].p_stats.err_frame_crc;
267 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
268 tmp += port->port_res[k].p_stats.queue_stopped;
271 for (k = 0; k < 16; k++)
272 data[i++] = atomic_read(&port->port_res[k].swqe_avail);
275 static const struct ethtool_ops ehea_ethtool_ops = {
276 .get_drvinfo = ehea_get_drvinfo,
277 .get_msglevel = ehea_get_msglevel,
278 .set_msglevel = ehea_set_msglevel,
279 .get_link = ethtool_op_get_link,
280 .get_strings = ehea_get_strings,
281 .get_sset_count = ehea_get_sset_count,
282 .get_ethtool_stats = ehea_get_ethtool_stats,
283 .nway_reset = ehea_nway_reset, /* Restart autonegotiation */
284 .get_link_ksettings = ehea_get_link_ksettings,
285 .set_link_ksettings = ehea_set_link_ksettings,
288 void ehea_set_ethtool_ops(struct net_device *netdev)
290 netdev->ethtool_ops = &ehea_ethtool_ops;