Merge git://git.kernel.org/pub/scm/linux/kernel/git/jejb/scsi-misc-2.6
[linux-2.6] / 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 static int
431 netxen_nic_set_eeprom(struct net_device *dev, struct ethtool_eeprom *eeprom,
432                         u8 * bytes)
433 {
434         struct netxen_adapter *adapter = netdev_priv(dev);
435         int offset = eeprom->offset;
436         static int flash_start;
437         static int ready_to_flash;
438         int ret;
439
440         if (flash_start == 0) {
441                 netxen_halt_pegs(adapter);
442                 ret = netxen_flash_unlock(adapter);
443                 if (ret < 0) {
444                         printk(KERN_ERR "%s: Flash unlock failed.\n",
445                                 netxen_nic_driver_name);
446                         return ret;
447                 }
448                 printk(KERN_INFO "%s: flash unlocked. \n",
449                         netxen_nic_driver_name);
450                 last_schedule_time = jiffies;
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
501 static void
502 netxen_nic_get_ringparam(struct net_device *dev, struct ethtool_ringparam *ring)
503 {
504         struct netxen_adapter *adapter = netdev_priv(dev);
505         int i;
506
507         ring->rx_pending = 0;
508         ring->rx_jumbo_pending = 0;
509         for (i = 0; i < MAX_RCV_CTX; ++i) {
510                 ring->rx_pending += adapter->recv_ctx[i].
511                     rcv_desc[RCV_DESC_NORMAL_CTXID].max_rx_desc_count;
512                 ring->rx_jumbo_pending += adapter->recv_ctx[i].
513                     rcv_desc[RCV_DESC_JUMBO_CTXID].max_rx_desc_count;
514         }
515         ring->tx_pending = adapter->max_tx_desc_count;
516
517         ring->rx_max_pending = MAX_RCV_DESCRIPTORS;
518         ring->tx_max_pending = MAX_CMD_DESCRIPTORS_HOST;
519         ring->rx_jumbo_max_pending = MAX_JUMBO_RCV_DESCRIPTORS;
520         ring->rx_mini_max_pending = 0;
521         ring->rx_mini_pending = 0;
522 }
523
524 static void
525 netxen_nic_get_pauseparam(struct net_device *dev,
526                           struct ethtool_pauseparam *pause)
527 {
528         struct netxen_adapter *adapter = netdev_priv(dev);
529         __u32 val;
530         int port = adapter->physical_port;
531
532         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
533                 if ((port < 0) || (port > NETXEN_NIU_MAX_GBE_PORTS))
534                         return;
535                 /* get flow control settings */
536                 netxen_nic_read_w0(adapter,NETXEN_NIU_GB_MAC_CONFIG_0(port),
537                                 &val);
538                 pause->rx_pause = netxen_gb_get_rx_flowctl(val);
539                 netxen_nic_read_w0(adapter, NETXEN_NIU_GB_PAUSE_CTL, &val);
540                 switch (port) {
541                         case 0:
542                                 pause->tx_pause = !(netxen_gb_get_gb0_mask(val));
543                                 break;
544                         case 1:
545                                 pause->tx_pause = !(netxen_gb_get_gb1_mask(val));
546                                 break;
547                         case 2:
548                                 pause->tx_pause = !(netxen_gb_get_gb2_mask(val));
549                                 break;
550                         case 3:
551                         default:
552                                 pause->tx_pause = !(netxen_gb_get_gb3_mask(val));
553                                 break;
554                 }
555         } else if (adapter->ahw.board_type == NETXEN_NIC_XGBE) {
556                 if ((port < 0) || (port > NETXEN_NIU_MAX_XG_PORTS))
557                         return;
558                 pause->rx_pause = 1;
559                 netxen_nic_read_w0(adapter, NETXEN_NIU_XG_PAUSE_CTL, &val);
560                 if (port == 0)
561                         pause->tx_pause = !(netxen_xg_get_xg0_mask(val));
562                 else
563                         pause->tx_pause = !(netxen_xg_get_xg1_mask(val));
564         } else {
565                 printk(KERN_ERR"%s: Unknown board type: %x\n",
566                                 netxen_nic_driver_name, adapter->ahw.board_type);
567         }
568 }
569
570 static int
571 netxen_nic_set_pauseparam(struct net_device *dev,
572                           struct ethtool_pauseparam *pause)
573 {
574         struct netxen_adapter *adapter = netdev_priv(dev);
575         __u32 val;
576         int port = adapter->physical_port;
577         /* read mode */
578         if (adapter->ahw.board_type == NETXEN_NIC_GBE) {
579                 if ((port < 0) || (port > NETXEN_NIU_MAX_GBE_PORTS))
580                         return -EIO;
581                 /* set flow control */
582                 netxen_nic_read_w0(adapter,
583                                         NETXEN_NIU_GB_MAC_CONFIG_0(port), &val);
584
585                 if (pause->rx_pause)
586                         netxen_gb_rx_flowctl(val);
587                 else
588                         netxen_gb_unset_rx_flowctl(val);
589
590                 netxen_nic_write_w0(adapter, NETXEN_NIU_GB_MAC_CONFIG_0(port),
591                                 val);
592                 /* set autoneg */
593                 netxen_nic_read_w0(adapter, NETXEN_NIU_GB_PAUSE_CTL, &val);
594                 switch (port) {
595                         case 0:
596                                 if (pause->tx_pause)
597                                         netxen_gb_unset_gb0_mask(val);
598                                 else
599                                         netxen_gb_set_gb0_mask(val);
600                                 break;
601                         case 1:
602                                 if (pause->tx_pause)
603                                         netxen_gb_unset_gb1_mask(val);
604                                 else
605                                         netxen_gb_set_gb1_mask(val);
606                                 break;
607                         case 2:
608                                 if (pause->tx_pause)
609                                         netxen_gb_unset_gb2_mask(val);
610                                 else
611                                         netxen_gb_set_gb2_mask(val);
612                                 break;
613                         case 3:
614                         default:
615                                 if (pause->tx_pause)
616                                         netxen_gb_unset_gb3_mask(val);
617                                 else
618                                         netxen_gb_set_gb3_mask(val);
619                                 break;
620                 }
621                 netxen_nic_write_w0(adapter, NETXEN_NIU_GB_PAUSE_CTL, val);
622         } else if (adapter->ahw.board_type == NETXEN_NIC_XGBE) {
623                 if ((port < 0) || (port > NETXEN_NIU_MAX_XG_PORTS))
624                         return -EIO;
625                 netxen_nic_read_w0(adapter, NETXEN_NIU_XG_PAUSE_CTL, &val);
626                 if (port == 0) {
627                         if (pause->tx_pause)
628                                 netxen_xg_unset_xg0_mask(val);
629                         else
630                                 netxen_xg_set_xg0_mask(val);
631                 } else {
632                         if (pause->tx_pause)
633                                 netxen_xg_unset_xg1_mask(val);
634                         else
635                                 netxen_xg_set_xg1_mask(val);
636                 }
637                 netxen_nic_write_w0(adapter, NETXEN_NIU_XG_PAUSE_CTL, val);
638         } else {
639                 printk(KERN_ERR "%s: Unknown board type: %x\n",
640                                 netxen_nic_driver_name,
641                                 adapter->ahw.board_type);
642         }
643         return 0;
644 }
645
646 static int netxen_nic_reg_test(struct net_device *dev)
647 {
648         struct netxen_adapter *adapter = netdev_priv(dev);
649         u32 data_read, data_written;
650
651         netxen_nic_read_w0(adapter, NETXEN_PCIX_PH_REG(0), &data_read);
652         if ((data_read & 0xffff) != PHAN_VENDOR_ID)
653         return 1;
654
655         data_written = (u32)0xa5a5a5a5;
656
657         netxen_nic_reg_write(adapter, CRB_SCRATCHPAD_TEST, data_written);
658         data_read = readl(NETXEN_CRB_NORMALIZE(adapter, CRB_SCRATCHPAD_TEST));
659         if (data_written != data_read)
660                 return 1;
661
662         return 0;
663 }
664
665 static int netxen_get_sset_count(struct net_device *dev, int sset)
666 {
667         switch (sset) {
668         case ETH_SS_TEST:
669                 return NETXEN_NIC_TEST_LEN;
670         case ETH_SS_STATS:
671                 return NETXEN_NIC_STATS_LEN;
672         default:
673                 return -EOPNOTSUPP;
674         }
675 }
676
677 static void
678 netxen_nic_diag_test(struct net_device *dev, struct ethtool_test *eth_test,
679                      u64 * data)
680 {
681         memset(data, 0, sizeof(uint64_t) * NETXEN_NIC_TEST_LEN);
682         if ((data[0] = netxen_nic_reg_test(dev)))
683                 eth_test->flags |= ETH_TEST_FL_FAILED;
684         /* link test */
685         if ((data[1] = (u64) netxen_nic_test_link(dev)))
686                 eth_test->flags |= ETH_TEST_FL_FAILED;
687 }
688
689 static void
690 netxen_nic_get_strings(struct net_device *dev, u32 stringset, u8 * data)
691 {
692         int index;
693
694         switch (stringset) {
695         case ETH_SS_TEST:
696                 memcpy(data, *netxen_nic_gstrings_test,
697                        NETXEN_NIC_TEST_LEN * ETH_GSTRING_LEN);
698                 break;
699         case ETH_SS_STATS:
700                 for (index = 0; index < NETXEN_NIC_STATS_LEN; index++) {
701                         memcpy(data + index * ETH_GSTRING_LEN,
702                                netxen_nic_gstrings_stats[index].stat_string,
703                                ETH_GSTRING_LEN);
704                 }
705                 break;
706         }
707 }
708
709 static void
710 netxen_nic_get_ethtool_stats(struct net_device *dev,
711                              struct ethtool_stats *stats, u64 * data)
712 {
713         struct netxen_adapter *adapter = netdev_priv(dev);
714         int index;
715
716         for (index = 0; index < NETXEN_NIC_STATS_LEN; index++) {
717                 char *p =
718                     (char *)adapter +
719                     netxen_nic_gstrings_stats[index].stat_offset;
720                 data[index] =
721                     (netxen_nic_gstrings_stats[index].sizeof_stat ==
722                      sizeof(u64)) ? *(u64 *) p : *(u32 *) p;
723         }
724 }
725
726 static u32 netxen_nic_get_rx_csum(struct net_device *dev)
727 {
728         struct netxen_adapter *adapter = netdev_priv(dev);
729         return adapter->rx_csum;
730 }
731
732 static int netxen_nic_set_rx_csum(struct net_device *dev, u32 data)
733 {
734         struct netxen_adapter *adapter = netdev_priv(dev);
735         adapter->rx_csum = !!data;
736         return 0;
737 }
738
739 struct ethtool_ops netxen_nic_ethtool_ops = {
740         .get_settings = netxen_nic_get_settings,
741         .set_settings = netxen_nic_set_settings,
742         .get_drvinfo = netxen_nic_get_drvinfo,
743         .get_regs_len = netxen_nic_get_regs_len,
744         .get_regs = netxen_nic_get_regs,
745         .get_link = ethtool_op_get_link,
746         .get_eeprom_len = netxen_nic_get_eeprom_len,
747         .get_eeprom = netxen_nic_get_eeprom,
748         .set_eeprom = netxen_nic_set_eeprom,
749         .get_ringparam = netxen_nic_get_ringparam,
750         .get_pauseparam = netxen_nic_get_pauseparam,
751         .set_pauseparam = netxen_nic_set_pauseparam,
752         .set_tx_csum = ethtool_op_set_tx_csum,
753         .set_sg = ethtool_op_set_sg,
754         .set_tso = ethtool_op_set_tso,
755         .self_test = netxen_nic_diag_test,
756         .get_strings = netxen_nic_get_strings,
757         .get_ethtool_stats = netxen_nic_get_ethtool_stats,
758         .get_sset_count = netxen_get_sset_count,
759         .get_rx_csum = netxen_nic_get_rx_csum,
760         .set_rx_csum = netxen_nic_set_rx_csum,
761 };