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;
159 /* read which mode */
160 if (adapter
->ahw
->port_type
== QLCNIC_GBE
) {
161 ecmd
->supported
= (SUPPORTED_10baseT_Half
|
162 SUPPORTED_10baseT_Full
|
163 SUPPORTED_100baseT_Half
|
164 SUPPORTED_100baseT_Full
|
165 SUPPORTED_1000baseT_Half
|
166 SUPPORTED_1000baseT_Full
);
168 ecmd
->advertising
= (ADVERTISED_100baseT_Half
|
169 ADVERTISED_100baseT_Full
|
170 ADVERTISED_1000baseT_Half
|
171 ADVERTISED_1000baseT_Full
);
173 ethtool_cmd_speed_set(ecmd
, adapter
->link_speed
);
174 ecmd
->duplex
= adapter
->link_duplex
;
175 ecmd
->autoneg
= adapter
->link_autoneg
;
177 } else if (adapter
->ahw
->port_type
== QLCNIC_XGBE
) {
180 val
= QLCRD32(adapter
, QLCNIC_PORT_MODE_ADDR
);
181 if (val
== QLCNIC_PORT_MODE_802_3_AP
) {
182 ecmd
->supported
= SUPPORTED_1000baseT_Full
;
183 ecmd
->advertising
= ADVERTISED_1000baseT_Full
;
185 ecmd
->supported
= SUPPORTED_10000baseT_Full
;
186 ecmd
->advertising
= ADVERTISED_10000baseT_Full
;
189 if (netif_running(dev
) && adapter
->has_link_events
) {
190 ethtool_cmd_speed_set(ecmd
, adapter
->link_speed
);
191 ecmd
->autoneg
= adapter
->link_autoneg
;
192 ecmd
->duplex
= adapter
->link_duplex
;
196 ethtool_cmd_speed_set(ecmd
, SPEED_UNKNOWN
);
197 ecmd
->duplex
= DUPLEX_UNKNOWN
;
198 ecmd
->autoneg
= AUTONEG_DISABLE
;
203 ecmd
->phy_address
= adapter
->physical_port
;
204 ecmd
->transceiver
= XCVR_EXTERNAL
;
206 switch (adapter
->ahw
->board_type
) {
207 case QLCNIC_BRDTYPE_P3P_REF_QG
:
208 case QLCNIC_BRDTYPE_P3P_4_GB
:
209 case QLCNIC_BRDTYPE_P3P_4_GB_MM
:
211 ecmd
->supported
|= SUPPORTED_Autoneg
;
212 ecmd
->advertising
|= ADVERTISED_Autoneg
;
213 case QLCNIC_BRDTYPE_P3P_10G_CX4
:
214 case QLCNIC_BRDTYPE_P3P_10G_CX4_LP
:
215 case QLCNIC_BRDTYPE_P3P_10000_BASE_T
:
216 ecmd
->supported
|= SUPPORTED_TP
;
217 ecmd
->advertising
|= ADVERTISED_TP
;
218 ecmd
->port
= PORT_TP
;
219 ecmd
->autoneg
= adapter
->link_autoneg
;
221 case QLCNIC_BRDTYPE_P3P_IMEZ
:
222 case QLCNIC_BRDTYPE_P3P_XG_LOM
:
223 case QLCNIC_BRDTYPE_P3P_HMEZ
:
224 ecmd
->supported
|= SUPPORTED_MII
;
225 ecmd
->advertising
|= ADVERTISED_MII
;
226 ecmd
->port
= PORT_MII
;
227 ecmd
->autoneg
= AUTONEG_DISABLE
;
229 case QLCNIC_BRDTYPE_P3P_10G_SFP_PLUS
:
230 case QLCNIC_BRDTYPE_P3P_10G_SFP_CT
:
231 case QLCNIC_BRDTYPE_P3P_10G_SFP_QT
:
232 ecmd
->advertising
|= ADVERTISED_TP
;
233 ecmd
->supported
|= SUPPORTED_TP
;
234 check_sfp_module
= netif_running(dev
) &&
235 adapter
->has_link_events
;
236 case QLCNIC_BRDTYPE_P3P_10G_XFP
:
237 ecmd
->supported
|= SUPPORTED_FIBRE
;
238 ecmd
->advertising
|= ADVERTISED_FIBRE
;
239 ecmd
->port
= PORT_FIBRE
;
240 ecmd
->autoneg
= AUTONEG_DISABLE
;
242 case QLCNIC_BRDTYPE_P3P_10G_TP
:
243 if (adapter
->ahw
->port_type
== QLCNIC_XGBE
) {
244 ecmd
->autoneg
= AUTONEG_DISABLE
;
245 ecmd
->supported
|= (SUPPORTED_FIBRE
| SUPPORTED_TP
);
247 (ADVERTISED_FIBRE
| ADVERTISED_TP
);
248 ecmd
->port
= PORT_FIBRE
;
249 check_sfp_module
= netif_running(dev
) &&
250 adapter
->has_link_events
;
252 ecmd
->autoneg
= AUTONEG_ENABLE
;
253 ecmd
->supported
|= (SUPPORTED_TP
| SUPPORTED_Autoneg
);
255 (ADVERTISED_TP
| ADVERTISED_Autoneg
);
256 ecmd
->port
= PORT_TP
;
260 dev_err(&adapter
->pdev
->dev
, "Unsupported board model %d\n",
261 adapter
->ahw
->board_type
);
265 if (check_sfp_module
) {
266 switch (adapter
->module_type
) {
267 case LINKEVENT_MODULE_OPTICAL_UNKNOWN
:
268 case LINKEVENT_MODULE_OPTICAL_SRLR
:
269 case LINKEVENT_MODULE_OPTICAL_LRM
:
270 case LINKEVENT_MODULE_OPTICAL_SFP_1G
:
271 ecmd
->port
= PORT_FIBRE
;
273 case LINKEVENT_MODULE_TWINAX_UNSUPPORTED_CABLE
:
274 case LINKEVENT_MODULE_TWINAX_UNSUPPORTED_CABLELEN
:
275 case LINKEVENT_MODULE_TWINAX
:
276 ecmd
->port
= PORT_TP
;
279 ecmd
->port
= PORT_OTHER
;
287 qlcnic_set_settings(struct net_device
*dev
, struct ethtool_cmd
*ecmd
)
291 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
293 if (adapter
->ahw
->port_type
!= QLCNIC_GBE
)
296 /* read which mode */
303 switch (ethtool_cmd_speed(ecmd
)) {
317 ret
= qlcnic_fw_cmd_set_port(adapter
, config
);
319 if (ret
== QLCNIC_RCODE_NOT_SUPPORTED
)
324 adapter
->link_speed
= ethtool_cmd_speed(ecmd
);
325 adapter
->link_duplex
= ecmd
->duplex
;
326 adapter
->link_autoneg
= ecmd
->autoneg
;
328 if (!netif_running(dev
))
331 dev
->netdev_ops
->ndo_stop(dev
);
332 return dev
->netdev_ops
->ndo_open(dev
);
336 qlcnic_get_regs(struct net_device
*dev
, struct ethtool_regs
*regs
, void *p
)
338 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
339 struct qlcnic_recv_context
*recv_ctx
= adapter
->recv_ctx
;
340 struct qlcnic_host_sds_ring
*sds_ring
;
342 int ring
, i
= 0, j
= 0;
344 memset(p
, 0, qlcnic_get_regs_len(dev
));
345 regs
->version
= (QLCNIC_ETHTOOL_REGS_VER
<< 24) |
346 (adapter
->ahw
->revision_id
<< 16) | (adapter
->pdev
)->device
;
348 regs_buff
[0] = (0xcafe0000 | (QLCNIC_DEV_INFO_SIZE
& 0xffff));
349 regs_buff
[1] = QLCNIC_MGMT_API_VERSION
;
351 for (i
= QLCNIC_DEV_INFO_SIZE
+ 1; diag_registers
[j
] != -1; j
++, i
++)
352 regs_buff
[i
] = QLCRD32(adapter
, diag_registers
[j
]);
354 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
357 regs_buff
[i
++] = 0xFFEFCDAB; /* Marker btw regs and ring count*/
359 regs_buff
[i
++] = 1; /* No. of tx ring */
360 regs_buff
[i
++] = le32_to_cpu(*(adapter
->tx_ring
->hw_consumer
));
361 regs_buff
[i
++] = readl(adapter
->tx_ring
->crb_cmd_producer
);
363 regs_buff
[i
++] = 2; /* No. of rx ring */
364 regs_buff
[i
++] = readl(recv_ctx
->rds_rings
[0].crb_rcv_producer
);
365 regs_buff
[i
++] = readl(recv_ctx
->rds_rings
[1].crb_rcv_producer
);
367 regs_buff
[i
++] = adapter
->max_sds_rings
;
369 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
370 sds_ring
= &(recv_ctx
->sds_rings
[ring
]);
371 regs_buff
[i
++] = readl(sds_ring
->crb_sts_consumer
);
375 static u32
qlcnic_test_link(struct net_device
*dev
)
377 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
380 val
= QLCRD32(adapter
, CRB_XG_STATE_P3P
);
381 val
= XG_LINK_STATE_P3P(adapter
->ahw
->pci_func
, val
);
382 return (val
== XG_LINK_UP_P3P
) ? 0 : 1;
386 qlcnic_get_eeprom(struct net_device
*dev
, struct ethtool_eeprom
*eeprom
,
389 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
393 if (eeprom
->len
== 0)
396 eeprom
->magic
= (adapter
->pdev
)->vendor
|
397 ((adapter
->pdev
)->device
<< 16);
398 offset
= eeprom
->offset
;
400 ret
= qlcnic_rom_fast_read_words(adapter
, offset
, bytes
,
409 qlcnic_get_ringparam(struct net_device
*dev
,
410 struct ethtool_ringparam
*ring
)
412 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
414 ring
->rx_pending
= adapter
->num_rxd
;
415 ring
->rx_jumbo_pending
= adapter
->num_jumbo_rxd
;
416 ring
->tx_pending
= adapter
->num_txd
;
418 ring
->rx_max_pending
= adapter
->max_rxd
;
419 ring
->rx_jumbo_max_pending
= adapter
->max_jumbo_rxd
;
420 ring
->tx_max_pending
= MAX_CMD_DESCRIPTORS
;
424 qlcnic_validate_ringparam(u32 val
, u32 min
, u32 max
, char *r_name
)
427 num_desc
= max(val
, min
);
428 num_desc
= min(num_desc
, max
);
429 num_desc
= roundup_pow_of_two(num_desc
);
431 if (val
!= num_desc
) {
432 printk(KERN_INFO
"%s: setting %s ring size %d instead of %d\n",
433 qlcnic_driver_name
, r_name
, num_desc
, val
);
440 qlcnic_set_ringparam(struct net_device
*dev
,
441 struct ethtool_ringparam
*ring
)
443 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
444 u16 num_rxd
, num_jumbo_rxd
, num_txd
;
446 if (ring
->rx_mini_pending
)
449 num_rxd
= qlcnic_validate_ringparam(ring
->rx_pending
,
450 MIN_RCV_DESCRIPTORS
, adapter
->max_rxd
, "rx");
452 num_jumbo_rxd
= qlcnic_validate_ringparam(ring
->rx_jumbo_pending
,
453 MIN_JUMBO_DESCRIPTORS
, adapter
->max_jumbo_rxd
,
456 num_txd
= qlcnic_validate_ringparam(ring
->tx_pending
,
457 MIN_CMD_DESCRIPTORS
, MAX_CMD_DESCRIPTORS
, "tx");
459 if (num_rxd
== adapter
->num_rxd
&& num_txd
== adapter
->num_txd
&&
460 num_jumbo_rxd
== adapter
->num_jumbo_rxd
)
463 adapter
->num_rxd
= num_rxd
;
464 adapter
->num_jumbo_rxd
= num_jumbo_rxd
;
465 adapter
->num_txd
= num_txd
;
467 return qlcnic_reset_context(adapter
);
470 static void qlcnic_get_channels(struct net_device
*dev
,
471 struct ethtool_channels
*channel
)
473 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
475 channel
->max_rx
= rounddown_pow_of_two(min_t(int,
476 adapter
->max_rx_ques
, num_online_cpus()));
477 channel
->max_tx
= adapter
->max_tx_ques
;
479 channel
->rx_count
= adapter
->max_sds_rings
;
480 channel
->tx_count
= adapter
->max_tx_ques
;
483 static int qlcnic_set_channels(struct net_device
*dev
,
484 struct ethtool_channels
*channel
)
486 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
489 if (channel
->other_count
|| channel
->combined_count
||
490 channel
->tx_count
!= channel
->max_tx
)
493 err
= qlcnic_validate_max_rss(dev
, channel
->max_rx
, channel
->rx_count
);
497 err
= qlcnic_set_max_rss(adapter
, channel
->rx_count
);
498 netdev_info(dev
, "allocated 0x%x sds rings\n",
499 adapter
->max_sds_rings
);
504 qlcnic_get_pauseparam(struct net_device
*netdev
,
505 struct ethtool_pauseparam
*pause
)
507 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
508 int port
= adapter
->physical_port
;
511 if (adapter
->ahw
->port_type
== QLCNIC_GBE
) {
512 if ((port
< 0) || (port
> QLCNIC_NIU_MAX_GBE_PORTS
))
514 /* get flow control settings */
515 val
= QLCRD32(adapter
, QLCNIC_NIU_GB_MAC_CONFIG_0(port
));
516 pause
->rx_pause
= qlcnic_gb_get_rx_flowctl(val
);
517 val
= QLCRD32(adapter
, QLCNIC_NIU_GB_PAUSE_CTL
);
520 pause
->tx_pause
= !(qlcnic_gb_get_gb0_mask(val
));
523 pause
->tx_pause
= !(qlcnic_gb_get_gb1_mask(val
));
526 pause
->tx_pause
= !(qlcnic_gb_get_gb2_mask(val
));
530 pause
->tx_pause
= !(qlcnic_gb_get_gb3_mask(val
));
533 } else if (adapter
->ahw
->port_type
== QLCNIC_XGBE
) {
534 if ((port
< 0) || (port
> QLCNIC_NIU_MAX_XG_PORTS
))
537 val
= QLCRD32(adapter
, QLCNIC_NIU_XG_PAUSE_CTL
);
539 pause
->tx_pause
= !(qlcnic_xg_get_xg0_mask(val
));
541 pause
->tx_pause
= !(qlcnic_xg_get_xg1_mask(val
));
543 dev_err(&netdev
->dev
, "Unknown board type: %x\n",
544 adapter
->ahw
->port_type
);
549 qlcnic_set_pauseparam(struct net_device
*netdev
,
550 struct ethtool_pauseparam
*pause
)
552 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
553 int port
= adapter
->physical_port
;
557 if (adapter
->ahw
->port_type
== QLCNIC_GBE
) {
558 if ((port
< 0) || (port
> QLCNIC_NIU_MAX_GBE_PORTS
))
560 /* set flow control */
561 val
= QLCRD32(adapter
, QLCNIC_NIU_GB_MAC_CONFIG_0(port
));
564 qlcnic_gb_rx_flowctl(val
);
566 qlcnic_gb_unset_rx_flowctl(val
);
568 QLCWR32(adapter
, QLCNIC_NIU_GB_MAC_CONFIG_0(port
),
571 val
= QLCRD32(adapter
, QLCNIC_NIU_GB_PAUSE_CTL
);
575 qlcnic_gb_unset_gb0_mask(val
);
577 qlcnic_gb_set_gb0_mask(val
);
581 qlcnic_gb_unset_gb1_mask(val
);
583 qlcnic_gb_set_gb1_mask(val
);
587 qlcnic_gb_unset_gb2_mask(val
);
589 qlcnic_gb_set_gb2_mask(val
);
594 qlcnic_gb_unset_gb3_mask(val
);
596 qlcnic_gb_set_gb3_mask(val
);
599 QLCWR32(adapter
, QLCNIC_NIU_GB_PAUSE_CTL
, val
);
600 } else if (adapter
->ahw
->port_type
== QLCNIC_XGBE
) {
601 if (!pause
->rx_pause
|| pause
->autoneg
)
604 if ((port
< 0) || (port
> QLCNIC_NIU_MAX_XG_PORTS
))
607 val
= QLCRD32(adapter
, QLCNIC_NIU_XG_PAUSE_CTL
);
610 qlcnic_xg_unset_xg0_mask(val
);
612 qlcnic_xg_set_xg0_mask(val
);
615 qlcnic_xg_unset_xg1_mask(val
);
617 qlcnic_xg_set_xg1_mask(val
);
619 QLCWR32(adapter
, QLCNIC_NIU_XG_PAUSE_CTL
, val
);
621 dev_err(&netdev
->dev
, "Unknown board type: %x\n",
622 adapter
->ahw
->port_type
);
627 static int qlcnic_reg_test(struct net_device
*dev
)
629 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
632 data_read
= QLCRD32(adapter
, QLCNIC_PCIX_PH_REG(0));
633 if ((data_read
& 0xffff) != adapter
->pdev
->vendor
)
639 static int qlcnic_get_sset_count(struct net_device
*dev
, int sset
)
641 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
644 return QLCNIC_TEST_LEN
;
646 if (adapter
->flags
& QLCNIC_ESWITCH_ENABLED
)
647 return QLCNIC_STATS_LEN
+ QLCNIC_DEVICE_STATS_LEN
;
648 return QLCNIC_STATS_LEN
;
654 static int qlcnic_irq_test(struct net_device
*netdev
)
656 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
657 int max_sds_rings
= adapter
->max_sds_rings
;
659 struct qlcnic_cmd_args cmd
;
661 if (test_and_set_bit(__QLCNIC_RESETTING
, &adapter
->state
))
664 ret
= qlcnic_diag_alloc_res(netdev
, QLCNIC_INTERRUPT_TEST
);
668 adapter
->diag_cnt
= 0;
669 memset(&cmd
, 0, sizeof(cmd
));
670 cmd
.req
.cmd
= QLCNIC_CDRP_CMD_INTRPT_TEST
;
671 cmd
.req
.arg1
= adapter
->ahw
->pci_func
;
672 qlcnic_issue_cmd(adapter
, &cmd
);
680 ret
= !adapter
->diag_cnt
;
683 qlcnic_diag_free_res(netdev
, max_sds_rings
);
686 adapter
->max_sds_rings
= max_sds_rings
;
687 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
691 #define QLCNIC_ILB_PKT_SIZE 64
692 #define QLCNIC_NUM_ILB_PKT 16
693 #define QLCNIC_ILB_MAX_RCV_LOOP 10
695 static void qlcnic_create_loopback_buff(unsigned char *data
, u8 mac
[])
697 unsigned char random_data
[] = {0xa8, 0x06, 0x45, 0x00};
699 memset(data
, 0x4e, QLCNIC_ILB_PKT_SIZE
);
701 memcpy(data
, mac
, ETH_ALEN
);
702 memcpy(data
+ ETH_ALEN
, mac
, ETH_ALEN
);
704 memcpy(data
+ 2 * ETH_ALEN
, random_data
, sizeof(random_data
));
707 int qlcnic_check_loopback_buff(unsigned char *data
, u8 mac
[])
709 unsigned char buff
[QLCNIC_ILB_PKT_SIZE
];
710 qlcnic_create_loopback_buff(buff
, mac
);
711 return memcmp(data
, buff
, QLCNIC_ILB_PKT_SIZE
);
714 static int qlcnic_do_lb_test(struct qlcnic_adapter
*adapter
, u8 mode
)
716 struct qlcnic_recv_context
*recv_ctx
= adapter
->recv_ctx
;
717 struct qlcnic_host_sds_ring
*sds_ring
= &recv_ctx
->sds_rings
[0];
719 int i
, loop
, cnt
= 0;
721 for (i
= 0; i
< QLCNIC_NUM_ILB_PKT
; i
++) {
722 skb
= netdev_alloc_skb(adapter
->netdev
, QLCNIC_ILB_PKT_SIZE
);
723 qlcnic_create_loopback_buff(skb
->data
, adapter
->mac_addr
);
724 skb_put(skb
, QLCNIC_ILB_PKT_SIZE
);
726 adapter
->diag_cnt
= 0;
727 qlcnic_xmit_frame(skb
, adapter
->netdev
);
732 qlcnic_process_rcv_ring_diag(sds_ring
);
733 if (loop
++ > QLCNIC_ILB_MAX_RCV_LOOP
)
735 } while (!adapter
->diag_cnt
);
737 dev_kfree_skb_any(skb
);
739 if (!adapter
->diag_cnt
)
741 "LB Test: packet #%d was not received\n", i
+ 1);
746 dev_warn(&adapter
->pdev
->dev
, "LB Test failed\n");
747 if (mode
!= QLCNIC_ILB_MODE
) {
748 dev_warn(&adapter
->pdev
->dev
,
749 "WARNING: Please make sure external"
750 "loopback connector is plugged in\n");
757 static int qlcnic_loopback_test(struct net_device
*netdev
, u8 mode
)
759 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
760 int max_sds_rings
= adapter
->max_sds_rings
;
761 struct qlcnic_host_sds_ring
*sds_ring
;
765 if (!(adapter
->capabilities
& QLCNIC_FW_CAPABILITY_MULTI_LOOPBACK
)) {
766 netdev_info(netdev
, "Firmware is not loopback test capable\n");
770 QLCDB(adapter
, DRV
, "%s loopback test in progress\n",
771 mode
== QLCNIC_ILB_MODE
? "internal" : "external");
772 if (adapter
->op_mode
== QLCNIC_NON_PRIV_FUNC
) {
773 netdev_warn(netdev
, "Loopback test not supported for non "
774 "privilege function\n");
778 if (test_and_set_bit(__QLCNIC_RESETTING
, &adapter
->state
))
781 ret
= qlcnic_diag_alloc_res(netdev
, QLCNIC_LOOPBACK_TEST
);
785 sds_ring
= &adapter
->recv_ctx
->sds_rings
[0];
787 ret
= qlcnic_set_lb_mode(adapter
, mode
);
791 adapter
->diag_cnt
= 0;
794 qlcnic_process_rcv_ring_diag(sds_ring
);
795 if (loop
++ > QLCNIC_ILB_MAX_RCV_LOOP
) {
796 netdev_info(netdev
, "firmware didnt respond to loopback"
797 " configure request\n");
798 ret
= -QLCNIC_FW_NOT_RESPOND
;
800 } else if (adapter
->diag_cnt
) {
801 ret
= adapter
->diag_cnt
;
804 } while (!QLCNIC_IS_LB_CONFIGURED(adapter
->ahw
->loopback_state
));
806 ret
= qlcnic_do_lb_test(adapter
, mode
);
808 qlcnic_clear_lb_mode(adapter
);
811 qlcnic_diag_free_res(netdev
, max_sds_rings
);
814 adapter
->max_sds_rings
= max_sds_rings
;
815 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
820 qlcnic_diag_test(struct net_device
*dev
, struct ethtool_test
*eth_test
,
823 memset(data
, 0, sizeof(u64
) * QLCNIC_TEST_LEN
);
825 data
[0] = qlcnic_reg_test(dev
);
827 eth_test
->flags
|= ETH_TEST_FL_FAILED
;
829 data
[1] = (u64
) qlcnic_test_link(dev
);
831 eth_test
->flags
|= ETH_TEST_FL_FAILED
;
833 if (eth_test
->flags
& ETH_TEST_FL_OFFLINE
) {
834 data
[2] = qlcnic_irq_test(dev
);
836 eth_test
->flags
|= ETH_TEST_FL_FAILED
;
838 data
[3] = qlcnic_loopback_test(dev
, QLCNIC_ILB_MODE
);
840 eth_test
->flags
|= ETH_TEST_FL_FAILED
;
841 if (eth_test
->flags
& ETH_TEST_FL_EXTERNAL_LB
) {
842 data
[4] = qlcnic_loopback_test(dev
, QLCNIC_ELB_MODE
);
844 eth_test
->flags
|= ETH_TEST_FL_FAILED
;
845 eth_test
->flags
|= ETH_TEST_FL_EXTERNAL_LB_DONE
;
851 qlcnic_get_strings(struct net_device
*dev
, u32 stringset
, u8
* data
)
853 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
858 memcpy(data
, *qlcnic_gstrings_test
,
859 QLCNIC_TEST_LEN
* ETH_GSTRING_LEN
);
862 for (index
= 0; index
< QLCNIC_STATS_LEN
; index
++) {
863 memcpy(data
+ index
* ETH_GSTRING_LEN
,
864 qlcnic_gstrings_stats
[index
].stat_string
,
867 if (!(adapter
->flags
& QLCNIC_ESWITCH_ENABLED
))
869 for (i
= 0; i
< QLCNIC_DEVICE_STATS_LEN
; index
++, i
++) {
870 memcpy(data
+ index
* ETH_GSTRING_LEN
,
871 qlcnic_device_gstrings_stats
[i
],
877 #define QLCNIC_FILL_ESWITCH_STATS(VAL1) \
878 (((VAL1) == QLCNIC_ESW_STATS_NOT_AVAIL) ? 0 : VAL1)
881 qlcnic_fill_device_stats(int *index
, u64
*data
,
882 struct __qlcnic_esw_statistics
*stats
)
886 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->unicast_frames
);
887 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->multicast_frames
);
888 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->broadcast_frames
);
889 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->dropped_frames
);
890 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->errors
);
891 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->local_frames
);
892 data
[ind
++] = QLCNIC_FILL_ESWITCH_STATS(stats
->numbytes
);
898 qlcnic_get_ethtool_stats(struct net_device
*dev
,
899 struct ethtool_stats
*stats
, u64
* data
)
901 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
902 struct qlcnic_esw_statistics port_stats
;
905 for (index
= 0; index
< QLCNIC_STATS_LEN
; index
++) {
908 qlcnic_gstrings_stats
[index
].stat_offset
;
910 (qlcnic_gstrings_stats
[index
].sizeof_stat
==
911 sizeof(u64
)) ? *(u64
*)p
:(*(u32
*)p
);
914 if (!(adapter
->flags
& QLCNIC_ESWITCH_ENABLED
))
917 memset(&port_stats
, 0, sizeof(struct qlcnic_esw_statistics
));
918 ret
= qlcnic_get_port_stats(adapter
, adapter
->ahw
->pci_func
,
919 QLCNIC_QUERY_RX_COUNTER
, &port_stats
.rx
);
923 qlcnic_fill_device_stats(&index
, data
, &port_stats
.rx
);
925 ret
= qlcnic_get_port_stats(adapter
, adapter
->ahw
->pci_func
,
926 QLCNIC_QUERY_TX_COUNTER
, &port_stats
.tx
);
930 qlcnic_fill_device_stats(&index
, data
, &port_stats
.tx
);
933 static int qlcnic_set_led(struct net_device
*dev
,
934 enum ethtool_phys_id_state state
)
936 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
937 int max_sds_rings
= adapter
->max_sds_rings
;
938 int err
= -EIO
, active
= 1;
940 if (adapter
->op_mode
== QLCNIC_NON_PRIV_FUNC
) {
941 netdev_warn(dev
, "LED test not supported for non "
942 "privilege function\n");
947 case ETHTOOL_ID_ACTIVE
:
948 if (test_and_set_bit(__QLCNIC_LED_ENABLE
, &adapter
->state
))
951 if (test_bit(__QLCNIC_RESETTING
, &adapter
->state
))
954 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
)) {
955 if (qlcnic_diag_alloc_res(dev
, QLCNIC_LED_TEST
))
957 set_bit(__QLCNIC_DIAG_RES_ALLOC
, &adapter
->state
);
960 if (adapter
->nic_ops
->config_led(adapter
, 1, 0xf) == 0) {
965 dev_err(&adapter
->pdev
->dev
,
966 "Failed to set LED blink state.\n");
969 case ETHTOOL_ID_INACTIVE
:
972 if (test_bit(__QLCNIC_RESETTING
, &adapter
->state
))
975 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
)) {
976 if (qlcnic_diag_alloc_res(dev
, QLCNIC_LED_TEST
))
978 set_bit(__QLCNIC_DIAG_RES_ALLOC
, &adapter
->state
);
981 if (adapter
->nic_ops
->config_led(adapter
, 0, 0xf))
982 dev_err(&adapter
->pdev
->dev
,
983 "Failed to reset LED blink state.\n");
991 if (test_and_clear_bit(__QLCNIC_DIAG_RES_ALLOC
, &adapter
->state
))
992 qlcnic_diag_free_res(dev
, max_sds_rings
);
995 clear_bit(__QLCNIC_LED_ENABLE
, &adapter
->state
);
1001 qlcnic_get_wol(struct net_device
*dev
, struct ethtool_wolinfo
*wol
)
1003 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
1009 wol_cfg
= QLCRD32(adapter
, QLCNIC_WOL_CONFIG_NV
);
1010 if (wol_cfg
& (1UL << adapter
->portnum
))
1011 wol
->supported
|= WAKE_MAGIC
;
1013 wol_cfg
= QLCRD32(adapter
, QLCNIC_WOL_CONFIG
);
1014 if (wol_cfg
& (1UL << adapter
->portnum
))
1015 wol
->wolopts
|= WAKE_MAGIC
;
1019 qlcnic_set_wol(struct net_device
*dev
, struct ethtool_wolinfo
*wol
)
1021 struct qlcnic_adapter
*adapter
= netdev_priv(dev
);
1024 if (wol
->wolopts
& ~WAKE_MAGIC
)
1027 wol_cfg
= QLCRD32(adapter
, QLCNIC_WOL_CONFIG_NV
);
1028 if (!(wol_cfg
& (1 << adapter
->portnum
)))
1031 wol_cfg
= QLCRD32(adapter
, QLCNIC_WOL_CONFIG
);
1032 if (wol
->wolopts
& WAKE_MAGIC
)
1033 wol_cfg
|= 1UL << adapter
->portnum
;
1035 wol_cfg
&= ~(1UL << adapter
->portnum
);
1037 QLCWR32(adapter
, QLCNIC_WOL_CONFIG
, wol_cfg
);
1043 * Set the coalescing parameters. Currently only normal is supported.
1044 * If rx_coalesce_usecs == 0 or rx_max_coalesced_frames == 0 then set the
1045 * firmware coalescing to default.
1047 static int qlcnic_set_intr_coalesce(struct net_device
*netdev
,
1048 struct ethtool_coalesce
*ethcoal
)
1050 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1052 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
1056 * Return Error if unsupported values or
1057 * unsupported parameters are set.
1059 if (ethcoal
->rx_coalesce_usecs
> 0xffff ||
1060 ethcoal
->rx_max_coalesced_frames
> 0xffff ||
1061 ethcoal
->tx_coalesce_usecs
||
1062 ethcoal
->tx_max_coalesced_frames
||
1063 ethcoal
->rx_coalesce_usecs_irq
||
1064 ethcoal
->rx_max_coalesced_frames_irq
||
1065 ethcoal
->tx_coalesce_usecs_irq
||
1066 ethcoal
->tx_max_coalesced_frames_irq
||
1067 ethcoal
->stats_block_coalesce_usecs
||
1068 ethcoal
->use_adaptive_rx_coalesce
||
1069 ethcoal
->use_adaptive_tx_coalesce
||
1070 ethcoal
->pkt_rate_low
||
1071 ethcoal
->rx_coalesce_usecs_low
||
1072 ethcoal
->rx_max_coalesced_frames_low
||
1073 ethcoal
->tx_coalesce_usecs_low
||
1074 ethcoal
->tx_max_coalesced_frames_low
||
1075 ethcoal
->pkt_rate_high
||
1076 ethcoal
->rx_coalesce_usecs_high
||
1077 ethcoal
->rx_max_coalesced_frames_high
||
1078 ethcoal
->tx_coalesce_usecs_high
||
1079 ethcoal
->tx_max_coalesced_frames_high
)
1082 if (!ethcoal
->rx_coalesce_usecs
||
1083 !ethcoal
->rx_max_coalesced_frames
) {
1084 adapter
->ahw
->coal
.flag
= QLCNIC_INTR_DEFAULT
;
1085 adapter
->ahw
->coal
.rx_time_us
=
1086 QLCNIC_DEFAULT_INTR_COALESCE_RX_TIME_US
;
1087 adapter
->ahw
->coal
.rx_packets
=
1088 QLCNIC_DEFAULT_INTR_COALESCE_RX_PACKETS
;
1090 adapter
->ahw
->coal
.flag
= 0;
1091 adapter
->ahw
->coal
.rx_time_us
= ethcoal
->rx_coalesce_usecs
;
1092 adapter
->ahw
->coal
.rx_packets
=
1093 ethcoal
->rx_max_coalesced_frames
;
1096 qlcnic_config_intr_coalesce(adapter
);
1101 static int qlcnic_get_intr_coalesce(struct net_device
*netdev
,
1102 struct ethtool_coalesce
*ethcoal
)
1104 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1106 if (adapter
->is_up
!= QLCNIC_ADAPTER_UP_MAGIC
)
1109 ethcoal
->rx_coalesce_usecs
= adapter
->ahw
->coal
.rx_time_us
;
1110 ethcoal
->rx_max_coalesced_frames
= adapter
->ahw
->coal
.rx_packets
;
1115 static u32
qlcnic_get_msglevel(struct net_device
*netdev
)
1117 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1119 return adapter
->msg_enable
;
1122 static void qlcnic_set_msglevel(struct net_device
*netdev
, u32 msglvl
)
1124 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1126 adapter
->msg_enable
= msglvl
;
1130 qlcnic_get_dump_flag(struct net_device
*netdev
, struct ethtool_dump
*dump
)
1132 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1133 struct qlcnic_fw_dump
*fw_dump
= &adapter
->ahw
->fw_dump
;
1136 dump
->len
= fw_dump
->tmpl_hdr
->size
+ fw_dump
->size
;
1139 dump
->flag
= fw_dump
->tmpl_hdr
->drv_cap_mask
;
1140 dump
->version
= adapter
->fw_version
;
1145 qlcnic_get_dump_data(struct net_device
*netdev
, struct ethtool_dump
*dump
,
1149 u32
*hdr_ptr
, *data
;
1150 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1151 struct qlcnic_fw_dump
*fw_dump
= &adapter
->ahw
->fw_dump
;
1153 if (!fw_dump
->clr
) {
1154 netdev_info(netdev
, "Dump not available\n");
1157 /* Copy template header first */
1158 copy_sz
= fw_dump
->tmpl_hdr
->size
;
1159 hdr_ptr
= (u32
*) fw_dump
->tmpl_hdr
;
1161 for (i
= 0; i
< copy_sz
/sizeof(u32
); i
++)
1162 *data
++ = cpu_to_le32(*hdr_ptr
++);
1164 /* Copy captured dump data */
1165 memcpy(buffer
+ copy_sz
, fw_dump
->data
, fw_dump
->size
);
1166 dump
->len
= copy_sz
+ fw_dump
->size
;
1167 dump
->flag
= fw_dump
->tmpl_hdr
->drv_cap_mask
;
1169 /* Free dump area once data has been captured */
1170 vfree(fw_dump
->data
);
1171 fw_dump
->data
= NULL
;
1173 netdev_info(netdev
, "extracted the FW dump Successfully\n");
1178 qlcnic_set_dump(struct net_device
*netdev
, struct ethtool_dump
*val
)
1181 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1182 struct qlcnic_fw_dump
*fw_dump
= &adapter
->ahw
->fw_dump
;
1184 switch (val
->flag
) {
1185 case QLCNIC_FORCE_FW_DUMP_KEY
:
1186 if (!fw_dump
->enable
) {
1187 netdev_info(netdev
, "FW dump not enabled\n");
1192 "Previous dump not cleared, not forcing dump\n");
1195 netdev_info(netdev
, "Forcing a FW dump\n");
1196 qlcnic_dev_request_reset(adapter
);
1198 case QLCNIC_DISABLE_FW_DUMP
:
1199 if (fw_dump
->enable
) {
1200 netdev_info(netdev
, "Disabling FW dump\n");
1201 fw_dump
->enable
= 0;
1204 case QLCNIC_ENABLE_FW_DUMP
:
1205 if (!fw_dump
->enable
&& fw_dump
->tmpl_hdr
) {
1206 netdev_info(netdev
, "Enabling FW dump\n");
1207 fw_dump
->enable
= 1;
1210 case QLCNIC_FORCE_FW_RESET
:
1211 netdev_info(netdev
, "Forcing a FW reset\n");
1212 qlcnic_dev_request_reset(adapter
);
1213 adapter
->flags
&= ~QLCNIC_FW_RESET_OWNER
;
1216 if (val
->flag
> QLCNIC_DUMP_MASK_MAX
||
1217 val
->flag
< QLCNIC_DUMP_MASK_MIN
) {
1219 "Invalid dump level: 0x%x\n", val
->flag
);
1223 fw_dump
->tmpl_hdr
->drv_cap_mask
= val
->flag
& 0xff;
1224 netdev_info(netdev
, "Driver mask changed to: 0x%x\n",
1225 fw_dump
->tmpl_hdr
->drv_cap_mask
);
1231 const struct ethtool_ops qlcnic_ethtool_ops
= {
1232 .get_settings
= qlcnic_get_settings
,
1233 .set_settings
= qlcnic_set_settings
,
1234 .get_drvinfo
= qlcnic_get_drvinfo
,
1235 .get_regs_len
= qlcnic_get_regs_len
,
1236 .get_regs
= qlcnic_get_regs
,
1237 .get_link
= ethtool_op_get_link
,
1238 .get_eeprom_len
= qlcnic_get_eeprom_len
,
1239 .get_eeprom
= qlcnic_get_eeprom
,
1240 .get_ringparam
= qlcnic_get_ringparam
,
1241 .set_ringparam
= qlcnic_set_ringparam
,
1242 .get_channels
= qlcnic_get_channels
,
1243 .set_channels
= qlcnic_set_channels
,
1244 .get_pauseparam
= qlcnic_get_pauseparam
,
1245 .set_pauseparam
= qlcnic_set_pauseparam
,
1246 .get_wol
= qlcnic_get_wol
,
1247 .set_wol
= qlcnic_set_wol
,
1248 .self_test
= qlcnic_diag_test
,
1249 .get_strings
= qlcnic_get_strings
,
1250 .get_ethtool_stats
= qlcnic_get_ethtool_stats
,
1251 .get_sset_count
= qlcnic_get_sset_count
,
1252 .get_coalesce
= qlcnic_get_intr_coalesce
,
1253 .set_coalesce
= qlcnic_set_intr_coalesce
,
1254 .set_phys_id
= qlcnic_set_led
,
1255 .set_msglevel
= qlcnic_set_msglevel
,
1256 .get_msglevel
= qlcnic_get_msglevel
,
1257 .get_dump_flag
= qlcnic_get_dump_flag
,
1258 .get_dump_data
= qlcnic_get_dump_data
,
1259 .set_dump
= qlcnic_set_dump
,