1 // SPDX-License-Identifier: GPL-2.0-only 2 /* Ethtool support for Altera Triple-Speed Ethernet MAC driver 3 * Copyright (C) 2008-2014 Altera Corporation. All rights reserved 4 * 5 * Contributors: 6 * Dalon Westergreen 7 * Thomas Chou 8 * Ian Abbott 9 * Yuriy Kozlov 10 * Tobias Klauser 11 * Andriy Smolskyy 12 * Roman Bulgakov 13 * Dmytro Mytarchuk 14 * 15 * Original driver contributed by SLS. 16 * Major updates contributed by GlobalLogic 17 */ 18 19 #include <linux/ethtool.h> 20 #include <linux/kernel.h> 21 #include <linux/netdevice.h> 22 #include <linux/phy.h> 23 24 #include "altera_tse.h" 25 26 #define TSE_STATS_LEN 31 27 #define TSE_NUM_REGS 128 28 29 static char const stat_gstrings[][ETH_GSTRING_LEN] = { 30 "tx_packets", 31 "rx_packets", 32 "rx_crc_errors", 33 "rx_align_errors", 34 "tx_bytes", 35 "rx_bytes", 36 "tx_pause", 37 "rx_pause", 38 "rx_errors", 39 "tx_errors", 40 "rx_unicast", 41 "rx_multicast", 42 "rx_broadcast", 43 "tx_discards", 44 "tx_unicast", 45 "tx_multicast", 46 "tx_broadcast", 47 "ether_drops", 48 "rx_total_bytes", 49 "rx_total_packets", 50 "rx_undersize", 51 "rx_oversize", 52 "rx_64_bytes", 53 "rx_65_127_bytes", 54 "rx_128_255_bytes", 55 "rx_256_511_bytes", 56 "rx_512_1023_bytes", 57 "rx_1024_1518_bytes", 58 "rx_gte_1519_bytes", 59 "rx_jabbers", 60 "rx_runts", 61 }; 62 63 static void tse_get_drvinfo(struct net_device *dev, 64 struct ethtool_drvinfo *info) 65 { 66 struct altera_tse_private *priv = netdev_priv(dev); 67 u32 rev = ioread32(&priv->mac_dev->megacore_revision); 68 69 strcpy(info->driver, "altera_tse"); 70 strcpy(info->version, "v8.0"); 71 snprintf(info->fw_version, ETHTOOL_FWVERS_LEN, "v%d.%d", 72 rev & 0xFFFF, (rev & 0xFFFF0000) >> 16); 73 sprintf(info->bus_info, "platform"); 74 } 75 76 /* Fill in a buffer with the strings which correspond to the 77 * stats 78 */ 79 static void tse_gstrings(struct net_device *dev, u32 stringset, u8 *buf) 80 { 81 memcpy(buf, stat_gstrings, TSE_STATS_LEN * ETH_GSTRING_LEN); 82 } 83 84 static void tse_fill_stats(struct net_device *dev, struct ethtool_stats *dummy, 85 u64 *buf) 86 { 87 struct altera_tse_private *priv = netdev_priv(dev); 88 u64 ext; 89 90 buf[0] = csrrd32(priv->mac_dev, 91 tse_csroffs(frames_transmitted_ok)); 92 buf[1] = csrrd32(priv->mac_dev, 93 tse_csroffs(frames_received_ok)); 94 buf[2] = csrrd32(priv->mac_dev, 95 tse_csroffs(frames_check_sequence_errors)); 96 buf[3] = csrrd32(priv->mac_dev, 97 tse_csroffs(alignment_errors)); 98 99 /* Extended aOctetsTransmittedOK counter */ 100 ext = (u64) csrrd32(priv->mac_dev, 101 tse_csroffs(msb_octets_transmitted_ok)) << 32; 102 103 ext |= csrrd32(priv->mac_dev, 104 tse_csroffs(octets_transmitted_ok)); 105 buf[4] = ext; 106 107 /* Extended aOctetsReceivedOK counter */ 108 ext = (u64) csrrd32(priv->mac_dev, 109 tse_csroffs(msb_octets_received_ok)) << 32; 110 111 ext |= csrrd32(priv->mac_dev, 112 tse_csroffs(octets_received_ok)); 113 buf[5] = ext; 114 115 buf[6] = csrrd32(priv->mac_dev, 116 tse_csroffs(tx_pause_mac_ctrl_frames)); 117 buf[7] = csrrd32(priv->mac_dev, 118 tse_csroffs(rx_pause_mac_ctrl_frames)); 119 buf[8] = csrrd32(priv->mac_dev, 120 tse_csroffs(if_in_errors)); 121 buf[9] = csrrd32(priv->mac_dev, 122 tse_csroffs(if_out_errors)); 123 buf[10] = csrrd32(priv->mac_dev, 124 tse_csroffs(if_in_ucast_pkts)); 125 buf[11] = csrrd32(priv->mac_dev, 126 tse_csroffs(if_in_multicast_pkts)); 127 buf[12] = csrrd32(priv->mac_dev, 128 tse_csroffs(if_in_broadcast_pkts)); 129 buf[13] = csrrd32(priv->mac_dev, 130 tse_csroffs(if_out_discards)); 131 buf[14] = csrrd32(priv->mac_dev, 132 tse_csroffs(if_out_ucast_pkts)); 133 buf[15] = csrrd32(priv->mac_dev, 134 tse_csroffs(if_out_multicast_pkts)); 135 buf[16] = csrrd32(priv->mac_dev, 136 tse_csroffs(if_out_broadcast_pkts)); 137 buf[17] = csrrd32(priv->mac_dev, 138 tse_csroffs(ether_stats_drop_events)); 139 140 /* Extended etherStatsOctets counter */ 141 ext = (u64) csrrd32(priv->mac_dev, 142 tse_csroffs(msb_ether_stats_octets)) << 32; 143 ext |= csrrd32(priv->mac_dev, 144 tse_csroffs(ether_stats_octets)); 145 buf[18] = ext; 146 147 buf[19] = csrrd32(priv->mac_dev, 148 tse_csroffs(ether_stats_pkts)); 149 buf[20] = csrrd32(priv->mac_dev, 150 tse_csroffs(ether_stats_undersize_pkts)); 151 buf[21] = csrrd32(priv->mac_dev, 152 tse_csroffs(ether_stats_oversize_pkts)); 153 buf[22] = csrrd32(priv->mac_dev, 154 tse_csroffs(ether_stats_pkts_64_octets)); 155 buf[23] = csrrd32(priv->mac_dev, 156 tse_csroffs(ether_stats_pkts_65to127_octets)); 157 buf[24] = csrrd32(priv->mac_dev, 158 tse_csroffs(ether_stats_pkts_128to255_octets)); 159 buf[25] = csrrd32(priv->mac_dev, 160 tse_csroffs(ether_stats_pkts_256to511_octets)); 161 buf[26] = csrrd32(priv->mac_dev, 162 tse_csroffs(ether_stats_pkts_512to1023_octets)); 163 buf[27] = csrrd32(priv->mac_dev, 164 tse_csroffs(ether_stats_pkts_1024to1518_octets)); 165 buf[28] = csrrd32(priv->mac_dev, 166 tse_csroffs(ether_stats_pkts_1519tox_octets)); 167 buf[29] = csrrd32(priv->mac_dev, 168 tse_csroffs(ether_stats_jabbers)); 169 buf[30] = csrrd32(priv->mac_dev, 170 tse_csroffs(ether_stats_fragments)); 171 } 172 173 static int tse_sset_count(struct net_device *dev, int sset) 174 { 175 switch (sset) { 176 case ETH_SS_STATS: 177 return TSE_STATS_LEN; 178 default: 179 return -EOPNOTSUPP; 180 } 181 } 182 183 static u32 tse_get_msglevel(struct net_device *dev) 184 { 185 struct altera_tse_private *priv = netdev_priv(dev); 186 return priv->msg_enable; 187 } 188 189 static void tse_set_msglevel(struct net_device *dev, uint32_t data) 190 { 191 struct altera_tse_private *priv = netdev_priv(dev); 192 priv->msg_enable = data; 193 } 194 195 static int tse_reglen(struct net_device *dev) 196 { 197 return TSE_NUM_REGS * sizeof(u32); 198 } 199 200 static void tse_get_regs(struct net_device *dev, struct ethtool_regs *regs, 201 void *regbuf) 202 { 203 int i; 204 struct altera_tse_private *priv = netdev_priv(dev); 205 u32 *buf = regbuf; 206 207 /* Set version to a known value, so ethtool knows 208 * how to do any special formatting of this data. 209 * This version number will need to change if and 210 * when this register table is changed. 211 * 212 * version[31:0] = 1: Dump the first 128 TSE Registers 213 * Upper bits are all 0 by default 214 * 215 * Upper 16-bits will indicate feature presence for 216 * Ethtool register decoding in future version. 217 */ 218 219 regs->version = 1; 220 221 for (i = 0; i < TSE_NUM_REGS; i++) 222 buf[i] = csrrd32(priv->mac_dev, i * 4); 223 } 224 225 static const struct ethtool_ops tse_ethtool_ops = { 226 .get_drvinfo = tse_get_drvinfo, 227 .get_regs_len = tse_reglen, 228 .get_regs = tse_get_regs, 229 .get_link = ethtool_op_get_link, 230 .get_strings = tse_gstrings, 231 .get_sset_count = tse_sset_count, 232 .get_ethtool_stats = tse_fill_stats, 233 .get_msglevel = tse_get_msglevel, 234 .set_msglevel = tse_set_msglevel, 235 .get_link_ksettings = phy_ethtool_get_link_ksettings, 236 .set_link_ksettings = phy_ethtool_set_link_ksettings, 237 }; 238 239 void altera_tse_set_ethtool_ops(struct net_device *netdev) 240 { 241 netdev->ethtool_ops = &tse_ethtool_ops; 242 } 243