1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright (c) 2016, The Linux Foundation. All rights reserved.
3  */
4 
5 #include <linux/ethtool.h>
6 #include <linux/phy.h>
7 
8 #include "emac.h"
9 
10 static const char * const emac_ethtool_stat_strings[] = {
11 	"rx_ok",
12 	"rx_bcast",
13 	"rx_mcast",
14 	"rx_pause",
15 	"rx_ctrl",
16 	"rx_fcs_err",
17 	"rx_len_err",
18 	"rx_byte_cnt",
19 	"rx_runt",
20 	"rx_frag",
21 	"rx_sz_64",
22 	"rx_sz_65_127",
23 	"rx_sz_128_255",
24 	"rx_sz_256_511",
25 	"rx_sz_512_1023",
26 	"rx_sz_1024_1518",
27 	"rx_sz_1519_max",
28 	"rx_sz_ov",
29 	"rx_rxf_ov",
30 	"rx_align_err",
31 	"rx_bcast_byte_cnt",
32 	"rx_mcast_byte_cnt",
33 	"rx_err_addr",
34 	"rx_crc_align",
35 	"rx_jabbers",
36 	"tx_ok",
37 	"tx_bcast",
38 	"tx_mcast",
39 	"tx_pause",
40 	"tx_exc_defer",
41 	"tx_ctrl",
42 	"tx_defer",
43 	"tx_byte_cnt",
44 	"tx_sz_64",
45 	"tx_sz_65_127",
46 	"tx_sz_128_255",
47 	"tx_sz_256_511",
48 	"tx_sz_512_1023",
49 	"tx_sz_1024_1518",
50 	"tx_sz_1519_max",
51 	"tx_1_col",
52 	"tx_2_col",
53 	"tx_late_col",
54 	"tx_abort_col",
55 	"tx_underrun",
56 	"tx_rd_eop",
57 	"tx_len_err",
58 	"tx_trunc",
59 	"tx_bcast_byte",
60 	"tx_mcast_byte",
61 	"tx_col",
62 };
63 
64 #define EMAC_STATS_LEN	ARRAY_SIZE(emac_ethtool_stat_strings)
65 
66 static u32 emac_get_msglevel(struct net_device *netdev)
67 {
68 	struct emac_adapter *adpt = netdev_priv(netdev);
69 
70 	return adpt->msg_enable;
71 }
72 
73 static void emac_set_msglevel(struct net_device *netdev, u32 data)
74 {
75 	struct emac_adapter *adpt = netdev_priv(netdev);
76 
77 	adpt->msg_enable = data;
78 }
79 
80 static int emac_get_sset_count(struct net_device *netdev, int sset)
81 {
82 	switch (sset) {
83 	case ETH_SS_PRIV_FLAGS:
84 		return 1;
85 	case ETH_SS_STATS:
86 		return EMAC_STATS_LEN;
87 	default:
88 		return -EOPNOTSUPP;
89 	}
90 }
91 
92 static void emac_get_strings(struct net_device *netdev, u32 stringset, u8 *data)
93 {
94 	unsigned int i;
95 
96 	switch (stringset) {
97 	case ETH_SS_PRIV_FLAGS:
98 		strcpy(data, "single-pause-mode");
99 		break;
100 
101 	case ETH_SS_STATS:
102 		for (i = 0; i < EMAC_STATS_LEN; i++) {
103 			strscpy(data, emac_ethtool_stat_strings[i],
104 				ETH_GSTRING_LEN);
105 			data += ETH_GSTRING_LEN;
106 		}
107 		break;
108 	}
109 }
110 
111 static void emac_get_ethtool_stats(struct net_device *netdev,
112 				   struct ethtool_stats *stats,
113 				   u64 *data)
114 {
115 	struct emac_adapter *adpt = netdev_priv(netdev);
116 
117 	spin_lock(&adpt->stats.lock);
118 
119 	emac_update_hw_stats(adpt);
120 	memcpy(data, &adpt->stats, EMAC_STATS_LEN * sizeof(u64));
121 
122 	spin_unlock(&adpt->stats.lock);
123 }
124 
125 static int emac_nway_reset(struct net_device *netdev)
126 {
127 	struct phy_device *phydev = netdev->phydev;
128 
129 	if (!phydev)
130 		return -ENODEV;
131 
132 	return genphy_restart_aneg(phydev);
133 }
134 
135 static void emac_get_ringparam(struct net_device *netdev,
136 			       struct ethtool_ringparam *ring,
137 			       struct kernel_ethtool_ringparam *kernel_ring,
138 			       struct netlink_ext_ack *extack)
139 {
140 	struct emac_adapter *adpt = netdev_priv(netdev);
141 
142 	ring->rx_max_pending = EMAC_MAX_RX_DESCS;
143 	ring->tx_max_pending = EMAC_MAX_TX_DESCS;
144 	ring->rx_pending = adpt->rx_desc_cnt;
145 	ring->tx_pending = adpt->tx_desc_cnt;
146 }
147 
148 static int emac_set_ringparam(struct net_device *netdev,
149 			      struct ethtool_ringparam *ring,
150 			      struct kernel_ethtool_ringparam *kernel_ring,
151 			      struct netlink_ext_ack *extack)
152 {
153 	struct emac_adapter *adpt = netdev_priv(netdev);
154 
155 	/* We don't have separate queues/rings for small/large frames, so
156 	 * reject any attempt to specify those values separately.
157 	 */
158 	if (ring->rx_mini_pending || ring->rx_jumbo_pending)
159 		return -EINVAL;
160 
161 	adpt->tx_desc_cnt =
162 		clamp_val(ring->tx_pending, EMAC_MIN_TX_DESCS, EMAC_MAX_TX_DESCS);
163 
164 	adpt->rx_desc_cnt =
165 		clamp_val(ring->rx_pending, EMAC_MIN_RX_DESCS, EMAC_MAX_RX_DESCS);
166 
167 	if (netif_running(netdev))
168 		return emac_reinit_locked(adpt);
169 
170 	return 0;
171 }
172 
173 static void emac_get_pauseparam(struct net_device *netdev,
174 				struct ethtool_pauseparam *pause)
175 {
176 	struct emac_adapter *adpt = netdev_priv(netdev);
177 
178 	pause->autoneg = adpt->automatic ? AUTONEG_ENABLE : AUTONEG_DISABLE;
179 	pause->rx_pause = adpt->rx_flow_control ? 1 : 0;
180 	pause->tx_pause = adpt->tx_flow_control ? 1 : 0;
181 }
182 
183 static int emac_set_pauseparam(struct net_device *netdev,
184 			       struct ethtool_pauseparam *pause)
185 {
186 	struct emac_adapter *adpt = netdev_priv(netdev);
187 
188 	adpt->automatic = pause->autoneg == AUTONEG_ENABLE;
189 	adpt->rx_flow_control = pause->rx_pause != 0;
190 	adpt->tx_flow_control = pause->tx_pause != 0;
191 
192 	if (netif_running(netdev))
193 		return emac_reinit_locked(adpt);
194 
195 	return 0;
196 }
197 
198 /* Selected registers that might want to track during runtime. */
199 static const u16 emac_regs[] = {
200 	EMAC_DMA_MAS_CTRL,
201 	EMAC_MAC_CTRL,
202 	EMAC_TXQ_CTRL_0,
203 	EMAC_RXQ_CTRL_0,
204 	EMAC_DMA_CTRL,
205 	EMAC_INT_MASK,
206 	EMAC_AXI_MAST_CTRL,
207 	EMAC_CORE_HW_VERSION,
208 	EMAC_MISC_CTRL,
209 };
210 
211 /* Every time emac_regs[] above is changed, increase this version number. */
212 #define EMAC_REGS_VERSION	0
213 
214 #define EMAC_MAX_REG_SIZE	ARRAY_SIZE(emac_regs)
215 
216 static void emac_get_regs(struct net_device *netdev,
217 			  struct ethtool_regs *regs, void *buff)
218 {
219 	struct emac_adapter *adpt = netdev_priv(netdev);
220 	u32 *val = buff;
221 	unsigned int i;
222 
223 	regs->version = EMAC_REGS_VERSION;
224 	regs->len = EMAC_MAX_REG_SIZE * sizeof(u32);
225 
226 	for (i = 0; i < EMAC_MAX_REG_SIZE; i++)
227 		val[i] = readl(adpt->base + emac_regs[i]);
228 }
229 
230 static int emac_get_regs_len(struct net_device *netdev)
231 {
232 	return EMAC_MAX_REG_SIZE * sizeof(u32);
233 }
234 
235 #define EMAC_PRIV_ENABLE_SINGLE_PAUSE	BIT(0)
236 
237 static int emac_set_priv_flags(struct net_device *netdev, u32 flags)
238 {
239 	struct emac_adapter *adpt = netdev_priv(netdev);
240 
241 	adpt->single_pause_mode = !!(flags & EMAC_PRIV_ENABLE_SINGLE_PAUSE);
242 
243 	if (netif_running(netdev))
244 		return emac_reinit_locked(adpt);
245 
246 	return 0;
247 }
248 
249 static u32 emac_get_priv_flags(struct net_device *netdev)
250 {
251 	struct emac_adapter *adpt = netdev_priv(netdev);
252 
253 	return adpt->single_pause_mode ? EMAC_PRIV_ENABLE_SINGLE_PAUSE : 0;
254 }
255 
256 static const struct ethtool_ops emac_ethtool_ops = {
257 	.get_link_ksettings = phy_ethtool_get_link_ksettings,
258 	.set_link_ksettings = phy_ethtool_set_link_ksettings,
259 
260 	.get_msglevel    = emac_get_msglevel,
261 	.set_msglevel    = emac_set_msglevel,
262 
263 	.get_sset_count  = emac_get_sset_count,
264 	.get_strings = emac_get_strings,
265 	.get_ethtool_stats = emac_get_ethtool_stats,
266 
267 	.get_ringparam = emac_get_ringparam,
268 	.set_ringparam = emac_set_ringparam,
269 
270 	.get_pauseparam = emac_get_pauseparam,
271 	.set_pauseparam = emac_set_pauseparam,
272 
273 	.nway_reset = emac_nway_reset,
274 
275 	.get_link = ethtool_op_get_link,
276 
277 	.get_regs_len    = emac_get_regs_len,
278 	.get_regs        = emac_get_regs,
279 
280 	.set_priv_flags = emac_set_priv_flags,
281 	.get_priv_flags = emac_get_priv_flags,
282 };
283 
284 void emac_set_ethtool_ops(struct net_device *netdev)
285 {
286 	netdev->ethtool_ops = &emac_ethtool_ops;
287 }
288