99071c25376639ed59398f9f089e07a16749f9d5
[pandora-kernel.git] / drivers / net / netxen / netxen_nic_ethtool.c
1 /*
2  * Copyright (C) 2003 - 2006 NetXen, Inc.
3  * All rights reserved.
4  *
5  * This program is free software; you can redistribute it and/or
6  * modify it under the terms of the GNU General Public License
7  * as published by the Free Software Foundation; either version 2
8  * of the License, or (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be useful, but
11  * WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License
16  * along with this program; if not, write to the Free Software
17  * Foundation, Inc., 59 Temple Place - Suite 330, Boston,
18  * MA  02111-1307, USA.
19  *
20  * The full GNU General Public License is included in this distribution
21  * in the file called LICENSE.
22  *
23  * Contact Information:
24  *    info@netxen.com
25  * NetXen,
26  * 3965 Freedom Circle, Fourth floor,
27  * Santa Clara, CA 95054
28  *
29  *
30  * ethtool support for netxen nic
31  *
32  */
33
34 #include <linux/types.h>
35 #include <linux/delay.h>
36 #include <asm/uaccess.h>
37 #include <linux/pci.h>
38 #include <asm/io.h>
39 #include <linux/netdevice.h>
40 #include <linux/ethtool.h>
41 #include <linux/version.h>
42
43 #include "netxen_nic.h"
44 #include "netxen_nic_hw.h"
45 #include "netxen_nic_phan_reg.h"
46
47 struct netxen_nic_stats {
48         char stat_string[ETH_GSTRING_LEN];
49         int sizeof_stat;
50         int stat_offset;
51 };
52
53 #define NETXEN_NIC_STAT(m) sizeof(((struct netxen_adapter *)0)->m), \
54                         offsetof(struct netxen_adapter, m)
55
56 #define NETXEN_NIC_PORT_WINDOW 0x10000
57 #define NETXEN_NIC_INVALID_DATA 0xDEADBEEF
58
59 static const struct netxen_nic_stats netxen_nic_gstrings_stats[] = {
60         {"rcvd_bad_skb", NETXEN_NIC_STAT(stats.rcvdbadskb)},
61         {"xmit_called", NETXEN_NIC_STAT(stats.xmitcalled)},
62         {"xmited_frames", NETXEN_NIC_STAT(stats.xmitedframes)},
63         {"xmit_finished", NETXEN_NIC_STAT(stats.xmitfinished)},
64         {"bad_skb_len", NETXEN_NIC_STAT(stats.badskblen)},
65         {"no_cmd_desc", NETXEN_NIC_STAT(stats.nocmddescriptor)},
66         {"polled", NETXEN_NIC_STAT(stats.polled)},
67         {"tx_dropped", NETXEN_NIC_STAT(stats.txdropped)},
68         {"csummed", NETXEN_NIC_STAT(stats.csummed)},
69         {"no_rcv", NETXEN_NIC_STAT(stats.no_rcv)},
70         {"rx_bytes", NETXEN_NIC_STAT(stats.rxbytes)},
71         {"tx_bytes", NETXEN_NIC_STAT(stats.txbytes)},
72 };
73
74 #define NETXEN_NIC_STATS_LEN    ARRAY_SIZE(netxen_nic_gstrings_stats)
75
76 static const char netxen_nic_gstrings_test[][ETH_GSTRING_LEN] = {
77         "Register_Test_on_offline",
78         "Link_Test_on_offline"
79 };
80
81 #define NETXEN_NIC_TEST_LEN     ARRAY_SIZE(netxen_nic_gstrings_test)
82
83 #define NETXEN_NIC_REGS_COUNT 42
84 #define NETXEN_NIC_REGS_LEN (NETXEN_NIC_REGS_COUNT * sizeof(__le32))
85 #define NETXEN_MAX_EEPROM_LEN   1024
86
87 static int netxen_nic_get_eeprom_len(struct net_device *dev)
88 {
89         return NETXEN_FLASH_TOTAL_SIZE;
90 }
91
92 static void
93 netxen_nic_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *drvinfo)
94 {
95         struct netxen_adapter *adapter = netdev_priv(dev);
96         u32 fw_major = 0;
97         u32 fw_minor = 0;
98         u32 fw_build = 0;
99
100         strncpy(drvinfo->driver, netxen_nic_driver_name, 32);
101         strncpy(drvinfo->version, NETXEN_NIC_LINUX_VERSIONID, 32);
102         fw_major = readl(NETXEN_CRB_NORMALIZE(adapter,
103                                               NETXEN_FW_VERSION_MAJOR));
104         fw_minor = readl(NETXEN_CRB_NORMALIZE(adapter,
105                                               NETXEN_FW_VERSION_MINOR));
106         fw_build = readl(NETXEN_CRB_NORMALIZE(adapter, NETXEN_FW_VERSION_SUB));
107         sprintf(drvinfo->fw_version, "%d.%d.%d", fw_major, fw_minor, fw_build);
108
109         strncpy(drvinfo->bus_info, pci_name(adapter->pdev), 32);
110         drvinfo->regdump_len = NETXEN_NIC_REGS_LEN;
111         drvinfo->eedump_len = netxen_nic_get_eeprom_len(dev);
112 }
113
114 static int
115 netxen_nic_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
116 {
117         struct netxen_adapter *adapter = netdev_priv(dev);
118         struct netxen_board_info *boardinfo = &adapter->ahw.boardcfg;
119
120         /* read which mode */
121         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
122                 ecmd->supported = (SUPPORTED_10baseT_Half |
123                                    SUPPORTED_10baseT_Full |
124                                    SUPPORTED_100baseT_Half |
125                                    SUPPORTED_100baseT_Full |
126                                    SUPPORTED_1000baseT_Half |
127                                    SUPPORTED_1000baseT_Full);
128
129                 ecmd->advertising = (ADVERTISED_100baseT_Half |
130                                      ADVERTISED_100baseT_Full |
131                                      ADVERTISED_1000baseT_Half |
132                                      ADVERTISED_1000baseT_Full);
133
134                 ecmd->port = PORT_TP;
135
136                 if (netif_running(dev)) {
137                         ecmd->speed = adapter->link_speed;
138                         ecmd->duplex = adapter->link_duplex;
139                 } else
140                         return -EIO;    /* link absent */
141         } else if (adapter->ahw.board_type == NETXEN_NIC_XGBE) {
142                 ecmd->supported = (SUPPORTED_TP |
143                                    SUPPORTED_1000baseT_Full |
144                                    SUPPORTED_10000baseT_Full);
145                 ecmd->advertising = (ADVERTISED_TP |
146                                      ADVERTISED_1000baseT_Full |
147                                      ADVERTISED_10000baseT_Full);
148                 ecmd->port = PORT_TP;
149
150                 ecmd->speed = SPEED_10000;
151                 ecmd->duplex = DUPLEX_FULL;
152                 ecmd->autoneg = AUTONEG_DISABLE;
153         } else
154                 return -EIO;
155
156         ecmd->phy_address = adapter->portnum;
157         ecmd->transceiver = XCVR_EXTERNAL;
158
159         switch ((netxen_brdtype_t) boardinfo->board_type) {
160         case NETXEN_BRDTYPE_P2_SB35_4G:
161         case NETXEN_BRDTYPE_P2_SB31_2G:
162                 ecmd->supported |= SUPPORTED_Autoneg;
163                 ecmd->advertising |= ADVERTISED_Autoneg;
164         case NETXEN_BRDTYPE_P2_SB31_10G_CX4:
165                 ecmd->supported |= SUPPORTED_TP;
166                 ecmd->advertising |= ADVERTISED_TP;
167                 ecmd->port = PORT_TP;
168                 ecmd->autoneg = (boardinfo->board_type ==
169                                  NETXEN_BRDTYPE_P2_SB31_10G_CX4) ?
170                     (AUTONEG_DISABLE) : (adapter->link_autoneg);
171                 break;
172         case NETXEN_BRDTYPE_P2_SB31_10G_HMEZ:
173         case NETXEN_BRDTYPE_P2_SB31_10G_IMEZ:
174                 ecmd->supported |= SUPPORTED_MII;
175                 ecmd->advertising |= ADVERTISED_MII;
176                 ecmd->port = PORT_FIBRE;
177                 ecmd->autoneg = AUTONEG_DISABLE;
178                 break;
179         case NETXEN_BRDTYPE_P2_SB31_10G:
180                 ecmd->supported |= SUPPORTED_FIBRE;
181                 ecmd->advertising |= ADVERTISED_FIBRE;
182                 ecmd->port = PORT_FIBRE;
183                 ecmd->autoneg = AUTONEG_DISABLE;
184                 break;
185         default:
186                 printk(KERN_ERR "netxen-nic: Unsupported board model %d\n",
187                        (netxen_brdtype_t) boardinfo->board_type);
188                 return -EIO;
189         }
190
191         return 0;
192 }
193
194 static int
195 netxen_nic_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
196 {
197         struct netxen_adapter *adapter = netdev_priv(dev);
198         __u32 status;
199
200         /* read which mode */
201         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
202                 /* autonegotiation */
203                 if (adapter->phy_write
204                     && adapter->phy_write(adapter,
205                                           NETXEN_NIU_GB_MII_MGMT_ADDR_AUTONEG,
206                                           ecmd->autoneg) != 0)
207                         return -EIO;
208                 else
209                         adapter->link_autoneg = ecmd->autoneg;
210
211                 if (adapter->phy_read
212                     && adapter->phy_read(adapter,
213                                          NETXEN_NIU_GB_MII_MGMT_ADDR_PHY_STATUS,
214                                          &status) != 0)
215                         return -EIO;
216
217                 /* speed */
218                 switch (ecmd->speed) {
219                 case SPEED_10:
220                         netxen_set_phy_speed(status, 0);
221                         break;
222                 case SPEED_100:
223                         netxen_set_phy_speed(status, 1);
224                         break;
225                 case SPEED_1000:
226                         netxen_set_phy_speed(status, 2);
227                         break;
228                 }
229                 /* set duplex mode */
230                 if (ecmd->duplex == DUPLEX_HALF)
231                         netxen_clear_phy_duplex(status);
232                 if (ecmd->duplex == DUPLEX_FULL)
233                         netxen_set_phy_duplex(status);
234                 if (adapter->phy_write
235                     && adapter->phy_write(adapter,
236                                           NETXEN_NIU_GB_MII_MGMT_ADDR_PHY_STATUS,
237                                           *((int *)&status)) != 0)
238                         return -EIO;
239                 else {
240                         adapter->link_speed = ecmd->speed;
241                         adapter->link_duplex = ecmd->duplex;
242                 }
243         } else
244                 return -EOPNOTSUPP;
245
246         if (netif_running(dev)) {
247                 dev->stop(dev);
248                 dev->open(dev);
249         }
250         return 0;
251 }
252
253 static int netxen_nic_get_regs_len(struct net_device *dev)
254 {
255         return NETXEN_NIC_REGS_LEN;
256 }
257
258 struct netxen_niu_regs {
259         __u32 reg[NETXEN_NIC_REGS_COUNT];
260 };
261
262 static struct netxen_niu_regs niu_registers[] = {
263         {
264          /* GB Mode */
265          {
266           NETXEN_NIU_GB_SERDES_RESET,
267           NETXEN_NIU_GB0_MII_MODE,
268           NETXEN_NIU_GB1_MII_MODE,
269           NETXEN_NIU_GB2_MII_MODE,
270           NETXEN_NIU_GB3_MII_MODE,
271           NETXEN_NIU_GB0_GMII_MODE,
272           NETXEN_NIU_GB1_GMII_MODE,
273           NETXEN_NIU_GB2_GMII_MODE,
274           NETXEN_NIU_GB3_GMII_MODE,
275           NETXEN_NIU_REMOTE_LOOPBACK,
276           NETXEN_NIU_GB0_HALF_DUPLEX,
277           NETXEN_NIU_GB1_HALF_DUPLEX,
278           NETXEN_NIU_RESET_SYS_FIFOS,
279           NETXEN_NIU_GB_CRC_DROP,
280           NETXEN_NIU_GB_DROP_WRONGADDR,
281           NETXEN_NIU_TEST_MUX_CTL,
282
283           NETXEN_NIU_GB_MAC_CONFIG_0(0),
284           NETXEN_NIU_GB_MAC_CONFIG_1(0),
285           NETXEN_NIU_GB_HALF_DUPLEX_CTRL(0),
286           NETXEN_NIU_GB_MAX_FRAME_SIZE(0),
287           NETXEN_NIU_GB_TEST_REG(0),
288           NETXEN_NIU_GB_MII_MGMT_CONFIG(0),
289           NETXEN_NIU_GB_MII_MGMT_COMMAND(0),
290           NETXEN_NIU_GB_MII_MGMT_ADDR(0),
291           NETXEN_NIU_GB_MII_MGMT_CTRL(0),
292           NETXEN_NIU_GB_MII_MGMT_STATUS(0),
293           NETXEN_NIU_GB_MII_MGMT_INDICATE(0),
294           NETXEN_NIU_GB_INTERFACE_CTRL(0),
295           NETXEN_NIU_GB_INTERFACE_STATUS(0),
296           NETXEN_NIU_GB_STATION_ADDR_0(0),
297           NETXEN_NIU_GB_STATION_ADDR_1(0),
298           -1,
299           }
300          },
301         {
302          /* XG Mode */
303          {
304           NETXEN_NIU_XG_SINGLE_TERM,
305           NETXEN_NIU_XG_DRIVE_HI,
306           NETXEN_NIU_XG_DRIVE_LO,
307           NETXEN_NIU_XG_DTX,
308           NETXEN_NIU_XG_DEQ,
309           NETXEN_NIU_XG_WORD_ALIGN,
310           NETXEN_NIU_XG_RESET,
311           NETXEN_NIU_XG_POWER_DOWN,
312           NETXEN_NIU_XG_RESET_PLL,
313           NETXEN_NIU_XG_SERDES_LOOPBACK,
314           NETXEN_NIU_XG_DO_BYTE_ALIGN,
315           NETXEN_NIU_XG_TX_ENABLE,
316           NETXEN_NIU_XG_RX_ENABLE,
317           NETXEN_NIU_XG_STATUS,
318           NETXEN_NIU_XG_PAUSE_THRESHOLD,
319           NETXEN_NIU_XGE_CONFIG_0,
320           NETXEN_NIU_XGE_CONFIG_1,
321           NETXEN_NIU_XGE_IPG,
322           NETXEN_NIU_XGE_STATION_ADDR_0_HI,
323           NETXEN_NIU_XGE_STATION_ADDR_0_1,
324           NETXEN_NIU_XGE_STATION_ADDR_1_LO,
325           NETXEN_NIU_XGE_STATUS,
326           NETXEN_NIU_XGE_MAX_FRAME_SIZE,
327           NETXEN_NIU_XGE_PAUSE_FRAME_VALUE,
328           NETXEN_NIU_XGE_TX_BYTE_CNT,
329           NETXEN_NIU_XGE_TX_FRAME_CNT,
330           NETXEN_NIU_XGE_RX_BYTE_CNT,
331           NETXEN_NIU_XGE_RX_FRAME_CNT,
332           NETXEN_NIU_XGE_AGGR_ERROR_CNT,
333           NETXEN_NIU_XGE_MULTICAST_FRAME_CNT,
334           NETXEN_NIU_XGE_UNICAST_FRAME_CNT,
335           NETXEN_NIU_XGE_CRC_ERROR_CNT,
336           NETXEN_NIU_XGE_OVERSIZE_FRAME_ERR,
337           NETXEN_NIU_XGE_UNDERSIZE_FRAME_ERR,
338           NETXEN_NIU_XGE_LOCAL_ERROR_CNT,
339           NETXEN_NIU_XGE_REMOTE_ERROR_CNT,
340           NETXEN_NIU_XGE_CONTROL_CHAR_CNT,
341           NETXEN_NIU_XGE_PAUSE_FRAME_CNT,
342           -1,
343           }
344          }
345 };
346
347 static void
348 netxen_nic_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *p)
349 {
350         struct netxen_adapter *adapter = netdev_priv(dev);
351         __u32 mode, *regs_buff = p;
352         void __iomem *addr;
353         int i, window;
354
355         memset(p, 0, NETXEN_NIC_REGS_LEN);
356         regs->version = (1 << 24) | (adapter->ahw.revision_id << 16) |
357             (adapter->pdev)->device;
358         /* which mode */
359         NETXEN_NIC_LOCKED_READ_REG(NETXEN_NIU_MODE, &regs_buff[0]);
360         mode = regs_buff[0];
361
362         /* Common registers to all the modes */
363         NETXEN_NIC_LOCKED_READ_REG(NETXEN_NIU_STRAP_VALUE_SAVE_HIGHER,
364                                    &regs_buff[2]);
365         /* GB/XGB Mode */
366         mode = (mode / 2) - 1;
367         window = 0;
368         if (mode <= 1) {
369                 for (i = 3; niu_registers[mode].reg[i - 3] != -1; i++) {
370                         /* GB: port specific registers */
371                         if (mode == 0 && i >= 19)
372                                 window = adapter->physical_port *
373                                         NETXEN_NIC_PORT_WINDOW;
374
375                         NETXEN_NIC_LOCKED_READ_REG(niu_registers[mode].
376                                                    reg[i - 3] + window,
377                                                    &regs_buff[i]);
378                 }
379
380         }
381 }
382
383 static u32 netxen_nic_test_link(struct net_device *dev)
384 {
385         struct netxen_adapter *adapter = netdev_priv(dev);
386         __u32 status;
387         int val;
388
389         /* read which mode */
390         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
391                 if (adapter->phy_read
392                     && adapter->phy_read(adapter,
393                                          NETXEN_NIU_GB_MII_MGMT_ADDR_PHY_STATUS,
394                                          &status) != 0)
395                         return -EIO;
396                 else {
397                         val = netxen_get_phy_link(status);
398                         return !val;
399                 }
400         } else if (adapter->ahw.board_type == NETXEN_NIC_XGBE) {
401                 val = readl(NETXEN_CRB_NORMALIZE(adapter, CRB_XG_STATE));
402                 return (val == XG_LINK_UP) ? 0 : 1;
403         }
404         return -EIO;
405 }
406
407 static int
408 netxen_nic_get_eeprom(struct net_device *dev, struct ethtool_eeprom *eeprom,
409                       u8 * bytes)
410 {
411         struct netxen_adapter *adapter = netdev_priv(dev);
412         int offset;
413         int ret;
414
415         if (eeprom->len == 0)
416                 return -EINVAL;
417
418         eeprom->magic = (adapter->pdev)->vendor |
419                         ((adapter->pdev)->device << 16);
420         offset = eeprom->offset;
421
422         ret = netxen_rom_fast_read_words(adapter, offset, bytes,
423                                                 eeprom->len);
424         if (ret < 0)
425                 return ret;
426
427         return 0;
428 }
429
430 #if 0
431 static int
432 netxen_nic_set_eeprom(struct net_device *dev, struct ethtool_eeprom *eeprom,
433                         u8 * bytes)
434 {
435         struct netxen_adapter *adapter = netdev_priv(dev);
436         int offset = eeprom->offset;
437         static int flash_start;
438         static int ready_to_flash;
439         int ret;
440
441         if (flash_start == 0) {
442                 netxen_halt_pegs(adapter);
443                 ret = netxen_flash_unlock(adapter);
444                 if (ret < 0) {
445                         printk(KERN_ERR "%s: Flash unlock failed.\n",
446                                 netxen_nic_driver_name);
447                         return ret;
448                 }
449                 printk(KERN_INFO "%s: flash unlocked. \n",
450                         netxen_nic_driver_name);
451                 ret = netxen_flash_erase_secondary(adapter);
452                 if (ret != FLASH_SUCCESS) {
453                         printk(KERN_ERR "%s: Flash erase failed.\n",
454                                 netxen_nic_driver_name);
455                         return ret;
456                 }
457                 printk(KERN_INFO "%s: secondary flash erased successfully.\n",
458                         netxen_nic_driver_name);
459                 flash_start = 1;
460                 return 0;
461         }
462
463         if (offset == NETXEN_BOOTLD_START) {
464                 ret = netxen_flash_erase_primary(adapter);
465                 if (ret != FLASH_SUCCESS) {
466                         printk(KERN_ERR "%s: Flash erase failed.\n",
467                                 netxen_nic_driver_name);
468                         return ret;
469                 }
470
471                 ret = netxen_rom_se(adapter, NETXEN_USER_START);
472                 if (ret != FLASH_SUCCESS)
473                         return ret;
474                 ret = netxen_rom_se(adapter, NETXEN_FIXED_START);
475                 if (ret != FLASH_SUCCESS)
476                         return ret;
477
478                 printk(KERN_INFO "%s: primary flash erased successfully\n",
479                         netxen_nic_driver_name);
480
481                 ret = netxen_backup_crbinit(adapter);
482                 if (ret != FLASH_SUCCESS) {
483                         printk(KERN_ERR "%s: CRBinit backup failed.\n",
484                                 netxen_nic_driver_name);
485                         return ret;
486                 }
487                 printk(KERN_INFO "%s: CRBinit backup done.\n",
488                         netxen_nic_driver_name);
489                 ready_to_flash = 1;
490         }
491
492         if (!ready_to_flash) {
493                 printk(KERN_ERR "%s: Invalid write sequence, returning...\n",
494                         netxen_nic_driver_name);
495                 return -EINVAL;
496         }
497
498         return netxen_rom_fast_write_words(adapter, offset, bytes, eeprom->len);
499 }
500 #endif /* 0 */
501
502 static void
503 netxen_nic_get_ringparam(struct net_device *dev, struct ethtool_ringparam *ring)
504 {
505         struct netxen_adapter *adapter = netdev_priv(dev);
506         int i;
507
508         ring->rx_pending = 0;
509         ring->rx_jumbo_pending = 0;
510         for (i = 0; i < MAX_RCV_CTX; ++i) {
511                 ring->rx_pending += adapter->recv_ctx[i].
512                     rcv_desc[RCV_DESC_NORMAL_CTXID].max_rx_desc_count;
513                 ring->rx_jumbo_pending += adapter->recv_ctx[i].
514                     rcv_desc[RCV_DESC_JUMBO_CTXID].max_rx_desc_count;
515         }
516         ring->tx_pending = adapter->max_tx_desc_count;
517
518         ring->rx_max_pending = MAX_RCV_DESCRIPTORS;
519         ring->tx_max_pending = MAX_CMD_DESCRIPTORS_HOST;
520         ring->rx_jumbo_max_pending = MAX_JUMBO_RCV_DESCRIPTORS;
521         ring->rx_mini_max_pending = 0;
522         ring->rx_mini_pending = 0;
523 }
524
525 static void
526 netxen_nic_get_pauseparam(struct net_device *dev,
527                           struct ethtool_pauseparam *pause)
528 {
529         struct netxen_adapter *adapter = netdev_priv(dev);
530         __u32 val;
531         int port = adapter->physical_port;
532
533         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
534                 if ((port < 0) || (port > NETXEN_NIU_MAX_GBE_PORTS))
535                         return;
536                 /* get flow control settings */
537                 netxen_nic_read_w0(adapter,NETXEN_NIU_GB_MAC_CONFIG_0(port),
538                                 &val);
539                 pause->rx_pause = netxen_gb_get_rx_flowctl(val);
540                 netxen_nic_read_w0(adapter, NETXEN_NIU_GB_PAUSE_CTL, &val);
541                 switch (port) {
542                         case 0:
543                                 pause->tx_pause = !(netxen_gb_get_gb0_mask(val));
544                                 break;
545                         case 1:
546                                 pause->tx_pause = !(netxen_gb_get_gb1_mask(val));
547                                 break;
548                         case 2:
549                                 pause->tx_pause = !(netxen_gb_get_gb2_mask(val));
550                                 break;
551                         case 3:
552                         default:
553                                 pause->tx_pause = !(netxen_gb_get_gb3_mask(val));
554                                 break;
555                 }
556         } else if (adapter->ahw.board_type == NETXEN_NIC_XGBE) {
557                 if ((port < 0) || (port > NETXEN_NIU_MAX_XG_PORTS))
558                         return;
559                 pause->rx_pause = 1;
560                 netxen_nic_read_w0(adapter, NETXEN_NIU_XG_PAUSE_CTL, &val);
561                 if (port == 0)
562                         pause->tx_pause = !(netxen_xg_get_xg0_mask(val));
563                 else
564                         pause->tx_pause = !(netxen_xg_get_xg1_mask(val));
565         } else {
566                 printk(KERN_ERR"%s: Unknown board type: %x\n",
567                                 netxen_nic_driver_name, adapter->ahw.board_type);
568         }
569 }
570
571 static int
572 netxen_nic_set_pauseparam(struct net_device *dev,
573                           struct ethtool_pauseparam *pause)
574 {
575         struct netxen_adapter *adapter = netdev_priv(dev);
576         __u32 val;
577         int port = adapter->physical_port;
578         /* read mode */
579         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
580                 if ((port < 0) || (port > NETXEN_NIU_MAX_GBE_PORTS))
581                         return -EIO;
582                 /* set flow control */
583                 netxen_nic_read_w0(adapter,
584                                         NETXEN_NIU_GB_MAC_CONFIG_0(port), &val);
585
586                 if (pause->rx_pause)
587                         netxen_gb_rx_flowctl(val);
588                 else
589                         netxen_gb_unset_rx_flowctl(val);
590
591                 netxen_nic_write_w0(adapter, NETXEN_NIU_GB_MAC_CONFIG_0(port),
592                                 val);
593                 /* set autoneg */
594                 netxen_nic_read_w0(adapter, NETXEN_NIU_GB_PAUSE_CTL, &val);
595                 switch (port) {
596                         case 0:
597                                 if (pause->tx_pause)
598                                         netxen_gb_unset_gb0_mask(val);
599                                 else
600                                         netxen_gb_set_gb0_mask(val);
601                                 break;
602                         case 1:
603                                 if (pause->tx_pause)
604                                         netxen_gb_unset_gb1_mask(val);
605                                 else
606                                         netxen_gb_set_gb1_mask(val);
607                                 break;
608                         case 2:
609                                 if (pause->tx_pause)
610                                         netxen_gb_unset_gb2_mask(val);
611                                 else
612                                         netxen_gb_set_gb2_mask(val);
613                                 break;
614                         case 3:
615                         default:
616                                 if (pause->tx_pause)
617                                         netxen_gb_unset_gb3_mask(val);
618                                 else
619                                         netxen_gb_set_gb3_mask(val);
620                                 break;
621                 }
622                 netxen_nic_write_w0(adapter, NETXEN_NIU_GB_PAUSE_CTL, val);
623         } else if (adapter->ahw.board_type == NETXEN_NIC_XGBE) {
624                 if ((port < 0) || (port > NETXEN_NIU_MAX_XG_PORTS))
625                         return -EIO;
626                 netxen_nic_read_w0(adapter, NETXEN_NIU_XG_PAUSE_CTL, &val);
627                 if (port == 0) {
628                         if (pause->tx_pause)
629                                 netxen_xg_unset_xg0_mask(val);
630                         else
631                                 netxen_xg_set_xg0_mask(val);
632                 } else {
633                         if (pause->tx_pause)
634                                 netxen_xg_unset_xg1_mask(val);
635                         else
636                                 netxen_xg_set_xg1_mask(val);
637                 }
638                 netxen_nic_write_w0(adapter, NETXEN_NIU_XG_PAUSE_CTL, val);
639         } else {
640                 printk(KERN_ERR "%s: Unknown board type: %x\n",
641                                 netxen_nic_driver_name,
642                                 adapter->ahw.board_type);
643         }
644         return 0;
645 }
646
647 static int netxen_nic_reg_test(struct net_device *dev)
648 {
649         struct netxen_adapter *adapter = netdev_priv(dev);
650         u32 data_read, data_written;
651
652         netxen_nic_read_w0(adapter, NETXEN_PCIX_PH_REG(0), &data_read);
653         if ((data_read & 0xffff) != PHAN_VENDOR_ID)
654         return 1;
655
656         data_written = (u32)0xa5a5a5a5;
657
658         netxen_nic_reg_write(adapter, CRB_SCRATCHPAD_TEST, data_written);
659         data_read = readl(NETXEN_CRB_NORMALIZE(adapter, CRB_SCRATCHPAD_TEST));
660         if (data_written != data_read)
661                 return 1;
662
663         return 0;
664 }
665
666 static int netxen_get_sset_count(struct net_device *dev, int sset)
667 {
668         switch (sset) {
669         case ETH_SS_TEST:
670                 return NETXEN_NIC_TEST_LEN;
671         case ETH_SS_STATS:
672                 return NETXEN_NIC_STATS_LEN;
673         default:
674                 return -EOPNOTSUPP;
675         }
676 }
677
678 static void
679 netxen_nic_diag_test(struct net_device *dev, struct ethtool_test *eth_test,
680                      u64 * data)
681 {
682         memset(data, 0, sizeof(uint64_t) * NETXEN_NIC_TEST_LEN);
683         if ((data[0] = netxen_nic_reg_test(dev)))
684                 eth_test->flags |= ETH_TEST_FL_FAILED;
685         /* link test */
686         if ((data[1] = (u64) netxen_nic_test_link(dev)))
687                 eth_test->flags |= ETH_TEST_FL_FAILED;
688 }
689
690 static void
691 netxen_nic_get_strings(struct net_device *dev, u32 stringset, u8 * data)
692 {
693         int index;
694
695         switch (stringset) {
696         case ETH_SS_TEST:
697                 memcpy(data, *netxen_nic_gstrings_test,
698                        NETXEN_NIC_TEST_LEN * ETH_GSTRING_LEN);
699                 break;
700         case ETH_SS_STATS:
701                 for (index = 0; index < NETXEN_NIC_STATS_LEN; index++) {
702                         memcpy(data + index * ETH_GSTRING_LEN,
703                                netxen_nic_gstrings_stats[index].stat_string,
704                                ETH_GSTRING_LEN);
705                 }
706                 break;
707         }
708 }
709
710 static void
711 netxen_nic_get_ethtool_stats(struct net_device *dev,
712                              struct ethtool_stats *stats, u64 * data)
713 {
714         struct netxen_adapter *adapter = netdev_priv(dev);
715         int index;
716
717         for (index = 0; index < NETXEN_NIC_STATS_LEN; index++) {
718                 char *p =
719                     (char *)adapter +
720                     netxen_nic_gstrings_stats[index].stat_offset;
721                 data[index] =
722                     (netxen_nic_gstrings_stats[index].sizeof_stat ==
723                      sizeof(u64)) ? *(u64 *) p : *(u32 *) p;
724         }
725 }
726
727 static u32 netxen_nic_get_rx_csum(struct net_device *dev)
728 {
729         struct netxen_adapter *adapter = netdev_priv(dev);
730         return adapter->rx_csum;
731 }
732
733 static int netxen_nic_set_rx_csum(struct net_device *dev, u32 data)
734 {
735         struct netxen_adapter *adapter = netdev_priv(dev);
736         adapter->rx_csum = !!data;
737         return 0;
738 }
739
740 struct ethtool_ops netxen_nic_ethtool_ops = {
741         .get_settings = netxen_nic_get_settings,
742         .set_settings = netxen_nic_set_settings,
743         .get_drvinfo = netxen_nic_get_drvinfo,
744         .get_regs_len = netxen_nic_get_regs_len,
745         .get_regs = netxen_nic_get_regs,
746         .get_link = ethtool_op_get_link,
747         .get_eeprom_len = netxen_nic_get_eeprom_len,
748         .get_eeprom = netxen_nic_get_eeprom,
749 #if 0
750         .set_eeprom = netxen_nic_set_eeprom,
751 #endif
752         .get_ringparam = netxen_nic_get_ringparam,
753         .get_pauseparam = netxen_nic_get_pauseparam,
754         .set_pauseparam = netxen_nic_set_pauseparam,
755         .set_tx_csum = ethtool_op_set_tx_csum,
756         .set_sg = ethtool_op_set_sg,
757         .set_tso = ethtool_op_set_tso,
758         .self_test = netxen_nic_diag_test,
759         .get_strings = netxen_nic_get_strings,
760         .get_ethtool_stats = netxen_nic_get_ethtool_stats,
761         .get_sset_count = netxen_get_sset_count,
762         .get_rx_csum = netxen_nic_get_rx_csum,
763         .set_rx_csum = netxen_nic_set_rx_csum,
764 };