2 * QLogic qlcnic NIC Driver
3 * Copyright (c) 2009-2010 QLogic Corporation
5 * See LICENSE.qlcnic for copyright and licensing details.
8 #include <linux/types.h>
9 #include <linux/delay.h>
10 #include <linux/pci.h>
12 #include <linux/netdevice.h>
13 #include <linux/ethtool.h>
18 char stat_string
[ETH_GSTRING_LEN
];
23 #define QLC_SIZEOF(m) FIELD_SIZEOF(struct qlcnic_adapter, m)
24 #define QLC_OFF(m) offsetof(struct qlcnic_adapter, m)
26 static const struct qlcnic_stats qlcnic_gstrings_stats
[] = {
28 QLC_SIZEOF(stats
.xmitcalled
), QLC_OFF(stats
.xmitcalled
)},
30 QLC_SIZEOF(stats
.xmitfinished
), QLC_OFF(stats
.xmitfinished
)},
32 QLC_SIZEOF(stats
.rxdropped
), QLC_OFF(stats
.rxdropped
)},
34 QLC_SIZEOF(stats
.txdropped
), QLC_OFF(stats
.txdropped
)},
36 QLC_SIZEOF(stats
.csummed
), QLC_OFF(stats
.csummed
)},
38 QLC_SIZEOF(stats
.rx_pkts
), QLC_OFF(stats
.rx_pkts
)},
40 QLC_SIZEOF(stats
.lro_pkts
), QLC_OFF(stats
.lro_pkts
)},
42 QLC_SIZEOF(stats
.rxbytes
), QLC_OFF(stats
.rxbytes
)},
44 QLC_SIZEOF(stats
.txbytes
), QLC_OFF(stats
.txbytes
)},
46 QLC_SIZEOF(stats
.lrobytes
), QLC_OFF(stats
.lrobytes
)},
48 QLC_SIZEOF(stats
.lso_frames
), QLC_OFF(stats
.lso_frames
)},
50 QLC_SIZEOF(stats
.xmit_on
), QLC_OFF(stats
.xmit_on
)},
52 QLC_SIZEOF(stats
.xmit_off
), QLC_OFF(stats
.xmit_off
)},
53 {"skb_alloc_failure", QLC_SIZEOF(stats
.skb_alloc_failure
),
54 QLC_OFF(stats
.skb_alloc_failure
)},
56 QLC_SIZEOF(stats
.null_rxbuf
), QLC_OFF(stats
.null_rxbuf
)},
57 {"rx dma map error", QLC_SIZEOF(stats
.rx_dma_map_error
),
58 QLC_OFF(stats
.rx_dma_map_error
)},
59 {"tx dma map error", QLC_SIZEOF(stats
.tx_dma_map_error
),
60 QLC_OFF(stats
.tx_dma_map_error
)},
64 static const char qlcnic_device_gstrings_stats
[][ETH_GSTRING_LEN
] = {
66 "rx multicast frames",
67 "rx broadcast frames",
73 "tx multicast frames",
74 "tx broadcast frames",
81 #define QLCNIC_STATS_LEN ARRAY_SIZE(qlcnic_gstrings_stats)
82 #define QLCNIC_DEVICE_STATS_LEN ARRAY_SIZE(qlcnic_device_gstrings_stats)
84 static const char qlcnic_gstrings_test
[][ETH_GSTRING_LEN
] = {
85 "Register_Test_on_offline",
86 "Link_Test_on_offline",
87 "Interrupt_Test_offline",
88 "Internal_Loopback_offline",
89 "External_Loopback_offline"
92 #define QLCNIC_TEST_LEN ARRAY_SIZE(qlcnic_gstrings_test)
94 #define QLCNIC_RING_REGS_COUNT 20
95 #define QLCNIC_RING_REGS_LEN (QLCNIC_RING_REGS_COUNT * sizeof(u32))
96 #define QLCNIC_MAX_EEPROM_LEN 1024
98 static const u32 diag_registers
[] = {
102 CRB_FW_CAPABILITIES_1
,
104 QLCNIC_CRB_DRV_ACTIVE
,
105 QLCNIC_CRB_DEV_STATE
,
106 QLCNIC_CRB_DRV_STATE
,
107 QLCNIC_CRB_DRV_SCRATCH
,
108 QLCNIC_CRB_DEV_PARTITION_INFO
,
109 QLCNIC_CRB_DRV_IDC_VER
,
110 QLCNIC_PEG_ALIVE_COUNTER
,
111 QLCNIC_PEG_HALT_STATUS1
,
112 QLCNIC_PEG_HALT_STATUS2
,
113 QLCNIC_CRB_PEG_NET_0
+0x3c,
114 QLCNIC_CRB_PEG_NET_1
+0x3c,
115 QLCNIC_CRB_PEG_NET_2
+0x3c,
116 QLCNIC_CRB_PEG_NET_4
+0x3c,
120 #define QLCNIC_MGMT_API_VERSION 2
121 #define QLCNIC_DEV_INFO_SIZE 1
122 #define QLCNIC_ETHTOOL_REGS_VER 2
123 static int qlcnic_get_regs_len(struct net_device
*dev
)
125 return sizeof(diag_registers
) + QLCNIC_RING_REGS_LEN
+
126 QLCNIC_DEV_INFO_SIZE
+ 1;
129 static int qlcnic_get_eeprom_len(struct net_device
*dev
)
131 return QLCNIC_FLASH_TOTAL_SIZE
;
135 qlcnic_get_drvinfo(struct net_device
*dev
, struct ethtool_drvinfo
*drvinfo
)
137 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
138 u32 fw_major
, fw_minor
, fw_build
;
140 fw_major
= QLCRD32(adapter
, QLCNIC_FW_VERSION_MAJOR
);
141 fw_minor
= QLCRD32(adapter
, QLCNIC_FW_VERSION_MINOR
);
142 fw_build
= QLCRD32(adapter
, QLCNIC_FW_VERSION_SUB
);
143 snprintf(drvinfo
->fw_version
, sizeof(drvinfo
->fw_version
),
144 "%d.%d.%d", fw_major
, fw_minor
, fw_build
);
146 strlcpy(drvinfo
->bus_info
, pci_name(adapter
->pdev
),
147 sizeof(drvinfo
->bus_info
));
148 strlcpy(drvinfo
->driver
, qlcnic_driver_name
, sizeof(drvinfo
->driver
));
149 strlcpy(drvinfo
->version
, QLCNIC_LINUX_VERSIONID
,
150 sizeof(drvinfo
->version
));
154 qlcnic_get_settings(struct net_device
*dev
, struct ethtool_cmd
*ecmd
)
156 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
157 int check_sfp_module
= 0;
158 u16 pcifn
= adapter
->ahw
->pci_func
;
160 /* read which mode */
161 if (adapter
->ahw
->port_type
== QLCNIC_GBE
) {
162 ecmd
->supported
= (SUPPORTED_10baseT_Half
|
163 SUPPORTED_10baseT_Full
|
164 SUPPORTED_100baseT_Half
|
165 SUPPORTED_100baseT_Full
|
166 SUPPORTED_1000baseT_Half
|
167 SUPPORTED_1000baseT_Full
);
169 ecmd
->advertising
= (ADVERTISED_100baseT_Half
|
170 ADVERTISED_100baseT_Full
|
171 ADVERTISED_1000baseT_Half
|
172 ADVERTISED_1000baseT_Full
);
174 ethtool_cmd_speed_set(ecmd
, adapter
->link_speed
);
175 ecmd
->duplex
= adapter
->link_duplex
;
176 ecmd
->autoneg
= adapter
->link_autoneg
;
178 } else if (adapter
->ahw
->port_type
== QLCNIC_XGBE
) {
181 val
= QLCRD32(adapter
, QLCNIC_PORT_MODE_ADDR
);
182 if (val
== QLCNIC_PORT_MODE_802_3_AP
) {
183 ecmd
->supported
= SUPPORTED_1000baseT_Full
;
184 ecmd
->advertising
= ADVERTISED_1000baseT_Full
;
186 ecmd
->supported
= SUPPORTED_10000baseT_Full
;
187 ecmd
->advertising
= ADVERTISED_10000baseT_Full
;
190 if (netif_running(dev
) && adapter
->has_link_events
) {
191 ethtool_cmd_speed_set(ecmd
, adapter
->link_speed
);
192 ecmd
->autoneg
= adapter
->link_autoneg
;
193 ecmd
->duplex
= adapter
->link_duplex
;
197 val
= QLCRD32(adapter
, P3P_LINK_SPEED_REG(pcifn
));
198 ethtool_cmd_speed_set(ecmd
, P3P_LINK_SPEED_MHZ
*
199 P3P_LINK_SPEED_VAL(pcifn
, val
));
200 ecmd
->duplex
= DUPLEX_FULL
;
201 ecmd
->autoneg
= AUTONEG_DISABLE
;
206 ecmd
->phy_address
= adapter
->physical_port
;
207 ecmd
->transceiver
= XCVR_EXTERNAL
;
209 switch (adapter
->ahw
->board_type
) {
210 case QLCNIC_BRDTYPE_P3P_REF_QG
:
211 case QLCNIC_BRDTYPE_P3P_4_GB
:
212 case QLCNIC_BRDTYPE_P3P_4_GB_MM
:
214 ecmd
->supported
|= SUPPORTED_Autoneg
;
215 ecmd
->advertising
|= ADVERTISED_Autoneg
;
216 case QLCNIC_BRDTYPE_P3P_10G_CX4
:
217 case QLCNIC_BRDTYPE_P3P_10G_CX4_LP
:
218 case QLCNIC_BRDTYPE_P3P_10000_BASE_T
:
219 ecmd
->supported
|= SUPPORTED_TP
;
220 ecmd
->advertising
|= ADVERTISED_TP
;
221 ecmd
->port
= PORT_TP
;
222 ecmd
->autoneg
= adapter
->link_autoneg
;
224 case QLCNIC_BRDTYPE_P3P_IMEZ
:
225 case QLCNIC_BRDTYPE_P3P_XG_LOM
:
226 case QLCNIC_BRDTYPE_P3P_HMEZ
:
227 ecmd
->supported
|= SUPPORTED_MII
;
228 ecmd
->advertising
|= ADVERTISED_MII
;
229 ecmd
->port
= PORT_MII
;
230 ecmd
->autoneg
= AUTONEG_DISABLE
;
232 case QLCNIC_BRDTYPE_P3P_10G_SFP_PLUS
:
233 case QLCNIC_BRDTYPE_P3P_10G_SFP_CT
:
234 case QLCNIC_BRDTYPE_P3P_10G_SFP_QT
:
235 ecmd
->advertising
|= ADVERTISED_TP
;
236 ecmd
->supported
|= SUPPORTED_TP
;
237 check_sfp_module
= netif_running(dev
) &&
238 adapter
->has_link_events
;
239 case QLCNIC_BRDTYPE_P3P_10G_XFP
:
240 ecmd
->supported
|= SUPPORTED_FIBRE
;
241 ecmd
->advertising
|= ADVERTISED_FIBRE
;
242 ecmd
->port
= PORT_FIBRE
;
243 ecmd
->autoneg
= AUTONEG_DISABLE
;
245 case QLCNIC_BRDTYPE_P3P_10G_TP
:
246 if (adapter
->ahw
->port_type
== QLCNIC_XGBE
) {
247 ecmd
->autoneg
= AUTONEG_DISABLE
;
248 ecmd
->supported
|= (SUPPORTED_FIBRE
| SUPPORTED_TP
);
250 (ADVERTISED_FIBRE
| ADVERTISED_TP
);
251 ecmd
->port
= PORT_FIBRE
;
252 check_sfp_module
= netif_running(dev
) &&
253 adapter
->has_link_events
;
255 ecmd
->autoneg
= AUTONEG_ENABLE
;
256 ecmd
->supported
|= (SUPPORTED_TP
| SUPPORTED_Autoneg
);
258 (ADVERTISED_TP
| ADVERTISED_Autoneg
);
259 ecmd
->port
= PORT_TP
;
263 dev_err(&adapter
->pdev
->dev
, "Unsupported board model %d\n",
264 adapter
->ahw
->board_type
);
268 if (check_sfp_module
) {
269 switch (adapter
->module_type
) {
270 case LINKEVENT_MODULE_OPTICAL_UNKNOWN
:
271 case LINKEVENT_MODULE_OPTICAL_SRLR
:
272 case LINKEVENT_MODULE_OPTICAL_LRM
:
273 case LINKEVENT_MODULE_OPTICAL_SFP_1G
:
274 ecmd
->port
= PORT_FIBRE
;
276 case LINKEVENT_MODULE_TWINAX_UNSUPPORTED_CABLE
:
277 case LINKEVENT_MODULE_TWINAX_UNSUPPORTED_CABLELEN
:
278 case LINKEVENT_MODULE_TWINAX
:
279 ecmd
->port
= PORT_TP
;
282 ecmd
->port
= PORT_OTHER
;
290 qlcnic_set_settings(struct net_device
*dev
, struct ethtool_cmd
*ecmd
)
294 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
296 if (adapter
->ahw
->port_type
!= QLCNIC_GBE
)
299 /* read which mode */
306 switch (ethtool_cmd_speed(ecmd
)) {
320 ret
= qlcnic_fw_cmd_set_port(adapter
, config
);
322 if (ret
== QLCNIC_RCODE_NOT_SUPPORTED
)
327 adapter
->link_speed
= ethtool_cmd_speed(ecmd
);
328 adapter
->link_duplex
= ecmd
->duplex
;
329 adapter
->link_autoneg
= ecmd
->autoneg
;
331 if (!netif_running(dev
))
334 dev
->netdev_ops
->ndo_stop(dev
);
335 return dev
->netdev_ops
->ndo_open(dev
);
339 qlcnic_get_regs(struct net_device
*dev
, struct ethtool_regs
*regs
, void *p
)
341 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
342 struct qlcnic_recv_context
*recv_ctx
= adapter
->recv_ctx
;
343 struct qlcnic_host_sds_ring
*sds_ring
;
345 int ring
, i
= 0, j
= 0;
347 memset(p
, 0, qlcnic_get_regs_len(dev
));
348 regs
->version
= (QLCNIC_ETHTOOL_REGS_VER
<< 24) |
349 (adapter
->ahw
->revision_id
<< 16) | (adapter
->pdev
)->device
;
351 regs_buff
[0] = (0xcafe0000 | (QLCNIC_DEV_INFO_SIZE
& 0xffff));
352 regs_buff
[1] = QLCNIC_MGMT_API_VERSION
;
354 for (i
= QLCNIC_DEV_INFO_SIZE
+ 1; diag_registers
[j
] != -1; j
++, i
++)
355 regs_buff
[i
] = QLCRD32(adapter
, diag_registers
[j
]);
357 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
360 regs_buff
[i
++] = 0xFFEFCDAB; /* Marker btw regs and ring count*/
362 regs_buff
[i
++] = 1; /* No. of tx ring */
363 regs_buff
[i
++] = le32_to_cpu(*(adapter
->tx_ring
->hw_consumer
));
364 regs_buff
[i
++] = readl(adapter
->tx_ring
->crb_cmd_producer
);
366 regs_buff
[i
++] = 2; /* No. of rx ring */
367 regs_buff
[i
++] = readl(recv_ctx
->rds_rings
[0].crb_rcv_producer
);
368 regs_buff
[i
++] = readl(recv_ctx
->rds_rings
[1].crb_rcv_producer
);
370 regs_buff
[i
++] = adapter
->max_sds_rings
;
372 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
373 sds_ring
= &(recv_ctx
->sds_rings
[ring
]);
374 regs_buff
[i
++] = readl(sds_ring
->crb_sts_consumer
);
378 static u32
qlcnic_test_link(struct net_device
*dev
)
380 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
383 val
= QLCRD32(adapter
, CRB_XG_STATE_P3P
);
384 val
= XG_LINK_STATE_P3P(adapter
->ahw
->pci_func
, val
);
385 return (val
== XG_LINK_UP_P3P
) ? 0 : 1;
389 qlcnic_get_eeprom(struct net_device
*dev
, struct ethtool_eeprom
*eeprom
,
392 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
396 if (eeprom
->len
== 0)
399 eeprom
->magic
= (adapter
->pdev
)->vendor
|
400 ((adapter
->pdev
)->device
<< 16);
401 offset
= eeprom
->offset
;
403 ret
= qlcnic_rom_fast_read_words(adapter
, offset
, bytes
,
412 qlcnic_get_ringparam(struct net_device
*dev
,
413 struct ethtool_ringparam
*ring
)
415 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
417 ring
->rx_pending
= adapter
->num_rxd
;
418 ring
->rx_jumbo_pending
= adapter
->num_jumbo_rxd
;
419 ring
->tx_pending
= adapter
->num_txd
;
421 ring
->rx_max_pending
= adapter
->max_rxd
;
422 ring
->rx_jumbo_max_pending
= adapter
->max_jumbo_rxd
;
423 ring
->tx_max_pending
= MAX_CMD_DESCRIPTORS
;
427 qlcnic_validate_ringparam(u32 val
, u32 min
, u32 max
, char *r_name
)
430 num_desc
= max(val
, min
);
431 num_desc
= min(num_desc
, max
);
432 num_desc
= roundup_pow_of_two(num_desc
);
434 if (val
!= num_desc
) {
435 printk(KERN_INFO
"%s: setting %s ring size %d instead of %d\n",
436 qlcnic_driver_name
, r_name
, num_desc
, val
);
443 qlcnic_set_ringparam(struct net_device
*dev
,
444 struct ethtool_ringparam
*ring
)
446 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
447 u16 num_rxd
, num_jumbo_rxd
, num_txd
;
449 if (ring
->rx_mini_pending
)
452 num_rxd
= qlcnic_validate_ringparam(ring
->rx_pending
,
453 MIN_RCV_DESCRIPTORS
, adapter
->max_rxd
, "rx");
455 num_jumbo_rxd
= qlcnic_validate_ringparam(ring
->rx_jumbo_pending
,
456 MIN_JUMBO_DESCRIPTORS
, adapter
->max_jumbo_rxd
,
459 num_txd
= qlcnic_validate_ringparam(ring
->tx_pending
,
460 MIN_CMD_DESCRIPTORS
, MAX_CMD_DESCRIPTORS
, "tx");
462 if (num_rxd
== adapter
->num_rxd
&& num_txd
== adapter
->num_txd
&&
463 num_jumbo_rxd
== adapter
->num_jumbo_rxd
)
466 adapter
->num_rxd
= num_rxd
;
467 adapter
->num_jumbo_rxd
= num_jumbo_rxd
;
468 adapter
->num_txd
= num_txd
;
470 return qlcnic_reset_context(adapter
);
473 static void qlcnic_get_channels(struct net_device
*dev
,
474 struct ethtool_channels
*channel
)
476 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
478 channel
->max_rx
= rounddown_pow_of_two(min_t(int,
479 adapter
->max_rx_ques
, num_online_cpus()));
480 channel
->max_tx
= adapter
->max_tx_ques
;
482 channel
->rx_count
= adapter
->max_sds_rings
;
483 channel
->tx_count
= adapter
->max_tx_ques
;
486 static int qlcnic_set_channels(struct net_device
*dev
,
487 struct ethtool_channels
*channel
)
489 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
492 if (channel
->other_count
|| channel
->combined_count
||
493 channel
->tx_count
!= channel
->max_tx
)
496 err
= qlcnic_validate_max_rss(dev
, channel
->max_rx
, channel
->rx_count
);
500 err
= qlcnic_set_max_rss(adapter
, channel
->rx_count
);
501 netdev_info(dev
, "allocated 0x%x sds rings\n",
502 adapter
->max_sds_rings
);
507 qlcnic_get_pauseparam(struct net_device
*netdev
,
508 struct ethtool_pauseparam
*pause
)
510 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
511 int port
= adapter
->physical_port
;
514 if (adapter
->ahw
->port_type
== QLCNIC_GBE
) {
515 if ((port
< 0) || (port
> QLCNIC_NIU_MAX_GBE_PORTS
))
517 /* get flow control settings */
518 val
= QLCRD32(adapter
, QLCNIC_NIU_GB_MAC_CONFIG_0(port
));
519 pause
->rx_pause
= qlcnic_gb_get_rx_flowctl(val
);
520 val
= QLCRD32(adapter
, QLCNIC_NIU_GB_PAUSE_CTL
);
523 pause
->tx_pause
= !(qlcnic_gb_get_gb0_mask(val
));
526 pause
->tx_pause
= !(qlcnic_gb_get_gb1_mask(val
));
529 pause
->tx_pause
= !(qlcnic_gb_get_gb2_mask(val
));
533 pause
->tx_pause
= !(qlcnic_gb_get_gb3_mask(val
));
536 } else if (adapter
->ahw
->port_type
== QLCNIC_XGBE
) {
537 if ((port
< 0) || (port
> QLCNIC_NIU_MAX_XG_PORTS
))
540 val
= QLCRD32(adapter
, QLCNIC_NIU_XG_PAUSE_CTL
);
542 pause
->tx_pause
= !(qlcnic_xg_get_xg0_mask(val
));
544 pause
->tx_pause
= !(qlcnic_xg_get_xg1_mask(val
));
546 dev_err(&netdev
->dev
, "Unknown board type: %x\n",
547 adapter
->ahw
->port_type
);
552 qlcnic_set_pauseparam(struct net_device
*netdev
,
553 struct ethtool_pauseparam
*pause
)
555 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
556 int port
= adapter
->physical_port
;
560 if (adapter
->ahw
->port_type
== QLCNIC_GBE
) {
561 if ((port
< 0) || (port
> QLCNIC_NIU_MAX_GBE_PORTS
))
563 /* set flow control */
564 val
= QLCRD32(adapter
, QLCNIC_NIU_GB_MAC_CONFIG_0(port
));
567 qlcnic_gb_rx_flowctl(val
);
569 qlcnic_gb_unset_rx_flowctl(val
);
571 QLCWR32(adapter
, QLCNIC_NIU_GB_MAC_CONFIG_0(port
),
574 val
= QLCRD32(adapter
, QLCNIC_NIU_GB_PAUSE_CTL
);
578 qlcnic_gb_unset_gb0_mask(val
);
580 qlcnic_gb_set_gb0_mask(val
);
584 qlcnic_gb_unset_gb1_mask(val
);
586 qlcnic_gb_set_gb1_mask(val
);
590 qlcnic_gb_unset_gb2_mask(val
);
592 qlcnic_gb_set_gb2_mask(val
);
597 qlcnic_gb_unset_gb3_mask(val
);
599 qlcnic_gb_set_gb3_mask(val
);
602 QLCWR32(adapter
, QLCNIC_NIU_GB_PAUSE_CTL
, val
);
603 } else if (adapter
->ahw
->port_type
== QLCNIC_XGBE
) {
604 if (!pause
->rx_pause
|| pause
->autoneg
)
607 if ((port
< 0) || (port
> QLCNIC_NIU_MAX_XG_PORTS
))
610 val
= QLCRD32(adapter
, QLCNIC_NIU_XG_PAUSE_CTL
);
613 qlcnic_xg_unset_xg0_mask(val
);
615 qlcnic_xg_set_xg0_mask(val
);
618 qlcnic_xg_unset_xg1_mask(val
);
620 qlcnic_xg_set_xg1_mask(val
);
622 QLCWR32(adapter
, QLCNIC_NIU_XG_PAUSE_CTL
, val
);
624 dev_err(&netdev
->dev
, "Unknown board type: %x\n",
625 adapter
->ahw
->port_type
);
630 static int qlcnic_reg_test(struct net_device
*dev
)
632 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
635 data_read
= QLCRD32(adapter
, QLCNIC_PCIX_PH_REG(0));
636 if ((data_read
& 0xffff) != adapter
->pdev
->vendor
)
642 static int qlcnic_get_sset_count(struct net_device
*dev
, int sset
)
644 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
647 return QLCNIC_TEST_LEN
;
649 if (adapter
->flags
& QLCNIC_ESWITCH_ENABLED
)
650 return QLCNIC_STATS_LEN
+ QLCNIC_DEVICE_STATS_LEN
;
651 return QLCNIC_STATS_LEN
;
657 static int qlcnic_irq_test(struct net_device
*netdev
)
659 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
660 int max_sds_rings
= adapter
->max_sds_rings
;
662 struct qlcnic_cmd_args cmd
;
664 if (test_and_set_bit(__QLCNIC_RESETTING
, &adapter
->state
))
667 ret
= qlcnic_diag_alloc_res(netdev
, QLCNIC_INTERRUPT_TEST
);
671 adapter
->diag_cnt
= 0;
672 memset(&cmd
, 0, sizeof(cmd
));
673 cmd
.req
.cmd
= QLCNIC_CDRP_CMD_INTRPT_TEST
;
674 cmd
.req
.arg1
= adapter
->ahw
->pci_func
;
675 qlcnic_issue_cmd(adapter
, &cmd
);
683 ret
= !adapter
->diag_cnt
;
686 qlcnic_diag_free_res(netdev
, max_sds_rings
);
689 adapter
->max_sds_rings
= max_sds_rings
;
690 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
694 #define QLCNIC_ILB_PKT_SIZE 64
695 #define QLCNIC_NUM_ILB_PKT 16
696 #define QLCNIC_ILB_MAX_RCV_LOOP 10
698 static void qlcnic_create_loopback_buff(unsigned char *data
, u8 mac
[])
700 unsigned char random_data
[] = {0xa8, 0x06, 0x45, 0x00};
702 memset(data
, 0x4e, QLCNIC_ILB_PKT_SIZE
);
704 memcpy(data
, mac
, ETH_ALEN
);
705 memcpy(data
+ ETH_ALEN
, mac
, ETH_ALEN
);
707 memcpy(data
+ 2 * ETH_ALEN
, random_data
, sizeof(random_data
));
710 int qlcnic_check_loopback_buff(unsigned char *data
, u8 mac
[])
712 unsigned char buff
[QLCNIC_ILB_PKT_SIZE
];
713 qlcnic_create_loopback_buff(buff
, mac
);
714 return memcmp(data
, buff
, QLCNIC_ILB_PKT_SIZE
);
717 static int qlcnic_do_lb_test(struct qlcnic_adapter
*adapter
, u8 mode
)
719 struct qlcnic_recv_context
*recv_ctx
= adapter
->recv_ctx
;
720 struct qlcnic_host_sds_ring
*sds_ring
= &recv_ctx
->sds_rings
[0];
722 int i
, loop
, cnt
= 0;
724 for (i
= 0; i
< QLCNIC_NUM_ILB_PKT
; i
++) {
725 skb
= dev_alloc_skb(QLCNIC_ILB_PKT_SIZE
);
726 qlcnic_create_loopback_buff(skb
->data
, adapter
->mac_addr
);
727 skb_put(skb
, QLCNIC_ILB_PKT_SIZE
);
729 adapter
->diag_cnt
= 0;
730 qlcnic_xmit_frame(skb
, adapter
->netdev
);
735 qlcnic_process_rcv_ring_diag(sds_ring
);
736 if (loop
++ > QLCNIC_ILB_MAX_RCV_LOOP
)
738 } while (!adapter
->diag_cnt
);
740 dev_kfree_skb_any(skb
);
742 if (!adapter
->diag_cnt
)
744 "LB Test: packet #%d was not received\n", i
+ 1);
749 dev_warn(&adapter
->pdev
->dev
, "LB Test failed\n");
750 if (mode
!= QLCNIC_ILB_MODE
) {
751 dev_warn(&adapter
->pdev
->dev
,
752 "WARNING: Please make sure external"
753 "loopback connector is plugged in\n");
760 static int qlcnic_loopback_test(struct net_device
*netdev
, u8 mode
)
762 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
763 int max_sds_rings
= adapter
->max_sds_rings
;
764 struct qlcnic_host_sds_ring
*sds_ring
;
768 if (!(adapter
->capabilities
& QLCNIC_FW_CAPABILITY_MULTI_LOOPBACK
)) {
769 netdev_info(netdev
, "Firmware is not loopback test capable\n");
773 QLCDB(adapter
, DRV
, "%s loopback test in progress\n",
774 mode
== QLCNIC_ILB_MODE
? "internal" : "external");
775 if (adapter
->op_mode
== QLCNIC_NON_PRIV_FUNC
) {
776 netdev_warn(netdev
, "Loopback test not supported for non "
777 "privilege function\n");
781 if (test_and_set_bit(__QLCNIC_RESETTING
, &adapter
->state
))
784 ret
= qlcnic_diag_alloc_res(netdev
, QLCNIC_LOOPBACK_TEST
);
788 sds_ring
= &adapter
->recv_ctx
->sds_rings
[0];
790 ret
= qlcnic_set_lb_mode(adapter
, mode
);
794 adapter
->diag_cnt
= 0;
797 qlcnic_process_rcv_ring_diag(sds_ring
);
798 if (loop
++ > QLCNIC_ILB_MAX_RCV_LOOP
) {
799 netdev_info(netdev
, "firmware didnt respond to loopback"
800 " configure request\n");
801 ret
= -QLCNIC_FW_NOT_RESPOND
;
803 } else if (adapter
->diag_cnt
) {
804 ret
= adapter
->diag_cnt
;
807 } while (!QLCNIC_IS_LB_CONFIGURED(adapter
->ahw
->loopback_state
));
809 ret
= qlcnic_do_lb_test(adapter
, mode
);
811 qlcnic_clear_lb_mode(adapter
);
814 qlcnic_diag_free_res(netdev
, max_sds_rings
);
817 adapter
->max_sds_rings
= max_sds_rings
;
818 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
823 qlcnic_diag_test(struct net_device
*dev
, struct ethtool_test
*eth_test
,
826 memset(data
, 0, sizeof(u64
) * QLCNIC_TEST_LEN
);
828 data
[0] = qlcnic_reg_test(dev
);
830 eth_test
->flags
|= ETH_TEST_FL_FAILED
;
832 data
[1] = (u64
) qlcnic_test_link(dev
);
834 eth_test
->flags
|= ETH_TEST_FL_FAILED
;
836 if (eth_test
->flags
& ETH_TEST_FL_OFFLINE
) {
837 data
[2] = qlcnic_irq_test(dev
);
839 eth_test
->flags
|= ETH_TEST_FL_FAILED
;
841 data
[3] = qlcnic_loopback_test(dev
, QLCNIC_ILB_MODE
);
843 eth_test
->flags
|= ETH_TEST_FL_FAILED
;
844 if (eth_test
->flags
& ETH_TEST_FL_EXTERNAL_LB
) {
845 data
[4] = qlcnic_loopback_test(dev
, QLCNIC_ELB_MODE
);
847 eth_test
->flags
|= ETH_TEST_FL_FAILED
;
848 eth_test
->flags
|= ETH_TEST_FL_EXTERNAL_LB_DONE
;
854 qlcnic_get_strings(struct net_device
*dev
, u32 stringset
, u8
* data
)
856 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
861 memcpy(data
, *qlcnic_gstrings_test
,
862 QLCNIC_TEST_LEN
* ETH_GSTRING_LEN
);
865 for (index
= 0; index
< QLCNIC_STATS_LEN
; index
++) {
866 memcpy(data
+ index
* ETH_GSTRING_LEN
,
867 qlcnic_gstrings_stats
[index
].stat_string
,
870 if (!(adapter
->flags
& QLCNIC_ESWITCH_ENABLED
))
872 for (i
= 0; i
< QLCNIC_DEVICE_STATS_LEN
; index
++, i
++) {
873 memcpy(data
+ index
* ETH_GSTRING_LEN
,
874 qlcnic_device_gstrings_stats
[i
],
880 #define QLCNIC_FILL_ESWITCH_STATS(VAL1) \
881 (((VAL1) == QLCNIC_ESW_STATS_NOT_AVAIL) ? 0 : VAL1)
884 qlcnic_fill_device_stats(int *index
, u64
*data
,
885 struct __qlcnic_esw_statistics
*stats
)
889 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->unicast_frames
);
890 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->multicast_frames
);
891 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->broadcast_frames
);
892 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->dropped_frames
);
893 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->errors
);
894 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->local_frames
);
895 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->numbytes
);
901 qlcnic_get_ethtool_stats(struct net_device
*dev
,
902 struct ethtool_stats
*stats
, u64
* data
)
904 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
905 struct qlcnic_esw_statistics port_stats
;
908 for (index
= 0; index
< QLCNIC_STATS_LEN
; index
++) {
911 qlcnic_gstrings_stats
[index
].stat_offset
;
913 (qlcnic_gstrings_stats
[index
].sizeof_stat
==
914 sizeof(u64
)) ? *(u64
*)p
:(*(u32
*)p
);
917 if (!(adapter
->flags
& QLCNIC_ESWITCH_ENABLED
))
920 memset(&port_stats
, 0, sizeof(struct qlcnic_esw_statistics
));
921 ret
= qlcnic_get_port_stats(adapter
, adapter
->ahw
->pci_func
,
922 QLCNIC_QUERY_RX_COUNTER
, &port_stats
.rx
);
926 qlcnic_fill_device_stats(&index
, data
, &port_stats
.rx
);
928 ret
= qlcnic_get_port_stats(adapter
, adapter
->ahw
->pci_func
,
929 QLCNIC_QUERY_TX_COUNTER
, &port_stats
.tx
);
933 qlcnic_fill_device_stats(&index
, data
, &port_stats
.tx
);
936 static int qlcnic_set_led(struct net_device
*dev
,
937 enum ethtool_phys_id_state state
)
939 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
940 int max_sds_rings
= adapter
->max_sds_rings
;
941 int err
= -EIO
, active
= 1;
943 if (adapter
->op_mode
== QLCNIC_NON_PRIV_FUNC
) {
944 netdev_warn(dev
, "LED test not supported for non "
945 "privilege function\n");
950 case ETHTOOL_ID_ACTIVE
:
951 if (test_and_set_bit(__QLCNIC_LED_ENABLE
, &adapter
->state
))
954 if (test_bit(__QLCNIC_RESETTING
, &adapter
->state
))
957 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
)) {
958 if (qlcnic_diag_alloc_res(dev
, QLCNIC_LED_TEST
))
960 set_bit(__QLCNIC_DIAG_RES_ALLOC
, &adapter
->state
);
963 if (adapter
->nic_ops
->config_led(adapter
, 1, 0xf) == 0) {
968 dev_err(&adapter
->pdev
->dev
,
969 "Failed to set LED blink state.\n");
972 case ETHTOOL_ID_INACTIVE
:
975 if (test_bit(__QLCNIC_RESETTING
, &adapter
->state
))
978 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
)) {
979 if (qlcnic_diag_alloc_res(dev
, QLCNIC_LED_TEST
))
981 set_bit(__QLCNIC_DIAG_RES_ALLOC
, &adapter
->state
);
984 if (adapter
->nic_ops
->config_led(adapter
, 0, 0xf))
985 dev_err(&adapter
->pdev
->dev
,
986 "Failed to reset LED blink state.\n");
994 if (test_and_clear_bit(__QLCNIC_DIAG_RES_ALLOC
, &adapter
->state
))
995 qlcnic_diag_free_res(dev
, max_sds_rings
);
998 clear_bit(__QLCNIC_LED_ENABLE
, &adapter
->state
);
1004 qlcnic_get_wol(struct net_device
*dev
, struct ethtool_wolinfo
*wol
)
1006 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
1012 wol_cfg
= QLCRD32(adapter
, QLCNIC_WOL_CONFIG_NV
);
1013 if (wol_cfg
& (1UL << adapter
->portnum
))
1014 wol
->supported
|= WAKE_MAGIC
;
1016 wol_cfg
= QLCRD32(adapter
, QLCNIC_WOL_CONFIG
);
1017 if (wol_cfg
& (1UL << adapter
->portnum
))
1018 wol
->wolopts
|= WAKE_MAGIC
;
1022 qlcnic_set_wol(struct net_device
*dev
, struct ethtool_wolinfo
*wol
)
1024 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
1027 if (wol
->wolopts
& ~WAKE_MAGIC
)
1030 wol_cfg
= QLCRD32(adapter
, QLCNIC_WOL_CONFIG_NV
);
1031 if (!(wol_cfg
& (1 << adapter
->portnum
)))
1034 wol_cfg
= QLCRD32(adapter
, QLCNIC_WOL_CONFIG
);
1035 if (wol
->wolopts
& WAKE_MAGIC
)
1036 wol_cfg
|= 1UL << adapter
->portnum
;
1038 wol_cfg
&= ~(1UL << adapter
->portnum
);
1040 QLCWR32(adapter
, QLCNIC_WOL_CONFIG
, wol_cfg
);
1046 * Set the coalescing parameters. Currently only normal is supported.
1047 * If rx_coalesce_usecs == 0 or rx_max_coalesced_frames == 0 then set the
1048 * firmware coalescing to default.
1050 static int qlcnic_set_intr_coalesce(struct net_device
*netdev
,
1051 struct ethtool_coalesce
*ethcoal
)
1053 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1055 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
1059 * Return Error if unsupported values or
1060 * unsupported parameters are set.
1062 if (ethcoal
->rx_coalesce_usecs
> 0xffff ||
1063 ethcoal
->rx_max_coalesced_frames
> 0xffff ||
1064 ethcoal
->tx_coalesce_usecs
||
1065 ethcoal
->tx_max_coalesced_frames
||
1066 ethcoal
->rx_coalesce_usecs_irq
||
1067 ethcoal
->rx_max_coalesced_frames_irq
||
1068 ethcoal
->tx_coalesce_usecs_irq
||
1069 ethcoal
->tx_max_coalesced_frames_irq
||
1070 ethcoal
->stats_block_coalesce_usecs
||
1071 ethcoal
->use_adaptive_rx_coalesce
||
1072 ethcoal
->use_adaptive_tx_coalesce
||
1073 ethcoal
->pkt_rate_low
||
1074 ethcoal
->rx_coalesce_usecs_low
||
1075 ethcoal
->rx_max_coalesced_frames_low
||
1076 ethcoal
->tx_coalesce_usecs_low
||
1077 ethcoal
->tx_max_coalesced_frames_low
||
1078 ethcoal
->pkt_rate_high
||
1079 ethcoal
->rx_coalesce_usecs_high
||
1080 ethcoal
->rx_max_coalesced_frames_high
||
1081 ethcoal
->tx_coalesce_usecs_high
||
1082 ethcoal
->tx_max_coalesced_frames_high
)
1085 if (!ethcoal
->rx_coalesce_usecs
||
1086 !ethcoal
->rx_max_coalesced_frames
) {
1087 adapter
->ahw
->coal
.flag
= QLCNIC_INTR_DEFAULT
;
1088 adapter
->ahw
->coal
.rx_time_us
=
1089 QLCNIC_DEFAULT_INTR_COALESCE_RX_TIME_US
;
1090 adapter
->ahw
->coal
.rx_packets
=
1091 QLCNIC_DEFAULT_INTR_COALESCE_RX_PACKETS
;
1093 adapter
->ahw
->coal
.flag
= 0;
1094 adapter
->ahw
->coal
.rx_time_us
= ethcoal
->rx_coalesce_usecs
;
1095 adapter
->ahw
->coal
.rx_packets
=
1096 ethcoal
->rx_max_coalesced_frames
;
1099 qlcnic_config_intr_coalesce(adapter
);
1104 static int qlcnic_get_intr_coalesce(struct net_device
*netdev
,
1105 struct ethtool_coalesce
*ethcoal
)
1107 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1109 if (adapter
->is_up
!= QLCNIC_ADAPTER_UP_MAGIC
)
1112 ethcoal
->rx_coalesce_usecs
= adapter
->ahw
->coal
.rx_time_us
;
1113 ethcoal
->rx_max_coalesced_frames
= adapter
->ahw
->coal
.rx_packets
;
1118 static u32
qlcnic_get_msglevel(struct net_device
*netdev
)
1120 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1122 return adapter
->msg_enable
;
1125 static void qlcnic_set_msglevel(struct net_device
*netdev
, u32 msglvl
)
1127 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1129 adapter
->msg_enable
= msglvl
;
1133 qlcnic_get_dump_flag(struct net_device
*netdev
, struct ethtool_dump
*dump
)
1135 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1136 struct qlcnic_fw_dump
*fw_dump
= &adapter
->ahw
->fw_dump
;
1139 dump
->len
= fw_dump
->tmpl_hdr
->size
+ fw_dump
->size
;
1142 dump
->flag
= fw_dump
->tmpl_hdr
->drv_cap_mask
;
1143 dump
->version
= adapter
->fw_version
;
1148 qlcnic_get_dump_data(struct net_device
*netdev
, struct ethtool_dump
*dump
,
1152 u32
*hdr_ptr
, *data
;
1153 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1154 struct qlcnic_fw_dump
*fw_dump
= &adapter
->ahw
->fw_dump
;
1156 if (!fw_dump
->clr
) {
1157 netdev_info(netdev
, "Dump not available\n");
1158 qlcnic_api_unlock(adapter
);
1161 /* Copy template header first */
1162 copy_sz
= fw_dump
->tmpl_hdr
->size
;
1163 hdr_ptr
= (u32
*) fw_dump
->tmpl_hdr
;
1165 for (i
= 0; i
< copy_sz
/sizeof(u32
); i
++)
1166 *data
++ = cpu_to_le32(*hdr_ptr
++);
1168 /* Copy captured dump data */
1169 memcpy(buffer
+ copy_sz
, fw_dump
->data
, fw_dump
->size
);
1170 dump
->len
= copy_sz
+ fw_dump
->size
;
1171 dump
->flag
= fw_dump
->tmpl_hdr
->drv_cap_mask
;
1173 /* Free dump area once data has been captured */
1174 vfree(fw_dump
->data
);
1175 fw_dump
->data
= NULL
;
1182 qlcnic_set_dump(struct net_device
*netdev
, struct ethtool_dump
*val
)
1185 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1186 struct qlcnic_fw_dump
*fw_dump
= &adapter
->ahw
->fw_dump
;
1188 switch (val
->flag
) {
1189 case QLCNIC_FORCE_FW_DUMP_KEY
:
1190 if (!fw_dump
->enable
) {
1191 netdev_info(netdev
, "FW dump not enabled\n");
1195 dev_info(&adapter
->pdev
->dev
,
1196 "Previous dump not cleared, not forcing dump\n");
1199 netdev_info(netdev
, "Forcing a FW dump\n");
1200 qlcnic_dev_request_reset(adapter
);
1202 case QLCNIC_DISABLE_FW_DUMP
:
1203 if (fw_dump
->enable
) {
1204 netdev_info(netdev
, "Disabling FW dump\n");
1205 fw_dump
->enable
= 0;
1208 case QLCNIC_ENABLE_FW_DUMP
:
1209 if (!fw_dump
->enable
&& fw_dump
->tmpl_hdr
) {
1210 netdev_info(netdev
, "Enabling FW dump\n");
1211 fw_dump
->enable
= 1;
1214 case QLCNIC_FORCE_FW_RESET
:
1215 netdev_info(netdev
, "Forcing a FW reset\n");
1216 qlcnic_dev_request_reset(adapter
);
1217 adapter
->flags
&= ~QLCNIC_FW_RESET_OWNER
;
1220 if (val
->flag
> QLCNIC_DUMP_MASK_MAX
||
1221 val
->flag
< QLCNIC_DUMP_MASK_MIN
) {
1223 "Invalid dump level: 0x%x\n", val
->flag
);
1227 fw_dump
->tmpl_hdr
->drv_cap_mask
= val
->flag
& 0xff;
1228 netdev_info(netdev
, "Driver mask changed to: 0x%x\n",
1229 fw_dump
->tmpl_hdr
->drv_cap_mask
);
1235 const struct ethtool_ops qlcnic_ethtool_ops
= {
1236 .get_settings
= qlcnic_get_settings
,
1237 .set_settings
= qlcnic_set_settings
,
1238 .get_drvinfo
= qlcnic_get_drvinfo
,
1239 .get_regs_len
= qlcnic_get_regs_len
,
1240 .get_regs
= qlcnic_get_regs
,
1241 .get_link
= ethtool_op_get_link
,
1242 .get_eeprom_len
= qlcnic_get_eeprom_len
,
1243 .get_eeprom
= qlcnic_get_eeprom
,
1244 .get_ringparam
= qlcnic_get_ringparam
,
1245 .set_ringparam
= qlcnic_set_ringparam
,
1246 .get_channels
= qlcnic_get_channels
,
1247 .set_channels
= qlcnic_set_channels
,
1248 .get_pauseparam
= qlcnic_get_pauseparam
,
1249 .set_pauseparam
= qlcnic_set_pauseparam
,
1250 .get_wol
= qlcnic_get_wol
,
1251 .set_wol
= qlcnic_set_wol
,
1252 .self_test
= qlcnic_diag_test
,
1253 .get_strings
= qlcnic_get_strings
,
1254 .get_ethtool_stats
= qlcnic_get_ethtool_stats
,
1255 .get_sset_count
= qlcnic_get_sset_count
,
1256 .get_coalesce
= qlcnic_get_intr_coalesce
,
1257 .set_coalesce
= qlcnic_set_intr_coalesce
,
1258 .set_phys_id
= qlcnic_set_led
,
1259 .set_msglevel
= qlcnic_set_msglevel
,
1260 .get_msglevel
= qlcnic_get_msglevel
,
1261 .get_dump_flag
= qlcnic_get_dump_flag
,
1262 .get_dump_data
= qlcnic_get_dump_data
,
1263 .set_dump
= qlcnic_set_dump
,