[linux-2.6-block.git] / drivers / net / ethernet / apm / xgene / xgene_enet_ethtool.c

/* Applied Micro X-Gene SoC Ethernet Driver
 *
 * Copyright (c) 2014, Applied Micro Circuits Corporation
 * Authors: Iyappan Subramanian <isubramanian@apm.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 of the  License, 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, see <http://www.gnu.org/licenses/>.
 */

#include <linux/ethtool.h>
#include "xgene_enet_main.h"

struct xgene_gstrings_stats {
	char name[ETH_GSTRING_LEN];
	int offset;
};

#define XGENE_STAT(m) { #m, offsetof(struct xgene_enet_pdata, stats.m) }

static const struct xgene_gstrings_stats gstrings_stats[] = {
	XGENE_STAT(rx_packets),
	XGENE_STAT(tx_packets),
	XGENE_STAT(rx_bytes),
	XGENE_STAT(tx_bytes),
	XGENE_STAT(rx_errors),
	XGENE_STAT(tx_errors),
	XGENE_STAT(rx_length_errors),
	XGENE_STAT(rx_crc_errors),
	XGENE_STAT(rx_frame_errors),
	XGENE_STAT(rx_fifo_errors)
};

#define XGENE_STATS_LEN		ARRAY_SIZE(gstrings_stats)

static void xgene_get_drvinfo(struct net_device *ndev,
			      struct ethtool_drvinfo *info)
{
	struct xgene_enet_pdata *pdata = netdev_priv(ndev);
	struct platform_device *pdev = pdata->pdev;

	strcpy(info->driver, "xgene_enet");
	strcpy(info->version, XGENE_DRV_VERSION);
	snprintf(info->fw_version, ETHTOOL_FWVERS_LEN, "N/A");
	sprintf(info->bus_info, "%s", pdev->name);
}

static int xgene_get_settings(struct net_device *ndev, struct ethtool_cmd *cmd)
{
	struct xgene_enet_pdata *pdata = netdev_priv(ndev);
	struct phy_device *phydev = pdata->phy_dev;

	if (pdata->phy_mode == PHY_INTERFACE_MODE_RGMII) {
		if (phydev == NULL)
			return -ENODEV;

		return phy_ethtool_gset(phydev, cmd);
	} else if (pdata->phy_mode == PHY_INTERFACE_MODE_SGMII) {
		cmd->supported = SUPPORTED_1000baseT_Full |
				 SUPPORTED_Autoneg | SUPPORTED_MII;
		cmd->advertising = cmd->supported;
		ethtool_cmd_speed_set(cmd, SPEED_1000);
		cmd->duplex = DUPLEX_FULL;
		cmd->port = PORT_MII;
		cmd->transceiver = XCVR_INTERNAL;
		cmd->autoneg = AUTONEG_ENABLE;
	} else {
		cmd->supported = SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE;
		cmd->advertising = cmd->supported;
		ethtool_cmd_speed_set(cmd, SPEED_10000);
		cmd->duplex = DUPLEX_FULL;
		cmd->port = PORT_FIBRE;
		cmd->transceiver = XCVR_INTERNAL;
		cmd->autoneg = AUTONEG_DISABLE;
	}

	return 0;
}

static int xgene_set_settings(struct net_device *ndev, struct ethtool_cmd *cmd)
{
	struct xgene_enet_pdata *pdata = netdev_priv(ndev);
	struct phy_device *phydev = pdata->phy_dev;

	if (pdata->phy_mode == PHY_INTERFACE_MODE_RGMII) {
		if (phydev == NULL)
			return -ENODEV;

		return phy_ethtool_sset(phydev, cmd);
	}

	return -EINVAL;
}

static void xgene_get_strings(struct net_device *ndev, u32 stringset, u8 *data)
{
	int i;
	u8 *p = data;

	if (stringset != ETH_SS_STATS)
		return;

	for (i = 0; i < XGENE_STATS_LEN; i++) {
		memcpy(p, gstrings_stats[i].name, ETH_GSTRING_LEN);
		p += ETH_GSTRING_LEN;
	}
}

