/* Applied Micro X-Gene SoC Ethernet Driver * * Copyright (c) 2014, Applied Micro Circuits Corporation * Authors: Iyappan Subramanian * * 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 . */ #include #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_link_ksettings(struct net_device *ndev, struct ethtool_link_ksettings *cmd) { struct xgene_enet_pdata *pdata = netdev_priv(ndev); struct phy_device *phydev = ndev->phydev; u32 supported; if (pdata->phy_mode == PHY_INTERFACE_MODE_RGMII) { if (phydev == NULL) return -ENODEV; return phy_ethtool_ksettings_get(phydev, cmd); } else if (pdata->phy_mode == PHY_INTERFACE_MODE_SGMII) { if (pdata->mdio_driver) { if (!phydev) return -ENODEV; return phy_ethtool_ksettings_get(phydev, cmd); } supported = SUPPORTED_1000baseT_Full | SUPPORTED_Autoneg | SUPPORTED_MII; ethtool_convert_legacy_u32_to_link_mode( cmd->link_modes.supported, supported); ethtool_convert_legacy_u32_to_link_mode( cmd->link_modes.advertising, supported); cmd->base.speed = SPEED_1000; cmd->base.duplex = DUPLEX_FULL; cmd->base.port = PORT_MII; cmd->base.autoneg = AUTONEG_ENABLE; } else { supported = SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE; ethtool_convert_legacy_u32_to_link_mode( cmd->link_modes.supported, supported); ethtool_convert_legacy_u32_to_link_mode( cmd->link_modes.advertising, supported); cmd->base.speed = SPEED_10000; cmd->base.duplex = DUPLEX_FULL; cmd->base.port = PORT_FIBRE; cmd->base.autoneg = AUTONEG_DISABLE; } return 0; } static int xgene_set_link_ksettings(struct net_device *ndev, const struct ethtool_link_ksettings *cmd) { struct xgene_enet_pdata *pdata = netdev_priv(ndev); struct phy_device *phydev = ndev->phydev; if (pdata->phy_mode == PHY_INTERFACE_MODE_RGMII) { if (!phydev) return -ENODEV; return phy_ethtool_ksettings_set(phydev, cmd); } if (pdata->phy_mode == PHY_INTERFACE_MODE_SGMII) { if (pdata->mdio_driver) { if (!phydev) return -ENODEV; return phy_ethtool_ksettings_set(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 void xgene_get_pauseparam(struct net_device *ndev, struct ethtool_pauseparam *pp) { struct xgene_enet_pdata *pdata = netdev_priv(ndev); pp->autoneg = pdata->pause_autoneg; pp->tx_pause = pdata->tx_pause; pp->rx_pause = pdata->rx_pause; } static int xgene_set_pauseparam(struct net_device *ndev, struct ethtool_pauseparam *pp) { struct xgene_enet_pdata *pdata = netdev_priv(ndev); struct phy_device *phydev = ndev->phydev; u32 oldadv, newadv; if (pdata->phy_mode == PHY_INTERFACE_MODE_RGMII || pdata->phy_mode == PHY_INTERFACE_MODE_SGMII) { if (!phydev) return -EINVAL; if (!(phydev->supported & SUPPORTED_Pause) || (!(phydev->supported & SUPPORTED_Asym_Pause) && pp->rx_pause != pp->tx_pause)) return -EINVAL; pdata->pause_autoneg = pp->autoneg; pdata->tx_pause = pp->tx_pause; pdata->rx_pause = pp->rx_pause; oldadv = phydev->advertising; newadv = oldadv & ~(ADVERTISED_Pause | ADVERTISED_Asym_Pause); if (pp->rx_pause) newadv |= ADVERTISED_Pause | ADVERTISED_Asym_Pause; if (pp->tx_pause) newadv ^= ADVERTISED_Asym_Pause; if (oldadv ^ newadv) { phydev->advertising = newadv; if (phydev->autoneg) return phy_start_aneg(phydev); if (!pp->autoneg) { pdata->mac_ops->flowctl_tx(pdata, pdata->tx_pause); pdata->mac_ops->flowctl_rx(pdata, pdata->rx_pause); } } } else { if (pp->autoneg) return -EINVAL; pdata->tx_pause = pp->tx_pause; pdata->rx_pause = pp->rx_pause; pdata->mac_ops->flowctl_tx(pdata, pdata->tx_pause); pdata->mac_ops->flowctl_rx(pdata, pdata->rx_pause); } return 0; } static const struct ethtool_ops xgene_ethtool_ops = { .get_drvinfo = xgene_get_drvinfo, .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, .get_link_ksettings = xgene_get_link_ksettings, .set_link_ksettings = xgene_set_link_ksettings, .get_pauseparam = xgene_get_pauseparam, .set_pauseparam = xgene_set_pauseparam }; void xgene_enet_set_ethtool_ops(struct net_device *ndev) { ndev->ethtool_ops = &xgene_ethtool_ops; }