diff options
Diffstat (limited to 'drivers/net/ethernet/ibm/ehea/ehea_ethtool.c')
| -rw-r--r-- | drivers/net/ethernet/ibm/ehea/ehea_ethtool.c | 282 | 
1 files changed, 282 insertions, 0 deletions
diff --git a/drivers/net/ethernet/ibm/ehea/ehea_ethtool.c b/drivers/net/ethernet/ibm/ehea/ehea_ethtool.c new file mode 100644 index 00000000000..85a3866459c --- /dev/null +++ b/drivers/net/ethernet/ibm/ehea/ehea_ethtool.c @@ -0,0 +1,282 @@ +/* + *  linux/drivers/net/ethernet/ibm/ehea/ehea_ethtool.c + * + *  eHEA ethernet device driver for IBM eServer System p + * + *  (C) Copyright IBM Corp. 2006 + * + *  Authors: + *       Christoph Raisch <raisch@de.ibm.com> + *       Jan-Bernd Themann <themann@de.ibm.com> + *       Thomas Klein <tklein@de.ibm.com> + * + * + * 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, 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., 675 Mass Ave, Cambridge, MA 02139, USA. + */ + +#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt + +#include "ehea.h" +#include "ehea_phyp.h" + +static int ehea_get_settings(struct net_device *dev, struct ethtool_cmd *cmd) +{ +	struct ehea_port *port = netdev_priv(dev); +	u32 speed; +	int ret; + +	ret = ehea_sense_port_attr(port); + +	if (ret) +		return ret; + +	if (netif_carrier_ok(dev)) { +		switch (port->port_speed) { +		case EHEA_SPEED_10M: +			speed = SPEED_10; +			break; +		case EHEA_SPEED_100M: +			speed = SPEED_100; +			break; +		case EHEA_SPEED_1G: +			speed = SPEED_1000; +			break; +		case EHEA_SPEED_10G: +			speed = SPEED_10000; +			break; +		default: +			speed = -1; +			break; /* BUG */ +		} +		cmd->duplex = port->full_duplex == 1 ? +						     DUPLEX_FULL : DUPLEX_HALF; +	} else { +		speed = SPEED_UNKNOWN; +		cmd->duplex = DUPLEX_UNKNOWN; +	} +	ethtool_cmd_speed_set(cmd, speed); + +	if (cmd->speed == SPEED_10000) { +		cmd->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE); +		cmd->advertising = (ADVERTISED_10000baseT_Full | ADVERTISED_FIBRE); +		cmd->port = PORT_FIBRE; +	} else { +		cmd->supported = (SUPPORTED_1000baseT_Full | SUPPORTED_100baseT_Full +			       | SUPPORTED_100baseT_Half | SUPPORTED_10baseT_Full +			       | SUPPORTED_10baseT_Half | SUPPORTED_Autoneg +			       | SUPPORTED_TP); +		cmd->advertising = (ADVERTISED_1000baseT_Full | ADVERTISED_Autoneg +				 | ADVERTISED_TP); +		cmd->port = PORT_TP; +	} + +	cmd->autoneg = port->autoneg == 1 ? AUTONEG_ENABLE : AUTONEG_DISABLE; + +	return 0; +} + +static int ehea_set_settings(struct net_device *dev, struct ethtool_cmd *cmd) +{ +	struct ehea_port *port = netdev_priv(dev); +	int ret = 0; +	u32 sp; + +	if (cmd->autoneg == AUTONEG_ENABLE) { +		sp = EHEA_SPEED_AUTONEG; +		goto doit; +	} + +	switch (cmd->speed) { +	case SPEED_10: +		if (cmd->duplex == DUPLEX_FULL) +			sp = H_SPEED_10M_F; +		else +			sp = H_SPEED_10M_H; +		break; + +	case SPEED_100: +		if (cmd->duplex == DUPLEX_FULL) +			sp = H_SPEED_100M_F; +		else +			sp = H_SPEED_100M_H; +		break; + +	case SPEED_1000: +		if (cmd->duplex == DUPLEX_FULL) +			sp = H_SPEED_1G_F; +		else +			ret = -EINVAL; +		break; + +	case SPEED_10000: +		if (cmd->duplex == DUPLEX_FULL) +			sp = H_SPEED_10G_F; +		else +			ret = -EINVAL; +		break; + +	default: +			ret = -EINVAL; +		break; +	} + +	if (ret) +		goto out; +doit: +	ret = ehea_set_portspeed(port, sp); + +	if (!ret) +		netdev_info(dev, +			    "Port speed successfully set: %dMbps %s Duplex\n", +			    port->port_speed, +			    port->full_duplex == 1 ? "Full" : "Half"); +out: +	return ret; +} + +static int ehea_nway_reset(struct net_device *dev) +{ +	struct ehea_port *port = netdev_priv(dev); +	int ret; + +	ret = ehea_set_portspeed(port, EHEA_SPEED_AUTONEG); + +	if (!ret) +		netdev_info(port->netdev, +			    "Port speed successfully set: %dMbps %s Duplex\n", +			    port->port_speed, +			    port->full_duplex == 1 ? "Full" : "Half"); +	return ret; +} + +static void ehea_get_drvinfo(struct net_device *dev, +			       struct ethtool_drvinfo *info) +{ +	strlcpy(info->driver, DRV_NAME, sizeof(info->driver)); +	strlcpy(info->version, DRV_VERSION, sizeof(info->version)); +} + +static u32 ehea_get_msglevel(struct net_device *dev) +{ +	struct ehea_port *port = netdev_priv(dev); +	return port->msg_enable; +} + +static void ehea_set_msglevel(struct net_device *dev, u32 value) +{ +	struct ehea_port *port = netdev_priv(dev); +	port->msg_enable = value; +} + +static const char ehea_ethtool_stats_keys[][ETH_GSTRING_LEN] = { +	{"sig_comp_iv"}, +	{"swqe_refill_th"}, +	{"port resets"}, +	{"Receive errors"}, +	{"TCP cksum errors"}, +	{"IP cksum errors"}, +	{"Frame cksum errors"}, +	{"num SQ stopped"}, +	{"PR0 free_swqes"}, +	{"PR1 free_swqes"}, +	{"PR2 free_swqes"}, +	{"PR3 free_swqes"}, +	{"PR4 free_swqes"}, +	{"PR5 free_swqes"}, +	{"PR6 free_swqes"}, +	{"PR7 free_swqes"}, +	{"PR8 free_swqes"}, +	{"PR9 free_swqes"}, +	{"PR10 free_swqes"}, +	{"PR11 free_swqes"}, +	{"PR12 free_swqes"}, +	{"PR13 free_swqes"}, +	{"PR14 free_swqes"}, +	{"PR15 free_swqes"}, +}; + +static void ehea_get_strings(struct net_device *dev, u32 stringset, u8 *data) +{ +	if (stringset == ETH_SS_STATS) { +		memcpy(data, &ehea_ethtool_stats_keys, +		       sizeof(ehea_ethtool_stats_keys)); +	} +} + +static int ehea_get_sset_count(struct net_device *dev, int sset) +{ +	switch (sset) { +	case ETH_SS_STATS: +		return ARRAY_SIZE(ehea_ethtool_stats_keys); +	default: +		return -EOPNOTSUPP; +	} +} + +static void ehea_get_ethtool_stats(struct net_device *dev, +				     struct ethtool_stats *stats, u64 *data) +{ +	int i, k, tmp; +	struct ehea_port *port = netdev_priv(dev); + +	for (i = 0; i < ehea_get_sset_count(dev, ETH_SS_STATS); i++) +		data[i] = 0; +	i = 0; + +	data[i++] = port->sig_comp_iv; +	data[i++] = port->port_res[0].swqe_refill_th; +	data[i++] = port->resets; + +	for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++) +		tmp += port->port_res[k].p_stats.poll_receive_errors; +	data[i++] = tmp; + +	for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++) +		tmp += port->port_res[k].p_stats.err_tcp_cksum; +	data[i++] = tmp; + +	for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++) +		tmp += port->port_res[k].p_stats.err_ip_cksum; +	data[i++] = tmp; + +	for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++) +		tmp += port->port_res[k].p_stats.err_frame_crc; +	data[i++] = tmp; + +	for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++) +		tmp += port->port_res[k].p_stats.queue_stopped; +	data[i++] = tmp; + +	for (k = 0; k < 16; k++) +		data[i++] = atomic_read(&port->port_res[k].swqe_avail); +} + +static const struct ethtool_ops ehea_ethtool_ops = { +	.get_settings = ehea_get_settings, +	.get_drvinfo = ehea_get_drvinfo, +	.get_msglevel = ehea_get_msglevel, +	.set_msglevel = ehea_set_msglevel, +	.get_link = ethtool_op_get_link, +	.get_strings = ehea_get_strings, +	.get_sset_count = ehea_get_sset_count, +	.get_ethtool_stats = ehea_get_ethtool_stats, +	.set_settings = ehea_set_settings, +	.nway_reset = ehea_nway_reset,		/* Restart autonegotiation */ +}; + +void ehea_set_ethtool_ops(struct net_device *netdev) +{ +	netdev->ethtool_ops = &ehea_ethtool_ops; +}  | 
