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>
21 struct edma_ethtool_stats
{
22 uint8_t stat_string
[ETH_GSTRING_LEN
];
26 #define EDMA_STAT(m) offsetof(struct edma_ethtool_statistics, m)
27 #define DRVINFO_LEN 32
29 /* Array of strings describing statistics
31 static const struct edma_ethtool_stats edma_gstrings_stats
[] = {
32 {"tx_q0_pkt", EDMA_STAT(tx_q0_pkt
)},
33 {"tx_q1_pkt", EDMA_STAT(tx_q1_pkt
)},
34 {"tx_q2_pkt", EDMA_STAT(tx_q2_pkt
)},
35 {"tx_q3_pkt", EDMA_STAT(tx_q3_pkt
)},
36 {"tx_q4_pkt", EDMA_STAT(tx_q4_pkt
)},
37 {"tx_q5_pkt", EDMA_STAT(tx_q5_pkt
)},
38 {"tx_q6_pkt", EDMA_STAT(tx_q6_pkt
)},
39 {"tx_q7_pkt", EDMA_STAT(tx_q7_pkt
)},
40 {"tx_q8_pkt", EDMA_STAT(tx_q8_pkt
)},
41 {"tx_q9_pkt", EDMA_STAT(tx_q9_pkt
)},
42 {"tx_q10_pkt", EDMA_STAT(tx_q10_pkt
)},
43 {"tx_q11_pkt", EDMA_STAT(tx_q11_pkt
)},
44 {"tx_q12_pkt", EDMA_STAT(tx_q12_pkt
)},
45 {"tx_q13_pkt", EDMA_STAT(tx_q13_pkt
)},
46 {"tx_q14_pkt", EDMA_STAT(tx_q14_pkt
)},
47 {"tx_q15_pkt", EDMA_STAT(tx_q15_pkt
)},
48 {"tx_q0_byte", EDMA_STAT(tx_q0_byte
)},
49 {"tx_q1_byte", EDMA_STAT(tx_q1_byte
)},
50 {"tx_q2_byte", EDMA_STAT(tx_q2_byte
)},
51 {"tx_q3_byte", EDMA_STAT(tx_q3_byte
)},
52 {"tx_q4_byte", EDMA_STAT(tx_q4_byte
)},
53 {"tx_q5_byte", EDMA_STAT(tx_q5_byte
)},
54 {"tx_q6_byte", EDMA_STAT(tx_q6_byte
)},
55 {"tx_q7_byte", EDMA_STAT(tx_q7_byte
)},
56 {"tx_q8_byte", EDMA_STAT(tx_q8_byte
)},
57 {"tx_q9_byte", EDMA_STAT(tx_q9_byte
)},
58 {"tx_q10_byte", EDMA_STAT(tx_q10_byte
)},
59 {"tx_q11_byte", EDMA_STAT(tx_q11_byte
)},
60 {"tx_q12_byte", EDMA_STAT(tx_q12_byte
)},
61 {"tx_q13_byte", EDMA_STAT(tx_q13_byte
)},
62 {"tx_q14_byte", EDMA_STAT(tx_q14_byte
)},
63 {"tx_q15_byte", EDMA_STAT(tx_q15_byte
)},
64 {"rx_q0_pkt", EDMA_STAT(rx_q0_pkt
)},
65 {"rx_q1_pkt", EDMA_STAT(rx_q1_pkt
)},
66 {"rx_q2_pkt", EDMA_STAT(rx_q2_pkt
)},
67 {"rx_q3_pkt", EDMA_STAT(rx_q3_pkt
)},
68 {"rx_q4_pkt", EDMA_STAT(rx_q4_pkt
)},
69 {"rx_q5_pkt", EDMA_STAT(rx_q5_pkt
)},
70 {"rx_q6_pkt", EDMA_STAT(rx_q6_pkt
)},
71 {"rx_q7_pkt", EDMA_STAT(rx_q7_pkt
)},
72 {"rx_q0_byte", EDMA_STAT(rx_q0_byte
)},
73 {"rx_q1_byte", EDMA_STAT(rx_q1_byte
)},
74 {"rx_q2_byte", EDMA_STAT(rx_q2_byte
)},
75 {"rx_q3_byte", EDMA_STAT(rx_q3_byte
)},
76 {"rx_q4_byte", EDMA_STAT(rx_q4_byte
)},
77 {"rx_q5_byte", EDMA_STAT(rx_q5_byte
)},
78 {"rx_q6_byte", EDMA_STAT(rx_q6_byte
)},
79 {"rx_q7_byte", EDMA_STAT(rx_q7_byte
)},
80 {"tx_desc_error", EDMA_STAT(tx_desc_error
)},
81 {"rx_alloc_fail_ctr", EDMA_STAT(rx_alloc_fail_ctr
)},
84 #define EDMA_STATS_LEN ARRAY_SIZE(edma_gstrings_stats)
86 /* edma_get_strset_count()
89 static int edma_get_strset_count(struct net_device
*netdev
,
94 return EDMA_STATS_LEN
;
96 netdev_dbg(netdev
, "%s: Invalid string set", __func__
);
102 /* edma_get_strings()
105 static void edma_get_strings(struct net_device
*netdev
, uint32_t stringset
,
113 for (i
= 0; i
< EDMA_STATS_LEN
; i
++) {
114 memcpy(p
, edma_gstrings_stats
[i
].stat_string
,
115 min((size_t)ETH_GSTRING_LEN
,
116 strlen(edma_gstrings_stats
[i
].stat_string
)
118 p
+= ETH_GSTRING_LEN
;
124 /* edma_get_ethtool_stats()
125 * Get ethtool statistics
127 static void edma_get_ethtool_stats(struct net_device
*netdev
,
128 struct ethtool_stats
*stats
, uint64_t *data
)
130 struct edma_adapter
*adapter
= netdev_priv(netdev
);
131 struct edma_common_info
*edma_cinfo
= adapter
->edma_cinfo
;
135 edma_read_append_stats(edma_cinfo
);
137 for(i
= 0; i
< EDMA_STATS_LEN
; i
++) {
138 p
= (uint8_t *)&(edma_cinfo
->edma_ethstats
) +
139 edma_gstrings_stats
[i
].stat_offset
;
140 data
[i
] = *(uint32_t *)p
;
144 /* edma_get_drvinfo()
145 * get edma driver info
147 static void edma_get_drvinfo(struct net_device
*dev
,
148 struct ethtool_drvinfo
*info
)
150 strlcpy(info
->driver
, "ess_edma", DRVINFO_LEN
);
151 strlcpy(info
->bus_info
, "axi", ETHTOOL_BUSINFO_LEN
);
155 * Reset the phy, if available.
157 static int edma_nway_reset(struct net_device
*netdev
)
163 * get wake on lan info
165 static void edma_get_wol(struct net_device
*netdev
,
166 struct ethtool_wolinfo
*wol
)
172 /* edma_get_msglevel()
175 static uint32_t edma_get_msglevel(struct net_device
*netdev
)
180 /* edma_get_settings()
183 static int edma_get_settings(struct net_device
*netdev
,
184 struct ethtool_link_ksettings
*cmd
)
186 struct edma_adapter
*adapter
= netdev_priv(netdev
);
188 if (adapter
->poll_required
) {
189 if ((adapter
->forced_speed
!= SPEED_UNKNOWN
)
190 && !(adapter
->poll_required
))
193 phy_ethtool_ksettings_get(adapter
->phydev
, cmd
);
194 if (linkmode_test_bit(ETHTOOL_LINK_MODE_FIBRE_BIT
, adapter
->phydev
->advertising
))
195 cmd
->base
.port
= PORT_FIBRE
;
197 cmd
->base
.port
= PORT_TP
;
199 /* If the speed/duplex for this GMAC is forced and we
200 * are not polling for link state changes, return the
201 * values as specified by platform. This will be true
202 * for GMACs connected to switch, and interfaces that
205 if (!(adapter
->poll_required
)) {
206 if (adapter
->forced_speed
!= SPEED_UNKNOWN
) {
207 /* set speed and duplex */
208 cmd
->base
.speed
= SPEED_1000
;
209 cmd
->base
.duplex
= DUPLEX_FULL
;
211 /* Populate capabilities advertised by self */
212 linkmode_zero(cmd
->link_modes
.advertising
);
213 cmd
->base
.autoneg
= 0;
214 cmd
->base
.port
= PORT_TP
;
215 cmd
->base
.transceiver
= XCVR_EXTERNAL
;
217 /* non link polled and non
218 * forced speed/duplex interface
228 /* edma_set_settings()
231 static int edma_set_settings(struct net_device
*netdev
,
232 const struct ethtool_link_ksettings
*cmd
)
234 struct edma_adapter
*adapter
= netdev_priv(netdev
);
236 if ((adapter
->forced_speed
!= SPEED_UNKNOWN
) &&
237 !adapter
->poll_required
)
240 return phy_ethtool_ksettings_set(adapter
->phydev
, cmd
);
244 * get interrupt mitigation
246 static int edma_get_coalesce(struct net_device
*netdev
,
247 struct ethtool_coalesce
*ec
)
251 edma_get_tx_rx_coalesce(®_val
);
253 /* We read the Interrupt Moderation Timer(IMT) register value,
254 * use lower 16 bit for rx and higher 16 bit for Tx. We do a
255 * left shift by 1, because IMT resolution timer is 2usecs.
256 * Hence the value given by the register is multiplied by 2 to
257 * get the actual time in usecs.
259 ec
->tx_coalesce_usecs
= (((reg_val
>> 16) & 0xffff) << 1);
260 ec
->rx_coalesce_usecs
= ((reg_val
& 0xffff) << 1);
266 * set interrupt mitigation
268 static int edma_set_coalesce(struct net_device
*netdev
,
269 struct ethtool_coalesce
*ec
)
271 if (ec
->tx_coalesce_usecs
)
272 edma_change_tx_coalesce(ec
->tx_coalesce_usecs
);
273 if (ec
->rx_coalesce_usecs
)
274 edma_change_rx_coalesce(ec
->rx_coalesce_usecs
);
279 /* edma_set_priv_flags()
280 * Set EDMA private flags
282 static int edma_set_priv_flags(struct net_device
*netdev
, u32 flags
)
287 /* edma_get_priv_flags()
288 * get edma driver flags
290 static u32
edma_get_priv_flags(struct net_device
*netdev
)
295 /* edma_get_ringparam()
298 static void edma_get_ringparam(struct net_device
*netdev
,
299 struct ethtool_ringparam
*ring
)
301 struct edma_adapter
*adapter
= netdev_priv(netdev
);
302 struct edma_common_info
*edma_cinfo
= adapter
->edma_cinfo
;
304 ring
->tx_max_pending
= edma_cinfo
->tx_ring_count
;
305 ring
->rx_max_pending
= edma_cinfo
->rx_ring_count
;
308 /* Ethtool operations
310 static const struct ethtool_ops edma_ethtool_ops
= {
311 .get_drvinfo
= &edma_get_drvinfo
,
312 .get_link
= ðtool_op_get_link
,
313 .get_msglevel
= &edma_get_msglevel
,
314 .nway_reset
= &edma_nway_reset
,
315 .get_wol
= &edma_get_wol
,
316 .get_link_ksettings
= &edma_get_settings
,
317 .set_link_ksettings
= &edma_set_settings
,
318 .get_strings
= &edma_get_strings
,
319 .get_sset_count
= &edma_get_strset_count
,
320 .get_ethtool_stats
= &edma_get_ethtool_stats
,
321 .get_coalesce
= &edma_get_coalesce
,
322 .set_coalesce
= &edma_set_coalesce
,
323 .get_priv_flags
= edma_get_priv_flags
,
324 .set_priv_flags
= edma_set_priv_flags
,
325 .get_ringparam
= edma_get_ringparam
,
328 /* edma_set_ethtool_ops
329 * Set ethtool operations
331 void edma_set_ethtool_ops(struct net_device
*netdev
)
333 netdev
->ethtool_ops
= &edma_ethtool_ops
;