Merge branch 'master' of git://git.kernel.org/pub/scm/linux/kernel/git/linville/wirel...
[linux-2.6.git] / drivers / net / ixgbe / ixgbe_ethtool.c
1 /*******************************************************************************
2
3   Intel 10 Gigabit PCI Express Linux driver
4   Copyright(c) 1999 - 2010 Intel Corporation.
5
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.
9
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
13   more details.
14
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.
18
19   The full GNU General Public License is included in this distribution in
20   the file called "COPYING".
21
22   Contact Information:
23   e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
24   Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
25
26 *******************************************************************************/
27
28 /* ethtool support for ixgbe */
29
30 #include <linux/types.h>
31 #include <linux/module.h>
32 #include <linux/slab.h>
33 #include <linux/pci.h>
34 #include <linux/netdevice.h>
35 #include <linux/ethtool.h>
36 #include <linux/vmalloc.h>
37 #include <linux/uaccess.h>
38
39 #include "ixgbe.h"
40
41
42 #define IXGBE_ALL_RAR_ENTRIES 16
43
44 enum {NETDEV_STATS, IXGBE_STATS};
45
46 struct ixgbe_stats {
47         char stat_string[ETH_GSTRING_LEN];
48         int type;
49         int sizeof_stat;
50         int stat_offset;
51 };
52
53 #define IXGBE_STAT(m)           IXGBE_STATS, \
54                                 sizeof(((struct ixgbe_adapter *)0)->m), \
55                                 offsetof(struct ixgbe_adapter, m)
56 #define IXGBE_NETDEV_STAT(m)    NETDEV_STATS, \
57                                 sizeof(((struct rtnl_link_stats64 *)0)->m), \
58                                 offsetof(struct rtnl_link_stats64, m)
59
60 static struct ixgbe_stats ixgbe_gstrings_stats[] = {
61         {"rx_packets", IXGBE_NETDEV_STAT(rx_packets)},
62         {"tx_packets", IXGBE_NETDEV_STAT(tx_packets)},
63         {"rx_bytes", IXGBE_NETDEV_STAT(rx_bytes)},
64         {"tx_bytes", IXGBE_NETDEV_STAT(tx_bytes)},
65         {"rx_pkts_nic", IXGBE_STAT(stats.gprc)},
66         {"tx_pkts_nic", IXGBE_STAT(stats.gptc)},
67         {"rx_bytes_nic", IXGBE_STAT(stats.gorc)},
68         {"tx_bytes_nic", IXGBE_STAT(stats.gotc)},
69         {"lsc_int", IXGBE_STAT(lsc_int)},
70         {"tx_busy", IXGBE_STAT(tx_busy)},
71         {"non_eop_descs", IXGBE_STAT(non_eop_descs)},
72         {"rx_errors", IXGBE_NETDEV_STAT(rx_errors)},
73         {"tx_errors", IXGBE_NETDEV_STAT(tx_errors)},
74         {"rx_dropped", IXGBE_NETDEV_STAT(rx_dropped)},
75         {"tx_dropped", IXGBE_NETDEV_STAT(tx_dropped)},
76         {"multicast", IXGBE_NETDEV_STAT(multicast)},
77         {"broadcast", IXGBE_STAT(stats.bprc)},
78         {"rx_no_buffer_count", IXGBE_STAT(stats.rnbc[0]) },
79         {"collisions", IXGBE_NETDEV_STAT(collisions)},
80         {"rx_over_errors", IXGBE_NETDEV_STAT(rx_over_errors)},
81         {"rx_crc_errors", IXGBE_NETDEV_STAT(rx_crc_errors)},
82         {"rx_frame_errors", IXGBE_NETDEV_STAT(rx_frame_errors)},
83         {"hw_rsc_aggregated", IXGBE_STAT(rsc_total_count)},
84         {"hw_rsc_flushed", IXGBE_STAT(rsc_total_flush)},
85         {"fdir_match", IXGBE_STAT(stats.fdirmatch)},
86         {"fdir_miss", IXGBE_STAT(stats.fdirmiss)},
87         {"rx_fifo_errors", IXGBE_NETDEV_STAT(rx_fifo_errors)},
88         {"rx_missed_errors", IXGBE_NETDEV_STAT(rx_missed_errors)},
89         {"tx_aborted_errors", IXGBE_NETDEV_STAT(tx_aborted_errors)},
90         {"tx_carrier_errors", IXGBE_NETDEV_STAT(tx_carrier_errors)},
91         {"tx_fifo_errors", IXGBE_NETDEV_STAT(tx_fifo_errors)},
92         {"tx_heartbeat_errors", IXGBE_NETDEV_STAT(tx_heartbeat_errors)},
93         {"tx_timeout_count", IXGBE_STAT(tx_timeout_count)},
94         {"tx_restart_queue", IXGBE_STAT(restart_queue)},
95         {"rx_long_length_errors", IXGBE_STAT(stats.roc)},
96         {"rx_short_length_errors", IXGBE_STAT(stats.ruc)},
97         {"tx_flow_control_xon", IXGBE_STAT(stats.lxontxc)},
98         {"rx_flow_control_xon", IXGBE_STAT(stats.lxonrxc)},
99         {"tx_flow_control_xoff", IXGBE_STAT(stats.lxofftxc)},
100         {"rx_flow_control_xoff", IXGBE_STAT(stats.lxoffrxc)},
101         {"rx_csum_offload_errors", IXGBE_STAT(hw_csum_rx_error)},
102         {"alloc_rx_page_failed", IXGBE_STAT(alloc_rx_page_failed)},
103         {"alloc_rx_buff_failed", IXGBE_STAT(alloc_rx_buff_failed)},
104         {"rx_no_dma_resources", IXGBE_STAT(hw_rx_no_dma_resources)},
105 #ifdef IXGBE_FCOE
106         {"fcoe_bad_fccrc", IXGBE_STAT(stats.fccrc)},
107         {"rx_fcoe_dropped", IXGBE_STAT(stats.fcoerpdc)},
108         {"rx_fcoe_packets", IXGBE_STAT(stats.fcoeprc)},
109         {"rx_fcoe_dwords", IXGBE_STAT(stats.fcoedwrc)},
110         {"tx_fcoe_packets", IXGBE_STAT(stats.fcoeptc)},
111         {"tx_fcoe_dwords", IXGBE_STAT(stats.fcoedwtc)},
112 #endif /* IXGBE_FCOE */
113 };
114
115 #define IXGBE_QUEUE_STATS_LEN \
116         ((((struct ixgbe_adapter *)netdev_priv(netdev))->num_tx_queues + \
117         ((struct ixgbe_adapter *)netdev_priv(netdev))->num_rx_queues) * \
118         (sizeof(struct ixgbe_queue_stats) / sizeof(u64)))
119 #define IXGBE_GLOBAL_STATS_LEN ARRAY_SIZE(ixgbe_gstrings_stats)
120 #define IXGBE_PB_STATS_LEN ( \
121                  (((struct ixgbe_adapter *)netdev_priv(netdev))->flags & \
122                  IXGBE_FLAG_DCB_ENABLED) ? \
123                  (sizeof(((struct ixgbe_adapter *)0)->stats.pxonrxc) + \
124                   sizeof(((struct ixgbe_adapter *)0)->stats.pxontxc) + \
125                   sizeof(((struct ixgbe_adapter *)0)->stats.pxoffrxc) + \
126                   sizeof(((struct ixgbe_adapter *)0)->stats.pxofftxc)) \
127                   / sizeof(u64) : 0)
128 #define IXGBE_STATS_LEN (IXGBE_GLOBAL_STATS_LEN + \
129                          IXGBE_PB_STATS_LEN + \
130                          IXGBE_QUEUE_STATS_LEN)
131
132 static const char ixgbe_gstrings_test[][ETH_GSTRING_LEN] = {
133         "Register test  (offline)", "Eeprom test    (offline)",
134         "Interrupt test (offline)", "Loopback test  (offline)",
135         "Link test   (on/offline)"
136 };
137 #define IXGBE_TEST_LEN sizeof(ixgbe_gstrings_test) / ETH_GSTRING_LEN
138
139 static int ixgbe_get_settings(struct net_device *netdev,
140                               struct ethtool_cmd *ecmd)
141 {
142         struct ixgbe_adapter *adapter = netdev_priv(netdev);
143         struct ixgbe_hw *hw = &adapter->hw;
144         u32 link_speed = 0;
145         bool link_up;
146
147         ecmd->supported = SUPPORTED_10000baseT_Full;
148         ecmd->autoneg = AUTONEG_ENABLE;
149         ecmd->transceiver = XCVR_EXTERNAL;
150         if ((hw->phy.media_type == ixgbe_media_type_copper) ||
151             (hw->phy.multispeed_fiber)) {
152                 ecmd->supported |= (SUPPORTED_1000baseT_Full |
153                                     SUPPORTED_Autoneg);
154
155                 switch (hw->mac.type) {
156                 case ixgbe_mac_X540:
157                         ecmd->supported |= SUPPORTED_100baseT_Full;
158                         break;
159                 default:
160                         break;
161                 }
162
163                 ecmd->advertising = ADVERTISED_Autoneg;
164                 if (hw->phy.autoneg_advertised & IXGBE_LINK_SPEED_100_FULL)
165                         ecmd->advertising |= ADVERTISED_100baseT_Full;
166                 if (hw->phy.autoneg_advertised & IXGBE_LINK_SPEED_10GB_FULL)
167                         ecmd->advertising |= ADVERTISED_10000baseT_Full;
168                 if (hw->phy.autoneg_advertised & IXGBE_LINK_SPEED_1GB_FULL)
169                         ecmd->advertising |= ADVERTISED_1000baseT_Full;
170                 /*
171                  * It's possible that phy.autoneg_advertised may not be
172                  * set yet.  If so display what the default would be -
173                  * both 1G and 10G supported.
174                  */
175                 if (!(ecmd->advertising & (ADVERTISED_1000baseT_Full |
176                                            ADVERTISED_10000baseT_Full)))
177                         ecmd->advertising |= (ADVERTISED_10000baseT_Full |
178                                               ADVERTISED_1000baseT_Full);
179
180                 switch (hw->mac.type) {
181                 case ixgbe_mac_X540:
182                         if (!(ecmd->advertising & ADVERTISED_100baseT_Full))
183                                 ecmd->advertising |= (ADVERTISED_100baseT_Full);
184                         break;
185                 default:
186                         break;
187                 }
188
189                 if (hw->phy.media_type == ixgbe_media_type_copper) {
190                         ecmd->supported |= SUPPORTED_TP;
191                         ecmd->advertising |= ADVERTISED_TP;
192                         ecmd->port = PORT_TP;
193                 } else {
194                         ecmd->supported |= SUPPORTED_FIBRE;
195                         ecmd->advertising |= ADVERTISED_FIBRE;
196                         ecmd->port = PORT_FIBRE;
197                 }
198         } else if (hw->phy.media_type == ixgbe_media_type_backplane) {
199                 /* Set as FIBRE until SERDES defined in kernel */
200                 if (hw->device_id == IXGBE_DEV_ID_82598_BX) {
201                         ecmd->supported = (SUPPORTED_1000baseT_Full |
202                                            SUPPORTED_FIBRE);
203                         ecmd->advertising = (ADVERTISED_1000baseT_Full |
204                                              ADVERTISED_FIBRE);
205                         ecmd->port = PORT_FIBRE;
206                         ecmd->autoneg = AUTONEG_DISABLE;
207                 } else if ((hw->device_id == IXGBE_DEV_ID_82599_COMBO_BACKPLANE) ||
208                            (hw->device_id == IXGBE_DEV_ID_82599_KX4_MEZZ)) {
209                         ecmd->supported |= (SUPPORTED_1000baseT_Full |
210                                             SUPPORTED_Autoneg |
211                                             SUPPORTED_FIBRE);
212                         ecmd->advertising = (ADVERTISED_10000baseT_Full |
213                                              ADVERTISED_1000baseT_Full |
214                                              ADVERTISED_Autoneg |
215                                              ADVERTISED_FIBRE);
216                         ecmd->port = PORT_FIBRE;
217                 } else {
218                         ecmd->supported |= (SUPPORTED_1000baseT_Full |
219                                             SUPPORTED_FIBRE);
220                         ecmd->advertising = (ADVERTISED_10000baseT_Full |
221                                              ADVERTISED_1000baseT_Full |
222                                              ADVERTISED_FIBRE);
223                         ecmd->port = PORT_FIBRE;
224                 }
225         } else {
226                 ecmd->supported |= SUPPORTED_FIBRE;
227                 ecmd->advertising = (ADVERTISED_10000baseT_Full |
228                                      ADVERTISED_FIBRE);
229                 ecmd->port = PORT_FIBRE;
230                 ecmd->autoneg = AUTONEG_DISABLE;
231         }
232
233         /* Get PHY type */
234         switch (adapter->hw.phy.type) {
235         case ixgbe_phy_tn:
236         case ixgbe_phy_aq:
237         case ixgbe_phy_cu_unknown:
238                 /* Copper 10G-BASET */
239                 ecmd->port = PORT_TP;
240                 break;
241         case ixgbe_phy_qt:
242                 ecmd->port = PORT_FIBRE;
243                 break;
244         case ixgbe_phy_nl:
245         case ixgbe_phy_sfp_passive_tyco:
246         case ixgbe_phy_sfp_passive_unknown:
247         case ixgbe_phy_sfp_ftl:
248         case ixgbe_phy_sfp_avago:
249         case ixgbe_phy_sfp_intel:
250         case ixgbe_phy_sfp_unknown:
251                 switch (adapter->hw.phy.sfp_type) {
252                 /* SFP+ devices, further checking needed */
253                 case ixgbe_sfp_type_da_cu:
254                 case ixgbe_sfp_type_da_cu_core0:
255                 case ixgbe_sfp_type_da_cu_core1:
256                         ecmd->port = PORT_DA;
257                         break;
258                 case ixgbe_sfp_type_sr:
259                 case ixgbe_sfp_type_lr:
260                 case ixgbe_sfp_type_srlr_core0:
261                 case ixgbe_sfp_type_srlr_core1:
262                         ecmd->port = PORT_FIBRE;
263                         break;
264                 case ixgbe_sfp_type_not_present:
265                         ecmd->port = PORT_NONE;
266                         break;
267                 case ixgbe_sfp_type_1g_cu_core0:
268                 case ixgbe_sfp_type_1g_cu_core1:
269                         ecmd->port = PORT_TP;
270                         ecmd->supported = SUPPORTED_TP;
271                         ecmd->advertising = (ADVERTISED_1000baseT_Full |
272                                              ADVERTISED_TP);
273                         break;
274                 case ixgbe_sfp_type_unknown:
275                 default:
276                         ecmd->port = PORT_OTHER;
277                         break;
278                 }
279                 break;
280         case ixgbe_phy_xaui:
281                 ecmd->port = PORT_NONE;
282                 break;
283         case ixgbe_phy_unknown:
284         case ixgbe_phy_generic:
285         case ixgbe_phy_sfp_unsupported:
286         default:
287                 ecmd->port = PORT_OTHER;
288                 break;
289         }
290
291         hw->mac.ops.check_link(hw, &link_speed, &link_up, false);
292         if (link_up) {
293                 switch (link_speed) {
294                 case IXGBE_LINK_SPEED_10GB_FULL:
295                         ecmd->speed = SPEED_10000;
296                         break;
297                 case IXGBE_LINK_SPEED_1GB_FULL:
298                         ecmd->speed = SPEED_1000;
299                         break;
300                 case IXGBE_LINK_SPEED_100_FULL:
301                         ecmd->speed = SPEED_100;
302                         break;
303                 default:
304                         break;
305                 }
306                 ecmd->duplex = DUPLEX_FULL;
307         } else {
308                 ecmd->speed = -1;
309                 ecmd->duplex = -1;
310         }
311
312         return 0;
313 }
314
315 static int ixgbe_set_settings(struct net_device *netdev,
316                               struct ethtool_cmd *ecmd)
317 {
318         struct ixgbe_adapter *adapter = netdev_priv(netdev);
319         struct ixgbe_hw *hw = &adapter->hw;
320         u32 advertised, old;
321         s32 err = 0;
322
323         if ((hw->phy.media_type == ixgbe_media_type_copper) ||
324             (hw->phy.multispeed_fiber)) {
325                 /* 10000/copper and 1000/copper must autoneg
326                  * this function does not support any duplex forcing, but can
327                  * limit the advertising of the adapter to only 10000 or 1000 */
328                 if (ecmd->autoneg == AUTONEG_DISABLE)
329                         return -EINVAL;
330
331                 old = hw->phy.autoneg_advertised;
332                 advertised = 0;
333                 if (ecmd->advertising & ADVERTISED_10000baseT_Full)
334                         advertised |= IXGBE_LINK_SPEED_10GB_FULL;
335
336                 if (ecmd->advertising & ADVERTISED_1000baseT_Full)
337                         advertised |= IXGBE_LINK_SPEED_1GB_FULL;
338
339                 if (old == advertised)
340                         return err;
341                 /* this sets the link speed and restarts auto-neg */
342                 hw->mac.autotry_restart = true;
343                 err = hw->mac.ops.setup_link(hw, advertised, true, true);
344                 if (err) {
345                         e_info(probe, "setup link failed with code %d\n", err);
346                         hw->mac.ops.setup_link(hw, old, true, true);
347                 }
348         } else {
349                 /* in this case we currently only support 10Gb/FULL */
350                 if ((ecmd->autoneg == AUTONEG_ENABLE) ||
351                     (ecmd->advertising != ADVERTISED_10000baseT_Full) ||
352                     (ecmd->speed + ecmd->duplex != SPEED_10000 + DUPLEX_FULL))
353                         return -EINVAL;
354         }
355
356         return err;
357 }
358
359 static void ixgbe_get_pauseparam(struct net_device *netdev,
360                                  struct ethtool_pauseparam *pause)
361 {
362         struct ixgbe_adapter *adapter = netdev_priv(netdev);
363         struct ixgbe_hw *hw = &adapter->hw;
364
365         /*
366          * Flow Control Autoneg isn't on if
367          *  - we didn't ask for it OR
368          *  - it failed, we know this by tx & rx being off
369          */
370         if (hw->fc.disable_fc_autoneg ||
371             (hw->fc.current_mode == ixgbe_fc_none))
372                 pause->autoneg = 0;
373         else
374                 pause->autoneg = 1;
375
376         if (hw->fc.current_mode == ixgbe_fc_rx_pause) {
377                 pause->rx_pause = 1;
378         } else if (hw->fc.current_mode == ixgbe_fc_tx_pause) {
379                 pause->tx_pause = 1;
380         } else if (hw->fc.current_mode == ixgbe_fc_full) {
381                 pause->rx_pause = 1;
382                 pause->tx_pause = 1;
383 #ifdef CONFIG_DCB
384         } else if (hw->fc.current_mode == ixgbe_fc_pfc) {
385                 pause->rx_pause = 0;
386                 pause->tx_pause = 0;
387 #endif
388         }
389 }
390
391 static int ixgbe_set_pauseparam(struct net_device *netdev,
392                                 struct ethtool_pauseparam *pause)
393 {
394         struct ixgbe_adapter *adapter = netdev_priv(netdev);
395         struct ixgbe_hw *hw = &adapter->hw;
396         struct ixgbe_fc_info fc;
397
398 #ifdef CONFIG_DCB
399         if (adapter->dcb_cfg.pfc_mode_enable ||
400                 ((hw->mac.type == ixgbe_mac_82598EB) &&
401                 (adapter->flags & IXGBE_FLAG_DCB_ENABLED)))
402                 return -EINVAL;
403
404 #endif
405         fc = hw->fc;
406
407         if (pause->autoneg != AUTONEG_ENABLE)
408                 fc.disable_fc_autoneg = true;
409         else
410                 fc.disable_fc_autoneg = false;
411
412         if ((pause->rx_pause && pause->tx_pause) || pause->autoneg)
413                 fc.requested_mode = ixgbe_fc_full;
414         else if (pause->rx_pause && !pause->tx_pause)
415                 fc.requested_mode = ixgbe_fc_rx_pause;
416         else if (!pause->rx_pause && pause->tx_pause)
417                 fc.requested_mode = ixgbe_fc_tx_pause;
418         else if (!pause->rx_pause && !pause->tx_pause)
419                 fc.requested_mode = ixgbe_fc_none;
420         else
421                 return -EINVAL;
422
423 #ifdef CONFIG_DCB
424         adapter->last_lfc_mode = fc.requested_mode;
425 #endif
426
427         /* if the thing changed then we'll update and use new autoneg */
428         if (memcmp(&fc, &hw->fc, sizeof(struct ixgbe_fc_info))) {
429                 hw->fc = fc;
430                 if (netif_running(netdev))
431                         ixgbe_reinit_locked(adapter);
432                 else
433                         ixgbe_reset(adapter);
434         }
435
436         return 0;
437 }
438
439 static u32 ixgbe_get_rx_csum(struct net_device *netdev)
440 {
441         struct ixgbe_adapter *adapter = netdev_priv(netdev);
442         return adapter->flags & IXGBE_FLAG_RX_CSUM_ENABLED;
443 }
444
445 static int ixgbe_set_rx_csum(struct net_device *netdev, u32 data)
446 {
447         struct ixgbe_adapter *adapter = netdev_priv(netdev);
448         if (data)
449                 adapter->flags |= IXGBE_FLAG_RX_CSUM_ENABLED;
450         else
451                 adapter->flags &= ~IXGBE_FLAG_RX_CSUM_ENABLED;
452
453         return 0;
454 }
455
456 static u32 ixgbe_get_tx_csum(struct net_device *netdev)
457 {
458         return (netdev->features & NETIF_F_IP_CSUM) != 0;
459 }
460
461 static int ixgbe_set_tx_csum(struct net_device *netdev, u32 data)
462 {
463         struct ixgbe_adapter *adapter = netdev_priv(netdev);
464         u32 feature_list;
465
466         feature_list = (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM);
467         switch (adapter->hw.mac.type) {
468         case ixgbe_mac_82599EB:
469         case ixgbe_mac_X540:
470                 feature_list |= NETIF_F_SCTP_CSUM;
471                 break;
472         default:
473                 break;
474         }
475         if (data)
476                 netdev->features |= feature_list;
477         else
478                 netdev->features &= ~feature_list;
479
480         return 0;
481 }
482
483 static int ixgbe_set_tso(struct net_device *netdev, u32 data)
484 {
485         if (data) {
486                 netdev->features |= NETIF_F_TSO;
487                 netdev->features |= NETIF_F_TSO6;
488         } else {
489                 netdev->features &= ~NETIF_F_TSO;
490                 netdev->features &= ~NETIF_F_TSO6;
491         }
492         return 0;
493 }
494
495 static u32 ixgbe_get_msglevel(struct net_device *netdev)
496 {
497         struct ixgbe_adapter *adapter = netdev_priv(netdev);
498         return adapter->msg_enable;
499 }
500
501 static void ixgbe_set_msglevel(struct net_device *netdev, u32 data)
502 {
503         struct ixgbe_adapter *adapter = netdev_priv(netdev);
504         adapter->msg_enable = data;
505 }
506
507 static int ixgbe_get_regs_len(struct net_device *netdev)
508 {
509 #define IXGBE_REGS_LEN  1128
510         return IXGBE_REGS_LEN * sizeof(u32);
511 }
512
513 #define IXGBE_GET_STAT(_A_, _R_) _A_->stats._R_
514
515 static void ixgbe_get_regs(struct net_device *netdev,
516                            struct ethtool_regs *regs, void *p)
517 {
518         struct ixgbe_adapter *adapter = netdev_priv(netdev);
519         struct ixgbe_hw *hw = &adapter->hw;
520         u32 *regs_buff = p;
521         u8 i;
522
523         memset(p, 0, IXGBE_REGS_LEN * sizeof(u32));
524
525         regs->version = (1 << 24) | hw->revision_id << 16 | hw->device_id;
526
527         /* General Registers */
528         regs_buff[0] = IXGBE_READ_REG(hw, IXGBE_CTRL);
529         regs_buff[1] = IXGBE_READ_REG(hw, IXGBE_STATUS);
530         regs_buff[2] = IXGBE_READ_REG(hw, IXGBE_CTRL_EXT);
531         regs_buff[3] = IXGBE_READ_REG(hw, IXGBE_ESDP);
532         regs_buff[4] = IXGBE_READ_REG(hw, IXGBE_EODSDP);
533         regs_buff[5] = IXGBE_READ_REG(hw, IXGBE_LEDCTL);
534         regs_buff[6] = IXGBE_READ_REG(hw, IXGBE_FRTIMER);
535         regs_buff[7] = IXGBE_READ_REG(hw, IXGBE_TCPTIMER);
536
537         /* NVM Register */
538         regs_buff[8] = IXGBE_READ_REG(hw, IXGBE_EEC);
539         regs_buff[9] = IXGBE_READ_REG(hw, IXGBE_EERD);
540         regs_buff[10] = IXGBE_READ_REG(hw, IXGBE_FLA);
541         regs_buff[11] = IXGBE_READ_REG(hw, IXGBE_EEMNGCTL);
542         regs_buff[12] = IXGBE_READ_REG(hw, IXGBE_EEMNGDATA);
543         regs_buff[13] = IXGBE_READ_REG(hw, IXGBE_FLMNGCTL);
544         regs_buff[14] = IXGBE_READ_REG(hw, IXGBE_FLMNGDATA);
545         regs_buff[15] = IXGBE_READ_REG(hw, IXGBE_FLMNGCNT);
546         regs_buff[16] = IXGBE_READ_REG(hw, IXGBE_FLOP);
547         regs_buff[17] = IXGBE_READ_REG(hw, IXGBE_GRC);
548
549         /* Interrupt */
550         /* don't read EICR because it can clear interrupt causes, instead
551          * read EICS which is a shadow but doesn't clear EICR */
552         regs_buff[18] = IXGBE_READ_REG(hw, IXGBE_EICS);
553         regs_buff[19] = IXGBE_READ_REG(hw, IXGBE_EICS);
554         regs_buff[20] = IXGBE_READ_REG(hw, IXGBE_EIMS);
555         regs_buff[21] = IXGBE_READ_REG(hw, IXGBE_EIMC);
556         regs_buff[22] = IXGBE_READ_REG(hw, IXGBE_EIAC);
557         regs_buff[23] = IXGBE_READ_REG(hw, IXGBE_EIAM);
558         regs_buff[24] = IXGBE_READ_REG(hw, IXGBE_EITR(0));
559         regs_buff[25] = IXGBE_READ_REG(hw, IXGBE_IVAR(0));
560         regs_buff[26] = IXGBE_READ_REG(hw, IXGBE_MSIXT);
561         regs_buff[27] = IXGBE_READ_REG(hw, IXGBE_MSIXPBA);
562         regs_buff[28] = IXGBE_READ_REG(hw, IXGBE_PBACL(0));
563         regs_buff[29] = IXGBE_READ_REG(hw, IXGBE_GPIE);
564
565         /* Flow Control */
566         regs_buff[30] = IXGBE_READ_REG(hw, IXGBE_PFCTOP);
567         regs_buff[31] = IXGBE_READ_REG(hw, IXGBE_FCTTV(0));
568         regs_buff[32] = IXGBE_READ_REG(hw, IXGBE_FCTTV(1));
569         regs_buff[33] = IXGBE_READ_REG(hw, IXGBE_FCTTV(2));
570         regs_buff[34] = IXGBE_READ_REG(hw, IXGBE_FCTTV(3));
571         for (i = 0; i < 8; i++) {
572                 switch (hw->mac.type) {
573                 case ixgbe_mac_82598EB:
574                         regs_buff[35 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTL(i));
575                         regs_buff[43 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTH(i));
576                         break;
577                 case ixgbe_mac_82599EB:
578                         regs_buff[35 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTL_82599(i));
579                         regs_buff[43 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTH_82599(i));
580                         break;
581                 default:
582                         break;
583                 }
584         }
585         regs_buff[51] = IXGBE_READ_REG(hw, IXGBE_FCRTV);
586         regs_buff[52] = IXGBE_READ_REG(hw, IXGBE_TFCS);
587
588         /* Receive DMA */
589         for (i = 0; i < 64; i++)
590                 regs_buff[53 + i] = IXGBE_READ_REG(hw, IXGBE_RDBAL(i));
591         for (i = 0; i < 64; i++)
592                 regs_buff[117 + i] = IXGBE_READ_REG(hw, IXGBE_RDBAH(i));
593         for (i = 0; i < 64; i++)
594                 regs_buff[181 + i] = IXGBE_READ_REG(hw, IXGBE_RDLEN(i));
595         for (i = 0; i < 64; i++)
596                 regs_buff[245 + i] = IXGBE_READ_REG(hw, IXGBE_RDH(i));
597         for (i = 0; i < 64; i++)
598                 regs_buff[309 + i] = IXGBE_READ_REG(hw, IXGBE_RDT(i));
599         for (i = 0; i < 64; i++)
600                 regs_buff[373 + i] = IXGBE_READ_REG(hw, IXGBE_RXDCTL(i));
601         for (i = 0; i < 16; i++)
602                 regs_buff[437 + i] = IXGBE_READ_REG(hw, IXGBE_SRRCTL(i));
603         for (i = 0; i < 16; i++)
604                 regs_buff[453 + i] = IXGBE_READ_REG(hw, IXGBE_DCA_RXCTRL(i));
605         regs_buff[469] = IXGBE_READ_REG(hw, IXGBE_RDRXCTL);
606         for (i = 0; i < 8; i++)
607                 regs_buff[470 + i] = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(i));
608         regs_buff[478] = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
609         regs_buff[479] = IXGBE_READ_REG(hw, IXGBE_DROPEN);
610
611         /* Receive */
612         regs_buff[480] = IXGBE_READ_REG(hw, IXGBE_RXCSUM);
613         regs_buff[481] = IXGBE_READ_REG(hw, IXGBE_RFCTL);
614         for (i = 0; i < 16; i++)
615                 regs_buff[482 + i] = IXGBE_READ_REG(hw, IXGBE_RAL(i));
616         for (i = 0; i < 16; i++)
617                 regs_buff[498 + i] = IXGBE_READ_REG(hw, IXGBE_RAH(i));
618         regs_buff[514] = IXGBE_READ_REG(hw, IXGBE_PSRTYPE(0));
619         regs_buff[515] = IXGBE_READ_REG(hw, IXGBE_FCTRL);
620         regs_buff[516] = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
621         regs_buff[517] = IXGBE_READ_REG(hw, IXGBE_MCSTCTRL);
622         regs_buff[518] = IXGBE_READ_REG(hw, IXGBE_MRQC);
623         regs_buff[519] = IXGBE_READ_REG(hw, IXGBE_VMD_CTL);
624         for (i = 0; i < 8; i++)
625                 regs_buff[520 + i] = IXGBE_READ_REG(hw, IXGBE_IMIR(i));
626         for (i = 0; i < 8; i++)
627                 regs_buff[528 + i] = IXGBE_READ_REG(hw, IXGBE_IMIREXT(i));
628         regs_buff[536] = IXGBE_READ_REG(hw, IXGBE_IMIRVP);
629
630         /* Transmit */
631         for (i = 0; i < 32; i++)
632                 regs_buff[537 + i] = IXGBE_READ_REG(hw, IXGBE_TDBAL(i));
633         for (i = 0; i < 32; i++)
634                 regs_buff[569 + i] = IXGBE_READ_REG(hw, IXGBE_TDBAH(i));
635         for (i = 0; i < 32; i++)
636                 regs_buff[601 + i] = IXGBE_READ_REG(hw, IXGBE_TDLEN(i));
637         for (i = 0; i < 32; i++)
638                 regs_buff[633 + i] = IXGBE_READ_REG(hw, IXGBE_TDH(i));
639         for (i = 0; i < 32; i++)
640                 regs_buff[665 + i] = IXGBE_READ_REG(hw, IXGBE_TDT(i));
641         for (i = 0; i < 32; i++)
642                 regs_buff[697 + i] = IXGBE_READ_REG(hw, IXGBE_TXDCTL(i));
643         for (i = 0; i < 32; i++)
644                 regs_buff[729 + i] = IXGBE_READ_REG(hw, IXGBE_TDWBAL(i));
645         for (i = 0; i < 32; i++)
646                 regs_buff[761 + i] = IXGBE_READ_REG(hw, IXGBE_TDWBAH(i));
647         regs_buff[793] = IXGBE_READ_REG(hw, IXGBE_DTXCTL);
648         for (i = 0; i < 16; i++)
649                 regs_buff[794 + i] = IXGBE_READ_REG(hw, IXGBE_DCA_TXCTRL(i));
650         regs_buff[810] = IXGBE_READ_REG(hw, IXGBE_TIPG);
651         for (i = 0; i < 8; i++)
652                 regs_buff[811 + i] = IXGBE_READ_REG(hw, IXGBE_TXPBSIZE(i));
653         regs_buff[819] = IXGBE_READ_REG(hw, IXGBE_MNGTXMAP);
654
655         /* Wake Up */
656         regs_buff[820] = IXGBE_READ_REG(hw, IXGBE_WUC);
657         regs_buff[821] = IXGBE_READ_REG(hw, IXGBE_WUFC);
658         regs_buff[822] = IXGBE_READ_REG(hw, IXGBE_WUS);
659         regs_buff[823] = IXGBE_READ_REG(hw, IXGBE_IPAV);
660         regs_buff[824] = IXGBE_READ_REG(hw, IXGBE_IP4AT);
661         regs_buff[825] = IXGBE_READ_REG(hw, IXGBE_IP6AT);
662         regs_buff[826] = IXGBE_READ_REG(hw, IXGBE_WUPL);
663         regs_buff[827] = IXGBE_READ_REG(hw, IXGBE_WUPM);
664         regs_buff[828] = IXGBE_READ_REG(hw, IXGBE_FHFT(0));
665
666         /* DCB */
667         regs_buff[829] = IXGBE_READ_REG(hw, IXGBE_RMCS);
668         regs_buff[830] = IXGBE_READ_REG(hw, IXGBE_DPMCS);
669         regs_buff[831] = IXGBE_READ_REG(hw, IXGBE_PDPMCS);
670         regs_buff[832] = IXGBE_READ_REG(hw, IXGBE_RUPPBMR);
671         for (i = 0; i < 8; i++)
672                 regs_buff[833 + i] = IXGBE_READ_REG(hw, IXGBE_RT2CR(i));
673         for (i = 0; i < 8; i++)
674                 regs_buff[841 + i] = IXGBE_READ_REG(hw, IXGBE_RT2SR(i));
675         for (i = 0; i < 8; i++)
676                 regs_buff[849 + i] = IXGBE_READ_REG(hw, IXGBE_TDTQ2TCCR(i));
677         for (i = 0; i < 8; i++)
678                 regs_buff[857 + i] = IXGBE_READ_REG(hw, IXGBE_TDTQ2TCSR(i));
679         for (i = 0; i < 8; i++)
680                 regs_buff[865 + i] = IXGBE_READ_REG(hw, IXGBE_TDPT2TCCR(i));
681         for (i = 0; i < 8; i++)
682                 regs_buff[873 + i] = IXGBE_READ_REG(hw, IXGBE_TDPT2TCSR(i));
683
684         /* Statistics */
685         regs_buff[881] = IXGBE_GET_STAT(adapter, crcerrs);
686         regs_buff[882] = IXGBE_GET_STAT(adapter, illerrc);
687         regs_buff[883] = IXGBE_GET_STAT(adapter, errbc);
688         regs_buff[884] = IXGBE_GET_STAT(adapter, mspdc);
689         for (i = 0; i < 8; i++)
690                 regs_buff[885 + i] = IXGBE_GET_STAT(adapter, mpc[i]);
691         regs_buff[893] = IXGBE_GET_STAT(adapter, mlfc);
692         regs_buff[894] = IXGBE_GET_STAT(adapter, mrfc);
693         regs_buff[895] = IXGBE_GET_STAT(adapter, rlec);
694         regs_buff[896] = IXGBE_GET_STAT(adapter, lxontxc);
695         regs_buff[897] = IXGBE_GET_STAT(adapter, lxonrxc);
696         regs_buff[898] = IXGBE_GET_STAT(adapter, lxofftxc);
697         regs_buff[899] = IXGBE_GET_STAT(adapter, lxoffrxc);
698         for (i = 0; i < 8; i++)
699                 regs_buff[900 + i] = IXGBE_GET_STAT(adapter, pxontxc[i]);
700         for (i = 0; i < 8; i++)
701                 regs_buff[908 + i] = IXGBE_GET_STAT(adapter, pxonrxc[i]);
702         for (i = 0; i < 8; i++)
703                 regs_buff[916 + i] = IXGBE_GET_STAT(adapter, pxofftxc[i]);
704         for (i = 0; i < 8; i++)
705                 regs_buff[924 + i] = IXGBE_GET_STAT(adapter, pxoffrxc[i]);
706         regs_buff[932] = IXGBE_GET_STAT(adapter, prc64);
707         regs_buff[933] = IXGBE_GET_STAT(adapter, prc127);
708         regs_buff[934] = IXGBE_GET_STAT(adapter, prc255);
709         regs_buff[935] = IXGBE_GET_STAT(adapter, prc511);
710         regs_buff[936] = IXGBE_GET_STAT(adapter, prc1023);
711         regs_buff[937] = IXGBE_GET_STAT(adapter, prc1522);
712         regs_buff[938] = IXGBE_GET_STAT(adapter, gprc);
713         regs_buff[939] = IXGBE_GET_STAT(adapter, bprc);
714         regs_buff[940] = IXGBE_GET_STAT(adapter, mprc);
715         regs_buff[941] = IXGBE_GET_STAT(adapter, gptc);
716         regs_buff[942] = IXGBE_GET_STAT(adapter, gorc);
717         regs_buff[944] = IXGBE_GET_STAT(adapter, gotc);
718         for (i = 0; i < 8; i++)
719                 regs_buff[946 + i] = IXGBE_GET_STAT(adapter, rnbc[i]);
720         regs_buff[954] = IXGBE_GET_STAT(adapter, ruc);
721         regs_buff[955] = IXGBE_GET_STAT(adapter, rfc);
722         regs_buff[956] = IXGBE_GET_STAT(adapter, roc);
723         regs_buff[957] = IXGBE_GET_STAT(adapter, rjc);
724         regs_buff[958] = IXGBE_GET_STAT(adapter, mngprc);
725         regs_buff[959] = IXGBE_GET_STAT(adapter, mngpdc);
726         regs_buff[960] = IXGBE_GET_STAT(adapter, mngptc);
727         regs_buff[961] = IXGBE_GET_STAT(adapter, tor);
728         regs_buff[963] = IXGBE_GET_STAT(adapter, tpr);
729         regs_buff[964] = IXGBE_GET_STAT(adapter, tpt);
730         regs_buff[965] = IXGBE_GET_STAT(adapter, ptc64);
731         regs_buff[966] = IXGBE_GET_STAT(adapter, ptc127);
732         regs_buff[967] = IXGBE_GET_STAT(adapter, ptc255);
733         regs_buff[968] = IXGBE_GET_STAT(adapter, ptc511);
734         regs_buff[969] = IXGBE_GET_STAT(adapter, ptc1023);
735         regs_buff[970] = IXGBE_GET_STAT(adapter, ptc1522);
736         regs_buff[971] = IXGBE_GET_STAT(adapter, mptc);
737         regs_buff[972] = IXGBE_GET_STAT(adapter, bptc);
738         regs_buff[973] = IXGBE_GET_STAT(adapter, xec);
739         for (i = 0; i < 16; i++)
740                 regs_buff[974 + i] = IXGBE_GET_STAT(adapter, qprc[i]);
741         for (i = 0; i < 16; i++)
742                 regs_buff[990 + i] = IXGBE_GET_STAT(adapter, qptc[i]);
743         for (i = 0; i < 16; i++)
744                 regs_buff[1006 + i] = IXGBE_GET_STAT(adapter, qbrc[i]);
745         for (i = 0; i < 16; i++)
746                 regs_buff[1022 + i] = IXGBE_GET_STAT(adapter, qbtc[i]);
747
748         /* MAC */
749         regs_buff[1038] = IXGBE_READ_REG(hw, IXGBE_PCS1GCFIG);
750         regs_buff[1039] = IXGBE_READ_REG(hw, IXGBE_PCS1GLCTL);
751         regs_buff[1040] = IXGBE_READ_REG(hw, IXGBE_PCS1GLSTA);
752         regs_buff[1041] = IXGBE_READ_REG(hw, IXGBE_PCS1GDBG0);
753         regs_buff[1042] = IXGBE_READ_REG(hw, IXGBE_PCS1GDBG1);
754         regs_buff[1043] = IXGBE_READ_REG(hw, IXGBE_PCS1GANA);
755         regs_buff[1044] = IXGBE_READ_REG(hw, IXGBE_PCS1GANLP);
756         regs_buff[1045] = IXGBE_READ_REG(hw, IXGBE_PCS1GANNP);
757         regs_buff[1046] = IXGBE_READ_REG(hw, IXGBE_PCS1GANLPNP);
758         regs_buff[1047] = IXGBE_READ_REG(hw, IXGBE_HLREG0);
759         regs_buff[1048] = IXGBE_READ_REG(hw, IXGBE_HLREG1);
760         regs_buff[1049] = IXGBE_READ_REG(hw, IXGBE_PAP);
761         regs_buff[1050] = IXGBE_READ_REG(hw, IXGBE_MACA);
762         regs_buff[1051] = IXGBE_READ_REG(hw, IXGBE_APAE);
763         regs_buff[1052] = IXGBE_READ_REG(hw, IXGBE_ARD);
764         regs_buff[1053] = IXGBE_READ_REG(hw, IXGBE_AIS);
765         regs_buff[1054] = IXGBE_READ_REG(hw, IXGBE_MSCA);
766         regs_buff[1055] = IXGBE_READ_REG(hw, IXGBE_MSRWD);
767         regs_buff[1056] = IXGBE_READ_REG(hw, IXGBE_MLADD);
768         regs_buff[1057] = IXGBE_READ_REG(hw, IXGBE_MHADD);
769         regs_buff[1058] = IXGBE_READ_REG(hw, IXGBE_TREG);
770         regs_buff[1059] = IXGBE_READ_REG(hw, IXGBE_PCSS1);
771         regs_buff[1060] = IXGBE_READ_REG(hw, IXGBE_PCSS2);
772         regs_buff[1061] = IXGBE_READ_REG(hw, IXGBE_XPCSS);
773         regs_buff[1062] = IXGBE_READ_REG(hw, IXGBE_SERDESC);
774         regs_buff[1063] = IXGBE_READ_REG(hw, IXGBE_MACS);
775         regs_buff[1064] = IXGBE_READ_REG(hw, IXGBE_AUTOC);
776         regs_buff[1065] = IXGBE_READ_REG(hw, IXGBE_LINKS);
777         regs_buff[1066] = IXGBE_READ_REG(hw, IXGBE_AUTOC2);
778         regs_buff[1067] = IXGBE_READ_REG(hw, IXGBE_AUTOC3);
779         regs_buff[1068] = IXGBE_READ_REG(hw, IXGBE_ANLP1);
780         regs_buff[1069] = IXGBE_READ_REG(hw, IXGBE_ANLP2);
781         regs_buff[1070] = IXGBE_READ_REG(hw, IXGBE_ATLASCTL);
782
783         /* Diagnostic */
784         regs_buff[1071] = IXGBE_READ_REG(hw, IXGBE_RDSTATCTL);
785         for (i = 0; i < 8; i++)
786                 regs_buff[1072 + i] = IXGBE_READ_REG(hw, IXGBE_RDSTAT(i));
787         regs_buff[1080] = IXGBE_READ_REG(hw, IXGBE_RDHMPN);
788         for (i = 0; i < 4; i++)
789                 regs_buff[1081 + i] = IXGBE_READ_REG(hw, IXGBE_RIC_DW(i));
790         regs_buff[1085] = IXGBE_READ_REG(hw, IXGBE_RDPROBE);
791         regs_buff[1086] = IXGBE_READ_REG(hw, IXGBE_TDSTATCTL);
792         for (i = 0; i < 8; i++)
793                 regs_buff[1087 + i] = IXGBE_READ_REG(hw, IXGBE_TDSTAT(i));
794         regs_buff[1095] = IXGBE_READ_REG(hw, IXGBE_TDHMPN);
795         for (i = 0; i < 4; i++)
796                 regs_buff[1096 + i] = IXGBE_READ_REG(hw, IXGBE_TIC_DW(i));
797         regs_buff[1100] = IXGBE_READ_REG(hw, IXGBE_TDPROBE);
798         regs_buff[1101] = IXGBE_READ_REG(hw, IXGBE_TXBUFCTRL);
799         regs_buff[1102] = IXGBE_READ_REG(hw, IXGBE_TXBUFDATA0);
800         regs_buff[1103] = IXGBE_READ_REG(hw, IXGBE_TXBUFDATA1);
801         regs_buff[1104] = IXGBE_READ_REG(hw, IXGBE_TXBUFDATA2);
802         regs_buff[1105] = IXGBE_READ_REG(hw, IXGBE_TXBUFDATA3);
803         regs_buff[1106] = IXGBE_READ_REG(hw, IXGBE_RXBUFCTRL);
804         regs_buff[1107] = IXGBE_READ_REG(hw, IXGBE_RXBUFDATA0);
805         regs_buff[1108] = IXGBE_READ_REG(hw, IXGBE_RXBUFDATA1);
806         regs_buff[1109] = IXGBE_READ_REG(hw, IXGBE_RXBUFDATA2);
807         regs_buff[1110] = IXGBE_READ_REG(hw, IXGBE_RXBUFDATA3);
808         for (i = 0; i < 8; i++)
809                 regs_buff[1111 + i] = IXGBE_READ_REG(hw, IXGBE_PCIE_DIAG(i));
810         regs_buff[1119] = IXGBE_READ_REG(hw, IXGBE_RFVAL);
811         regs_buff[1120] = IXGBE_READ_REG(hw, IXGBE_MDFTC1);
812         regs_buff[1121] = IXGBE_READ_REG(hw, IXGBE_MDFTC2);
813         regs_buff[1122] = IXGBE_READ_REG(hw, IXGBE_MDFTFIFO1);
814         regs_buff[1123] = IXGBE_READ_REG(hw, IXGBE_MDFTFIFO2);
815         regs_buff[1124] = IXGBE_READ_REG(hw, IXGBE_MDFTS);
816         regs_buff[1125] = IXGBE_READ_REG(hw, IXGBE_PCIEECCCTL);
817         regs_buff[1126] = IXGBE_READ_REG(hw, IXGBE_PBTXECC);
818         regs_buff[1127] = IXGBE_READ_REG(hw, IXGBE_PBRXECC);
819 }
820
821 static int ixgbe_get_eeprom_len(struct net_device *netdev)
822 {
823         struct ixgbe_adapter *adapter = netdev_priv(netdev);
824         return adapter->hw.eeprom.word_size * 2;
825 }
826
827 static int ixgbe_get_eeprom(struct net_device *netdev,
828                             struct ethtool_eeprom *eeprom, u8 *bytes)
829 {
830         struct ixgbe_adapter *adapter = netdev_priv(netdev);
831         struct ixgbe_hw *hw = &adapter->hw;
832         u16 *eeprom_buff;
833         int first_word, last_word, eeprom_len;
834         int ret_val = 0;
835         u16 i;
836
837         if (eeprom->len == 0)
838                 return -EINVAL;
839
840         eeprom->magic = hw->vendor_id | (hw->device_id << 16);
841
842         first_word = eeprom->offset >> 1;
843         last_word = (eeprom->offset + eeprom->len - 1) >> 1;
844         eeprom_len = last_word - first_word + 1;
845
846         eeprom_buff = kmalloc(sizeof(u16) * eeprom_len, GFP_KERNEL);
847         if (!eeprom_buff)
848                 return -ENOMEM;
849
850         for (i = 0; i < eeprom_len; i++) {
851                 if ((ret_val = hw->eeprom.ops.read(hw, first_word + i,
852                     &eeprom_buff[i])))
853                         break;
854         }
855
856         /* Device's eeprom is always little-endian, word addressable */
857         for (i = 0; i < eeprom_len; i++)
858                 le16_to_cpus(&eeprom_buff[i]);
859
860         memcpy(bytes, (u8 *)eeprom_buff + (eeprom->offset & 1), eeprom->len);
861         kfree(eeprom_buff);
862
863         return ret_val;
864 }
865
866 static void ixgbe_get_drvinfo(struct net_device *netdev,
867                               struct ethtool_drvinfo *drvinfo)
868 {
869         struct ixgbe_adapter *adapter = netdev_priv(netdev);
870         char firmware_version[32];
871
872         strncpy(drvinfo->driver, ixgbe_driver_name,
873                 sizeof(drvinfo->driver) - 1);
874         strncpy(drvinfo->version, ixgbe_driver_version,
875                 sizeof(drvinfo->version) - 1);
876
877         snprintf(firmware_version, sizeof(firmware_version), "%d.%d-%d",
878                  (adapter->eeprom_version & 0xF000) >> 12,
879                  (adapter->eeprom_version & 0x0FF0) >> 4,
880                  adapter->eeprom_version & 0x000F);
881
882         strncpy(drvinfo->fw_version, firmware_version,
883                 sizeof(drvinfo->fw_version));
884         strncpy(drvinfo->bus_info, pci_name(adapter->pdev),
885                 sizeof(drvinfo->bus_info));
886         drvinfo->n_stats = IXGBE_STATS_LEN;
887         drvinfo->testinfo_len = IXGBE_TEST_LEN;
888         drvinfo->regdump_len = ixgbe_get_regs_len(netdev);
889 }
890
891 static void ixgbe_get_ringparam(struct net_device *netdev,
892                                 struct ethtool_ringparam *ring)
893 {
894         struct ixgbe_adapter *adapter = netdev_priv(netdev);
895         struct ixgbe_ring *tx_ring = adapter->tx_ring[0];
896         struct ixgbe_ring *rx_ring = adapter->rx_ring[0];
897
898         ring->rx_max_pending = IXGBE_MAX_RXD;
899         ring->tx_max_pending = IXGBE_MAX_TXD;
900         ring->rx_mini_max_pending = 0;
901         ring->rx_jumbo_max_pending = 0;
902         ring->rx_pending = rx_ring->count;
903         ring->tx_pending = tx_ring->count;
904         ring->rx_mini_pending = 0;
905         ring->rx_jumbo_pending = 0;
906 }
907
908 static int ixgbe_set_ringparam(struct net_device *netdev,
909                                struct ethtool_ringparam *ring)
910 {
911         struct ixgbe_adapter *adapter = netdev_priv(netdev);
912         struct ixgbe_ring *temp_tx_ring, *temp_rx_ring;
913         int i, err = 0;
914         u32 new_rx_count, new_tx_count;
915         bool need_update = false;
916
917         if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending))
918                 return -EINVAL;
919
920         new_rx_count = max(ring->rx_pending, (u32)IXGBE_MIN_RXD);
921         new_rx_count = min(new_rx_count, (u32)IXGBE_MAX_RXD);
922         new_rx_count = ALIGN(new_rx_count, IXGBE_REQ_RX_DESCRIPTOR_MULTIPLE);
923
924         new_tx_count = max(ring->tx_pending, (u32)IXGBE_MIN_TXD);
925         new_tx_count = min(new_tx_count, (u32)IXGBE_MAX_TXD);
926         new_tx_count = ALIGN(new_tx_count, IXGBE_REQ_TX_DESCRIPTOR_MULTIPLE);
927
928         if ((new_tx_count == adapter->tx_ring[0]->count) &&
929             (new_rx_count == adapter->rx_ring[0]->count)) {
930                 /* nothing to do */
931                 return 0;
932         }
933
934         while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
935                 msleep(1);
936
937         if (!netif_running(adapter->netdev)) {
938                 for (i = 0; i < adapter->num_tx_queues; i++)
939                         adapter->tx_ring[i]->count = new_tx_count;
940                 for (i = 0; i < adapter->num_rx_queues; i++)
941                         adapter->rx_ring[i]->count = new_rx_count;
942                 adapter->tx_ring_count = new_tx_count;
943                 adapter->rx_ring_count = new_rx_count;
944                 goto clear_reset;
945         }
946
947         temp_tx_ring = vmalloc(adapter->num_tx_queues * sizeof(struct ixgbe_ring));
948         if (!temp_tx_ring) {
949                 err = -ENOMEM;
950                 goto clear_reset;
951         }
952
953         if (new_tx_count != adapter->tx_ring_count) {
954                 for (i = 0; i < adapter->num_tx_queues; i++) {
955                         memcpy(&temp_tx_ring[i], adapter->tx_ring[i],
956                                sizeof(struct ixgbe_ring));
957                         temp_tx_ring[i].count = new_tx_count;
958                         err = ixgbe_setup_tx_resources(&temp_tx_ring[i]);
959                         if (err) {
960                                 while (i) {
961                                         i--;
962                                         ixgbe_free_tx_resources(&temp_tx_ring[i]);
963                                 }
964                                 goto clear_reset;
965                         }
966                 }
967                 need_update = true;
968         }
969
970         temp_rx_ring = vmalloc(adapter->num_rx_queues * sizeof(struct ixgbe_ring));
971         if (!temp_rx_ring) {
972                 err = -ENOMEM;
973                 goto err_setup;
974         }
975
976         if (new_rx_count != adapter->rx_ring_count) {
977                 for (i = 0; i < adapter->num_rx_queues; i++) {
978                         memcpy(&temp_rx_ring[i], adapter->rx_ring[i],
979                                sizeof(struct ixgbe_ring));
980                         temp_rx_ring[i].count = new_rx_count;
981                         err = ixgbe_setup_rx_resources(&temp_rx_ring[i]);
982                         if (err) {
983                                 while (i) {
984                                         i--;
985                                         ixgbe_free_rx_resources(&temp_rx_ring[i]);
986                                 }
987                                 goto err_setup;
988                         }
989                 }
990                 need_update = true;
991         }
992
993         /* if rings need to be updated, here's the place to do it in one shot */
994         if (need_update) {
995                 ixgbe_down(adapter);
996
997                 /* tx */
998                 if (new_tx_count != adapter->tx_ring_count) {
999                         for (i = 0; i < adapter->num_tx_queues; i++) {
1000                                 ixgbe_free_tx_resources(adapter->tx_ring[i]);
1001                                 memcpy(adapter->tx_ring[i], &temp_tx_ring[i],
1002                                        sizeof(struct ixgbe_ring));
1003                         }
1004                         adapter->tx_ring_count = new_tx_count;
1005                 }
1006
1007                 /* rx */
1008                 if (new_rx_count != adapter->rx_ring_count) {
1009                         for (i = 0; i < adapter->num_rx_queues; i++) {
1010                                 ixgbe_free_rx_resources(adapter->rx_ring[i]);
1011                                 memcpy(adapter->rx_ring[i], &temp_rx_ring[i],
1012                                        sizeof(struct ixgbe_ring));
1013                         }
1014                         adapter->rx_ring_count = new_rx_count;
1015                 }
1016                 ixgbe_up(adapter);
1017         }
1018
1019         vfree(temp_rx_ring);
1020 err_setup:
1021         vfree(temp_tx_ring);
1022 clear_reset:
1023         clear_bit(__IXGBE_RESETTING, &adapter->state);
1024         return err;
1025 }
1026
1027 static int ixgbe_get_sset_count(struct net_device *netdev, int sset)
1028 {
1029         switch (sset) {
1030         case ETH_SS_TEST:
1031                 return IXGBE_TEST_LEN;
1032         case ETH_SS_STATS:
1033                 return IXGBE_STATS_LEN;
1034         case ETH_SS_NTUPLE_FILTERS:
1035                 return ETHTOOL_MAX_NTUPLE_LIST_ENTRY *
1036                        ETHTOOL_MAX_NTUPLE_STRING_PER_ENTRY;
1037         default:
1038                 return -EOPNOTSUPP;
1039         }
1040 }
1041
1042 static void ixgbe_get_ethtool_stats(struct net_device *netdev,
1043                                     struct ethtool_stats *stats, u64 *data)
1044 {
1045         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1046         struct rtnl_link_stats64 temp;
1047         const struct rtnl_link_stats64 *net_stats;
1048         unsigned int start;
1049         struct ixgbe_ring *ring;
1050         int i, j;
1051         char *p = NULL;
1052
1053         ixgbe_update_stats(adapter);
1054         net_stats = dev_get_stats(netdev, &temp);
1055         for (i = 0; i < IXGBE_GLOBAL_STATS_LEN; i++) {
1056                 switch (ixgbe_gstrings_stats[i].type) {
1057                 case NETDEV_STATS:
1058                         p = (char *) net_stats +
1059                                         ixgbe_gstrings_stats[i].stat_offset;
1060                         break;
1061                 case IXGBE_STATS:
1062                         p = (char *) adapter +
1063                                         ixgbe_gstrings_stats[i].stat_offset;
1064                         break;
1065                 }
1066
1067                 data[i] = (ixgbe_gstrings_stats[i].sizeof_stat ==
1068                            sizeof(u64)) ? *(u64 *)p : *(u32 *)p;
1069         }
1070         for (j = 0; j < adapter->num_tx_queues; j++) {
1071                 ring = adapter->tx_ring[j];
1072                 do {
1073                         start = u64_stats_fetch_begin_bh(&ring->syncp);
1074                         data[i]   = ring->stats.packets;
1075                         data[i+1] = ring->stats.bytes;
1076                 } while (u64_stats_fetch_retry_bh(&ring->syncp, start));
1077                 i += 2;
1078         }
1079         for (j = 0; j < adapter->num_rx_queues; j++) {
1080                 ring = adapter->rx_ring[j];
1081                 do {
1082                         start = u64_stats_fetch_begin_bh(&ring->syncp);
1083                         data[i]   = ring->stats.packets;
1084                         data[i+1] = ring->stats.bytes;
1085                 } while (u64_stats_fetch_retry_bh(&ring->syncp, start));
1086                 i += 2;
1087         }
1088         if (adapter->flags & IXGBE_FLAG_DCB_ENABLED) {
1089                 for (j = 0; j < MAX_TX_PACKET_BUFFERS; j++) {
1090                         data[i++] = adapter->stats.pxontxc[j];
1091                         data[i++] = adapter->stats.pxofftxc[j];
1092                 }
1093                 for (j = 0; j < MAX_RX_PACKET_BUFFERS; j++) {
1094                         data[i++] = adapter->stats.pxonrxc[j];
1095                         data[i++] = adapter->stats.pxoffrxc[j];
1096                 }
1097         }
1098 }
1099
1100 static void ixgbe_get_strings(struct net_device *netdev, u32 stringset,
1101                               u8 *data)
1102 {
1103         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1104         char *p = (char *)data;
1105         int i;
1106
1107         switch (stringset) {
1108         case ETH_SS_TEST:
1109                 memcpy(data, *ixgbe_gstrings_test,
1110                        IXGBE_TEST_LEN * ETH_GSTRING_LEN);
1111                 break;
1112         case ETH_SS_STATS:
1113                 for (i = 0; i < IXGBE_GLOBAL_STATS_LEN; i++) {
1114                         memcpy(p, ixgbe_gstrings_stats[i].stat_string,
1115                                ETH_GSTRING_LEN);
1116                         p += ETH_GSTRING_LEN;
1117                 }
1118                 for (i = 0; i < adapter->num_tx_queues; i++) {
1119                         sprintf(p, "tx_queue_%u_packets", i);
1120                         p += ETH_GSTRING_LEN;
1121                         sprintf(p, "tx_queue_%u_bytes", i);
1122                         p += ETH_GSTRING_LEN;
1123                 }
1124                 for (i = 0; i < adapter->num_rx_queues; i++) {
1125                         sprintf(p, "rx_queue_%u_packets", i);
1126                         p += ETH_GSTRING_LEN;
1127                         sprintf(p, "rx_queue_%u_bytes", i);
1128                         p += ETH_GSTRING_LEN;
1129                 }
1130                 if (adapter->flags & IXGBE_FLAG_DCB_ENABLED) {
1131                         for (i = 0; i < MAX_TX_PACKET_BUFFERS; i++) {
1132                                 sprintf(p, "tx_pb_%u_pxon", i);
1133                                 p += ETH_GSTRING_LEN;
1134                                 sprintf(p, "tx_pb_%u_pxoff", i);
1135                                 p += ETH_GSTRING_LEN;
1136                         }
1137                         for (i = 0; i < MAX_RX_PACKET_BUFFERS; i++) {
1138                                 sprintf(p, "rx_pb_%u_pxon", i);
1139                                 p += ETH_GSTRING_LEN;
1140                                 sprintf(p, "rx_pb_%u_pxoff", i);
1141                                 p += ETH_GSTRING_LEN;
1142                         }
1143                 }
1144                 /* BUG_ON(p - data != IXGBE_STATS_LEN * ETH_GSTRING_LEN); */
1145                 break;
1146         }
1147 }
1148
1149 static int ixgbe_link_test(struct ixgbe_adapter *adapter, u64 *data)
1150 {
1151         struct ixgbe_hw *hw = &adapter->hw;
1152         bool link_up;
1153         u32 link_speed = 0;
1154         *data = 0;
1155
1156         hw->mac.ops.check_link(hw, &link_speed, &link_up, true);
1157         if (link_up)
1158                 return *data;
1159         else
1160                 *data = 1;
1161         return *data;
1162 }
1163
1164 /* ethtool register test data */
1165 struct ixgbe_reg_test {
1166         u16 reg;
1167         u8  array_len;
1168         u8  test_type;
1169         u32 mask;
1170         u32 write;
1171 };
1172
1173 /* In the hardware, registers are laid out either singly, in arrays
1174  * spaced 0x40 bytes apart, or in contiguous tables.  We assume
1175  * most tests take place on arrays or single registers (handled
1176  * as a single-element array) and special-case the tables.
1177  * Table tests are always pattern tests.
1178  *
1179  * We also make provision for some required setup steps by specifying
1180  * registers to be written without any read-back testing.
1181  */
1182
1183 #define PATTERN_TEST    1
1184 #define SET_READ_TEST   2
1185 #define WRITE_NO_TEST   3
1186 #define TABLE32_TEST    4
1187 #define TABLE64_TEST_LO 5
1188 #define TABLE64_TEST_HI 6
1189
1190 /* default 82599 register test */
1191 static const struct ixgbe_reg_test reg_test_82599[] = {
1192         { IXGBE_FCRTL_82599(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1193         { IXGBE_FCRTH_82599(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1194         { IXGBE_PFCTOP, 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1195         { IXGBE_VLNCTRL, 1, PATTERN_TEST, 0x00000000, 0x00000000 },
1196         { IXGBE_RDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFF80 },
1197         { IXGBE_RDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1198         { IXGBE_RDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
1199         { IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, IXGBE_RXDCTL_ENABLE },
1200         { IXGBE_RDT(0), 4, PATTERN_TEST, 0x0000FFFF, 0x0000FFFF },
1201         { IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, 0 },
1202         { IXGBE_FCRTH(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1203         { IXGBE_FCTTV(0), 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1204         { IXGBE_TDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
1205         { IXGBE_TDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1206         { IXGBE_TDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFF80 },
1207         { IXGBE_RXCTRL, 1, SET_READ_TEST, 0x00000001, 0x00000001 },
1208         { IXGBE_RAL(0), 16, TABLE64_TEST_LO, 0xFFFFFFFF, 0xFFFFFFFF },
1209         { IXGBE_RAL(0), 16, TABLE64_TEST_HI, 0x8001FFFF, 0x800CFFFF },
1210         { IXGBE_MTA(0), 128, TABLE32_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1211         { 0, 0, 0, 0 }
1212 };
1213
1214 /* default 82598 register test */
1215 static const struct ixgbe_reg_test reg_test_82598[] = {
1216         { IXGBE_FCRTL(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1217         { IXGBE_FCRTH(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1218         { IXGBE_PFCTOP, 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1219         { IXGBE_VLNCTRL, 1, PATTERN_TEST, 0x00000000, 0x00000000 },
1220         { IXGBE_RDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
1221         { IXGBE_RDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1222         { IXGBE_RDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
1223         /* Enable all four RX queues before testing. */
1224         { IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, IXGBE_RXDCTL_ENABLE },
1225         /* RDH is read-only for 82598, only test RDT. */
1226         { IXGBE_RDT(0), 4, PATTERN_TEST, 0x0000FFFF, 0x0000FFFF },
1227         { IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, 0 },
1228         { IXGBE_FCRTH(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1229         { IXGBE_FCTTV(0), 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1230         { IXGBE_TIPG, 1, PATTERN_TEST, 0x000000FF, 0x000000FF },
1231         { IXGBE_TDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
1232         { IXGBE_TDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1233         { IXGBE_TDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
1234         { IXGBE_RXCTRL, 1, SET_READ_TEST, 0x00000003, 0x00000003 },
1235         { IXGBE_DTXCTL, 1, SET_READ_TEST, 0x00000005, 0x00000005 },
1236         { IXGBE_RAL(0), 16, TABLE64_TEST_LO, 0xFFFFFFFF, 0xFFFFFFFF },
1237         { IXGBE_RAL(0), 16, TABLE64_TEST_HI, 0x800CFFFF, 0x800CFFFF },
1238         { IXGBE_MTA(0), 128, TABLE32_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1239         { 0, 0, 0, 0 }
1240 };
1241
1242 static const u32 register_test_patterns[] = {
1243         0x5A5A5A5A, 0xA5A5A5A5, 0x00000000, 0xFFFFFFFF
1244 };
1245
1246 #define REG_PATTERN_TEST(R, M, W)                                             \
1247 {                                                                             \
1248         u32 pat, val, before;                                                 \
1249         for (pat = 0; pat < ARRAY_SIZE(register_test_patterns); pat++) {      \
1250                 before = readl(adapter->hw.hw_addr + R);                      \
1251                 writel((register_test_patterns[pat] & W),                     \
1252                        (adapter->hw.hw_addr + R));                            \
1253                 val = readl(adapter->hw.hw_addr + R);                         \
1254                 if (val != (register_test_patterns[pat] & W & M)) {           \
1255                         e_err(drv, "pattern test reg %04X failed: got "       \
1256                               "0x%08X expected 0x%08X\n",                     \
1257                               R, val, (register_test_patterns[pat] & W & M)); \
1258                         *data = R;                                            \
1259                         writel(before, adapter->hw.hw_addr + R);              \
1260                         return 1;                                             \
1261                 }                                                             \
1262                 writel(before, adapter->hw.hw_addr + R);                      \
1263         }                                                                     \
1264 }
1265
1266 #define REG_SET_AND_CHECK(R, M, W)                                            \
1267 {                                                                             \
1268         u32 val, before;                                                      \
1269         before = readl(adapter->hw.hw_addr + R);                              \
1270         writel((W & M), (adapter->hw.hw_addr + R));                           \
1271         val = readl(adapter->hw.hw_addr + R);                                 \
1272         if ((W & M) != (val & M)) {                                           \
1273                 e_err(drv, "set/check reg %04X test failed: got 0x%08X "  \
1274                       "expected 0x%08X\n", R, (val & M), (W & M));        \
1275                 *data = R;                                                    \
1276                 writel(before, (adapter->hw.hw_addr + R));                    \
1277                 return 1;                                                     \
1278         }                                                                     \
1279         writel(before, (adapter->hw.hw_addr + R));                            \
1280 }
1281
1282 static int ixgbe_reg_test(struct ixgbe_adapter *adapter, u64 *data)
1283 {
1284         const struct ixgbe_reg_test *test;
1285         u32 value, before, after;
1286         u32 i, toggle;
1287
1288         switch (adapter->hw.mac.type) {
1289         case ixgbe_mac_82598EB:
1290                 toggle = 0x7FFFF3FF;
1291                 test = reg_test_82598;
1292                 break;
1293         case ixgbe_mac_82599EB:
1294         case ixgbe_mac_X540:
1295                 toggle = 0x7FFFF30F;
1296                 test = reg_test_82599;
1297                 break;
1298         default:
1299                 *data = 1;
1300                 return 1;
1301                 break;
1302         }
1303
1304         /*
1305          * Because the status register is such a special case,
1306          * we handle it separately from the rest of the register
1307          * tests.  Some bits are read-only, some toggle, and some
1308          * are writeable on newer MACs.
1309          */
1310         before = IXGBE_READ_REG(&adapter->hw, IXGBE_STATUS);
1311         value = (IXGBE_READ_REG(&adapter->hw, IXGBE_STATUS) & toggle);
1312         IXGBE_WRITE_REG(&adapter->hw, IXGBE_STATUS, toggle);
1313         after = IXGBE_READ_REG(&adapter->hw, IXGBE_STATUS) & toggle;
1314         if (value != after) {
1315                 e_err(drv, "failed STATUS register test got: 0x%08X "
1316                       "expected: 0x%08X\n", after, value);
1317                 *data = 1;
1318                 return 1;
1319         }
1320         /* restore previous status */
1321         IXGBE_WRITE_REG(&adapter->hw, IXGBE_STATUS, before);
1322
1323         /*
1324          * Perform the remainder of the register test, looping through
1325          * the test table until we either fail or reach the null entry.
1326          */
1327         while (test->reg) {
1328                 for (i = 0; i < test->array_len; i++) {
1329                         switch (test->test_type) {
1330                         case PATTERN_TEST:
1331                                 REG_PATTERN_TEST(test->reg + (i * 0x40),
1332                                                 test->mask,
1333                                                 test->write);
1334                                 break;
1335                         case SET_READ_TEST:
1336                                 REG_SET_AND_CHECK(test->reg + (i * 0x40),
1337                                                 test->mask,
1338                                                 test->write);
1339                                 break;
1340                         case WRITE_NO_TEST:
1341                                 writel(test->write,
1342                                        (adapter->hw.hw_addr + test->reg)
1343                                        + (i * 0x40));
1344                                 break;
1345                         case TABLE32_TEST:
1346                                 REG_PATTERN_TEST(test->reg + (i * 4),
1347                                                 test->mask,
1348                                                 test->write);
1349                                 break;
1350                         case TABLE64_TEST_LO:
1351                                 REG_PATTERN_TEST(test->reg + (i * 8),
1352                                                 test->mask,
1353                                                 test->write);
1354                                 break;
1355                         case TABLE64_TEST_HI:
1356                                 REG_PATTERN_TEST((test->reg + 4) + (i * 8),
1357                                                 test->mask,
1358                                                 test->write);
1359                                 break;
1360                         }
1361                 }
1362                 test++;
1363         }
1364
1365         *data = 0;
1366         return 0;
1367 }
1368
1369 static int ixgbe_eeprom_test(struct ixgbe_adapter *adapter, u64 *data)
1370 {
1371         struct ixgbe_hw *hw = &adapter->hw;
1372         if (hw->eeprom.ops.validate_checksum(hw, NULL))
1373                 *data = 1;
1374         else
1375                 *data = 0;
1376         return *data;
1377 }
1378
1379 static irqreturn_t ixgbe_test_intr(int irq, void *data)
1380 {
1381         struct net_device *netdev = (struct net_device *) data;
1382         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1383
1384         adapter->test_icr |= IXGBE_READ_REG(&adapter->hw, IXGBE_EICR);
1385
1386         return IRQ_HANDLED;
1387 }
1388
1389 static int ixgbe_intr_test(struct ixgbe_adapter *adapter, u64 *data)
1390 {
1391         struct net_device *netdev = adapter->netdev;
1392         u32 mask, i = 0, shared_int = true;
1393         u32 irq = adapter->pdev->irq;
1394
1395         *data = 0;
1396
1397         /* Hook up test interrupt handler just for this test */
1398         if (adapter->msix_entries) {
1399                 /* NOTE: we don't test MSI-X interrupts here, yet */
1400                 return 0;
1401         } else if (adapter->flags & IXGBE_FLAG_MSI_ENABLED) {
1402                 shared_int = false;
1403                 if (request_irq(irq, ixgbe_test_intr, 0, netdev->name,
1404                                 netdev)) {
1405                         *data = 1;
1406                         return -1;
1407                 }
1408         } else if (!request_irq(irq, ixgbe_test_intr, IRQF_PROBE_SHARED,
1409                                 netdev->name, netdev)) {
1410                 shared_int = false;
1411         } else if (request_irq(irq, ixgbe_test_intr, IRQF_SHARED,
1412                                netdev->name, netdev)) {
1413                 *data = 1;
1414                 return -1;
1415         }
1416         e_info(hw, "testing %s interrupt\n", shared_int ?
1417                "shared" : "unshared");
1418
1419         /* Disable all the interrupts */
1420         IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFFFFFF);
1421         msleep(10);
1422
1423         /* Test each interrupt */
1424         for (; i < 10; i++) {
1425                 /* Interrupt to test */
1426                 mask = 1 << i;
1427
1428                 if (!shared_int) {
1429                         /*
1430                          * Disable the interrupts to be reported in
1431                          * the cause register and then force the same
1432                          * interrupt and see if one gets posted.  If
1433                          * an interrupt was posted to the bus, the
1434                          * test failed.
1435                          */
1436                         adapter->test_icr = 0;
1437                         IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC,
1438                                         ~mask & 0x00007FFF);
1439                         IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS,
1440                                         ~mask & 0x00007FFF);
1441                         msleep(10);
1442
1443                         if (adapter->test_icr & mask) {
1444                                 *data = 3;
1445                                 break;
1446                         }
1447                 }
1448
1449                 /*
1450                  * Enable the interrupt to be reported in the cause
1451                  * register and then force the same interrupt and see
1452                  * if one gets posted.  If an interrupt was not posted
1453                  * to the bus, the test failed.
1454                  */
1455                 adapter->test_icr = 0;
1456                 IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMS, mask);
1457                 IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS, mask);
1458                 msleep(10);
1459
1460                 if (!(adapter->test_icr &mask)) {
1461                         *data = 4;
1462                         break;
1463                 }
1464
1465                 if (!shared_int) {
1466                         /*
1467                          * Disable the other interrupts to be reported in
1468                          * the cause register and then force the other
1469                          * interrupts and see if any get posted.  If
1470                          * an interrupt was posted to the bus, the
1471                          * test failed.
1472                          */
1473                         adapter->test_icr = 0;
1474                         IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC,
1475                                         ~mask & 0x00007FFF);
1476                         IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS,
1477                                         ~mask & 0x00007FFF);
1478                         msleep(10);
1479
1480                         if (adapter->test_icr) {
1481                                 *data = 5;
1482                                 break;
1483                         }
1484                 }
1485         }
1486
1487         /* Disable all the interrupts */
1488         IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFFFFFF);
1489         msleep(10);
1490
1491         /* Unhook test interrupt handler */
1492         free_irq(irq, netdev);
1493
1494         return *data;
1495 }
1496
1497 static void ixgbe_free_desc_rings(struct ixgbe_adapter *adapter)
1498 {
1499         struct ixgbe_ring *tx_ring = &adapter->test_tx_ring;
1500         struct ixgbe_ring *rx_ring = &adapter->test_rx_ring;
1501         struct ixgbe_hw *hw = &adapter->hw;
1502         u32 reg_ctl;
1503
1504         /* shut down the DMA engines now so they can be reinitialized later */
1505
1506         /* first Rx */
1507         reg_ctl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
1508         reg_ctl &= ~IXGBE_RXCTRL_RXEN;
1509         IXGBE_WRITE_REG(hw, IXGBE_RXCTRL, reg_ctl);
1510         ixgbe_disable_rx_queue(adapter, rx_ring);
1511
1512         /* now Tx */
1513         reg_ctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(tx_ring->reg_idx));
1514         reg_ctl &= ~IXGBE_TXDCTL_ENABLE;
1515         IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(tx_ring->reg_idx), reg_ctl);
1516
1517         switch (hw->mac.type) {
1518         case ixgbe_mac_82599EB:
1519         case ixgbe_mac_X540:
1520                 reg_ctl = IXGBE_READ_REG(hw, IXGBE_DMATXCTL);
1521                 reg_ctl &= ~IXGBE_DMATXCTL_TE;
1522                 IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL, reg_ctl);
1523                 break;
1524         default:
1525                 break;
1526         }
1527
1528         ixgbe_reset(adapter);
1529
1530         ixgbe_free_tx_resources(&adapter->test_tx_ring);
1531         ixgbe_free_rx_resources(&adapter->test_rx_ring);
1532 }
1533
1534 static int ixgbe_setup_desc_rings(struct ixgbe_adapter *adapter)
1535 {
1536         struct ixgbe_ring *tx_ring = &adapter->test_tx_ring;
1537         struct ixgbe_ring *rx_ring = &adapter->test_rx_ring;
1538         u32 rctl, reg_data;
1539         int ret_val;
1540         int err;
1541
1542         /* Setup Tx descriptor ring and Tx buffers */
1543         tx_ring->count = IXGBE_DEFAULT_TXD;
1544         tx_ring->queue_index = 0;
1545         tx_ring->dev = &adapter->pdev->dev;
1546         tx_ring->netdev = adapter->netdev;
1547         tx_ring->reg_idx = adapter->tx_ring[0]->reg_idx;
1548         tx_ring->numa_node = adapter->node;
1549
1550         err = ixgbe_setup_tx_resources(tx_ring);
1551         if (err)
1552                 return 1;
1553
1554         switch (adapter->hw.mac.type) {
1555         case ixgbe_mac_82599EB:
1556         case ixgbe_mac_X540:
1557                 reg_data = IXGBE_READ_REG(&adapter->hw, IXGBE_DMATXCTL);
1558                 reg_data |= IXGBE_DMATXCTL_TE;
1559                 IXGBE_WRITE_REG(&adapter->hw, IXGBE_DMATXCTL, reg_data);
1560                 break;
1561         default:
1562                 break;
1563         }
1564
1565         ixgbe_configure_tx_ring(adapter, tx_ring);
1566
1567         /* Setup Rx Descriptor ring and Rx buffers */
1568         rx_ring->count = IXGBE_DEFAULT_RXD;
1569         rx_ring->queue_index = 0;
1570         rx_ring->dev = &adapter->pdev->dev;
1571         rx_ring->netdev = adapter->netdev;
1572         rx_ring->reg_idx = adapter->rx_ring[0]->reg_idx;
1573         rx_ring->rx_buf_len = IXGBE_RXBUFFER_2048;
1574         rx_ring->numa_node = adapter->node;
1575
1576         err = ixgbe_setup_rx_resources(rx_ring);
1577         if (err) {
1578                 ret_val = 4;
1579                 goto err_nomem;
1580         }
1581
1582         rctl = IXGBE_READ_REG(&adapter->hw, IXGBE_RXCTRL);
1583         IXGBE_WRITE_REG(&adapter->hw, IXGBE_RXCTRL, rctl & ~IXGBE_RXCTRL_RXEN);
1584
1585         ixgbe_configure_rx_ring(adapter, rx_ring);
1586
1587         rctl |= IXGBE_RXCTRL_RXEN | IXGBE_RXCTRL_DMBYPS;
1588         IXGBE_WRITE_REG(&adapter->hw, IXGBE_RXCTRL, rctl);
1589
1590         return 0;
1591
1592 err_nomem:
1593         ixgbe_free_desc_rings(adapter);
1594         return ret_val;
1595 }
1596
1597 static int ixgbe_setup_loopback_test(struct ixgbe_adapter *adapter)
1598 {
1599         struct ixgbe_hw *hw = &adapter->hw;
1600         u32 reg_data;
1601
1602         /* right now we only support MAC loopback in the driver */
1603         reg_data = IXGBE_READ_REG(&adapter->hw, IXGBE_HLREG0);
1604         /* Setup MAC loopback */
1605         reg_data |= IXGBE_HLREG0_LPBK;
1606         IXGBE_WRITE_REG(&adapter->hw, IXGBE_HLREG0, reg_data);
1607
1608         reg_data = IXGBE_READ_REG(&adapter->hw, IXGBE_FCTRL);
1609         reg_data |= IXGBE_FCTRL_BAM | IXGBE_FCTRL_SBP | IXGBE_FCTRL_MPE;
1610         IXGBE_WRITE_REG(&adapter->hw, IXGBE_FCTRL, reg_data);
1611
1612         reg_data = IXGBE_READ_REG(&adapter->hw, IXGBE_AUTOC);
1613         reg_data &= ~IXGBE_AUTOC_LMS_MASK;
1614         reg_data |= IXGBE_AUTOC_LMS_10G_LINK_NO_AN | IXGBE_AUTOC_FLU;
1615         IXGBE_WRITE_REG(&adapter->hw, IXGBE_AUTOC, reg_data);
1616         IXGBE_WRITE_FLUSH(&adapter->hw);
1617         msleep(10);
1618
1619         /* Disable Atlas Tx lanes; re-enabled in reset path */
1620         if (hw->mac.type == ixgbe_mac_82598EB) {
1621                 u8 atlas;
1622
1623                 hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_LPBK, &atlas);
1624                 atlas |= IXGBE_ATLAS_PDN_TX_REG_EN;
1625                 hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_LPBK, atlas);
1626
1627                 hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_10G, &atlas);
1628                 atlas |= IXGBE_ATLAS_PDN_TX_10G_QL_ALL;
1629                 hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_10G, atlas);
1630
1631                 hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_1G, &atlas);
1632                 atlas |= IXGBE_ATLAS_PDN_TX_1G_QL_ALL;
1633                 hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_1G, atlas);
1634
1635                 hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_AN, &atlas);
1636                 atlas |= IXGBE_ATLAS_PDN_TX_AN_QL_ALL;
1637                 hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_AN, atlas);
1638         }
1639
1640         return 0;
1641 }
1642
1643 static void ixgbe_loopback_cleanup(struct ixgbe_adapter *adapter)
1644 {
1645         u32 reg_data;
1646
1647         reg_data = IXGBE_READ_REG(&adapter->hw, IXGBE_HLREG0);
1648         reg_data &= ~IXGBE_HLREG0_LPBK;
1649         IXGBE_WRITE_REG(&adapter->hw, IXGBE_HLREG0, reg_data);
1650 }
1651
1652 static void ixgbe_create_lbtest_frame(struct sk_buff *skb,
1653                                       unsigned int frame_size)
1654 {
1655         memset(skb->data, 0xFF, frame_size);
1656         frame_size &= ~1;
1657         memset(&skb->data[frame_size / 2], 0xAA, frame_size / 2 - 1);
1658         memset(&skb->data[frame_size / 2 + 10], 0xBE, 1);
1659         memset(&skb->data[frame_size / 2 + 12], 0xAF, 1);
1660 }
1661
1662 static int ixgbe_check_lbtest_frame(struct sk_buff *skb,
1663                                     unsigned int frame_size)
1664 {
1665         frame_size &= ~1;
1666         if (*(skb->data + 3) == 0xFF) {
1667                 if ((*(skb->data + frame_size / 2 + 10) == 0xBE) &&
1668                     (*(skb->data + frame_size / 2 + 12) == 0xAF)) {
1669                         return 0;
1670                 }
1671         }
1672         return 13;
1673 }
1674
1675 static u16 ixgbe_clean_test_rings(struct ixgbe_ring *rx_ring,
1676                                   struct ixgbe_ring *tx_ring,
1677                                   unsigned int size)
1678 {
1679         union ixgbe_adv_rx_desc *rx_desc;
1680         struct ixgbe_rx_buffer *rx_buffer_info;
1681         struct ixgbe_tx_buffer *tx_buffer_info;
1682         const int bufsz = rx_ring->rx_buf_len;
1683         u32 staterr;
1684         u16 rx_ntc, tx_ntc, count = 0;
1685
1686         /* initialize next to clean and descriptor values */
1687         rx_ntc = rx_ring->next_to_clean;
1688         tx_ntc = tx_ring->next_to_clean;
1689         rx_desc = IXGBE_RX_DESC_ADV(rx_ring, rx_ntc);
1690         staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
1691
1692         while (staterr & IXGBE_RXD_STAT_DD) {
1693                 /* check Rx buffer */
1694                 rx_buffer_info = &rx_ring->rx_buffer_info[rx_ntc];
1695
1696                 /* unmap Rx buffer, will be remapped by alloc_rx_buffers */
1697                 dma_unmap_single(rx_ring->dev,
1698                                  rx_buffer_info->dma,
1699                                  bufsz,
1700                                  DMA_FROM_DEVICE);
1701                 rx_buffer_info->dma = 0;
1702
1703                 /* verify contents of skb */
1704                 if (!ixgbe_check_lbtest_frame(rx_buffer_info->skb, size))
1705                         count++;
1706
1707                 /* unmap buffer on Tx side */
1708                 tx_buffer_info = &tx_ring->tx_buffer_info[tx_ntc];
1709                 ixgbe_unmap_and_free_tx_resource(tx_ring, tx_buffer_info);
1710
1711                 /* increment Rx/Tx next to clean counters */
1712                 rx_ntc++;
1713                 if (rx_ntc == rx_ring->count)
1714                         rx_ntc = 0;
1715                 tx_ntc++;
1716                 if (tx_ntc == tx_ring->count)
1717                         tx_ntc = 0;
1718
1719                 /* fetch next descriptor */
1720                 rx_desc = IXGBE_RX_DESC_ADV(rx_ring, rx_ntc);
1721                 staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
1722         }
1723
1724         /* re-map buffers to ring, store next to clean values */
1725         ixgbe_alloc_rx_buffers(rx_ring, count);
1726         rx_ring->next_to_clean = rx_ntc;
1727         tx_ring->next_to_clean = tx_ntc;
1728
1729         return count;
1730 }
1731
1732 static int ixgbe_run_loopback_test(struct ixgbe_adapter *adapter)
1733 {
1734         struct ixgbe_ring *tx_ring = &adapter->test_tx_ring;
1735         struct ixgbe_ring *rx_ring = &adapter->test_rx_ring;
1736         int i, j, lc, good_cnt, ret_val = 0;
1737         unsigned int size = 1024;
1738         netdev_tx_t tx_ret_val;
1739         struct sk_buff *skb;
1740
1741         /* allocate test skb */
1742         skb = alloc_skb(size, GFP_KERNEL);
1743         if (!skb)
1744                 return 11;
1745
1746         /* place data into test skb */
1747         ixgbe_create_lbtest_frame(skb, size);
1748         skb_put(skb, size);
1749
1750         /*
1751          * Calculate the loop count based on the largest descriptor ring
1752          * The idea is to wrap the largest ring a number of times using 64
1753          * send/receive pairs during each loop
1754          */
1755
1756         if (rx_ring->count <= tx_ring->count)
1757                 lc = ((tx_ring->count / 64) * 2) + 1;
1758         else
1759                 lc = ((rx_ring->count / 64) * 2) + 1;
1760
1761         for (j = 0; j <= lc; j++) {
1762                 /* reset count of good packets */
1763                 good_cnt = 0;
1764
1765                 /* place 64 packets on the transmit queue*/
1766                 for (i = 0; i < 64; i++) {
1767                         skb_get(skb);
1768                         tx_ret_val = ixgbe_xmit_frame_ring(skb,
1769                                                            adapter,
1770                                                            tx_ring);
1771                         if (tx_ret_val == NETDEV_TX_OK)
1772                                 good_cnt++;
1773                 }
1774
1775                 if (good_cnt != 64) {
1776                         ret_val = 12;
1777                         break;
1778                 }
1779
1780                 /* allow 200 milliseconds for packets to go from Tx to Rx */
1781                 msleep(200);
1782
1783                 good_cnt = ixgbe_clean_test_rings(rx_ring, tx_ring, size);
1784                 if (good_cnt != 64) {
1785                         ret_val = 13;
1786                         break;
1787                 }
1788         }
1789
1790         /* free the original skb */
1791         kfree_skb(skb);
1792
1793         return ret_val;
1794 }
1795
1796 static int ixgbe_loopback_test(struct ixgbe_adapter *adapter, u64 *data)
1797 {
1798         *data = ixgbe_setup_desc_rings(adapter);
1799         if (*data)
1800                 goto out;
1801         *data = ixgbe_setup_loopback_test(adapter);
1802         if (*data)
1803                 goto err_loopback;
1804         *data = ixgbe_run_loopback_test(adapter);
1805         ixgbe_loopback_cleanup(adapter);
1806
1807 err_loopback:
1808         ixgbe_free_desc_rings(adapter);
1809 out:
1810         return *data;
1811 }
1812
1813 static void ixgbe_diag_test(struct net_device *netdev,
1814                             struct ethtool_test *eth_test, u64 *data)
1815 {
1816         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1817         bool if_running = netif_running(netdev);
1818
1819         set_bit(__IXGBE_TESTING, &adapter->state);
1820         if (eth_test->flags == ETH_TEST_FL_OFFLINE) {
1821                 /* Offline tests */
1822
1823                 e_info(hw, "offline testing starting\n");
1824
1825                 /* Link test performed before hardware reset so autoneg doesn't
1826                  * interfere with test result */
1827                 if (ixgbe_link_test(adapter, &data[4]))
1828                         eth_test->flags |= ETH_TEST_FL_FAILED;
1829
1830                 if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
1831                         int i;
1832                         for (i = 0; i < adapter->num_vfs; i++) {
1833                                 if (adapter->vfinfo[i].clear_to_send) {
1834                                         netdev_warn(netdev, "%s",
1835                                                     "offline diagnostic is not "
1836                                                     "supported when VFs are "
1837                                                     "present\n");
1838                                         data[0] = 1;
1839                                         data[1] = 1;
1840                                         data[2] = 1;
1841                                         data[3] = 1;
1842                                         eth_test->flags |= ETH_TEST_FL_FAILED;
1843                                         clear_bit(__IXGBE_TESTING,
1844                                                   &adapter->state);
1845                                         goto skip_ol_tests;
1846                                 }
1847                         }
1848                 }
1849
1850                 if (if_running)
1851                         /* indicate we're in test mode */
1852                         dev_close(netdev);
1853                 else
1854                         ixgbe_reset(adapter);
1855
1856                 e_info(hw, "register testing starting\n");
1857                 if (ixgbe_reg_test(adapter, &data[0]))
1858                         eth_test->flags |= ETH_TEST_FL_FAILED;
1859
1860                 ixgbe_reset(adapter);
1861                 e_info(hw, "eeprom testing starting\n");
1862                 if (ixgbe_eeprom_test(adapter, &data[1]))
1863                         eth_test->flags |= ETH_TEST_FL_FAILED;
1864
1865                 ixgbe_reset(adapter);
1866                 e_info(hw, "interrupt testing starting\n");
1867                 if (ixgbe_intr_test(adapter, &data[2]))
1868                         eth_test->flags |= ETH_TEST_FL_FAILED;
1869
1870                 /* If SRIOV or VMDq is enabled then skip MAC
1871                  * loopback diagnostic. */
1872                 if (adapter->flags & (IXGBE_FLAG_SRIOV_ENABLED |
1873                                       IXGBE_FLAG_VMDQ_ENABLED)) {
1874                         e_info(hw, "Skip MAC loopback diagnostic in VT "
1875                                "mode\n");
1876                         data[3] = 0;
1877                         goto skip_loopback;
1878                 }
1879
1880                 ixgbe_reset(adapter);
1881                 e_info(hw, "loopback testing starting\n");
1882                 if (ixgbe_loopback_test(adapter, &data[3]))
1883                         eth_test->flags |= ETH_TEST_FL_FAILED;
1884
1885 skip_loopback:
1886                 ixgbe_reset(adapter);
1887
1888                 clear_bit(__IXGBE_TESTING, &adapter->state);
1889                 if (if_running)
1890                         dev_open(netdev);
1891         } else {
1892                 e_info(hw, "online testing starting\n");
1893                 /* Online tests */
1894                 if (ixgbe_link_test(adapter, &data[4]))
1895                         eth_test->flags |= ETH_TEST_FL_FAILED;
1896
1897                 /* Online tests aren't run; pass by default */
1898                 data[0] = 0;
1899                 data[1] = 0;
1900                 data[2] = 0;
1901                 data[3] = 0;
1902
1903                 clear_bit(__IXGBE_TESTING, &adapter->state);
1904         }
1905 skip_ol_tests:
1906         msleep_interruptible(4 * 1000);
1907 }
1908
1909 static int ixgbe_wol_exclusion(struct ixgbe_adapter *adapter,
1910                                struct ethtool_wolinfo *wol)
1911 {
1912         struct ixgbe_hw *hw = &adapter->hw;
1913         int retval = 1;
1914
1915         /* WOL not supported except for the following */
1916         switch(hw->device_id) {
1917         case IXGBE_DEV_ID_82599_SFP:
1918                 /* Only this subdevice supports WOL */
1919                 if (hw->subsystem_device_id != IXGBE_SUBDEV_ID_82599_SFP) {
1920                         wol->supported = 0;
1921                         break;
1922                 }
1923                 retval = 0;
1924                 break;
1925         case IXGBE_DEV_ID_82599_COMBO_BACKPLANE:
1926                 /* All except this subdevice support WOL */
1927                 if (hw->subsystem_device_id ==
1928                     IXGBE_SUBDEV_ID_82599_KX4_KR_MEZZ) {
1929                         wol->supported = 0;
1930                         break;
1931                 }
1932                 retval = 0;
1933                 break;
1934         case IXGBE_DEV_ID_82599_KX4:
1935                 retval = 0;
1936                 break;
1937         default:
1938                 wol->supported = 0;
1939         }
1940
1941         return retval;
1942 }
1943
1944 static void ixgbe_get_wol(struct net_device *netdev,
1945                           struct ethtool_wolinfo *wol)
1946 {
1947         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1948
1949         wol->supported = WAKE_UCAST | WAKE_MCAST |
1950                          WAKE_BCAST | WAKE_MAGIC;
1951         wol->wolopts = 0;
1952
1953         if (ixgbe_wol_exclusion(adapter, wol) ||
1954             !device_can_wakeup(&adapter->pdev->dev))
1955                 return;
1956
1957         if (adapter->wol & IXGBE_WUFC_EX)
1958                 wol->wolopts |= WAKE_UCAST;
1959         if (adapter->wol & IXGBE_WUFC_MC)
1960                 wol->wolopts |= WAKE_MCAST;
1961         if (adapter->wol & IXGBE_WUFC_BC)
1962                 wol->wolopts |= WAKE_BCAST;
1963         if (adapter->wol & IXGBE_WUFC_MAG)
1964                 wol->wolopts |= WAKE_MAGIC;
1965 }
1966
1967 static int ixgbe_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
1968 {
1969         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1970
1971         if (wol->wolopts & (WAKE_PHY | WAKE_ARP | WAKE_MAGICSECURE))
1972                 return -EOPNOTSUPP;
1973
1974         if (ixgbe_wol_exclusion(adapter, wol))
1975                 return wol->wolopts ? -EOPNOTSUPP : 0;
1976
1977         adapter->wol = 0;
1978
1979         if (wol->wolopts & WAKE_UCAST)
1980                 adapter->wol |= IXGBE_WUFC_EX;
1981         if (wol->wolopts & WAKE_MCAST)
1982                 adapter->wol |= IXGBE_WUFC_MC;
1983         if (wol->wolopts & WAKE_BCAST)
1984                 adapter->wol |= IXGBE_WUFC_BC;
1985         if (wol->wolopts & WAKE_MAGIC)
1986                 adapter->wol |= IXGBE_WUFC_MAG;
1987
1988         device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);
1989
1990         return 0;
1991 }
1992
1993 static int ixgbe_nway_reset(struct net_device *netdev)
1994 {
1995         struct ixgbe_adapter *adapter = netdev_priv(netdev);
1996
1997         if (netif_running(netdev))
1998                 ixgbe_reinit_locked(adapter);
1999
2000         return 0;
2001 }
2002
2003 static int ixgbe_phys_id(struct net_device *netdev, u32 data)
2004 {
2005         struct ixgbe_adapter *adapter = netdev_priv(netdev);
2006         struct ixgbe_hw *hw = &adapter->hw;
2007         u32 led_reg = IXGBE_READ_REG(hw, IXGBE_LEDCTL);
2008         u32 i;
2009
2010         if (!data || data > 300)
2011                 data = 300;
2012
2013         for (i = 0; i < (data * 1000); i += 400) {
2014                 hw->mac.ops.led_on(hw, IXGBE_LED_ON);
2015                 msleep_interruptible(200);
2016                 hw->mac.ops.led_off(hw, IXGBE_LED_ON);
2017                 msleep_interruptible(200);
2018         }
2019
2020         /* Restore LED settings */
2021         IXGBE_WRITE_REG(&adapter->hw, IXGBE_LEDCTL, led_reg);
2022
2023         return 0;
2024 }
2025
2026 static int ixgbe_get_coalesce(struct net_device *netdev,
2027                               struct ethtool_coalesce *ec)
2028 {
2029         struct ixgbe_adapter *adapter = netdev_priv(netdev);
2030
2031         ec->tx_max_coalesced_frames_irq = adapter->tx_ring[0]->work_limit;
2032
2033         /* only valid if in constant ITR mode */
2034         switch (adapter->rx_itr_setting) {
2035         case 0:
2036                 /* throttling disabled */
2037                 ec->rx_coalesce_usecs = 0;
2038                 break;
2039         case 1:
2040                 /* dynamic ITR mode */
2041                 ec->rx_coalesce_usecs = 1;
2042                 break;
2043         default:
2044                 /* fixed interrupt rate mode */
2045                 ec->rx_coalesce_usecs = 1000000/adapter->rx_eitr_param;
2046                 break;
2047         }
2048
2049         /* if in mixed tx/rx queues per vector mode, report only rx settings */
2050         if (adapter->q_vector[0]->txr_count && adapter->q_vector[0]->rxr_count)
2051                 return 0;
2052
2053         /* only valid if in constant ITR mode */
2054         switch (adapter->tx_itr_setting) {
2055         case 0:
2056                 /* throttling disabled */
2057                 ec->tx_coalesce_usecs = 0;
2058                 break;
2059         case 1:
2060                 /* dynamic ITR mode */
2061                 ec->tx_coalesce_usecs = 1;
2062                 break;
2063         default:
2064                 ec->tx_coalesce_usecs = 1000000/adapter->tx_eitr_param;
2065                 break;
2066         }
2067
2068         return 0;
2069 }
2070
2071 /*
2072  * this function must be called before setting the new value of
2073  * rx_itr_setting
2074  */
2075 static bool ixgbe_update_rsc(struct ixgbe_adapter *adapter,
2076                              struct ethtool_coalesce *ec)
2077 {
2078         struct net_device *netdev = adapter->netdev;
2079
2080         if (!(adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE))
2081                 return false;
2082
2083         /* if interrupt rate is too high then disable RSC */
2084         if (ec->rx_coalesce_usecs != 1 &&
2085             ec->rx_coalesce_usecs <= 1000000/IXGBE_MAX_RSC_INT_RATE) {
2086                 if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED) {
2087                         e_info(probe, "rx-usecs set too low, "
2088                                       "disabling RSC\n");
2089                         adapter->flags2 &= ~IXGBE_FLAG2_RSC_ENABLED;
2090                         return true;
2091                 }
2092         } else {
2093                 /* check the feature flag value and enable RSC if necessary */
2094                 if ((netdev->features & NETIF_F_LRO) &&
2095                     !(adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)) {
2096                         e_info(probe, "rx-usecs set to %d, "
2097                                       "re-enabling RSC\n",
2098                                ec->rx_coalesce_usecs);
2099                         adapter->flags2 |= IXGBE_FLAG2_RSC_ENABLED;
2100                         return true;
2101                 }
2102         }
2103         return false;
2104 }
2105
2106 static int ixgbe_set_coalesce(struct net_device *netdev,
2107                               struct ethtool_coalesce *ec)
2108 {
2109         struct ixgbe_adapter *adapter = netdev_priv(netdev);
2110         struct ixgbe_q_vector *q_vector;
2111         int i;
2112         bool need_reset = false;
2113
2114         /* don't accept tx specific changes if we've got mixed RxTx vectors */
2115         if (adapter->q_vector[0]->txr_count && adapter->q_vector[0]->rxr_count
2116            && ec->tx_coalesce_usecs)
2117                 return -EINVAL;
2118
2119         if (ec->tx_max_coalesced_frames_irq)
2120                 adapter->tx_ring[0]->work_limit = ec->tx_max_coalesced_frames_irq;
2121
2122         if (ec->rx_coalesce_usecs > 1) {
2123                 /* check the limits */
2124                 if ((1000000/ec->rx_coalesce_usecs > IXGBE_MAX_INT_RATE) ||
2125                     (1000000/ec->rx_coalesce_usecs < IXGBE_MIN_INT_RATE))
2126                         return -EINVAL;
2127
2128                 /* check the old value and enable RSC if necessary */
2129                 need_reset = ixgbe_update_rsc(adapter, ec);
2130
2131                 /* store the value in ints/second */
2132                 adapter->rx_eitr_param = 1000000/ec->rx_coalesce_usecs;
2133
2134                 /* static value of interrupt rate */
2135                 adapter->rx_itr_setting = adapter->rx_eitr_param;
2136                 /* clear the lower bit as its used for dynamic state */
2137                 adapter->rx_itr_setting &= ~1;
2138         } else if (ec->rx_coalesce_usecs == 1) {
2139                 /* check the old value and enable RSC if necessary */
2140                 need_reset = ixgbe_update_rsc(adapter, ec);
2141
2142                 /* 1 means dynamic mode */
2143                 adapter->rx_eitr_param = 20000;
2144                 adapter->rx_itr_setting = 1;
2145         } else {
2146                 /* check the old value and enable RSC if necessary */
2147                 need_reset = ixgbe_update_rsc(adapter, ec);
2148                 /*
2149                  * any other value means disable eitr, which is best
2150                  * served by setting the interrupt rate very high
2151                  */
2152                 adapter->rx_eitr_param = IXGBE_MAX_INT_RATE;
2153                 adapter->rx_itr_setting = 0;
2154         }
2155
2156         if (ec->tx_coalesce_usecs > 1) {
2157                 /*
2158                  * don't have to worry about max_int as above because
2159                  * tx vectors don't do hardware RSC (an rx function)
2160                  */
2161                 /* check the limits */
2162                 if ((1000000/ec->tx_coalesce_usecs > IXGBE_MAX_INT_RATE) ||
2163                     (1000000/ec->tx_coalesce_usecs < IXGBE_MIN_INT_RATE))
2164                         return -EINVAL;
2165
2166                 /* store the value in ints/second */
2167                 adapter->tx_eitr_param = 1000000/ec->tx_coalesce_usecs;
2168
2169                 /* static value of interrupt rate */
2170                 adapter->tx_itr_setting = adapter->tx_eitr_param;
2171
2172                 /* clear the lower bit as its used for dynamic state */
2173                 adapter->tx_itr_setting &= ~1;
2174         } else if (ec->tx_coalesce_usecs == 1) {
2175                 /* 1 means dynamic mode */
2176                 adapter->tx_eitr_param = 10000;
2177                 adapter->tx_itr_setting = 1;
2178         } else {
2179                 adapter->tx_eitr_param = IXGBE_MAX_INT_RATE;
2180                 adapter->tx_itr_setting = 0;
2181         }
2182
2183         /* MSI/MSIx Interrupt Mode */
2184         if (adapter->flags &
2185             (IXGBE_FLAG_MSIX_ENABLED | IXGBE_FLAG_MSI_ENABLED)) {
2186                 int num_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
2187                 for (i = 0; i < num_vectors; i++) {
2188                         q_vector = adapter->q_vector[i];
2189                         if (q_vector->txr_count && !q_vector->rxr_count)
2190                                 /* tx only */
2191                                 q_vector->eitr = adapter->tx_eitr_param;
2192                         else
2193                                 /* rx only or mixed */
2194                                 q_vector->eitr = adapter->rx_eitr_param;
2195                         ixgbe_write_eitr(q_vector);
2196                 }
2197         /* Legacy Interrupt Mode */
2198         } else {
2199                 q_vector = adapter->q_vector[0];
2200                 q_vector->eitr = adapter->rx_eitr_param;
2201                 ixgbe_write_eitr(q_vector);
2202         }
2203
2204         /*
2205          * do reset here at the end to make sure EITR==0 case is handled
2206          * correctly w.r.t stopping tx, and changing TXDCTL.WTHRESH settings
2207          * also locks in RSC enable/disable which requires reset
2208          */
2209         if (need_reset) {
2210                 if (netif_running(netdev))
2211                         ixgbe_reinit_locked(adapter);
2212                 else
2213                         ixgbe_reset(adapter);
2214         }
2215
2216         return 0;
2217 }
2218
2219 static int ixgbe_set_flags(struct net_device *netdev, u32 data)
2220 {
2221         struct ixgbe_adapter *adapter = netdev_priv(netdev);
2222         bool need_reset = false;
2223         int rc;
2224
2225 #ifdef CONFIG_IXGBE_DCB
2226         if ((adapter->flags & IXGBE_FLAG_DCB_ENABLED) &&
2227             !(data & ETH_FLAG_RXVLAN))
2228                 return -EINVAL;
2229 #endif
2230
2231         need_reset = (data & ETH_FLAG_RXVLAN) !=
2232                      (netdev->features & NETIF_F_HW_VLAN_RX);
2233
2234         rc = ethtool_op_set_flags(netdev, data, ETH_FLAG_LRO | ETH_FLAG_NTUPLE |
2235                                         ETH_FLAG_RXVLAN | ETH_FLAG_TXVLAN);
2236         if (rc)
2237                 return rc;
2238
2239         /* if state changes we need to update adapter->flags and reset */
2240         if ((adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE) &&
2241             (!!(data & ETH_FLAG_LRO) !=
2242              !!(adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED))) {
2243                 if ((data & ETH_FLAG_LRO) &&
2244                     (!adapter->rx_itr_setting ||
2245                      (adapter->rx_itr_setting > IXGBE_MAX_RSC_INT_RATE))) {
2246                         e_info(probe, "rx-usecs set too low, "
2247                                       "not enabling RSC.\n");
2248                 } else {
2249                         adapter->flags2 ^= IXGBE_FLAG2_RSC_ENABLED;
2250                         switch (adapter->hw.mac.type) {
2251                         case ixgbe_mac_82599EB:
2252                                 need_reset = true;
2253                                 break;
2254                         case ixgbe_mac_X540: {
2255                                 int i;
2256                                 for (i = 0; i < adapter->num_rx_queues; i++) {
2257                                         struct ixgbe_ring *ring =
2258                                                           adapter->rx_ring[i];
2259                                         if (adapter->flags2 &
2260                                             IXGBE_FLAG2_RSC_ENABLED) {
2261                                                 ixgbe_configure_rscctl(adapter,
2262                                                                        ring);
2263                                         } else {
2264                                                 ixgbe_clear_rscctl(adapter,
2265                                                                    ring);
2266                                         }
2267                                 }
2268                         }
2269                                 break;
2270                         default:
2271                                 break;
2272                         }
2273                 }
2274         }
2275
2276         /*
2277          * Check if Flow Director n-tuple support was enabled or disabled.  If
2278          * the state changed, we need to reset.
2279          */
2280         if ((adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE) &&
2281             (!(data & ETH_FLAG_NTUPLE))) {
2282                 /* turn off Flow Director perfect, set hash and reset */
2283                 adapter->flags &= ~IXGBE_FLAG_FDIR_PERFECT_CAPABLE;
2284                 adapter->flags |= IXGBE_FLAG_FDIR_HASH_CAPABLE;
2285                 need_reset = true;
2286         } else if ((!(adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE)) &&
2287                    (data & ETH_FLAG_NTUPLE)) {
2288                 /* turn off Flow Director hash, enable perfect and reset */
2289                 adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
2290                 adapter->flags |= IXGBE_FLAG_FDIR_PERFECT_CAPABLE;
2291                 need_reset = true;
2292         } else {
2293                 /* no state change */
2294         }
2295
2296         if (need_reset) {
2297                 if (netif_running(netdev))
2298                         ixgbe_reinit_locked(adapter);
2299                 else
2300                         ixgbe_reset(adapter);
2301         }
2302
2303         return 0;
2304 }
2305
2306 static int ixgbe_set_rx_ntuple(struct net_device *dev,
2307                                struct ethtool_rx_ntuple *cmd)
2308 {
2309         struct ixgbe_adapter *adapter = netdev_priv(dev);
2310         struct ethtool_rx_ntuple_flow_spec *fs = &cmd->fs;
2311         union ixgbe_atr_input input_struct;
2312         struct ixgbe_atr_input_masks input_masks;
2313         int target_queue;
2314         int err;
2315
2316         if (adapter->hw.mac.type == ixgbe_mac_82598EB)
2317                 return -EOPNOTSUPP;
2318
2319         /*
2320          * Don't allow programming if the action is a queue greater than
2321          * the number of online Tx queues.
2322          */
2323         if ((fs->action >= adapter->num_tx_queues) ||
2324             (fs->action < ETHTOOL_RXNTUPLE_ACTION_DROP))
2325                 return -EINVAL;
2326
2327         memset(&input_struct, 0, sizeof(union ixgbe_atr_input));
2328         memset(&input_masks, 0, sizeof(struct ixgbe_atr_input_masks));
2329
2330         /* record flow type */
2331         switch (fs->flow_type) {
2332         case IPV4_FLOW:
2333                 input_struct.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_IPV4;
2334                 break;
2335         case TCP_V4_FLOW:
2336                 input_struct.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_TCPV4;
2337                 break;
2338         case UDP_V4_FLOW:
2339                 input_struct.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_UDPV4;
2340                 break;
2341         case SCTP_V4_FLOW:
2342                 input_struct.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_SCTPV4;
2343                 break;
2344         default:
2345                 return -1;
2346         }
2347
2348         /* copy vlan tag minus the CFI bit */
2349         if ((fs->vlan_tag & 0xEFFF) || (~fs->vlan_tag_mask & 0xEFFF)) {
2350                 input_struct.formatted.vlan_id = htons(fs->vlan_tag & 0xEFFF);
2351                 if (!fs->vlan_tag_mask) {
2352                         input_masks.vlan_id_mask = htons(0xEFFF);
2353                 } else {
2354                         switch (~fs->vlan_tag_mask & 0xEFFF) {
2355                         /* all of these are valid vlan-mask values */
2356                         case 0xEFFF:
2357                         case 0xE000:
2358                         case 0x0FFF:
2359                         case 0x0000:
2360                                 input_masks.vlan_id_mask =
2361                                         htons(~fs->vlan_tag_mask);
2362                                 break;
2363                         /* exit with error if vlan-mask is invalid */
2364                         default:
2365                                 e_err(drv, "Partial VLAN ID or "
2366                                       "priority mask in vlan-mask is not "
2367                                       "supported by hardware\n");
2368                                 return -1;
2369                         }
2370                 }
2371         }
2372
2373         /* make sure we only use the first 2 bytes of user data */
2374         if ((fs->data & 0xFFFF) || (~fs->data_mask & 0xFFFF)) {
2375                 input_struct.formatted.flex_bytes = htons(fs->data & 0xFFFF);
2376                 if (!(fs->data_mask & 0xFFFF)) {
2377                         input_masks.flex_mask = 0xFFFF;
2378                 } else if (~fs->data_mask & 0xFFFF) {
2379                         e_err(drv, "Partial user-def-mask is not "
2380                               "supported by hardware\n");
2381                         return -1;
2382                 }
2383         }
2384
2385         /*
2386          * Copy input into formatted structures
2387          *
2388          * These assignments are based on the following logic
2389          * If neither input or mask are set assume value is masked out.
2390          * If input is set, but mask is not mask should default to accept all.
2391          * If input is not set, but mask is set then mask likely results in 0.
2392          * If input is set and mask is set then assign both.
2393          */
2394         if (fs->h_u.tcp_ip4_spec.ip4src || ~fs->m_u.tcp_ip4_spec.ip4src) {
2395                 input_struct.formatted.src_ip[0] = fs->h_u.tcp_ip4_spec.ip4src;
2396                 if (!fs->m_u.tcp_ip4_spec.ip4src)
2397                         input_masks.src_ip_mask[0] = 0xFFFFFFFF;
2398                 else
2399                         input_masks.src_ip_mask[0] =
2400                                 ~fs->m_u.tcp_ip4_spec.ip4src;
2401         }
2402         if (fs->h_u.tcp_ip4_spec.ip4dst || ~fs->m_u.tcp_ip4_spec.ip4dst) {
2403                 input_struct.formatted.dst_ip[0] = fs->h_u.tcp_ip4_spec.ip4dst;
2404                 if (!fs->m_u.tcp_ip4_spec.ip4dst)
2405                         input_masks.dst_ip_mask[0] = 0xFFFFFFFF;
2406                 else
2407                         input_masks.dst_ip_mask[0] =
2408                                 ~fs->m_u.tcp_ip4_spec.ip4dst;
2409         }
2410         if (fs->h_u.tcp_ip4_spec.psrc || ~fs->m_u.tcp_ip4_spec.psrc) {
2411                 input_struct.formatted.src_port = fs->h_u.tcp_ip4_spec.psrc;
2412                 if (!fs->m_u.tcp_ip4_spec.psrc)
2413                         input_masks.src_port_mask = 0xFFFF;
2414                 else
2415                         input_masks.src_port_mask = ~fs->m_u.tcp_ip4_spec.psrc;
2416         }
2417         if (fs->h_u.tcp_ip4_spec.pdst || ~fs->m_u.tcp_ip4_spec.pdst) {
2418                 input_struct.formatted.dst_port = fs->h_u.tcp_ip4_spec.pdst;
2419                 if (!fs->m_u.tcp_ip4_spec.pdst)
2420                         input_masks.dst_port_mask = 0xFFFF;
2421                 else
2422                         input_masks.dst_port_mask = ~fs->m_u.tcp_ip4_spec.pdst;
2423         }
2424
2425         /* determine if we need to drop or route the packet */
2426         if (fs->action == ETHTOOL_RXNTUPLE_ACTION_DROP)
2427                 target_queue = MAX_RX_QUEUES - 1;
2428         else
2429                 target_queue = fs->action;
2430
2431         spin_lock(&adapter->fdir_perfect_lock);
2432         err = ixgbe_fdir_add_perfect_filter_82599(&adapter->hw,
2433                                                   &input_struct,
2434                                                   &input_masks, 0,
2435                                                   target_queue);
2436         spin_unlock(&adapter->fdir_perfect_lock);
2437
2438         return err ? -1 : 0;
2439 }
2440
2441 static const struct ethtool_ops ixgbe_ethtool_ops = {
2442         .get_settings           = ixgbe_get_settings,
2443         .set_settings           = ixgbe_set_settings,
2444         .get_drvinfo            = ixgbe_get_drvinfo,
2445         .get_regs_len           = ixgbe_get_regs_len,
2446         .get_regs               = ixgbe_get_regs,
2447         .get_wol                = ixgbe_get_wol,
2448         .set_wol                = ixgbe_set_wol,
2449         .nway_reset             = ixgbe_nway_reset,
2450         .get_link               = ethtool_op_get_link,
2451         .get_eeprom_len         = ixgbe_get_eeprom_len,
2452         .get_eeprom             = ixgbe_get_eeprom,
2453         .get_ringparam          = ixgbe_get_ringparam,
2454         .set_ringparam          = ixgbe_set_ringparam,
2455         .get_pauseparam         = ixgbe_get_pauseparam,
2456         .set_pauseparam         = ixgbe_set_pauseparam,
2457         .get_rx_csum            = ixgbe_get_rx_csum,
2458         .set_rx_csum            = ixgbe_set_rx_csum,
2459         .get_tx_csum            = ixgbe_get_tx_csum,
2460         .set_tx_csum            = ixgbe_set_tx_csum,
2461         .get_sg                 = ethtool_op_get_sg,
2462         .set_sg                 = ethtool_op_set_sg,
2463         .get_msglevel           = ixgbe_get_msglevel,
2464         .set_msglevel           = ixgbe_set_msglevel,
2465         .get_tso                = ethtool_op_get_tso,
2466         .set_tso                = ixgbe_set_tso,
2467         .self_test              = ixgbe_diag_test,
2468         .get_strings            = ixgbe_get_strings,
2469         .phys_id                = ixgbe_phys_id,
2470         .get_sset_count         = ixgbe_get_sset_count,
2471         .get_ethtool_stats      = ixgbe_get_ethtool_stats,
2472         .get_coalesce           = ixgbe_get_coalesce,
2473         .set_coalesce           = ixgbe_set_coalesce,
2474         .get_flags              = ethtool_op_get_flags,
2475         .set_flags              = ixgbe_set_flags,
2476         .set_rx_ntuple          = ixgbe_set_rx_ntuple,
2477 };
2478
2479 void ixgbe_set_ethtool_ops(struct net_device *netdev)
2480 {
2481         SET_ETHTOOL_OPS(netdev, &ixgbe_ethtool_ops);
2482 }