1 // SPDX-License-Identifier: GPL-2.0
2 /* Texas Instruments K3 AM65 Ethernet Switch SubSystem Driver ethtool ops
3 *
4 * Copyright (C) 2020 Texas Instruments Incorporated - http://www.ti.com/
5 *
6 */
7
8 #include <linux/net_tstamp.h>
9 #include <linux/phy.h>
10 #include <linux/platform_device.h>
11 #include <linux/pm_runtime.h>
12
13 #include "am65-cpsw-nuss.h"
14 #include "cpsw_ale.h"
15 #include "am65-cpts.h"
16
17 #define AM65_CPSW_REGDUMP_VER 0x1
18
19 enum {
20 AM65_CPSW_REGDUMP_MOD_NUSS = 1,
21 AM65_CPSW_REGDUMP_MOD_RGMII_STATUS = 2,
22 AM65_CPSW_REGDUMP_MOD_MDIO = 3,
23 AM65_CPSW_REGDUMP_MOD_CPSW = 4,
24 AM65_CPSW_REGDUMP_MOD_CPSW_P0 = 5,
25 AM65_CPSW_REGDUMP_MOD_CPSW_P1 = 6,
26 AM65_CPSW_REGDUMP_MOD_CPSW_CPTS = 7,
27 AM65_CPSW_REGDUMP_MOD_CPSW_ALE = 8,
28 AM65_CPSW_REGDUMP_MOD_CPSW_ALE_TBL = 9,
29 AM65_CPSW_REGDUMP_MOD_LAST,
30 };
31
32 /**
33 * struct am65_cpsw_regdump_hdr - regdump record header
34 *
35 * @module_id: CPSW module ID
36 * @len: CPSW module registers space length in u32
37 */
38
39 struct am65_cpsw_regdump_hdr {
40 u32 module_id;
41 u32 len;
42 };
43
44 /**
45 * struct am65_cpsw_regdump_item - regdump module description
46 *
47 * @hdr: CPSW module header
48 * @start_ofs: CPSW module registers start addr
49 * @end_ofs: CPSW module registers end addr
50 *
51 * Registers dump provided in the format:
52 * u32 : module ID
53 * u32 : dump length
54 * u32[..len]: registers values
55 */
56 struct am65_cpsw_regdump_item {
57 struct am65_cpsw_regdump_hdr hdr;
58 u32 start_ofs;
59 u32 end_ofs;
60 };
61
62 #define AM65_CPSW_REGDUMP_REC(mod, start, end) { \
63 .hdr.module_id = (mod), \
64 .hdr.len = (((u32 *)(end)) - ((u32 *)(start)) + 1) * sizeof(u32) * 2 + \
65 sizeof(struct am65_cpsw_regdump_hdr), \
66 .start_ofs = (start), \
67 .end_ofs = end, \
68 }
69
70 static const struct am65_cpsw_regdump_item am65_cpsw_regdump[] = {
71 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_NUSS, 0x0, 0x1c),
72 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_RGMII_STATUS, 0x30, 0x4c),
73 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_MDIO, 0xf00, 0xffc),
74 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW, 0x20000, 0x2011c),
75 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW_P0, 0x21000, 0x21320),
76 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW_P1, 0x22000, 0x223a4),
77 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW_CPTS,
78 0x3d000, 0x3d048),
79 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW_ALE, 0x3e000, 0x3e13c),
80 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW_ALE_TBL, 0, 0),
81 };
82
83 struct am65_cpsw_stats_regs {
84 u32 rx_good_frames;
85 u32 rx_broadcast_frames;
86 u32 rx_multicast_frames;
87 u32 rx_pause_frames; /* slave */
88 u32 rx_crc_errors;
89 u32 rx_align_code_errors; /* slave */
90 u32 rx_oversized_frames;
91 u32 rx_jabber_frames; /* slave */
92 u32 rx_undersized_frames;
93 u32 rx_fragments; /* slave */
94 u32 ale_drop;
95 u32 ale_overrun_drop;
96 u32 rx_octets;
97 u32 tx_good_frames;
98 u32 tx_broadcast_frames;
99 u32 tx_multicast_frames;
100 u32 tx_pause_frames; /* slave */
101 u32 tx_deferred_frames; /* slave */
102 u32 tx_collision_frames; /* slave */
103 u32 tx_single_coll_frames; /* slave */
104 u32 tx_mult_coll_frames; /* slave */
105 u32 tx_excessive_collisions; /* slave */
106 u32 tx_late_collisions; /* slave */
107 u32 rx_ipg_error; /* slave 10G only */
108 u32 tx_carrier_sense_errors; /* slave */
109 u32 tx_octets;
110 u32 tx_64B_frames;
111 u32 tx_65_to_127B_frames;
112 u32 tx_128_to_255B_frames;
113 u32 tx_256_to_511B_frames;
114 u32 tx_512_to_1023B_frames;
115 u32 tx_1024B_frames;
116 u32 net_octets;
117 u32 rx_bottom_fifo_drop;
118 u32 rx_port_mask_drop;
119 u32 rx_top_fifo_drop;
120 u32 ale_rate_limit_drop;
121 u32 ale_vid_ingress_drop;
122 u32 ale_da_eq_sa_drop;
123 u32 ale_block_drop; /* K3 */
124 u32 ale_secure_drop; /* K3 */
125 u32 ale_auth_drop; /* K3 */
126 u32 ale_unknown_ucast;
127 u32 ale_unknown_ucast_bytes;
128 u32 ale_unknown_mcast;
129 u32 ale_unknown_mcast_bytes;
130 u32 ale_unknown_bcast;
131 u32 ale_unknown_bcast_bytes;
132 u32 ale_pol_match;
133 u32 ale_pol_match_red;
134 u32 ale_pol_match_yellow;
135 u32 ale_mcast_sa_drop; /* K3 */
136 u32 ale_dual_vlan_drop; /* K3 */
137 u32 ale_len_err_drop; /* K3 */
138 u32 ale_ip_next_hdr_drop; /* K3 */
139 u32 ale_ipv4_frag_drop; /* K3 */
140 u32 __rsvd_1[24];
141 u32 iet_rx_assembly_err; /* K3 slave */
142 u32 iet_rx_assembly_ok; /* K3 slave */
143 u32 iet_rx_smd_err; /* K3 slave */
144 u32 iet_rx_frag; /* K3 slave */
145 u32 iet_tx_hold; /* K3 slave */
146 u32 iet_tx_frag; /* K3 slave */
147 u32 __rsvd_2[9];
148 u32 tx_mem_protect_err;
149 /* following NU only */
150 u32 tx_pri0;
151 u32 tx_pri1;
152 u32 tx_pri2;
153 u32 tx_pri3;
154 u32 tx_pri4;
155 u32 tx_pri5;
156 u32 tx_pri6;
157 u32 tx_pri7;
158 u32 tx_pri0_bcnt;
159 u32 tx_pri1_bcnt;
160 u32 tx_pri2_bcnt;
161 u32 tx_pri3_bcnt;
162 u32 tx_pri4_bcnt;
163 u32 tx_pri5_bcnt;
164 u32 tx_pri6_bcnt;
165 u32 tx_pri7_bcnt;
166 u32 tx_pri0_drop;
167 u32 tx_pri1_drop;
168 u32 tx_pri2_drop;
169 u32 tx_pri3_drop;
170 u32 tx_pri4_drop;
171 u32 tx_pri5_drop;
172 u32 tx_pri6_drop;
173 u32 tx_pri7_drop;
174 u32 tx_pri0_drop_bcnt;
175 u32 tx_pri1_drop_bcnt;
176 u32 tx_pri2_drop_bcnt;
177 u32 tx_pri3_drop_bcnt;
178 u32 tx_pri4_drop_bcnt;
179 u32 tx_pri5_drop_bcnt;
180 u32 tx_pri6_drop_bcnt;
181 u32 tx_pri7_drop_bcnt;
182 };
183
184 struct am65_cpsw_ethtool_stat {
185 char desc[ETH_GSTRING_LEN];
186 int offset;
187 };
188
189 #define AM65_CPSW_STATS(prefix, field) \
190 { \
191 #prefix#field, \
192 offsetof(struct am65_cpsw_stats_regs, field) \
193 }
194
195 static const struct am65_cpsw_ethtool_stat am65_host_stats[] = {
196 AM65_CPSW_STATS(p0_, rx_good_frames),
197 AM65_CPSW_STATS(p0_, rx_broadcast_frames),
198 AM65_CPSW_STATS(p0_, rx_multicast_frames),
199 AM65_CPSW_STATS(p0_, rx_crc_errors),
200 AM65_CPSW_STATS(p0_, rx_oversized_frames),
201 AM65_CPSW_STATS(p0_, rx_undersized_frames),
202 AM65_CPSW_STATS(p0_, ale_drop),
203 AM65_CPSW_STATS(p0_, ale_overrun_drop),
204 AM65_CPSW_STATS(p0_, rx_octets),
205 AM65_CPSW_STATS(p0_, tx_good_frames),
206 AM65_CPSW_STATS(p0_, tx_broadcast_frames),
207 AM65_CPSW_STATS(p0_, tx_multicast_frames),
208 AM65_CPSW_STATS(p0_, tx_octets),
209 AM65_CPSW_STATS(p0_, tx_64B_frames),
210 AM65_CPSW_STATS(p0_, tx_65_to_127B_frames),
211 AM65_CPSW_STATS(p0_, tx_128_to_255B_frames),
212 AM65_CPSW_STATS(p0_, tx_256_to_511B_frames),
213 AM65_CPSW_STATS(p0_, tx_512_to_1023B_frames),
214 AM65_CPSW_STATS(p0_, tx_1024B_frames),
215 AM65_CPSW_STATS(p0_, net_octets),
216 AM65_CPSW_STATS(p0_, rx_bottom_fifo_drop),
217 AM65_CPSW_STATS(p0_, rx_port_mask_drop),
218 AM65_CPSW_STATS(p0_, rx_top_fifo_drop),
219 AM65_CPSW_STATS(p0_, ale_rate_limit_drop),
220 AM65_CPSW_STATS(p0_, ale_vid_ingress_drop),
221 AM65_CPSW_STATS(p0_, ale_da_eq_sa_drop),
222 AM65_CPSW_STATS(p0_, ale_block_drop),
223 AM65_CPSW_STATS(p0_, ale_secure_drop),
224 AM65_CPSW_STATS(p0_, ale_auth_drop),
225 AM65_CPSW_STATS(p0_, ale_unknown_ucast),
226 AM65_CPSW_STATS(p0_, ale_unknown_ucast_bytes),
227 AM65_CPSW_STATS(p0_, ale_unknown_mcast),
228 AM65_CPSW_STATS(p0_, ale_unknown_mcast_bytes),
229 AM65_CPSW_STATS(p0_, ale_unknown_bcast),
230 AM65_CPSW_STATS(p0_, ale_unknown_bcast_bytes),
231 AM65_CPSW_STATS(p0_, ale_pol_match),
232 AM65_CPSW_STATS(p0_, ale_pol_match_red),
233 AM65_CPSW_STATS(p0_, ale_pol_match_yellow),
234 AM65_CPSW_STATS(p0_, ale_mcast_sa_drop),
235 AM65_CPSW_STATS(p0_, ale_dual_vlan_drop),
236 AM65_CPSW_STATS(p0_, ale_len_err_drop),
237 AM65_CPSW_STATS(p0_, ale_ip_next_hdr_drop),
238 AM65_CPSW_STATS(p0_, ale_ipv4_frag_drop),
239 AM65_CPSW_STATS(p0_, tx_mem_protect_err),
240 AM65_CPSW_STATS(p0_, tx_pri0),
241 AM65_CPSW_STATS(p0_, tx_pri1),
242 AM65_CPSW_STATS(p0_, tx_pri2),
243 AM65_CPSW_STATS(p0_, tx_pri3),
244 AM65_CPSW_STATS(p0_, tx_pri4),
245 AM65_CPSW_STATS(p0_, tx_pri5),
246 AM65_CPSW_STATS(p0_, tx_pri6),
247 AM65_CPSW_STATS(p0_, tx_pri7),
248 AM65_CPSW_STATS(p0_, tx_pri0_bcnt),
249 AM65_CPSW_STATS(p0_, tx_pri1_bcnt),
250 AM65_CPSW_STATS(p0_, tx_pri2_bcnt),
251 AM65_CPSW_STATS(p0_, tx_pri3_bcnt),
252 AM65_CPSW_STATS(p0_, tx_pri4_bcnt),
253 AM65_CPSW_STATS(p0_, tx_pri5_bcnt),
254 AM65_CPSW_STATS(p0_, tx_pri6_bcnt),
255 AM65_CPSW_STATS(p0_, tx_pri7_bcnt),
256 AM65_CPSW_STATS(p0_, tx_pri0_drop),
257 AM65_CPSW_STATS(p0_, tx_pri1_drop),
258 AM65_CPSW_STATS(p0_, tx_pri2_drop),
259 AM65_CPSW_STATS(p0_, tx_pri3_drop),
260 AM65_CPSW_STATS(p0_, tx_pri4_drop),
261 AM65_CPSW_STATS(p0_, tx_pri5_drop),
262 AM65_CPSW_STATS(p0_, tx_pri6_drop),
263 AM65_CPSW_STATS(p0_, tx_pri7_drop),
264 AM65_CPSW_STATS(p0_, tx_pri0_drop_bcnt),
265 AM65_CPSW_STATS(p0_, tx_pri1_drop_bcnt),
266 AM65_CPSW_STATS(p0_, tx_pri2_drop_bcnt),
267 AM65_CPSW_STATS(p0_, tx_pri3_drop_bcnt),
268 AM65_CPSW_STATS(p0_, tx_pri4_drop_bcnt),
269 AM65_CPSW_STATS(p0_, tx_pri5_drop_bcnt),
270 AM65_CPSW_STATS(p0_, tx_pri6_drop_bcnt),
271 AM65_CPSW_STATS(p0_, tx_pri7_drop_bcnt),
272 };
273
274 static const struct am65_cpsw_ethtool_stat am65_slave_stats[] = {
275 AM65_CPSW_STATS(, rx_good_frames),
276 AM65_CPSW_STATS(, rx_broadcast_frames),
277 AM65_CPSW_STATS(, rx_multicast_frames),
278 AM65_CPSW_STATS(, rx_pause_frames),
279 AM65_CPSW_STATS(, rx_crc_errors),
280 AM65_CPSW_STATS(, rx_align_code_errors),
281 AM65_CPSW_STATS(, rx_oversized_frames),
282 AM65_CPSW_STATS(, rx_jabber_frames),
283 AM65_CPSW_STATS(, rx_undersized_frames),
284 AM65_CPSW_STATS(, rx_fragments),
285 AM65_CPSW_STATS(, ale_drop),
286 AM65_CPSW_STATS(, ale_overrun_drop),
287 AM65_CPSW_STATS(, rx_octets),
288 AM65_CPSW_STATS(, tx_good_frames),
289 AM65_CPSW_STATS(, tx_broadcast_frames),
290 AM65_CPSW_STATS(, tx_multicast_frames),
291 AM65_CPSW_STATS(, tx_pause_frames),
292 AM65_CPSW_STATS(, tx_deferred_frames),
293 AM65_CPSW_STATS(, tx_collision_frames),
294 AM65_CPSW_STATS(, tx_single_coll_frames),
295 AM65_CPSW_STATS(, tx_mult_coll_frames),
296 AM65_CPSW_STATS(, tx_excessive_collisions),
297 AM65_CPSW_STATS(, tx_late_collisions),
298 AM65_CPSW_STATS(, rx_ipg_error),
299 AM65_CPSW_STATS(, tx_carrier_sense_errors),
300 AM65_CPSW_STATS(, tx_octets),
301 AM65_CPSW_STATS(, tx_64B_frames),
302 AM65_CPSW_STATS(, tx_65_to_127B_frames),
303 AM65_CPSW_STATS(, tx_128_to_255B_frames),
304 AM65_CPSW_STATS(, tx_256_to_511B_frames),
305 AM65_CPSW_STATS(, tx_512_to_1023B_frames),
306 AM65_CPSW_STATS(, tx_1024B_frames),
307 AM65_CPSW_STATS(, net_octets),
308 AM65_CPSW_STATS(, rx_bottom_fifo_drop),
309 AM65_CPSW_STATS(, rx_port_mask_drop),
310 AM65_CPSW_STATS(, rx_top_fifo_drop),
311 AM65_CPSW_STATS(, ale_rate_limit_drop),
312 AM65_CPSW_STATS(, ale_vid_ingress_drop),
313 AM65_CPSW_STATS(, ale_da_eq_sa_drop),
314 AM65_CPSW_STATS(, ale_block_drop),
315 AM65_CPSW_STATS(, ale_secure_drop),
316 AM65_CPSW_STATS(, ale_auth_drop),
317 AM65_CPSW_STATS(, ale_unknown_ucast),
318 AM65_CPSW_STATS(, ale_unknown_ucast_bytes),
319 AM65_CPSW_STATS(, ale_unknown_mcast),
320 AM65_CPSW_STATS(, ale_unknown_mcast_bytes),
321 AM65_CPSW_STATS(, ale_unknown_bcast),
322 AM65_CPSW_STATS(, ale_unknown_bcast_bytes),
323 AM65_CPSW_STATS(, ale_pol_match),
324 AM65_CPSW_STATS(, ale_pol_match_red),
325 AM65_CPSW_STATS(, ale_pol_match_yellow),
326 AM65_CPSW_STATS(, ale_mcast_sa_drop),
327 AM65_CPSW_STATS(, ale_dual_vlan_drop),
328 AM65_CPSW_STATS(, ale_len_err_drop),
329 AM65_CPSW_STATS(, ale_ip_next_hdr_drop),
330 AM65_CPSW_STATS(, ale_ipv4_frag_drop),
331 AM65_CPSW_STATS(, iet_rx_assembly_err),
332 AM65_CPSW_STATS(, iet_rx_assembly_ok),
333 AM65_CPSW_STATS(, iet_rx_smd_err),
334 AM65_CPSW_STATS(, iet_rx_frag),
335 AM65_CPSW_STATS(, iet_tx_hold),
336 AM65_CPSW_STATS(, iet_tx_frag),
337 AM65_CPSW_STATS(, tx_mem_protect_err),
338 AM65_CPSW_STATS(, tx_pri0),
339 AM65_CPSW_STATS(, tx_pri1),
340 AM65_CPSW_STATS(, tx_pri2),
341 AM65_CPSW_STATS(, tx_pri3),
342 AM65_CPSW_STATS(, tx_pri4),
343 AM65_CPSW_STATS(, tx_pri5),
344 AM65_CPSW_STATS(, tx_pri6),
345 AM65_CPSW_STATS(, tx_pri7),
346 AM65_CPSW_STATS(, tx_pri0_bcnt),
347 AM65_CPSW_STATS(, tx_pri1_bcnt),
348 AM65_CPSW_STATS(, tx_pri2_bcnt),
349 AM65_CPSW_STATS(, tx_pri3_bcnt),
350 AM65_CPSW_STATS(, tx_pri4_bcnt),
351 AM65_CPSW_STATS(, tx_pri5_bcnt),
352 AM65_CPSW_STATS(, tx_pri6_bcnt),
353 AM65_CPSW_STATS(, tx_pri7_bcnt),
354 AM65_CPSW_STATS(, tx_pri0_drop),
355 AM65_CPSW_STATS(, tx_pri1_drop),
356 AM65_CPSW_STATS(, tx_pri2_drop),
357 AM65_CPSW_STATS(, tx_pri3_drop),
358 AM65_CPSW_STATS(, tx_pri4_drop),
359 AM65_CPSW_STATS(, tx_pri5_drop),
360 AM65_CPSW_STATS(, tx_pri6_drop),
361 AM65_CPSW_STATS(, tx_pri7_drop),
362 AM65_CPSW_STATS(, tx_pri0_drop_bcnt),
363 AM65_CPSW_STATS(, tx_pri1_drop_bcnt),
364 AM65_CPSW_STATS(, tx_pri2_drop_bcnt),
365 AM65_CPSW_STATS(, tx_pri3_drop_bcnt),
366 AM65_CPSW_STATS(, tx_pri4_drop_bcnt),
367 AM65_CPSW_STATS(, tx_pri5_drop_bcnt),
368 AM65_CPSW_STATS(, tx_pri6_drop_bcnt),
369 AM65_CPSW_STATS(, tx_pri7_drop_bcnt),
370 };
371
372 /* Ethtool priv_flags */
373 static const char am65_cpsw_ethtool_priv_flags[][ETH_GSTRING_LEN] = {
374 #define AM65_CPSW_PRIV_P0_RX_PTYPE_RROBIN BIT(0)
375 "p0-rx-ptype-rrobin",
376 };
377
am65_cpsw_ethtool_op_begin(struct net_device * ndev)378 static int am65_cpsw_ethtool_op_begin(struct net_device *ndev)
379 {
380 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
381 int ret;
382
383 ret = pm_runtime_get_sync(common->dev);
384 if (ret < 0) {
385 dev_err(common->dev, "ethtool begin failed %d\n", ret);
386 pm_runtime_put_noidle(common->dev);
387 }
388
389 return ret;
390 }
391
am65_cpsw_ethtool_op_complete(struct net_device * ndev)392 static void am65_cpsw_ethtool_op_complete(struct net_device *ndev)
393 {
394 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
395 int ret;
396
397 ret = pm_runtime_put(common->dev);
398 if (ret < 0 && ret != -EBUSY)
399 dev_err(common->dev, "ethtool complete failed %d\n", ret);
400 }
401
am65_cpsw_get_drvinfo(struct net_device * ndev,struct ethtool_drvinfo * info)402 static void am65_cpsw_get_drvinfo(struct net_device *ndev,
403 struct ethtool_drvinfo *info)
404 {
405 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
406
407 strlcpy(info->driver, dev_driver_string(common->dev),
408 sizeof(info->driver));
409 strlcpy(info->bus_info, dev_name(common->dev), sizeof(info->bus_info));
410 }
411
am65_cpsw_get_msglevel(struct net_device * ndev)412 static u32 am65_cpsw_get_msglevel(struct net_device *ndev)
413 {
414 struct am65_cpsw_ndev_priv *priv = am65_ndev_to_priv(ndev);
415
416 return priv->msg_enable;
417 }
418
am65_cpsw_set_msglevel(struct net_device * ndev,u32 value)419 static void am65_cpsw_set_msglevel(struct net_device *ndev, u32 value)
420 {
421 struct am65_cpsw_ndev_priv *priv = am65_ndev_to_priv(ndev);
422
423 priv->msg_enable = value;
424 }
425
am65_cpsw_get_channels(struct net_device * ndev,struct ethtool_channels * ch)426 static void am65_cpsw_get_channels(struct net_device *ndev,
427 struct ethtool_channels *ch)
428 {
429 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
430
431 ch->max_rx = AM65_CPSW_MAX_RX_QUEUES;
432 ch->max_tx = AM65_CPSW_MAX_TX_QUEUES;
433 ch->rx_count = AM65_CPSW_MAX_RX_QUEUES;
434 ch->tx_count = common->tx_ch_num;
435 }
436
am65_cpsw_set_channels(struct net_device * ndev,struct ethtool_channels * chs)437 static int am65_cpsw_set_channels(struct net_device *ndev,
438 struct ethtool_channels *chs)
439 {
440 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
441
442 if (!chs->rx_count || !chs->tx_count)
443 return -EINVAL;
444
445 /* Check if interface is up. Can change the num queues when
446 * the interface is down.
447 */
448 if (common->usage_count)
449 return -EBUSY;
450
451 am65_cpsw_nuss_remove_tx_chns(common);
452
453 return am65_cpsw_nuss_update_tx_chns(common, chs->tx_count);
454 }
455
am65_cpsw_get_ringparam(struct net_device * ndev,struct ethtool_ringparam * ering)456 static void am65_cpsw_get_ringparam(struct net_device *ndev,
457 struct ethtool_ringparam *ering)
458 {
459 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
460
461 /* not supported */
462 ering->tx_pending = common->tx_chns[0].descs_num;
463 ering->rx_pending = common->rx_chns.descs_num;
464 }
465
am65_cpsw_get_pauseparam(struct net_device * ndev,struct ethtool_pauseparam * pause)466 static void am65_cpsw_get_pauseparam(struct net_device *ndev,
467 struct ethtool_pauseparam *pause)
468 {
469 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev);
470
471 pause->autoneg = AUTONEG_DISABLE;
472 pause->rx_pause = salve->rx_pause ? true : false;
473 pause->tx_pause = salve->tx_pause ? true : false;
474 }
475
am65_cpsw_set_pauseparam(struct net_device * ndev,struct ethtool_pauseparam * pause)476 static int am65_cpsw_set_pauseparam(struct net_device *ndev,
477 struct ethtool_pauseparam *pause)
478 {
479 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev);
480
481 if (!salve->phy)
482 return -EINVAL;
483
484 if (!phy_validate_pause(salve->phy, pause))
485 return -EINVAL;
486
487 salve->rx_pause = pause->rx_pause ? true : false;
488 salve->tx_pause = pause->tx_pause ? true : false;
489
490 phy_set_asym_pause(salve->phy, salve->rx_pause, salve->tx_pause);
491
492 return 0;
493 }
494
am65_cpsw_get_wol(struct net_device * ndev,struct ethtool_wolinfo * wol)495 static void am65_cpsw_get_wol(struct net_device *ndev,
496 struct ethtool_wolinfo *wol)
497 {
498 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev);
499
500 wol->supported = 0;
501 wol->wolopts = 0;
502
503 if (salve->phy)
504 phy_ethtool_get_wol(salve->phy, wol);
505 }
506
am65_cpsw_set_wol(struct net_device * ndev,struct ethtool_wolinfo * wol)507 static int am65_cpsw_set_wol(struct net_device *ndev,
508 struct ethtool_wolinfo *wol)
509 {
510 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev);
511
512 if (!salve->phy)
513 return -EOPNOTSUPP;
514
515 return phy_ethtool_set_wol(salve->phy, wol);
516 }
517
am65_cpsw_get_link_ksettings(struct net_device * ndev,struct ethtool_link_ksettings * ecmd)518 static int am65_cpsw_get_link_ksettings(struct net_device *ndev,
519 struct ethtool_link_ksettings *ecmd)
520 {
521 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev);
522
523 if (!salve->phy)
524 return -EOPNOTSUPP;
525
526 phy_ethtool_ksettings_get(salve->phy, ecmd);
527 return 0;
528 }
529
530 static int
am65_cpsw_set_link_ksettings(struct net_device * ndev,const struct ethtool_link_ksettings * ecmd)531 am65_cpsw_set_link_ksettings(struct net_device *ndev,
532 const struct ethtool_link_ksettings *ecmd)
533 {
534 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev);
535
536 if (!salve->phy || phy_is_pseudo_fixed_link(salve->phy))
537 return -EOPNOTSUPP;
538
539 return phy_ethtool_ksettings_set(salve->phy, ecmd);
540 }
541
am65_cpsw_get_eee(struct net_device * ndev,struct ethtool_eee * edata)542 static int am65_cpsw_get_eee(struct net_device *ndev, struct ethtool_eee *edata)
543 {
544 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev);
545
546 if (!salve->phy || phy_is_pseudo_fixed_link(salve->phy))
547 return -EOPNOTSUPP;
548
549 return phy_ethtool_get_eee(salve->phy, edata);
550 }
551
am65_cpsw_set_eee(struct net_device * ndev,struct ethtool_eee * edata)552 static int am65_cpsw_set_eee(struct net_device *ndev, struct ethtool_eee *edata)
553 {
554 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev);
555
556 if (!salve->phy || phy_is_pseudo_fixed_link(salve->phy))
557 return -EOPNOTSUPP;
558
559 return phy_ethtool_set_eee(salve->phy, edata);
560 }
561
am65_cpsw_nway_reset(struct net_device * ndev)562 static int am65_cpsw_nway_reset(struct net_device *ndev)
563 {
564 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev);
565
566 if (!salve->phy || phy_is_pseudo_fixed_link(salve->phy))
567 return -EOPNOTSUPP;
568
569 return phy_restart_aneg(salve->phy);
570 }
571
am65_cpsw_get_regs_len(struct net_device * ndev)572 static int am65_cpsw_get_regs_len(struct net_device *ndev)
573 {
574 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
575 u32 ale_entries, i, regdump_len = 0;
576
577 ale_entries = cpsw_ale_get_num_entries(common->ale);
578 for (i = 0; i < ARRAY_SIZE(am65_cpsw_regdump); i++) {
579 if (am65_cpsw_regdump[i].hdr.module_id ==
580 AM65_CPSW_REGDUMP_MOD_CPSW_ALE_TBL) {
581 regdump_len += sizeof(struct am65_cpsw_regdump_hdr);
582 regdump_len += ale_entries *
583 ALE_ENTRY_WORDS * sizeof(u32);
584 continue;
585 }
586 regdump_len += am65_cpsw_regdump[i].hdr.len;
587 }
588
589 return regdump_len;
590 }
591
am65_cpsw_get_regs(struct net_device * ndev,struct ethtool_regs * regs,void * p)592 static void am65_cpsw_get_regs(struct net_device *ndev,
593 struct ethtool_regs *regs, void *p)
594 {
595 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
596 u32 ale_entries, i, j, pos, *reg = p;
597
598 /* update CPSW IP version */
599 regs->version = AM65_CPSW_REGDUMP_VER;
600 ale_entries = cpsw_ale_get_num_entries(common->ale);
601
602 pos = 0;
603 for (i = 0; i < ARRAY_SIZE(am65_cpsw_regdump); i++) {
604 reg[pos++] = am65_cpsw_regdump[i].hdr.module_id;
605
606 if (am65_cpsw_regdump[i].hdr.module_id ==
607 AM65_CPSW_REGDUMP_MOD_CPSW_ALE_TBL) {
608 u32 ale_tbl_len = ale_entries *
609 ALE_ENTRY_WORDS * sizeof(u32) +
610 sizeof(struct am65_cpsw_regdump_hdr);
611 reg[pos++] = ale_tbl_len;
612 cpsw_ale_dump(common->ale, ®[pos]);
613 pos += ale_tbl_len;
614 continue;
615 }
616
617 reg[pos++] = am65_cpsw_regdump[i].hdr.len;
618
619 j = am65_cpsw_regdump[i].start_ofs;
620 do {
621 reg[pos++] = j;
622 reg[pos++] = readl_relaxed(common->ss_base + j);
623 j += sizeof(u32);
624 } while (j <= am65_cpsw_regdump[i].end_ofs);
625 }
626 }
627
am65_cpsw_get_sset_count(struct net_device * ndev,int sset)628 static int am65_cpsw_get_sset_count(struct net_device *ndev, int sset)
629 {
630 switch (sset) {
631 case ETH_SS_STATS:
632 return ARRAY_SIZE(am65_host_stats) +
633 ARRAY_SIZE(am65_slave_stats);
634 case ETH_SS_PRIV_FLAGS:
635 return ARRAY_SIZE(am65_cpsw_ethtool_priv_flags);
636 default:
637 return -EOPNOTSUPP;
638 }
639 }
640
am65_cpsw_get_strings(struct net_device * ndev,u32 stringset,u8 * data)641 static void am65_cpsw_get_strings(struct net_device *ndev,
642 u32 stringset, u8 *data)
643 {
644 const struct am65_cpsw_ethtool_stat *hw_stats;
645 u32 i, num_stats;
646 u8 *p = data;
647
648 switch (stringset) {
649 case ETH_SS_STATS:
650 num_stats = ARRAY_SIZE(am65_host_stats);
651 hw_stats = am65_host_stats;
652 for (i = 0; i < num_stats; i++) {
653 memcpy(p, hw_stats[i].desc, ETH_GSTRING_LEN);
654 p += ETH_GSTRING_LEN;
655 }
656
657 num_stats = ARRAY_SIZE(am65_slave_stats);
658 hw_stats = am65_slave_stats;
659 for (i = 0; i < num_stats; i++) {
660 memcpy(p, hw_stats[i].desc, ETH_GSTRING_LEN);
661 p += ETH_GSTRING_LEN;
662 }
663 break;
664 case ETH_SS_PRIV_FLAGS:
665 num_stats = ARRAY_SIZE(am65_cpsw_ethtool_priv_flags);
666
667 for (i = 0; i < num_stats; i++) {
668 memcpy(p, am65_cpsw_ethtool_priv_flags[i],
669 ETH_GSTRING_LEN);
670 p += ETH_GSTRING_LEN;
671 }
672 break;
673 }
674 }
675
am65_cpsw_get_ethtool_stats(struct net_device * ndev,struct ethtool_stats * stats,u64 * data)676 static void am65_cpsw_get_ethtool_stats(struct net_device *ndev,
677 struct ethtool_stats *stats, u64 *data)
678 {
679 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
680 const struct am65_cpsw_ethtool_stat *hw_stats;
681 struct am65_cpsw_host *host_p;
682 struct am65_cpsw_port *port;
683 u32 i, num_stats;
684
685 host_p = am65_common_get_host(common);
686 port = am65_ndev_to_port(ndev);
687 num_stats = ARRAY_SIZE(am65_host_stats);
688 hw_stats = am65_host_stats;
689 for (i = 0; i < num_stats; i++)
690 *data++ = readl_relaxed(host_p->stat_base +
691 hw_stats[i].offset);
692
693 num_stats = ARRAY_SIZE(am65_slave_stats);
694 hw_stats = am65_slave_stats;
695 for (i = 0; i < num_stats; i++)
696 *data++ = readl_relaxed(port->stat_base +
697 hw_stats[i].offset);
698 }
699
am65_cpsw_get_ethtool_ts_info(struct net_device * ndev,struct ethtool_ts_info * info)700 static int am65_cpsw_get_ethtool_ts_info(struct net_device *ndev,
701 struct ethtool_ts_info *info)
702 {
703 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
704
705 if (!IS_ENABLED(CONFIG_TI_K3_AM65_CPTS))
706 return ethtool_op_get_ts_info(ndev, info);
707
708 info->so_timestamping =
709 SOF_TIMESTAMPING_TX_HARDWARE |
710 SOF_TIMESTAMPING_TX_SOFTWARE |
711 SOF_TIMESTAMPING_RX_HARDWARE |
712 SOF_TIMESTAMPING_RX_SOFTWARE |
713 SOF_TIMESTAMPING_SOFTWARE |
714 SOF_TIMESTAMPING_RAW_HARDWARE;
715 info->phc_index = am65_cpts_phc_index(common->cpts);
716 info->tx_types = BIT(HWTSTAMP_TX_OFF) | BIT(HWTSTAMP_TX_ON);
717 info->rx_filters = BIT(HWTSTAMP_FILTER_NONE) | BIT(HWTSTAMP_FILTER_ALL);
718 return 0;
719 }
720
am65_cpsw_get_ethtool_priv_flags(struct net_device * ndev)721 static u32 am65_cpsw_get_ethtool_priv_flags(struct net_device *ndev)
722 {
723 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
724 u32 priv_flags = 0;
725
726 if (common->pf_p0_rx_ptype_rrobin)
727 priv_flags |= AM65_CPSW_PRIV_P0_RX_PTYPE_RROBIN;
728
729 return priv_flags;
730 }
731
am65_cpsw_set_ethtool_priv_flags(struct net_device * ndev,u32 flags)732 static int am65_cpsw_set_ethtool_priv_flags(struct net_device *ndev, u32 flags)
733 {
734 struct am65_cpsw_common *common = am65_ndev_to_common(ndev);
735 int rrobin;
736
737 rrobin = !!(flags & AM65_CPSW_PRIV_P0_RX_PTYPE_RROBIN);
738
739 if (common->usage_count)
740 return -EBUSY;
741
742 if (common->est_enabled && rrobin) {
743 netdev_err(ndev,
744 "p0-rx-ptype-rrobin flag conflicts with QOS\n");
745 return -EINVAL;
746 }
747
748 common->pf_p0_rx_ptype_rrobin = rrobin;
749
750 return 0;
751 }
752
753 const struct ethtool_ops am65_cpsw_ethtool_ops_slave = {
754 .begin = am65_cpsw_ethtool_op_begin,
755 .complete = am65_cpsw_ethtool_op_complete,
756 .get_drvinfo = am65_cpsw_get_drvinfo,
757 .get_msglevel = am65_cpsw_get_msglevel,
758 .set_msglevel = am65_cpsw_set_msglevel,
759 .get_channels = am65_cpsw_get_channels,
760 .set_channels = am65_cpsw_set_channels,
761 .get_ringparam = am65_cpsw_get_ringparam,
762 .get_regs_len = am65_cpsw_get_regs_len,
763 .get_regs = am65_cpsw_get_regs,
764 .get_sset_count = am65_cpsw_get_sset_count,
765 .get_strings = am65_cpsw_get_strings,
766 .get_ethtool_stats = am65_cpsw_get_ethtool_stats,
767 .get_ts_info = am65_cpsw_get_ethtool_ts_info,
768 .get_priv_flags = am65_cpsw_get_ethtool_priv_flags,
769 .set_priv_flags = am65_cpsw_set_ethtool_priv_flags,
770
771 .get_link = ethtool_op_get_link,
772 .get_link_ksettings = am65_cpsw_get_link_ksettings,
773 .set_link_ksettings = am65_cpsw_set_link_ksettings,
774 .get_pauseparam = am65_cpsw_get_pauseparam,
775 .set_pauseparam = am65_cpsw_set_pauseparam,
776 .get_wol = am65_cpsw_get_wol,
777 .set_wol = am65_cpsw_set_wol,
778 .get_eee = am65_cpsw_get_eee,
779 .set_eee = am65_cpsw_set_eee,
780 .nway_reset = am65_cpsw_nway_reset,
781 };
782