/* Ethtool support for Altera Triple-Speed Ethernet MAC driver * Copyright (C) 2008-2014 Altera Corporation. All rights reserved * * Contributors: * Dalon Westergreen * Thomas Chou * Ian Abbott * Yuriy Kozlov * Tobias Klauser * Andriy Smolskyy * Roman Bulgakov * Dmytro Mytarchuk * * Original driver contributed by SLS. * Major updates contributed by GlobalLogic * * This program is free software; you can redistribute it and/or modify it * under the terms and conditions of the GNU General Public License, * version 2, as published by the Free Software Foundation. * * This program is distributed in the hope 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 #include #include #include "altera_tse.h" #define TSE_STATS_LEN 31 #define TSE_NUM_REGS 128 static char const stat_gstrings[][ETH_GSTRING_LEN] = { "tx_packets", "rx_packets", "rx_crc_errors", "rx_align_errors", "tx_bytes", "rx_bytes", "tx_pause", "rx_pause", "rx_errors", "tx_errors", "rx_unicast", "rx_multicast", "rx_broadcast", "tx_discards", "tx_unicast", "tx_multicast", "tx_broadcast", "ether_drops", "rx_total_bytes", "rx_total_packets", "rx_undersize", "rx_oversize", "rx_64_bytes", "rx_65_127_bytes", "rx_128_255_bytes", "rx_256_511_bytes", "rx_512_1023_bytes", "rx_1024_1518_bytes", "rx_gte_1519_bytes", "rx_jabbers", "rx_runts", }; static void tse_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) { struct altera_tse_private *priv = netdev_priv(dev); u32 rev = ioread32(&priv->mac_dev->megacore_revision); strcpy(info->driver, "Altera TSE MAC IP Driver"); strcpy(info->version, "v8.0"); snprintf(info->fw_version, ETHTOOL_FWVERS_LEN, "v%d.%d", rev & 0xFFFF, (rev & 0xFFFF0000) >> 16); sprintf(info->bus_info, "platform"); } /* Fill in a buffer with the strings which correspond to the * stats */ static void tse_gstrings(struct net_device *dev, u32 stringset, u8 *buf) { memcpy(buf, stat_gstrings, TSE_STATS_LEN * ETH_GSTRING_LEN); } static void tse_fill_stats(struct net_device *dev, struct ethtool_stats *dummy, u64 *buf) { struct altera_tse_private *priv = netdev_priv(dev); struct altera_tse_mac *mac = priv->mac_dev; u64 ext; buf[0] = ioread32(&mac->frames_transmitted_ok); buf[1] = ioread32(&mac->frames_received_ok); buf[2] = ioread32(&mac->frames_check_sequence_errors); buf[3] = ioread32(&mac->alignment_errors); /* Extended aOctetsTransmittedOK counter */ ext = (u64) ioread32(&mac->msb_octets_transmitted_ok) << 32; ext |= ioread32(&mac->octets_transmitted_ok); buf[4] = ext; /* Extended aOctetsReceivedOK counter */ ext = (u64) ioread32(&mac->msb_octets_received_ok) << 32; ext |= ioread32(&mac->octets_received_ok); buf[5] = ext; buf[6] = ioread32(&mac->tx_pause_mac_ctrl_frames); buf[7] = ioread32(&mac->rx_pause_mac_ctrl_frames); buf[8] = ioread32(&mac->if_in_errors); buf[9] = ioread32(&mac->if_out_errors); buf[10] = ioread32(&mac->if_in_ucast_pkts); buf[11] = ioread32(&mac->if_in_multicast_pkts); buf[12] = ioread32(&mac->if_in_broadcast_pkts); buf[13] = ioread32(&mac->if_out_discards); buf[14] = ioread32(&mac->if_out_ucast_pkts); buf[15] = ioread32(&mac->if_out_multicast_pkts); buf[16] = ioread32(&mac->if_out_broadcast_pkts); buf[17] = ioread32(&mac->ether_stats_drop_events); /* Extended etherStatsOctets counter */ ext = (u64) ioread32(&mac->msb_ether_stats_octets) << 32; ext |= ioread32(&mac->ether_stats_octets); buf[18] = ext; buf[19] = ioread32(&mac->ether_stats_pkts); buf[20] = ioread32(&mac->ether_stats_undersize_pkts); buf[21] = ioread32(&mac->ether_stats_oversize_pkts); buf[22] = ioread32(&mac->ether_stats_pkts_64_octets); buf[23] = ioread32(&mac->ether_stats_pkts_65to127_octets); buf[24] = ioread32(&mac->ether_stats_pkts_128to255_octets); buf[25] = ioread32(&mac->ether_stats_pkts_256to511_octets); buf[26] = ioread32(&mac->ether_stats_pkts_512to1023_octets); buf[27] = ioread32(&mac->ether_stats_pkts_1024to1518_octets); buf[28] = ioread32(&mac->ether_stats_pkts_1519tox_octets); buf[29] = ioread32(&mac->ether_stats_jabbers); buf[30] = ioread32(&mac->ether_stats_fragments); } static int tse_sset_count(struct net_device *dev, int sset) { switch (sset) { case ETH_SS_STATS: return TSE_STATS_LEN; default: return -EOPNOTSUPP; } } static u32 tse_get_msglevel(struct net_device *dev) { struct altera_tse_private *priv = netdev_priv(dev); return priv->msg_enable; } static void tse_set_msglevel(struct net_device *dev, uint32_t data) { struct altera_tse_private *priv = netdev_priv(dev); priv->msg_enable = data; } static int tse_reglen(struct net_device *dev) { return TSE_NUM_REGS * sizeof(u32); } static void tse_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *regbuf) { int i; struct altera_tse_private *priv = netdev_priv(dev); u32 *tse_mac_regs = (u32 *)priv->mac_dev; u32 *buf = regbuf; for (i = 0; i < TSE_NUM_REGS; i++) buf[i] = ioread32(&tse_mac_regs[i]); } static int tse_get_settings(struct net_device *dev, struct ethtool_cmd *cmd) { struct altera_tse_private *priv = netdev_priv(dev); struct phy_device *phydev = priv->phydev; if (phydev == NULL) return -ENODEV; return phy_ethtool_gset(phydev, cmd); } static int tse_set_settings(struct net_device *dev, struct ethtool_cmd *cmd) { struct altera_tse_private *priv = netdev_priv(dev); struct phy_device *phydev = priv->phydev; if (phydev == NULL) return -ENODEV; return phy_ethtool_sset(phydev, cmd); } static const struct ethtool_ops tse_ethtool_ops = { .get_drvinfo = tse_get_drvinfo, .get_regs_len = tse_reglen, .get_regs = tse_get_regs, .get_link = ethtool_op_get_link, .get_settings = tse_get_settings, .set_settings = tse_set_settings, .get_strings = tse_gstrings, .get_sset_count = tse_sset_count, .get_ethtool_stats = tse_fill_stats, .get_msglevel = tse_get_msglevel, .set_msglevel = tse_set_msglevel, }; void altera_tse_set_ethtool_ops(struct net_device *netdev) { SET_ETHTOOL_OPS(netdev, &tse_ethtool_ops); }