2 * Copyright (c) 2015 - 2016, The Linux Foundation. All rights reserved.
4 * Permission to use, copy, modify, and/or distribute this software for
5 * any purpose with or without fee is hereby granted, provided that the
6 * above copyright notice and this permission notice appear in all copies.
7 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
8 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
9 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
10 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
11 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
12 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT
13 * OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
16 #include <linux/ethtool.h>
17 #include <linux/netdevice.h>
18 #include <linux/string.h>
19 #include <linux/version.h>
22 struct edma_ethtool_stats
{
23 uint8_t stat_string
[ETH_GSTRING_LEN
];
27 #define EDMA_STAT(m) offsetof(struct edma_ethtool_statistics, m)
28 #define DRVINFO_LEN 32
30 /* Array of strings describing statistics
32 static const struct edma_ethtool_stats edma_gstrings_stats
[] = {
33 {"tx_q0_pkt", EDMA_STAT(tx_q0_pkt
)},
34 {"tx_q1_pkt", EDMA_STAT(tx_q1_pkt
)},
35 {"tx_q2_pkt", EDMA_STAT(tx_q2_pkt
)},
36 {"tx_q3_pkt", EDMA_STAT(tx_q3_pkt
)},
37 {"tx_q4_pkt", EDMA_STAT(tx_q4_pkt
)},
38 {"tx_q5_pkt", EDMA_STAT(tx_q5_pkt
)},
39 {"tx_q6_pkt", EDMA_STAT(tx_q6_pkt
)},
40 {"tx_q7_pkt", EDMA_STAT(tx_q7_pkt
)},
41 {"tx_q8_pkt", EDMA_STAT(tx_q8_pkt
)},
42 {"tx_q9_pkt", EDMA_STAT(tx_q9_pkt
)},
43 {"tx_q10_pkt", EDMA_STAT(tx_q10_pkt
)},
44 {"tx_q11_pkt", EDMA_STAT(tx_q11_pkt
)},
45 {"tx_q12_pkt", EDMA_STAT(tx_q12_pkt
)},
46 {"tx_q13_pkt", EDMA_STAT(tx_q13_pkt
)},
47 {"tx_q14_pkt", EDMA_STAT(tx_q14_pkt
)},
48 {"tx_q15_pkt", EDMA_STAT(tx_q15_pkt
)},
49 {"tx_q0_byte", EDMA_STAT(tx_q0_byte
)},
50 {"tx_q1_byte", EDMA_STAT(tx_q1_byte
)},
51 {"tx_q2_byte", EDMA_STAT(tx_q2_byte
)},
52 {"tx_q3_byte", EDMA_STAT(tx_q3_byte
)},
53 {"tx_q4_byte", EDMA_STAT(tx_q4_byte
)},
54 {"tx_q5_byte", EDMA_STAT(tx_q5_byte
)},
55 {"tx_q6_byte", EDMA_STAT(tx_q6_byte
)},
56 {"tx_q7_byte", EDMA_STAT(tx_q7_byte
)},
57 {"tx_q8_byte", EDMA_STAT(tx_q8_byte
)},
58 {"tx_q9_byte", EDMA_STAT(tx_q9_byte
)},
59 {"tx_q10_byte", EDMA_STAT(tx_q10_byte
)},
60 {"tx_q11_byte", EDMA_STAT(tx_q11_byte
)},
61 {"tx_q12_byte", EDMA_STAT(tx_q12_byte
)},
62 {"tx_q13_byte", EDMA_STAT(tx_q13_byte
)},
63 {"tx_q14_byte", EDMA_STAT(tx_q14_byte
)},
64 {"tx_q15_byte", EDMA_STAT(tx_q15_byte
)},
65 {"rx_q0_pkt", EDMA_STAT(rx_q0_pkt
)},
66 {"rx_q1_pkt", EDMA_STAT(rx_q1_pkt
)},
67 {"rx_q2_pkt", EDMA_STAT(rx_q2_pkt
)},
68 {"rx_q3_pkt", EDMA_STAT(rx_q3_pkt
)},
69 {"rx_q4_pkt", EDMA_STAT(rx_q4_pkt
)},
70 {"rx_q5_pkt", EDMA_STAT(rx_q5_pkt
)},
71 {"rx_q6_pkt", EDMA_STAT(rx_q6_pkt
)},
72 {"rx_q7_pkt", EDMA_STAT(rx_q7_pkt
)},
73 {"rx_q0_byte", EDMA_STAT(rx_q0_byte
)},
74 {"rx_q1_byte", EDMA_STAT(rx_q1_byte
)},
75 {"rx_q2_byte", EDMA_STAT(rx_q2_byte
)},
76 {"rx_q3_byte", EDMA_STAT(rx_q3_byte
)},
77 {"rx_q4_byte", EDMA_STAT(rx_q4_byte
)},
78 {"rx_q5_byte", EDMA_STAT(rx_q5_byte
)},
79 {"rx_q6_byte", EDMA_STAT(rx_q6_byte
)},
80 {"rx_q7_byte", EDMA_STAT(rx_q7_byte
)},
81 {"tx_desc_error", EDMA_STAT(tx_desc_error
)},
82 {"rx_alloc_fail_ctr", EDMA_STAT(rx_alloc_fail_ctr
)},
85 #define EDMA_STATS_LEN ARRAY_SIZE(edma_gstrings_stats)
87 /* edma_get_strset_count()
90 static int edma_get_strset_count(struct net_device
*netdev
,
95 return EDMA_STATS_LEN
;
97 netdev_dbg(netdev
, "%s: Invalid string set", __func__
);
103 /* edma_get_strings()
106 static void edma_get_strings(struct net_device
*netdev
, uint32_t stringset
,
114 for (i
= 0; i
< EDMA_STATS_LEN
; i
++) {
115 memcpy(p
, edma_gstrings_stats
[i
].stat_string
,
116 min((size_t)ETH_GSTRING_LEN
,
117 strlen(edma_gstrings_stats
[i
].stat_string
)
119 p
+= ETH_GSTRING_LEN
;
125 /* edma_get_ethtool_stats()
126 * Get ethtool statistics
128 static void edma_get_ethtool_stats(struct net_device
*netdev
,
129 struct ethtool_stats
*stats
, uint64_t *data
)
131 struct edma_adapter
*adapter
= netdev_priv(netdev
);
132 struct edma_common_info
*edma_cinfo
= adapter
->edma_cinfo
;
136 edma_read_append_stats(edma_cinfo
);
138 for(i
= 0; i
< EDMA_STATS_LEN
; i
++) {
139 p
= (uint8_t *)&(edma_cinfo
->edma_ethstats
) +
140 edma_gstrings_stats
[i
].stat_offset
;
141 data
[i
] = *(uint32_t *)p
;
145 /* edma_get_drvinfo()
146 * get edma driver info
148 static void edma_get_drvinfo(struct net_device
*dev
,
149 struct ethtool_drvinfo
*info
)
151 strlcpy(info
->driver
, "ess_edma", DRVINFO_LEN
);
152 strlcpy(info
->bus_info
, "axi", ETHTOOL_BUSINFO_LEN
);
156 * Reset the phy, if available.
158 static int edma_nway_reset(struct net_device
*netdev
)
164 * get wake on lan info
166 static void edma_get_wol(struct net_device
*netdev
,
167 struct ethtool_wolinfo
*wol
)
173 /* edma_get_msglevel()
176 static uint32_t edma_get_msglevel(struct net_device
*netdev
)
181 /* edma_get_settings()
184 static int edma_get_settings(struct net_device
*netdev
,
185 struct ethtool_link_ksettings
*cmd
)
187 struct edma_adapter
*adapter
= netdev_priv(netdev
);
189 if (adapter
->poll_required
) {
190 if ((adapter
->forced_speed
!= SPEED_UNKNOWN
)
191 && !(adapter
->poll_required
))
194 phy_ethtool_ksettings_get(adapter
->phydev
, cmd
);
195 if (linkmode_test_bit(ETHTOOL_LINK_MODE_FIBRE_BIT
, adapter
->phydev
->advertising
))
196 cmd
->base
.port
= PORT_FIBRE
;
198 cmd
->base
.port
= PORT_TP
;
200 /* If the speed/duplex for this GMAC is forced and we
201 * are not polling for link state changes, return the
202 * values as specified by platform. This will be true
203 * for GMACs connected to switch, and interfaces that
206 if (!(adapter
->poll_required
)) {
207 if (adapter
->forced_speed
!= SPEED_UNKNOWN
) {
208 /* set speed and duplex */
209 cmd
->base
.speed
= SPEED_1000
;
210 cmd
->base
.duplex
= DUPLEX_FULL
;
212 /* Populate capabilities advertised by self */
213 linkmode_zero(cmd
->link_modes
.advertising
);
214 cmd
->base
.autoneg
= 0;
215 cmd
->base
.port
= PORT_TP
;
216 cmd
->base
.transceiver
= XCVR_EXTERNAL
;
218 /* non link polled and non
219 * forced speed/duplex interface
229 /* edma_set_settings()
232 static int edma_set_settings(struct net_device
*netdev
,
233 const struct ethtool_link_ksettings
*cmd
)
235 struct edma_adapter
*adapter
= netdev_priv(netdev
);
237 if ((adapter
->forced_speed
!= SPEED_UNKNOWN
) &&
238 !adapter
->poll_required
)
241 return phy_ethtool_ksettings_set(adapter
->phydev
, cmd
);
245 * get interrupt mitigation
247 static int edma_get_coalesce(struct net_device
*netdev
,
248 struct ethtool_coalesce
*ec
)
252 edma_get_tx_rx_coalesce(®_val
);
254 /* We read the Interrupt Moderation Timer(IMT) register value,
255 * use lower 16 bit for rx and higher 16 bit for Tx. We do a
256 * left shift by 1, because IMT resolution timer is 2usecs.
257 * Hence the value given by the register is multiplied by 2 to
258 * get the actual time in usecs.
260 ec
->tx_coalesce_usecs
= (((reg_val
>> 16) & 0xffff) << 1);
261 ec
->rx_coalesce_usecs
= ((reg_val
& 0xffff) << 1);
267 * set interrupt mitigation
269 static int edma_set_coalesce(struct net_device
*netdev
,
270 struct ethtool_coalesce
*ec
)
272 if (ec
->tx_coalesce_usecs
)
273 edma_change_tx_coalesce(ec
->tx_coalesce_usecs
);
274 if (ec
->rx_coalesce_usecs
)
275 edma_change_rx_coalesce(ec
->rx_coalesce_usecs
);
280 /* edma_set_priv_flags()
281 * Set EDMA private flags
283 static int edma_set_priv_flags(struct net_device
*netdev
, u32 flags
)
288 /* edma_get_priv_flags()
289 * get edma driver flags
291 static u32
edma_get_priv_flags(struct net_device
*netdev
)
296 /* edma_get_ringparam()
299 static void edma_get_ringparam(struct net_device
*netdev
,
300 struct ethtool_ringparam
*ring
)
302 struct edma_adapter
*adapter
= netdev_priv(netdev
);
303 struct edma_common_info
*edma_cinfo
= adapter
->edma_cinfo
;
305 ring
->tx_max_pending
= edma_cinfo
->tx_ring_count
;
306 ring
->rx_max_pending
= edma_cinfo
->rx_ring_count
;
309 /* Ethtool operations
311 static const struct ethtool_ops edma_ethtool_ops
= {
312 #if LINUX_VERSION_CODE >= KERNEL_VERSION(5,7,0)
313 .supported_coalesce_params
= ETHTOOL_COALESCE_USECS
,
315 .get_drvinfo
= &edma_get_drvinfo
,
316 .get_link
= ðtool_op_get_link
,
317 .get_msglevel
= &edma_get_msglevel
,
318 .nway_reset
= &edma_nway_reset
,
319 .get_wol
= &edma_get_wol
,
320 .get_link_ksettings
= &edma_get_settings
,
321 .set_link_ksettings
= &edma_set_settings
,
322 .get_strings
= &edma_get_strings
,
323 .get_sset_count
= &edma_get_strset_count
,
324 .get_ethtool_stats
= &edma_get_ethtool_stats
,
325 .get_coalesce
= &edma_get_coalesce
,
326 .set_coalesce
= &edma_set_coalesce
,
327 .get_priv_flags
= edma_get_priv_flags
,
328 .set_priv_flags
= edma_set_priv_flags
,
329 .get_ringparam
= edma_get_ringparam
,
332 /* edma_set_ethtool_ops
333 * Set ethtool operations
335 void edma_set_ethtool_ops(struct net_device
*netdev
)
337 netdev
->ethtool_ops
= &edma_ethtool_ops
;