1 /*******************************************************************************
4 Copyright (C) 2007-2009 STMicroelectronics Ltd
6 This program is free software; you can redistribute it and/or modify it
7 under the terms and conditions of the GNU General Public License,
8 version 2, as published by the Free Software Foundation.
10 This program is distributed in the hope it will be useful, but WITHOUT
11 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12 FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
15 You should have received a copy of the GNU General Public License along with
16 this program; if not, write to the Free Software Foundation, Inc.,
17 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
19 The full GNU General Public License is included in this distribution in
20 the file called "COPYING".
22 Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
23 *******************************************************************************/
25 #include <linux/etherdevice.h>
26 #include <linux/ethtool.h>
27 #include <linux/mii.h>
28 #include <linux/phy.h>
31 #include "dwmac_dma.h"
33 #define REG_SPACE_SIZE 0x1054
34 #define MAC100_ETHTOOL_NAME "st_mac100"
35 #define GMAC_ETHTOOL_NAME "st_gmac"
38 char stat_string
[ETH_GSTRING_LEN
];
43 #define STMMAC_STAT(m) \
44 { #m, FIELD_SIZEOF(struct stmmac_extra_stats, m), \
45 offsetof(struct stmmac_priv, xstats.m)}
47 static const struct stmmac_stats stmmac_gstrings_stats
[] = {
48 STMMAC_STAT(tx_underflow
),
49 STMMAC_STAT(tx_carrier
),
50 STMMAC_STAT(tx_losscarrier
),
51 STMMAC_STAT(tx_heartbeat
),
52 STMMAC_STAT(tx_deferred
),
55 STMMAC_STAT(tx_jabber
),
56 STMMAC_STAT(tx_frame_flushed
),
57 STMMAC_STAT(tx_payload_error
),
58 STMMAC_STAT(tx_ip_header_error
),
60 STMMAC_STAT(rx_partial
),
62 STMMAC_STAT(rx_toolong
),
63 STMMAC_STAT(rx_collision
),
65 STMMAC_STAT(rx_length
),
67 STMMAC_STAT(rx_multicast
),
68 STMMAC_STAT(rx_gmac_overflow
),
69 STMMAC_STAT(rx_watchdog
),
70 STMMAC_STAT(da_rx_filter_fail
),
71 STMMAC_STAT(sa_rx_filter_fail
),
72 STMMAC_STAT(rx_missed_cntr
),
73 STMMAC_STAT(rx_overflow_cntr
),
74 STMMAC_STAT(tx_undeflow_irq
),
75 STMMAC_STAT(tx_process_stopped_irq
),
76 STMMAC_STAT(tx_jabber_irq
),
77 STMMAC_STAT(rx_overflow_irq
),
78 STMMAC_STAT(rx_buf_unav_irq
),
79 STMMAC_STAT(rx_process_stopped_irq
),
80 STMMAC_STAT(rx_watchdog_irq
),
81 STMMAC_STAT(tx_early_irq
),
82 STMMAC_STAT(fatal_bus_error_irq
),
83 STMMAC_STAT(threshold
),
84 STMMAC_STAT(tx_pkt_n
),
85 STMMAC_STAT(rx_pkt_n
),
87 STMMAC_STAT(sched_timer_n
),
88 STMMAC_STAT(normal_irq_n
),
90 #define STMMAC_STATS_LEN ARRAY_SIZE(stmmac_gstrings_stats)
92 static void stmmac_ethtool_getdrvinfo(struct net_device
*dev
,
93 struct ethtool_drvinfo
*info
)
95 struct stmmac_priv
*priv
= netdev_priv(dev
);
98 strcpy(info
->driver
, MAC100_ETHTOOL_NAME
);
100 strcpy(info
->driver
, GMAC_ETHTOOL_NAME
);
102 strcpy(info
->version
, DRV_MODULE_VERSION
);
103 info
->fw_version
[0] = '\0';
104 info
->n_stats
= STMMAC_STATS_LEN
;
107 static int stmmac_ethtool_getsettings(struct net_device
*dev
,
108 struct ethtool_cmd
*cmd
)
110 struct stmmac_priv
*priv
= netdev_priv(dev
);
111 struct phy_device
*phy
= priv
->phydev
;
114 pr_err("%s: %s: PHY is not registered\n",
115 __func__
, dev
->name
);
118 if (!netif_running(dev
)) {
119 pr_err("%s: interface is disabled: we cannot track "
120 "link speed / duplex setting\n", dev
->name
);
123 cmd
->transceiver
= XCVR_INTERNAL
;
124 spin_lock_irq(&priv
->lock
);
125 rc
= phy_ethtool_gset(phy
, cmd
);
126 spin_unlock_irq(&priv
->lock
);
130 static int stmmac_ethtool_setsettings(struct net_device
*dev
,
131 struct ethtool_cmd
*cmd
)
133 struct stmmac_priv
*priv
= netdev_priv(dev
);
134 struct phy_device
*phy
= priv
->phydev
;
137 spin_lock(&priv
->lock
);
138 rc
= phy_ethtool_sset(phy
, cmd
);
139 spin_unlock(&priv
->lock
);
144 static u32
stmmac_ethtool_getmsglevel(struct net_device
*dev
)
146 struct stmmac_priv
*priv
= netdev_priv(dev
);
147 return priv
->msg_enable
;
150 static void stmmac_ethtool_setmsglevel(struct net_device
*dev
, u32 level
)
152 struct stmmac_priv
*priv
= netdev_priv(dev
);
153 priv
->msg_enable
= level
;
157 static int stmmac_check_if_running(struct net_device
*dev
)
159 if (!netif_running(dev
))
164 static int stmmac_ethtool_get_regs_len(struct net_device
*dev
)
166 return REG_SPACE_SIZE
;
169 static void stmmac_ethtool_gregs(struct net_device
*dev
,
170 struct ethtool_regs
*regs
, void *space
)
173 u32
*reg_space
= (u32
*) space
;
175 struct stmmac_priv
*priv
= netdev_priv(dev
);
177 memset(reg_space
, 0x0, REG_SPACE_SIZE
);
179 if (!priv
->is_gmac
) {
181 for (i
= 0; i
< 12; i
++)
182 reg_space
[i
] = readl(priv
->ioaddr
+ (i
* 4));
184 for (i
= 0; i
< 9; i
++)
186 readl(priv
->ioaddr
+ (DMA_BUS_MODE
+ (i
* 4)));
187 reg_space
[22] = readl(priv
->ioaddr
+ DMA_CUR_TX_BUF_ADDR
);
188 reg_space
[23] = readl(priv
->ioaddr
+ DMA_CUR_RX_BUF_ADDR
);
191 for (i
= 0; i
< 55; i
++)
192 reg_space
[i
] = readl(priv
->ioaddr
+ (i
* 4));
194 for (i
= 0; i
< 22; i
++)
196 readl(priv
->ioaddr
+ (DMA_BUS_MODE
+ (i
* 4)));
200 static int stmmac_ethtool_set_tx_csum(struct net_device
*netdev
, u32 data
)
203 netdev
->features
|= NETIF_F_HW_CSUM
;
205 netdev
->features
&= ~NETIF_F_HW_CSUM
;
210 static u32
stmmac_ethtool_get_rx_csum(struct net_device
*dev
)
212 struct stmmac_priv
*priv
= netdev_priv(dev
);
218 stmmac_get_pauseparam(struct net_device
*netdev
,
219 struct ethtool_pauseparam
*pause
)
221 struct stmmac_priv
*priv
= netdev_priv(netdev
);
223 spin_lock(&priv
->lock
);
227 pause
->autoneg
= priv
->phydev
->autoneg
;
229 if (priv
->flow_ctrl
& FLOW_RX
)
231 if (priv
->flow_ctrl
& FLOW_TX
)
234 spin_unlock(&priv
->lock
);
238 stmmac_set_pauseparam(struct net_device
*netdev
,
239 struct ethtool_pauseparam
*pause
)
241 struct stmmac_priv
*priv
= netdev_priv(netdev
);
242 struct phy_device
*phy
= priv
->phydev
;
243 int new_pause
= FLOW_OFF
;
246 spin_lock(&priv
->lock
);
249 new_pause
|= FLOW_RX
;
251 new_pause
|= FLOW_TX
;
253 priv
->flow_ctrl
= new_pause
;
256 if (netif_running(netdev
)) {
257 struct ethtool_cmd cmd
;
258 /* auto-negotiation automatically restarted */
259 cmd
.cmd
= ETHTOOL_NWAY_RST
;
260 cmd
.supported
= phy
->supported
;
261 cmd
.advertising
= phy
->advertising
;
262 cmd
.autoneg
= phy
->autoneg
;
263 cmd
.speed
= phy
->speed
;
264 cmd
.duplex
= phy
->duplex
;
265 cmd
.phy_address
= phy
->addr
;
266 ret
= phy_ethtool_sset(phy
, &cmd
);
269 priv
->hw
->mac
->flow_ctrl(priv
->ioaddr
, phy
->duplex
,
270 priv
->flow_ctrl
, priv
->pause
);
271 spin_unlock(&priv
->lock
);
275 static void stmmac_get_ethtool_stats(struct net_device
*dev
,
276 struct ethtool_stats
*dummy
, u64
*data
)
278 struct stmmac_priv
*priv
= netdev_priv(dev
);
281 /* Update HW stats if supported */
282 priv
->hw
->dma
->dma_diagnostic_fr(&dev
->stats
, (void *) &priv
->xstats
,
285 for (i
= 0; i
< STMMAC_STATS_LEN
; i
++) {
286 char *p
= (char *)priv
+ stmmac_gstrings_stats
[i
].stat_offset
;
287 data
[i
] = (stmmac_gstrings_stats
[i
].sizeof_stat
==
288 sizeof(u64
)) ? (*(u64
*)p
) : (*(u32
*)p
);
292 static int stmmac_get_sset_count(struct net_device
*netdev
, int sset
)
296 return STMMAC_STATS_LEN
;
302 static void stmmac_get_strings(struct net_device
*dev
, u32 stringset
, u8
*data
)
309 for (i
= 0; i
< STMMAC_STATS_LEN
; i
++) {
310 memcpy(p
, stmmac_gstrings_stats
[i
].stat_string
,
312 p
+= ETH_GSTRING_LEN
;
321 /* Currently only support WOL through Magic packet. */
322 static void stmmac_get_wol(struct net_device
*dev
, struct ethtool_wolinfo
*wol
)
324 struct stmmac_priv
*priv
= netdev_priv(dev
);
326 spin_lock_irq(&priv
->lock
);
327 if (device_can_wakeup(priv
->device
)) {
328 wol
->supported
= WAKE_MAGIC
;
329 wol
->wolopts
= priv
->wolopts
;
331 spin_unlock_irq(&priv
->lock
);
334 static int stmmac_set_wol(struct net_device
*dev
, struct ethtool_wolinfo
*wol
)
336 struct stmmac_priv
*priv
= netdev_priv(dev
);
337 u32 support
= WAKE_MAGIC
;
339 if (!device_can_wakeup(priv
->device
))
342 if (wol
->wolopts
& ~support
)
346 pr_info("stmmac: wakeup enable\n");
347 device_set_wakeup_enable(priv
->device
, 1);
348 enable_irq_wake(dev
->irq
);
350 device_set_wakeup_enable(priv
->device
, 0);
351 disable_irq_wake(dev
->irq
);
354 spin_lock_irq(&priv
->lock
);
355 priv
->wolopts
= wol
->wolopts
;
356 spin_unlock_irq(&priv
->lock
);
361 static struct ethtool_ops stmmac_ethtool_ops
= {
362 .begin
= stmmac_check_if_running
,
363 .get_drvinfo
= stmmac_ethtool_getdrvinfo
,
364 .get_settings
= stmmac_ethtool_getsettings
,
365 .set_settings
= stmmac_ethtool_setsettings
,
366 .get_msglevel
= stmmac_ethtool_getmsglevel
,
367 .set_msglevel
= stmmac_ethtool_setmsglevel
,
368 .get_regs
= stmmac_ethtool_gregs
,
369 .get_regs_len
= stmmac_ethtool_get_regs_len
,
370 .get_link
= ethtool_op_get_link
,
371 .get_rx_csum
= stmmac_ethtool_get_rx_csum
,
372 .get_tx_csum
= ethtool_op_get_tx_csum
,
373 .set_tx_csum
= stmmac_ethtool_set_tx_csum
,
374 .get_sg
= ethtool_op_get_sg
,
375 .set_sg
= ethtool_op_set_sg
,
376 .get_pauseparam
= stmmac_get_pauseparam
,
377 .set_pauseparam
= stmmac_set_pauseparam
,
378 .get_ethtool_stats
= stmmac_get_ethtool_stats
,
379 .get_strings
= stmmac_get_strings
,
380 .get_wol
= stmmac_get_wol
,
381 .set_wol
= stmmac_set_wol
,
382 .get_sset_count
= stmmac_get_sset_count
,
383 .get_tso
= ethtool_op_get_tso
,
384 .set_tso
= ethtool_op_set_tso
,
387 void stmmac_set_ethtool_ops(struct net_device
*netdev
)
389 SET_ETHTOOL_OPS(netdev
, &stmmac_ethtool_ops
);