]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/net/qlcnic/qlcnic_ethtool.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge branch 'master' of master.kernel.org:/pub/scm/linux/kernel/git/davem/net-2.6
[net-next-2.6.git] / drivers / net / qlcnic / qlcnic_ethtool.c
CommitLineData
af19b491
AKS		 1/*
2 * Copyright (C) 2009 - QLogic Corporation.
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 "COPYING".
22 *
23 */
24
25#include <linux/types.h>
26#include <linux/delay.h>
27#include <linux/pci.h>
28#include <linux/io.h>
29#include <linux/netdevice.h>
30#include <linux/ethtool.h>
31
32#include "qlcnic.h"
33
34struct qlcnic_stats {
35 char stat_string[ETH_GSTRING_LEN];
36 int sizeof_stat;
37 int stat_offset;
38};
39
40#define QLC_SIZEOF(m) FIELD_SIZEOF(struct qlcnic_adapter, m)
41#define QLC_OFF(m) offsetof(struct qlcnic_adapter, m)
42
43static const struct qlcnic_stats qlcnic_gstrings_stats[] = {
44 {"xmit_called",
45 QLC_SIZEOF(stats.xmitcalled), QLC_OFF(stats.xmitcalled)},
46 {"xmit_finished",
47 QLC_SIZEOF(stats.xmitfinished), QLC_OFF(stats.xmitfinished)},
48 {"rx_dropped",
49 QLC_SIZEOF(stats.rxdropped), QLC_OFF(stats.rxdropped)},
50 {"tx_dropped",
51 QLC_SIZEOF(stats.txdropped), QLC_OFF(stats.txdropped)},
52 {"csummed",
53 QLC_SIZEOF(stats.csummed), QLC_OFF(stats.csummed)},
54 {"rx_pkts",
55 QLC_SIZEOF(stats.rx_pkts), QLC_OFF(stats.rx_pkts)},
56 {"lro_pkts",
57 QLC_SIZEOF(stats.lro_pkts), QLC_OFF(stats.lro_pkts)},
58 {"rx_bytes",
59 QLC_SIZEOF(stats.rxbytes), QLC_OFF(stats.rxbytes)},
60 {"tx_bytes",
61 QLC_SIZEOF(stats.txbytes), QLC_OFF(stats.txbytes)},
8bfe8b91
SC		 62 {"lrobytes",
63 QLC_SIZEOF(stats.lrobytes), QLC_OFF(stats.lrobytes)},
64 {"lso_frames",
65 QLC_SIZEOF(stats.lso_frames), QLC_OFF(stats.lso_frames)},
66 {"xmit_on",
67 QLC_SIZEOF(stats.xmit_on), QLC_OFF(stats.xmit_on)},
68 {"xmit_off",
69 QLC_SIZEOF(stats.xmit_off), QLC_OFF(stats.xmit_off)},
70 {"skb_alloc_failure", QLC_SIZEOF(stats.skb_alloc_failure),
71 QLC_OFF(stats.skb_alloc_failure)},
8ae6df97
AKS		 72 {"null rxbuf",
73 QLC_SIZEOF(stats.null_rxbuf), QLC_OFF(stats.null_rxbuf)},
74 {"rx dma map error", QLC_SIZEOF(stats.rx_dma_map_error),
75 QLC_OFF(stats.rx_dma_map_error)},
76 {"tx dma map error", QLC_SIZEOF(stats.tx_dma_map_error),
77 QLC_OFF(stats.tx_dma_map_error)},
8bfe8b91 78
af19b491
AKS		 79};
80
81#define QLCNIC_STATS_LEN ARRAY_SIZE(qlcnic_gstrings_stats)
82
83static const char qlcnic_gstrings_test[][ETH_GSTRING_LEN] = {
84 "Register_Test_on_offline",
7eb9855d 85 "Link_Test_on_offline",
cdaff185
AKS		 86 "Interrupt_Test_offline",
87 "Loopback_Test_offline"
af19b491
AKS		 88};
89
90#define QLCNIC_TEST_LEN ARRAY_SIZE(qlcnic_gstrings_test)
91
92#define QLCNIC_RING_REGS_COUNT 20
93#define QLCNIC_RING_REGS_LEN (QLCNIC_RING_REGS_COUNT * sizeof(u32))
94#define QLCNIC_MAX_EEPROM_LEN 1024
95
96static const u32 diag_registers[] = {
97 CRB_CMDPEG_STATE,
98 CRB_RCVPEG_STATE,
99 CRB_XG_STATE_P3,
100 CRB_FW_CAPABILITIES_1,
101 ISR_INT_STATE_REG,
31018e06 102 QLCNIC_CRB_DRV_ACTIVE,
af19b491
AKS		 103 QLCNIC_CRB_DEV_STATE,
104 QLCNIC_CRB_DRV_STATE,
105 QLCNIC_CRB_DRV_SCRATCH,
106 QLCNIC_CRB_DEV_PARTITION_INFO,
107 QLCNIC_CRB_DRV_IDC_VER,
108 QLCNIC_PEG_ALIVE_COUNTER,
109 QLCNIC_PEG_HALT_STATUS1,
110 QLCNIC_PEG_HALT_STATUS2,
111 QLCNIC_CRB_PEG_NET_0+0x3c,
112 QLCNIC_CRB_PEG_NET_1+0x3c,
113 QLCNIC_CRB_PEG_NET_2+0x3c,
114 QLCNIC_CRB_PEG_NET_4+0x3c,
115 -1
116};
117
2cffcdbf
RB		 118#define QLCNIC_MGMT_API_VERSION 2
119#define QLCNIC_DEV_INFO_SIZE 1
120#define QLCNIC_ETHTOOL_REGS_VER 2
af19b491
AKS		 121static int qlcnic_get_regs_len(struct net_device *dev)
122{
2cffcdbf
RB		 123 return sizeof(diag_registers) + QLCNIC_RING_REGS_LEN +
124 QLCNIC_DEV_INFO_SIZE + 1;
af19b491
AKS		 125}
126
127static int qlcnic_get_eeprom_len(struct net_device *dev)
128{
129 return QLCNIC_FLASH_TOTAL_SIZE;
130}
131
132static void
133qlcnic_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *drvinfo)
134{
135 struct qlcnic_adapter *adapter = netdev_priv(dev);
136 u32 fw_major, fw_minor, fw_build;
137
138 fw_major = QLCRD32(adapter, QLCNIC_FW_VERSION_MAJOR);
139 fw_minor = QLCRD32(adapter, QLCNIC_FW_VERSION_MINOR);
140 fw_build = QLCRD32(adapter, QLCNIC_FW_VERSION_SUB);
141 sprintf(drvinfo->fw_version, "%d.%d.%d", fw_major, fw_minor, fw_build);
142
143 strlcpy(drvinfo->bus_info, pci_name(adapter->pdev), 32);
144 strlcpy(drvinfo->driver, qlcnic_driver_name, 32);
145 strlcpy(drvinfo->version, QLCNIC_LINUX_VERSIONID, 32);
146}
147
148static int
149qlcnic_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
150{
151 struct qlcnic_adapter *adapter = netdev_priv(dev);
152 int check_sfp_module = 0;
153 u16 pcifn = adapter->ahw.pci_func;
154
155 /* read which mode */
156 if (adapter->ahw.port_type == QLCNIC_GBE) {
157 ecmd->supported = (SUPPORTED_10baseT_Half |
158 SUPPORTED_10baseT_Full |
159 SUPPORTED_100baseT_Half |
160 SUPPORTED_100baseT_Full |
161 SUPPORTED_1000baseT_Half |
162 SUPPORTED_1000baseT_Full);
163
164 ecmd->advertising = (ADVERTISED_100baseT_Half |
165 ADVERTISED_100baseT_Full |
166 ADVERTISED_1000baseT_Half |
167 ADVERTISED_1000baseT_Full);
168
169 ecmd->speed = adapter->link_speed;
170 ecmd->duplex = adapter->link_duplex;
171 ecmd->autoneg = adapter->link_autoneg;
172
173 } else if (adapter->ahw.port_type == QLCNIC_XGBE) {
174 u32 val;
175
176 val = QLCRD32(adapter, QLCNIC_PORT_MODE_ADDR);
177 if (val == QLCNIC_PORT_MODE_802_3_AP) {
178 ecmd->supported = SUPPORTED_1000baseT_Full;
179 ecmd->advertising = ADVERTISED_1000baseT_Full;
180 } else {
181 ecmd->supported = SUPPORTED_10000baseT_Full;
182 ecmd->advertising = ADVERTISED_10000baseT_Full;
183 }
184
185 if (netif_running(dev) && adapter->has_link_events) {
186 ecmd->speed = adapter->link_speed;
187 ecmd->autoneg = adapter->link_autoneg;
188 ecmd->duplex = adapter->link_duplex;
189 goto skip;
190 }
191
192 val = QLCRD32(adapter, P3_LINK_SPEED_REG(pcifn));
193 ecmd->speed = P3_LINK_SPEED_MHZ *
194 P3_LINK_SPEED_VAL(pcifn, val);
195 ecmd->duplex = DUPLEX_FULL;
196 ecmd->autoneg = AUTONEG_DISABLE;
197 } else
198 return -EIO;
199
200skip:
201 ecmd->phy_address = adapter->physical_port;
202 ecmd->transceiver = XCVR_EXTERNAL;
203
204 switch (adapter->ahw.board_type) {
205 case QLCNIC_BRDTYPE_P3_REF_QG:
206 case QLCNIC_BRDTYPE_P3_4_GB:
207 case QLCNIC_BRDTYPE_P3_4_GB_MM:
208
209 ecmd->supported |= SUPPORTED_Autoneg;
210 ecmd->advertising |= ADVERTISED_Autoneg;
211 case QLCNIC_BRDTYPE_P3_10G_CX4:
212 case QLCNIC_BRDTYPE_P3_10G_CX4_LP:
213 case QLCNIC_BRDTYPE_P3_10000_BASE_T:
214 ecmd->supported |= SUPPORTED_TP;
215 ecmd->advertising |= ADVERTISED_TP;
216 ecmd->port = PORT_TP;
217 ecmd->autoneg = adapter->link_autoneg;
218 break;
219 case QLCNIC_BRDTYPE_P3_IMEZ:
220 case QLCNIC_BRDTYPE_P3_XG_LOM:
221 case QLCNIC_BRDTYPE_P3_HMEZ:
222 ecmd->supported |= SUPPORTED_MII;
223 ecmd->advertising |= ADVERTISED_MII;
224 ecmd->port = PORT_MII;
225 ecmd->autoneg = AUTONEG_DISABLE;
226 break;
227 case QLCNIC_BRDTYPE_P3_10G_SFP_PLUS:
228 case QLCNIC_BRDTYPE_P3_10G_SFP_CT:
229 case QLCNIC_BRDTYPE_P3_10G_SFP_QT:
230 ecmd->advertising |= ADVERTISED_TP;
231 ecmd->supported |= SUPPORTED_TP;
232 check_sfp_module = netif_running(dev) &&
233 adapter->has_link_events;
234 case QLCNIC_BRDTYPE_P3_10G_XFP:
235 ecmd->supported |= SUPPORTED_FIBRE;
236 ecmd->advertising |= ADVERTISED_FIBRE;
237 ecmd->port = PORT_FIBRE;
238 ecmd->autoneg = AUTONEG_DISABLE;
239 break;
240 case QLCNIC_BRDTYPE_P3_10G_TP:
241 if (adapter->ahw.port_type == QLCNIC_XGBE) {
242 ecmd->autoneg = AUTONEG_DISABLE;
243 ecmd->supported |= (SUPPORTED_FIBRE | SUPPORTED_TP);
244 ecmd->advertising |=
245 (ADVERTISED_FIBRE | ADVERTISED_TP);
246 ecmd->port = PORT_FIBRE;
247 check_sfp_module = netif_running(dev) &&
248 adapter->has_link_events;
249 } else {
250 ecmd->autoneg = AUTONEG_ENABLE;
251 ecmd->supported |= (SUPPORTED_TP | SUPPORTED_Autoneg);
252 ecmd->advertising |=
253 (ADVERTISED_TP | ADVERTISED_Autoneg);
254 ecmd->port = PORT_TP;
255 }
256 break;
257 default:
258 dev_err(&adapter->pdev->dev, "Unsupported board model %d\n",
259 adapter->ahw.board_type);
260 return -EIO;
261 }
262
263 if (check_sfp_module) {
264 switch (adapter->module_type) {
265 case LINKEVENT_MODULE_OPTICAL_UNKNOWN:
266 case LINKEVENT_MODULE_OPTICAL_SRLR:
267 case LINKEVENT_MODULE_OPTICAL_LRM:
268 case LINKEVENT_MODULE_OPTICAL_SFP_1G:
269 ecmd->port = PORT_FIBRE;
270 break;
271 case LINKEVENT_MODULE_TWINAX_UNSUPPORTED_CABLE:
272 case LINKEVENT_MODULE_TWINAX_UNSUPPORTED_CABLELEN:
273 case LINKEVENT_MODULE_TWINAX:
274 ecmd->port = PORT_TP;
275 break;
276 default:
277 ecmd->port = PORT_OTHER;
278 }
279 }
280
281 return 0;
282}
283
284static int
285qlcnic_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
286{
287 struct qlcnic_adapter *adapter = netdev_priv(dev);
288 __u32 status;
289
290 /* read which mode */
291 if (adapter->ahw.port_type == QLCNIC_GBE) {
292 /* autonegotiation */
293 if (qlcnic_fw_cmd_set_phy(adapter,
294 QLCNIC_NIU_GB_MII_MGMT_ADDR_AUTONEG,
295 ecmd->autoneg) != 0)
296 return -EIO;
297 else
298 adapter->link_autoneg = ecmd->autoneg;
299
300 if (qlcnic_fw_cmd_query_phy(adapter,
301 QLCNIC_NIU_GB_MII_MGMT_ADDR_PHY_STATUS,
302 &status) != 0)
303 return -EIO;
304
305 switch (ecmd->speed) {
306 case SPEED_10:
307 qlcnic_set_phy_speed(status, 0);
308 break;
309 case SPEED_100:
310 qlcnic_set_phy_speed(status, 1);
311 break;
312 case SPEED_1000:
313 qlcnic_set_phy_speed(status, 2);
314 break;
315 }
316
317 if (ecmd->duplex == DUPLEX_HALF)
318 qlcnic_clear_phy_duplex(status);
319 if (ecmd->duplex == DUPLEX_FULL)
320 qlcnic_set_phy_duplex(status);
321 if (qlcnic_fw_cmd_set_phy(adapter,
322 QLCNIC_NIU_GB_MII_MGMT_ADDR_PHY_STATUS,
323 *((int *)&status)) != 0)
324 return -EIO;
325 else {
326 adapter->link_speed = ecmd->speed;
327 adapter->link_duplex = ecmd->duplex;
328 }
329 } else
330 return -EOPNOTSUPP;
331
332 if (!netif_running(dev))
333 return 0;
334
335 dev->netdev_ops->ndo_stop(dev);
336 return dev->netdev_ops->ndo_open(dev);
337}
338
339static void
340qlcnic_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *p)
341{
342 struct qlcnic_adapter *adapter = netdev_priv(dev);
343 struct qlcnic_recv_context *recv_ctx = &adapter->recv_ctx;
344 struct qlcnic_host_sds_ring *sds_ring;
345 u32 *regs_buff = p;
346 int ring, i = 0;
347
348 memset(p, 0, qlcnic_get_regs_len(dev));
2cffcdbf
RB		 349 regs->version = (QLCNIC_ETHTOOL_REGS_VER << 24) |
350 (adapter->ahw.revision_id << 16) | (adapter->pdev)->device;
af19b491 351
2cffcdbf
RB		 352 regs_buff[0] = (0xcafe0000 | (QLCNIC_DEV_INFO_SIZE & 0xffff));
353 regs_buff[1] = QLCNIC_MGMT_API_VERSION;
354
355 for (i = QLCNIC_DEV_INFO_SIZE + 1; diag_registers[i] != -1; i++)
af19b491
AKS		 356 regs_buff[i] = QLCRD32(adapter, diag_registers[i]);
357
8a15ad1f 358 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
ce668443
AKS		 359 return;
360
af19b491
AKS		 361 regs_buff[i++] = 0xFFEFCDAB; /* Marker btw regs and ring count*/
362
363 regs_buff[i++] = 1; /* No. of tx ring */
364 regs_buff[i++] = le32_to_cpu(*(adapter->tx_ring->hw_consumer));
365 regs_buff[i++] = readl(adapter->tx_ring->crb_cmd_producer);
366
367 regs_buff[i++] = 2; /* No. of rx ring */
368 regs_buff[i++] = readl(recv_ctx->rds_rings[0].crb_rcv_producer);
369 regs_buff[i++] = readl(recv_ctx->rds_rings[1].crb_rcv_producer);
370
371 regs_buff[i++] = adapter->max_sds_rings;
372
373 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
374 sds_ring = &(recv_ctx->sds_rings[ring]);
375 regs_buff[i++] = readl(sds_ring->crb_sts_consumer);
376 }
377}
378
379static u32 qlcnic_test_link(struct net_device *dev)
380{
381 struct qlcnic_adapter *adapter = netdev_priv(dev);
382 u32 val;
383
384 val = QLCRD32(adapter, CRB_XG_STATE_P3);
385 val = XG_LINK_STATE_P3(adapter->ahw.pci_func, val);
386 return (val == XG_LINK_UP_P3) ? 0 : 1;
387}
388
389static int
390qlcnic_get_eeprom(struct net_device *dev, struct ethtool_eeprom *eeprom,
391 u8 *bytes)
392{
393 struct qlcnic_adapter *adapter = netdev_priv(dev);
394 int offset;
395 int ret;
396
397 if (eeprom->len == 0)
398 return -EINVAL;
399
400 eeprom->magic = (adapter->pdev)->vendor |
401 ((adapter->pdev)->device << 16);
402 offset = eeprom->offset;
403
404 ret = qlcnic_rom_fast_read_words(adapter, offset, bytes,
405 eeprom->len);
406 if (ret < 0)
407 return ret;
408
409 return 0;
410}
411
412static void
413qlcnic_get_ringparam(struct net_device *dev,
414 struct ethtool_ringparam *ring)
415{
416 struct qlcnic_adapter *adapter = netdev_priv(dev);
417
418 ring->rx_pending = adapter->num_rxd;
419 ring->rx_jumbo_pending = adapter->num_jumbo_rxd;
af19b491
AKS		 420 ring->tx_pending = adapter->num_txd;
421
422 if (adapter->ahw.port_type == QLCNIC_GBE) {
423 ring->rx_max_pending = MAX_RCV_DESCRIPTORS_1G;
424 ring->rx_jumbo_max_pending = MAX_JUMBO_RCV_DESCRIPTORS_1G;
425 } else {
426 ring->rx_max_pending = MAX_RCV_DESCRIPTORS_10G;
427 ring->rx_jumbo_max_pending = MAX_JUMBO_RCV_DESCRIPTORS_10G;
428 }
429
430 ring->tx_max_pending = MAX_CMD_DESCRIPTORS;
431
432 ring->rx_mini_max_pending = 0;
433 ring->rx_mini_pending = 0;
434}
435
436static u32
437qlcnic_validate_ringparam(u32 val, u32 min, u32 max, char *r_name)
438{
439 u32 num_desc;
440 num_desc = max(val, min);
441 num_desc = min(num_desc, max);
442 num_desc = roundup_pow_of_two(num_desc);
443
444 if (val != num_desc) {
445 printk(KERN_INFO "%s: setting %s ring size %d instead of %d\n",
446 qlcnic_driver_name, r_name, num_desc, val);
447 }
448
449 return num_desc;
450}
451
452static int
453qlcnic_set_ringparam(struct net_device *dev,
454 struct ethtool_ringparam *ring)
455{
456 struct qlcnic_adapter *adapter = netdev_priv(dev);
457 u16 max_rcv_desc = MAX_RCV_DESCRIPTORS_10G;
458 u16 max_jumbo_desc = MAX_JUMBO_RCV_DESCRIPTORS_10G;
459 u16 num_rxd, num_jumbo_rxd, num_txd;
460
461
462 if (ring->rx_mini_pending)
463 return -EOPNOTSUPP;
464
465 if (adapter->ahw.port_type == QLCNIC_GBE) {
466 max_rcv_desc = MAX_RCV_DESCRIPTORS_1G;
467 max_jumbo_desc = MAX_JUMBO_RCV_DESCRIPTORS_10G;
468 }
469
470 num_rxd = qlcnic_validate_ringparam(ring->rx_pending,
471 MIN_RCV_DESCRIPTORS, max_rcv_desc, "rx");
472
473 num_jumbo_rxd = qlcnic_validate_ringparam(ring->rx_jumbo_pending,
474 MIN_JUMBO_DESCRIPTORS, max_jumbo_desc, "rx jumbo");
475
476 num_txd = qlcnic_validate_ringparam(ring->tx_pending,
477 MIN_CMD_DESCRIPTORS, MAX_CMD_DESCRIPTORS, "tx");
478
479 if (num_rxd == adapter->num_rxd && num_txd == adapter->num_txd &&
480 num_jumbo_rxd == adapter->num_jumbo_rxd)
481 return 0;
482
483 adapter->num_rxd = num_rxd;
484 adapter->num_jumbo_rxd = num_jumbo_rxd;
485 adapter->num_txd = num_txd;
486
487 return qlcnic_reset_context(adapter);
488}
489
490static void
491qlcnic_get_pauseparam(struct net_device *netdev,
492 struct ethtool_pauseparam *pause)
493{
494 struct qlcnic_adapter *adapter = netdev_priv(netdev);
495 int port = adapter->physical_port;
496 __u32 val;
497
498 if (adapter->ahw.port_type == QLCNIC_GBE) {
499 if ((port < 0) || (port > QLCNIC_NIU_MAX_GBE_PORTS))
500 return;
501 /* get flow control settings */
502 val = QLCRD32(adapter, QLCNIC_NIU_GB_MAC_CONFIG_0(port));
503 pause->rx_pause = qlcnic_gb_get_rx_flowctl(val);
504 val = QLCRD32(adapter, QLCNIC_NIU_GB_PAUSE_CTL);
505 switch (port) {
506 case 0:
507 pause->tx_pause = !(qlcnic_gb_get_gb0_mask(val));
508 break;
509 case 1:
510 pause->tx_pause = !(qlcnic_gb_get_gb1_mask(val));
511 break;
512 case 2:
513 pause->tx_pause = !(qlcnic_gb_get_gb2_mask(val));
514 break;
515 case 3:
516 default:
517 pause->tx_pause = !(qlcnic_gb_get_gb3_mask(val));
518 break;
519 }
520 } else if (adapter->ahw.port_type == QLCNIC_XGBE) {
521 if ((port < 0) || (port > QLCNIC_NIU_MAX_XG_PORTS))
522 return;
523 pause->rx_pause = 1;
524 val = QLCRD32(adapter, QLCNIC_NIU_XG_PAUSE_CTL);
525 if (port == 0)
526 pause->tx_pause = !(qlcnic_xg_get_xg0_mask(val));
527 else
528 pause->tx_pause = !(qlcnic_xg_get_xg1_mask(val));
529 } else {
530 dev_err(&netdev->dev, "Unknown board type: %x\n",
531 adapter->ahw.port_type);
532 }
533}
534
535static int
536qlcnic_set_pauseparam(struct net_device *netdev,
537 struct ethtool_pauseparam *pause)
538{
539 struct qlcnic_adapter *adapter = netdev_priv(netdev);
540 int port = adapter->physical_port;
541 __u32 val;
542
543 /* read mode */
544 if (adapter->ahw.port_type == QLCNIC_GBE) {
545 if ((port < 0) || (port > QLCNIC_NIU_MAX_GBE_PORTS))
546 return -EIO;
547 /* set flow control */
548 val = QLCRD32(adapter, QLCNIC_NIU_GB_MAC_CONFIG_0(port));
549
550 if (pause->rx_pause)
551 qlcnic_gb_rx_flowctl(val);
552 else
553 qlcnic_gb_unset_rx_flowctl(val);
554
555 QLCWR32(adapter, QLCNIC_NIU_GB_MAC_CONFIG_0(port),
556 val);
557 /* set autoneg */
558 val = QLCRD32(adapter, QLCNIC_NIU_GB_PAUSE_CTL);
559 switch (port) {
560 case 0:
561 if (pause->tx_pause)
562 qlcnic_gb_unset_gb0_mask(val);
563 else
564 qlcnic_gb_set_gb0_mask(val);
565 break;
566 case 1:
567 if (pause->tx_pause)
568 qlcnic_gb_unset_gb1_mask(val);
569 else
570 qlcnic_gb_set_gb1_mask(val);
571 break;
572 case 2:
573 if (pause->tx_pause)
574 qlcnic_gb_unset_gb2_mask(val);
575 else
576 qlcnic_gb_set_gb2_mask(val);
577 break;
578 case 3:
579 default:
580 if (pause->tx_pause)
581 qlcnic_gb_unset_gb3_mask(val);
582 else
583 qlcnic_gb_set_gb3_mask(val);
584 break;
585 }
586 QLCWR32(adapter, QLCNIC_NIU_GB_PAUSE_CTL, val);
587 } else if (adapter->ahw.port_type == QLCNIC_XGBE) {
6d181688
RB		 588 if (!pause->rx_pause || pause->autoneg)
589 return -EOPNOTSUPP;
590
af19b491
AKS		 591 if ((port < 0) || (port > QLCNIC_NIU_MAX_XG_PORTS))
592 return -EIO;
6d181688 593
af19b491
AKS		 594 val = QLCRD32(adapter, QLCNIC_NIU_XG_PAUSE_CTL);
595 if (port == 0) {
596 if (pause->tx_pause)
597 qlcnic_xg_unset_xg0_mask(val);
598 else
599 qlcnic_xg_set_xg0_mask(val);
600 } else {
601 if (pause->tx_pause)
602 qlcnic_xg_unset_xg1_mask(val);
603 else
604 qlcnic_xg_set_xg1_mask(val);
605 }
606 QLCWR32(adapter, QLCNIC_NIU_XG_PAUSE_CTL, val);
607 } else {
608 dev_err(&netdev->dev, "Unknown board type: %x\n",
609 adapter->ahw.port_type);
610 }
611 return 0;
612}
613
614static int qlcnic_reg_test(struct net_device *dev)
615{
616 struct qlcnic_adapter *adapter = netdev_priv(dev);
deffab05 617 u32 data_read;
af19b491
AKS		 618
619 data_read = QLCRD32(adapter, QLCNIC_PCIX_PH_REG(0));
620 if ((data_read & 0xffff) != adapter->pdev->vendor)
621 return 1;
622
af19b491
AKS		 623 return 0;
624}
625
626static int qlcnic_get_sset_count(struct net_device *dev, int sset)
627{
628 switch (sset) {
629 case ETH_SS_TEST:
630 return QLCNIC_TEST_LEN;
631 case ETH_SS_STATS:
632 return QLCNIC_STATS_LEN;
633 default:
634 return -EOPNOTSUPP;
635 }
636}
637
cdaff185
AKS		 638#define QLC_ILB_PKT_SIZE 64
639
640static void qlcnic_create_loopback_buff(unsigned char *data)
641{
642 unsigned char random_data[] = {0xa8, 0x06, 0x45, 0x00};
643 memset(data, 0x4e, QLC_ILB_PKT_SIZE);
644 memset(data, 0xff, 12);
645 memcpy(data + 12, random_data, sizeof(random_data));
646}
647
648int qlcnic_check_loopback_buff(unsigned char *data)
649{
650 unsigned char buff[QLC_ILB_PKT_SIZE];
651 qlcnic_create_loopback_buff(buff);
652 return memcmp(data, buff, QLC_ILB_PKT_SIZE);
653}
654
655static int qlcnic_do_ilb_test(struct qlcnic_adapter *adapter)
656{
657 struct qlcnic_recv_context *recv_ctx = &adapter->recv_ctx;
658 struct qlcnic_host_sds_ring *sds_ring = &recv_ctx->sds_rings[0];
659 struct sk_buff *skb;
660 int i;
661
662 for (i = 0; i < 16; i++) {
663 skb = dev_alloc_skb(QLC_ILB_PKT_SIZE);
664 qlcnic_create_loopback_buff(skb->data);
665 skb_put(skb, QLC_ILB_PKT_SIZE);
666
667 adapter->diag_cnt = 0;
668
669 qlcnic_xmit_frame(skb, adapter->netdev);
670
671 msleep(5);
672
673 qlcnic_process_rcv_ring_diag(sds_ring);
674
675 dev_kfree_skb_any(skb);
676 if (!adapter->diag_cnt)
677 return -1;
678 }
679 return 0;
680}
681
682static int qlcnic_loopback_test(struct net_device *netdev)
683{
684 struct qlcnic_adapter *adapter = netdev_priv(netdev);
685 int max_sds_rings = adapter->max_sds_rings;
686 int ret;
687
36a1898d
AKS		 688 if (adapter->op_mode == QLCNIC_NON_PRIV_FUNC) {
689 dev_warn(&adapter->pdev->dev, "Loopback test not supported"
690 "for non privilege function\n");
691 return 0;
692 }
693
cdaff185
AKS		 694 if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
695 return -EIO;
696
697 ret = qlcnic_diag_alloc_res(netdev, QLCNIC_LOOPBACK_TEST);
698 if (ret)
699 goto clear_it;
700
36a1898d 701 ret = qlcnic_set_ilb_mode(adapter);
cdaff185
AKS		 702 if (ret)
703 goto done;
704
705 ret = qlcnic_do_ilb_test(adapter);
706
36a1898d 707 qlcnic_clear_ilb_mode(adapter);
cdaff185
AKS		 708
709done:
710 qlcnic_diag_free_res(netdev, max_sds_rings);
711
712clear_it:
713 adapter->max_sds_rings = max_sds_rings;
714 clear_bit(__QLCNIC_RESETTING, &adapter->state);
715 return ret;
716}
717
7eb9855d
AKS		 718static int qlcnic_irq_test(struct net_device *netdev)
719{
720 struct qlcnic_adapter *adapter = netdev_priv(netdev);
721 int max_sds_rings = adapter->max_sds_rings;
722 int ret;
723
724 if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
725 return -EIO;
726
727 ret = qlcnic_diag_alloc_res(netdev, QLCNIC_INTERRUPT_TEST);
728 if (ret)
729 goto clear_it;
730
731 adapter->diag_cnt = 0;
732 ret = qlcnic_issue_cmd(adapter, adapter->ahw.pci_func,
2e9d722d
AC		 733 adapter->fw_hal_version, adapter->portnum,
734 0, 0, 0x00000011);
7eb9855d
AKS		 735 if (ret)
736 goto done;
737
738 msleep(10);
739
740 ret = !adapter->diag_cnt;
741
742done:
743 qlcnic_diag_free_res(netdev, max_sds_rings);
744
745clear_it:
746 adapter->max_sds_rings = max_sds_rings;
747 clear_bit(__QLCNIC_RESETTING, &adapter->state);
748 return ret;
749}
750
af19b491
AKS		 751static void
752qlcnic_diag_test(struct net_device *dev, struct ethtool_test *eth_test,
753 u64 *data)
754{
755 memset(data, 0, sizeof(u64) * QLCNIC_TEST_LEN);
897d3596 756
8dec32cc
SC		 757 data[0] = qlcnic_reg_test(dev);
758 if (data[0])
759 eth_test->flags |= ETH_TEST_FL_FAILED;
760
761 data[1] = (u64) qlcnic_test_link(dev);
762 if (data[1])
763 eth_test->flags |= ETH_TEST_FL_FAILED;
764
7eb9855d
AKS		 765 if (eth_test->flags == ETH_TEST_FL_OFFLINE) {
766 data[2] = qlcnic_irq_test(dev);
767 if (data[2])
768 eth_test->flags |= ETH_TEST_FL_FAILED;
cdaff185
AKS		 769
770 data[3] = qlcnic_loopback_test(dev);
771 if (data[3])
772 eth_test->flags |= ETH_TEST_FL_FAILED;
773
7eb9855d 774 }
af19b491
AKS		 775}
776
777static void
778qlcnic_get_strings(struct net_device *dev, u32 stringset, u8 * data)
779{
780 int index;
781
782 switch (stringset) {
783 case ETH_SS_TEST:
784 memcpy(data, *qlcnic_gstrings_test,
785 QLCNIC_TEST_LEN * ETH_GSTRING_LEN);
786 break;
787 case ETH_SS_STATS:
788 for (index = 0; index < QLCNIC_STATS_LEN; index++) {
789 memcpy(data + index * ETH_GSTRING_LEN,
790 qlcnic_gstrings_stats[index].stat_string,
791 ETH_GSTRING_LEN);
792 }
793 break;
794 }
795}
796
797static void
798qlcnic_get_ethtool_stats(struct net_device *dev,
799 struct ethtool_stats *stats, u64 * data)
800{
801 struct qlcnic_adapter *adapter = netdev_priv(dev);
802 int index;
803
804 for (index = 0; index < QLCNIC_STATS_LEN; index++) {
805 char *p =
806 (char *)adapter +
807 qlcnic_gstrings_stats[index].stat_offset;
808 data[index] =
809 (qlcnic_gstrings_stats[index].sizeof_stat ==
810 sizeof(u64)) ? *(u64 *)p:(*(u32 *)p);
811 }
812}
813
0325d69b
RB		 814static int qlcnic_set_tx_csum(struct net_device *dev, u32 data)
815{
816 struct qlcnic_adapter *adapter = netdev_priv(dev);
817
818 if ((adapter->flags & QLCNIC_ESWITCH_ENABLED))
819 return -EOPNOTSUPP;
820 if (data)
821 dev->features |= (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM);
822 else
823 dev->features &= ~(NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM);
824
825 return 0;
826
827}
8bae5698
SC		 828static u32 qlcnic_get_tx_csum(struct net_device *dev)
829{
830 return dev->features & NETIF_F_IP_CSUM;
831}
832
af19b491
AKS		 833static u32 qlcnic_get_rx_csum(struct net_device *dev)
834{
835 struct qlcnic_adapter *adapter = netdev_priv(dev);
836 return adapter->rx_csum;
837}
838
839static int qlcnic_set_rx_csum(struct net_device *dev, u32 data)
840{
841 struct qlcnic_adapter *adapter = netdev_priv(dev);
24763d80 842
0325d69b
RB		 843 if ((adapter->flags & QLCNIC_ESWITCH_ENABLED))
844 return -EOPNOTSUPP;
24763d80
SC		 845 if (!!data) {
846 adapter->rx_csum = !!data;
847 return 0;
848 }
849
850 if (adapter->flags & QLCNIC_LRO_ENABLED) {
851 if (qlcnic_config_hw_lro(adapter, QLCNIC_LRO_DISABLED))
852 return -EIO;
853
854 dev->features &= ~NETIF_F_LRO;
855 qlcnic_send_lro_cleanup(adapter);
856 }
af19b491 857 adapter->rx_csum = !!data;
24763d80 858 dev_info(&adapter->pdev->dev, "disabling LRO as rx_csum is off\n");
af19b491
AKS		 859 return 0;
860}
861
862static u32 qlcnic_get_tso(struct net_device *dev)
863{
864 return (dev->features & (NETIF_F_TSO | NETIF_F_TSO6)) != 0;
865}
866
867static int qlcnic_set_tso(struct net_device *dev, u32 data)
868{
ac8d0c4f
AC		 869 struct qlcnic_adapter *adapter = netdev_priv(dev);
870 if (!(adapter->capabilities & QLCNIC_FW_CAPABILITY_TSO))
871 return -EOPNOTSUPP;
af19b491
AKS		 872 if (data)
873 dev->features |= (NETIF_F_TSO | NETIF_F_TSO6);
874 else
875 dev->features &= ~(NETIF_F_TSO | NETIF_F_TSO6);
876
877 return 0;
878}
879
897d3596
SC		 880static int qlcnic_blink_led(struct net_device *dev, u32 val)
881{
882 struct qlcnic_adapter *adapter = netdev_priv(dev);
883 int ret;
884
8a15ad1f
AKS		 885 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
886 return -EIO;
887
2e9d722d 888 ret = adapter->nic_ops->config_led(adapter, 1, 0xf);
897d3596
SC		 889 if (ret) {
890 dev_err(&adapter->pdev->dev,
891 "Failed to set LED blink state.\n");
892 return ret;
893 }
894
895 msleep_interruptible(val * 1000);
896
2e9d722d 897 ret = adapter->nic_ops->config_led(adapter, 0, 0xf);
897d3596
SC		 898 if (ret) {
899 dev_err(&adapter->pdev->dev,
900 "Failed to reset LED blink state.\n");
901 return ret;
902 }
903
904 return 0;
905}
906
af19b491
AKS		 907static void
908qlcnic_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
909{
910 struct qlcnic_adapter *adapter = netdev_priv(dev);
911 u32 wol_cfg;
912
913 wol->supported = 0;
914 wol->wolopts = 0;
915
916 wol_cfg = QLCRD32(adapter, QLCNIC_WOL_CONFIG_NV);
917 if (wol_cfg & (1UL << adapter->portnum))
918 wol->supported |= WAKE_MAGIC;
919
920 wol_cfg = QLCRD32(adapter, QLCNIC_WOL_CONFIG);
921 if (wol_cfg & (1UL << adapter->portnum))
922 wol->wolopts |= WAKE_MAGIC;
923}
924
925static int
926qlcnic_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
927{
928 struct qlcnic_adapter *adapter = netdev_priv(dev);
929 u32 wol_cfg;
930
931 if (wol->wolopts & ~WAKE_MAGIC)
932 return -EOPNOTSUPP;
933
934 wol_cfg = QLCRD32(adapter, QLCNIC_WOL_CONFIG_NV);
935 if (!(wol_cfg & (1 << adapter->portnum)))
936 return -EOPNOTSUPP;
937
938 wol_cfg = QLCRD32(adapter, QLCNIC_WOL_CONFIG);
939 if (wol->wolopts & WAKE_MAGIC)
940 wol_cfg |= 1UL << adapter->portnum;
941 else
942 wol_cfg &= ~(1UL << adapter->portnum);
943
944 QLCWR32(adapter, QLCNIC_WOL_CONFIG, wol_cfg);
945
946 return 0;
947}
948
949/*
950 * Set the coalescing parameters. Currently only normal is supported.
951 * If rx_coalesce_usecs == 0 or rx_max_coalesced_frames == 0 then set the
952 * firmware coalescing to default.
953 */
954static int qlcnic_set_intr_coalesce(struct net_device *netdev,
955 struct ethtool_coalesce *ethcoal)
956{
957 struct qlcnic_adapter *adapter = netdev_priv(netdev);
958
8a15ad1f 959 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
af19b491
AKS		 960 return -EINVAL;
961
962 /*
963 * Return Error if unsupported values or
964 * unsupported parameters are set.
965 */
966 if (ethcoal->rx_coalesce_usecs > 0xffff ||
967 ethcoal->rx_max_coalesced_frames > 0xffff ||
968 ethcoal->tx_coalesce_usecs > 0xffff ||
969 ethcoal->tx_max_coalesced_frames > 0xffff ||
970 ethcoal->rx_coalesce_usecs_irq ||
971 ethcoal->rx_max_coalesced_frames_irq ||
972 ethcoal->tx_coalesce_usecs_irq ||
973 ethcoal->tx_max_coalesced_frames_irq ||
974 ethcoal->stats_block_coalesce_usecs ||
975 ethcoal->use_adaptive_rx_coalesce ||
976 ethcoal->use_adaptive_tx_coalesce ||
977 ethcoal->pkt_rate_low ||
978 ethcoal->rx_coalesce_usecs_low ||
979 ethcoal->rx_max_coalesced_frames_low ||
980 ethcoal->tx_coalesce_usecs_low ||
981 ethcoal->tx_max_coalesced_frames_low ||
982 ethcoal->pkt_rate_high ||
983 ethcoal->rx_coalesce_usecs_high ||
984 ethcoal->rx_max_coalesced_frames_high ||
985 ethcoal->tx_coalesce_usecs_high ||
986 ethcoal->tx_max_coalesced_frames_high)
987 return -EINVAL;
988
989 if (!ethcoal->rx_coalesce_usecs ||
990 !ethcoal->rx_max_coalesced_frames) {
991 adapter->coal.flags = QLCNIC_INTR_DEFAULT;
992 adapter->coal.normal.data.rx_time_us =
993 QLCNIC_DEFAULT_INTR_COALESCE_RX_TIME_US;
994 adapter->coal.normal.data.rx_packets =
995 QLCNIC_DEFAULT_INTR_COALESCE_RX_PACKETS;
996 } else {
997 adapter->coal.flags = 0;
998 adapter->coal.normal.data.rx_time_us =
999 ethcoal->rx_coalesce_usecs;
1000 adapter->coal.normal.data.rx_packets =
1001 ethcoal->rx_max_coalesced_frames;
1002 }
1003 adapter->coal.normal.data.tx_time_us = ethcoal->tx_coalesce_usecs;
1004 adapter->coal.normal.data.tx_packets =
1005 ethcoal->tx_max_coalesced_frames;
1006
1007 qlcnic_config_intr_coalesce(adapter);
1008
1009 return 0;
1010}
1011
1012static int qlcnic_get_intr_coalesce(struct net_device *netdev,
1013 struct ethtool_coalesce *ethcoal)
1014{
1015 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1016
1017 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1018 return -EINVAL;
1019
1020 ethcoal->rx_coalesce_usecs = adapter->coal.normal.data.rx_time_us;
1021 ethcoal->tx_coalesce_usecs = adapter->coal.normal.data.tx_time_us;
1022 ethcoal->rx_max_coalesced_frames =
1023 adapter->coal.normal.data.rx_packets;
1024 ethcoal->tx_max_coalesced_frames =
1025 adapter->coal.normal.data.tx_packets;
1026
1027 return 0;
1028}
1029
1030static int qlcnic_set_flags(struct net_device *netdev, u32 data)
1031{
1032 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1033 int hw_lro;
1034
deaec0f6 1035 if (data & ~ETH_FLAG_LRO)
97d1935a 1036 return -EINVAL;
deaec0f6 1037
af19b491
AKS		 1038 if (!(adapter->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO))
1039 return -EINVAL;
1040
24763d80
SC		 1041 if (!adapter->rx_csum) {
1042 dev_info(&adapter->pdev->dev, "rx csum is off, "
1043 "cannot toggle lro\n");
1044 return -EINVAL;
1045 }
1046
1047 if ((data & ETH_FLAG_LRO) && (adapter->flags & QLCNIC_LRO_ENABLED))
1048 return 0;
1049
deaec0f6
SG		 1050 if (data & ETH_FLAG_LRO) {
1051 hw_lro = QLCNIC_LRO_ENABLED;
1052 netdev->features |= NETIF_F_LRO;
1053 } else {
1054 hw_lro = 0;
1055 netdev->features &= ~NETIF_F_LRO;
1056 }
af19b491
AKS		 1057
1058 if (qlcnic_config_hw_lro(adapter, hw_lro))
1059 return -EIO;
1060
1061 if ((hw_lro == 0) && qlcnic_send_lro_cleanup(adapter))
1062 return -EIO;
1063
1064
1065 return 0;
1066}
1067
65b5b420
AKS		 1068static u32 qlcnic_get_msglevel(struct net_device *netdev)
1069{
1070 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1071
1072 return adapter->msg_enable;
1073}
1074
1075static void qlcnic_set_msglevel(struct net_device *netdev, u32 msglvl)
1076{
1077 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1078
1079 adapter->msg_enable = msglvl;
1080}
1081
af19b491
AKS		 1082const struct ethtool_ops qlcnic_ethtool_ops = {
1083 .get_settings = qlcnic_get_settings,
1084 .set_settings = qlcnic_set_settings,
1085 .get_drvinfo = qlcnic_get_drvinfo,
1086 .get_regs_len = qlcnic_get_regs_len,
1087 .get_regs = qlcnic_get_regs,
1088 .get_link = ethtool_op_get_link,
1089 .get_eeprom_len = qlcnic_get_eeprom_len,
1090 .get_eeprom = qlcnic_get_eeprom,
1091 .get_ringparam = qlcnic_get_ringparam,
1092 .set_ringparam = qlcnic_set_ringparam,
1093 .get_pauseparam = qlcnic_get_pauseparam,
1094 .set_pauseparam = qlcnic_set_pauseparam,
8bae5698 1095 .get_tx_csum = qlcnic_get_tx_csum,
0325d69b 1096 .set_tx_csum = qlcnic_set_tx_csum,
af19b491
AKS		 1097 .set_sg = ethtool_op_set_sg,
1098 .get_tso = qlcnic_get_tso,
1099 .set_tso = qlcnic_set_tso,
1100 .get_wol = qlcnic_get_wol,
1101 .set_wol = qlcnic_set_wol,
1102 .self_test = qlcnic_diag_test,
1103 .get_strings = qlcnic_get_strings,
1104 .get_ethtool_stats = qlcnic_get_ethtool_stats,
1105 .get_sset_count = qlcnic_get_sset_count,
1106 .get_rx_csum = qlcnic_get_rx_csum,
1107 .set_rx_csum = qlcnic_set_rx_csum,
1108 .get_coalesce = qlcnic_get_intr_coalesce,
1109 .set_coalesce = qlcnic_set_intr_coalesce,
1110 .get_flags = ethtool_op_get_flags,
1111 .set_flags = qlcnic_set_flags,
897d3596 1112 .phys_id = qlcnic_blink_led,
65b5b420
AKS		 1113 .set_msglevel = qlcnic_set_msglevel,
1114 .get_msglevel = qlcnic_get_msglevel,
af19b491 1115};
Clone of davem's net-next-2.6 tree