2 * Copyright (C) 2009 - QLogic Corporation.
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.
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.
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,
20 * The full GNU General Public License is included in this distribution
21 * in the file called "COPYING".
25 #include <linux/slab.h>
26 #include <linux/vmalloc.h>
27 #include <linux/interrupt.h>
31 #include <linux/swab.h>
32 #include <linux/dma-mapping.h>
33 #include <linux/if_vlan.h>
35 #include <linux/ipv6.h>
36 #include <linux/inetdevice.h>
37 #include <linux/sysfs.h>
38 #include <linux/aer.h>
40 MODULE_DESCRIPTION("QLogic 1/10 GbE Converged/Intelligent Ethernet Driver");
41 MODULE_LICENSE("GPL");
42 MODULE_VERSION(QLCNIC_LINUX_VERSIONID
);
43 MODULE_FIRMWARE(QLCNIC_UNIFIED_ROMIMAGE_NAME
);
45 char qlcnic_driver_name
[] = "qlcnic";
46 static const char qlcnic_driver_string
[] = "QLogic 1/10 GbE "
47 "Converged/Intelligent Ethernet Driver v" QLCNIC_LINUX_VERSIONID
;
49 static struct workqueue_struct
*qlcnic_wq
;
50 static int qlcnic_mac_learn
;
51 module_param(qlcnic_mac_learn
, int, 0644);
52 MODULE_PARM_DESC(qlcnic_mac_learn
, "Mac Filter (0=disabled, 1=enabled)");
54 static int use_msi
= 1;
55 module_param(use_msi
, int, 0644);
56 MODULE_PARM_DESC(use_msi
, "MSI interrupt (0=disabled, 1=enabled");
58 static int use_msi_x
= 1;
59 module_param(use_msi_x
, int, 0644);
60 MODULE_PARM_DESC(use_msi_x
, "MSI-X interrupt (0=disabled, 1=enabled");
62 static int auto_fw_reset
= AUTO_FW_RESET_ENABLED
;
63 module_param(auto_fw_reset
, int, 0644);
64 MODULE_PARM_DESC(auto_fw_reset
, "Auto firmware reset (0=disabled, 1=enabled");
66 static int load_fw_file
;
67 module_param(load_fw_file
, int, 0644);
68 MODULE_PARM_DESC(load_fw_file
, "Load firmware from (0=flash, 1=file");
70 static int qlcnic_config_npars
;
71 module_param(qlcnic_config_npars
, int, 0644);
72 MODULE_PARM_DESC(qlcnic_config_npars
, "Configure NPARs (0=disabled, 1=enabled");
74 static int __devinit
qlcnic_probe(struct pci_dev
*pdev
,
75 const struct pci_device_id
*ent
);
76 static void __devexit
qlcnic_remove(struct pci_dev
*pdev
);
77 static int qlcnic_open(struct net_device
*netdev
);
78 static int qlcnic_close(struct net_device
*netdev
);
79 static void qlcnic_tx_timeout(struct net_device
*netdev
);
80 static void qlcnic_attach_work(struct work_struct
*work
);
81 static void qlcnic_fwinit_work(struct work_struct
*work
);
82 static void qlcnic_fw_poll_work(struct work_struct
*work
);
83 static void qlcnic_schedule_work(struct qlcnic_adapter
*adapter
,
84 work_func_t func
, int delay
);
85 static void qlcnic_cancel_fw_work(struct qlcnic_adapter
*adapter
);
86 static int qlcnic_poll(struct napi_struct
*napi
, int budget
);
87 static int qlcnic_rx_poll(struct napi_struct
*napi
, int budget
);
88 #ifdef CONFIG_NET_POLL_CONTROLLER
89 static void qlcnic_poll_controller(struct net_device
*netdev
);
92 static void qlcnic_create_sysfs_entries(struct qlcnic_adapter
*adapter
);
93 static void qlcnic_remove_sysfs_entries(struct qlcnic_adapter
*adapter
);
94 static void qlcnic_create_diag_entries(struct qlcnic_adapter
*adapter
);
95 static void qlcnic_remove_diag_entries(struct qlcnic_adapter
*adapter
);
97 static void qlcnic_idc_debug_info(struct qlcnic_adapter
*adapter
, u8 encoding
);
98 static void qlcnic_clr_all_drv_state(struct qlcnic_adapter
*adapter
, u8
);
99 static int qlcnic_can_start_firmware(struct qlcnic_adapter
*adapter
);
101 static irqreturn_t
qlcnic_tmp_intr(int irq
, void *data
);
102 static irqreturn_t
qlcnic_intr(int irq
, void *data
);
103 static irqreturn_t
qlcnic_msi_intr(int irq
, void *data
);
104 static irqreturn_t
qlcnic_msix_intr(int irq
, void *data
);
106 static struct net_device_stats
*qlcnic_get_stats(struct net_device
*netdev
);
107 static void qlcnic_restore_indev_addr(struct net_device
*dev
, unsigned long);
108 static int qlcnic_start_firmware(struct qlcnic_adapter
*);
110 static void qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter
*adapter
);
111 static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter
*adapter
);
112 static void qlcnic_dev_set_npar_ready(struct qlcnic_adapter
*);
113 static int qlcnicvf_config_led(struct qlcnic_adapter
*, u32
, u32
);
114 static int qlcnicvf_config_bridged_mode(struct qlcnic_adapter
*, u32
);
115 static int qlcnicvf_start_firmware(struct qlcnic_adapter
*);
116 static void qlcnic_set_netdev_features(struct qlcnic_adapter
*,
117 struct qlcnic_esw_func_cfg
*);
118 /* PCI Device ID Table */
119 #define ENTRY(device) \
120 {PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, (device)), \
121 .class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}
123 #define PCI_DEVICE_ID_QLOGIC_QLE824X 0x8020
125 static DEFINE_PCI_DEVICE_TABLE(qlcnic_pci_tbl
) = {
126 ENTRY(PCI_DEVICE_ID_QLOGIC_QLE824X
),
130 MODULE_DEVICE_TABLE(pci
, qlcnic_pci_tbl
);
134 qlcnic_update_cmd_producer(struct qlcnic_adapter
*adapter
,
135 struct qlcnic_host_tx_ring
*tx_ring
)
137 writel(tx_ring
->producer
, tx_ring
->crb_cmd_producer
);
140 static const u32 msi_tgt_status
[8] = {
141 ISR_INT_TARGET_STATUS
, ISR_INT_TARGET_STATUS_F1
,
142 ISR_INT_TARGET_STATUS_F2
, ISR_INT_TARGET_STATUS_F3
,
143 ISR_INT_TARGET_STATUS_F4
, ISR_INT_TARGET_STATUS_F5
,
144 ISR_INT_TARGET_STATUS_F6
, ISR_INT_TARGET_STATUS_F7
148 struct qlcnic_legacy_intr_set legacy_intr
[] = QLCNIC_LEGACY_INTR_CONFIG
;
150 static inline void qlcnic_disable_int(struct qlcnic_host_sds_ring
*sds_ring
)
152 writel(0, sds_ring
->crb_intr_mask
);
155 static inline void qlcnic_enable_int(struct qlcnic_host_sds_ring
*sds_ring
)
157 struct qlcnic_adapter
*adapter
= sds_ring
->adapter
;
159 writel(0x1, sds_ring
->crb_intr_mask
);
161 if (!QLCNIC_IS_MSI_FAMILY(adapter
))
162 writel(0xfbff, adapter
->tgt_mask_reg
);
166 qlcnic_alloc_sds_rings(struct qlcnic_recv_context
*recv_ctx
, int count
)
168 int size
= sizeof(struct qlcnic_host_sds_ring
) * count
;
170 recv_ctx
->sds_rings
= kzalloc(size
, GFP_KERNEL
);
172 return recv_ctx
->sds_rings
== NULL
;
176 qlcnic_free_sds_rings(struct qlcnic_recv_context
*recv_ctx
)
178 if (recv_ctx
->sds_rings
!= NULL
)
179 kfree(recv_ctx
->sds_rings
);
181 recv_ctx
->sds_rings
= NULL
;
185 qlcnic_napi_add(struct qlcnic_adapter
*adapter
, struct net_device
*netdev
)
188 struct qlcnic_host_sds_ring
*sds_ring
;
189 struct qlcnic_recv_context
*recv_ctx
= &adapter
->recv_ctx
;
191 if (qlcnic_alloc_sds_rings(recv_ctx
, adapter
->max_sds_rings
))
194 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
195 sds_ring
= &recv_ctx
->sds_rings
[ring
];
197 if (ring
== adapter
->max_sds_rings
- 1)
198 netif_napi_add(netdev
, &sds_ring
->napi
, qlcnic_poll
,
199 QLCNIC_NETDEV_WEIGHT
/adapter
->max_sds_rings
);
201 netif_napi_add(netdev
, &sds_ring
->napi
,
202 qlcnic_rx_poll
, QLCNIC_NETDEV_WEIGHT
*2);
209 qlcnic_napi_del(struct qlcnic_adapter
*adapter
)
212 struct qlcnic_host_sds_ring
*sds_ring
;
213 struct qlcnic_recv_context
*recv_ctx
= &adapter
->recv_ctx
;
215 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
216 sds_ring
= &recv_ctx
->sds_rings
[ring
];
217 netif_napi_del(&sds_ring
->napi
);
220 qlcnic_free_sds_rings(&adapter
->recv_ctx
);
224 qlcnic_napi_enable(struct qlcnic_adapter
*adapter
)
227 struct qlcnic_host_sds_ring
*sds_ring
;
228 struct qlcnic_recv_context
*recv_ctx
= &adapter
->recv_ctx
;
230 if (adapter
->is_up
!= QLCNIC_ADAPTER_UP_MAGIC
)
233 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
234 sds_ring
= &recv_ctx
->sds_rings
[ring
];
235 napi_enable(&sds_ring
->napi
);
236 qlcnic_enable_int(sds_ring
);
241 qlcnic_napi_disable(struct qlcnic_adapter
*adapter
)
244 struct qlcnic_host_sds_ring
*sds_ring
;
245 struct qlcnic_recv_context
*recv_ctx
= &adapter
->recv_ctx
;
247 if (adapter
->is_up
!= QLCNIC_ADAPTER_UP_MAGIC
)
250 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
251 sds_ring
= &recv_ctx
->sds_rings
[ring
];
252 qlcnic_disable_int(sds_ring
);
253 napi_synchronize(&sds_ring
->napi
);
254 napi_disable(&sds_ring
->napi
);
258 static void qlcnic_clear_stats(struct qlcnic_adapter
*adapter
)
260 memset(&adapter
->stats
, 0, sizeof(adapter
->stats
));
263 static void qlcnic_set_msix_bit(struct pci_dev
*pdev
, int enable
)
268 pos
= pci_find_capability(pdev
, PCI_CAP_ID_MSIX
);
270 pci_read_config_dword(pdev
, pos
, &control
);
272 control
|= PCI_MSIX_FLAGS_ENABLE
;
275 pci_write_config_dword(pdev
, pos
, control
);
279 static void qlcnic_init_msix_entries(struct qlcnic_adapter
*adapter
, int count
)
283 for (i
= 0; i
< count
; i
++)
284 adapter
->msix_entries
[i
].entry
= i
;
288 qlcnic_read_mac_addr(struct qlcnic_adapter
*adapter
)
290 u8 mac_addr
[ETH_ALEN
];
291 struct net_device
*netdev
= adapter
->netdev
;
292 struct pci_dev
*pdev
= adapter
->pdev
;
294 if (qlcnic_get_mac_address(adapter
, mac_addr
) != 0)
297 memcpy(netdev
->dev_addr
, mac_addr
, ETH_ALEN
);
298 memcpy(netdev
->perm_addr
, netdev
->dev_addr
, netdev
->addr_len
);
299 memcpy(adapter
->mac_addr
, netdev
->dev_addr
, netdev
->addr_len
);
301 /* set station address */
303 if (!is_valid_ether_addr(netdev
->perm_addr
))
304 dev_warn(&pdev
->dev
, "Bad MAC address %pM.\n",
310 static int qlcnic_set_mac(struct net_device
*netdev
, void *p
)
312 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
313 struct sockaddr
*addr
= p
;
315 if ((adapter
->flags
& QLCNIC_MAC_OVERRIDE_DISABLED
))
318 if (!is_valid_ether_addr(addr
->sa_data
))
321 if (test_bit(__QLCNIC_DEV_UP
, &adapter
->state
)) {
322 netif_device_detach(netdev
);
323 qlcnic_napi_disable(adapter
);
326 memcpy(adapter
->mac_addr
, addr
->sa_data
, netdev
->addr_len
);
327 memcpy(netdev
->dev_addr
, addr
->sa_data
, netdev
->addr_len
);
328 qlcnic_set_multi(adapter
->netdev
);
330 if (test_bit(__QLCNIC_DEV_UP
, &adapter
->state
)) {
331 netif_device_attach(netdev
);
332 qlcnic_napi_enable(adapter
);
337 static void qlcnic_vlan_rx_register(struct net_device
*netdev
,
338 struct vlan_group
*grp
)
340 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
341 adapter
->vlgrp
= grp
;
344 static const struct net_device_ops qlcnic_netdev_ops
= {
345 .ndo_open
= qlcnic_open
,
346 .ndo_stop
= qlcnic_close
,
347 .ndo_start_xmit
= qlcnic_xmit_frame
,
348 .ndo_get_stats
= qlcnic_get_stats
,
349 .ndo_validate_addr
= eth_validate_addr
,
350 .ndo_set_multicast_list
= qlcnic_set_multi
,
351 .ndo_set_mac_address
= qlcnic_set_mac
,
352 .ndo_change_mtu
= qlcnic_change_mtu
,
353 .ndo_tx_timeout
= qlcnic_tx_timeout
,
354 .ndo_vlan_rx_register
= qlcnic_vlan_rx_register
,
355 #ifdef CONFIG_NET_POLL_CONTROLLER
356 .ndo_poll_controller
= qlcnic_poll_controller
,
360 static struct qlcnic_nic_template qlcnic_ops
= {
361 .config_bridged_mode
= qlcnic_config_bridged_mode
,
362 .config_led
= qlcnic_config_led
,
363 .start_firmware
= qlcnic_start_firmware
366 static struct qlcnic_nic_template qlcnic_vf_ops
= {
367 .config_bridged_mode
= qlcnicvf_config_bridged_mode
,
368 .config_led
= qlcnicvf_config_led
,
369 .start_firmware
= qlcnicvf_start_firmware
373 qlcnic_setup_intr(struct qlcnic_adapter
*adapter
)
375 const struct qlcnic_legacy_intr_set
*legacy_intrp
;
376 struct pci_dev
*pdev
= adapter
->pdev
;
379 if (adapter
->rss_supported
) {
380 num_msix
= (num_online_cpus() >= MSIX_ENTRIES_PER_ADAPTER
) ?
381 MSIX_ENTRIES_PER_ADAPTER
: 2;
385 adapter
->max_sds_rings
= 1;
387 adapter
->flags
&= ~(QLCNIC_MSI_ENABLED
| QLCNIC_MSIX_ENABLED
);
389 legacy_intrp
= &legacy_intr
[adapter
->ahw
.pci_func
];
391 adapter
->int_vec_bit
= legacy_intrp
->int_vec_bit
;
392 adapter
->tgt_status_reg
= qlcnic_get_ioaddr(adapter
,
393 legacy_intrp
->tgt_status_reg
);
394 adapter
->tgt_mask_reg
= qlcnic_get_ioaddr(adapter
,
395 legacy_intrp
->tgt_mask_reg
);
396 adapter
->isr_int_vec
= qlcnic_get_ioaddr(adapter
, ISR_INT_VECTOR
);
398 adapter
->crb_int_state_reg
= qlcnic_get_ioaddr(adapter
,
401 qlcnic_set_msix_bit(pdev
, 0);
403 if (adapter
->msix_supported
) {
405 qlcnic_init_msix_entries(adapter
, num_msix
);
406 err
= pci_enable_msix(pdev
, adapter
->msix_entries
, num_msix
);
408 adapter
->flags
|= QLCNIC_MSIX_ENABLED
;
409 qlcnic_set_msix_bit(pdev
, 1);
411 if (adapter
->rss_supported
)
412 adapter
->max_sds_rings
= num_msix
;
414 dev_info(&pdev
->dev
, "using msi-x interrupts\n");
419 pci_disable_msix(pdev
);
421 /* fall through for msi */
424 if (use_msi
&& !pci_enable_msi(pdev
)) {
425 adapter
->flags
|= QLCNIC_MSI_ENABLED
;
426 adapter
->tgt_status_reg
= qlcnic_get_ioaddr(adapter
,
427 msi_tgt_status
[adapter
->ahw
.pci_func
]);
428 dev_info(&pdev
->dev
, "using msi interrupts\n");
429 adapter
->msix_entries
[0].vector
= pdev
->irq
;
433 dev_info(&pdev
->dev
, "using legacy interrupts\n");
434 adapter
->msix_entries
[0].vector
= pdev
->irq
;
438 qlcnic_teardown_intr(struct qlcnic_adapter
*adapter
)
440 if (adapter
->flags
& QLCNIC_MSIX_ENABLED
)
441 pci_disable_msix(adapter
->pdev
);
442 if (adapter
->flags
& QLCNIC_MSI_ENABLED
)
443 pci_disable_msi(adapter
->pdev
);
447 qlcnic_cleanup_pci_map(struct qlcnic_adapter
*adapter
)
449 if (adapter
->ahw
.pci_base0
!= NULL
)
450 iounmap(adapter
->ahw
.pci_base0
);
454 qlcnic_init_pci_info(struct qlcnic_adapter
*adapter
)
456 struct qlcnic_pci_info
*pci_info
;
460 pci_info
= kcalloc(QLCNIC_MAX_PCI_FUNC
, sizeof(*pci_info
), GFP_KERNEL
);
464 adapter
->npars
= kzalloc(sizeof(struct qlcnic_npar_info
) *
465 QLCNIC_MAX_PCI_FUNC
, GFP_KERNEL
);
466 if (!adapter
->npars
) {
471 adapter
->eswitch
= kzalloc(sizeof(struct qlcnic_eswitch
) *
472 QLCNIC_NIU_MAX_XG_PORTS
, GFP_KERNEL
);
473 if (!adapter
->eswitch
) {
478 ret
= qlcnic_get_pci_info(adapter
, pci_info
);
482 for (i
= 0; i
< QLCNIC_MAX_PCI_FUNC
; i
++) {
483 pfn
= pci_info
[i
].id
;
484 if (pfn
> QLCNIC_MAX_PCI_FUNC
)
485 return QL_STATUS_INVALID_PARAM
;
486 adapter
->npars
[pfn
].active
= (u8
)pci_info
[i
].active
;
487 adapter
->npars
[pfn
].type
= (u8
)pci_info
[i
].type
;
488 adapter
->npars
[pfn
].phy_port
= (u8
)pci_info
[i
].default_port
;
489 adapter
->npars
[pfn
].min_bw
= pci_info
[i
].tx_min_bw
;
490 adapter
->npars
[pfn
].max_bw
= pci_info
[i
].tx_max_bw
;
493 for (i
= 0; i
< QLCNIC_NIU_MAX_XG_PORTS
; i
++)
494 adapter
->eswitch
[i
].flags
|= QLCNIC_SWITCH_ENABLE
;
500 kfree(adapter
->eswitch
);
501 adapter
->eswitch
= NULL
;
503 kfree(adapter
->npars
);
504 adapter
->npars
= NULL
;
512 qlcnic_set_function_modes(struct qlcnic_adapter
*adapter
)
517 u32 data
= QLCNIC_MGMT_FUNC
;
518 void __iomem
*priv_op
= adapter
->ahw
.pci_base0
+ QLCNIC_DRV_OP_MODE
;
520 /* If other drivers are not in use set their privilege level */
521 ref_count
= QLCRD32(adapter
, QLCNIC_CRB_DRV_ACTIVE
);
522 ret
= qlcnic_api_lock(adapter
);
526 if (qlcnic_config_npars
) {
527 for (i
= 0; i
< QLCNIC_MAX_PCI_FUNC
; i
++) {
529 if (adapter
->npars
[i
].type
!= QLCNIC_TYPE_NIC
||
530 id
== adapter
->ahw
.pci_func
)
532 data
|= (qlcnic_config_npars
&
533 QLC_DEV_SET_DRV(0xf, id
));
536 data
= readl(priv_op
);
537 data
= (data
& ~QLC_DEV_SET_DRV(0xf, adapter
->ahw
.pci_func
)) |
538 (QLC_DEV_SET_DRV(QLCNIC_MGMT_FUNC
,
539 adapter
->ahw
.pci_func
));
541 writel(data
, priv_op
);
542 qlcnic_api_unlock(adapter
);
548 qlcnic_check_vf(struct qlcnic_adapter
*adapter
)
550 void __iomem
*msix_base_addr
;
551 void __iomem
*priv_op
;
554 u32 op_mode
, priv_level
;
556 /* Determine FW API version */
557 adapter
->fw_hal_version
= readl(adapter
->ahw
.pci_base0
+ QLCNIC_FW_API
);
559 /* Find PCI function number */
560 pci_read_config_dword(adapter
->pdev
, QLCNIC_MSIX_TABLE_OFFSET
, &func
);
561 msix_base_addr
= adapter
->ahw
.pci_base0
+ QLCNIC_MSIX_BASE
;
562 msix_base
= readl(msix_base_addr
);
563 func
= (func
- msix_base
)/QLCNIC_MSIX_TBL_PGSIZE
;
564 adapter
->ahw
.pci_func
= func
;
566 /* Determine function privilege level */
567 priv_op
= adapter
->ahw
.pci_base0
+ QLCNIC_DRV_OP_MODE
;
568 op_mode
= readl(priv_op
);
569 if (op_mode
== QLC_DEV_DRV_DEFAULT
)
570 priv_level
= QLCNIC_MGMT_FUNC
;
572 priv_level
= QLC_DEV_GET_DRV(op_mode
, adapter
->ahw
.pci_func
);
574 if (priv_level
== QLCNIC_NON_PRIV_FUNC
) {
575 adapter
->op_mode
= QLCNIC_NON_PRIV_FUNC
;
576 dev_info(&adapter
->pdev
->dev
,
577 "HAL Version: %d Non Privileged function\n",
578 adapter
->fw_hal_version
);
579 adapter
->nic_ops
= &qlcnic_vf_ops
;
581 adapter
->nic_ops
= &qlcnic_ops
;
585 qlcnic_setup_pci_map(struct qlcnic_adapter
*adapter
)
587 void __iomem
*mem_ptr0
= NULL
;
588 resource_size_t mem_base
;
589 unsigned long mem_len
, pci_len0
= 0;
591 struct pci_dev
*pdev
= adapter
->pdev
;
593 /* remap phys address */
594 mem_base
= pci_resource_start(pdev
, 0); /* 0 is for BAR 0 */
595 mem_len
= pci_resource_len(pdev
, 0);
597 if (mem_len
== QLCNIC_PCI_2MB_SIZE
) {
599 mem_ptr0
= pci_ioremap_bar(pdev
, 0);
600 if (mem_ptr0
== NULL
) {
601 dev_err(&pdev
->dev
, "failed to map PCI bar 0\n");
609 dev_info(&pdev
->dev
, "%dMB memory map\n", (int)(mem_len
>>20));
611 adapter
->ahw
.pci_base0
= mem_ptr0
;
612 adapter
->ahw
.pci_len0
= pci_len0
;
614 qlcnic_check_vf(adapter
);
616 adapter
->ahw
.ocm_win_crb
= qlcnic_get_ioaddr(adapter
,
617 QLCNIC_PCIX_PS_REG(PCIX_OCM_WINDOW_REG(adapter
->ahw
.pci_func
)));
622 static void get_brd_name(struct qlcnic_adapter
*adapter
, char *name
)
624 struct pci_dev
*pdev
= adapter
->pdev
;
627 for (i
= 0; i
< NUM_SUPPORTED_BOARDS
; ++i
) {
628 if (qlcnic_boards
[i
].vendor
== pdev
->vendor
&&
629 qlcnic_boards
[i
].device
== pdev
->device
&&
630 qlcnic_boards
[i
].sub_vendor
== pdev
->subsystem_vendor
&&
631 qlcnic_boards
[i
].sub_device
== pdev
->subsystem_device
) {
632 sprintf(name
, "%pM: %s" ,
634 qlcnic_boards
[i
].short_name
);
642 sprintf(name
, "%pM Gigabit Ethernet", adapter
->mac_addr
);
646 qlcnic_check_options(struct qlcnic_adapter
*adapter
)
648 u32 fw_major
, fw_minor
, fw_build
;
649 struct pci_dev
*pdev
= adapter
->pdev
;
651 fw_major
= QLCRD32(adapter
, QLCNIC_FW_VERSION_MAJOR
);
652 fw_minor
= QLCRD32(adapter
, QLCNIC_FW_VERSION_MINOR
);
653 fw_build
= QLCRD32(adapter
, QLCNIC_FW_VERSION_SUB
);
655 adapter
->fw_version
= QLCNIC_VERSION_CODE(fw_major
, fw_minor
, fw_build
);
657 dev_info(&pdev
->dev
, "firmware v%d.%d.%d\n",
658 fw_major
, fw_minor
, fw_build
);
660 adapter
->flags
&= ~QLCNIC_LRO_ENABLED
;
662 if (adapter
->ahw
.port_type
== QLCNIC_XGBE
) {
663 adapter
->num_rxd
= DEFAULT_RCV_DESCRIPTORS_10G
;
664 adapter
->num_jumbo_rxd
= MAX_JUMBO_RCV_DESCRIPTORS_10G
;
665 } else if (adapter
->ahw
.port_type
== QLCNIC_GBE
) {
666 adapter
->num_rxd
= DEFAULT_RCV_DESCRIPTORS_1G
;
667 adapter
->num_jumbo_rxd
= MAX_JUMBO_RCV_DESCRIPTORS_1G
;
670 adapter
->msix_supported
= !!use_msi_x
;
671 adapter
->rss_supported
= !!use_msi_x
;
673 adapter
->num_txd
= MAX_CMD_DESCRIPTORS
;
675 adapter
->max_rds_rings
= MAX_RDS_RINGS
;
679 qlcnic_initialize_nic(struct qlcnic_adapter
*adapter
)
682 struct qlcnic_info nic_info
;
684 err
= qlcnic_get_nic_info(adapter
, &nic_info
, adapter
->ahw
.pci_func
);
688 adapter
->physical_port
= (u8
)nic_info
.phys_port
;
689 adapter
->switch_mode
= nic_info
.switch_mode
;
690 adapter
->max_tx_ques
= nic_info
.max_tx_ques
;
691 adapter
->max_rx_ques
= nic_info
.max_rx_ques
;
692 adapter
->capabilities
= nic_info
.capabilities
;
693 adapter
->max_mac_filters
= nic_info
.max_mac_filters
;
694 adapter
->max_mtu
= nic_info
.max_mtu
;
696 if (adapter
->capabilities
& BIT_6
)
697 adapter
->flags
|= QLCNIC_ESWITCH_ENABLED
;
699 adapter
->flags
&= ~QLCNIC_ESWITCH_ENABLED
;
705 qlcnic_set_vlan_config(struct qlcnic_adapter
*adapter
,
706 struct qlcnic_esw_func_cfg
*esw_cfg
)
708 if (esw_cfg
->discard_tagged
)
709 adapter
->flags
&= ~QLCNIC_TAGGING_ENABLED
;
711 adapter
->flags
|= QLCNIC_TAGGING_ENABLED
;
713 if (esw_cfg
->vlan_id
)
714 adapter
->pvid
= esw_cfg
->vlan_id
;
720 qlcnic_set_eswitch_port_features(struct qlcnic_adapter
*adapter
,
721 struct qlcnic_esw_func_cfg
*esw_cfg
)
723 adapter
->flags
&= ~QLCNIC_MACSPOOF
;
724 adapter
->flags
&= ~QLCNIC_MAC_OVERRIDE_DISABLED
;
726 if (esw_cfg
->mac_anti_spoof
)
727 adapter
->flags
|= QLCNIC_MACSPOOF
;
729 if (!esw_cfg
->mac_override
)
730 adapter
->flags
|= QLCNIC_MAC_OVERRIDE_DISABLED
;
732 qlcnic_set_netdev_features(adapter
, esw_cfg
);
736 qlcnic_set_eswitch_port_config(struct qlcnic_adapter
*adapter
)
738 struct qlcnic_esw_func_cfg esw_cfg
;
740 if (!(adapter
->flags
& QLCNIC_ESWITCH_ENABLED
))
743 esw_cfg
.pci_func
= adapter
->ahw
.pci_func
;
744 if (qlcnic_get_eswitch_port_config(adapter
, &esw_cfg
))
746 qlcnic_set_vlan_config(adapter
, &esw_cfg
);
747 qlcnic_set_eswitch_port_features(adapter
, &esw_cfg
);
753 qlcnic_set_netdev_features(struct qlcnic_adapter
*adapter
,
754 struct qlcnic_esw_func_cfg
*esw_cfg
)
756 struct net_device
*netdev
= adapter
->netdev
;
757 unsigned long features
, vlan_features
;
759 features
= (NETIF_F_SG
| NETIF_F_IP_CSUM
|
760 NETIF_F_IPV6_CSUM
| NETIF_F_GRO
);
761 vlan_features
= (NETIF_F_SG
| NETIF_F_IP_CSUM
|
764 if (adapter
->capabilities
& QLCNIC_FW_CAPABILITY_TSO
) {
765 features
|= (NETIF_F_TSO
| NETIF_F_TSO6
);
766 vlan_features
|= (NETIF_F_TSO
| NETIF_F_TSO6
);
768 if (adapter
->capabilities
& QLCNIC_FW_CAPABILITY_HW_LRO
)
769 features
|= NETIF_F_LRO
;
771 if (esw_cfg
->offload_flags
& BIT_0
) {
772 netdev
->features
|= features
;
773 adapter
->rx_csum
= 1;
774 if (!(esw_cfg
->offload_flags
& BIT_1
))
775 netdev
->features
&= ~NETIF_F_TSO
;
776 if (!(esw_cfg
->offload_flags
& BIT_2
))
777 netdev
->features
&= ~NETIF_F_TSO6
;
779 netdev
->features
&= ~features
;
780 adapter
->rx_csum
= 0;
783 netdev
->vlan_features
= (features
& vlan_features
);
787 qlcnic_check_eswitch_mode(struct qlcnic_adapter
*adapter
)
789 void __iomem
*priv_op
;
790 u32 op_mode
, priv_level
;
793 err
= qlcnic_initialize_nic(adapter
);
797 if (adapter
->flags
& QLCNIC_ADAPTER_INITIALIZED
)
800 priv_op
= adapter
->ahw
.pci_base0
+ QLCNIC_DRV_OP_MODE
;
801 op_mode
= readl(priv_op
);
802 priv_level
= QLC_DEV_GET_DRV(op_mode
, adapter
->ahw
.pci_func
);
804 if (op_mode
== QLC_DEV_DRV_DEFAULT
)
805 priv_level
= QLCNIC_MGMT_FUNC
;
807 priv_level
= QLC_DEV_GET_DRV(op_mode
, adapter
->ahw
.pci_func
);
809 if (adapter
->flags
& QLCNIC_ESWITCH_ENABLED
) {
810 if (priv_level
== QLCNIC_MGMT_FUNC
) {
811 adapter
->op_mode
= QLCNIC_MGMT_FUNC
;
812 err
= qlcnic_init_pci_info(adapter
);
815 /* Set privilege level for other functions */
816 qlcnic_set_function_modes(adapter
);
817 dev_info(&adapter
->pdev
->dev
,
818 "HAL Version: %d, Management function\n",
819 adapter
->fw_hal_version
);
820 } else if (priv_level
== QLCNIC_PRIV_FUNC
) {
821 adapter
->op_mode
= QLCNIC_PRIV_FUNC
;
822 dev_info(&adapter
->pdev
->dev
,
823 "HAL Version: %d, Privileged function\n",
824 adapter
->fw_hal_version
);
828 adapter
->flags
|= QLCNIC_ADAPTER_INITIALIZED
;
834 qlcnic_set_default_offload_settings(struct qlcnic_adapter
*adapter
)
836 struct qlcnic_esw_func_cfg esw_cfg
;
837 struct qlcnic_npar_info
*npar
;
840 if (adapter
->need_fw_reset
)
843 for (i
= 0; i
< QLCNIC_MAX_PCI_FUNC
; i
++) {
844 if (adapter
->npars
[i
].type
!= QLCNIC_TYPE_NIC
)
846 memset(&esw_cfg
, 0, sizeof(struct qlcnic_esw_func_cfg
));
847 esw_cfg
.pci_func
= i
;
848 esw_cfg
.offload_flags
= BIT_0
;
849 esw_cfg
.mac_override
= BIT_0
;
850 if (adapter
->capabilities
& QLCNIC_FW_CAPABILITY_TSO
)
851 esw_cfg
.offload_flags
|= (BIT_1
| BIT_2
);
852 if (qlcnic_config_switch_port(adapter
, &esw_cfg
))
854 npar
= &adapter
->npars
[i
];
855 npar
->pvid
= esw_cfg
.vlan_id
;
856 npar
->mac_override
= esw_cfg
.mac_override
;
857 npar
->mac_anti_spoof
= esw_cfg
.mac_anti_spoof
;
858 npar
->discard_tagged
= esw_cfg
.discard_tagged
;
859 npar
->promisc_mode
= esw_cfg
.promisc_mode
;
860 npar
->offload_flags
= esw_cfg
.offload_flags
;
867 qlcnic_reset_eswitch_config(struct qlcnic_adapter
*adapter
,
868 struct qlcnic_npar_info
*npar
, int pci_func
)
870 struct qlcnic_esw_func_cfg esw_cfg
;
871 esw_cfg
.op_mode
= QLCNIC_PORT_DEFAULTS
;
872 esw_cfg
.pci_func
= pci_func
;
873 esw_cfg
.vlan_id
= npar
->pvid
;
874 esw_cfg
.mac_override
= npar
->mac_override
;
875 esw_cfg
.discard_tagged
= npar
->discard_tagged
;
876 esw_cfg
.mac_anti_spoof
= npar
->mac_anti_spoof
;
877 esw_cfg
.offload_flags
= npar
->offload_flags
;
878 esw_cfg
.promisc_mode
= npar
->promisc_mode
;
879 if (qlcnic_config_switch_port(adapter
, &esw_cfg
))
882 esw_cfg
.op_mode
= QLCNIC_ADD_VLAN
;
883 if (qlcnic_config_switch_port(adapter
, &esw_cfg
))
890 qlcnic_reset_npar_config(struct qlcnic_adapter
*adapter
)
893 struct qlcnic_npar_info
*npar
;
894 struct qlcnic_info nic_info
;
896 if (!adapter
->need_fw_reset
)
899 /* Set the NPAR config data after FW reset */
900 for (i
= 0; i
< QLCNIC_MAX_PCI_FUNC
; i
++) {
901 npar
= &adapter
->npars
[i
];
902 if (npar
->type
!= QLCNIC_TYPE_NIC
)
904 err
= qlcnic_get_nic_info(adapter
, &nic_info
, i
);
907 nic_info
.min_tx_bw
= npar
->min_bw
;
908 nic_info
.max_tx_bw
= npar
->max_bw
;
909 err
= qlcnic_set_nic_info(adapter
, &nic_info
);
913 if (npar
->enable_pm
) {
914 err
= qlcnic_config_port_mirroring(adapter
,
915 npar
->dest_npar
, 1, i
);
919 err
= qlcnic_reset_eswitch_config(adapter
, npar
, i
);
926 static int qlcnic_check_npar_opertional(struct qlcnic_adapter
*adapter
)
928 u8 npar_opt_timeo
= QLCNIC_DEV_NPAR_OPER_TIMEO
;
931 if (adapter
->op_mode
== QLCNIC_MGMT_FUNC
)
934 npar_state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_NPAR_STATE
);
935 while (npar_state
!= QLCNIC_DEV_NPAR_OPER
&& --npar_opt_timeo
) {
937 npar_state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_NPAR_STATE
);
939 if (!npar_opt_timeo
) {
940 dev_err(&adapter
->pdev
->dev
,
941 "Waiting for NPAR state to opertional timeout\n");
948 qlcnic_set_mgmt_operations(struct qlcnic_adapter
*adapter
)
952 if (!(adapter
->flags
& QLCNIC_ESWITCH_ENABLED
) ||
953 adapter
->op_mode
!= QLCNIC_MGMT_FUNC
)
956 err
= qlcnic_set_default_offload_settings(adapter
);
960 err
= qlcnic_reset_npar_config(adapter
);
964 qlcnic_dev_set_npar_ready(adapter
);
970 qlcnic_start_firmware(struct qlcnic_adapter
*adapter
)
974 err
= qlcnic_can_start_firmware(adapter
);
978 goto check_fw_status
;
981 qlcnic_request_firmware(adapter
);
983 err
= qlcnic_check_flash_fw_ver(adapter
);
987 adapter
->fw_type
= QLCNIC_FLASH_ROMIMAGE
;
990 err
= qlcnic_need_fw_reset(adapter
);
992 goto check_fw_status
;
994 err
= qlcnic_pinit_from_rom(adapter
);
998 err
= qlcnic_load_firmware(adapter
);
1002 qlcnic_release_firmware(adapter
);
1003 QLCWR32(adapter
, CRB_DRIVER_VERSION
, QLCNIC_DRIVER_VERSION
);
1006 err
= qlcnic_check_fw_status(adapter
);
1010 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
, QLCNIC_DEV_READY
);
1011 qlcnic_idc_debug_info(adapter
, 1);
1013 err
= qlcnic_check_eswitch_mode(adapter
);
1015 dev_err(&adapter
->pdev
->dev
,
1016 "Memory allocation failed for eswitch\n");
1019 err
= qlcnic_set_mgmt_operations(adapter
);
1023 qlcnic_check_options(adapter
);
1024 adapter
->need_fw_reset
= 0;
1026 qlcnic_release_firmware(adapter
);
1030 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
, QLCNIC_DEV_FAILED
);
1031 dev_err(&adapter
->pdev
->dev
, "Device state set to failed\n");
1033 qlcnic_release_firmware(adapter
);
1038 qlcnic_request_irq(struct qlcnic_adapter
*adapter
)
1040 irq_handler_t handler
;
1041 struct qlcnic_host_sds_ring
*sds_ring
;
1044 unsigned long flags
= 0;
1045 struct net_device
*netdev
= adapter
->netdev
;
1046 struct qlcnic_recv_context
*recv_ctx
= &adapter
->recv_ctx
;
1048 if (adapter
->diag_test
== QLCNIC_INTERRUPT_TEST
) {
1049 handler
= qlcnic_tmp_intr
;
1050 if (!QLCNIC_IS_MSI_FAMILY(adapter
))
1051 flags
|= IRQF_SHARED
;
1054 if (adapter
->flags
& QLCNIC_MSIX_ENABLED
)
1055 handler
= qlcnic_msix_intr
;
1056 else if (adapter
->flags
& QLCNIC_MSI_ENABLED
)
1057 handler
= qlcnic_msi_intr
;
1059 flags
|= IRQF_SHARED
;
1060 handler
= qlcnic_intr
;
1063 adapter
->irq
= netdev
->irq
;
1065 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
1066 sds_ring
= &recv_ctx
->sds_rings
[ring
];
1067 sprintf(sds_ring
->name
, "%s[%d]", netdev
->name
, ring
);
1068 err
= request_irq(sds_ring
->irq
, handler
,
1069 flags
, sds_ring
->name
, sds_ring
);
1078 qlcnic_free_irq(struct qlcnic_adapter
*adapter
)
1081 struct qlcnic_host_sds_ring
*sds_ring
;
1083 struct qlcnic_recv_context
*recv_ctx
= &adapter
->recv_ctx
;
1085 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
1086 sds_ring
= &recv_ctx
->sds_rings
[ring
];
1087 free_irq(sds_ring
->irq
, sds_ring
);
1092 qlcnic_init_coalesce_defaults(struct qlcnic_adapter
*adapter
)
1094 adapter
->coal
.flags
= QLCNIC_INTR_DEFAULT
;
1095 adapter
->coal
.normal
.data
.rx_time_us
=
1096 QLCNIC_DEFAULT_INTR_COALESCE_RX_TIME_US
;
1097 adapter
->coal
.normal
.data
.rx_packets
=
1098 QLCNIC_DEFAULT_INTR_COALESCE_RX_PACKETS
;
1099 adapter
->coal
.normal
.data
.tx_time_us
=
1100 QLCNIC_DEFAULT_INTR_COALESCE_TX_TIME_US
;
1101 adapter
->coal
.normal
.data
.tx_packets
=
1102 QLCNIC_DEFAULT_INTR_COALESCE_TX_PACKETS
;
1106 __qlcnic_up(struct qlcnic_adapter
*adapter
, struct net_device
*netdev
)
1109 struct qlcnic_host_rds_ring
*rds_ring
;
1111 if (adapter
->is_up
!= QLCNIC_ADAPTER_UP_MAGIC
)
1114 if (test_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
1116 if (qlcnic_set_eswitch_port_config(adapter
))
1119 if (qlcnic_fw_create_ctx(adapter
))
1122 for (ring
= 0; ring
< adapter
->max_rds_rings
; ring
++) {
1123 rds_ring
= &adapter
->recv_ctx
.rds_rings
[ring
];
1124 qlcnic_post_rx_buffers(adapter
, ring
, rds_ring
);
1127 qlcnic_set_multi(netdev
);
1128 qlcnic_fw_cmd_set_mtu(adapter
, netdev
->mtu
);
1130 adapter
->ahw
.linkup
= 0;
1132 if (adapter
->max_sds_rings
> 1)
1133 qlcnic_config_rss(adapter
, 1);
1135 qlcnic_config_intr_coalesce(adapter
);
1137 if (netdev
->features
& NETIF_F_LRO
)
1138 qlcnic_config_hw_lro(adapter
, QLCNIC_LRO_ENABLED
);
1140 qlcnic_napi_enable(adapter
);
1142 qlcnic_linkevent_request(adapter
, 1);
1144 adapter
->reset_context
= 0;
1145 set_bit(__QLCNIC_DEV_UP
, &adapter
->state
);
1149 /* Usage: During resume and firmware recovery module.*/
1152 qlcnic_up(struct qlcnic_adapter
*adapter
, struct net_device
*netdev
)
1157 if (netif_running(netdev
))
1158 err
= __qlcnic_up(adapter
, netdev
);
1165 __qlcnic_down(struct qlcnic_adapter
*adapter
, struct net_device
*netdev
)
1167 if (adapter
->is_up
!= QLCNIC_ADAPTER_UP_MAGIC
)
1170 if (!test_and_clear_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
1174 spin_lock(&adapter
->tx_clean_lock
);
1175 netif_carrier_off(netdev
);
1176 netif_tx_disable(netdev
);
1178 qlcnic_free_mac_list(adapter
);
1180 if (adapter
->fhash
.fnum
)
1181 qlcnic_delete_lb_filters(adapter
);
1183 qlcnic_nic_set_promisc(adapter
, QLCNIC_NIU_NON_PROMISC_MODE
);
1185 qlcnic_napi_disable(adapter
);
1187 qlcnic_fw_destroy_ctx(adapter
);
1189 qlcnic_reset_rx_buffers_list(adapter
);
1190 qlcnic_release_tx_buffers(adapter
);
1191 spin_unlock(&adapter
->tx_clean_lock
);
1194 /* Usage: During suspend and firmware recovery module */
1197 qlcnic_down(struct qlcnic_adapter
*adapter
, struct net_device
*netdev
)
1200 if (netif_running(netdev
))
1201 __qlcnic_down(adapter
, netdev
);
1207 qlcnic_attach(struct qlcnic_adapter
*adapter
)
1209 struct net_device
*netdev
= adapter
->netdev
;
1210 struct pci_dev
*pdev
= adapter
->pdev
;
1213 if (adapter
->is_up
== QLCNIC_ADAPTER_UP_MAGIC
)
1216 err
= qlcnic_napi_add(adapter
, netdev
);
1220 err
= qlcnic_alloc_sw_resources(adapter
);
1222 dev_err(&pdev
->dev
, "Error in setting sw resources\n");
1223 goto err_out_napi_del
;
1226 err
= qlcnic_alloc_hw_resources(adapter
);
1228 dev_err(&pdev
->dev
, "Error in setting hw resources\n");
1229 goto err_out_free_sw
;
1232 err
= qlcnic_request_irq(adapter
);
1234 dev_err(&pdev
->dev
, "failed to setup interrupt\n");
1235 goto err_out_free_hw
;
1238 qlcnic_init_coalesce_defaults(adapter
);
1240 qlcnic_create_sysfs_entries(adapter
);
1242 adapter
->is_up
= QLCNIC_ADAPTER_UP_MAGIC
;
1246 qlcnic_free_hw_resources(adapter
);
1248 qlcnic_free_sw_resources(adapter
);
1250 qlcnic_napi_del(adapter
);
1255 qlcnic_detach(struct qlcnic_adapter
*adapter
)
1257 if (adapter
->is_up
!= QLCNIC_ADAPTER_UP_MAGIC
)
1260 qlcnic_remove_sysfs_entries(adapter
);
1262 qlcnic_free_hw_resources(adapter
);
1263 qlcnic_release_rx_buffers(adapter
);
1264 qlcnic_free_irq(adapter
);
1265 qlcnic_napi_del(adapter
);
1266 qlcnic_free_sw_resources(adapter
);
1271 void qlcnic_diag_free_res(struct net_device
*netdev
, int max_sds_rings
)
1273 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1274 struct qlcnic_host_sds_ring
*sds_ring
;
1277 clear_bit(__QLCNIC_DEV_UP
, &adapter
->state
);
1278 if (adapter
->diag_test
== QLCNIC_INTERRUPT_TEST
) {
1279 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
1280 sds_ring
= &adapter
->recv_ctx
.sds_rings
[ring
];
1281 qlcnic_disable_int(sds_ring
);
1285 qlcnic_fw_destroy_ctx(adapter
);
1287 qlcnic_detach(adapter
);
1289 adapter
->diag_test
= 0;
1290 adapter
->max_sds_rings
= max_sds_rings
;
1292 if (qlcnic_attach(adapter
))
1295 if (netif_running(netdev
))
1296 __qlcnic_up(adapter
, netdev
);
1298 netif_device_attach(netdev
);
1301 int qlcnic_diag_alloc_res(struct net_device
*netdev
, int test
)
1303 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1304 struct qlcnic_host_sds_ring
*sds_ring
;
1305 struct qlcnic_host_rds_ring
*rds_ring
;
1309 netif_device_detach(netdev
);
1311 if (netif_running(netdev
))
1312 __qlcnic_down(adapter
, netdev
);
1314 qlcnic_detach(adapter
);
1316 adapter
->max_sds_rings
= 1;
1317 adapter
->diag_test
= test
;
1319 ret
= qlcnic_attach(adapter
);
1321 netif_device_attach(netdev
);
1325 ret
= qlcnic_fw_create_ctx(adapter
);
1327 qlcnic_detach(adapter
);
1328 netif_device_attach(netdev
);
1332 for (ring
= 0; ring
< adapter
->max_rds_rings
; ring
++) {
1333 rds_ring
= &adapter
->recv_ctx
.rds_rings
[ring
];
1334 qlcnic_post_rx_buffers(adapter
, ring
, rds_ring
);
1337 if (adapter
->diag_test
== QLCNIC_INTERRUPT_TEST
) {
1338 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
1339 sds_ring
= &adapter
->recv_ctx
.sds_rings
[ring
];
1340 qlcnic_enable_int(sds_ring
);
1343 set_bit(__QLCNIC_DEV_UP
, &adapter
->state
);
1348 /* Reset context in hardware only */
1350 qlcnic_reset_hw_context(struct qlcnic_adapter
*adapter
)
1352 struct net_device
*netdev
= adapter
->netdev
;
1354 if (test_and_set_bit(__QLCNIC_RESETTING
, &adapter
->state
))
1357 netif_device_detach(netdev
);
1359 qlcnic_down(adapter
, netdev
);
1361 qlcnic_up(adapter
, netdev
);
1363 netif_device_attach(netdev
);
1365 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
1370 qlcnic_reset_context(struct qlcnic_adapter
*adapter
)
1373 struct net_device
*netdev
= adapter
->netdev
;
1375 if (test_and_set_bit(__QLCNIC_RESETTING
, &adapter
->state
))
1378 if (adapter
->is_up
== QLCNIC_ADAPTER_UP_MAGIC
) {
1380 netif_device_detach(netdev
);
1382 if (netif_running(netdev
))
1383 __qlcnic_down(adapter
, netdev
);
1385 qlcnic_detach(adapter
);
1387 if (netif_running(netdev
)) {
1388 err
= qlcnic_attach(adapter
);
1390 __qlcnic_up(adapter
, netdev
);
1393 netif_device_attach(netdev
);
1396 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
1401 qlcnic_setup_netdev(struct qlcnic_adapter
*adapter
,
1402 struct net_device
*netdev
, u8 pci_using_dac
)
1405 struct pci_dev
*pdev
= adapter
->pdev
;
1407 adapter
->rx_csum
= 1;
1408 adapter
->mc_enabled
= 0;
1409 adapter
->max_mc_count
= 38;
1411 netdev
->netdev_ops
= &qlcnic_netdev_ops
;
1412 netdev
->watchdog_timeo
= 5*HZ
;
1414 qlcnic_change_mtu(netdev
, netdev
->mtu
);
1416 SET_ETHTOOL_OPS(netdev
, &qlcnic_ethtool_ops
);
1418 netdev
->features
|= (NETIF_F_SG
| NETIF_F_IP_CSUM
|
1419 NETIF_F_IPV6_CSUM
| NETIF_F_GRO
| NETIF_F_HW_VLAN_RX
);
1420 netdev
->vlan_features
|= (NETIF_F_SG
| NETIF_F_IP_CSUM
|
1423 if (adapter
->capabilities
& QLCNIC_FW_CAPABILITY_TSO
) {
1424 netdev
->features
|= (NETIF_F_TSO
| NETIF_F_TSO6
);
1425 netdev
->vlan_features
|= (NETIF_F_TSO
| NETIF_F_TSO6
);
1428 if (pci_using_dac
) {
1429 netdev
->features
|= NETIF_F_HIGHDMA
;
1430 netdev
->vlan_features
|= NETIF_F_HIGHDMA
;
1433 if (adapter
->capabilities
& QLCNIC_FW_CAPABILITY_FVLANTX
)
1434 netdev
->features
|= (NETIF_F_HW_VLAN_TX
);
1436 if (adapter
->capabilities
& QLCNIC_FW_CAPABILITY_HW_LRO
)
1437 netdev
->features
|= NETIF_F_LRO
;
1438 netdev
->irq
= adapter
->msix_entries
[0].vector
;
1440 netif_carrier_off(netdev
);
1441 netif_stop_queue(netdev
);
1443 err
= register_netdev(netdev
);
1445 dev_err(&pdev
->dev
, "failed to register net device\n");
1452 static int qlcnic_set_dma_mask(struct pci_dev
*pdev
, u8
*pci_using_dac
)
1454 if (!pci_set_dma_mask(pdev
, DMA_BIT_MASK(64)) &&
1455 !pci_set_consistent_dma_mask(pdev
, DMA_BIT_MASK(64)))
1457 else if (!pci_set_dma_mask(pdev
, DMA_BIT_MASK(32)) &&
1458 !pci_set_consistent_dma_mask(pdev
, DMA_BIT_MASK(32)))
1461 dev_err(&pdev
->dev
, "Unable to set DMA mask, aborting\n");
1468 static int __devinit
1469 qlcnic_probe(struct pci_dev
*pdev
, const struct pci_device_id
*ent
)
1471 struct net_device
*netdev
= NULL
;
1472 struct qlcnic_adapter
*adapter
= NULL
;
1474 uint8_t revision_id
;
1475 uint8_t pci_using_dac
;
1476 char brd_name
[QLCNIC_MAX_BOARD_NAME_LEN
];
1478 err
= pci_enable_device(pdev
);
1482 if (!(pci_resource_flags(pdev
, 0) & IORESOURCE_MEM
)) {
1484 goto err_out_disable_pdev
;
1487 err
= qlcnic_set_dma_mask(pdev
, &pci_using_dac
);
1489 goto err_out_disable_pdev
;
1491 err
= pci_request_regions(pdev
, qlcnic_driver_name
);
1493 goto err_out_disable_pdev
;
1495 pci_set_master(pdev
);
1496 pci_enable_pcie_error_reporting(pdev
);
1498 netdev
= alloc_etherdev(sizeof(struct qlcnic_adapter
));
1500 dev_err(&pdev
->dev
, "failed to allocate net_device\n");
1502 goto err_out_free_res
;
1505 SET_NETDEV_DEV(netdev
, &pdev
->dev
);
1507 adapter
= netdev_priv(netdev
);
1508 adapter
->netdev
= netdev
;
1509 adapter
->pdev
= pdev
;
1510 adapter
->dev_rst_time
= jiffies
;
1512 revision_id
= pdev
->revision
;
1513 adapter
->ahw
.revision_id
= revision_id
;
1515 rwlock_init(&adapter
->ahw
.crb_lock
);
1516 mutex_init(&adapter
->ahw
.mem_lock
);
1518 spin_lock_init(&adapter
->tx_clean_lock
);
1519 INIT_LIST_HEAD(&adapter
->mac_list
);
1521 err
= qlcnic_setup_pci_map(adapter
);
1523 goto err_out_free_netdev
;
1525 /* This will be reset for mezz cards */
1526 adapter
->portnum
= adapter
->ahw
.pci_func
;
1528 err
= qlcnic_get_board_info(adapter
);
1530 dev_err(&pdev
->dev
, "Error getting board config info.\n");
1531 goto err_out_iounmap
;
1534 err
= qlcnic_setup_idc_param(adapter
);
1536 goto err_out_iounmap
;
1538 err
= adapter
->nic_ops
->start_firmware(adapter
);
1540 dev_err(&pdev
->dev
, "Loading fw failed.Please Reboot\n");
1541 goto err_out_decr_ref
;
1544 if (qlcnic_read_mac_addr(adapter
))
1545 dev_warn(&pdev
->dev
, "failed to read mac addr\n");
1547 if (adapter
->portnum
== 0) {
1548 get_brd_name(adapter
, brd_name
);
1550 pr_info("%s: %s Board Chip rev 0x%x\n",
1551 module_name(THIS_MODULE
),
1552 brd_name
, adapter
->ahw
.revision_id
);
1555 qlcnic_clear_stats(adapter
);
1557 qlcnic_setup_intr(adapter
);
1559 err
= qlcnic_setup_netdev(adapter
, netdev
, pci_using_dac
);
1561 goto err_out_disable_msi
;
1563 pci_set_drvdata(pdev
, adapter
);
1565 qlcnic_schedule_work(adapter
, qlcnic_fw_poll_work
, FW_POLL_DELAY
);
1567 switch (adapter
->ahw
.port_type
) {
1569 dev_info(&adapter
->pdev
->dev
, "%s: GbE port initialized\n",
1570 adapter
->netdev
->name
);
1573 dev_info(&adapter
->pdev
->dev
, "%s: XGbE port initialized\n",
1574 adapter
->netdev
->name
);
1578 qlcnic_alloc_lb_filters_mem(adapter
);
1579 qlcnic_create_diag_entries(adapter
);
1583 err_out_disable_msi
:
1584 qlcnic_teardown_intr(adapter
);
1587 qlcnic_clr_all_drv_state(adapter
, 0);
1590 qlcnic_cleanup_pci_map(adapter
);
1592 err_out_free_netdev
:
1593 free_netdev(netdev
);
1596 pci_release_regions(pdev
);
1598 err_out_disable_pdev
:
1599 pci_set_drvdata(pdev
, NULL
);
1600 pci_disable_device(pdev
);
1604 static void __devexit
qlcnic_remove(struct pci_dev
*pdev
)
1606 struct qlcnic_adapter
*adapter
;
1607 struct net_device
*netdev
;
1609 adapter
= pci_get_drvdata(pdev
);
1610 if (adapter
== NULL
)
1613 netdev
= adapter
->netdev
;
1615 qlcnic_cancel_fw_work(adapter
);
1617 unregister_netdev(netdev
);
1619 qlcnic_detach(adapter
);
1621 if (adapter
->npars
!= NULL
)
1622 kfree(adapter
->npars
);
1623 if (adapter
->eswitch
!= NULL
)
1624 kfree(adapter
->eswitch
);
1626 qlcnic_clr_all_drv_state(adapter
, 0);
1628 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
1630 qlcnic_free_lb_filters_mem(adapter
);
1632 qlcnic_teardown_intr(adapter
);
1634 qlcnic_remove_diag_entries(adapter
);
1636 qlcnic_cleanup_pci_map(adapter
);
1638 qlcnic_release_firmware(adapter
);
1640 pci_disable_pcie_error_reporting(pdev
);
1641 pci_release_regions(pdev
);
1642 pci_disable_device(pdev
);
1643 pci_set_drvdata(pdev
, NULL
);
1645 free_netdev(netdev
);
1647 static int __qlcnic_shutdown(struct pci_dev
*pdev
)
1649 struct qlcnic_adapter
*adapter
= pci_get_drvdata(pdev
);
1650 struct net_device
*netdev
= adapter
->netdev
;
1653 netif_device_detach(netdev
);
1655 qlcnic_cancel_fw_work(adapter
);
1657 if (netif_running(netdev
))
1658 qlcnic_down(adapter
, netdev
);
1660 qlcnic_clr_all_drv_state(adapter
, 0);
1662 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
1664 retval
= pci_save_state(pdev
);
1668 if (qlcnic_wol_supported(adapter
)) {
1669 pci_enable_wake(pdev
, PCI_D3cold
, 1);
1670 pci_enable_wake(pdev
, PCI_D3hot
, 1);
1676 static void qlcnic_shutdown(struct pci_dev
*pdev
)
1678 if (__qlcnic_shutdown(pdev
))
1681 pci_disable_device(pdev
);
1686 qlcnic_suspend(struct pci_dev
*pdev
, pm_message_t state
)
1690 retval
= __qlcnic_shutdown(pdev
);
1694 pci_set_power_state(pdev
, pci_choose_state(pdev
, state
));
1699 qlcnic_resume(struct pci_dev
*pdev
)
1701 struct qlcnic_adapter
*adapter
= pci_get_drvdata(pdev
);
1702 struct net_device
*netdev
= adapter
->netdev
;
1705 err
= pci_enable_device(pdev
);
1709 pci_set_power_state(pdev
, PCI_D0
);
1710 pci_set_master(pdev
);
1711 pci_restore_state(pdev
);
1713 err
= adapter
->nic_ops
->start_firmware(adapter
);
1715 dev_err(&pdev
->dev
, "failed to start firmware\n");
1719 if (netif_running(netdev
)) {
1720 err
= qlcnic_up(adapter
, netdev
);
1724 qlcnic_restore_indev_addr(netdev
, NETDEV_UP
);
1727 netif_device_attach(netdev
);
1728 qlcnic_schedule_work(adapter
, qlcnic_fw_poll_work
, FW_POLL_DELAY
);
1733 static int qlcnic_open(struct net_device
*netdev
)
1735 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1738 err
= qlcnic_attach(adapter
);
1742 err
= __qlcnic_up(adapter
, netdev
);
1746 netif_start_queue(netdev
);
1751 qlcnic_detach(adapter
);
1756 * qlcnic_close - Disables a network interface entry point
1758 static int qlcnic_close(struct net_device
*netdev
)
1760 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1762 __qlcnic_down(adapter
, netdev
);
1767 qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter
*adapter
)
1772 if (!qlcnic_mac_learn
)
1775 spin_lock_init(&adapter
->mac_learn_lock
);
1777 head
= kcalloc(QLCNIC_LB_MAX_FILTERS
, sizeof(struct hlist_head
),
1782 adapter
->fhash
.fmax
= QLCNIC_LB_MAX_FILTERS
;
1783 adapter
->fhash
.fhead
= (struct hlist_head
*)head
;
1785 for (i
= 0; i
< adapter
->fhash
.fmax
; i
++)
1786 INIT_HLIST_HEAD(&adapter
->fhash
.fhead
[i
]);
1789 static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter
*adapter
)
1791 if (adapter
->fhash
.fmax
&& adapter
->fhash
.fhead
)
1792 kfree(adapter
->fhash
.fhead
);
1794 adapter
->fhash
.fhead
= NULL
;
1795 adapter
->fhash
.fmax
= 0;
1798 static void qlcnic_change_filter(struct qlcnic_adapter
*adapter
,
1799 u64 uaddr
, __le16 vlan_id
, struct qlcnic_host_tx_ring
*tx_ring
)
1801 struct cmd_desc_type0
*hwdesc
;
1802 struct qlcnic_nic_req
*req
;
1803 struct qlcnic_mac_req
*mac_req
;
1804 struct qlcnic_vlan_req
*vlan_req
;
1808 producer
= tx_ring
->producer
;
1809 hwdesc
= &tx_ring
->desc_head
[tx_ring
->producer
];
1811 req
= (struct qlcnic_nic_req
*)hwdesc
;
1812 memset(req
, 0, sizeof(struct qlcnic_nic_req
));
1813 req
->qhdr
= cpu_to_le64(QLCNIC_REQUEST
<< 23);
1815 word
= QLCNIC_MAC_EVENT
| ((u64
)(adapter
->portnum
) << 16);
1816 req
->req_hdr
= cpu_to_le64(word
);
1818 mac_req
= (struct qlcnic_mac_req
*)&(req
->words
[0]);
1819 mac_req
->op
= vlan_id
? QLCNIC_MAC_VLAN_ADD
: QLCNIC_MAC_ADD
;
1820 memcpy(mac_req
->mac_addr
, &uaddr
, ETH_ALEN
);
1822 vlan_req
= (struct qlcnic_vlan_req
*)&req
->words
[1];
1823 vlan_req
->vlan_id
= vlan_id
;
1825 tx_ring
->producer
= get_next_index(producer
, tx_ring
->num_desc
);
1828 #define QLCNIC_MAC_HASH(MAC)\
1829 ((((MAC) & 0x70000) >> 0x10) | (((MAC) & 0x70000000000ULL) >> 0x25))
1832 qlcnic_send_filter(struct qlcnic_adapter
*adapter
,
1833 struct qlcnic_host_tx_ring
*tx_ring
,
1834 struct cmd_desc_type0
*first_desc
,
1835 struct sk_buff
*skb
)
1837 struct ethhdr
*phdr
= (struct ethhdr
*)(skb
->data
);
1838 struct qlcnic_filter
*fil
, *tmp_fil
;
1839 struct hlist_node
*tmp_hnode
, *n
;
1840 struct hlist_head
*head
;
1845 if (!compare_ether_addr(phdr
->h_source
, adapter
->mac_addr
))
1848 if (adapter
->fhash
.fnum
>= adapter
->fhash
.fmax
)
1851 /* Only NPAR capable devices support vlan based learning*/
1852 if (adapter
->flags
& QLCNIC_ESWITCH_ENABLED
)
1853 vlan_id
= first_desc
->vlan_TCI
;
1854 memcpy(&src_addr
, phdr
->h_source
, ETH_ALEN
);
1855 hindex
= QLCNIC_MAC_HASH(src_addr
) & (QLCNIC_LB_MAX_FILTERS
- 1);
1856 head
= &(adapter
->fhash
.fhead
[hindex
]);
1858 hlist_for_each_entry_safe(tmp_fil
, tmp_hnode
, n
, head
, fnode
) {
1859 if (!memcmp(tmp_fil
->faddr
, &src_addr
, ETH_ALEN
) &&
1860 tmp_fil
->vlan_id
== vlan_id
) {
1861 tmp_fil
->ftime
= jiffies
;
1866 fil
= kzalloc(sizeof(struct qlcnic_filter
), GFP_ATOMIC
);
1870 qlcnic_change_filter(adapter
, src_addr
, vlan_id
, tx_ring
);
1872 fil
->ftime
= jiffies
;
1873 fil
->vlan_id
= vlan_id
;
1874 memcpy(fil
->faddr
, &src_addr
, ETH_ALEN
);
1875 spin_lock(&adapter
->mac_learn_lock
);
1876 hlist_add_head(&(fil
->fnode
), head
);
1877 adapter
->fhash
.fnum
++;
1878 spin_unlock(&adapter
->mac_learn_lock
);
1882 qlcnic_tso_check(struct net_device
*netdev
,
1883 struct qlcnic_host_tx_ring
*tx_ring
,
1884 struct cmd_desc_type0
*first_desc
,
1885 struct sk_buff
*skb
)
1887 u8 opcode
= TX_ETHER_PKT
;
1888 __be16 protocol
= skb
->protocol
;
1890 int copied
, offset
, copy_len
, hdr_len
= 0, tso
= 0;
1891 struct cmd_desc_type0
*hwdesc
;
1892 struct vlan_ethhdr
*vh
;
1893 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
1894 u32 producer
= tx_ring
->producer
;
1895 __le16 vlan_oob
= first_desc
->flags_opcode
&
1896 cpu_to_le16(FLAGS_VLAN_OOB
);
1898 if (*(skb
->data
) & BIT_0
) {
1900 memcpy(&first_desc
->eth_addr
, skb
->data
, ETH_ALEN
);
1903 if ((netdev
->features
& (NETIF_F_TSO
| NETIF_F_TSO6
)) &&
1904 skb_shinfo(skb
)->gso_size
> 0) {
1906 hdr_len
= skb_transport_offset(skb
) + tcp_hdrlen(skb
);
1908 first_desc
->mss
= cpu_to_le16(skb_shinfo(skb
)->gso_size
);
1909 first_desc
->total_hdr_length
= hdr_len
;
1911 first_desc
->total_hdr_length
+= VLAN_HLEN
;
1912 first_desc
->tcp_hdr_offset
= VLAN_HLEN
;
1913 first_desc
->ip_hdr_offset
= VLAN_HLEN
;
1914 /* Only in case of TSO on vlan device */
1915 flags
|= FLAGS_VLAN_TAGGED
;
1918 opcode
= (protocol
== cpu_to_be16(ETH_P_IPV6
)) ?
1919 TX_TCP_LSO6
: TX_TCP_LSO
;
1922 } else if (skb
->ip_summed
== CHECKSUM_PARTIAL
) {
1925 if (protocol
== cpu_to_be16(ETH_P_IP
)) {
1926 l4proto
= ip_hdr(skb
)->protocol
;
1928 if (l4proto
== IPPROTO_TCP
)
1929 opcode
= TX_TCP_PKT
;
1930 else if (l4proto
== IPPROTO_UDP
)
1931 opcode
= TX_UDP_PKT
;
1932 } else if (protocol
== cpu_to_be16(ETH_P_IPV6
)) {
1933 l4proto
= ipv6_hdr(skb
)->nexthdr
;
1935 if (l4proto
== IPPROTO_TCP
)
1936 opcode
= TX_TCPV6_PKT
;
1937 else if (l4proto
== IPPROTO_UDP
)
1938 opcode
= TX_UDPV6_PKT
;
1942 first_desc
->tcp_hdr_offset
+= skb_transport_offset(skb
);
1943 first_desc
->ip_hdr_offset
+= skb_network_offset(skb
);
1944 qlcnic_set_tx_flags_opcode(first_desc
, flags
, opcode
);
1949 /* For LSO, we need to copy the MAC/IP/TCP headers into
1950 * the descriptor ring
1956 /* Create a TSO vlan header template for firmware */
1958 hwdesc
= &tx_ring
->desc_head
[producer
];
1959 tx_ring
->cmd_buf_arr
[producer
].skb
= NULL
;
1961 copy_len
= min((int)sizeof(struct cmd_desc_type0
) - offset
,
1962 hdr_len
+ VLAN_HLEN
);
1964 vh
= (struct vlan_ethhdr
*)((char *)hwdesc
+ 2);
1965 skb_copy_from_linear_data(skb
, vh
, 12);
1966 vh
->h_vlan_proto
= htons(ETH_P_8021Q
);
1967 vh
->h_vlan_TCI
= (__be16
)swab16((u16
)first_desc
->vlan_TCI
);
1969 skb_copy_from_linear_data_offset(skb
, 12,
1970 (char *)vh
+ 16, copy_len
- 16);
1972 copied
= copy_len
- VLAN_HLEN
;
1975 producer
= get_next_index(producer
, tx_ring
->num_desc
);
1978 while (copied
< hdr_len
) {
1980 copy_len
= min((int)sizeof(struct cmd_desc_type0
) - offset
,
1981 (hdr_len
- copied
));
1983 hwdesc
= &tx_ring
->desc_head
[producer
];
1984 tx_ring
->cmd_buf_arr
[producer
].skb
= NULL
;
1986 skb_copy_from_linear_data_offset(skb
, copied
,
1987 (char *)hwdesc
+ offset
, copy_len
);
1992 producer
= get_next_index(producer
, tx_ring
->num_desc
);
1995 tx_ring
->producer
= producer
;
1997 adapter
->stats
.lso_frames
++;
2001 qlcnic_map_tx_skb(struct pci_dev
*pdev
,
2002 struct sk_buff
*skb
, struct qlcnic_cmd_buffer
*pbuf
)
2004 struct qlcnic_skb_frag
*nf
;
2005 struct skb_frag_struct
*frag
;
2009 nr_frags
= skb_shinfo(skb
)->nr_frags
;
2010 nf
= &pbuf
->frag_array
[0];
2012 map
= pci_map_single(pdev
, skb
->data
,
2013 skb_headlen(skb
), PCI_DMA_TODEVICE
);
2014 if (pci_dma_mapping_error(pdev
, map
))
2018 nf
->length
= skb_headlen(skb
);
2020 for (i
= 0; i
< nr_frags
; i
++) {
2021 frag
= &skb_shinfo(skb
)->frags
[i
];
2022 nf
= &pbuf
->frag_array
[i
+1];
2024 map
= pci_map_page(pdev
, frag
->page
, frag
->page_offset
,
2025 frag
->size
, PCI_DMA_TODEVICE
);
2026 if (pci_dma_mapping_error(pdev
, map
))
2030 nf
->length
= frag
->size
;
2037 nf
= &pbuf
->frag_array
[i
+1];
2038 pci_unmap_page(pdev
, nf
->dma
, nf
->length
, PCI_DMA_TODEVICE
);
2041 nf
= &pbuf
->frag_array
[0];
2042 pci_unmap_single(pdev
, nf
->dma
, skb_headlen(skb
), PCI_DMA_TODEVICE
);
2049 qlcnic_check_tx_tagging(struct qlcnic_adapter
*adapter
,
2050 struct sk_buff
*skb
,
2051 struct cmd_desc_type0
*first_desc
)
2055 __be16 protocol
= skb
->protocol
;
2056 struct vlan_ethhdr
*vh
;
2058 if (protocol
== cpu_to_be16(ETH_P_8021Q
)) {
2059 vh
= (struct vlan_ethhdr
*)skb
->data
;
2060 protocol
= vh
->h_vlan_encapsulated_proto
;
2061 flags
= FLAGS_VLAN_TAGGED
;
2062 qlcnic_set_tx_vlan_tci(first_desc
, ntohs(vh
->h_vlan_TCI
));
2063 } else if (vlan_tx_tag_present(skb
)) {
2064 flags
= FLAGS_VLAN_OOB
;
2065 qlcnic_set_tx_vlan_tci(first_desc
, vlan_tx_tag_get(skb
));
2067 if (unlikely(adapter
->pvid
)) {
2068 if (first_desc
->vlan_TCI
&&
2069 !(adapter
->flags
& QLCNIC_TAGGING_ENABLED
))
2071 if (first_desc
->vlan_TCI
&&
2072 (adapter
->flags
& QLCNIC_TAGGING_ENABLED
))
2075 flags
= FLAGS_VLAN_OOB
;
2076 qlcnic_set_tx_vlan_tci(first_desc
, adapter
->pvid
);
2079 qlcnic_set_tx_flags_opcode(first_desc
, flags
, opcode
);
2084 qlcnic_clear_cmddesc(u64
*desc
)
2092 qlcnic_xmit_frame(struct sk_buff
*skb
, struct net_device
*netdev
)
2094 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
2095 struct qlcnic_host_tx_ring
*tx_ring
= adapter
->tx_ring
;
2096 struct qlcnic_cmd_buffer
*pbuf
;
2097 struct qlcnic_skb_frag
*buffrag
;
2098 struct cmd_desc_type0
*hwdesc
, *first_desc
;
2099 struct pci_dev
*pdev
;
2100 struct ethhdr
*phdr
;
2104 int frag_count
, no_of_desc
;
2105 u32 num_txd
= tx_ring
->num_desc
;
2107 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
)) {
2108 netif_stop_queue(netdev
);
2109 return NETDEV_TX_BUSY
;
2112 if (adapter
->flags
& QLCNIC_MACSPOOF
) {
2113 phdr
= (struct ethhdr
*)skb
->data
;
2114 if (compare_ether_addr(phdr
->h_source
,
2119 frag_count
= skb_shinfo(skb
)->nr_frags
+ 1;
2121 /* 4 fragments per cmd des */
2122 no_of_desc
= (frag_count
+ 3) >> 2;
2124 if (unlikely(qlcnic_tx_avail(tx_ring
) <= TX_STOP_THRESH
)) {
2125 netif_stop_queue(netdev
);
2127 if (qlcnic_tx_avail(tx_ring
) > TX_STOP_THRESH
)
2128 netif_start_queue(netdev
);
2130 adapter
->stats
.xmit_off
++;
2131 return NETDEV_TX_BUSY
;
2135 producer
= tx_ring
->producer
;
2136 pbuf
= &tx_ring
->cmd_buf_arr
[producer
];
2138 pdev
= adapter
->pdev
;
2140 first_desc
= hwdesc
= &tx_ring
->desc_head
[producer
];
2141 qlcnic_clear_cmddesc((u64
*)hwdesc
);
2143 if (qlcnic_check_tx_tagging(adapter
, skb
, first_desc
))
2146 if (qlcnic_map_tx_skb(pdev
, skb
, pbuf
)) {
2147 adapter
->stats
.tx_dma_map_error
++;
2152 pbuf
->frag_count
= frag_count
;
2154 qlcnic_set_tx_frags_len(first_desc
, frag_count
, skb
->len
);
2155 qlcnic_set_tx_port(first_desc
, adapter
->portnum
);
2157 for (i
= 0; i
< frag_count
; i
++) {
2161 if ((k
== 0) && (i
> 0)) {
2162 /* move to next desc.*/
2163 producer
= get_next_index(producer
, num_txd
);
2164 hwdesc
= &tx_ring
->desc_head
[producer
];
2165 qlcnic_clear_cmddesc((u64
*)hwdesc
);
2166 tx_ring
->cmd_buf_arr
[producer
].skb
= NULL
;
2169 buffrag
= &pbuf
->frag_array
[i
];
2171 hwdesc
->buffer_length
[k
] = cpu_to_le16(buffrag
->length
);
2174 hwdesc
->addr_buffer1
= cpu_to_le64(buffrag
->dma
);
2177 hwdesc
->addr_buffer2
= cpu_to_le64(buffrag
->dma
);
2180 hwdesc
->addr_buffer3
= cpu_to_le64(buffrag
->dma
);
2183 hwdesc
->addr_buffer4
= cpu_to_le64(buffrag
->dma
);
2188 tx_ring
->producer
= get_next_index(producer
, num_txd
);
2190 qlcnic_tso_check(netdev
, tx_ring
, first_desc
, skb
);
2192 if (qlcnic_mac_learn
)
2193 qlcnic_send_filter(adapter
, tx_ring
, first_desc
, skb
);
2195 qlcnic_update_cmd_producer(adapter
, tx_ring
);
2197 adapter
->stats
.txbytes
+= skb
->len
;
2198 adapter
->stats
.xmitcalled
++;
2200 return NETDEV_TX_OK
;
2203 adapter
->stats
.txdropped
++;
2204 dev_kfree_skb_any(skb
);
2205 return NETDEV_TX_OK
;
2208 static int qlcnic_check_temp(struct qlcnic_adapter
*adapter
)
2210 struct net_device
*netdev
= adapter
->netdev
;
2211 u32 temp
, temp_state
, temp_val
;
2214 temp
= QLCRD32(adapter
, CRB_TEMP_STATE
);
2216 temp_state
= qlcnic_get_temp_state(temp
);
2217 temp_val
= qlcnic_get_temp_val(temp
);
2219 if (temp_state
== QLCNIC_TEMP_PANIC
) {
2220 dev_err(&netdev
->dev
,
2221 "Device temperature %d degrees C exceeds"
2222 " maximum allowed. Hardware has been shut down.\n",
2225 } else if (temp_state
== QLCNIC_TEMP_WARN
) {
2226 if (adapter
->temp
== QLCNIC_TEMP_NORMAL
) {
2227 dev_err(&netdev
->dev
,
2228 "Device temperature %d degrees C "
2229 "exceeds operating range."
2230 " Immediate action needed.\n",
2234 if (adapter
->temp
== QLCNIC_TEMP_WARN
) {
2235 dev_info(&netdev
->dev
,
2236 "Device temperature is now %d degrees C"
2237 " in normal range.\n", temp_val
);
2240 adapter
->temp
= temp_state
;
2244 void qlcnic_advert_link_change(struct qlcnic_adapter
*adapter
, int linkup
)
2246 struct net_device
*netdev
= adapter
->netdev
;
2248 if (adapter
->ahw
.linkup
&& !linkup
) {
2249 netdev_info(netdev
, "NIC Link is down\n");
2250 adapter
->ahw
.linkup
= 0;
2251 if (netif_running(netdev
)) {
2252 netif_carrier_off(netdev
);
2253 netif_stop_queue(netdev
);
2255 } else if (!adapter
->ahw
.linkup
&& linkup
) {
2256 netdev_info(netdev
, "NIC Link is up\n");
2257 adapter
->ahw
.linkup
= 1;
2258 if (netif_running(netdev
)) {
2259 netif_carrier_on(netdev
);
2260 netif_wake_queue(netdev
);
2265 static void qlcnic_tx_timeout(struct net_device
*netdev
)
2267 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
2269 if (test_bit(__QLCNIC_RESETTING
, &adapter
->state
))
2272 dev_err(&netdev
->dev
, "transmit timeout, resetting.\n");
2274 if (++adapter
->tx_timeo_cnt
>= QLCNIC_MAX_TX_TIMEOUTS
)
2275 adapter
->need_fw_reset
= 1;
2277 adapter
->reset_context
= 1;
2280 static struct net_device_stats
*qlcnic_get_stats(struct net_device
*netdev
)
2282 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
2283 struct net_device_stats
*stats
= &netdev
->stats
;
2285 stats
->rx_packets
= adapter
->stats
.rx_pkts
+ adapter
->stats
.lro_pkts
;
2286 stats
->tx_packets
= adapter
->stats
.xmitfinished
;
2287 stats
->rx_bytes
= adapter
->stats
.rxbytes
+ adapter
->stats
.lrobytes
;
2288 stats
->tx_bytes
= adapter
->stats
.txbytes
;
2289 stats
->rx_dropped
= adapter
->stats
.rxdropped
;
2290 stats
->tx_dropped
= adapter
->stats
.txdropped
;
2295 static irqreturn_t
qlcnic_clear_legacy_intr(struct qlcnic_adapter
*adapter
)
2299 status
= readl(adapter
->isr_int_vec
);
2301 if (!(status
& adapter
->int_vec_bit
))
2304 /* check interrupt state machine, to be sure */
2305 status
= readl(adapter
->crb_int_state_reg
);
2306 if (!ISR_LEGACY_INT_TRIGGERED(status
))
2309 writel(0xffffffff, adapter
->tgt_status_reg
);
2310 /* read twice to ensure write is flushed */
2311 readl(adapter
->isr_int_vec
);
2312 readl(adapter
->isr_int_vec
);
2317 static irqreturn_t
qlcnic_tmp_intr(int irq
, void *data
)
2319 struct qlcnic_host_sds_ring
*sds_ring
= data
;
2320 struct qlcnic_adapter
*adapter
= sds_ring
->adapter
;
2322 if (adapter
->flags
& QLCNIC_MSIX_ENABLED
)
2324 else if (adapter
->flags
& QLCNIC_MSI_ENABLED
) {
2325 writel(0xffffffff, adapter
->tgt_status_reg
);
2329 if (qlcnic_clear_legacy_intr(adapter
) == IRQ_NONE
)
2333 adapter
->diag_cnt
++;
2334 qlcnic_enable_int(sds_ring
);
2338 static irqreturn_t
qlcnic_intr(int irq
, void *data
)
2340 struct qlcnic_host_sds_ring
*sds_ring
= data
;
2341 struct qlcnic_adapter
*adapter
= sds_ring
->adapter
;
2343 if (qlcnic_clear_legacy_intr(adapter
) == IRQ_NONE
)
2346 napi_schedule(&sds_ring
->napi
);
2351 static irqreturn_t
qlcnic_msi_intr(int irq
, void *data
)
2353 struct qlcnic_host_sds_ring
*sds_ring
= data
;
2354 struct qlcnic_adapter
*adapter
= sds_ring
->adapter
;
2356 /* clear interrupt */
2357 writel(0xffffffff, adapter
->tgt_status_reg
);
2359 napi_schedule(&sds_ring
->napi
);
2363 static irqreturn_t
qlcnic_msix_intr(int irq
, void *data
)
2365 struct qlcnic_host_sds_ring
*sds_ring
= data
;
2367 napi_schedule(&sds_ring
->napi
);
2371 static int qlcnic_process_cmd_ring(struct qlcnic_adapter
*adapter
)
2373 u32 sw_consumer
, hw_consumer
;
2375 struct qlcnic_cmd_buffer
*buffer
;
2376 struct pci_dev
*pdev
= adapter
->pdev
;
2377 struct net_device
*netdev
= adapter
->netdev
;
2378 struct qlcnic_skb_frag
*frag
;
2380 struct qlcnic_host_tx_ring
*tx_ring
= adapter
->tx_ring
;
2382 if (!spin_trylock(&adapter
->tx_clean_lock
))
2385 sw_consumer
= tx_ring
->sw_consumer
;
2386 hw_consumer
= le32_to_cpu(*(tx_ring
->hw_consumer
));
2388 while (sw_consumer
!= hw_consumer
) {
2389 buffer
= &tx_ring
->cmd_buf_arr
[sw_consumer
];
2391 frag
= &buffer
->frag_array
[0];
2392 pci_unmap_single(pdev
, frag
->dma
, frag
->length
,
2395 for (i
= 1; i
< buffer
->frag_count
; i
++) {
2397 pci_unmap_page(pdev
, frag
->dma
, frag
->length
,
2402 adapter
->stats
.xmitfinished
++;
2403 dev_kfree_skb_any(buffer
->skb
);
2407 sw_consumer
= get_next_index(sw_consumer
, tx_ring
->num_desc
);
2408 if (++count
>= MAX_STATUS_HANDLE
)
2412 if (count
&& netif_running(netdev
)) {
2413 tx_ring
->sw_consumer
= sw_consumer
;
2417 if (netif_queue_stopped(netdev
) && netif_carrier_ok(netdev
)) {
2418 if (qlcnic_tx_avail(tx_ring
) > TX_STOP_THRESH
) {
2419 netif_wake_queue(netdev
);
2420 adapter
->stats
.xmit_on
++;
2423 adapter
->tx_timeo_cnt
= 0;
2426 * If everything is freed up to consumer then check if the ring is full
2427 * If the ring is full then check if more needs to be freed and
2428 * schedule the call back again.
2430 * This happens when there are 2 CPUs. One could be freeing and the
2431 * other filling it. If the ring is full when we get out of here and
2432 * the card has already interrupted the host then the host can miss the
2435 * There is still a possible race condition and the host could miss an
2436 * interrupt. The card has to take care of this.
2438 hw_consumer
= le32_to_cpu(*(tx_ring
->hw_consumer
));
2439 done
= (sw_consumer
== hw_consumer
);
2440 spin_unlock(&adapter
->tx_clean_lock
);
2445 static int qlcnic_poll(struct napi_struct
*napi
, int budget
)
2447 struct qlcnic_host_sds_ring
*sds_ring
=
2448 container_of(napi
, struct qlcnic_host_sds_ring
, napi
);
2450 struct qlcnic_adapter
*adapter
= sds_ring
->adapter
;
2455 tx_complete
= qlcnic_process_cmd_ring(adapter
);
2457 work_done
= qlcnic_process_rcv_ring(sds_ring
, budget
);
2459 if ((work_done
< budget
) && tx_complete
) {
2460 napi_complete(&sds_ring
->napi
);
2461 if (test_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
2462 qlcnic_enable_int(sds_ring
);
2468 static int qlcnic_rx_poll(struct napi_struct
*napi
, int budget
)
2470 struct qlcnic_host_sds_ring
*sds_ring
=
2471 container_of(napi
, struct qlcnic_host_sds_ring
, napi
);
2473 struct qlcnic_adapter
*adapter
= sds_ring
->adapter
;
2476 work_done
= qlcnic_process_rcv_ring(sds_ring
, budget
);
2478 if (work_done
< budget
) {
2479 napi_complete(&sds_ring
->napi
);
2480 if (test_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
2481 qlcnic_enable_int(sds_ring
);
2487 #ifdef CONFIG_NET_POLL_CONTROLLER
2488 static void qlcnic_poll_controller(struct net_device
*netdev
)
2491 struct qlcnic_host_sds_ring
*sds_ring
;
2492 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
2493 struct qlcnic_recv_context
*recv_ctx
= &adapter
->recv_ctx
;
2495 disable_irq(adapter
->irq
);
2496 for (ring
= 0; ring
< adapter
->max_sds_rings
; ring
++) {
2497 sds_ring
= &recv_ctx
->sds_rings
[ring
];
2498 qlcnic_intr(adapter
->irq
, sds_ring
);
2500 enable_irq(adapter
->irq
);
2505 qlcnic_idc_debug_info(struct qlcnic_adapter
*adapter
, u8 encoding
)
2509 val
= adapter
->portnum
& 0xf;
2510 val
|= encoding
<< 7;
2511 val
|= (jiffies
- adapter
->dev_rst_time
) << 8;
2513 QLCWR32(adapter
, QLCNIC_CRB_DRV_SCRATCH
, val
);
2514 adapter
->dev_rst_time
= jiffies
;
2518 qlcnic_set_drv_state(struct qlcnic_adapter
*adapter
, u8 state
)
2522 WARN_ON(state
!= QLCNIC_DEV_NEED_RESET
&&
2523 state
!= QLCNIC_DEV_NEED_QUISCENT
);
2525 if (qlcnic_api_lock(adapter
))
2528 val
= QLCRD32(adapter
, QLCNIC_CRB_DRV_STATE
);
2530 if (state
== QLCNIC_DEV_NEED_RESET
)
2531 QLC_DEV_SET_RST_RDY(val
, adapter
->portnum
);
2532 else if (state
== QLCNIC_DEV_NEED_QUISCENT
)
2533 QLC_DEV_SET_QSCNT_RDY(val
, adapter
->portnum
);
2535 QLCWR32(adapter
, QLCNIC_CRB_DRV_STATE
, val
);
2537 qlcnic_api_unlock(adapter
);
2543 qlcnic_clr_drv_state(struct qlcnic_adapter
*adapter
)
2547 if (qlcnic_api_lock(adapter
))
2550 val
= QLCRD32(adapter
, QLCNIC_CRB_DRV_STATE
);
2551 QLC_DEV_CLR_RST_QSCNT(val
, adapter
->portnum
);
2552 QLCWR32(adapter
, QLCNIC_CRB_DRV_STATE
, val
);
2554 qlcnic_api_unlock(adapter
);
2560 qlcnic_clr_all_drv_state(struct qlcnic_adapter
*adapter
, u8 failed
)
2564 if (qlcnic_api_lock(adapter
))
2567 val
= QLCRD32(adapter
, QLCNIC_CRB_DRV_ACTIVE
);
2568 QLC_DEV_CLR_REF_CNT(val
, adapter
->portnum
);
2569 QLCWR32(adapter
, QLCNIC_CRB_DRV_ACTIVE
, val
);
2572 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
, QLCNIC_DEV_FAILED
);
2573 dev_info(&adapter
->pdev
->dev
,
2574 "Device state set to Failed. Please Reboot\n");
2575 } else if (!(val
& 0x11111111))
2576 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
, QLCNIC_DEV_COLD
);
2578 val
= QLCRD32(adapter
, QLCNIC_CRB_DRV_STATE
);
2579 QLC_DEV_CLR_RST_QSCNT(val
, adapter
->portnum
);
2580 QLCWR32(adapter
, QLCNIC_CRB_DRV_STATE
, val
);
2582 qlcnic_api_unlock(adapter
);
2584 adapter
->fw_fail_cnt
= 0;
2585 clear_bit(__QLCNIC_START_FW
, &adapter
->state
);
2586 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
2589 /* Grab api lock, before checking state */
2591 qlcnic_check_drv_state(struct qlcnic_adapter
*adapter
)
2595 state
= QLCRD32(adapter
, QLCNIC_CRB_DRV_STATE
);
2596 act
= QLCRD32(adapter
, QLCNIC_CRB_DRV_ACTIVE
);
2598 if (((state
& 0x11111111) == (act
& 0x11111111)) ||
2599 ((act
& 0x11111111) == ((state
>> 1) & 0x11111111)))
2605 static int qlcnic_check_idc_ver(struct qlcnic_adapter
*adapter
)
2607 u32 val
= QLCRD32(adapter
, QLCNIC_CRB_DRV_IDC_VER
);
2609 if (val
!= QLCNIC_DRV_IDC_VER
) {
2610 dev_warn(&adapter
->pdev
->dev
, "IDC Version mismatch, driver's"
2611 " idc ver = %x; reqd = %x\n", QLCNIC_DRV_IDC_VER
, val
);
2618 qlcnic_can_start_firmware(struct qlcnic_adapter
*adapter
)
2620 u32 val
, prev_state
;
2621 u8 dev_init_timeo
= adapter
->dev_init_timeo
;
2622 u8 portnum
= adapter
->portnum
;
2625 if (test_and_clear_bit(__QLCNIC_START_FW
, &adapter
->state
))
2628 if (qlcnic_api_lock(adapter
))
2631 val
= QLCRD32(adapter
, QLCNIC_CRB_DRV_ACTIVE
);
2632 if (!(val
& (1 << (portnum
* 4)))) {
2633 QLC_DEV_SET_REF_CNT(val
, portnum
);
2634 QLCWR32(adapter
, QLCNIC_CRB_DRV_ACTIVE
, val
);
2637 prev_state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_STATE
);
2638 QLCDB(adapter
, HW
, "Device state = %u\n", prev_state
);
2640 switch (prev_state
) {
2641 case QLCNIC_DEV_COLD
:
2642 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
, QLCNIC_DEV_INITIALIZING
);
2643 QLCWR32(adapter
, QLCNIC_CRB_DRV_IDC_VER
, QLCNIC_DRV_IDC_VER
);
2644 qlcnic_idc_debug_info(adapter
, 0);
2645 qlcnic_api_unlock(adapter
);
2648 case QLCNIC_DEV_READY
:
2649 ret
= qlcnic_check_idc_ver(adapter
);
2650 qlcnic_api_unlock(adapter
);
2653 case QLCNIC_DEV_NEED_RESET
:
2654 val
= QLCRD32(adapter
, QLCNIC_CRB_DRV_STATE
);
2655 QLC_DEV_SET_RST_RDY(val
, portnum
);
2656 QLCWR32(adapter
, QLCNIC_CRB_DRV_STATE
, val
);
2659 case QLCNIC_DEV_NEED_QUISCENT
:
2660 val
= QLCRD32(adapter
, QLCNIC_CRB_DRV_STATE
);
2661 QLC_DEV_SET_QSCNT_RDY(val
, portnum
);
2662 QLCWR32(adapter
, QLCNIC_CRB_DRV_STATE
, val
);
2665 case QLCNIC_DEV_FAILED
:
2666 dev_err(&adapter
->pdev
->dev
, "Device in failed state.\n");
2667 qlcnic_api_unlock(adapter
);
2670 case QLCNIC_DEV_INITIALIZING
:
2671 case QLCNIC_DEV_QUISCENT
:
2675 qlcnic_api_unlock(adapter
);
2679 prev_state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_STATE
);
2681 if (prev_state
== QLCNIC_DEV_QUISCENT
)
2683 } while ((prev_state
!= QLCNIC_DEV_READY
) && --dev_init_timeo
);
2685 if (!dev_init_timeo
) {
2686 dev_err(&adapter
->pdev
->dev
,
2687 "Waiting for device to initialize timeout\n");
2691 if (qlcnic_api_lock(adapter
))
2694 val
= QLCRD32(adapter
, QLCNIC_CRB_DRV_STATE
);
2695 QLC_DEV_CLR_RST_QSCNT(val
, portnum
);
2696 QLCWR32(adapter
, QLCNIC_CRB_DRV_STATE
, val
);
2698 ret
= qlcnic_check_idc_ver(adapter
);
2699 qlcnic_api_unlock(adapter
);
2705 qlcnic_fwinit_work(struct work_struct
*work
)
2707 struct qlcnic_adapter
*adapter
= container_of(work
,
2708 struct qlcnic_adapter
, fw_work
.work
);
2709 u32 dev_state
= 0xf;
2711 if (qlcnic_api_lock(adapter
))
2714 dev_state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_STATE
);
2715 if (dev_state
== QLCNIC_DEV_QUISCENT
||
2716 dev_state
== QLCNIC_DEV_NEED_QUISCENT
) {
2717 qlcnic_api_unlock(adapter
);
2718 qlcnic_schedule_work(adapter
, qlcnic_fwinit_work
,
2723 if (adapter
->op_mode
== QLCNIC_NON_PRIV_FUNC
) {
2724 qlcnic_api_unlock(adapter
);
2728 if (adapter
->fw_wait_cnt
++ > adapter
->reset_ack_timeo
) {
2729 dev_err(&adapter
->pdev
->dev
, "Reset:Failed to get ack %d sec\n",
2730 adapter
->reset_ack_timeo
);
2731 goto skip_ack_check
;
2734 if (!qlcnic_check_drv_state(adapter
)) {
2736 dev_state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_STATE
);
2738 if (dev_state
== QLCNIC_DEV_NEED_RESET
) {
2739 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
,
2740 QLCNIC_DEV_INITIALIZING
);
2741 set_bit(__QLCNIC_START_FW
, &adapter
->state
);
2742 QLCDB(adapter
, DRV
, "Restarting fw\n");
2743 qlcnic_idc_debug_info(adapter
, 0);
2746 qlcnic_api_unlock(adapter
);
2748 if (!adapter
->nic_ops
->start_firmware(adapter
)) {
2749 qlcnic_schedule_work(adapter
, qlcnic_attach_work
, 0);
2750 adapter
->fw_wait_cnt
= 0;
2756 qlcnic_api_unlock(adapter
);
2759 dev_state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_STATE
);
2760 QLCDB(adapter
, HW
, "Func waiting: Device state=%u\n", dev_state
);
2762 switch (dev_state
) {
2763 case QLCNIC_DEV_READY
:
2764 if (!adapter
->nic_ops
->start_firmware(adapter
)) {
2765 qlcnic_schedule_work(adapter
, qlcnic_attach_work
, 0);
2766 adapter
->fw_wait_cnt
= 0;
2769 case QLCNIC_DEV_FAILED
:
2772 qlcnic_schedule_work(adapter
,
2773 qlcnic_fwinit_work
, FW_POLL_DELAY
);
2778 dev_err(&adapter
->pdev
->dev
, "Fwinit work failed state=%u "
2779 "fw_wait_cnt=%u\n", dev_state
, adapter
->fw_wait_cnt
);
2780 netif_device_attach(adapter
->netdev
);
2781 qlcnic_clr_all_drv_state(adapter
, 0);
2785 qlcnic_detach_work(struct work_struct
*work
)
2787 struct qlcnic_adapter
*adapter
= container_of(work
,
2788 struct qlcnic_adapter
, fw_work
.work
);
2789 struct net_device
*netdev
= adapter
->netdev
;
2792 netif_device_detach(netdev
);
2794 /* Dont grab rtnl lock during Quiscent mode */
2795 if (adapter
->dev_state
== QLCNIC_DEV_NEED_QUISCENT
) {
2796 if (netif_running(netdev
))
2797 __qlcnic_down(adapter
, netdev
);
2799 qlcnic_down(adapter
, netdev
);
2801 status
= QLCRD32(adapter
, QLCNIC_PEG_HALT_STATUS1
);
2803 if (status
& QLCNIC_RCODE_FATAL_ERROR
)
2806 if (adapter
->temp
== QLCNIC_TEMP_PANIC
)
2809 if (qlcnic_set_drv_state(adapter
, adapter
->dev_state
))
2812 adapter
->fw_wait_cnt
= 0;
2814 qlcnic_schedule_work(adapter
, qlcnic_fwinit_work
, FW_POLL_DELAY
);
2819 dev_err(&adapter
->pdev
->dev
, "detach failed; status=%d temp=%d\n",
2820 status
, adapter
->temp
);
2821 netif_device_attach(netdev
);
2822 qlcnic_clr_all_drv_state(adapter
, 1);
2825 /*Transit NPAR state to NON Operational */
2827 qlcnic_set_npar_non_operational(struct qlcnic_adapter
*adapter
)
2831 state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_NPAR_STATE
);
2832 if (state
== QLCNIC_DEV_NPAR_NON_OPER
)
2835 if (qlcnic_api_lock(adapter
))
2837 QLCWR32(adapter
, QLCNIC_CRB_DEV_NPAR_STATE
, QLCNIC_DEV_NPAR_NON_OPER
);
2838 qlcnic_api_unlock(adapter
);
2841 /* Caller should held RESETTING bit.
2842 * This should be call in sync with qlcnic_request_quiscent_mode.
2844 void qlcnic_clear_quiscent_mode(struct qlcnic_adapter
*adapter
)
2846 qlcnic_clr_drv_state(adapter
);
2847 qlcnic_api_lock(adapter
);
2848 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
, QLCNIC_DEV_READY
);
2849 qlcnic_api_unlock(adapter
);
2852 /* Caller should held RESETTING bit.
2854 int qlcnic_request_quiscent_mode(struct qlcnic_adapter
*adapter
)
2856 u8 timeo
= adapter
->dev_init_timeo
/ 2;
2859 if (qlcnic_api_lock(adapter
))
2862 state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_STATE
);
2863 if (state
!= QLCNIC_DEV_READY
)
2866 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
, QLCNIC_DEV_NEED_QUISCENT
);
2867 qlcnic_api_unlock(adapter
);
2868 QLCDB(adapter
, DRV
, "NEED QUISCENT state set\n");
2869 qlcnic_idc_debug_info(adapter
, 0);
2871 qlcnic_set_drv_state(adapter
, QLCNIC_DEV_NEED_QUISCENT
);
2875 state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_STATE
);
2876 if (state
== QLCNIC_DEV_QUISCENT
)
2878 if (!qlcnic_check_drv_state(adapter
)) {
2879 if (qlcnic_api_lock(adapter
))
2881 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
,
2882 QLCNIC_DEV_QUISCENT
);
2883 qlcnic_api_unlock(adapter
);
2884 QLCDB(adapter
, DRV
, "QUISCENT mode set\n");
2889 dev_err(&adapter
->pdev
->dev
, "Failed to quiesce device, DRV_STATE=%08x"
2890 " DRV_ACTIVE=%08x\n", QLCRD32(adapter
, QLCNIC_CRB_DRV_STATE
),
2891 QLCRD32(adapter
, QLCNIC_CRB_DRV_ACTIVE
));
2892 qlcnic_clear_quiscent_mode(adapter
);
2896 /*Transit to RESET state from READY state only */
2898 qlcnic_dev_request_reset(struct qlcnic_adapter
*adapter
)
2902 adapter
->need_fw_reset
= 1;
2903 if (qlcnic_api_lock(adapter
))
2906 state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_STATE
);
2908 if (state
== QLCNIC_DEV_READY
) {
2909 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
, QLCNIC_DEV_NEED_RESET
);
2910 QLCDB(adapter
, DRV
, "NEED_RESET state set\n");
2911 qlcnic_idc_debug_info(adapter
, 0);
2914 QLCWR32(adapter
, QLCNIC_CRB_DEV_NPAR_STATE
, QLCNIC_DEV_NPAR_NON_OPER
);
2915 qlcnic_api_unlock(adapter
);
2918 /* Transit to NPAR READY state from NPAR NOT READY state */
2920 qlcnic_dev_set_npar_ready(struct qlcnic_adapter
*adapter
)
2922 if (qlcnic_api_lock(adapter
))
2925 QLCWR32(adapter
, QLCNIC_CRB_DEV_NPAR_STATE
, QLCNIC_DEV_NPAR_OPER
);
2926 QLCDB(adapter
, DRV
, "NPAR operational state set\n");
2928 qlcnic_api_unlock(adapter
);
2932 qlcnic_schedule_work(struct qlcnic_adapter
*adapter
,
2933 work_func_t func
, int delay
)
2935 if (test_bit(__QLCNIC_AER
, &adapter
->state
))
2938 INIT_DELAYED_WORK(&adapter
->fw_work
, func
);
2939 queue_delayed_work(qlcnic_wq
, &adapter
->fw_work
,
2940 round_jiffies_relative(delay
));
2944 qlcnic_cancel_fw_work(struct qlcnic_adapter
*adapter
)
2946 while (test_and_set_bit(__QLCNIC_RESETTING
, &adapter
->state
))
2949 cancel_delayed_work_sync(&adapter
->fw_work
);
2953 qlcnic_attach_work(struct work_struct
*work
)
2955 struct qlcnic_adapter
*adapter
= container_of(work
,
2956 struct qlcnic_adapter
, fw_work
.work
);
2957 struct net_device
*netdev
= adapter
->netdev
;
2960 if (adapter
->op_mode
!= QLCNIC_MGMT_FUNC
) {
2961 npar_state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_NPAR_STATE
);
2962 if (adapter
->fw_wait_cnt
++ > QLCNIC_DEV_NPAR_OPER_TIMEO
)
2963 qlcnic_clr_all_drv_state(adapter
, 0);
2964 else if (npar_state
!= QLCNIC_DEV_NPAR_OPER
)
2965 qlcnic_schedule_work(adapter
, qlcnic_attach_work
,
2969 QLCDB(adapter
, DRV
, "Waiting for NPAR state to operational\n");
2973 if (netif_running(netdev
)) {
2974 if (qlcnic_up(adapter
, netdev
))
2977 qlcnic_restore_indev_addr(netdev
, NETDEV_UP
);
2981 netif_device_attach(netdev
);
2982 adapter
->fw_fail_cnt
= 0;
2983 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
2985 if (!qlcnic_clr_drv_state(adapter
))
2986 qlcnic_schedule_work(adapter
, qlcnic_fw_poll_work
,
2991 qlcnic_check_health(struct qlcnic_adapter
*adapter
)
2993 u32 state
= 0, heartbeat
;
2994 struct net_device
*netdev
= adapter
->netdev
;
2996 if (qlcnic_check_temp(adapter
))
2999 if (adapter
->need_fw_reset
)
3000 qlcnic_dev_request_reset(adapter
);
3002 state
= QLCRD32(adapter
, QLCNIC_CRB_DEV_STATE
);
3003 if (state
== QLCNIC_DEV_NEED_RESET
) {
3004 qlcnic_set_npar_non_operational(adapter
);
3005 adapter
->need_fw_reset
= 1;
3006 } else if (state
== QLCNIC_DEV_NEED_QUISCENT
)
3009 heartbeat
= QLCRD32(adapter
, QLCNIC_PEG_ALIVE_COUNTER
);
3010 if (heartbeat
!= adapter
->heartbeat
) {
3011 adapter
->heartbeat
= heartbeat
;
3012 adapter
->fw_fail_cnt
= 0;
3013 if (adapter
->need_fw_reset
)
3016 if (adapter
->reset_context
&&
3017 auto_fw_reset
== AUTO_FW_RESET_ENABLED
) {
3018 qlcnic_reset_hw_context(adapter
);
3019 adapter
->netdev
->trans_start
= jiffies
;
3025 if (++adapter
->fw_fail_cnt
< FW_FAIL_THRESH
)
3028 qlcnic_dev_request_reset(adapter
);
3030 if ((auto_fw_reset
== AUTO_FW_RESET_ENABLED
))
3031 clear_bit(__QLCNIC_FW_ATTACHED
, &adapter
->state
);
3033 dev_info(&netdev
->dev
, "firmware hang detected\n");
3036 adapter
->dev_state
= (state
== QLCNIC_DEV_NEED_QUISCENT
) ? state
:
3037 QLCNIC_DEV_NEED_RESET
;
3039 if ((auto_fw_reset
== AUTO_FW_RESET_ENABLED
) &&
3040 !test_and_set_bit(__QLCNIC_RESETTING
, &adapter
->state
)) {
3042 qlcnic_schedule_work(adapter
, qlcnic_detach_work
, 0);
3043 QLCDB(adapter
, DRV
, "fw recovery scheduled.\n");
3050 qlcnic_fw_poll_work(struct work_struct
*work
)
3052 struct qlcnic_adapter
*adapter
= container_of(work
,
3053 struct qlcnic_adapter
, fw_work
.work
);
3055 if (test_bit(__QLCNIC_RESETTING
, &adapter
->state
))
3059 if (qlcnic_check_health(adapter
))
3062 if (adapter
->fhash
.fnum
)
3063 qlcnic_prune_lb_filters(adapter
);
3066 qlcnic_schedule_work(adapter
, qlcnic_fw_poll_work
, FW_POLL_DELAY
);
3069 static int qlcnic_is_first_func(struct pci_dev
*pdev
)
3071 struct pci_dev
*oth_pdev
;
3072 int val
= pdev
->devfn
;
3075 oth_pdev
= pci_get_domain_bus_and_slot(pci_domain_nr
3076 (pdev
->bus
), pdev
->bus
->number
,
3077 PCI_DEVFN(PCI_SLOT(pdev
->devfn
), val
));
3081 if (oth_pdev
->current_state
!= PCI_D3cold
) {
3082 pci_dev_put(oth_pdev
);
3085 pci_dev_put(oth_pdev
);
3090 static int qlcnic_attach_func(struct pci_dev
*pdev
)
3092 int err
, first_func
;
3093 struct qlcnic_adapter
*adapter
= pci_get_drvdata(pdev
);
3094 struct net_device
*netdev
= adapter
->netdev
;
3096 pdev
->error_state
= pci_channel_io_normal
;
3098 err
= pci_enable_device(pdev
);
3102 pci_set_power_state(pdev
, PCI_D0
);
3103 pci_set_master(pdev
);
3104 pci_restore_state(pdev
);
3106 first_func
= qlcnic_is_first_func(pdev
);
3108 if (qlcnic_api_lock(adapter
))
3111 if (adapter
->op_mode
!= QLCNIC_NON_PRIV_FUNC
&& first_func
) {
3112 adapter
->need_fw_reset
= 1;
3113 set_bit(__QLCNIC_START_FW
, &adapter
->state
);
3114 QLCWR32(adapter
, QLCNIC_CRB_DEV_STATE
, QLCNIC_DEV_INITIALIZING
);
3115 QLCDB(adapter
, DRV
, "Restarting fw\n");
3117 qlcnic_api_unlock(adapter
);
3119 err
= adapter
->nic_ops
->start_firmware(adapter
);
3123 qlcnic_clr_drv_state(adapter
);
3124 qlcnic_setup_intr(adapter
);
3126 if (netif_running(netdev
)) {
3127 err
= qlcnic_attach(adapter
);
3129 qlcnic_clr_all_drv_state(adapter
, 1);
3130 clear_bit(__QLCNIC_AER
, &adapter
->state
);
3131 netif_device_attach(netdev
);
3135 err
= qlcnic_up(adapter
, netdev
);
3139 qlcnic_restore_indev_addr(netdev
, NETDEV_UP
);
3142 netif_device_attach(netdev
);
3146 static pci_ers_result_t
qlcnic_io_error_detected(struct pci_dev
*pdev
,
3147 pci_channel_state_t state
)
3149 struct qlcnic_adapter
*adapter
= pci_get_drvdata(pdev
);
3150 struct net_device
*netdev
= adapter
->netdev
;
3152 if (state
== pci_channel_io_perm_failure
)
3153 return PCI_ERS_RESULT_DISCONNECT
;
3155 if (state
== pci_channel_io_normal
)
3156 return PCI_ERS_RESULT_RECOVERED
;
3158 set_bit(__QLCNIC_AER
, &adapter
->state
);
3159 netif_device_detach(netdev
);
3161 cancel_delayed_work_sync(&adapter
->fw_work
);
3163 if (netif_running(netdev
))
3164 qlcnic_down(adapter
, netdev
);
3166 qlcnic_detach(adapter
);
3167 qlcnic_teardown_intr(adapter
);
3169 clear_bit(__QLCNIC_RESETTING
, &adapter
->state
);
3171 pci_save_state(pdev
);
3172 pci_disable_device(pdev
);
3174 return PCI_ERS_RESULT_NEED_RESET
;
3177 static pci_ers_result_t
qlcnic_io_slot_reset(struct pci_dev
*pdev
)
3179 return qlcnic_attach_func(pdev
) ? PCI_ERS_RESULT_DISCONNECT
:
3180 PCI_ERS_RESULT_RECOVERED
;
3183 static void qlcnic_io_resume(struct pci_dev
*pdev
)
3185 struct qlcnic_adapter
*adapter
= pci_get_drvdata(pdev
);
3187 pci_cleanup_aer_uncorrect_error_status(pdev
);
3189 if (QLCRD32(adapter
, QLCNIC_CRB_DEV_STATE
) == QLCNIC_DEV_READY
&&
3190 test_and_clear_bit(__QLCNIC_AER
, &adapter
->state
))
3191 qlcnic_schedule_work(adapter
, qlcnic_fw_poll_work
,
3196 qlcnicvf_start_firmware(struct qlcnic_adapter
*adapter
)
3200 err
= qlcnic_can_start_firmware(adapter
);
3204 err
= qlcnic_check_npar_opertional(adapter
);
3208 err
= qlcnic_initialize_nic(adapter
);
3212 qlcnic_check_options(adapter
);
3214 err
= qlcnic_set_eswitch_port_config(adapter
);
3218 adapter
->need_fw_reset
= 0;
3224 qlcnicvf_config_bridged_mode(struct qlcnic_adapter
*adapter
, u32 enable
)
3230 qlcnicvf_config_led(struct qlcnic_adapter
*adapter
, u32 state
, u32 rate
)
3236 qlcnic_store_bridged_mode(struct device
*dev
,
3237 struct device_attribute
*attr
, const char *buf
, size_t len
)
3239 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3243 if (!(adapter
->capabilities
& QLCNIC_FW_CAPABILITY_BDG
))
3246 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
3249 if (strict_strtoul(buf
, 2, &new))
3252 if (!adapter
->nic_ops
->config_bridged_mode(adapter
, !!new))
3260 qlcnic_show_bridged_mode(struct device
*dev
,
3261 struct device_attribute
*attr
, char *buf
)
3263 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3264 int bridged_mode
= 0;
3266 if (adapter
->capabilities
& QLCNIC_FW_CAPABILITY_BDG
)
3267 bridged_mode
= !!(adapter
->flags
& QLCNIC_BRIDGE_ENABLED
);
3269 return sprintf(buf
, "%d\n", bridged_mode
);
3272 static struct device_attribute dev_attr_bridged_mode
= {
3273 .attr
= {.name
= "bridged_mode", .mode
= (S_IRUGO
| S_IWUSR
)},
3274 .show
= qlcnic_show_bridged_mode
,
3275 .store
= qlcnic_store_bridged_mode
,
3279 qlcnic_store_diag_mode(struct device
*dev
,
3280 struct device_attribute
*attr
, const char *buf
, size_t len
)
3282 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3285 if (strict_strtoul(buf
, 2, &new))
3288 if (!!new != !!(adapter
->flags
& QLCNIC_DIAG_ENABLED
))
3289 adapter
->flags
^= QLCNIC_DIAG_ENABLED
;
3295 qlcnic_show_diag_mode(struct device
*dev
,
3296 struct device_attribute
*attr
, char *buf
)
3298 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3300 return sprintf(buf
, "%d\n",
3301 !!(adapter
->flags
& QLCNIC_DIAG_ENABLED
));
3304 static struct device_attribute dev_attr_diag_mode
= {
3305 .attr
= {.name
= "diag_mode", .mode
= (S_IRUGO
| S_IWUSR
)},
3306 .show
= qlcnic_show_diag_mode
,
3307 .store
= qlcnic_store_diag_mode
,
3311 qlcnic_sysfs_validate_crb(struct qlcnic_adapter
*adapter
,
3312 loff_t offset
, size_t size
)
3314 size_t crb_size
= 4;
3316 if (!(adapter
->flags
& QLCNIC_DIAG_ENABLED
))
3319 if (offset
< QLCNIC_PCI_CRBSPACE
) {
3320 if (ADDR_IN_RANGE(offset
, QLCNIC_PCI_CAMQM
,
3321 QLCNIC_PCI_CAMQM_END
))
3327 if ((size
!= crb_size
) || (offset
& (crb_size
-1)))
3334 qlcnic_sysfs_read_crb(struct file
*filp
, struct kobject
*kobj
,
3335 struct bin_attribute
*attr
,
3336 char *buf
, loff_t offset
, size_t size
)
3338 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3339 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3344 ret
= qlcnic_sysfs_validate_crb(adapter
, offset
, size
);
3348 if (ADDR_IN_RANGE(offset
, QLCNIC_PCI_CAMQM
, QLCNIC_PCI_CAMQM_END
)) {
3349 qlcnic_pci_camqm_read_2M(adapter
, offset
, &qmdata
);
3350 memcpy(buf
, &qmdata
, size
);
3352 data
= QLCRD32(adapter
, offset
);
3353 memcpy(buf
, &data
, size
);
3359 qlcnic_sysfs_write_crb(struct file
*filp
, struct kobject
*kobj
,
3360 struct bin_attribute
*attr
,
3361 char *buf
, loff_t offset
, size_t size
)
3363 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3364 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3369 ret
= qlcnic_sysfs_validate_crb(adapter
, offset
, size
);
3373 if (ADDR_IN_RANGE(offset
, QLCNIC_PCI_CAMQM
, QLCNIC_PCI_CAMQM_END
)) {
3374 memcpy(&qmdata
, buf
, size
);
3375 qlcnic_pci_camqm_write_2M(adapter
, offset
, qmdata
);
3377 memcpy(&data
, buf
, size
);
3378 QLCWR32(adapter
, offset
, data
);
3384 qlcnic_sysfs_validate_mem(struct qlcnic_adapter
*adapter
,
3385 loff_t offset
, size_t size
)
3387 if (!(adapter
->flags
& QLCNIC_DIAG_ENABLED
))
3390 if ((size
!= 8) || (offset
& 0x7))
3397 qlcnic_sysfs_read_mem(struct file
*filp
, struct kobject
*kobj
,
3398 struct bin_attribute
*attr
,
3399 char *buf
, loff_t offset
, size_t size
)
3401 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3402 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3406 ret
= qlcnic_sysfs_validate_mem(adapter
, offset
, size
);
3410 if (qlcnic_pci_mem_read_2M(adapter
, offset
, &data
))
3413 memcpy(buf
, &data
, size
);
3419 qlcnic_sysfs_write_mem(struct file
*filp
, struct kobject
*kobj
,
3420 struct bin_attribute
*attr
,
3421 char *buf
, loff_t offset
, size_t size
)
3423 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3424 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3428 ret
= qlcnic_sysfs_validate_mem(adapter
, offset
, size
);
3432 memcpy(&data
, buf
, size
);
3434 if (qlcnic_pci_mem_write_2M(adapter
, offset
, data
))
3441 static struct bin_attribute bin_attr_crb
= {
3442 .attr
= {.name
= "crb", .mode
= (S_IRUGO
| S_IWUSR
)},
3444 .read
= qlcnic_sysfs_read_crb
,
3445 .write
= qlcnic_sysfs_write_crb
,
3448 static struct bin_attribute bin_attr_mem
= {
3449 .attr
= {.name
= "mem", .mode
= (S_IRUGO
| S_IWUSR
)},
3451 .read
= qlcnic_sysfs_read_mem
,
3452 .write
= qlcnic_sysfs_write_mem
,
3456 validate_pm_config(struct qlcnic_adapter
*adapter
,
3457 struct qlcnic_pm_func_cfg
*pm_cfg
, int count
)
3460 u8 src_pci_func
, s_esw_id
, d_esw_id
;
3464 for (i
= 0; i
< count
; i
++) {
3465 src_pci_func
= pm_cfg
[i
].pci_func
;
3466 dest_pci_func
= pm_cfg
[i
].dest_npar
;
3467 if (src_pci_func
>= QLCNIC_MAX_PCI_FUNC
3468 || dest_pci_func
>= QLCNIC_MAX_PCI_FUNC
)
3469 return QL_STATUS_INVALID_PARAM
;
3471 if (adapter
->npars
[src_pci_func
].type
!= QLCNIC_TYPE_NIC
)
3472 return QL_STATUS_INVALID_PARAM
;
3474 if (adapter
->npars
[dest_pci_func
].type
!= QLCNIC_TYPE_NIC
)
3475 return QL_STATUS_INVALID_PARAM
;
3477 s_esw_id
= adapter
->npars
[src_pci_func
].phy_port
;
3478 d_esw_id
= adapter
->npars
[dest_pci_func
].phy_port
;
3480 if (s_esw_id
!= d_esw_id
)
3481 return QL_STATUS_INVALID_PARAM
;
3489 qlcnic_sysfs_write_pm_config(struct file
*filp
, struct kobject
*kobj
,
3490 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3492 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3493 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3494 struct qlcnic_pm_func_cfg
*pm_cfg
;
3495 u32 id
, action
, pci_func
;
3496 int count
, rem
, i
, ret
;
3498 count
= size
/ sizeof(struct qlcnic_pm_func_cfg
);
3499 rem
= size
% sizeof(struct qlcnic_pm_func_cfg
);
3501 return QL_STATUS_INVALID_PARAM
;
3503 pm_cfg
= (struct qlcnic_pm_func_cfg
*) buf
;
3505 ret
= validate_pm_config(adapter
, pm_cfg
, count
);
3508 for (i
= 0; i
< count
; i
++) {
3509 pci_func
= pm_cfg
[i
].pci_func
;
3510 action
= !!pm_cfg
[i
].action
;
3511 id
= adapter
->npars
[pci_func
].phy_port
;
3512 ret
= qlcnic_config_port_mirroring(adapter
, id
,
3518 for (i
= 0; i
< count
; i
++) {
3519 pci_func
= pm_cfg
[i
].pci_func
;
3520 id
= adapter
->npars
[pci_func
].phy_port
;
3521 adapter
->npars
[pci_func
].enable_pm
= !!pm_cfg
[i
].action
;
3522 adapter
->npars
[pci_func
].dest_npar
= id
;
3528 qlcnic_sysfs_read_pm_config(struct file
*filp
, struct kobject
*kobj
,
3529 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3531 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3532 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3533 struct qlcnic_pm_func_cfg pm_cfg
[QLCNIC_MAX_PCI_FUNC
];
3536 if (size
!= sizeof(pm_cfg
))
3537 return QL_STATUS_INVALID_PARAM
;
3539 for (i
= 0; i
< QLCNIC_MAX_PCI_FUNC
; i
++) {
3540 if (adapter
->npars
[i
].type
!= QLCNIC_TYPE_NIC
)
3542 pm_cfg
[i
].action
= adapter
->npars
[i
].enable_pm
;
3543 pm_cfg
[i
].dest_npar
= 0;
3544 pm_cfg
[i
].pci_func
= i
;
3546 memcpy(buf
, &pm_cfg
, size
);
3552 validate_esw_config(struct qlcnic_adapter
*adapter
,
3553 struct qlcnic_esw_func_cfg
*esw_cfg
, int count
)
3559 op_mode
= readl(adapter
->ahw
.pci_base0
+ QLCNIC_DRV_OP_MODE
);
3561 for (i
= 0; i
< count
; i
++) {
3562 pci_func
= esw_cfg
[i
].pci_func
;
3563 if (pci_func
>= QLCNIC_MAX_PCI_FUNC
)
3564 return QL_STATUS_INVALID_PARAM
;
3566 if (adapter
->op_mode
== QLCNIC_MGMT_FUNC
)
3567 if (adapter
->npars
[pci_func
].type
!= QLCNIC_TYPE_NIC
)
3568 return QL_STATUS_INVALID_PARAM
;
3570 switch (esw_cfg
[i
].op_mode
) {
3571 case QLCNIC_PORT_DEFAULTS
:
3572 if (QLC_DEV_GET_DRV(op_mode
, pci_func
) !=
3573 QLCNIC_NON_PRIV_FUNC
) {
3574 esw_cfg
[i
].mac_anti_spoof
= 0;
3575 esw_cfg
[i
].mac_override
= 1;
3578 case QLCNIC_ADD_VLAN
:
3579 if (!IS_VALID_VLAN(esw_cfg
[i
].vlan_id
))
3580 return QL_STATUS_INVALID_PARAM
;
3581 if (!esw_cfg
[i
].op_type
)
3582 return QL_STATUS_INVALID_PARAM
;
3584 case QLCNIC_DEL_VLAN
:
3585 if (!esw_cfg
[i
].op_type
)
3586 return QL_STATUS_INVALID_PARAM
;
3589 return QL_STATUS_INVALID_PARAM
;
3596 qlcnic_sysfs_write_esw_config(struct file
*file
, struct kobject
*kobj
,
3597 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3599 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3600 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3601 struct qlcnic_esw_func_cfg
*esw_cfg
;
3602 struct qlcnic_npar_info
*npar
;
3603 int count
, rem
, i
, ret
;
3604 u8 pci_func
, op_mode
= 0;
3606 count
= size
/ sizeof(struct qlcnic_esw_func_cfg
);
3607 rem
= size
% sizeof(struct qlcnic_esw_func_cfg
);
3609 return QL_STATUS_INVALID_PARAM
;
3611 esw_cfg
= (struct qlcnic_esw_func_cfg
*) buf
;
3612 ret
= validate_esw_config(adapter
, esw_cfg
, count
);
3616 for (i
= 0; i
< count
; i
++) {
3617 if (adapter
->op_mode
== QLCNIC_MGMT_FUNC
)
3618 if (qlcnic_config_switch_port(adapter
, &esw_cfg
[i
]))
3619 return QL_STATUS_INVALID_PARAM
;
3621 if (adapter
->ahw
.pci_func
!= esw_cfg
[i
].pci_func
)
3624 op_mode
= esw_cfg
[i
].op_mode
;
3625 qlcnic_get_eswitch_port_config(adapter
, &esw_cfg
[i
]);
3626 esw_cfg
[i
].op_mode
= op_mode
;
3627 esw_cfg
[i
].pci_func
= adapter
->ahw
.pci_func
;
3629 switch (esw_cfg
[i
].op_mode
) {
3630 case QLCNIC_PORT_DEFAULTS
:
3631 qlcnic_set_eswitch_port_features(adapter
, &esw_cfg
[i
]);
3633 case QLCNIC_ADD_VLAN
:
3634 qlcnic_set_vlan_config(adapter
, &esw_cfg
[i
]);
3636 case QLCNIC_DEL_VLAN
:
3637 esw_cfg
[i
].vlan_id
= 0;
3638 qlcnic_set_vlan_config(adapter
, &esw_cfg
[i
]);
3643 if (adapter
->op_mode
!= QLCNIC_MGMT_FUNC
)
3646 for (i
= 0; i
< count
; i
++) {
3647 pci_func
= esw_cfg
[i
].pci_func
;
3648 npar
= &adapter
->npars
[pci_func
];
3649 switch (esw_cfg
[i
].op_mode
) {
3650 case QLCNIC_PORT_DEFAULTS
:
3651 npar
->promisc_mode
= esw_cfg
[i
].promisc_mode
;
3652 npar
->mac_override
= esw_cfg
[i
].mac_override
;
3653 npar
->offload_flags
= esw_cfg
[i
].offload_flags
;
3654 npar
->mac_anti_spoof
= esw_cfg
[i
].mac_anti_spoof
;
3655 npar
->discard_tagged
= esw_cfg
[i
].discard_tagged
;
3657 case QLCNIC_ADD_VLAN
:
3658 npar
->pvid
= esw_cfg
[i
].vlan_id
;
3660 case QLCNIC_DEL_VLAN
:
3670 qlcnic_sysfs_read_esw_config(struct file
*file
, struct kobject
*kobj
,
3671 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3673 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3674 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3675 struct qlcnic_esw_func_cfg esw_cfg
[QLCNIC_MAX_PCI_FUNC
];
3678 if (size
!= sizeof(esw_cfg
))
3679 return QL_STATUS_INVALID_PARAM
;
3681 for (i
= 0; i
< QLCNIC_MAX_PCI_FUNC
; i
++) {
3682 if (adapter
->npars
[i
].type
!= QLCNIC_TYPE_NIC
)
3684 esw_cfg
[i
].pci_func
= i
;
3685 if (qlcnic_get_eswitch_port_config(adapter
, &esw_cfg
[i
]))
3686 return QL_STATUS_INVALID_PARAM
;
3688 memcpy(buf
, &esw_cfg
, size
);
3694 validate_npar_config(struct qlcnic_adapter
*adapter
,
3695 struct qlcnic_npar_func_cfg
*np_cfg
, int count
)
3699 for (i
= 0; i
< count
; i
++) {
3700 pci_func
= np_cfg
[i
].pci_func
;
3701 if (pci_func
>= QLCNIC_MAX_PCI_FUNC
)
3702 return QL_STATUS_INVALID_PARAM
;
3704 if (adapter
->npars
[pci_func
].type
!= QLCNIC_TYPE_NIC
)
3705 return QL_STATUS_INVALID_PARAM
;
3707 if (!IS_VALID_BW(np_cfg
[i
].min_bw
)
3708 || !IS_VALID_BW(np_cfg
[i
].max_bw
)
3709 || !IS_VALID_RX_QUEUES(np_cfg
[i
].max_rx_queues
)
3710 || !IS_VALID_TX_QUEUES(np_cfg
[i
].max_tx_queues
))
3711 return QL_STATUS_INVALID_PARAM
;
3717 qlcnic_sysfs_write_npar_config(struct file
*file
, struct kobject
*kobj
,
3718 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3720 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3721 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3722 struct qlcnic_info nic_info
;
3723 struct qlcnic_npar_func_cfg
*np_cfg
;
3724 int i
, count
, rem
, ret
;
3727 count
= size
/ sizeof(struct qlcnic_npar_func_cfg
);
3728 rem
= size
% sizeof(struct qlcnic_npar_func_cfg
);
3730 return QL_STATUS_INVALID_PARAM
;
3732 np_cfg
= (struct qlcnic_npar_func_cfg
*) buf
;
3733 ret
= validate_npar_config(adapter
, np_cfg
, count
);
3737 for (i
= 0; i
< count
; i
++) {
3738 pci_func
= np_cfg
[i
].pci_func
;
3739 ret
= qlcnic_get_nic_info(adapter
, &nic_info
, pci_func
);
3742 nic_info
.pci_func
= pci_func
;
3743 nic_info
.min_tx_bw
= np_cfg
[i
].min_bw
;
3744 nic_info
.max_tx_bw
= np_cfg
[i
].max_bw
;
3745 ret
= qlcnic_set_nic_info(adapter
, &nic_info
);
3748 adapter
->npars
[i
].min_bw
= nic_info
.min_tx_bw
;
3749 adapter
->npars
[i
].max_bw
= nic_info
.max_tx_bw
;
3756 qlcnic_sysfs_read_npar_config(struct file
*file
, struct kobject
*kobj
,
3757 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3759 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3760 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3761 struct qlcnic_info nic_info
;
3762 struct qlcnic_npar_func_cfg np_cfg
[QLCNIC_MAX_PCI_FUNC
];
3765 if (size
!= sizeof(np_cfg
))
3766 return QL_STATUS_INVALID_PARAM
;
3768 for (i
= 0; i
< QLCNIC_MAX_PCI_FUNC
; i
++) {
3769 if (adapter
->npars
[i
].type
!= QLCNIC_TYPE_NIC
)
3771 ret
= qlcnic_get_nic_info(adapter
, &nic_info
, i
);
3775 np_cfg
[i
].pci_func
= i
;
3776 np_cfg
[i
].op_mode
= (u8
)nic_info
.op_mode
;
3777 np_cfg
[i
].port_num
= nic_info
.phys_port
;
3778 np_cfg
[i
].fw_capab
= nic_info
.capabilities
;
3779 np_cfg
[i
].min_bw
= nic_info
.min_tx_bw
;
3780 np_cfg
[i
].max_bw
= nic_info
.max_tx_bw
;
3781 np_cfg
[i
].max_tx_queues
= nic_info
.max_tx_ques
;
3782 np_cfg
[i
].max_rx_queues
= nic_info
.max_rx_ques
;
3784 memcpy(buf
, &np_cfg
, size
);
3789 qlcnic_sysfs_get_port_stats(struct file
*file
, struct kobject
*kobj
,
3790 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3792 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3793 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3794 struct qlcnic_esw_statistics port_stats
;
3797 if (size
!= sizeof(struct qlcnic_esw_statistics
))
3798 return QL_STATUS_INVALID_PARAM
;
3800 if (offset
>= QLCNIC_MAX_PCI_FUNC
)
3801 return QL_STATUS_INVALID_PARAM
;
3803 memset(&port_stats
, 0, size
);
3804 ret
= qlcnic_get_port_stats(adapter
, offset
, QLCNIC_QUERY_RX_COUNTER
,
3809 ret
= qlcnic_get_port_stats(adapter
, offset
, QLCNIC_QUERY_TX_COUNTER
,
3814 memcpy(buf
, &port_stats
, size
);
3819 qlcnic_sysfs_get_esw_stats(struct file
*file
, struct kobject
*kobj
,
3820 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3822 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3823 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3824 struct qlcnic_esw_statistics esw_stats
;
3827 if (size
!= sizeof(struct qlcnic_esw_statistics
))
3828 return QL_STATUS_INVALID_PARAM
;
3830 if (offset
>= QLCNIC_NIU_MAX_XG_PORTS
)
3831 return QL_STATUS_INVALID_PARAM
;
3833 memset(&esw_stats
, 0, size
);
3834 ret
= qlcnic_get_eswitch_stats(adapter
, offset
, QLCNIC_QUERY_RX_COUNTER
,
3839 ret
= qlcnic_get_eswitch_stats(adapter
, offset
, QLCNIC_QUERY_TX_COUNTER
,
3844 memcpy(buf
, &esw_stats
, size
);
3849 qlcnic_sysfs_clear_esw_stats(struct file
*file
, struct kobject
*kobj
,
3850 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3852 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3853 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3856 if (offset
>= QLCNIC_NIU_MAX_XG_PORTS
)
3857 return QL_STATUS_INVALID_PARAM
;
3859 ret
= qlcnic_clear_esw_stats(adapter
, QLCNIC_STATS_ESWITCH
, offset
,
3860 QLCNIC_QUERY_RX_COUNTER
);
3864 ret
= qlcnic_clear_esw_stats(adapter
, QLCNIC_STATS_ESWITCH
, offset
,
3865 QLCNIC_QUERY_TX_COUNTER
);
3873 qlcnic_sysfs_clear_port_stats(struct file
*file
, struct kobject
*kobj
,
3874 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3877 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3878 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3881 if (offset
>= QLCNIC_MAX_PCI_FUNC
)
3882 return QL_STATUS_INVALID_PARAM
;
3884 ret
= qlcnic_clear_esw_stats(adapter
, QLCNIC_STATS_PORT
, offset
,
3885 QLCNIC_QUERY_RX_COUNTER
);
3889 ret
= qlcnic_clear_esw_stats(adapter
, QLCNIC_STATS_PORT
, offset
,
3890 QLCNIC_QUERY_TX_COUNTER
);
3898 qlcnic_sysfs_read_pci_config(struct file
*file
, struct kobject
*kobj
,
3899 struct bin_attribute
*attr
, char *buf
, loff_t offset
, size_t size
)
3901 struct device
*dev
= container_of(kobj
, struct device
, kobj
);
3902 struct qlcnic_adapter
*adapter
= dev_get_drvdata(dev
);
3903 struct qlcnic_pci_func_cfg pci_cfg
[QLCNIC_MAX_PCI_FUNC
];
3904 struct qlcnic_pci_info
*pci_info
;
3907 if (size
!= sizeof(pci_cfg
))
3908 return QL_STATUS_INVALID_PARAM
;
3910 pci_info
= kcalloc(QLCNIC_MAX_PCI_FUNC
, sizeof(*pci_info
), GFP_KERNEL
);
3914 ret
= qlcnic_get_pci_info(adapter
, pci_info
);
3920 for (i
= 0; i
< QLCNIC_MAX_PCI_FUNC
; i
++) {
3921 pci_cfg
[i
].pci_func
= pci_info
[i
].id
;
3922 pci_cfg
[i
].func_type
= pci_info
[i
].type
;
3923 pci_cfg
[i
].port_num
= pci_info
[i
].default_port
;
3924 pci_cfg
[i
].min_bw
= pci_info
[i
].tx_min_bw
;
3925 pci_cfg
[i
].max_bw
= pci_info
[i
].tx_max_bw
;
3926 memcpy(&pci_cfg
[i
].def_mac_addr
, &pci_info
[i
].mac
, ETH_ALEN
);
3928 memcpy(buf
, &pci_cfg
, size
);
3932 static struct bin_attribute bin_attr_npar_config
= {
3933 .attr
= {.name
= "npar_config", .mode
= (S_IRUGO
| S_IWUSR
)},
3935 .read
= qlcnic_sysfs_read_npar_config
,
3936 .write
= qlcnic_sysfs_write_npar_config
,
3939 static struct bin_attribute bin_attr_pci_config
= {
3940 .attr
= {.name
= "pci_config", .mode
= (S_IRUGO
| S_IWUSR
)},
3942 .read
= qlcnic_sysfs_read_pci_config
,
3946 static struct bin_attribute bin_attr_port_stats
= {
3947 .attr
= {.name
= "port_stats", .mode
= (S_IRUGO
| S_IWUSR
)},
3949 .read
= qlcnic_sysfs_get_port_stats
,
3950 .write
= qlcnic_sysfs_clear_port_stats
,
3953 static struct bin_attribute bin_attr_esw_stats
= {
3954 .attr
= {.name
= "esw_stats", .mode
= (S_IRUGO
| S_IWUSR
)},
3956 .read
= qlcnic_sysfs_get_esw_stats
,
3957 .write
= qlcnic_sysfs_clear_esw_stats
,
3960 static struct bin_attribute bin_attr_esw_config
= {
3961 .attr
= {.name
= "esw_config", .mode
= (S_IRUGO
| S_IWUSR
)},
3963 .read
= qlcnic_sysfs_read_esw_config
,
3964 .write
= qlcnic_sysfs_write_esw_config
,
3967 static struct bin_attribute bin_attr_pm_config
= {
3968 .attr
= {.name
= "pm_config", .mode
= (S_IRUGO
| S_IWUSR
)},
3970 .read
= qlcnic_sysfs_read_pm_config
,
3971 .write
= qlcnic_sysfs_write_pm_config
,
3975 qlcnic_create_sysfs_entries(struct qlcnic_adapter
*adapter
)
3977 struct device
*dev
= &adapter
->pdev
->dev
;
3979 if (adapter
->capabilities
& QLCNIC_FW_CAPABILITY_BDG
)
3980 if (device_create_file(dev
, &dev_attr_bridged_mode
))
3982 "failed to create bridged_mode sysfs entry\n");
3986 qlcnic_remove_sysfs_entries(struct qlcnic_adapter
*adapter
)
3988 struct device
*dev
= &adapter
->pdev
->dev
;
3990 if (adapter
->capabilities
& QLCNIC_FW_CAPABILITY_BDG
)
3991 device_remove_file(dev
, &dev_attr_bridged_mode
);
3995 qlcnic_create_diag_entries(struct qlcnic_adapter
*adapter
)
3997 struct device
*dev
= &adapter
->pdev
->dev
;
3999 if (device_create_bin_file(dev
, &bin_attr_port_stats
))
4000 dev_info(dev
, "failed to create port stats sysfs entry");
4002 if (adapter
->op_mode
== QLCNIC_NON_PRIV_FUNC
)
4004 if (device_create_file(dev
, &dev_attr_diag_mode
))
4005 dev_info(dev
, "failed to create diag_mode sysfs entry\n");
4006 if (device_create_bin_file(dev
, &bin_attr_crb
))
4007 dev_info(dev
, "failed to create crb sysfs entry\n");
4008 if (device_create_bin_file(dev
, &bin_attr_mem
))
4009 dev_info(dev
, "failed to create mem sysfs entry\n");
4010 if (!(adapter
->flags
& QLCNIC_ESWITCH_ENABLED
))
4012 if (device_create_bin_file(dev
, &bin_attr_esw_config
))
4013 dev_info(dev
, "failed to create esw config sysfs entry");
4014 if (adapter
->op_mode
!= QLCNIC_MGMT_FUNC
)
4016 if (device_create_bin_file(dev
, &bin_attr_pci_config
))
4017 dev_info(dev
, "failed to create pci config sysfs entry");
4018 if (device_create_bin_file(dev
, &bin_attr_npar_config
))
4019 dev_info(dev
, "failed to create npar config sysfs entry");
4020 if (device_create_bin_file(dev
, &bin_attr_pm_config
))
4021 dev_info(dev
, "failed to create pm config sysfs entry");
4022 if (device_create_bin_file(dev
, &bin_attr_esw_stats
))
4023 dev_info(dev
, "failed to create eswitch stats sysfs entry");
4027 qlcnic_remove_diag_entries(struct qlcnic_adapter
*adapter
)
4029 struct device
*dev
= &adapter
->pdev
->dev
;
4031 device_remove_bin_file(dev
, &bin_attr_port_stats
);
4033 if (adapter
->op_mode
== QLCNIC_NON_PRIV_FUNC
)
4035 device_remove_file(dev
, &dev_attr_diag_mode
);
4036 device_remove_bin_file(dev
, &bin_attr_crb
);
4037 device_remove_bin_file(dev
, &bin_attr_mem
);
4038 if (!(adapter
->flags
& QLCNIC_ESWITCH_ENABLED
))
4040 device_remove_bin_file(dev
, &bin_attr_esw_config
);
4041 if (adapter
->op_mode
!= QLCNIC_MGMT_FUNC
)
4043 device_remove_bin_file(dev
, &bin_attr_pci_config
);
4044 device_remove_bin_file(dev
, &bin_attr_npar_config
);
4045 device_remove_bin_file(dev
, &bin_attr_pm_config
);
4046 device_remove_bin_file(dev
, &bin_attr_esw_stats
);
4051 #define is_qlcnic_netdev(dev) (dev->netdev_ops == &qlcnic_netdev_ops)
4054 qlcnic_config_indev_addr(struct qlcnic_adapter
*adapter
,
4055 struct net_device
*dev
, unsigned long event
)
4057 struct in_device
*indev
;
4059 indev
= in_dev_get(dev
);
4066 qlcnic_config_ipaddr(adapter
,
4067 ifa
->ifa_address
, QLCNIC_IP_UP
);
4070 qlcnic_config_ipaddr(adapter
,
4071 ifa
->ifa_address
, QLCNIC_IP_DOWN
);
4076 } endfor_ifa(indev
);
4082 qlcnic_restore_indev_addr(struct net_device
*netdev
, unsigned long event
)
4084 struct qlcnic_adapter
*adapter
= netdev_priv(netdev
);
4085 struct net_device
*dev
;
4088 qlcnic_config_indev_addr(adapter
, netdev
, event
);
4090 if (!adapter
->vlgrp
)
4093 for (vid
= 0; vid
< VLAN_GROUP_ARRAY_LEN
; vid
++) {
4094 dev
= vlan_group_get_device(adapter
->vlgrp
, vid
);
4098 qlcnic_config_indev_addr(adapter
, dev
, event
);
4102 static int qlcnic_netdev_event(struct notifier_block
*this,
4103 unsigned long event
, void *ptr
)
4105 struct qlcnic_adapter
*adapter
;
4106 struct net_device
*dev
= (struct net_device
*)ptr
;
4112 if (dev
->priv_flags
& IFF_802_1Q_VLAN
) {
4113 dev
= vlan_dev_real_dev(dev
);
4117 if (!is_qlcnic_netdev(dev
))
4120 adapter
= netdev_priv(dev
);
4125 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
4128 qlcnic_config_indev_addr(adapter
, dev
, event
);
4134 qlcnic_inetaddr_event(struct notifier_block
*this,
4135 unsigned long event
, void *ptr
)
4137 struct qlcnic_adapter
*adapter
;
4138 struct net_device
*dev
;
4140 struct in_ifaddr
*ifa
= (struct in_ifaddr
*)ptr
;
4142 dev
= ifa
->ifa_dev
? ifa
->ifa_dev
->dev
: NULL
;
4148 if (dev
->priv_flags
& IFF_802_1Q_VLAN
) {
4149 dev
= vlan_dev_real_dev(dev
);
4153 if (!is_qlcnic_netdev(dev
))
4156 adapter
= netdev_priv(dev
);
4161 if (!test_bit(__QLCNIC_DEV_UP
, &adapter
->state
))
4166 qlcnic_config_ipaddr(adapter
, ifa
->ifa_address
, QLCNIC_IP_UP
);
4169 qlcnic_config_ipaddr(adapter
, ifa
->ifa_address
, QLCNIC_IP_DOWN
);
4179 static struct notifier_block qlcnic_netdev_cb
= {
4180 .notifier_call
= qlcnic_netdev_event
,
4183 static struct notifier_block qlcnic_inetaddr_cb
= {
4184 .notifier_call
= qlcnic_inetaddr_event
,
4188 qlcnic_restore_indev_addr(struct net_device
*dev
, unsigned long event
)
4191 static struct pci_error_handlers qlcnic_err_handler
= {
4192 .error_detected
= qlcnic_io_error_detected
,
4193 .slot_reset
= qlcnic_io_slot_reset
,
4194 .resume
= qlcnic_io_resume
,
4197 static struct pci_driver qlcnic_driver
= {
4198 .name
= qlcnic_driver_name
,
4199 .id_table
= qlcnic_pci_tbl
,
4200 .probe
= qlcnic_probe
,
4201 .remove
= __devexit_p(qlcnic_remove
),
4203 .suspend
= qlcnic_suspend
,
4204 .resume
= qlcnic_resume
,
4206 .shutdown
= qlcnic_shutdown
,
4207 .err_handler
= &qlcnic_err_handler
4211 static int __init
qlcnic_init_module(void)
4215 printk(KERN_INFO
"%s\n", qlcnic_driver_string
);
4217 qlcnic_wq
= create_singlethread_workqueue("qlcnic");
4218 if (qlcnic_wq
== NULL
) {
4219 printk(KERN_ERR
"qlcnic: cannot create workqueue\n");
4224 register_netdevice_notifier(&qlcnic_netdev_cb
);
4225 register_inetaddr_notifier(&qlcnic_inetaddr_cb
);
4228 ret
= pci_register_driver(&qlcnic_driver
);
4231 unregister_inetaddr_notifier(&qlcnic_inetaddr_cb
);
4232 unregister_netdevice_notifier(&qlcnic_netdev_cb
);
4234 destroy_workqueue(qlcnic_wq
);
4240 module_init(qlcnic_init_module
);
4242 static void __exit
qlcnic_exit_module(void)
4245 pci_unregister_driver(&qlcnic_driver
);
4248 unregister_inetaddr_notifier(&qlcnic_inetaddr_cb
);
4249 unregister_netdevice_notifier(&qlcnic_netdev_cb
);
4251 destroy_workqueue(qlcnic_wq
);
4254 module_exit(qlcnic_exit_module
);