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
15 * Original driver contributed by SLS.
16 * Major updates contributed by GlobalLogic
19 #include <linux/ethtool.h>
20 #include <linux/kernel.h>
21 #include <linux/netdevice.h>
22 #include <linux/phy.h>
24 #include "altera_tse.h"
26 #define TSE_STATS_LEN 31
27 #define TSE_NUM_REGS 128
29 static char const stat_gstrings[][ETH_GSTRING_LEN] = {
63 static void tse_get_drvinfo(struct net_device *dev,
64 struct ethtool_drvinfo *info)
66 struct altera_tse_private *priv = netdev_priv(dev);
67 u32 rev = ioread32(&priv->mac_dev->megacore_revision);
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");
76 /* Fill in a buffer with the strings which correspond to the
79 static void tse_gstrings(struct net_device *dev, u32 stringset, u8 *buf)
81 memcpy(buf, stat_gstrings, TSE_STATS_LEN * ETH_GSTRING_LEN);
84 static void tse_fill_stats(struct net_device *dev, struct ethtool_stats *dummy,
87 struct altera_tse_private *priv = netdev_priv(dev);
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));
99 /* Extended aOctetsTransmittedOK counter */
100 ext = (u64) csrrd32(priv->mac_dev,
101 tse_csroffs(msb_octets_transmitted_ok)) << 32;
103 ext |= csrrd32(priv->mac_dev,
104 tse_csroffs(octets_transmitted_ok));
107 /* Extended aOctetsReceivedOK counter */
108 ext = (u64) csrrd32(priv->mac_dev,
109 tse_csroffs(msb_octets_received_ok)) << 32;
111 ext |= csrrd32(priv->mac_dev,
112 tse_csroffs(octets_received_ok));
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));
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));
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));
173 static int tse_sset_count(struct net_device *dev, int sset)
177 return TSE_STATS_LEN;
183 static u32 tse_get_msglevel(struct net_device *dev)
185 struct altera_tse_private *priv = netdev_priv(dev);
186 return priv->msg_enable;
189 static void tse_set_msglevel(struct net_device *dev, uint32_t data)
191 struct altera_tse_private *priv = netdev_priv(dev);
192 priv->msg_enable = data;
195 static int tse_reglen(struct net_device *dev)
197 return TSE_NUM_REGS * sizeof(u32);
200 static void tse_get_regs(struct net_device *dev, struct ethtool_regs *regs,
204 struct altera_tse_private *priv = netdev_priv(dev);
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.
212 * version[31:0] = 1: Dump the first 128 TSE Registers
213 * Upper bits are all 0 by default
215 * Upper 16-bits will indicate feature presence for
216 * Ethtool register decoding in future version.
221 for (i = 0; i < TSE_NUM_REGS; i++)
222 buf[i] = csrrd32(priv->mac_dev, i * 4);
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,
239 void altera_tse_set_ethtool_ops(struct net_device *netdev)
241 netdev->ethtool_ops = &tse_ethtool_ops;