2 * Copyright (C) 1999 - 2010 Intel Corporation.
3 * Copyright (C) 2010 OKI SEMICONDUCTOR Co., LTD.
5 * This code was derived from the Intel e1000e Linux driver.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; version 2 of the License.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
21 #include "pch_gbe_api.h"
24 * pch_gbe_stats - Stats item infomation
26 struct pch_gbe_stats
{
27 char string
[ETH_GSTRING_LEN
];
32 #define PCH_GBE_STAT(m) \
35 .size = FIELD_SIZEOF(struct pch_gbe_hw_stats, m), \
36 .offset = offsetof(struct pch_gbe_hw_stats, m), \
40 * pch_gbe_gstrings_stats - ethtool information status name list
42 static const struct pch_gbe_stats pch_gbe_gstrings_stats
[] = {
43 PCH_GBE_STAT(rx_packets
),
44 PCH_GBE_STAT(tx_packets
),
45 PCH_GBE_STAT(rx_bytes
),
46 PCH_GBE_STAT(tx_bytes
),
47 PCH_GBE_STAT(rx_errors
),
48 PCH_GBE_STAT(tx_errors
),
49 PCH_GBE_STAT(rx_dropped
),
50 PCH_GBE_STAT(tx_dropped
),
51 PCH_GBE_STAT(multicast
),
52 PCH_GBE_STAT(collisions
),
53 PCH_GBE_STAT(rx_crc_errors
),
54 PCH_GBE_STAT(rx_frame_errors
),
55 PCH_GBE_STAT(rx_alloc_buff_failed
),
56 PCH_GBE_STAT(tx_length_errors
),
57 PCH_GBE_STAT(tx_aborted_errors
),
58 PCH_GBE_STAT(tx_carrier_errors
),
59 PCH_GBE_STAT(tx_timeout_count
),
60 PCH_GBE_STAT(tx_restart_count
),
61 PCH_GBE_STAT(intr_rx_dsc_empty_count
),
62 PCH_GBE_STAT(intr_rx_frame_err_count
),
63 PCH_GBE_STAT(intr_rx_fifo_err_count
),
64 PCH_GBE_STAT(intr_rx_dma_err_count
),
65 PCH_GBE_STAT(intr_tx_fifo_err_count
),
66 PCH_GBE_STAT(intr_tx_dma_err_count
),
67 PCH_GBE_STAT(intr_tcpip_err_count
)
70 #define PCH_GBE_QUEUE_STATS_LEN 0
71 #define PCH_GBE_GLOBAL_STATS_LEN ARRAY_SIZE(pch_gbe_gstrings_stats)
72 #define PCH_GBE_STATS_LEN (PCH_GBE_GLOBAL_STATS_LEN + PCH_GBE_QUEUE_STATS_LEN)
74 #define PCH_GBE_MAC_REGS_LEN (sizeof(struct pch_gbe_regs) / 4)
75 #define PCH_GBE_REGS_LEN (PCH_GBE_MAC_REGS_LEN + PCH_GBE_PHY_REGS_LEN)
77 * pch_gbe_get_settings - Get device-specific settings
78 * @netdev: Network interface device structure
79 * @ecmd: Ethtool command
82 * Negative value: Failed.
84 static int pch_gbe_get_settings(struct net_device
*netdev
,
85 struct ethtool_cmd
*ecmd
)
87 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
90 ret
= mii_ethtool_gset(&adapter
->mii
, ecmd
);
91 ecmd
->supported
&= ~(SUPPORTED_TP
| SUPPORTED_1000baseT_Half
);
92 ecmd
->advertising
&= ~(ADVERTISED_TP
| ADVERTISED_1000baseT_Half
);
94 if (!netif_carrier_ok(adapter
->netdev
))
100 * pch_gbe_set_settings - Set device-specific settings
101 * @netdev: Network interface device structure
102 * @ecmd: Ethtool command
105 * Negative value: Failed.
107 static int pch_gbe_set_settings(struct net_device
*netdev
,
108 struct ethtool_cmd
*ecmd
)
110 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
111 struct pch_gbe_hw
*hw
= &adapter
->hw
;
114 pch_gbe_hal_write_phy_reg(hw
, MII_BMCR
, BMCR_RESET
);
116 if (ecmd
->speed
== USHRT_MAX
) {
117 ecmd
->speed
= SPEED_1000
;
118 ecmd
->duplex
= DUPLEX_FULL
;
120 ret
= mii_ethtool_sset(&adapter
->mii
, ecmd
);
122 pr_err("Error: mii_ethtool_sset\n");
125 hw
->mac
.link_speed
= ecmd
->speed
;
126 hw
->mac
.link_duplex
= ecmd
->duplex
;
127 hw
->phy
.autoneg_advertised
= ecmd
->advertising
;
128 hw
->mac
.autoneg
= ecmd
->autoneg
;
129 pch_gbe_hal_phy_sw_reset(hw
);
132 if (netif_running(adapter
->netdev
)) {
133 pch_gbe_down(adapter
);
134 ret
= pch_gbe_up(adapter
);
136 pch_gbe_reset(adapter
);
142 * pch_gbe_get_regs_len - Report the size of device registers
143 * @netdev: Network interface device structure
144 * Returns: the size of device registers.
146 static int pch_gbe_get_regs_len(struct net_device
*netdev
)
148 return PCH_GBE_REGS_LEN
* (int)sizeof(u32
);
152 * pch_gbe_get_drvinfo - Report driver information
153 * @netdev: Network interface device structure
154 * @drvinfo: Driver information structure
156 static void pch_gbe_get_drvinfo(struct net_device
*netdev
,
157 struct ethtool_drvinfo
*drvinfo
)
159 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
161 strcpy(drvinfo
->driver
, KBUILD_MODNAME
);
162 strcpy(drvinfo
->version
, pch_driver_version
);
163 strcpy(drvinfo
->fw_version
, "N/A");
164 strcpy(drvinfo
->bus_info
, pci_name(adapter
->pdev
));
165 drvinfo
->regdump_len
= pch_gbe_get_regs_len(netdev
);
169 * pch_gbe_get_regs - Get device registers
170 * @netdev: Network interface device structure
171 * @regs: Ethtool register structure
172 * @p: Buffer pointer of read device register date
174 static void pch_gbe_get_regs(struct net_device
*netdev
,
175 struct ethtool_regs
*regs
, void *p
)
177 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
178 struct pch_gbe_hw
*hw
= &adapter
->hw
;
179 struct pci_dev
*pdev
= adapter
->pdev
;
183 regs
->version
= 0x1000000 | (__u32
)pdev
->revision
<< 16 | pdev
->device
;
184 for (i
= 0; i
< PCH_GBE_MAC_REGS_LEN
; i
++)
185 *regs_buff
++ = ioread32(&hw
->reg
->INT_ST
+ i
);
187 for (i
= 0; i
< PCH_GBE_PHY_REGS_LEN
; i
++) {
188 pch_gbe_hal_read_phy_reg(&adapter
->hw
, i
, &tmp
);
194 * pch_gbe_get_wol - Report whether Wake-on-Lan is enabled
195 * @netdev: Network interface device structure
196 * @wol: Wake-on-Lan information
198 static void pch_gbe_get_wol(struct net_device
*netdev
,
199 struct ethtool_wolinfo
*wol
)
201 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
203 wol
->supported
= WAKE_UCAST
| WAKE_MCAST
| WAKE_BCAST
| WAKE_MAGIC
;
206 if ((adapter
->wake_up_evt
& PCH_GBE_WLC_IND
))
207 wol
->wolopts
|= WAKE_UCAST
;
208 if ((adapter
->wake_up_evt
& PCH_GBE_WLC_MLT
))
209 wol
->wolopts
|= WAKE_MCAST
;
210 if ((adapter
->wake_up_evt
& PCH_GBE_WLC_BR
))
211 wol
->wolopts
|= WAKE_BCAST
;
212 if ((adapter
->wake_up_evt
& PCH_GBE_WLC_MP
))
213 wol
->wolopts
|= WAKE_MAGIC
;
217 * pch_gbe_set_wol - Turn Wake-on-Lan on or off
218 * @netdev: Network interface device structure
219 * @wol: Pointer of wake-on-Lan information straucture
222 * Negative value: Failed.
224 static int pch_gbe_set_wol(struct net_device
*netdev
,
225 struct ethtool_wolinfo
*wol
)
227 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
229 if ((wol
->wolopts
& (WAKE_PHY
| WAKE_ARP
| WAKE_MAGICSECURE
)))
231 /* these settings will always override what we currently have */
232 adapter
->wake_up_evt
= 0;
234 if ((wol
->wolopts
& WAKE_UCAST
))
235 adapter
->wake_up_evt
|= PCH_GBE_WLC_IND
;
236 if ((wol
->wolopts
& WAKE_MCAST
))
237 adapter
->wake_up_evt
|= PCH_GBE_WLC_MLT
;
238 if ((wol
->wolopts
& WAKE_BCAST
))
239 adapter
->wake_up_evt
|= PCH_GBE_WLC_BR
;
240 if ((wol
->wolopts
& WAKE_MAGIC
))
241 adapter
->wake_up_evt
|= PCH_GBE_WLC_MP
;
246 * pch_gbe_nway_reset - Restart autonegotiation
247 * @netdev: Network interface device structure
250 * Negative value: Failed.
252 static int pch_gbe_nway_reset(struct net_device
*netdev
)
254 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
256 return mii_nway_restart(&adapter
->mii
);
260 * pch_gbe_get_ringparam - Report ring sizes
261 * @netdev: Network interface device structure
262 * @ring: Ring param structure
264 static void pch_gbe_get_ringparam(struct net_device
*netdev
,
265 struct ethtool_ringparam
*ring
)
267 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
268 struct pch_gbe_tx_ring
*txdr
= adapter
->tx_ring
;
269 struct pch_gbe_rx_ring
*rxdr
= adapter
->rx_ring
;
271 ring
->rx_max_pending
= PCH_GBE_MAX_RXD
;
272 ring
->tx_max_pending
= PCH_GBE_MAX_TXD
;
273 ring
->rx_mini_max_pending
= 0;
274 ring
->rx_jumbo_max_pending
= 0;
275 ring
->rx_pending
= rxdr
->count
;
276 ring
->tx_pending
= txdr
->count
;
277 ring
->rx_mini_pending
= 0;
278 ring
->rx_jumbo_pending
= 0;
282 * pch_gbe_set_ringparam - Set ring sizes
283 * @netdev: Network interface device structure
284 * @ring: Ring param structure
287 * Negative value: Failed.
289 static int pch_gbe_set_ringparam(struct net_device
*netdev
,
290 struct ethtool_ringparam
*ring
)
292 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
293 struct pch_gbe_tx_ring
*txdr
, *tx_old
;
294 struct pch_gbe_rx_ring
*rxdr
, *rx_old
;
295 int tx_ring_size
, rx_ring_size
;
298 if ((ring
->rx_mini_pending
) || (ring
->rx_jumbo_pending
))
300 tx_ring_size
= (int)sizeof(struct pch_gbe_tx_ring
);
301 rx_ring_size
= (int)sizeof(struct pch_gbe_rx_ring
);
303 if ((netif_running(adapter
->netdev
)))
304 pch_gbe_down(adapter
);
305 tx_old
= adapter
->tx_ring
;
306 rx_old
= adapter
->rx_ring
;
308 txdr
= kzalloc(tx_ring_size
, GFP_KERNEL
);
313 rxdr
= kzalloc(rx_ring_size
, GFP_KERNEL
);
318 adapter
->tx_ring
= txdr
;
319 adapter
->rx_ring
= rxdr
;
322 clamp_val(ring
->rx_pending
, PCH_GBE_MIN_RXD
, PCH_GBE_MAX_RXD
);
323 rxdr
->count
= roundup(rxdr
->count
, PCH_GBE_RX_DESC_MULTIPLE
);
326 clamp_val(ring
->tx_pending
, PCH_GBE_MIN_RXD
, PCH_GBE_MAX_RXD
);
327 txdr
->count
= roundup(txdr
->count
, PCH_GBE_TX_DESC_MULTIPLE
);
329 if ((netif_running(adapter
->netdev
))) {
330 /* Try to get new resources before deleting old */
331 err
= pch_gbe_setup_rx_resources(adapter
, adapter
->rx_ring
);
334 err
= pch_gbe_setup_tx_resources(adapter
, adapter
->tx_ring
);
337 /* save the new, restore the old in order to free it,
338 * then restore the new back again */
340 adapter
->rx_ring
= rx_old
;
341 adapter
->tx_ring
= tx_old
;
342 pch_gbe_free_rx_resources(adapter
, adapter
->rx_ring
);
343 pch_gbe_free_tx_resources(adapter
, adapter
->tx_ring
);
346 adapter
->rx_ring
= rxdr
;
347 adapter
->tx_ring
= txdr
;
349 pch_gbe_free_rx_resources(adapter
, rx_old
);
350 pch_gbe_free_tx_resources(adapter
, tx_old
);
353 adapter
->rx_ring
= rxdr
;
354 adapter
->tx_ring
= txdr
;
356 err
= pch_gbe_up(adapter
);
361 pch_gbe_free_rx_resources(adapter
, adapter
->rx_ring
);
363 adapter
->rx_ring
= rx_old
;
364 adapter
->tx_ring
= tx_old
;
369 if (netif_running(adapter
->netdev
))
375 * pch_gbe_get_pauseparam - Report pause parameters
376 * @netdev: Network interface device structure
377 * @pause: Pause parameters structure
379 static void pch_gbe_get_pauseparam(struct net_device
*netdev
,
380 struct ethtool_pauseparam
*pause
)
382 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
383 struct pch_gbe_hw
*hw
= &adapter
->hw
;
386 ((hw
->mac
.fc_autoneg
) ? AUTONEG_ENABLE
: AUTONEG_DISABLE
);
388 if (hw
->mac
.fc
== PCH_GBE_FC_RX_PAUSE
) {
390 } else if (hw
->mac
.fc
== PCH_GBE_FC_TX_PAUSE
) {
392 } else if (hw
->mac
.fc
== PCH_GBE_FC_FULL
) {
399 * pch_gbe_set_pauseparam - Set pause paramters
400 * @netdev: Network interface device structure
401 * @pause: Pause parameters structure
404 * Negative value: Failed.
406 static int pch_gbe_set_pauseparam(struct net_device
*netdev
,
407 struct ethtool_pauseparam
*pause
)
409 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
410 struct pch_gbe_hw
*hw
= &adapter
->hw
;
413 hw
->mac
.fc_autoneg
= pause
->autoneg
;
414 if ((pause
->rx_pause
) && (pause
->tx_pause
))
415 hw
->mac
.fc
= PCH_GBE_FC_FULL
;
416 else if ((pause
->rx_pause
) && (!pause
->tx_pause
))
417 hw
->mac
.fc
= PCH_GBE_FC_RX_PAUSE
;
418 else if ((!pause
->rx_pause
) && (pause
->tx_pause
))
419 hw
->mac
.fc
= PCH_GBE_FC_TX_PAUSE
;
420 else if ((!pause
->rx_pause
) && (!pause
->tx_pause
))
421 hw
->mac
.fc
= PCH_GBE_FC_NONE
;
423 if (hw
->mac
.fc_autoneg
== AUTONEG_ENABLE
) {
424 if ((netif_running(adapter
->netdev
))) {
425 pch_gbe_down(adapter
);
426 ret
= pch_gbe_up(adapter
);
428 pch_gbe_reset(adapter
);
431 ret
= pch_gbe_mac_force_mac_fc(hw
);
437 * pch_gbe_get_rx_csum - Report whether receive checksums are turned on or off
438 * @netdev: Network interface device structure
440 * true(1): Checksum On
441 * false(0): Checksum Off
443 static u32
pch_gbe_get_rx_csum(struct net_device
*netdev
)
445 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
447 return adapter
->rx_csum
;
451 * pch_gbe_set_rx_csum - Turn receive checksum on or off
452 * @netdev: Network interface device structure
453 * @data: Checksum On[true] or Off[false]
456 * Negative value: Failed.
458 static int pch_gbe_set_rx_csum(struct net_device
*netdev
, u32 data
)
460 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
462 adapter
->rx_csum
= data
;
463 if ((netif_running(netdev
)))
464 pch_gbe_reinit_locked(adapter
);
466 pch_gbe_reset(adapter
);
472 * pch_gbe_get_tx_csum - Report whether transmit checksums are turned on or off
473 * @netdev: Network interface device structure
475 * true(1): Checksum On
476 * false(0): Checksum Off
478 static u32
pch_gbe_get_tx_csum(struct net_device
*netdev
)
480 return (netdev
->features
& NETIF_F_HW_CSUM
) != 0;
484 * pch_gbe_set_tx_csum - Turn transmit checksums on or off
485 * @netdev: Network interface device structure
486 * @data: Checksum on[true] or off[false]
489 * Negative value: Failed.
491 static int pch_gbe_set_tx_csum(struct net_device
*netdev
, u32 data
)
493 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
495 adapter
->tx_csum
= data
;
497 netdev
->features
|= NETIF_F_HW_CSUM
;
499 netdev
->features
&= ~NETIF_F_HW_CSUM
;
504 * pch_gbe_get_strings - Return a set of strings that describe the requested
506 * @netdev: Network interface device structure
507 * @stringset: Select the stringset. [ETH_SS_TEST] [ETH_SS_STATS]
508 * @data: Pointer of read string data.
510 static void pch_gbe_get_strings(struct net_device
*netdev
, u32 stringset
,
517 case (u32
) ETH_SS_STATS
:
518 for (i
= 0; i
< PCH_GBE_GLOBAL_STATS_LEN
; i
++) {
519 memcpy(p
, pch_gbe_gstrings_stats
[i
].string
,
521 p
+= ETH_GSTRING_LEN
;
528 * pch_gbe_get_ethtool_stats - Return statistics about the device
529 * @netdev: Network interface device structure
530 * @stats: Ethtool statue structure
531 * @data: Pointer of read status area
533 static void pch_gbe_get_ethtool_stats(struct net_device
*netdev
,
534 struct ethtool_stats
*stats
, u64
*data
)
536 struct pch_gbe_adapter
*adapter
= netdev_priv(netdev
);
538 const struct pch_gbe_stats
*gstats
= pch_gbe_gstrings_stats
;
539 char *hw_stats
= (char *)&adapter
->stats
;
541 pch_gbe_update_stats(adapter
);
542 for (i
= 0; i
< PCH_GBE_GLOBAL_STATS_LEN
; i
++) {
543 char *p
= hw_stats
+ gstats
->offset
;
544 data
[i
] = gstats
->size
== sizeof(u64
) ? *(u64
*)p
:(*(u32
*)p
);
549 static int pch_gbe_get_sset_count(struct net_device
*netdev
, int sset
)
553 return PCH_GBE_STATS_LEN
;
559 static const struct ethtool_ops pch_gbe_ethtool_ops
= {
560 .get_settings
= pch_gbe_get_settings
,
561 .set_settings
= pch_gbe_set_settings
,
562 .get_drvinfo
= pch_gbe_get_drvinfo
,
563 .get_regs_len
= pch_gbe_get_regs_len
,
564 .get_regs
= pch_gbe_get_regs
,
565 .get_wol
= pch_gbe_get_wol
,
566 .set_wol
= pch_gbe_set_wol
,
567 .nway_reset
= pch_gbe_nway_reset
,
568 .get_link
= ethtool_op_get_link
,
569 .get_ringparam
= pch_gbe_get_ringparam
,
570 .set_ringparam
= pch_gbe_set_ringparam
,
571 .get_pauseparam
= pch_gbe_get_pauseparam
,
572 .set_pauseparam
= pch_gbe_set_pauseparam
,
573 .get_rx_csum
= pch_gbe_get_rx_csum
,
574 .set_rx_csum
= pch_gbe_set_rx_csum
,
575 .get_tx_csum
= pch_gbe_get_tx_csum
,
576 .set_tx_csum
= pch_gbe_set_tx_csum
,
577 .get_strings
= pch_gbe_get_strings
,
578 .get_ethtool_stats
= pch_gbe_get_ethtool_stats
,
579 .get_sset_count
= pch_gbe_get_sset_count
,
582 void pch_gbe_set_ethtool_ops(struct net_device
*netdev
)
584 SET_ETHTOOL_OPS(netdev
, &pch_gbe_ethtool_ops
);