static int xgene_get_sset_count(struct net_device *ndev, int sset)
{
	if (sset != ETH_SS_STATS)
		return -EINVAL;

	return XGENE_STATS_LEN;
}

static void xgene_get_ethtool_stats(struct net_device *ndev,
				    struct ethtool_stats *dummy,
				    u64 *data)
{
	void *pdata = netdev_priv(ndev);
	int i;

	for (i = 0; i < XGENE_STATS_LEN; i++)
		*data++ = *(u64 *)(pdata + gstrings_stats[i].offset);
}

static const struct ethtool_ops xgene_ethtool_ops = {
	.get_drvinfo = xgene_get_drvinfo,
	.get_settings = xgene_get_settings,
	.set_settings = xgene_set_settings,
	.get_link = ethtool_op_get_link,
	.get_strings = xgene_get_strings,
	.get_sset_count = xgene_get_sset_count,
	.get_ethtool_stats = xgene_get_ethtool_stats
};

void xgene_enet_set_ethtool_ops(struct net_device *ndev)
{
	ndev->ethtool_ops = &xgene_ethtool_ops;
}
Commit	Line	Data
e6ad7673 IS	1	/* Applied Micro X-Gene SoC Ethernet Driver
	2	*
	3	* Copyright (c) 2014, Applied Micro Circuits Corporation
	4	* Authors: Iyappan Subramanian <isubramanian@apm.com>
	5	*
	6	* This program is free software; you can redistribute it and/or modify it
	7	* under the terms of the GNU General Public License as published by the
	8	* Free Software Foundation; either version 2 of the License, or (at your
	9	* option) any later version.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License
	17	* along with this program. If not, see <http://www.gnu.org/licenses/>.
	18	*/
	19
	20	#include <linux/ethtool.h>
	21	#include "xgene_enet_main.h"
	22
	23	struct xgene_gstrings_stats {
	24	char name[ETH_GSTRING_LEN];
	25	int offset;
	26	};
	27
	28	#define XGENE_STAT(m) { #m, offsetof(struct xgene_enet_pdata, stats.m) }
	29
	30	static const struct xgene_gstrings_stats gstrings_stats[] = {
	31	XGENE_STAT(rx_packets),
	32	XGENE_STAT(tx_packets),
	33	XGENE_STAT(rx_bytes),
	34	XGENE_STAT(tx_bytes),
	35	XGENE_STAT(rx_errors),
	36	XGENE_STAT(tx_errors),
	37	XGENE_STAT(rx_length_errors),
	38	XGENE_STAT(rx_crc_errors),
	39	XGENE_STAT(rx_frame_errors),
	40	XGENE_STAT(rx_fifo_errors)
	41	};
	42
	43	#define XGENE_STATS_LEN ARRAY_SIZE(gstrings_stats)
	44
	45	static void xgene_get_drvinfo(struct net_device *ndev,
	46	struct ethtool_drvinfo *info)
	47	{
	48	struct xgene_enet_pdata *pdata = netdev_priv(ndev);
	49	struct platform_device *pdev = pdata->pdev;
	50
	51	strcpy(info->driver, "xgene_enet");
	52	strcpy(info->version, XGENE_DRV_VERSION);
	53	snprintf(info->fw_version, ETHTOOL_FWVERS_LEN, "N/A");
	54	sprintf(info->bus_info, "%s", pdev->name);
	55	}
	56
	57	static int xgene_get_settings(struct net_device ndev, struct ethtool_cmd cmd)
	58	{
	59	struct xgene_enet_pdata *pdata = netdev_priv(ndev);
	60	struct phy_device *phydev = pdata->phy_dev;
	61
41aace6e IS	62	if (pdata->phy_mode == PHY_INTERFACE_MODE_RGMII) {
	63	if (phydev == NULL)
	64	return -ENODEV;
e6ad7673	65
41aace6e	66	return phy_ethtool_gset(phydev, cmd);
5e6a024b IS	67	} else if (pdata->phy_mode == PHY_INTERFACE_MODE_SGMII) {
	68	cmd->supported = SUPPORTED_1000baseT_Full \|
	69	SUPPORTED_Autoneg \| SUPPORTED_MII;
	70	cmd->advertising = cmd->supported;
	71	ethtool_cmd_speed_set(cmd, SPEED_1000);
	72	cmd->duplex = DUPLEX_FULL;
	73	cmd->port = PORT_MII;
	74	cmd->transceiver = XCVR_INTERNAL;
	75	cmd->autoneg = AUTONEG_ENABLE;
	76	} else {
	77	cmd->supported = SUPPORTED_10000baseT_Full \| SUPPORTED_FIBRE;
	78	cmd->advertising = cmd->supported;
	79	ethtool_cmd_speed_set(cmd, SPEED_10000);
	80	cmd->duplex = DUPLEX_FULL;
	81	cmd->port = PORT_FIBRE;
	82	cmd->transceiver = XCVR_INTERNAL;
	83	cmd->autoneg = AUTONEG_DISABLE;
41aace6e IS	84	}
41aace6e IS	85
41aace6e	86	return 0;
e6ad7673 IS	87	}
	88
	89	static int xgene_set_settings(struct net_device ndev, struct ethtool_cmd cmd)
	90	{
	91	struct xgene_enet_pdata *pdata = netdev_priv(ndev);
	92	struct phy_device *phydev = pdata->phy_dev;
	93
41aace6e IS	94	if (pdata->phy_mode == PHY_INTERFACE_MODE_RGMII) {
	95	if (phydev == NULL)
	96	return -ENODEV;
	97
	98	return phy_ethtool_sset(phydev, cmd);
	99	}
e6ad7673	100
41aace6e	101	return -EINVAL;
e6ad7673 IS	102	}
	103
	104	static void xgene_get_strings(struct net_device ndev, u32 stringset, u8 data)
	105	{
	106	int i;
	107	u8 *p = data;
	108
	109	if (stringset != ETH_SS_STATS)
	110	return;
	111
	112	for (i = 0; i < XGENE_STATS_LEN; i++) {
	113	memcpy(p, gstrings_stats[i].name, ETH_GSTRING_LEN);
	114	p += ETH_GSTRING_LEN;
	115	}
	116	}
	117
	118	static int xgene_get_sset_count(struct net_device *ndev, int sset)
	119	{
	120	if (sset != ETH_SS_STATS)
	121	return -EINVAL;
	122
	123	return XGENE_STATS_LEN;
	124	}
	125
	126	static void xgene_get_ethtool_stats(struct net_device *ndev,
	127	struct ethtool_stats *dummy,
	128	u64 *data)
	129	{
	130	void *pdata = netdev_priv(ndev);
	131	int i;
	132
	133	for (i = 0; i < XGENE_STATS_LEN; i++)
	134	data++ = (u64 *)(pdata + gstrings_stats[i].offset);
	135	}
	136
	137	static const struct ethtool_ops xgene_ethtool_ops = {
	138	.get_drvinfo = xgene_get_drvinfo,
	139	.get_settings = xgene_get_settings,
	140	.set_settings = xgene_set_settings,
	141	.get_link = ethtool_op_get_link,
	142	.get_strings = xgene_get_strings,
	143	.get_sset_count = xgene_get_sset_count,
	144	.get_ethtool_stats = xgene_get_ethtool_stats
	145	};
	146
	147	void xgene_enet_set_ethtool_ops(struct net_device *ndev)
	148	{
	149	ndev->ethtool_ops = &xgene_ethtool_ops;
	150	}