projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge tag 'v3.5-rc6' into irqdomain/next
[deliverable/linux.git] / drivers / net / ethernet / qlogic / qlcnic / qlcnic_main.c
CommitLineData
af19b491 1/*
40839129
SV		 2 * QLogic qlcnic NIC Driver
3 * Copyright (c) 2009-2010 QLogic Corporation
af19b491 4 *
40839129 5 * See LICENSE.qlcnic for copyright and licensing details.
af19b491
AKS		 6 */
7
5a0e3ad6 8#include <linux/slab.h>
af19b491
AKS		 9#include <linux/vmalloc.h>
10#include <linux/interrupt.h>
11
12#include "qlcnic.h"
13
7e56cac4 14#include <linux/swab.h>
af19b491 15#include <linux/dma-mapping.h>
af19b491
AKS		 16#include <net/ip.h>
17#include <linux/ipv6.h>
18#include <linux/inetdevice.h>
19#include <linux/sysfs.h>
451724c8 20#include <linux/aer.h>
f94bc1e7 21#include <linux/log2.h>
af19b491 22
7f9a0c34 23MODULE_DESCRIPTION("QLogic 1/10 GbE Converged/Intelligent Ethernet Driver");
af19b491
AKS		 24MODULE_LICENSE("GPL");
25MODULE_VERSION(QLCNIC_LINUX_VERSIONID);
26MODULE_FIRMWARE(QLCNIC_UNIFIED_ROMIMAGE_NAME);
27
28char qlcnic_driver_name[] = "qlcnic";
7f9a0c34
SV		 29static const char qlcnic_driver_string[] = "QLogic 1/10 GbE "
30 "Converged/Intelligent Ethernet Driver v" QLCNIC_LINUX_VERSIONID;
af19b491 31
f7ec804a 32static struct workqueue_struct *qlcnic_wq;
b5e5492c 33static int qlcnic_mac_learn;
b11a25aa 34module_param(qlcnic_mac_learn, int, 0444);
b5e5492c
AKS		 35MODULE_PARM_DESC(qlcnic_mac_learn, "Mac Filter (0=disabled, 1=enabled)");
36
af19b491 37static int use_msi = 1;
b11a25aa 38module_param(use_msi, int, 0444);
af19b491
AKS		 39MODULE_PARM_DESC(use_msi, "MSI interrupt (0=disabled, 1=enabled");
40
41static int use_msi_x = 1;
b11a25aa 42module_param(use_msi_x, int, 0444);
af19b491
AKS		 43MODULE_PARM_DESC(use_msi_x, "MSI-X interrupt (0=disabled, 1=enabled");
44
9ce13ca8 45static int auto_fw_reset = 1;
af19b491
AKS		 46module_param(auto_fw_reset, int, 0644);
47MODULE_PARM_DESC(auto_fw_reset, "Auto firmware reset (0=disabled, 1=enabled");
48
4d5bdb38 49static int load_fw_file;
b11a25aa 50module_param(load_fw_file, int, 0444);
4d5bdb38
AKS		 51MODULE_PARM_DESC(load_fw_file, "Load firmware from (0=flash, 1=file");
52
2e9d722d 53static int qlcnic_config_npars;
b11a25aa 54module_param(qlcnic_config_npars, int, 0444);
2e9d722d
AC		 55MODULE_PARM_DESC(qlcnic_config_npars, "Configure NPARs (0=disabled, 1=enabled");
56
af19b491
AKS		 57static int __devinit qlcnic_probe(struct pci_dev *pdev,
58 const struct pci_device_id *ent);
59static void __devexit qlcnic_remove(struct pci_dev *pdev);
60static int qlcnic_open(struct net_device *netdev);
61static int qlcnic_close(struct net_device *netdev);
af19b491 62static void qlcnic_tx_timeout(struct net_device *netdev);
af19b491
AKS		 63static void qlcnic_attach_work(struct work_struct *work);
64static void qlcnic_fwinit_work(struct work_struct *work);
65static void qlcnic_fw_poll_work(struct work_struct *work);
66static void qlcnic_schedule_work(struct qlcnic_adapter *adapter,
67 work_func_t func, int delay);
68static void qlcnic_cancel_fw_work(struct qlcnic_adapter *adapter);
69static int qlcnic_poll(struct napi_struct *napi, int budget);
8f891387 70static int qlcnic_rx_poll(struct napi_struct *napi, int budget);
af19b491
AKS		 71#ifdef CONFIG_NET_POLL_CONTROLLER
72static void qlcnic_poll_controller(struct net_device *netdev);
73#endif
74
75static void qlcnic_create_sysfs_entries(struct qlcnic_adapter *adapter);
76static void qlcnic_remove_sysfs_entries(struct qlcnic_adapter *adapter);
77static void qlcnic_create_diag_entries(struct qlcnic_adapter *adapter);
78static void qlcnic_remove_diag_entries(struct qlcnic_adapter *adapter);
79
6df900e9 80static void qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding);
21854f02 81static void qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8);
af19b491
AKS		 82static int qlcnic_can_start_firmware(struct qlcnic_adapter *adapter);
83
7eb9855d 84static irqreturn_t qlcnic_tmp_intr(int irq, void *data);
af19b491
AKS		 85static irqreturn_t qlcnic_intr(int irq, void *data);
86static irqreturn_t qlcnic_msi_intr(int irq, void *data);
87static irqreturn_t qlcnic_msix_intr(int irq, void *data);
88
89static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev);
aec1e845 90static void qlcnic_restore_indev_addr(struct net_device *dev, unsigned long);
9f26f547
AC		 91static int qlcnic_start_firmware(struct qlcnic_adapter *);
92
b5e5492c 93static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter);
9f26f547 94static void qlcnic_dev_set_npar_ready(struct qlcnic_adapter *);
9f26f547
AC		 95static int qlcnicvf_config_led(struct qlcnic_adapter *, u32, u32);
96static int qlcnicvf_config_bridged_mode(struct qlcnic_adapter *, u32);
97static int qlcnicvf_start_firmware(struct qlcnic_adapter *);
0325d69b
RB		 98static void qlcnic_set_netdev_features(struct qlcnic_adapter *,
99 struct qlcnic_esw_func_cfg *);
8e586137
JP		 100static int qlcnic_vlan_rx_add(struct net_device *, u16);
101static int qlcnic_vlan_rx_del(struct net_device *, u16);
b9796a14 102
af19b491
AKS		 103/* PCI Device ID Table */
104#define ENTRY(device) \
105 {PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, (device)), \
106 .class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}
107
108#define PCI_DEVICE_ID_QLOGIC_QLE824X 0x8020
109
6a902881 110static DEFINE_PCI_DEVICE_TABLE(qlcnic_pci_tbl) = {
af19b491
AKS		 111 ENTRY(PCI_DEVICE_ID_QLOGIC_QLE824X),
112 {0,}
113};
114
115MODULE_DEVICE_TABLE(pci, qlcnic_pci_tbl);
116
117
b1fc6d3c 118inline void
af19b491
AKS		 119qlcnic_update_cmd_producer(struct qlcnic_adapter *adapter,
120 struct qlcnic_host_tx_ring *tx_ring)
121{
122 writel(tx_ring->producer, tx_ring->crb_cmd_producer);
af19b491
AKS		 123}
124
125static const u32 msi_tgt_status[8] = {
126 ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1,
127 ISR_INT_TARGET_STATUS_F2, ISR_INT_TARGET_STATUS_F3,
128 ISR_INT_TARGET_STATUS_F4, ISR_INT_TARGET_STATUS_F5,
129 ISR_INT_TARGET_STATUS_F6, ISR_INT_TARGET_STATUS_F7
130};
131
132static const
133struct qlcnic_legacy_intr_set legacy_intr[] = QLCNIC_LEGACY_INTR_CONFIG;
134
135static inline void qlcnic_disable_int(struct qlcnic_host_sds_ring *sds_ring)
136{
137 writel(0, sds_ring->crb_intr_mask);
138}
139
140static inline void qlcnic_enable_int(struct qlcnic_host_sds_ring *sds_ring)
141{
142 struct qlcnic_adapter *adapter = sds_ring->adapter;
143
144 writel(0x1, sds_ring->crb_intr_mask);
145
146 if (!QLCNIC_IS_MSI_FAMILY(adapter))
147 writel(0xfbff, adapter->tgt_mask_reg);
148}
149
150static int
151qlcnic_alloc_sds_rings(struct qlcnic_recv_context *recv_ctx, int count)
152{
153 int size = sizeof(struct qlcnic_host_sds_ring) * count;
154
155 recv_ctx->sds_rings = kzalloc(size, GFP_KERNEL);
156
807540ba 157 return recv_ctx->sds_rings == NULL;
af19b491
AKS		 158}
159
160static void
161qlcnic_free_sds_rings(struct qlcnic_recv_context *recv_ctx)
162{
163 if (recv_ctx->sds_rings != NULL)
164 kfree(recv_ctx->sds_rings);
165
166 recv_ctx->sds_rings = NULL;
167}
168
169static int
170qlcnic_napi_add(struct qlcnic_adapter *adapter, struct net_device *netdev)
171{
172 int ring;
173 struct qlcnic_host_sds_ring *sds_ring;
b1fc6d3c 174 struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
af19b491
AKS		 175
176 if (qlcnic_alloc_sds_rings(recv_ctx, adapter->max_sds_rings))
177 return -ENOMEM;
178
179 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
180 sds_ring = &recv_ctx->sds_rings[ring];
8f891387 181
182 if (ring == adapter->max_sds_rings - 1)
183 netif_napi_add(netdev, &sds_ring->napi, qlcnic_poll,
184 QLCNIC_NETDEV_WEIGHT/adapter->max_sds_rings);
185 else
186 netif_napi_add(netdev, &sds_ring->napi,
187 qlcnic_rx_poll, QLCNIC_NETDEV_WEIGHT*2);
af19b491
AKS		 188 }
189
190 return 0;
191}
192
193static void
194qlcnic_napi_del(struct qlcnic_adapter *adapter)
195{
196 int ring;
197 struct qlcnic_host_sds_ring *sds_ring;
b1fc6d3c 198 struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
af19b491
AKS		 199
200 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
201 sds_ring = &recv_ctx->sds_rings[ring];
202 netif_napi_del(&sds_ring->napi);
203 }
204
b1fc6d3c 205 qlcnic_free_sds_rings(adapter->recv_ctx);
af19b491
AKS		 206}
207
208static void
209qlcnic_napi_enable(struct qlcnic_adapter *adapter)
210{
211 int ring;
212 struct qlcnic_host_sds_ring *sds_ring;
b1fc6d3c 213 struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
af19b491 214
780ab790
AKS		 215 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
216 return;
217
af19b491
AKS		 218 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
219 sds_ring = &recv_ctx->sds_rings[ring];
220 napi_enable(&sds_ring->napi);
221 qlcnic_enable_int(sds_ring);
222 }
223}
224
225static void
226qlcnic_napi_disable(struct qlcnic_adapter *adapter)
227{
228 int ring;
229 struct qlcnic_host_sds_ring *sds_ring;
b1fc6d3c 230 struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
af19b491 231
780ab790
AKS		 232 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
233 return;
234
af19b491
AKS		 235 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
236 sds_ring = &recv_ctx->sds_rings[ring];
237 qlcnic_disable_int(sds_ring);
238 napi_synchronize(&sds_ring->napi);
239 napi_disable(&sds_ring->napi);
240 }
241}
242
243static void qlcnic_clear_stats(struct qlcnic_adapter *adapter)
244{
245 memset(&adapter->stats, 0, sizeof(adapter->stats));
af19b491
AKS		 246}
247
af19b491
AKS		 248static void qlcnic_set_msix_bit(struct pci_dev *pdev, int enable)
249{
250 u32 control;
251 int pos;
252
253 pos = pci_find_capability(pdev, PCI_CAP_ID_MSIX);
254 if (pos) {
255 pci_read_config_dword(pdev, pos, &control);
256 if (enable)
257 control |= PCI_MSIX_FLAGS_ENABLE;
258 else
259 control = 0;
260 pci_write_config_dword(pdev, pos, control);
261 }
262}
263
264static void qlcnic_init_msix_entries(struct qlcnic_adapter *adapter, int count)
265{
266 int i;
267
268 for (i = 0; i < count; i++)
269 adapter->msix_entries[i].entry = i;
270}
271
272static int
273qlcnic_read_mac_addr(struct qlcnic_adapter *adapter)
274{
2e9d722d 275 u8 mac_addr[ETH_ALEN];
af19b491
AKS		 276 struct net_device *netdev = adapter->netdev;
277 struct pci_dev *pdev = adapter->pdev;
278
da48e6c3 279 if (qlcnic_get_mac_address(adapter, mac_addr) != 0)
af19b491
AKS		 280 return -EIO;
281
2e9d722d 282 memcpy(netdev->dev_addr, mac_addr, ETH_ALEN);
af19b491
AKS		 283 memcpy(netdev->perm_addr, netdev->dev_addr, netdev->addr_len);
284 memcpy(adapter->mac_addr, netdev->dev_addr, netdev->addr_len);
285
286 /* set station address */
287
288 if (!is_valid_ether_addr(netdev->perm_addr))
289 dev_warn(&pdev->dev, "Bad MAC address %pM.\n",
290 netdev->dev_addr);
291
292 return 0;
293}
294
295static int qlcnic_set_mac(struct net_device *netdev, void *p)
296{
297 struct qlcnic_adapter *adapter = netdev_priv(netdev);
298 struct sockaddr *addr = p;
299
7373373d
RB		 300 if ((adapter->flags & QLCNIC_MAC_OVERRIDE_DISABLED))
301 return -EOPNOTSUPP;
302
af19b491 303 if (!is_valid_ether_addr(addr->sa_data))
504f9b5a 304 return -EADDRNOTAVAIL;
af19b491 305
8a15ad1f 306 if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
af19b491
AKS		 307 netif_device_detach(netdev);
308 qlcnic_napi_disable(adapter);
309 }
310
311 memcpy(adapter->mac_addr, addr->sa_data, netdev->addr_len);
312 memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
313 qlcnic_set_multi(adapter->netdev);
314
8a15ad1f 315 if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
af19b491
AKS		 316 netif_device_attach(netdev);
317 qlcnic_napi_enable(adapter);
318 }
319 return 0;
320}
321
322static const struct net_device_ops qlcnic_netdev_ops = {
323 .ndo_open = qlcnic_open,
324 .ndo_stop = qlcnic_close,
325 .ndo_start_xmit = qlcnic_xmit_frame,
326 .ndo_get_stats = qlcnic_get_stats,
327 .ndo_validate_addr = eth_validate_addr,
afc4b13d 328 .ndo_set_rx_mode = qlcnic_set_multi,
af19b491
AKS		 329 .ndo_set_mac_address = qlcnic_set_mac,
330 .ndo_change_mtu = qlcnic_change_mtu,
135d84a9
MM		 331 .ndo_fix_features = qlcnic_fix_features,
332 .ndo_set_features = qlcnic_set_features,
af19b491 333 .ndo_tx_timeout = qlcnic_tx_timeout,
b9796a14
AC		 334 .ndo_vlan_rx_add_vid = qlcnic_vlan_rx_add,
335 .ndo_vlan_rx_kill_vid = qlcnic_vlan_rx_del,
af19b491
AKS		 336#ifdef CONFIG_NET_POLL_CONTROLLER
337 .ndo_poll_controller = qlcnic_poll_controller,
338#endif
339};
340
b43e5ee7
SC		 341static const struct net_device_ops qlcnic_netdev_failed_ops = {
342 .ndo_open = qlcnic_open,
343};
344
2e9d722d 345static struct qlcnic_nic_template qlcnic_ops = {
2e9d722d
AC		 346 .config_bridged_mode = qlcnic_config_bridged_mode,
347 .config_led = qlcnic_config_led,
9f26f547
AC		 348 .start_firmware = qlcnic_start_firmware
349};
350
351static struct qlcnic_nic_template qlcnic_vf_ops = {
9f26f547
AC		 352 .config_bridged_mode = qlcnicvf_config_bridged_mode,
353 .config_led = qlcnicvf_config_led,
9f26f547 354 .start_firmware = qlcnicvf_start_firmware
2e9d722d
AC		 355};
356
f94bc1e7 357static int qlcnic_enable_msix(struct qlcnic_adapter *adapter, u32 num_msix)
af19b491 358{
af19b491 359 struct pci_dev *pdev = adapter->pdev;
f94bc1e7 360 int err = -1;
af19b491
AKS		 361
362 adapter->max_sds_rings = 1;
af19b491 363 adapter->flags &= ~(QLCNIC_MSI_ENABLED | QLCNIC_MSIX_ENABLED);
af19b491
AKS		 364 qlcnic_set_msix_bit(pdev, 0);
365
366 if (adapter->msix_supported) {
f94bc1e7 367 enable_msix:
af19b491
AKS		 368 qlcnic_init_msix_entries(adapter, num_msix);
369 err = pci_enable_msix(pdev, adapter->msix_entries, num_msix);
370 if (err == 0) {
371 adapter->flags |= QLCNIC_MSIX_ENABLED;
372 qlcnic_set_msix_bit(pdev, 1);
373
b1fc6d3c 374 adapter->max_sds_rings = num_msix;
af19b491
AKS		 375
376 dev_info(&pdev->dev, "using msi-x interrupts\n");
f94bc1e7 377 return err;
af19b491 378 }
f94bc1e7
SC		 379 if (err > 0) {
380 num_msix = rounddown_pow_of_two(err);
381 if (num_msix)
382 goto enable_msix;
383 }
384 }
385 return err;
386}
af19b491 387
af19b491 388
f94bc1e7
SC		 389static void qlcnic_enable_msi_legacy(struct qlcnic_adapter *adapter)
390{
391 const struct qlcnic_legacy_intr_set *legacy_intrp;
392 struct pci_dev *pdev = adapter->pdev;
af19b491
AKS		 393
394 if (use_msi && !pci_enable_msi(pdev)) {
395 adapter->flags |= QLCNIC_MSI_ENABLED;
396 adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter,
b1fc6d3c 397 msi_tgt_status[adapter->ahw->pci_func]);
af19b491
AKS		 398 dev_info(&pdev->dev, "using msi interrupts\n");
399 adapter->msix_entries[0].vector = pdev->irq;
400 return;
401 }
402
f94bc1e7
SC		 403 legacy_intrp = &legacy_intr[adapter->ahw->pci_func];
404
405 adapter->int_vec_bit = legacy_intrp->int_vec_bit;
406 adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter,
407 legacy_intrp->tgt_status_reg);
408 adapter->tgt_mask_reg = qlcnic_get_ioaddr(adapter,
409 legacy_intrp->tgt_mask_reg);
410 adapter->isr_int_vec = qlcnic_get_ioaddr(adapter, ISR_INT_VECTOR);
411
412 adapter->crb_int_state_reg = qlcnic_get_ioaddr(adapter,
413 ISR_INT_STATE_REG);
af19b491
AKS		 414 dev_info(&pdev->dev, "using legacy interrupts\n");
415 adapter->msix_entries[0].vector = pdev->irq;
416}
417
f94bc1e7
SC		 418static void
419qlcnic_setup_intr(struct qlcnic_adapter *adapter)
420{
421 int num_msix;
422
423 if (adapter->msix_supported) {
5f6ec29a
SC		 424 num_msix = rounddown_pow_of_two(min_t(int, num_online_cpus(),
425 QLCNIC_DEF_NUM_STS_DESC_RINGS));
f94bc1e7
SC		 426 } else
427 num_msix = 1;
428
429 if (!qlcnic_enable_msix(adapter, num_msix))
430 return;
431
432 qlcnic_enable_msi_legacy(adapter);
433}
434
af19b491
AKS		 435static void
436qlcnic_teardown_intr(struct qlcnic_adapter *adapter)
437{
438 if (adapter->flags & QLCNIC_MSIX_ENABLED)
439 pci_disable_msix(adapter->pdev);
440 if (adapter->flags & QLCNIC_MSI_ENABLED)
441 pci_disable_msi(adapter->pdev);
442}
443
444static void
445qlcnic_cleanup_pci_map(struct qlcnic_adapter *adapter)
446{
b1fc6d3c
AC		 447 if (adapter->ahw->pci_base0 != NULL)
448 iounmap(adapter->ahw->pci_base0);
af19b491
AKS		 449}
450
346fe763
RB		 451static int
452qlcnic_init_pci_info(struct qlcnic_adapter *adapter)
453{
e88db3bd 454 struct qlcnic_pci_info *pci_info;
900853a4 455 int i, ret = 0;
346fe763
RB		 456 u8 pfn;
457
e88db3bd
DC		 458 pci_info = kcalloc(QLCNIC_MAX_PCI_FUNC, sizeof(*pci_info), GFP_KERNEL);
459 if (!pci_info)
460 return -ENOMEM;
461
ca315ac2 462 adapter->npars = kzalloc(sizeof(struct qlcnic_npar_info) *
346fe763 463 QLCNIC_MAX_PCI_FUNC, GFP_KERNEL);
e88db3bd 464 if (!adapter->npars) {
900853a4 465 ret = -ENOMEM;
e88db3bd
DC		 466 goto err_pci_info;
467 }
346fe763 468
ca315ac2 469 adapter->eswitch = kzalloc(sizeof(struct qlcnic_eswitch) *
346fe763
RB		 470 QLCNIC_NIU_MAX_XG_PORTS, GFP_KERNEL);
471 if (!adapter->eswitch) {
900853a4 472 ret = -ENOMEM;
ca315ac2 473 goto err_npars;
346fe763
RB		 474 }
475
476 ret = qlcnic_get_pci_info(adapter, pci_info);
ca315ac2
DC		 477 if (ret)
478 goto err_eswitch;
346fe763 479
ca315ac2
DC		 480 for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
481 pfn = pci_info[i].id;
0f6efff9 482 if (pfn >= QLCNIC_MAX_PCI_FUNC) {
f848d6dd
SC		 483 ret = QL_STATUS_INVALID_PARAM;
484 goto err_eswitch;
485 }
a1c0c459
SC		 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;
ca315ac2
DC		 489 adapter->npars[pfn].min_bw = pci_info[i].tx_min_bw;
490 adapter->npars[pfn].max_bw = pci_info[i].tx_max_bw;
346fe763
RB		 491 }
492
ca315ac2
DC		 493 for (i = 0; i < QLCNIC_NIU_MAX_XG_PORTS; i++)
494 adapter->eswitch[i].flags |= QLCNIC_SWITCH_ENABLE;
495
e88db3bd 496 kfree(pci_info);
ca315ac2
DC		 497 return 0;
498
499err_eswitch:
346fe763
RB		 500 kfree(adapter->eswitch);
501 adapter->eswitch = NULL;
ca315ac2 502err_npars:
346fe763 503 kfree(adapter->npars);
ca315ac2 504 adapter->npars = NULL;
e88db3bd
DC		 505err_pci_info:
506 kfree(pci_info);
346fe763
RB		 507
508 return ret;
509}
510
2e9d722d
AC		 511static int
512qlcnic_set_function_modes(struct qlcnic_adapter *adapter)
513{
514 u8 id;
515 u32 ref_count;
516 int i, ret = 1;
517 u32 data = QLCNIC_MGMT_FUNC;
b1fc6d3c 518 void __iomem *priv_op = adapter->ahw->pci_base0 + QLCNIC_DRV_OP_MODE;
2e9d722d
AC		 519
520 /* If other drivers are not in use set their privilege level */
31018e06 521 ref_count = QLCRD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
2e9d722d
AC		 522 ret = qlcnic_api_lock(adapter);
523 if (ret)
524 goto err_lock;
2e9d722d 525
0e33c664
AC		 526 if (qlcnic_config_npars) {
527 for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
346fe763 528 id = i;
0e33c664 529 if (adapter->npars[i].type != QLCNIC_TYPE_NIC ||
b1fc6d3c 530 id == adapter->ahw->pci_func)
0e33c664
AC		 531 continue;
532 data |= (qlcnic_config_npars &
533 QLC_DEV_SET_DRV(0xf, id));
534 }
535 } else {
536 data = readl(priv_op);
b1fc6d3c 537 data = (data & ~QLC_DEV_SET_DRV(0xf, adapter->ahw->pci_func)) |
0e33c664 538 (QLC_DEV_SET_DRV(QLCNIC_MGMT_FUNC,
b1fc6d3c 539 adapter->ahw->pci_func));
2e9d722d
AC		 540 }
541 writel(data, priv_op);
2e9d722d
AC		 542 qlcnic_api_unlock(adapter);
543err_lock:
544 return ret;
545}
546
0866d96d
AC		 547static void
548qlcnic_check_vf(struct qlcnic_adapter *adapter)
2e9d722d
AC		 549{
550 void __iomem *msix_base_addr;
551 void __iomem *priv_op;
552 u32 func;
553 u32 msix_base;
554 u32 op_mode, priv_level;
555
556 /* Determine FW API version */
b1fc6d3c
AC		 557 adapter->fw_hal_version = readl(adapter->ahw->pci_base0 +
558 QLCNIC_FW_API);
2e9d722d
AC		 559
560 /* Find PCI function number */
561 pci_read_config_dword(adapter->pdev, QLCNIC_MSIX_TABLE_OFFSET, &func);
b1fc6d3c 562 msix_base_addr = adapter->ahw->pci_base0 + QLCNIC_MSIX_BASE;
2e9d722d
AC		 563 msix_base = readl(msix_base_addr);
564 func = (func - msix_base)/QLCNIC_MSIX_TBL_PGSIZE;
b1fc6d3c 565 adapter->ahw->pci_func = func;
2e9d722d
AC		 566
567 /* Determine function privilege level */
b1fc6d3c 568 priv_op = adapter->ahw->pci_base0 + QLCNIC_DRV_OP_MODE;
2e9d722d 569 op_mode = readl(priv_op);
0e33c664 570 if (op_mode == QLC_DEV_DRV_DEFAULT)
2e9d722d 571 priv_level = QLCNIC_MGMT_FUNC;
0e33c664 572 else
b1fc6d3c 573 priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
2e9d722d 574
0866d96d 575 if (priv_level == QLCNIC_NON_PRIV_FUNC) {
9f26f547
AC		 576 adapter->op_mode = QLCNIC_NON_PRIV_FUNC;
577 dev_info(&adapter->pdev->dev,
578 "HAL Version: %d Non Privileged function\n",
579 adapter->fw_hal_version);
580 adapter->nic_ops = &qlcnic_vf_ops;
0866d96d
AC		 581 } else
582 adapter->nic_ops = &qlcnic_ops;
2e9d722d
AC		 583}
584
af19b491
AKS		 585static int
586qlcnic_setup_pci_map(struct qlcnic_adapter *adapter)
587{
588 void __iomem *mem_ptr0 = NULL;
589 resource_size_t mem_base;
590 unsigned long mem_len, pci_len0 = 0;
591
592 struct pci_dev *pdev = adapter->pdev;
af19b491 593
af19b491
AKS		 594 /* remap phys address */
595 mem_base = pci_resource_start(pdev, 0); /* 0 is for BAR 0 */
596 mem_len = pci_resource_len(pdev, 0);
597
598 if (mem_len == QLCNIC_PCI_2MB_SIZE) {
599
600 mem_ptr0 = pci_ioremap_bar(pdev, 0);
601 if (mem_ptr0 == NULL) {
602 dev_err(&pdev->dev, "failed to map PCI bar 0\n");
603 return -EIO;
604 }
605 pci_len0 = mem_len;
606 } else {
607 return -EIO;
608 }
609
610 dev_info(&pdev->dev, "%dMB memory map\n", (int)(mem_len>>20));
611
b1fc6d3c
AC		 612 adapter->ahw->pci_base0 = mem_ptr0;
613 adapter->ahw->pci_len0 = pci_len0;
af19b491 614
0866d96d 615 qlcnic_check_vf(adapter);
2e9d722d 616
b1fc6d3c
AC		 617 adapter->ahw->ocm_win_crb = qlcnic_get_ioaddr(adapter,
618 QLCNIC_PCIX_PS_REG(PCIX_OCM_WINDOW_REG(
619 adapter->ahw->pci_func)));
af19b491
AKS		 620
621 return 0;
622}
623
624static void get_brd_name(struct qlcnic_adapter *adapter, char *name)
625{
626 struct pci_dev *pdev = adapter->pdev;
627 int i, found = 0;
628
629 for (i = 0; i < NUM_SUPPORTED_BOARDS; ++i) {
630 if (qlcnic_boards[i].vendor == pdev->vendor &&
631 qlcnic_boards[i].device == pdev->device &&
632 qlcnic_boards[i].sub_vendor == pdev->subsystem_vendor &&
633 qlcnic_boards[i].sub_device == pdev->subsystem_device) {
02f6e46f
SC		 634 sprintf(name, "%pM: %s" ,
635 adapter->mac_addr,
636 qlcnic_boards[i].short_name);
af19b491
AKS		 637 found = 1;
638 break;
639 }
640
641 }
642
643 if (!found)
7f9a0c34 644 sprintf(name, "%pM Gigabit Ethernet", adapter->mac_addr);
af19b491
AKS		 645}
646
647static void
648qlcnic_check_options(struct qlcnic_adapter *adapter)
649{
031a4a26 650 u32 fw_major, fw_minor, fw_build, prev_fw_version;
af19b491 651 struct pci_dev *pdev = adapter->pdev;
031a4a26
SV		 652 struct qlcnic_fw_dump *fw_dump = &adapter->ahw->fw_dump;
653
654 prev_fw_version = adapter->fw_version;
af19b491
AKS		 655
656 fw_major = QLCRD32(adapter, QLCNIC_FW_VERSION_MAJOR);
657 fw_minor = QLCRD32(adapter, QLCNIC_FW_VERSION_MINOR);
658 fw_build = QLCRD32(adapter, QLCNIC_FW_VERSION_SUB);
659
660 adapter->fw_version = QLCNIC_VERSION_CODE(fw_major, fw_minor, fw_build);
661
031a4a26
SV		 662 if (adapter->op_mode != QLCNIC_NON_PRIV_FUNC) {
663 if (fw_dump->tmpl_hdr == NULL ||
664 adapter->fw_version > prev_fw_version) {
665 if (fw_dump->tmpl_hdr)
666 vfree(fw_dump->tmpl_hdr);
667 if (!qlcnic_fw_cmd_get_minidump_temp(adapter))
668 dev_info(&pdev->dev,
669 "Supports FW dump capability\n");
670 }
671 }
672
251a84c9
AKS		 673 dev_info(&pdev->dev, "firmware v%d.%d.%d\n",
674 fw_major, fw_minor, fw_build);
b1fc6d3c 675 if (adapter->ahw->port_type == QLCNIC_XGBE) {
90d19005
SC		 676 if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
677 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_VF;
678 adapter->max_rxd = MAX_RCV_DESCRIPTORS_VF;
679 } else {
680 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_10G;
681 adapter->max_rxd = MAX_RCV_DESCRIPTORS_10G;
682 }
683
af19b491 684 adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
90d19005
SC		 685 adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
686
b1fc6d3c 687 } else if (adapter->ahw->port_type == QLCNIC_GBE) {
af19b491
AKS		 688 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
689 adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
90d19005
SC		 690 adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
691 adapter->max_rxd = MAX_RCV_DESCRIPTORS_1G;
af19b491
AKS		 692 }
693
694 adapter->msix_supported = !!use_msi_x;
af19b491
AKS		 695
696 adapter->num_txd = MAX_CMD_DESCRIPTORS;
697
251b036a 698 adapter->max_rds_rings = MAX_RDS_RINGS;
af19b491
AKS		 699}
700
174240a8
RB		 701static int
702qlcnic_initialize_nic(struct qlcnic_adapter *adapter)
703{
704 int err;
705 struct qlcnic_info nic_info;
706
b1fc6d3c 707 err = qlcnic_get_nic_info(adapter, &nic_info, adapter->ahw->pci_func);
174240a8
RB		 708 if (err)
709 return err;
710
a1c0c459 711 adapter->physical_port = (u8)nic_info.phys_port;
174240a8
RB		 712 adapter->switch_mode = nic_info.switch_mode;
713 adapter->max_tx_ques = nic_info.max_tx_ques;
714 adapter->max_rx_ques = nic_info.max_rx_ques;
715 adapter->capabilities = nic_info.capabilities;
716 adapter->max_mac_filters = nic_info.max_mac_filters;
717 adapter->max_mtu = nic_info.max_mtu;
718
719 if (adapter->capabilities & BIT_6)
720 adapter->flags |= QLCNIC_ESWITCH_ENABLED;
721 else
722 adapter->flags &= ~QLCNIC_ESWITCH_ENABLED;
723
724 return err;
725}
726
8cf61f89
AKS		 727static void
728qlcnic_set_vlan_config(struct qlcnic_adapter *adapter,
729 struct qlcnic_esw_func_cfg *esw_cfg)
730{
731 if (esw_cfg->discard_tagged)
732 adapter->flags &= ~QLCNIC_TAGGING_ENABLED;
733 else
734 adapter->flags |= QLCNIC_TAGGING_ENABLED;
735
736 if (esw_cfg->vlan_id)
737 adapter->pvid = esw_cfg->vlan_id;
738 else
739 adapter->pvid = 0;
740}
741
8e586137 742static int
b9796a14
AC		 743qlcnic_vlan_rx_add(struct net_device *netdev, u16 vid)
744{
745 struct qlcnic_adapter *adapter = netdev_priv(netdev);
746 set_bit(vid, adapter->vlans);
8e586137 747 return 0;
b9796a14
AC		 748}
749
8e586137 750static int
b9796a14
AC		 751qlcnic_vlan_rx_del(struct net_device *netdev, u16 vid)
752{
753 struct qlcnic_adapter *adapter = netdev_priv(netdev);
754
755 qlcnic_restore_indev_addr(netdev, NETDEV_DOWN);
756 clear_bit(vid, adapter->vlans);
8e586137 757 return 0;
b9796a14
AC		 758}
759
0325d69b
RB		 760static void
761qlcnic_set_eswitch_port_features(struct qlcnic_adapter *adapter,
762 struct qlcnic_esw_func_cfg *esw_cfg)
763{
ee07c1a7
RB		 764 adapter->flags &= ~(QLCNIC_MACSPOOF | QLCNIC_MAC_OVERRIDE_DISABLED |
765 QLCNIC_PROMISC_DISABLED);
7613c87b
RB		 766
767 if (esw_cfg->mac_anti_spoof)
768 adapter->flags |= QLCNIC_MACSPOOF;
fe4d434d 769
7373373d
RB		 770 if (!esw_cfg->mac_override)
771 adapter->flags |= QLCNIC_MAC_OVERRIDE_DISABLED;
772
ee07c1a7
RB		 773 if (!esw_cfg->promisc_mode)
774 adapter->flags |= QLCNIC_PROMISC_DISABLED;
775
0325d69b
RB		 776 qlcnic_set_netdev_features(adapter, esw_cfg);
777}
778
779static int
780qlcnic_set_eswitch_port_config(struct qlcnic_adapter *adapter)
781{
782 struct qlcnic_esw_func_cfg esw_cfg;
783
784 if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED))
785 return 0;
786
b1fc6d3c 787 esw_cfg.pci_func = adapter->ahw->pci_func;
0325d69b
RB		 788 if (qlcnic_get_eswitch_port_config(adapter, &esw_cfg))
789 return -EIO;
8cf61f89 790 qlcnic_set_vlan_config(adapter, &esw_cfg);
0325d69b
RB		 791 qlcnic_set_eswitch_port_features(adapter, &esw_cfg);
792
793 return 0;
794}
795
796static void
797qlcnic_set_netdev_features(struct qlcnic_adapter *adapter,
798 struct qlcnic_esw_func_cfg *esw_cfg)
799{
800 struct net_device *netdev = adapter->netdev;
c8f44aff 801 netdev_features_t features, vlan_features;
0325d69b 802
135d84a9 803 features = (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
0325d69b
RB		 804 NETIF_F_IPV6_CSUM | NETIF_F_GRO);
805 vlan_features = (NETIF_F_SG | NETIF_F_IP_CSUM |
b9796a14 806 NETIF_F_IPV6_CSUM | NETIF_F_HW_VLAN_FILTER);
0325d69b
RB		 807
808 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_TSO) {
809 features |= (NETIF_F_TSO | NETIF_F_TSO6);
810 vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
811 }
b56421d0
RB		 812
813 if (netdev->features & NETIF_F_LRO)
0325d69b
RB		 814 features |= NETIF_F_LRO;
815
816 if (esw_cfg->offload_flags & BIT_0) {
817 netdev->features |= features;
0325d69b
RB		 818 if (!(esw_cfg->offload_flags & BIT_1))
819 netdev->features &= ~NETIF_F_TSO;
820 if (!(esw_cfg->offload_flags & BIT_2))
821 netdev->features &= ~NETIF_F_TSO6;
822 } else {
823 netdev->features &= ~features;
0325d69b
RB		 824 }
825
826 netdev->vlan_features = (features & vlan_features);
827}
828
0866d96d
AC		 829static int
830qlcnic_check_eswitch_mode(struct qlcnic_adapter *adapter)
831{
832 void __iomem *priv_op;
833 u32 op_mode, priv_level;
834 int err = 0;
835
174240a8
RB		 836 err = qlcnic_initialize_nic(adapter);
837 if (err)
838 return err;
839
0866d96d
AC		 840 if (adapter->flags & QLCNIC_ADAPTER_INITIALIZED)
841 return 0;
842
b1fc6d3c 843 priv_op = adapter->ahw->pci_base0 + QLCNIC_DRV_OP_MODE;
0866d96d 844 op_mode = readl(priv_op);
b1fc6d3c 845 priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
0866d96d
AC		 846
847 if (op_mode == QLC_DEV_DRV_DEFAULT)
848 priv_level = QLCNIC_MGMT_FUNC;
849 else
b1fc6d3c 850 priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
0866d96d 851
174240a8 852 if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
0866d96d
AC		 853 if (priv_level == QLCNIC_MGMT_FUNC) {
854 adapter->op_mode = QLCNIC_MGMT_FUNC;
855 err = qlcnic_init_pci_info(adapter);
856 if (err)
857 return err;
858 /* Set privilege level for other functions */
859 qlcnic_set_function_modes(adapter);
860 dev_info(&adapter->pdev->dev,
861 "HAL Version: %d, Management function\n",
862 adapter->fw_hal_version);
863 } else if (priv_level == QLCNIC_PRIV_FUNC) {
864 adapter->op_mode = QLCNIC_PRIV_FUNC;
865 dev_info(&adapter->pdev->dev,
866 "HAL Version: %d, Privileged function\n",
867 adapter->fw_hal_version);
868 }
174240a8 869 }
0866d96d
AC		 870
871 adapter->flags |= QLCNIC_ADAPTER_INITIALIZED;
872
873 return err;
874}
875
0325d69b
RB		 876static int
877qlcnic_set_default_offload_settings(struct qlcnic_adapter *adapter)
878{
879 struct qlcnic_esw_func_cfg esw_cfg;
880 struct qlcnic_npar_info *npar;
881 u8 i;
882
174240a8 883 if (adapter->need_fw_reset)
0325d69b
RB		 884 return 0;
885
886 for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
887 if (adapter->npars[i].type != QLCNIC_TYPE_NIC)
888 continue;
889 memset(&esw_cfg, 0, sizeof(struct qlcnic_esw_func_cfg));
890 esw_cfg.pci_func = i;
891 esw_cfg.offload_flags = BIT_0;
7373373d 892 esw_cfg.mac_override = BIT_0;
ee07c1a7 893 esw_cfg.promisc_mode = BIT_0;
0325d69b
RB		 894 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_TSO)
895 esw_cfg.offload_flags |= (BIT_1 | BIT_2);
896 if (qlcnic_config_switch_port(adapter, &esw_cfg))
897 return -EIO;
898 npar = &adapter->npars[i];
899 npar->pvid = esw_cfg.vlan_id;
7373373d 900 npar->mac_override = esw_cfg.mac_override;
0325d69b
RB		 901 npar->mac_anti_spoof = esw_cfg.mac_anti_spoof;
902 npar->discard_tagged = esw_cfg.discard_tagged;
903 npar->promisc_mode = esw_cfg.promisc_mode;
904 npar->offload_flags = esw_cfg.offload_flags;
905 }
906
907 return 0;
908}
909
4e8acb01
RB		 910static int
911qlcnic_reset_eswitch_config(struct qlcnic_adapter *adapter,
912 struct qlcnic_npar_info *npar, int pci_func)
913{
914 struct qlcnic_esw_func_cfg esw_cfg;
915 esw_cfg.op_mode = QLCNIC_PORT_DEFAULTS;
916 esw_cfg.pci_func = pci_func;
917 esw_cfg.vlan_id = npar->pvid;
7373373d 918 esw_cfg.mac_override = npar->mac_override;
4e8acb01
RB		 919 esw_cfg.discard_tagged = npar->discard_tagged;
920 esw_cfg.mac_anti_spoof = npar->mac_anti_spoof;
921 esw_cfg.offload_flags = npar->offload_flags;
922 esw_cfg.promisc_mode = npar->promisc_mode;
923 if (qlcnic_config_switch_port(adapter, &esw_cfg))
924 return -EIO;
925
926 esw_cfg.op_mode = QLCNIC_ADD_VLAN;
927 if (qlcnic_config_switch_port(adapter, &esw_cfg))
928 return -EIO;
929
930 return 0;
931}
932
cea8975e
AC		 933static int
934qlcnic_reset_npar_config(struct qlcnic_adapter *adapter)
935{
4e8acb01 936 int i, err;
cea8975e
AC		 937 struct qlcnic_npar_info *npar;
938 struct qlcnic_info nic_info;
939
174240a8 940 if (!adapter->need_fw_reset)
cea8975e
AC		 941 return 0;
942
4e8acb01
RB		 943 /* Set the NPAR config data after FW reset */
944 for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
945 npar = &adapter->npars[i];
946 if (npar->type != QLCNIC_TYPE_NIC)
947 continue;
948 err = qlcnic_get_nic_info(adapter, &nic_info, i);
949 if (err)
950 return err;
951 nic_info.min_tx_bw = npar->min_bw;
952 nic_info.max_tx_bw = npar->max_bw;
953 err = qlcnic_set_nic_info(adapter, &nic_info);
954 if (err)
955 return err;
cea8975e 956
4e8acb01
RB		 957 if (npar->enable_pm) {
958 err = qlcnic_config_port_mirroring(adapter,
959 npar->dest_npar, 1, i);
960 if (err)
961 return err;
cea8975e 962 }
4e8acb01
RB		 963 err = qlcnic_reset_eswitch_config(adapter, npar, i);
964 if (err)
965 return err;
cea8975e 966 }
4e8acb01 967 return 0;
cea8975e
AC		 968}
969
78f84e1a
AKS		 970static int qlcnic_check_npar_opertional(struct qlcnic_adapter *adapter)
971{
972 u8 npar_opt_timeo = QLCNIC_DEV_NPAR_OPER_TIMEO;
973 u32 npar_state;
974
975 if (adapter->op_mode == QLCNIC_MGMT_FUNC)
976 return 0;
977
978 npar_state = QLCRD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
979 while (npar_state != QLCNIC_DEV_NPAR_OPER && --npar_opt_timeo) {
980 msleep(1000);
981 npar_state = QLCRD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
982 }
983 if (!npar_opt_timeo) {
984 dev_err(&adapter->pdev->dev,
985 "Waiting for NPAR state to opertional timeout\n");
986 return -EIO;
987 }
988 return 0;
989}
990
174240a8
RB		 991static int
992qlcnic_set_mgmt_operations(struct qlcnic_adapter *adapter)
993{
994 int err;
995
996 if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
997 adapter->op_mode != QLCNIC_MGMT_FUNC)
998 return 0;
999
1000 err = qlcnic_set_default_offload_settings(adapter);
1001 if (err)
1002 return err;
1003
1004 err = qlcnic_reset_npar_config(adapter);
1005 if (err)
1006 return err;
1007
1008 qlcnic_dev_set_npar_ready(adapter);
1009
1010 return err;
1011}
1012
af19b491
AKS		 1013static int
1014qlcnic_start_firmware(struct qlcnic_adapter *adapter)
1015{
d4066833 1016 int err;
af19b491 1017
aa5e18c0
SC		 1018 err = qlcnic_can_start_firmware(adapter);
1019 if (err < 0)
1020 return err;
1021 else if (!err)
d4066833 1022 goto check_fw_status;
af19b491 1023
4d5bdb38
AKS		 1024 if (load_fw_file)
1025 qlcnic_request_firmware(adapter);
8f891387 1026 else {
8cfdce08
SC		 1027 err = qlcnic_check_flash_fw_ver(adapter);
1028 if (err)
8f891387 1029 goto err_out;
1030
4d5bdb38 1031 adapter->fw_type = QLCNIC_FLASH_ROMIMAGE;
8f891387 1032 }
af19b491
AKS		 1033
1034 err = qlcnic_need_fw_reset(adapter);
af19b491 1035 if (err == 0)
4e70812b 1036 goto check_fw_status;
af19b491 1037
d4066833
SC		 1038 err = qlcnic_pinit_from_rom(adapter);
1039 if (err)
1040 goto err_out;
af19b491
AKS		 1041
1042 err = qlcnic_load_firmware(adapter);
1043 if (err)
1044 goto err_out;
1045
1046 qlcnic_release_firmware(adapter);
d4066833 1047 QLCWR32(adapter, CRB_DRIVER_VERSION, QLCNIC_DRIVER_VERSION);
af19b491 1048
d4066833
SC		 1049check_fw_status:
1050 err = qlcnic_check_fw_status(adapter);
af19b491
AKS		 1051 if (err)
1052 goto err_out;
1053
1054 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_READY);
6df900e9 1055 qlcnic_idc_debug_info(adapter, 1);
b18971d1 1056
0866d96d
AC		 1057 err = qlcnic_check_eswitch_mode(adapter);
1058 if (err) {
1059 dev_err(&adapter->pdev->dev,
1060 "Memory allocation failed for eswitch\n");
1061 goto err_out;
1062 }
174240a8
RB		 1063 err = qlcnic_set_mgmt_operations(adapter);
1064 if (err)
1065 goto err_out;
1066
1067 qlcnic_check_options(adapter);
af19b491
AKS		 1068 adapter->need_fw_reset = 0;
1069
a7fc948f
AKS		 1070 qlcnic_release_firmware(adapter);
1071 return 0;
af19b491
AKS		 1072
1073err_out:
a7fc948f
AKS		 1074 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_FAILED);
1075 dev_err(&adapter->pdev->dev, "Device state set to failed\n");
0866d96d 1076
af19b491
AKS		 1077 qlcnic_release_firmware(adapter);
1078 return err;
1079}
1080
1081static int
1082qlcnic_request_irq(struct qlcnic_adapter *adapter)
1083{
1084 irq_handler_t handler;
1085 struct qlcnic_host_sds_ring *sds_ring;
1086 int err, ring;
1087
1088 unsigned long flags = 0;
1089 struct net_device *netdev = adapter->netdev;
b1fc6d3c 1090 struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
af19b491 1091
7eb9855d
AKS		 1092 if (adapter->diag_test == QLCNIC_INTERRUPT_TEST) {
1093 handler = qlcnic_tmp_intr;
1094 if (!QLCNIC_IS_MSI_FAMILY(adapter))
1095 flags |= IRQF_SHARED;
1096
1097 } else {
1098 if (adapter->flags & QLCNIC_MSIX_ENABLED)
1099 handler = qlcnic_msix_intr;
1100 else if (adapter->flags & QLCNIC_MSI_ENABLED)
1101 handler = qlcnic_msi_intr;
1102 else {
1103 flags |= IRQF_SHARED;
1104 handler = qlcnic_intr;
1105 }
af19b491
AKS		 1106 }
1107 adapter->irq = netdev->irq;
1108
1109 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
1110 sds_ring = &recv_ctx->sds_rings[ring];
1111 sprintf(sds_ring->name, "%s[%d]", netdev->name, ring);
1112 err = request_irq(sds_ring->irq, handler,
1113 flags, sds_ring->name, sds_ring);
1114 if (err)
1115 return err;
1116 }
1117
1118 return 0;
1119}
1120
1121static void
1122qlcnic_free_irq(struct qlcnic_adapter *adapter)
1123{
1124 int ring;
1125 struct qlcnic_host_sds_ring *sds_ring;
1126
b1fc6d3c 1127 struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
af19b491
AKS		 1128
1129 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
1130 sds_ring = &recv_ctx->sds_rings[ring];
1131 free_irq(sds_ring->irq, sds_ring);
1132 }
1133}
1134
af19b491
AKS		 1135static int
1136__qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1137{
8a15ad1f
AKS		 1138 int ring;
1139 struct qlcnic_host_rds_ring *rds_ring;
1140
af19b491
AKS		 1141 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1142 return -EIO;
1143
8a15ad1f
AKS		 1144 if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
1145 return 0;
0325d69b
RB		 1146 if (qlcnic_set_eswitch_port_config(adapter))
1147 return -EIO;
8a15ad1f
AKS		 1148
1149 if (qlcnic_fw_create_ctx(adapter))
1150 return -EIO;
1151
1152 for (ring = 0; ring < adapter->max_rds_rings; ring++) {
b1fc6d3c
AC		 1153 rds_ring = &adapter->recv_ctx->rds_rings[ring];
1154 qlcnic_post_rx_buffers(adapter, rds_ring);
8a15ad1f
AKS		 1155 }
1156
af19b491
AKS		 1157 qlcnic_set_multi(netdev);
1158 qlcnic_fw_cmd_set_mtu(adapter, netdev->mtu);
1159
b1fc6d3c 1160 adapter->ahw->linkup = 0;
af19b491
AKS		 1161
1162 if (adapter->max_sds_rings > 1)
1163 qlcnic_config_rss(adapter, 1);
1164
1165 qlcnic_config_intr_coalesce(adapter);
1166
24763d80 1167 if (netdev->features & NETIF_F_LRO)
af19b491
AKS		 1168 qlcnic_config_hw_lro(adapter, QLCNIC_LRO_ENABLED);
1169
1170 qlcnic_napi_enable(adapter);
1171
1172 qlcnic_linkevent_request(adapter, 1);
1173
68bf1c68 1174 adapter->reset_context = 0;
af19b491
AKS		 1175 set_bit(__QLCNIC_DEV_UP, &adapter->state);
1176 return 0;
1177}
1178
1179/* Usage: During resume and firmware recovery module.*/
1180
1181static int
1182qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1183{
1184 int err = 0;
1185
1186 rtnl_lock();
1187 if (netif_running(netdev))
1188 err = __qlcnic_up(adapter, netdev);
1189 rtnl_unlock();
1190
1191 return err;
1192}
1193
1194static void
1195__qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1196{
1197 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1198 return;
1199
1200 if (!test_and_clear_bit(__QLCNIC_DEV_UP, &adapter->state))
1201 return;
1202
1203 smp_mb();
1204 spin_lock(&adapter->tx_clean_lock);
1205 netif_carrier_off(netdev);
1206 netif_tx_disable(netdev);
1207
1208 qlcnic_free_mac_list(adapter);
1209
b5e5492c
AKS		 1210 if (adapter->fhash.fnum)
1211 qlcnic_delete_lb_filters(adapter);
1212
af19b491
AKS		 1213 qlcnic_nic_set_promisc(adapter, QLCNIC_NIU_NON_PROMISC_MODE);
1214
1215 qlcnic_napi_disable(adapter);
1216
8a15ad1f
AKS		 1217 qlcnic_fw_destroy_ctx(adapter);
1218
1219 qlcnic_reset_rx_buffers_list(adapter);
af19b491
AKS		 1220 qlcnic_release_tx_buffers(adapter);
1221 spin_unlock(&adapter->tx_clean_lock);
1222}
1223
1224/* Usage: During suspend and firmware recovery module */
1225
1226static void
1227qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1228{
1229 rtnl_lock();
1230 if (netif_running(netdev))
1231 __qlcnic_down(adapter, netdev);
1232 rtnl_unlock();
1233
1234}
1235
1236static int
1237qlcnic_attach(struct qlcnic_adapter *adapter)
1238{
1239 struct net_device *netdev = adapter->netdev;
1240 struct pci_dev *pdev = adapter->pdev;
8a15ad1f 1241 int err;
af19b491
AKS		 1242
1243 if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC)
1244 return 0;
1245
af19b491
AKS		 1246 err = qlcnic_napi_add(adapter, netdev);
1247 if (err)
1248 return err;
1249
1250 err = qlcnic_alloc_sw_resources(adapter);
1251 if (err) {
1252 dev_err(&pdev->dev, "Error in setting sw resources\n");
8a15ad1f 1253 goto err_out_napi_del;
af19b491
AKS		 1254 }
1255
1256 err = qlcnic_alloc_hw_resources(adapter);
1257 if (err) {
1258 dev_err(&pdev->dev, "Error in setting hw resources\n");
1259 goto err_out_free_sw;
1260 }
1261
af19b491
AKS		 1262 err = qlcnic_request_irq(adapter);
1263 if (err) {
1264 dev_err(&pdev->dev, "failed to setup interrupt\n");
8a15ad1f 1265 goto err_out_free_hw;
af19b491
AKS		 1266 }
1267
af19b491
AKS		 1268 qlcnic_create_sysfs_entries(adapter);
1269
1270 adapter->is_up = QLCNIC_ADAPTER_UP_MAGIC;
1271 return 0;
1272
8a15ad1f 1273err_out_free_hw:
af19b491
AKS		 1274 qlcnic_free_hw_resources(adapter);
1275err_out_free_sw:
1276 qlcnic_free_sw_resources(adapter);
8a15ad1f
AKS		 1277err_out_napi_del:
1278 qlcnic_napi_del(adapter);
af19b491
AKS		 1279 return err;
1280}
1281
1282static void
1283qlcnic_detach(struct qlcnic_adapter *adapter)
1284{
1285 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1286 return;
1287
1288 qlcnic_remove_sysfs_entries(adapter);
1289
1290 qlcnic_free_hw_resources(adapter);
1291 qlcnic_release_rx_buffers(adapter);
1292 qlcnic_free_irq(adapter);
1293 qlcnic_napi_del(adapter);
1294 qlcnic_free_sw_resources(adapter);
1295
1296 adapter->is_up = 0;
1297}
1298
7eb9855d
AKS		 1299void qlcnic_diag_free_res(struct net_device *netdev, int max_sds_rings)
1300{
1301 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1302 struct qlcnic_host_sds_ring *sds_ring;
1303 int ring;
1304
78ad3892 1305 clear_bit(__QLCNIC_DEV_UP, &adapter->state);
cdaff185
AKS		 1306 if (adapter->diag_test == QLCNIC_INTERRUPT_TEST) {
1307 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
b1fc6d3c 1308 sds_ring = &adapter->recv_ctx->sds_rings[ring];
cdaff185
AKS		 1309 qlcnic_disable_int(sds_ring);
1310 }
7eb9855d
AKS		 1311 }
1312
8a15ad1f
AKS		 1313 qlcnic_fw_destroy_ctx(adapter);
1314
7eb9855d
AKS		 1315 qlcnic_detach(adapter);
1316
1317 adapter->diag_test = 0;
1318 adapter->max_sds_rings = max_sds_rings;
1319
1320 if (qlcnic_attach(adapter))
34ce3626 1321 goto out;
7eb9855d
AKS		 1322
1323 if (netif_running(netdev))
1324 __qlcnic_up(adapter, netdev);
34ce3626 1325out:
7eb9855d
AKS		 1326 netif_device_attach(netdev);
1327}
1328
b1fc6d3c
AC		 1329static int qlcnic_alloc_adapter_resources(struct qlcnic_adapter *adapter)
1330{
1331 int err = 0;
1332 adapter->ahw = kzalloc(sizeof(struct qlcnic_hardware_context),
1333 GFP_KERNEL);
1334 if (!adapter->ahw) {
1335 dev_err(&adapter->pdev->dev,
1336 "Failed to allocate recv ctx resources for adapter\n");
1337 err = -ENOMEM;
1338 goto err_out;
1339 }
1340 adapter->recv_ctx = kzalloc(sizeof(struct qlcnic_recv_context),
1341 GFP_KERNEL);
1342 if (!adapter->recv_ctx) {
1343 dev_err(&adapter->pdev->dev,
1344 "Failed to allocate recv ctx resources for adapter\n");
1345 kfree(adapter->ahw);
1346 adapter->ahw = NULL;
1347 err = -ENOMEM;
8816d009 1348 goto err_out;
b1fc6d3c 1349 }
8816d009
AC		 1350 /* Initialize interrupt coalesce parameters */
1351 adapter->ahw->coal.flag = QLCNIC_INTR_DEFAULT;
1352 adapter->ahw->coal.rx_time_us = QLCNIC_DEFAULT_INTR_COALESCE_RX_TIME_US;
1353 adapter->ahw->coal.rx_packets = QLCNIC_DEFAULT_INTR_COALESCE_RX_PACKETS;
b1fc6d3c
AC		 1354err_out:
1355 return err;
1356}
1357
1358static void qlcnic_free_adapter_resources(struct qlcnic_adapter *adapter)
1359{
1360 kfree(adapter->recv_ctx);
1361 adapter->recv_ctx = NULL;
1362
18f2f616
AC		 1363 if (adapter->ahw->fw_dump.tmpl_hdr) {
1364 vfree(adapter->ahw->fw_dump.tmpl_hdr);
1365 adapter->ahw->fw_dump.tmpl_hdr = NULL;
1366 }
b1fc6d3c
AC		 1367 kfree(adapter->ahw);
1368 adapter->ahw = NULL;
1369}
1370
7eb9855d
AKS		 1371int qlcnic_diag_alloc_res(struct net_device *netdev, int test)
1372{
1373 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1374 struct qlcnic_host_sds_ring *sds_ring;
8a15ad1f 1375 struct qlcnic_host_rds_ring *rds_ring;
7eb9855d
AKS		 1376 int ring;
1377 int ret;
1378
1379 netif_device_detach(netdev);
1380
1381 if (netif_running(netdev))
1382 __qlcnic_down(adapter, netdev);
1383
1384 qlcnic_detach(adapter);
1385
1386 adapter->max_sds_rings = 1;
1387 adapter->diag_test = test;
1388
1389 ret = qlcnic_attach(adapter);
34ce3626
AKS		 1390 if (ret) {
1391 netif_device_attach(netdev);
7eb9855d 1392 return ret;
34ce3626 1393 }
7eb9855d 1394
8a15ad1f
AKS		 1395 ret = qlcnic_fw_create_ctx(adapter);
1396 if (ret) {
1397 qlcnic_detach(adapter);
57e46248 1398 netif_device_attach(netdev);
8a15ad1f
AKS		 1399 return ret;
1400 }
1401
1402 for (ring = 0; ring < adapter->max_rds_rings; ring++) {
b1fc6d3c
AC		 1403 rds_ring = &adapter->recv_ctx->rds_rings[ring];
1404 qlcnic_post_rx_buffers(adapter, rds_ring);
8a15ad1f
AKS		 1405 }
1406
cdaff185
AKS		 1407 if (adapter->diag_test == QLCNIC_INTERRUPT_TEST) {
1408 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
b1fc6d3c 1409 sds_ring = &adapter->recv_ctx->sds_rings[ring];
cdaff185
AKS		 1410 qlcnic_enable_int(sds_ring);
1411 }
7eb9855d 1412 }
22c8c934
SC		 1413
1414 if (adapter->diag_test == QLCNIC_LOOPBACK_TEST) {
1415 adapter->ahw->loopback_state = 0;
1416 qlcnic_linkevent_request(adapter, 1);
1417 }
1418
78ad3892 1419 set_bit(__QLCNIC_DEV_UP, &adapter->state);
7eb9855d
AKS		 1420
1421 return 0;
1422}
1423
68bf1c68
AKS		 1424/* Reset context in hardware only */
1425static int
1426qlcnic_reset_hw_context(struct qlcnic_adapter *adapter)
1427{
1428 struct net_device *netdev = adapter->netdev;
1429
1430 if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
1431 return -EBUSY;
1432
1433 netif_device_detach(netdev);
1434
1435 qlcnic_down(adapter, netdev);
1436
1437 qlcnic_up(adapter, netdev);
1438
1439 netif_device_attach(netdev);
1440
1441 clear_bit(__QLCNIC_RESETTING, &adapter->state);
1442 return 0;
1443}
1444
af19b491
AKS		 1445int
1446qlcnic_reset_context(struct qlcnic_adapter *adapter)
1447{
1448 int err = 0;
1449 struct net_device *netdev = adapter->netdev;
1450
1451 if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
1452 return -EBUSY;
1453
1454 if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC) {
1455
1456 netif_device_detach(netdev);
1457
1458 if (netif_running(netdev))
1459 __qlcnic_down(adapter, netdev);
1460
1461 qlcnic_detach(adapter);
1462
1463 if (netif_running(netdev)) {
1464 err = qlcnic_attach(adapter);
1d5c88e3 1465 if (!err) {
34ce3626 1466 __qlcnic_up(adapter, netdev);
1d5c88e3
AC		 1467 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
1468 }
af19b491
AKS		 1469 }
1470
1471 netif_device_attach(netdev);
1472 }
1473
af19b491
AKS		 1474 clear_bit(__QLCNIC_RESETTING, &adapter->state);
1475 return err;
1476}
1477
1478static int
1479qlcnic_setup_netdev(struct qlcnic_adapter *adapter,
1bb09fb9 1480 struct net_device *netdev, u8 pci_using_dac)
af19b491
AKS		 1481{
1482 int err;
1483 struct pci_dev *pdev = adapter->pdev;
1484
af19b491
AKS		 1485 adapter->mc_enabled = 0;
1486 adapter->max_mc_count = 38;
1487
1488 netdev->netdev_ops = &qlcnic_netdev_ops;
ef71ff83 1489 netdev->watchdog_timeo = 5*HZ;
af19b491
AKS		 1490
1491 qlcnic_change_mtu(netdev, netdev->mtu);
1492
1493 SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_ops);
1494
135d84a9
MM		 1495 netdev->hw_features = NETIF_F_SG | NETIF_F_IP_CSUM |
1496 NETIF_F_IPV6_CSUM | NETIF_F_RXCSUM;
ac8d0c4f 1497
135d84a9
MM		 1498 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_TSO)
1499 netdev->hw_features |= NETIF_F_TSO | NETIF_F_TSO6;
1500 if (pci_using_dac)
1501 netdev->hw_features |= NETIF_F_HIGHDMA;
af19b491 1502
135d84a9 1503 netdev->vlan_features = netdev->hw_features;
af19b491
AKS		 1504
1505 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_FVLANTX)
135d84a9 1506 netdev->hw_features |= NETIF_F_HW_VLAN_TX;
af19b491 1507 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
135d84a9
MM		 1508 netdev->hw_features |= NETIF_F_LRO;
1509
1510 netdev->features |= netdev->hw_features |
1511 NETIF_F_HW_VLAN_RX | NETIF_F_HW_VLAN_FILTER;
1512
af19b491
AKS		 1513 netdev->irq = adapter->msix_entries[0].vector;
1514
af19b491
AKS		 1515 err = register_netdev(netdev);
1516 if (err) {
1517 dev_err(&pdev->dev, "failed to register net device\n");
1518 return err;
1519 }
1520
1521 return 0;
1522}
1523
1bb09fb9
AKS		 1524static int qlcnic_set_dma_mask(struct pci_dev *pdev, u8 *pci_using_dac)
1525{
1526 if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) &&
1527 !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)))
1528 *pci_using_dac = 1;
1529 else if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) &&
1530 !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)))
1531 *pci_using_dac = 0;
1532 else {
1533 dev_err(&pdev->dev, "Unable to set DMA mask, aborting\n");
1534 return -EIO;
1535 }
1536
1537 return 0;
1538}
1539
f94bc1e7
SC		 1540static int
1541qlcnic_alloc_msix_entries(struct qlcnic_adapter *adapter, u16 count)
1542{
1543 adapter->msix_entries = kcalloc(count, sizeof(struct msix_entry),
1544 GFP_KERNEL);
1545
1546 if (adapter->msix_entries)
1547 return 0;
1548
1549 dev_err(&adapter->pdev->dev, "failed allocating msix_entries\n");
1550 return -ENOMEM;
1551}
1552
af19b491
AKS		 1553static int __devinit
1554qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
1555{
1556 struct net_device *netdev = NULL;
1557 struct qlcnic_adapter *adapter = NULL;
1558 int err;
af19b491 1559 uint8_t revision_id;
1bb09fb9 1560 uint8_t pci_using_dac;
da48e6c3 1561 char brd_name[QLCNIC_MAX_BOARD_NAME_LEN];
af19b491
AKS		 1562
1563 err = pci_enable_device(pdev);
1564 if (err)
1565 return err;
1566
1567 if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
1568 err = -ENODEV;
1569 goto err_out_disable_pdev;
1570 }
1571
1bb09fb9
AKS		 1572 err = qlcnic_set_dma_mask(pdev, &pci_using_dac);
1573 if (err)
1574 goto err_out_disable_pdev;
1575
af19b491
AKS		 1576 err = pci_request_regions(pdev, qlcnic_driver_name);
1577 if (err)
1578 goto err_out_disable_pdev;
1579
1580 pci_set_master(pdev);
451724c8 1581 pci_enable_pcie_error_reporting(pdev);
af19b491
AKS		 1582
1583 netdev = alloc_etherdev(sizeof(struct qlcnic_adapter));
1584 if (!netdev) {
af19b491
AKS		 1585 err = -ENOMEM;
1586 goto err_out_free_res;
1587 }
1588
1589 SET_NETDEV_DEV(netdev, &pdev->dev);
1590
1591 adapter = netdev_priv(netdev);
1592 adapter->netdev = netdev;
1593 adapter->pdev = pdev;
af19b491 1594
b1fc6d3c
AC		 1595 if (qlcnic_alloc_adapter_resources(adapter))
1596 goto err_out_free_netdev;
1597
1598 adapter->dev_rst_time = jiffies;
af19b491 1599 revision_id = pdev->revision;
b1fc6d3c 1600 adapter->ahw->revision_id = revision_id;
e5dcf6dc 1601 adapter->mac_learn = qlcnic_mac_learn;
af19b491 1602
b1fc6d3c
AC		 1603 rwlock_init(&adapter->ahw->crb_lock);
1604 mutex_init(&adapter->ahw->mem_lock);
af19b491
AKS		 1605
1606 spin_lock_init(&adapter->tx_clean_lock);
1607 INIT_LIST_HEAD(&adapter->mac_list);
1608
1609 err = qlcnic_setup_pci_map(adapter);
1610 if (err)
b1fc6d3c 1611 goto err_out_free_hw;
af19b491
AKS		 1612
1613 /* This will be reset for mezz cards */
b1fc6d3c 1614 adapter->portnum = adapter->ahw->pci_func;
af19b491
AKS		 1615
1616 err = qlcnic_get_board_info(adapter);
1617 if (err) {
1618 dev_err(&pdev->dev, "Error getting board config info.\n");
1619 goto err_out_iounmap;
1620 }
1621
8cfdce08
SC		 1622 err = qlcnic_setup_idc_param(adapter);
1623 if (err)
b3a24649 1624 goto err_out_iounmap;
af19b491 1625
1dc0f3c5 1626 adapter->flags |= QLCNIC_NEED_FLR;
b0044bcf 1627
9f26f547 1628 err = adapter->nic_ops->start_firmware(adapter);
a7fc948f 1629 if (err) {
b43e5ee7
SC		 1630 dev_err(&pdev->dev, "Loading fw failed. Please Reboot\n"
1631 "\t\tIf reboot doesn't help, try flashing the card\n");
1632 goto err_out_maintenance_mode;
a7fc948f 1633 }
af19b491 1634
da48e6c3
RB		 1635 if (qlcnic_read_mac_addr(adapter))
1636 dev_warn(&pdev->dev, "failed to read mac addr\n");
1637
1638 if (adapter->portnum == 0) {
1639 get_brd_name(adapter, brd_name);
1640
1641 pr_info("%s: %s Board Chip rev 0x%x\n",
1642 module_name(THIS_MODULE),
b1fc6d3c 1643 brd_name, adapter->ahw->revision_id);
da48e6c3
RB		 1644 }
1645
af19b491
AKS		 1646 qlcnic_clear_stats(adapter);
1647
f94bc1e7
SC		 1648 err = qlcnic_alloc_msix_entries(adapter, adapter->max_rx_ques);
1649 if (err)
1650 goto err_out_decr_ref;
1651
af19b491
AKS		 1652 qlcnic_setup_intr(adapter);
1653
1bb09fb9 1654 err = qlcnic_setup_netdev(adapter, netdev, pci_using_dac);
af19b491
AKS		 1655 if (err)
1656 goto err_out_disable_msi;
1657
1658 pci_set_drvdata(pdev, adapter);
1659
1660 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
1661
b1fc6d3c 1662 switch (adapter->ahw->port_type) {
af19b491
AKS		 1663 case QLCNIC_GBE:
1664 dev_info(&adapter->pdev->dev, "%s: GbE port initialized\n",
1665 adapter->netdev->name);
1666 break;
1667 case QLCNIC_XGBE:
1668 dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n",
1669 adapter->netdev->name);
1670 break;
1671 }
1672
e5dcf6dc
SC		 1673 if (adapter->mac_learn)
1674 qlcnic_alloc_lb_filters_mem(adapter);
1675
af19b491
AKS		 1676 qlcnic_create_diag_entries(adapter);
1677
1678 return 0;
1679
1680err_out_disable_msi:
1681 qlcnic_teardown_intr(adapter);
f94bc1e7 1682 kfree(adapter->msix_entries);
af19b491
AKS		 1683
1684err_out_decr_ref:
21854f02 1685 qlcnic_clr_all_drv_state(adapter, 0);
af19b491
AKS		 1686
1687err_out_iounmap:
1688 qlcnic_cleanup_pci_map(adapter);
1689
b1fc6d3c
AC		 1690err_out_free_hw:
1691 qlcnic_free_adapter_resources(adapter);
1692
af19b491
AKS		 1693err_out_free_netdev:
1694 free_netdev(netdev);
1695
1696err_out_free_res:
1697 pci_release_regions(pdev);
1698
1699err_out_disable_pdev:
1700 pci_set_drvdata(pdev, NULL);
1701 pci_disable_device(pdev);
1702 return err;
b43e5ee7
SC		 1703
1704err_out_maintenance_mode:
1705 netdev->netdev_ops = &qlcnic_netdev_failed_ops;
1706 SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_failed_ops);
1707 err = register_netdev(netdev);
1708 if (err) {
1709 dev_err(&pdev->dev, "failed to register net device\n");
1710 goto err_out_decr_ref;
1711 }
1712 pci_set_drvdata(pdev, adapter);
1713 qlcnic_create_diag_entries(adapter);
1714 return 0;
af19b491
AKS		 1715}
1716
1717static void __devexit qlcnic_remove(struct pci_dev *pdev)
1718{
1719 struct qlcnic_adapter *adapter;
1720 struct net_device *netdev;
1721
1722 adapter = pci_get_drvdata(pdev);
1723 if (adapter == NULL)
1724 return;
1725
1726 netdev = adapter->netdev;
1727
1728 qlcnic_cancel_fw_work(adapter);
1729
1730 unregister_netdev(netdev);
1731
af19b491
AKS		 1732 qlcnic_detach(adapter);
1733
2e9d722d
AC		 1734 if (adapter->npars != NULL)
1735 kfree(adapter->npars);
1736 if (adapter->eswitch != NULL)
1737 kfree(adapter->eswitch);
1738
21854f02 1739 qlcnic_clr_all_drv_state(adapter, 0);
af19b491
AKS		 1740
1741 clear_bit(__QLCNIC_RESETTING, &adapter->state);
1742
b5e5492c
AKS		 1743 qlcnic_free_lb_filters_mem(adapter);
1744
af19b491 1745 qlcnic_teardown_intr(adapter);
f94bc1e7 1746 kfree(adapter->msix_entries);
af19b491
AKS		 1747
1748 qlcnic_remove_diag_entries(adapter);
1749
1750 qlcnic_cleanup_pci_map(adapter);
1751
1752 qlcnic_release_firmware(adapter);
1753
451724c8 1754 pci_disable_pcie_error_reporting(pdev);
af19b491
AKS		 1755 pci_release_regions(pdev);
1756 pci_disable_device(pdev);
1757 pci_set_drvdata(pdev, NULL);
1758
b1fc6d3c 1759 qlcnic_free_adapter_resources(adapter);
af19b491
AKS		 1760 free_netdev(netdev);
1761}
1762static int __qlcnic_shutdown(struct pci_dev *pdev)
1763{
1764 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
1765 struct net_device *netdev = adapter->netdev;
1766 int retval;
1767
1768 netif_device_detach(netdev);
1769
1770 qlcnic_cancel_fw_work(adapter);
1771
1772 if (netif_running(netdev))
1773 qlcnic_down(adapter, netdev);
1774
21854f02 1775 qlcnic_clr_all_drv_state(adapter, 0);
af19b491
AKS		 1776
1777 clear_bit(__QLCNIC_RESETTING, &adapter->state);
1778
1779 retval = pci_save_state(pdev);
1780 if (retval)
1781 return retval;
1782
1783 if (qlcnic_wol_supported(adapter)) {
1784 pci_enable_wake(pdev, PCI_D3cold, 1);
1785 pci_enable_wake(pdev, PCI_D3hot, 1);
1786 }
1787
1788 return 0;
1789}
1790
1791static void qlcnic_shutdown(struct pci_dev *pdev)
1792{
1793 if (__qlcnic_shutdown(pdev))
1794 return;
1795
1796 pci_disable_device(pdev);
1797}
1798
1799#ifdef CONFIG_PM
1800static int
1801qlcnic_suspend(struct pci_dev *pdev, pm_message_t state)
1802{
1803 int retval;
1804
1805 retval = __qlcnic_shutdown(pdev);
1806 if (retval)
1807 return retval;
1808
1809 pci_set_power_state(pdev, pci_choose_state(pdev, state));
1810 return 0;
1811}
1812
1813static int
1814qlcnic_resume(struct pci_dev *pdev)
1815{
1816 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
1817 struct net_device *netdev = adapter->netdev;
1818 int err;
1819
1820 err = pci_enable_device(pdev);
1821 if (err)
1822 return err;
1823
1824 pci_set_power_state(pdev, PCI_D0);
1825 pci_set_master(pdev);
1826 pci_restore_state(pdev);
1827
9f26f547 1828 err = adapter->nic_ops->start_firmware(adapter);
af19b491
AKS		 1829 if (err) {
1830 dev_err(&pdev->dev, "failed to start firmware\n");
1831 return err;
1832 }
1833
1834 if (netif_running(netdev)) {
af19b491
AKS		 1835 err = qlcnic_up(adapter, netdev);
1836 if (err)
52486a3a 1837 goto done;
af19b491 1838
aec1e845 1839 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
af19b491 1840 }
52486a3a 1841done:
af19b491
AKS		 1842 netif_device_attach(netdev);
1843 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
1844 return 0;
af19b491
AKS		 1845}
1846#endif
1847
1848static int qlcnic_open(struct net_device *netdev)
1849{
1850 struct qlcnic_adapter *adapter = netdev_priv(netdev);
b43e5ee7 1851 u32 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
af19b491
AKS		 1852 int err;
1853
b43e5ee7
SC		 1854 if (state == QLCNIC_DEV_FAILED || (state == QLCNIC_DEV_BADBAD)) {
1855 netdev_err(netdev, "Device in FAILED state\n");
1856 return -EIO;
1857 }
1858
c55ad8e5
AKS		 1859 netif_carrier_off(netdev);
1860
af19b491
AKS		 1861 err = qlcnic_attach(adapter);
1862 if (err)
1863 return err;
1864
1865 err = __qlcnic_up(adapter, netdev);
1866 if (err)
1867 goto err_out;
1868
1869 netif_start_queue(netdev);
1870
1871 return 0;
1872
1873err_out:
1874 qlcnic_detach(adapter);
1875 return err;
1876}
1877
1878/*
1879 * qlcnic_close - Disables a network interface entry point
1880 */
1881static int qlcnic_close(struct net_device *netdev)
1882{
1883 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1884
1885 __qlcnic_down(adapter, netdev);
1886 return 0;
1887}
1888
e5dcf6dc 1889void qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter *adapter)
b5e5492c
AKS		 1890{
1891 void *head;
1892 int i;
1893
e5dcf6dc 1894 if (adapter->fhash.fmax && adapter->fhash.fhead)
b5e5492c
AKS		 1895 return;
1896
1897 spin_lock_init(&adapter->mac_learn_lock);
1898
1899 head = kcalloc(QLCNIC_LB_MAX_FILTERS, sizeof(struct hlist_head),
1900 GFP_KERNEL);
1901 if (!head)
1902 return;
1903
1904 adapter->fhash.fmax = QLCNIC_LB_MAX_FILTERS;
43d620c8 1905 adapter->fhash.fhead = head;
b5e5492c
AKS		 1906
1907 for (i = 0; i < adapter->fhash.fmax; i++)
1908 INIT_HLIST_HEAD(&adapter->fhash.fhead[i]);
1909}
1910
1911static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter)
1912{
1913 if (adapter->fhash.fmax && adapter->fhash.fhead)
1914 kfree(adapter->fhash.fhead);
1915
1916 adapter->fhash.fhead = NULL;
1917 adapter->fhash.fmax = 0;
1918}
1919
1920static void qlcnic_change_filter(struct qlcnic_adapter *adapter,
7e56cac4 1921 u64 uaddr, __le16 vlan_id, struct qlcnic_host_tx_ring *tx_ring)
b5e5492c
AKS		 1922{
1923 struct cmd_desc_type0 *hwdesc;
1924 struct qlcnic_nic_req *req;
1925 struct qlcnic_mac_req *mac_req;
7e56cac4 1926 struct qlcnic_vlan_req *vlan_req;
b5e5492c
AKS		 1927 u32 producer;
1928 u64 word;
1929
1930 producer = tx_ring->producer;
1931 hwdesc = &tx_ring->desc_head[tx_ring->producer];
1932
1933 req = (struct qlcnic_nic_req *)hwdesc;
1934 memset(req, 0, sizeof(struct qlcnic_nic_req));
1935 req->qhdr = cpu_to_le64(QLCNIC_REQUEST << 23);
1936
1937 word = QLCNIC_MAC_EVENT | ((u64)(adapter->portnum) << 16);
1938 req->req_hdr = cpu_to_le64(word);
1939
1940 mac_req = (struct qlcnic_mac_req *)&(req->words[0]);
03c5d770 1941 mac_req->op = vlan_id ? QLCNIC_MAC_VLAN_ADD : QLCNIC_MAC_ADD;
b5e5492c
AKS		 1942 memcpy(mac_req->mac_addr, &uaddr, ETH_ALEN);
1943
7e56cac4
SC		 1944 vlan_req = (struct qlcnic_vlan_req *)&req->words[1];
1945 vlan_req->vlan_id = vlan_id;
03c5d770 1946
b5e5492c 1947 tx_ring->producer = get_next_index(producer, tx_ring->num_desc);
036d61f0 1948 smp_mb();
b5e5492c
AKS		 1949}
1950
1951#define QLCNIC_MAC_HASH(MAC)\
1952 ((((MAC) & 0x70000) >> 0x10) | (((MAC) & 0x70000000000ULL) >> 0x25))
1953
1954static void
1955qlcnic_send_filter(struct qlcnic_adapter *adapter,
1956 struct qlcnic_host_tx_ring *tx_ring,
1957 struct cmd_desc_type0 *first_desc,
1958 struct sk_buff *skb)
1959{
1960 struct ethhdr *phdr = (struct ethhdr *)(skb->data);
1961 struct qlcnic_filter *fil, *tmp_fil;
1962 struct hlist_node *tmp_hnode, *n;
1963 struct hlist_head *head;
1964 u64 src_addr = 0;
7e56cac4 1965 __le16 vlan_id = 0;
b5e5492c
AKS		 1966 u8 hindex;
1967
2e42e474 1968 if (ether_addr_equal(phdr->h_source, adapter->mac_addr))
b5e5492c
AKS		 1969 return;
1970
1971 if (adapter->fhash.fnum >= adapter->fhash.fmax)
1972 return;
1973
03c5d770
AKS		 1974 /* Only NPAR capable devices support vlan based learning*/
1975 if (adapter->flags & QLCNIC_ESWITCH_ENABLED)
1976 vlan_id = first_desc->vlan_TCI;
b5e5492c
AKS		 1977 memcpy(&src_addr, phdr->h_source, ETH_ALEN);
1978 hindex = QLCNIC_MAC_HASH(src_addr) & (QLCNIC_LB_MAX_FILTERS - 1);
1979 head = &(adapter->fhash.fhead[hindex]);
1980
1981 hlist_for_each_entry_safe(tmp_fil, tmp_hnode, n, head, fnode) {
03c5d770
AKS		 1982 if (!memcmp(tmp_fil->faddr, &src_addr, ETH_ALEN) &&
1983 tmp_fil->vlan_id == vlan_id) {
e5edb7b1 1984
1985 if (jiffies >
1986 (QLCNIC_READD_AGE * HZ + tmp_fil->ftime))
1987 qlcnic_change_filter(adapter, src_addr, vlan_id,
1988 tx_ring);
b5e5492c
AKS		 1989 tmp_fil->ftime = jiffies;
1990 return;
1991 }
1992 }
1993
1994 fil = kzalloc(sizeof(struct qlcnic_filter), GFP_ATOMIC);
1995 if (!fil)
1996 return;
1997
03c5d770 1998 qlcnic_change_filter(adapter, src_addr, vlan_id, tx_ring);
b5e5492c
AKS		 1999
2000 fil->ftime = jiffies;
03c5d770 2001 fil->vlan_id = vlan_id;
b5e5492c
AKS		 2002 memcpy(fil->faddr, &src_addr, ETH_ALEN);
2003 spin_lock(&adapter->mac_learn_lock);
2004 hlist_add_head(&(fil->fnode), head);
2005 adapter->fhash.fnum++;
2006 spin_unlock(&adapter->mac_learn_lock);
2007}
2008
036d61f0
AC		 2009static int
2010qlcnic_tx_pkt(struct qlcnic_adapter *adapter,
af19b491
AKS		 2011 struct cmd_desc_type0 *first_desc,
2012 struct sk_buff *skb)
2013{
036d61f0
AC		 2014 u8 opcode = 0, hdr_len = 0;
2015 u16 flags = 0, vlan_tci = 0;
2016 int copied, offset, copy_len;
af19b491
AKS		 2017 struct cmd_desc_type0 *hwdesc;
2018 struct vlan_ethhdr *vh;
036d61f0
AC		 2019 struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
2020 u16 protocol = ntohs(skb->protocol);
2e9d722d 2021 u32 producer = tx_ring->producer;
036d61f0
AC		 2022
2023 if (protocol == ETH_P_8021Q) {
2024 vh = (struct vlan_ethhdr *)skb->data;
2025 flags = FLAGS_VLAN_TAGGED;
2026 vlan_tci = vh->h_vlan_TCI;
2027 } else if (vlan_tx_tag_present(skb)) {
2028 flags = FLAGS_VLAN_OOB;
2029 vlan_tci = vlan_tx_tag_get(skb);
2030 }
2031 if (unlikely(adapter->pvid)) {
2032 if (vlan_tci && !(adapter->flags & QLCNIC_TAGGING_ENABLED))
2033 return -EIO;
2034 if (vlan_tci && (adapter->flags & QLCNIC_TAGGING_ENABLED))
2035 goto set_flags;
2036
2037 flags = FLAGS_VLAN_OOB;
2038 vlan_tci = adapter->pvid;
2039 }
2040set_flags:
2041 qlcnic_set_tx_vlan_tci(first_desc, vlan_tci);
2042 qlcnic_set_tx_flags_opcode(first_desc, flags, opcode);
af19b491 2043
2e9d722d
AC		 2044 if (*(skb->data) & BIT_0) {
2045 flags |= BIT_0;
2046 memcpy(&first_desc->eth_addr, skb->data, ETH_ALEN);
2047 }
036d61f0
AC		 2048 opcode = TX_ETHER_PKT;
2049 if ((adapter->netdev->features & (NETIF_F_TSO | NETIF_F_TSO6)) &&
af19b491
AKS		 2050 skb_shinfo(skb)->gso_size > 0) {
2051
2052 hdr_len = skb_transport_offset(skb) + tcp_hdrlen(skb);
2053
2054 first_desc->mss = cpu_to_le16(skb_shinfo(skb)->gso_size);
2055 first_desc->total_hdr_length = hdr_len;
036d61f0
AC		 2056
2057 opcode = (protocol == ETH_P_IPV6) ? TX_TCP_LSO6 : TX_TCP_LSO;
2058
2059 /* For LSO, we need to copy the MAC/IP/TCP headers into
2060 * the descriptor ring */
2061 copied = 0;
2062 offset = 2;
2063
2064 if (flags & FLAGS_VLAN_OOB) {
af19b491
AKS		 2065 first_desc->total_hdr_length += VLAN_HLEN;
2066 first_desc->tcp_hdr_offset = VLAN_HLEN;
2067 first_desc->ip_hdr_offset = VLAN_HLEN;
2068 /* Only in case of TSO on vlan device */
2069 flags |= FLAGS_VLAN_TAGGED;
036d61f0
AC		 2070
2071 /* Create a TSO vlan header template for firmware */
2072
2073 hwdesc = &tx_ring->desc_head[producer];
2074 tx_ring->cmd_buf_arr[producer].skb = NULL;
2075
2076 copy_len = min((int)sizeof(struct cmd_desc_type0) -
2077 offset, hdr_len + VLAN_HLEN);
2078
2079 vh = (struct vlan_ethhdr *)((char *) hwdesc + 2);
2080 skb_copy_from_linear_data(skb, vh, 12);
2081 vh->h_vlan_proto = htons(ETH_P_8021Q);
2082 vh->h_vlan_TCI = htons(vlan_tci);
2083
2084 skb_copy_from_linear_data_offset(skb, 12,
2085 (char *)vh + 16, copy_len - 16);
2086
2087 copied = copy_len - VLAN_HLEN;
2088 offset = 0;
2089
2090 producer = get_next_index(producer, tx_ring->num_desc);
af19b491
AKS		 2091 }
2092
036d61f0
AC		 2093 while (copied < hdr_len) {
2094
2095 copy_len = min((int)sizeof(struct cmd_desc_type0) -
2096 offset, (hdr_len - copied));
2097
2098 hwdesc = &tx_ring->desc_head[producer];
2099 tx_ring->cmd_buf_arr[producer].skb = NULL;
2100
2101 skb_copy_from_linear_data_offset(skb, copied,
2102 (char *) hwdesc + offset, copy_len);
2103
2104 copied += copy_len;
2105 offset = 0;
2106
2107 producer = get_next_index(producer, tx_ring->num_desc);
2108 }
2109
2110 tx_ring->producer = producer;
2111 smp_mb();
2112 adapter->stats.lso_frames++;
af19b491
AKS		 2113
2114 } else if (skb->ip_summed == CHECKSUM_PARTIAL) {
2115 u8 l4proto;
2116
036d61f0 2117 if (protocol == ETH_P_IP) {
af19b491
AKS		 2118 l4proto = ip_hdr(skb)->protocol;
2119
2120 if (l4proto == IPPROTO_TCP)
2121 opcode = TX_TCP_PKT;
2122 else if (l4proto == IPPROTO_UDP)
2123 opcode = TX_UDP_PKT;
036d61f0 2124 } else if (protocol == ETH_P_IPV6) {
af19b491
AKS		 2125 l4proto = ipv6_hdr(skb)->nexthdr;
2126
2127 if (l4proto == IPPROTO_TCP)
2128 opcode = TX_TCPV6_PKT;
2129 else if (l4proto == IPPROTO_UDP)
2130 opcode = TX_UDPV6_PKT;
2131 }
2132 }
af19b491
AKS		 2133 first_desc->tcp_hdr_offset += skb_transport_offset(skb);
2134 first_desc->ip_hdr_offset += skb_network_offset(skb);
2135 qlcnic_set_tx_flags_opcode(first_desc, flags, opcode);
2136
036d61f0 2137 return 0;
af19b491
AKS		 2138}
2139
2140static int
2141qlcnic_map_tx_skb(struct pci_dev *pdev,
2142 struct sk_buff *skb, struct qlcnic_cmd_buffer *pbuf)
2143{
2144 struct qlcnic_skb_frag *nf;
2145 struct skb_frag_struct *frag;
2146 int i, nr_frags;
2147 dma_addr_t map;
2148
2149 nr_frags = skb_shinfo(skb)->nr_frags;
2150 nf = &pbuf->frag_array[0];
2151
2152 map = pci_map_single(pdev, skb->data,
2153 skb_headlen(skb), PCI_DMA_TODEVICE);
2154 if (pci_dma_mapping_error(pdev, map))
2155 goto out_err;
2156
2157 nf->dma = map;
2158 nf->length = skb_headlen(skb);
2159
2160 for (i = 0; i < nr_frags; i++) {
2161 frag = &skb_shinfo(skb)->frags[i];
2162 nf = &pbuf->frag_array[i+1];
2163
9e903e08 2164 map = skb_frag_dma_map(&pdev->dev, frag, 0, skb_frag_size(frag),
5d6bcdfe
IC		 2165 DMA_TO_DEVICE);
2166 if (dma_mapping_error(&pdev->dev, map))
af19b491
AKS		 2167 goto unwind;
2168
2169 nf->dma = map;
9e903e08 2170 nf->length = skb_frag_size(frag);
af19b491
AKS		 2171 }
2172
2173 return 0;
2174
2175unwind:
2176 while (--i >= 0) {
2177 nf = &pbuf->frag_array[i+1];
2178 pci_unmap_page(pdev, nf->dma, nf->length, PCI_DMA_TODEVICE);
2179 }
2180
2181 nf = &pbuf->frag_array[0];
2182 pci_unmap_single(pdev, nf->dma, skb_headlen(skb), PCI_DMA_TODEVICE);
2183
2184out_err:
2185 return -ENOMEM;
2186}
2187
036d61f0
AC		 2188static void
2189qlcnic_unmap_buffers(struct pci_dev *pdev, struct sk_buff *skb,
2190 struct qlcnic_cmd_buffer *pbuf)
8cf61f89 2191{
036d61f0
AC		 2192 struct qlcnic_skb_frag *nf = &pbuf->frag_array[0];
2193 int nr_frags = skb_shinfo(skb)->nr_frags;
2194 int i;
8cf61f89 2195
036d61f0
AC		 2196 for (i = 0; i < nr_frags; i++) {
2197 nf = &pbuf->frag_array[i+1];
2198 pci_unmap_page(pdev, nf->dma, nf->length, PCI_DMA_TODEVICE);
8cf61f89 2199 }
8cf61f89 2200
036d61f0
AC		 2201 nf = &pbuf->frag_array[0];
2202 pci_unmap_single(pdev, nf->dma, skb_headlen(skb), PCI_DMA_TODEVICE);
5b446c6a 2203 pbuf->skb = NULL;
8cf61f89
AKS		 2204}
2205
af19b491
AKS		 2206static inline void
2207qlcnic_clear_cmddesc(u64 *desc)
2208{
2209 desc[0] = 0ULL;
2210 desc[2] = 0ULL;
8cf61f89 2211 desc[7] = 0ULL;
af19b491
AKS		 2212}
2213
cdaff185 2214netdev_tx_t
af19b491
AKS		 2215qlcnic_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
2216{
2217 struct qlcnic_adapter *adapter = netdev_priv(netdev);
2218 struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
2219 struct qlcnic_cmd_buffer *pbuf;
2220 struct qlcnic_skb_frag *buffrag;
2221 struct cmd_desc_type0 *hwdesc, *first_desc;
2222 struct pci_dev *pdev;
dcb50aff 2223 struct ethhdr *phdr;
91a403ca 2224 int delta = 0;
af19b491
AKS		 2225 int i, k;
2226
2227 u32 producer;
036d61f0 2228 int frag_count;
af19b491
AKS		 2229 u32 num_txd = tx_ring->num_desc;
2230
780ab790
AKS		 2231 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
2232 netif_stop_queue(netdev);
2233 return NETDEV_TX_BUSY;
2234 }
2235
fe4d434d 2236 if (adapter->flags & QLCNIC_MACSPOOF) {
dcb50aff 2237 phdr = (struct ethhdr *)skb->data;
2e42e474 2238 if (!ether_addr_equal(phdr->h_source, adapter->mac_addr))
fe4d434d
SC		 2239 goto drop_packet;
2240 }
2241
af19b491 2242 frag_count = skb_shinfo(skb)->nr_frags + 1;
91a403ca
AKS		 2243 /* 14 frags supported for normal packet and
2244 * 32 frags supported for TSO packet
2245 */
2246 if (!skb_is_gso(skb) && frag_count > QLCNIC_MAX_FRAGS_PER_TX) {
2247
2248 for (i = 0; i < (frag_count - QLCNIC_MAX_FRAGS_PER_TX); i++)
9e903e08 2249 delta += skb_frag_size(&skb_shinfo(skb)->frags[i]);
91a403ca
AKS		 2250
2251 if (!__pskb_pull_tail(skb, delta))
2252 goto drop_packet;
2253
2254 frag_count = 1 + skb_shinfo(skb)->nr_frags;
2255 }
af19b491 2256
ef71ff83 2257 if (unlikely(qlcnic_tx_avail(tx_ring) <= TX_STOP_THRESH)) {
af19b491 2258 netif_stop_queue(netdev);
ef71ff83
RB		 2259 if (qlcnic_tx_avail(tx_ring) > TX_STOP_THRESH)
2260 netif_start_queue(netdev);
2261 else {
2262 adapter->stats.xmit_off++;
2263 return NETDEV_TX_BUSY;
2264 }
af19b491
AKS		 2265 }
2266
2267 producer = tx_ring->producer;
2268 pbuf = &tx_ring->cmd_buf_arr[producer];
2269
2270 pdev = adapter->pdev;
2271
8cf61f89
AKS		 2272 first_desc = hwdesc = &tx_ring->desc_head[producer];
2273 qlcnic_clear_cmddesc((u64 *)hwdesc);
2274
8ae6df97
AKS		 2275 if (qlcnic_map_tx_skb(pdev, skb, pbuf)) {
2276 adapter->stats.tx_dma_map_error++;
af19b491 2277 goto drop_packet;
8ae6df97 2278 }
af19b491
AKS		 2279
2280 pbuf->skb = skb;
2281 pbuf->frag_count = frag_count;
2282
af19b491
AKS		 2283 qlcnic_set_tx_frags_len(first_desc, frag_count, skb->len);
2284 qlcnic_set_tx_port(first_desc, adapter->portnum);
2285
2286 for (i = 0; i < frag_count; i++) {
2287
2288 k = i % 4;
2289
2290 if ((k == 0) && (i > 0)) {
2291 /* move to next desc.*/
2292 producer = get_next_index(producer, num_txd);
2293 hwdesc = &tx_ring->desc_head[producer];
2294 qlcnic_clear_cmddesc((u64 *)hwdesc);
2295 tx_ring->cmd_buf_arr[producer].skb = NULL;
2296 }
2297
2298 buffrag = &pbuf->frag_array[i];
2299
2300 hwdesc->buffer_length[k] = cpu_to_le16(buffrag->length);
2301 switch (k) {
2302 case 0:
2303 hwdesc->addr_buffer1 = cpu_to_le64(buffrag->dma);
2304 break;
2305 case 1:
2306 hwdesc->addr_buffer2 = cpu_to_le64(buffrag->dma);
2307 break;
2308 case 2:
2309 hwdesc->addr_buffer3 = cpu_to_le64(buffrag->dma);
2310 break;
2311 case 3:
2312 hwdesc->addr_buffer4 = cpu_to_le64(buffrag->dma);
2313 break;
2314 }
2315 }
2316
2317 tx_ring->producer = get_next_index(producer, num_txd);
036d61f0 2318 smp_mb();
af19b491 2319
036d61f0
AC		 2320 if (unlikely(qlcnic_tx_pkt(adapter, first_desc, skb)))
2321 goto unwind_buff;
af19b491 2322
e5dcf6dc 2323 if (adapter->mac_learn)
b5e5492c
AKS		 2324 qlcnic_send_filter(adapter, tx_ring, first_desc, skb);
2325
af19b491
AKS		 2326 adapter->stats.txbytes += skb->len;
2327 adapter->stats.xmitcalled++;
2328
f127f472
SC		 2329 qlcnic_update_cmd_producer(adapter, tx_ring);
2330
af19b491
AKS		 2331 return NETDEV_TX_OK;
2332
036d61f0
AC		 2333unwind_buff:
2334 qlcnic_unmap_buffers(pdev, skb, pbuf);
af19b491
AKS		 2335drop_packet:
2336 adapter->stats.txdropped++;
2337 dev_kfree_skb_any(skb);
2338 return NETDEV_TX_OK;
2339}
2340
2341static int qlcnic_check_temp(struct qlcnic_adapter *adapter)
2342{
2343 struct net_device *netdev = adapter->netdev;
2344 u32 temp, temp_state, temp_val;
2345 int rv = 0;
2346
2347 temp = QLCRD32(adapter, CRB_TEMP_STATE);
2348
2349 temp_state = qlcnic_get_temp_state(temp);
2350 temp_val = qlcnic_get_temp_val(temp);
2351
2352 if (temp_state == QLCNIC_TEMP_PANIC) {
2353 dev_err(&netdev->dev,
2354 "Device temperature %d degrees C exceeds"
2355 " maximum allowed. Hardware has been shut down.\n",
2356 temp_val);
2357 rv = 1;
2358 } else if (temp_state == QLCNIC_TEMP_WARN) {
2359 if (adapter->temp == QLCNIC_TEMP_NORMAL) {
2360 dev_err(&netdev->dev,
2361 "Device temperature %d degrees C "
2362 "exceeds operating range."
2363 " Immediate action needed.\n",
2364 temp_val);
2365 }
2366 } else {
2367 if (adapter->temp == QLCNIC_TEMP_WARN) {
2368 dev_info(&netdev->dev,
2369 "Device temperature is now %d degrees C"
2370 " in normal range.\n", temp_val);
2371 }
2372 }
2373 adapter->temp = temp_state;
2374 return rv;
2375}
2376
2377void qlcnic_advert_link_change(struct qlcnic_adapter *adapter, int linkup)
2378{
2379 struct net_device *netdev = adapter->netdev;
2380
b1fc6d3c 2381 if (adapter->ahw->linkup && !linkup) {
69324275 2382 netdev_info(netdev, "NIC Link is down\n");
b1fc6d3c 2383 adapter->ahw->linkup = 0;
af19b491
AKS		 2384 if (netif_running(netdev)) {
2385 netif_carrier_off(netdev);
2386 netif_stop_queue(netdev);
2387 }
b1fc6d3c 2388 } else if (!adapter->ahw->linkup && linkup) {
69324275 2389 netdev_info(netdev, "NIC Link is up\n");
b1fc6d3c 2390 adapter->ahw->linkup = 1;
af19b491
AKS		 2391 if (netif_running(netdev)) {
2392 netif_carrier_on(netdev);
2393 netif_wake_queue(netdev);
2394 }
2395 }
2396}
2397
2398static void qlcnic_tx_timeout(struct net_device *netdev)
2399{
2400 struct qlcnic_adapter *adapter = netdev_priv(netdev);
2401
2402 if (test_bit(__QLCNIC_RESETTING, &adapter->state))
2403 return;
2404
2405 dev_err(&netdev->dev, "transmit timeout, resetting.\n");
af19b491
AKS		 2406
2407 if (++adapter->tx_timeo_cnt >= QLCNIC_MAX_TX_TIMEOUTS)
68bf1c68
AKS		 2408 adapter->need_fw_reset = 1;
2409 else
2410 adapter->reset_context = 1;
af19b491
AKS		 2411}
2412
2413static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev)
2414{
2415 struct qlcnic_adapter *adapter = netdev_priv(netdev);
2416 struct net_device_stats *stats = &netdev->stats;
2417
af19b491
AKS		 2418 stats->rx_packets = adapter->stats.rx_pkts + adapter->stats.lro_pkts;
2419 stats->tx_packets = adapter->stats.xmitfinished;
7e382594 2420 stats->rx_bytes = adapter->stats.rxbytes + adapter->stats.lrobytes;
af19b491
AKS		 2421 stats->tx_bytes = adapter->stats.txbytes;
2422 stats->rx_dropped = adapter->stats.rxdropped;
2423 stats->tx_dropped = adapter->stats.txdropped;
2424
2425 return stats;
2426}
2427
7eb9855d 2428static irqreturn_t qlcnic_clear_legacy_intr(struct qlcnic_adapter *adapter)
af19b491 2429{
af19b491
AKS		 2430 u32 status;
2431
2432 status = readl(adapter->isr_int_vec);
2433
2434 if (!(status & adapter->int_vec_bit))
2435 return IRQ_NONE;
2436
2437 /* check interrupt state machine, to be sure */
2438 status = readl(adapter->crb_int_state_reg);
2439 if (!ISR_LEGACY_INT_TRIGGERED(status))
2440 return IRQ_NONE;
2441
2442 writel(0xffffffff, adapter->tgt_status_reg);
2443 /* read twice to ensure write is flushed */
2444 readl(adapter->isr_int_vec);
2445 readl(adapter->isr_int_vec);
2446
7eb9855d
AKS		 2447 return IRQ_HANDLED;
2448}
2449
2450static irqreturn_t qlcnic_tmp_intr(int irq, void *data)
2451{
2452 struct qlcnic_host_sds_ring *sds_ring = data;
2453 struct qlcnic_adapter *adapter = sds_ring->adapter;
2454
2455 if (adapter->flags & QLCNIC_MSIX_ENABLED)
2456 goto done;
2457 else if (adapter->flags & QLCNIC_MSI_ENABLED) {
2458 writel(0xffffffff, adapter->tgt_status_reg);
2459 goto done;
2460 }
2461
2462 if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
2463 return IRQ_NONE;
2464
2465done:
2466 adapter->diag_cnt++;
2467 qlcnic_enable_int(sds_ring);
2468 return IRQ_HANDLED;
2469}
2470
2471static irqreturn_t qlcnic_intr(int irq, void *data)
2472{
2473 struct qlcnic_host_sds_ring *sds_ring = data;
2474 struct qlcnic_adapter *adapter = sds_ring->adapter;
2475
2476 if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
2477 return IRQ_NONE;
2478
af19b491
AKS		 2479 napi_schedule(&sds_ring->napi);
2480
2481 return IRQ_HANDLED;
2482}
2483
2484static irqreturn_t qlcnic_msi_intr(int irq, void *data)
2485{
2486 struct qlcnic_host_sds_ring *sds_ring = data;
2487 struct qlcnic_adapter *adapter = sds_ring->adapter;
2488
2489 /* clear interrupt */
2490 writel(0xffffffff, adapter->tgt_status_reg);
2491
2492 napi_schedule(&sds_ring->napi);
2493 return IRQ_HANDLED;
2494}
2495
2496static irqreturn_t qlcnic_msix_intr(int irq, void *data)
2497{
2498 struct qlcnic_host_sds_ring *sds_ring = data;
2499
2500 napi_schedule(&sds_ring->napi);
2501 return IRQ_HANDLED;
2502}
2503
2504static int qlcnic_process_cmd_ring(struct qlcnic_adapter *adapter)
2505{
2506 u32 sw_consumer, hw_consumer;
2507 int count = 0, i;
2508 struct qlcnic_cmd_buffer *buffer;
2509 struct pci_dev *pdev = adapter->pdev;
2510 struct net_device *netdev = adapter->netdev;
2511 struct qlcnic_skb_frag *frag;
2512 int done;
2513 struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
2514
2515 if (!spin_trylock(&adapter->tx_clean_lock))
2516 return 1;
2517
2518 sw_consumer = tx_ring->sw_consumer;
2519 hw_consumer = le32_to_cpu(*(tx_ring->hw_consumer));
2520
2521 while (sw_consumer != hw_consumer) {
2522 buffer = &tx_ring->cmd_buf_arr[sw_consumer];
2523 if (buffer->skb) {
2524 frag = &buffer->frag_array[0];
2525 pci_unmap_single(pdev, frag->dma, frag->length,
2526 PCI_DMA_TODEVICE);
2527 frag->dma = 0ULL;
2528 for (i = 1; i < buffer->frag_count; i++) {
2529 frag++;
2530 pci_unmap_page(pdev, frag->dma, frag->length,
2531 PCI_DMA_TODEVICE);
2532 frag->dma = 0ULL;
2533 }
2534
2535 adapter->stats.xmitfinished++;
2536 dev_kfree_skb_any(buffer->skb);
2537 buffer->skb = NULL;
2538 }
2539
2540 sw_consumer = get_next_index(sw_consumer, tx_ring->num_desc);
2541 if (++count >= MAX_STATUS_HANDLE)
2542 break;
2543 }
2544
2545 if (count && netif_running(netdev)) {
2546 tx_ring->sw_consumer = sw_consumer;
2547
2548 smp_mb();
2549
2550 if (netif_queue_stopped(netdev) && netif_carrier_ok(netdev)) {
af19b491
AKS		 2551 if (qlcnic_tx_avail(tx_ring) > TX_STOP_THRESH) {
2552 netif_wake_queue(netdev);
8bfe8b91 2553 adapter->stats.xmit_on++;
af19b491 2554 }
af19b491 2555 }
ef71ff83 2556 adapter->tx_timeo_cnt = 0;
af19b491
AKS		 2557 }
2558 /*
2559 * If everything is freed up to consumer then check if the ring is full
2560 * If the ring is full then check if more needs to be freed and
2561 * schedule the call back again.
2562 *
2563 * This happens when there are 2 CPUs. One could be freeing and the
2564 * other filling it. If the ring is full when we get out of here and
2565 * the card has already interrupted the host then the host can miss the
2566 * interrupt.
2567 *
2568 * There is still a possible race condition and the host could miss an
2569 * interrupt. The card has to take care of this.
2570 */
2571 hw_consumer = le32_to_cpu(*(tx_ring->hw_consumer));
2572 done = (sw_consumer == hw_consumer);
2573 spin_unlock(&adapter->tx_clean_lock);
2574
2575 return done;
2576}
2577
2578static int qlcnic_poll(struct napi_struct *napi, int budget)
2579{
2580 struct qlcnic_host_sds_ring *sds_ring =
2581 container_of(napi, struct qlcnic_host_sds_ring, napi);
2582
2583 struct qlcnic_adapter *adapter = sds_ring->adapter;
2584
2585 int tx_complete;
2586 int work_done;
2587
2588 tx_complete = qlcnic_process_cmd_ring(adapter);
2589
2590 work_done = qlcnic_process_rcv_ring(sds_ring, budget);
2591
2592 if ((work_done < budget) && tx_complete) {
2593 napi_complete(&sds_ring->napi);
2594 if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
2595 qlcnic_enable_int(sds_ring);
2596 }
2597
2598 return work_done;
2599}
2600
8f891387 2601static int qlcnic_rx_poll(struct napi_struct *napi, int budget)
2602{
2603 struct qlcnic_host_sds_ring *sds_ring =
2604 container_of(napi, struct qlcnic_host_sds_ring, napi);
2605
2606 struct qlcnic_adapter *adapter = sds_ring->adapter;
2607 int work_done;
2608
2609 work_done = qlcnic_process_rcv_ring(sds_ring, budget);
2610
2611 if (work_done < budget) {
2612 napi_complete(&sds_ring->napi);
2613 if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
2614 qlcnic_enable_int(sds_ring);
2615 }
2616
2617 return work_done;
2618}
2619
af19b491
AKS		 2620#ifdef CONFIG_NET_POLL_CONTROLLER
2621static void qlcnic_poll_controller(struct net_device *netdev)
2622{
bf82791e
YL		 2623 int ring;
2624 struct qlcnic_host_sds_ring *sds_ring;
af19b491 2625 struct qlcnic_adapter *adapter = netdev_priv(netdev);
b1fc6d3c 2626 struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
bf82791e 2627
af19b491 2628 disable_irq(adapter->irq);
bf82791e
YL		 2629 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
2630 sds_ring = &recv_ctx->sds_rings[ring];
2631 qlcnic_intr(adapter->irq, sds_ring);
2632 }
af19b491
AKS		 2633 enable_irq(adapter->irq);
2634}
2635#endif
2636
6df900e9
SC		 2637static void
2638qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding)
2639{
2640 u32 val;
2641
2642 val = adapter->portnum & 0xf;
2643 val |= encoding << 7;
2644 val |= (jiffies - adapter->dev_rst_time) << 8;
2645
2646 QLCWR32(adapter, QLCNIC_CRB_DRV_SCRATCH, val);
2647 adapter->dev_rst_time = jiffies;
2648}
2649
ade91f8e
AKS		 2650static int
2651qlcnic_set_drv_state(struct qlcnic_adapter *adapter, u8 state)
af19b491
AKS		 2652{
2653 u32 val;
2654
2655 WARN_ON(state != QLCNIC_DEV_NEED_RESET &&
2656 state != QLCNIC_DEV_NEED_QUISCENT);
2657
2658 if (qlcnic_api_lock(adapter))
ade91f8e 2659 return -EIO;
af19b491
AKS		 2660
2661 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
2662
2663 if (state == QLCNIC_DEV_NEED_RESET)
6d2a4724 2664 QLC_DEV_SET_RST_RDY(val, adapter->portnum);
af19b491 2665 else if (state == QLCNIC_DEV_NEED_QUISCENT)
6d2a4724 2666 QLC_DEV_SET_QSCNT_RDY(val, adapter->portnum);
af19b491
AKS		 2667
2668 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2669
2670 qlcnic_api_unlock(adapter);
ade91f8e
AKS		 2671
2672 return 0;
af19b491
AKS		 2673}
2674
1b95a839
AKS		 2675static int
2676qlcnic_clr_drv_state(struct qlcnic_adapter *adapter)
2677{
2678 u32 val;
2679
2680 if (qlcnic_api_lock(adapter))
2681 return -EBUSY;
2682
2683 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
6d2a4724 2684 QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
1b95a839
AKS		 2685 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2686
2687 qlcnic_api_unlock(adapter);
2688
2689 return 0;
2690}
2691
af19b491 2692static void
21854f02 2693qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8 failed)
af19b491
AKS		 2694{
2695 u32 val;
2696
2697 if (qlcnic_api_lock(adapter))
2698 goto err;
2699
31018e06 2700 val = QLCRD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
6d2a4724 2701 QLC_DEV_CLR_REF_CNT(val, adapter->portnum);
31018e06 2702 QLCWR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
af19b491 2703
21854f02
AKS		 2704 if (failed) {
2705 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_FAILED);
2706 dev_info(&adapter->pdev->dev,
2707 "Device state set to Failed. Please Reboot\n");
2708 } else if (!(val & 0x11111111))
af19b491
AKS		 2709 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_COLD);
2710
2711 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
6d2a4724 2712 QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
af19b491
AKS		 2713 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2714
2715 qlcnic_api_unlock(adapter);
2716err:
2717 adapter->fw_fail_cnt = 0;
032a13c7 2718 adapter->flags &= ~QLCNIC_FW_HANG;
af19b491
AKS		 2719 clear_bit(__QLCNIC_START_FW, &adapter->state);
2720 clear_bit(__QLCNIC_RESETTING, &adapter->state);
2721}
2722
f73dfc50 2723/* Grab api lock, before checking state */
af19b491
AKS		 2724static int
2725qlcnic_check_drv_state(struct qlcnic_adapter *adapter)
2726{
602ca6f0 2727 int act, state, active_mask;
af19b491
AKS		 2728
2729 state = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
31018e06 2730 act = QLCRD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
af19b491 2731
602ca6f0
SV		 2732 if (adapter->flags & QLCNIC_FW_RESET_OWNER) {
2733 active_mask = (~(1 << (adapter->ahw->pci_func * 4)));
2734 act = act & active_mask;
2735 }
2736
af19b491
AKS		 2737 if (((state & 0x11111111) == (act & 0x11111111)) ||
2738 ((act & 0x11111111) == ((state >> 1) & 0x11111111)))
2739 return 0;
2740 else
2741 return 1;
2742}
2743
96f8118c
SC		 2744static int qlcnic_check_idc_ver(struct qlcnic_adapter *adapter)
2745{
2746 u32 val = QLCRD32(adapter, QLCNIC_CRB_DRV_IDC_VER);
2747
2748 if (val != QLCNIC_DRV_IDC_VER) {
2749 dev_warn(&adapter->pdev->dev, "IDC Version mismatch, driver's"
2750 " idc ver = %x; reqd = %x\n", QLCNIC_DRV_IDC_VER, val);
2751 }
2752
2753 return 0;
2754}
2755
af19b491
AKS		 2756static int
2757qlcnic_can_start_firmware(struct qlcnic_adapter *adapter)
2758{
2759 u32 val, prev_state;
aa5e18c0 2760 u8 dev_init_timeo = adapter->dev_init_timeo;
6d2a4724 2761 u8 portnum = adapter->portnum;
96f8118c 2762 u8 ret;
af19b491 2763
f73dfc50
AKS		 2764 if (test_and_clear_bit(__QLCNIC_START_FW, &adapter->state))
2765 return 1;
2766
af19b491
AKS		 2767 if (qlcnic_api_lock(adapter))
2768 return -1;
2769
31018e06 2770 val = QLCRD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
6d2a4724
AKS		 2771 if (!(val & (1 << (portnum * 4)))) {
2772 QLC_DEV_SET_REF_CNT(val, portnum);
31018e06 2773 QLCWR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
af19b491
AKS		 2774 }
2775
2776 prev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
65b5b420 2777 QLCDB(adapter, HW, "Device state = %u\n", prev_state);
af19b491
AKS		 2778
2779 switch (prev_state) {
2780 case QLCNIC_DEV_COLD:
bbd8c6a4 2781 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_INITIALIZING);
96f8118c 2782 QLCWR32(adapter, QLCNIC_CRB_DRV_IDC_VER, QLCNIC_DRV_IDC_VER);
6df900e9 2783 qlcnic_idc_debug_info(adapter, 0);
af19b491
AKS		 2784 qlcnic_api_unlock(adapter);
2785 return 1;
2786
2787 case QLCNIC_DEV_READY:
96f8118c 2788 ret = qlcnic_check_idc_ver(adapter);
af19b491 2789 qlcnic_api_unlock(adapter);
96f8118c 2790 return ret;
af19b491
AKS		 2791
2792 case QLCNIC_DEV_NEED_RESET:
2793 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
6d2a4724 2794 QLC_DEV_SET_RST_RDY(val, portnum);
af19b491
AKS		 2795 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2796 break;
2797
2798 case QLCNIC_DEV_NEED_QUISCENT:
2799 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
6d2a4724 2800 QLC_DEV_SET_QSCNT_RDY(val, portnum);
af19b491
AKS		 2801 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2802 break;
2803
2804 case QLCNIC_DEV_FAILED:
a7fc948f 2805 dev_err(&adapter->pdev->dev, "Device in failed state.\n");
af19b491
AKS		 2806 qlcnic_api_unlock(adapter);
2807 return -1;
bbd8c6a4
AKS		 2808
2809 case QLCNIC_DEV_INITIALIZING:
2810 case QLCNIC_DEV_QUISCENT:
2811 break;
af19b491
AKS		 2812 }
2813
2814 qlcnic_api_unlock(adapter);
aa5e18c0
SC		 2815
2816 do {
af19b491 2817 msleep(1000);
a5e463d0
SC		 2818 prev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2819
2820 if (prev_state == QLCNIC_DEV_QUISCENT)
2821 continue;
2822 } while ((prev_state != QLCNIC_DEV_READY) && --dev_init_timeo);
af19b491 2823
65b5b420
AKS		 2824 if (!dev_init_timeo) {
2825 dev_err(&adapter->pdev->dev,
2826 "Waiting for device to initialize timeout\n");
af19b491 2827 return -1;
65b5b420 2828 }
af19b491
AKS		 2829
2830 if (qlcnic_api_lock(adapter))
2831 return -1;
2832
2833 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
6d2a4724 2834 QLC_DEV_CLR_RST_QSCNT(val, portnum);
af19b491
AKS		 2835 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2836
96f8118c 2837 ret = qlcnic_check_idc_ver(adapter);
af19b491
AKS		 2838 qlcnic_api_unlock(adapter);
2839
96f8118c 2840 return ret;
af19b491
AKS		 2841}
2842
2843static void
2844qlcnic_fwinit_work(struct work_struct *work)
2845{
2846 struct qlcnic_adapter *adapter = container_of(work,
2847 struct qlcnic_adapter, fw_work.work);
3c4b23b1 2848 u32 dev_state = 0xf;
7b749ff4 2849 u32 val;
af19b491 2850
f73dfc50
AKS		 2851 if (qlcnic_api_lock(adapter))
2852 goto err_ret;
af19b491 2853
a5e463d0 2854 dev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
b8c17620
AKS		 2855 if (dev_state == QLCNIC_DEV_QUISCENT ||
2856 dev_state == QLCNIC_DEV_NEED_QUISCENT) {
a5e463d0
SC		 2857 qlcnic_api_unlock(adapter);
2858 qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
2859 FW_POLL_DELAY * 2);
2860 return;
2861 }
2862
9f26f547 2863 if (adapter->op_mode == QLCNIC_NON_PRIV_FUNC) {
3c4b23b1
AKS		 2864 qlcnic_api_unlock(adapter);
2865 goto wait_npar;
9f26f547
AC		 2866 }
2867
16e3cf73
SV		 2868 if (dev_state == QLCNIC_DEV_INITIALIZING ||
2869 dev_state == QLCNIC_DEV_READY) {
2870 dev_info(&adapter->pdev->dev, "Detected state change from "
2871 "DEV_NEED_RESET, skipping ack check\n");
2872 goto skip_ack_check;
2873 }
2874
f73dfc50 2875 if (adapter->fw_wait_cnt++ > adapter->reset_ack_timeo) {
16e3cf73 2876 dev_info(&adapter->pdev->dev, "Reset:Failed to get ack %d sec\n",
f73dfc50
AKS		 2877 adapter->reset_ack_timeo);
2878 goto skip_ack_check;
2879 }
2880
2881 if (!qlcnic_check_drv_state(adapter)) {
2882skip_ack_check:
2883 dev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
a5e463d0 2884
f73dfc50
AKS		 2885 if (dev_state == QLCNIC_DEV_NEED_RESET) {
2886 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE,
2887 QLCNIC_DEV_INITIALIZING);
2888 set_bit(__QLCNIC_START_FW, &adapter->state);
2889 QLCDB(adapter, DRV, "Restarting fw\n");
6df900e9 2890 qlcnic_idc_debug_info(adapter, 0);
7b749ff4
SV		 2891 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
2892 QLC_DEV_SET_RST_RDY(val, adapter->portnum);
2893 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
af19b491
AKS		 2894 }
2895
f73dfc50
AKS		 2896 qlcnic_api_unlock(adapter);
2897
287e38aa 2898 rtnl_lock();
7b749ff4
SV		 2899 if (adapter->ahw->fw_dump.enable &&
2900 (adapter->flags & QLCNIC_FW_RESET_OWNER)) {
9d6a6440
AC		 2901 QLCDB(adapter, DRV, "Take FW dump\n");
2902 qlcnic_dump_fw(adapter);
032a13c7 2903 adapter->flags |= QLCNIC_FW_HANG;
9d6a6440 2904 }
287e38aa 2905 rtnl_unlock();
7b749ff4
SV		 2906
2907 adapter->flags &= ~QLCNIC_FW_RESET_OWNER;
9f26f547 2908 if (!adapter->nic_ops->start_firmware(adapter)) {
af19b491 2909 qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
b18971d1 2910 adapter->fw_wait_cnt = 0;
af19b491
AKS		 2911 return;
2912 }
af19b491
AKS		 2913 goto err_ret;
2914 }
2915
f73dfc50 2916 qlcnic_api_unlock(adapter);
aa5e18c0 2917
9f26f547 2918wait_npar:
af19b491 2919 dev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
f73dfc50 2920 QLCDB(adapter, HW, "Func waiting: Device state=%u\n", dev_state);
65b5b420 2921
af19b491 2922 switch (dev_state) {
3c4b23b1 2923 case QLCNIC_DEV_READY:
9f26f547 2924 if (!adapter->nic_ops->start_firmware(adapter)) {
f73dfc50 2925 qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
b18971d1 2926 adapter->fw_wait_cnt = 0;
f73dfc50
AKS		 2927 return;
2928 }
3c4b23b1
AKS		 2929 case QLCNIC_DEV_FAILED:
2930 break;
2931 default:
2932 qlcnic_schedule_work(adapter,
2933 qlcnic_fwinit_work, FW_POLL_DELAY);
2934 return;
af19b491
AKS		 2935 }
2936
2937err_ret:
f73dfc50
AKS		 2938 dev_err(&adapter->pdev->dev, "Fwinit work failed state=%u "
2939 "fw_wait_cnt=%u\n", dev_state, adapter->fw_wait_cnt);
34ce3626 2940 netif_device_attach(adapter->netdev);
21854f02 2941 qlcnic_clr_all_drv_state(adapter, 0);
af19b491
AKS		 2942}
2943
2944static void
2945qlcnic_detach_work(struct work_struct *work)
2946{
2947 struct qlcnic_adapter *adapter = container_of(work,
2948 struct qlcnic_adapter, fw_work.work);
2949 struct net_device *netdev = adapter->netdev;
2950 u32 status;
2951
2952 netif_device_detach(netdev);
2953
b8c17620
AKS		 2954 /* Dont grab rtnl lock during Quiscent mode */
2955 if (adapter->dev_state == QLCNIC_DEV_NEED_QUISCENT) {
2956 if (netif_running(netdev))
2957 __qlcnic_down(adapter, netdev);
2958 } else
2959 qlcnic_down(adapter, netdev);
af19b491 2960
af19b491
AKS		 2961 status = QLCRD32(adapter, QLCNIC_PEG_HALT_STATUS1);
2962
44f65b29
SC		 2963 if (status & QLCNIC_RCODE_FATAL_ERROR) {
2964 dev_err(&adapter->pdev->dev,
2965 "Detaching the device: peg halt status1=0x%x\n",
2966 status);
2967
2968 if (QLCNIC_FWERROR_CODE(status) == QLCNIC_FWERROR_FAN_FAILURE) {
2969 dev_err(&adapter->pdev->dev,
2970 "On board active cooling fan failed. "
2971 "Device has been halted.\n");
2972 dev_err(&adapter->pdev->dev,
2973 "Replace the adapter.\n");
2974 }
2975
af19b491 2976 goto err_ret;
44f65b29 2977 }
af19b491 2978
44f65b29
SC		 2979 if (adapter->temp == QLCNIC_TEMP_PANIC) {
2980 dev_err(&adapter->pdev->dev, "Detaching the device: temp=%d\n",
2981 adapter->temp);
af19b491 2982 goto err_ret;
44f65b29
SC		 2983 }
2984
602ca6f0
SV		 2985 /* Dont ack if this instance is the reset owner */
2986 if (!(adapter->flags & QLCNIC_FW_RESET_OWNER)) {
44f65b29
SC		 2987 if (qlcnic_set_drv_state(adapter, adapter->dev_state)) {
2988 dev_err(&adapter->pdev->dev,
2989 "Failed to set driver state,"
2990 "detaching the device.\n");
602ca6f0 2991 goto err_ret;
44f65b29 2992 }
602ca6f0 2993 }
af19b491
AKS		 2994
2995 adapter->fw_wait_cnt = 0;
2996
2997 qlcnic_schedule_work(adapter, qlcnic_fwinit_work, FW_POLL_DELAY);
2998
2999 return;
3000
3001err_ret:
34ce3626 3002 netif_device_attach(netdev);
21854f02 3003 qlcnic_clr_all_drv_state(adapter, 1);
af19b491
AKS		 3004}
3005
3c4b23b1
AKS		 3006/*Transit NPAR state to NON Operational */
3007static void
3008qlcnic_set_npar_non_operational(struct qlcnic_adapter *adapter)
3009{
3010 u32 state;
3011
3012 state = QLCRD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
3013 if (state == QLCNIC_DEV_NPAR_NON_OPER)
3014 return;
3015
3016 if (qlcnic_api_lock(adapter))
3017 return;
3018 QLCWR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE, QLCNIC_DEV_NPAR_NON_OPER);
3019 qlcnic_api_unlock(adapter);
3020}
3021
f73dfc50 3022/*Transit to RESET state from READY state only */
18f2f616 3023void
af19b491
AKS		 3024qlcnic_dev_request_reset(struct qlcnic_adapter *adapter)
3025{
646779f1
SV		 3026 u32 state, xg_val = 0, gb_val = 0;
3027
3028 qlcnic_xg_set_xg0_mask(xg_val);
3029 qlcnic_xg_set_xg1_mask(xg_val);
3030 QLCWR32(adapter, QLCNIC_NIU_XG_PAUSE_CTL, xg_val);
3031 qlcnic_gb_set_gb0_mask(gb_val);
3032 qlcnic_gb_set_gb1_mask(gb_val);
3033 qlcnic_gb_set_gb2_mask(gb_val);
3034 qlcnic_gb_set_gb3_mask(gb_val);
3035 QLCWR32(adapter, QLCNIC_NIU_GB_PAUSE_CTL, gb_val);
3036 dev_info(&adapter->pdev->dev, "Pause control frames disabled"
3037 " on all ports\n");
cea8975e 3038 adapter->need_fw_reset = 1;
af19b491
AKS		 3039 if (qlcnic_api_lock(adapter))
3040 return;
3041
3042 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
b43e5ee7
SC		 3043 if (state == QLCNIC_DEV_FAILED || (state == QLCNIC_DEV_BADBAD)) {
3044 netdev_err(adapter->netdev,
3045 "Device is in FAILED state, Please Reboot\n");
3046 qlcnic_api_unlock(adapter);
3047 return;
3048 }
af19b491 3049
f73dfc50 3050 if (state == QLCNIC_DEV_READY) {
af19b491 3051 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_NEED_RESET);
602ca6f0 3052 adapter->flags |= QLCNIC_FW_RESET_OWNER;
65b5b420 3053 QLCDB(adapter, DRV, "NEED_RESET state set\n");
6df900e9 3054 qlcnic_idc_debug_info(adapter, 0);
af19b491
AKS		 3055 }
3056
3c4b23b1 3057 QLCWR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE, QLCNIC_DEV_NPAR_NON_OPER);
af19b491
AKS		 3058 qlcnic_api_unlock(adapter);
3059}
3060
9f26f547
AC		 3061/* Transit to NPAR READY state from NPAR NOT READY state */
3062static void
3063qlcnic_dev_set_npar_ready(struct qlcnic_adapter *adapter)
3064{
9f26f547
AC		 3065 if (qlcnic_api_lock(adapter))
3066 return;
3067
3c4b23b1
AKS		 3068 QLCWR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE, QLCNIC_DEV_NPAR_OPER);
3069 QLCDB(adapter, DRV, "NPAR operational state set\n");
9f26f547
AC		 3070
3071 qlcnic_api_unlock(adapter);
3072}
3073
af19b491
AKS		 3074static void
3075qlcnic_schedule_work(struct qlcnic_adapter *adapter,
3076 work_func_t func, int delay)
3077{
451724c8
SC		 3078 if (test_bit(__QLCNIC_AER, &adapter->state))
3079 return;
3080
af19b491 3081 INIT_DELAYED_WORK(&adapter->fw_work, func);
f7ec804a
AKS		 3082 queue_delayed_work(qlcnic_wq, &adapter->fw_work,
3083 round_jiffies_relative(delay));
af19b491
AKS		 3084}
3085
3086static void
3087qlcnic_cancel_fw_work(struct qlcnic_adapter *adapter)
3088{
3089 while (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
3090 msleep(10);
3091
b43e5ee7
SC		 3092 if (!adapter->fw_work.work.func)
3093 return;
3094
af19b491
AKS		 3095 cancel_delayed_work_sync(&adapter->fw_work);
3096}
3097
3098static void
3099qlcnic_attach_work(struct work_struct *work)
3100{
3101 struct qlcnic_adapter *adapter = container_of(work,
3102 struct qlcnic_adapter, fw_work.work);
3103 struct net_device *netdev = adapter->netdev;
b18971d1 3104 u32 npar_state;
af19b491 3105
b18971d1
AKS		 3106 if (adapter->op_mode != QLCNIC_MGMT_FUNC) {
3107 npar_state = QLCRD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
3108 if (adapter->fw_wait_cnt++ > QLCNIC_DEV_NPAR_OPER_TIMEO)
3109 qlcnic_clr_all_drv_state(adapter, 0);
3110 else if (npar_state != QLCNIC_DEV_NPAR_OPER)
3111 qlcnic_schedule_work(adapter, qlcnic_attach_work,
3112 FW_POLL_DELAY);
3113 else
3114 goto attach;
3115 QLCDB(adapter, DRV, "Waiting for NPAR state to operational\n");
3116 return;
3117 }
3118attach:
af19b491 3119 if (netif_running(netdev)) {
52486a3a 3120 if (qlcnic_up(adapter, netdev))
af19b491 3121 goto done;
af19b491 3122
aec1e845 3123 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
af19b491
AKS		 3124 }
3125
af19b491 3126done:
34ce3626 3127 netif_device_attach(netdev);
af19b491 3128 adapter->fw_fail_cnt = 0;
032a13c7 3129 adapter->flags &= ~QLCNIC_FW_HANG;
af19b491 3130 clear_bit(__QLCNIC_RESETTING, &adapter->state);
1b95a839
AKS		 3131
3132 if (!qlcnic_clr_drv_state(adapter))
3133 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3134 FW_POLL_DELAY);
af19b491
AKS		 3135}
3136
3137static int
3138qlcnic_check_health(struct qlcnic_adapter *adapter)
3139{
4e70812b 3140 u32 state = 0, heartbeat;
853d4bca 3141 u32 peg_status;
af19b491
AKS		 3142
3143 if (qlcnic_check_temp(adapter))
3144 goto detach;
3145
2372a5f1 3146 if (adapter->need_fw_reset)
af19b491 3147 qlcnic_dev_request_reset(adapter);
af19b491
AKS		 3148
3149 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
b8c17620 3150 if (state == QLCNIC_DEV_NEED_RESET) {
3c4b23b1 3151 qlcnic_set_npar_non_operational(adapter);
af19b491 3152 adapter->need_fw_reset = 1;
b8c17620
AKS		 3153 } else if (state == QLCNIC_DEV_NEED_QUISCENT)
3154 goto detach;
af19b491 3155
4e70812b
SC		 3156 heartbeat = QLCRD32(adapter, QLCNIC_PEG_ALIVE_COUNTER);
3157 if (heartbeat != adapter->heartbeat) {
3158 adapter->heartbeat = heartbeat;
af19b491
AKS		 3159 adapter->fw_fail_cnt = 0;
3160 if (adapter->need_fw_reset)
3161 goto detach;
68bf1c68 3162
9ce13ca8 3163 if (adapter->reset_context && auto_fw_reset) {
68bf1c68
AKS		 3164 qlcnic_reset_hw_context(adapter);
3165 adapter->netdev->trans_start = jiffies;
3166 }
3167
af19b491
AKS		 3168 return 0;
3169 }
3170
3171 if (++adapter->fw_fail_cnt < FW_FAIL_THRESH)
3172 return 0;
3173
032a13c7
SV		 3174 adapter->flags |= QLCNIC_FW_HANG;
3175
af19b491
AKS		 3176 qlcnic_dev_request_reset(adapter);
3177
9ce13ca8 3178 if (auto_fw_reset)
0df170b6 3179 clear_bit(__QLCNIC_FW_ATTACHED, &adapter->state);
af19b491 3180
853d4bca
AR		 3181 dev_err(&adapter->pdev->dev, "firmware hang detected\n");
3182 dev_err(&adapter->pdev->dev, "Dumping hw/fw registers\n"
c76ecb7a
SV		 3183 "PEG_HALT_STATUS1: 0x%x, PEG_HALT_STATUS2: 0x%x,\n"
3184 "PEG_NET_0_PC: 0x%x, PEG_NET_1_PC: 0x%x,\n"
3185 "PEG_NET_2_PC: 0x%x, PEG_NET_3_PC: 0x%x,\n"
3186 "PEG_NET_4_PC: 0x%x\n",
3187 QLCRD32(adapter, QLCNIC_PEG_HALT_STATUS1),
3188 QLCRD32(adapter, QLCNIC_PEG_HALT_STATUS2),
3189 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_0 + 0x3c),
3190 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_1 + 0x3c),
3191 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_2 + 0x3c),
3192 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_3 + 0x3c),
3193 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_4 + 0x3c));
853d4bca 3194 peg_status = QLCRD32(adapter, QLCNIC_PEG_HALT_STATUS1);
97048a1f 3195 if (QLCNIC_FWERROR_CODE(peg_status) == 0x67)
853d4bca
AR		 3196 dev_err(&adapter->pdev->dev,
3197 "Firmware aborted with error code 0x00006700. "
3198 "Device is being reset.\n");
af19b491
AKS		 3199detach:
3200 adapter->dev_state = (state == QLCNIC_DEV_NEED_QUISCENT) ? state :
3201 QLCNIC_DEV_NEED_RESET;
3202
9ce13ca8 3203 if (auto_fw_reset &&
65b5b420
AKS		 3204 !test_and_set_bit(__QLCNIC_RESETTING, &adapter->state)) {
3205
af19b491 3206 qlcnic_schedule_work(adapter, qlcnic_detach_work, 0);
65b5b420
AKS		 3207 QLCDB(adapter, DRV, "fw recovery scheduled.\n");
3208 }
af19b491
AKS		 3209
3210 return 1;
3211}
3212
3213static void
3214qlcnic_fw_poll_work(struct work_struct *work)
3215{
3216 struct qlcnic_adapter *adapter = container_of(work,
3217 struct qlcnic_adapter, fw_work.work);
3218
3219 if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3220 goto reschedule;
3221
3222
3223 if (qlcnic_check_health(adapter))
3224 return;
3225
b5e5492c
AKS		 3226 if (adapter->fhash.fnum)
3227 qlcnic_prune_lb_filters(adapter);
3228
af19b491
AKS		 3229reschedule:
3230 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
3231}
3232
451724c8
SC		 3233static int qlcnic_is_first_func(struct pci_dev *pdev)
3234{
3235 struct pci_dev *oth_pdev;
3236 int val = pdev->devfn;
3237
3238 while (val-- > 0) {
3239 oth_pdev = pci_get_domain_bus_and_slot(pci_domain_nr
3240 (pdev->bus), pdev->bus->number,
3241 PCI_DEVFN(PCI_SLOT(pdev->devfn), val));
bfc978fa
AKS		 3242 if (!oth_pdev)
3243 continue;
451724c8 3244
bfc978fa
AKS		 3245 if (oth_pdev->current_state != PCI_D3cold) {
3246 pci_dev_put(oth_pdev);
451724c8 3247 return 0;
bfc978fa
AKS		 3248 }
3249 pci_dev_put(oth_pdev);
451724c8
SC		 3250 }
3251 return 1;
3252}
3253
3254static int qlcnic_attach_func(struct pci_dev *pdev)
3255{
3256 int err, first_func;
3257 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3258 struct net_device *netdev = adapter->netdev;
3259
3260 pdev->error_state = pci_channel_io_normal;
3261
3262 err = pci_enable_device(pdev);
3263 if (err)
3264 return err;
3265
3266 pci_set_power_state(pdev, PCI_D0);
3267 pci_set_master(pdev);
3268 pci_restore_state(pdev);
3269
3270 first_func = qlcnic_is_first_func(pdev);
3271
3272 if (qlcnic_api_lock(adapter))
3273 return -EINVAL;
3274
933fce12 3275 if (adapter->op_mode != QLCNIC_NON_PRIV_FUNC && first_func) {
451724c8
SC		 3276 adapter->need_fw_reset = 1;
3277 set_bit(__QLCNIC_START_FW, &adapter->state);
3278 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_INITIALIZING);
3279 QLCDB(adapter, DRV, "Restarting fw\n");
3280 }
3281 qlcnic_api_unlock(adapter);
3282
3283 err = adapter->nic_ops->start_firmware(adapter);
3284 if (err)
3285 return err;
3286
3287 qlcnic_clr_drv_state(adapter);
3288 qlcnic_setup_intr(adapter);
3289
3290 if (netif_running(netdev)) {
3291 err = qlcnic_attach(adapter);
3292 if (err) {
21854f02 3293 qlcnic_clr_all_drv_state(adapter, 1);
451724c8
SC		 3294 clear_bit(__QLCNIC_AER, &adapter->state);
3295 netif_device_attach(netdev);
3296 return err;
3297 }
3298
3299 err = qlcnic_up(adapter, netdev);
3300 if (err)
3301 goto done;
3302
aec1e845 3303 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
451724c8
SC		 3304 }
3305 done:
3306 netif_device_attach(netdev);
3307 return err;
3308}
3309
3310static pci_ers_result_t qlcnic_io_error_detected(struct pci_dev *pdev,
3311 pci_channel_state_t state)
3312{
3313 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3314 struct net_device *netdev = adapter->netdev;
3315
3316 if (state == pci_channel_io_perm_failure)
3317 return PCI_ERS_RESULT_DISCONNECT;
3318
3319 if (state == pci_channel_io_normal)
3320 return PCI_ERS_RESULT_RECOVERED;
3321
3322 set_bit(__QLCNIC_AER, &adapter->state);
3323 netif_device_detach(netdev);
3324
3325 cancel_delayed_work_sync(&adapter->fw_work);
3326
3327 if (netif_running(netdev))
3328 qlcnic_down(adapter, netdev);
3329
3330 qlcnic_detach(adapter);
3331 qlcnic_teardown_intr(adapter);
3332
3333 clear_bit(__QLCNIC_RESETTING, &adapter->state);
3334
3335 pci_save_state(pdev);
3336 pci_disable_device(pdev);
3337
3338 return PCI_ERS_RESULT_NEED_RESET;
3339}
3340
3341static pci_ers_result_t qlcnic_io_slot_reset(struct pci_dev *pdev)
3342{
3343 return qlcnic_attach_func(pdev) ? PCI_ERS_RESULT_DISCONNECT :
3344 PCI_ERS_RESULT_RECOVERED;
3345}
3346
3347static void qlcnic_io_resume(struct pci_dev *pdev)
3348{
3349 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3350
3351 pci_cleanup_aer_uncorrect_error_status(pdev);
3352
3353 if (QLCRD32(adapter, QLCNIC_CRB_DEV_STATE) == QLCNIC_DEV_READY &&
3354 test_and_clear_bit(__QLCNIC_AER, &adapter->state))
3355 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3356 FW_POLL_DELAY);
3357}
3358
87eb743b
AC		 3359static int
3360qlcnicvf_start_firmware(struct qlcnic_adapter *adapter)
3361{
3362 int err;
3363
3364 err = qlcnic_can_start_firmware(adapter);
3365 if (err)
3366 return err;
3367
78f84e1a
AKS		 3368 err = qlcnic_check_npar_opertional(adapter);
3369 if (err)
3370 return err;
3c4b23b1 3371
174240a8
RB		 3372 err = qlcnic_initialize_nic(adapter);
3373 if (err)
3374 return err;
3375
87eb743b
AC		 3376 qlcnic_check_options(adapter);
3377
7373373d
RB		 3378 err = qlcnic_set_eswitch_port_config(adapter);
3379 if (err)
3380 return err;
3381
87eb743b
AC		 3382 adapter->need_fw_reset = 0;
3383
3384 return err;
3385}
3386
3387static int
3388qlcnicvf_config_bridged_mode(struct qlcnic_adapter *adapter, u32 enable)
3389{
3390 return -EOPNOTSUPP;
3391}
3392
3393static int
3394qlcnicvf_config_led(struct qlcnic_adapter *adapter, u32 state, u32 rate)
3395{
3396 return -EOPNOTSUPP;
3397}
3398
af19b491
AKS		 3399static ssize_t
3400qlcnic_store_bridged_mode(struct device *dev,
3401 struct device_attribute *attr, const char *buf, size_t len)
3402{
3403 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3404 unsigned long new;
3405 int ret = -EINVAL;
3406
3407 if (!(adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG))
3408 goto err_out;
3409
8a15ad1f 3410 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
af19b491
AKS		 3411 goto err_out;
3412
3413 if (strict_strtoul(buf, 2, &new))
3414 goto err_out;
3415
2e9d722d 3416 if (!adapter->nic_ops->config_bridged_mode(adapter, !!new))
af19b491
AKS		 3417 ret = len;
3418
3419err_out:
3420 return ret;
3421}
3422
3423static ssize_t
3424qlcnic_show_bridged_mode(struct device *dev,
3425 struct device_attribute *attr, char *buf)
3426{
3427 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3428 int bridged_mode = 0;
3429
3430 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG)
3431 bridged_mode = !!(adapter->flags & QLCNIC_BRIDGE_ENABLED);
3432
3433 return sprintf(buf, "%d\n", bridged_mode);
3434}
3435
3436static struct device_attribute dev_attr_bridged_mode = {
3437 .attr = {.name = "bridged_mode", .mode = (S_IRUGO | S_IWUSR)},
3438 .show = qlcnic_show_bridged_mode,
3439 .store = qlcnic_store_bridged_mode,
3440};
3441
3442static ssize_t
3443qlcnic_store_diag_mode(struct device *dev,
3444 struct device_attribute *attr, const char *buf, size_t len)
3445{
3446 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3447 unsigned long new;
3448
3449 if (strict_strtoul(buf, 2, &new))
3450 return -EINVAL;
3451
3452 if (!!new != !!(adapter->flags & QLCNIC_DIAG_ENABLED))
3453 adapter->flags ^= QLCNIC_DIAG_ENABLED;
3454
3455 return len;
3456}
3457
3458static ssize_t
3459qlcnic_show_diag_mode(struct device *dev,
3460 struct device_attribute *attr, char *buf)
3461{
3462 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3463
3464 return sprintf(buf, "%d\n",
3465 !!(adapter->flags & QLCNIC_DIAG_ENABLED));
3466}
3467
3468static struct device_attribute dev_attr_diag_mode = {
3469 .attr = {.name = "diag_mode", .mode = (S_IRUGO | S_IWUSR)},
3470 .show = qlcnic_show_diag_mode,
3471 .store = qlcnic_store_diag_mode,
3472};
3473
f94bc1e7
SC		 3474int qlcnic_validate_max_rss(struct net_device *netdev, u8 max_hw, u8 val)
3475{
3476 if (!use_msi_x && !use_msi) {
3477 netdev_info(netdev, "no msix or msi support, hence no rss\n");
3478 return -EINVAL;
3479 }
3480
3481 if ((val > max_hw) || (val < 2) || !is_power_of_2(val)) {
3482 netdev_info(netdev, "rss_ring valid range [2 - %x] in "
3483 " powers of 2\n", max_hw);
3484 return -EINVAL;
3485 }
3486 return 0;
3487
3488}
3489
3490int qlcnic_set_max_rss(struct qlcnic_adapter *adapter, u8 data)
3491{
3492 struct net_device *netdev = adapter->netdev;
3493 int err = 0;
3494
3495 if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
3496 return -EBUSY;
3497
3498 netif_device_detach(netdev);
3499 if (netif_running(netdev))
3500 __qlcnic_down(adapter, netdev);
3501 qlcnic_detach(adapter);
3502 qlcnic_teardown_intr(adapter);
3503
3504 if (qlcnic_enable_msix(adapter, data)) {
3505 netdev_info(netdev, "failed setting max_rss; rss disabled\n");
3506 qlcnic_enable_msi_legacy(adapter);
3507 }
3508
3509 if (netif_running(netdev)) {
3510 err = qlcnic_attach(adapter);
3511 if (err)
3512 goto done;
3513 err = __qlcnic_up(adapter, netdev);
3514 if (err)
3515 goto done;
3516 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3517 }
3518 done:
3519 netif_device_attach(netdev);
3520 clear_bit(__QLCNIC_RESETTING, &adapter->state);
3521 return err;
3522}
3523
728a98b8
SC		 3524static int
3525qlcnic_validate_beacon(struct qlcnic_adapter *adapter, u16 beacon, u8 *state,
3526 u8 *rate)
3527{
3528 *rate = LSB(beacon);
3529 *state = MSB(beacon);
3530
3531 QLCDB(adapter, DRV, "rate %x state %x\n", *rate, *state);
3532
3533 if (!*state) {
3534 *rate = __QLCNIC_MAX_LED_RATE;
3535 return 0;
3536 } else if (*state > __QLCNIC_MAX_LED_STATE)
3537 return -EINVAL;
3538
3539 if ((!*rate) || (*rate > __QLCNIC_MAX_LED_RATE))
3540 return -EINVAL;
3541
3542 return 0;
3543}
3544
3545static ssize_t
3546qlcnic_store_beacon(struct device *dev,
3547 struct device_attribute *attr, const char *buf, size_t len)
3548{
3549 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3550 int max_sds_rings = adapter->max_sds_rings;
728a98b8
SC		 3551 u16 beacon;
3552 u8 b_state, b_rate;
3553 int err;
3554
10ee0fae
SC		 3555 if (adapter->op_mode == QLCNIC_NON_PRIV_FUNC) {
3556 dev_warn(dev, "LED test not supported for non "
3557 "privilege function\n");
3558 return -EOPNOTSUPP;
3559 }
3560
728a98b8
SC		 3561 if (len != sizeof(u16))
3562 return QL_STATUS_INVALID_PARAM;
3563
3564 memcpy(&beacon, buf, sizeof(u16));
3565 err = qlcnic_validate_beacon(adapter, beacon, &b_state, &b_rate);
3566 if (err)
3567 return err;
3568
3569 if (adapter->ahw->beacon_state == b_state)
3570 return len;
3571
10ee0fae
SC		 3572 rtnl_lock();
3573
728a98b8 3574 if (!adapter->ahw->beacon_state)
10ee0fae
SC		 3575 if (test_and_set_bit(__QLCNIC_LED_ENABLE, &adapter->state)) {
3576 rtnl_unlock();
728a98b8 3577 return -EBUSY;
10ee0fae
SC		 3578 }
3579
3580 if (test_bit(__QLCNIC_RESETTING, &adapter->state)) {
3581 err = -EIO;
3582 goto out;
3583 }
728a98b8
SC		 3584
3585 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
728a98b8 3586 err = qlcnic_diag_alloc_res(adapter->netdev, QLCNIC_LED_TEST);
10ee0fae
SC		 3587 if (err)
3588 goto out;
3589 set_bit(__QLCNIC_DIAG_RES_ALLOC, &adapter->state);
728a98b8
SC		 3590 }
3591
3592 err = qlcnic_config_led(adapter, b_state, b_rate);
3593
3594 if (!err) {
728a98b8 3595 err = len;
10ee0fae 3596 adapter->ahw->beacon_state = b_state;
728a98b8
SC		 3597 }
3598
10ee0fae 3599 if (test_and_clear_bit(__QLCNIC_DIAG_RES_ALLOC, &adapter->state))
728a98b8 3600 qlcnic_diag_free_res(adapter->netdev, max_sds_rings);
728a98b8 3601
10ee0fae
SC		 3602 out:
3603 if (!adapter->ahw->beacon_state)
728a98b8 3604 clear_bit(__QLCNIC_LED_ENABLE, &adapter->state);
10ee0fae 3605 rtnl_unlock();
728a98b8
SC		 3606
3607 return err;
3608}
3609
3610static ssize_t
3611qlcnic_show_beacon(struct device *dev,
3612 struct device_attribute *attr, char *buf)
3613{
3614 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3615
3616 return sprintf(buf, "%d\n", adapter->ahw->beacon_state);
3617}
3618
3619static struct device_attribute dev_attr_beacon = {
3620 .attr = {.name = "beacon", .mode = (S_IRUGO | S_IWUSR)},
3621 .show = qlcnic_show_beacon,
3622 .store = qlcnic_store_beacon,
3623};
3624
af19b491
AKS		 3625static int
3626qlcnic_sysfs_validate_crb(struct qlcnic_adapter *adapter,
3627 loff_t offset, size_t size)
3628{
897e8c7c
DP		 3629 size_t crb_size = 4;
3630
af19b491
AKS		 3631 if (!(adapter->flags & QLCNIC_DIAG_ENABLED))
3632 return -EIO;
3633
897e8c7c
DP		 3634 if (offset < QLCNIC_PCI_CRBSPACE) {
3635 if (ADDR_IN_RANGE(offset, QLCNIC_PCI_CAMQM,
3636 QLCNIC_PCI_CAMQM_END))
3637 crb_size = 8;
3638 else
3639 return -EINVAL;
3640 }
af19b491 3641
897e8c7c
DP		 3642 if ((size != crb_size) || (offset & (crb_size-1)))
3643 return -EINVAL;
af19b491
AKS		 3644
3645 return 0;
3646}
3647
3648static ssize_t
2c3c8bea
CW		 3649qlcnic_sysfs_read_crb(struct file *filp, struct kobject *kobj,
3650 struct bin_attribute *attr,
af19b491
AKS		 3651 char *buf, loff_t offset, size_t size)
3652{
3653 struct device *dev = container_of(kobj, struct device, kobj);
3654 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3655 u32 data;
897e8c7c 3656 u64 qmdata;
af19b491
AKS		 3657 int ret;
3658
3659 ret = qlcnic_sysfs_validate_crb(adapter, offset, size);
3660 if (ret != 0)
3661 return ret;
3662
897e8c7c
DP		 3663 if (ADDR_IN_RANGE(offset, QLCNIC_PCI_CAMQM, QLCNIC_PCI_CAMQM_END)) {
3664 qlcnic_pci_camqm_read_2M(adapter, offset, &qmdata);
3665 memcpy(buf, &qmdata, size);
3666 } else {
3667 data = QLCRD32(adapter, offset);
3668 memcpy(buf, &data, size);
3669 }
af19b491
AKS		 3670 return size;
3671}
3672
3673static ssize_t
2c3c8bea
CW		 3674qlcnic_sysfs_write_crb(struct file *filp, struct kobject *kobj,
3675 struct bin_attribute *attr,
af19b491
AKS		 3676 char *buf, loff_t offset, size_t size)
3677{
3678 struct device *dev = container_of(kobj, struct device, kobj);
3679 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3680 u32 data;
897e8c7c 3681 u64 qmdata;
af19b491
AKS		 3682 int ret;
3683
3684 ret = qlcnic_sysfs_validate_crb(adapter, offset, size);
3685 if (ret != 0)
3686 return ret;
3687
897e8c7c
DP		 3688 if (ADDR_IN_RANGE(offset, QLCNIC_PCI_CAMQM, QLCNIC_PCI_CAMQM_END)) {
3689 memcpy(&qmdata, buf, size);
3690 qlcnic_pci_camqm_write_2M(adapter, offset, qmdata);
3691 } else {
3692 memcpy(&data, buf, size);
3693 QLCWR32(adapter, offset, data);
3694 }
af19b491
AKS		 3695 return size;
3696}
3697
3698static int
3699qlcnic_sysfs_validate_mem(struct qlcnic_adapter *adapter,
3700 loff_t offset, size_t size)
3701{
3702 if (!(adapter->flags & QLCNIC_DIAG_ENABLED))
3703 return -EIO;
3704
3705 if ((size != 8) || (offset & 0x7))
3706 return -EIO;
3707
3708 return 0;
3709}
3710
3711static ssize_t
2c3c8bea
CW		 3712qlcnic_sysfs_read_mem(struct file *filp, struct kobject *kobj,
3713 struct bin_attribute *attr,
af19b491
AKS		 3714 char *buf, loff_t offset, size_t size)
3715{
3716 struct device *dev = container_of(kobj, struct device, kobj);
3717 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3718 u64 data;
3719 int ret;
3720
3721 ret = qlcnic_sysfs_validate_mem(adapter, offset, size);
3722 if (ret != 0)
3723 return ret;
3724
3725 if (qlcnic_pci_mem_read_2M(adapter, offset, &data))
3726 return -EIO;
3727
3728 memcpy(buf, &data, size);
3729
3730 return size;
3731}
3732
3733static ssize_t
2c3c8bea
CW		 3734qlcnic_sysfs_write_mem(struct file *filp, struct kobject *kobj,
3735 struct bin_attribute *attr,
af19b491
AKS		 3736 char *buf, loff_t offset, size_t size)
3737{
3738 struct device *dev = container_of(kobj, struct device, kobj);
3739 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3740 u64 data;
3741 int ret;
3742
3743 ret = qlcnic_sysfs_validate_mem(adapter, offset, size);
3744 if (ret != 0)
3745 return ret;
3746
3747 memcpy(&data, buf, size);
3748
3749 if (qlcnic_pci_mem_write_2M(adapter, offset, data))
3750 return -EIO;
3751
3752 return size;
3753}
3754
af19b491
AKS		 3755static struct bin_attribute bin_attr_crb = {
3756 .attr = {.name = "crb", .mode = (S_IRUGO | S_IWUSR)},
3757 .size = 0,
3758 .read = qlcnic_sysfs_read_crb,
3759 .write = qlcnic_sysfs_write_crb,
3760};
3761
3762static struct bin_attribute bin_attr_mem = {
3763 .attr = {.name = "mem", .mode = (S_IRUGO | S_IWUSR)},
3764 .size = 0,
3765 .read = qlcnic_sysfs_read_mem,
3766 .write = qlcnic_sysfs_write_mem,
3767};
3768
cea8975e 3769static int
346fe763
RB		 3770validate_pm_config(struct qlcnic_adapter *adapter,
3771 struct qlcnic_pm_func_cfg *pm_cfg, int count)
3772{
3773
3774 u8 src_pci_func, s_esw_id, d_esw_id;
3775 u8 dest_pci_func;
3776 int i;
3777
3778 for (i = 0; i < count; i++) {
3779 src_pci_func = pm_cfg[i].pci_func;
3780 dest_pci_func = pm_cfg[i].dest_npar;
3781 if (src_pci_func >= QLCNIC_MAX_PCI_FUNC
3782 || dest_pci_func >= QLCNIC_MAX_PCI_FUNC)
3783 return QL_STATUS_INVALID_PARAM;
3784
3785 if (adapter->npars[src_pci_func].type != QLCNIC_TYPE_NIC)
3786 return QL_STATUS_INVALID_PARAM;
3787
3788 if (adapter->npars[dest_pci_func].type != QLCNIC_TYPE_NIC)
3789 return QL_STATUS_INVALID_PARAM;
3790
346fe763
RB		 3791 s_esw_id = adapter->npars[src_pci_func].phy_port;
3792 d_esw_id = adapter->npars[dest_pci_func].phy_port;
3793
3794 if (s_esw_id != d_esw_id)
3795 return QL_STATUS_INVALID_PARAM;
3796
3797 }
3798 return 0;
3799
3800}
3801
3802static ssize_t
3803qlcnic_sysfs_write_pm_config(struct file *filp, struct kobject *kobj,
3804 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
3805{
3806 struct device *dev = container_of(kobj, struct device, kobj);
3807 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3808 struct qlcnic_pm_func_cfg *pm_cfg;
3809 u32 id, action, pci_func;
3810 int count, rem, i, ret;
3811
3812 count = size / sizeof(struct qlcnic_pm_func_cfg);
3813 rem = size % sizeof(struct qlcnic_pm_func_cfg);
3814 if (rem)
3815 return QL_STATUS_INVALID_PARAM;
3816
3817 pm_cfg = (struct qlcnic_pm_func_cfg *) buf;
3818
3819 ret = validate_pm_config(adapter, pm_cfg, count);
3820 if (ret)
3821 return ret;
3822 for (i = 0; i < count; i++) {
3823 pci_func = pm_cfg[i].pci_func;
4e8acb01 3824 action = !!pm_cfg[i].action;
346fe763
RB		 3825 id = adapter->npars[pci_func].phy_port;
3826 ret = qlcnic_config_port_mirroring(adapter, id,
3827 action, pci_func);
3828 if (ret)
3829 return ret;
3830 }
3831
3832 for (i = 0; i < count; i++) {
3833 pci_func = pm_cfg[i].pci_func;
3834 id = adapter->npars[pci_func].phy_port;
4e8acb01 3835 adapter->npars[pci_func].enable_pm = !!pm_cfg[i].action;
346fe763
RB		 3836 adapter->npars[pci_func].dest_npar = id;
3837 }
3838 return size;
3839}
3840
3841static ssize_t
3842qlcnic_sysfs_read_pm_config(struct file *filp, struct kobject *kobj,
3843 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
3844{
3845 struct device *dev = container_of(kobj, struct device, kobj);
3846 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3847 struct qlcnic_pm_func_cfg pm_cfg[QLCNIC_MAX_PCI_FUNC];
3848 int i;
3849
3850 if (size != sizeof(pm_cfg))
3851 return QL_STATUS_INVALID_PARAM;
3852
3853 for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
3854 if (adapter->npars[i].type != QLCNIC_TYPE_NIC)
3855 continue;
3856 pm_cfg[i].action = adapter->npars[i].enable_pm;
3857 pm_cfg[i].dest_npar = 0;
3858 pm_cfg[i].pci_func = i;
3859 }
3860 memcpy(buf, &pm_cfg, size);
3861
3862 return size;
3863}
3864
cea8975e 3865static int
346fe763 3866validate_esw_config(struct qlcnic_adapter *adapter,
4e8acb01 3867 struct qlcnic_esw_func_cfg *esw_cfg, int count)
346fe763 3868{
7613c87b 3869 u32 op_mode;
346fe763
RB		 3870 u8 pci_func;
3871 int i;
7613c87b 3872
b1fc6d3c 3873 op_mode = readl(adapter->ahw->pci_base0 + QLCNIC_DRV_OP_MODE);
7613c87b 3874
346fe763
RB		 3875 for (i = 0; i < count; i++) {
3876 pci_func = esw_cfg[i].pci_func;
3877 if (pci_func >= QLCNIC_MAX_PCI_FUNC)
3878 return QL_STATUS_INVALID_PARAM;
3879
4e8acb01
RB		 3880 if (adapter->op_mode == QLCNIC_MGMT_FUNC)
3881 if (adapter->npars[pci_func].type != QLCNIC_TYPE_NIC)
3882 return QL_STATUS_INVALID_PARAM;
346fe763 3883
4e8acb01
RB		 3884 switch (esw_cfg[i].op_mode) {
3885 case QLCNIC_PORT_DEFAULTS:
7613c87b 3886 if (QLC_DEV_GET_DRV(op_mode, pci_func) !=
7373373d 3887 QLCNIC_NON_PRIV_FUNC) {
091056b2
AKS		 3888 if (esw_cfg[i].mac_anti_spoof != 0)
3889 return QL_STATUS_INVALID_PARAM;
3890 if (esw_cfg[i].mac_override != 1)
3891 return QL_STATUS_INVALID_PARAM;
3892 if (esw_cfg[i].promisc_mode != 1)
3893 return QL_STATUS_INVALID_PARAM;
7373373d 3894 }
4e8acb01
RB		 3895 break;
3896 case QLCNIC_ADD_VLAN:
346fe763
RB		 3897 if (!IS_VALID_VLAN(esw_cfg[i].vlan_id))
3898 return QL_STATUS_INVALID_PARAM;
4e8acb01
RB		 3899 if (!esw_cfg[i].op_type)
3900 return QL_STATUS_INVALID_PARAM;
3901 break;
3902 case QLCNIC_DEL_VLAN:
4e8acb01
RB		 3903 if (!esw_cfg[i].op_type)
3904 return QL_STATUS_INVALID_PARAM;
3905 break;
3906 default:
346fe763 3907 return QL_STATUS_INVALID_PARAM;
4e8acb01 3908 }
346fe763 3909 }
346fe763
RB		 3910 return 0;
3911}
3912
3913static ssize_t
3914qlcnic_sysfs_write_esw_config(struct file *file, struct kobject *kobj,
3915 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
3916{
3917 struct device *dev = container_of(kobj, struct device, kobj);
3918 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3919 struct qlcnic_esw_func_cfg *esw_cfg;
4e8acb01 3920 struct qlcnic_npar_info *npar;
346fe763 3921 int count, rem, i, ret;
0325d69b 3922 u8 pci_func, op_mode = 0;
346fe763
RB		 3923
3924 count = size / sizeof(struct qlcnic_esw_func_cfg);
3925 rem = size % sizeof(struct qlcnic_esw_func_cfg);
3926 if (rem)
3927 return QL_STATUS_INVALID_PARAM;
3928
3929 esw_cfg = (struct qlcnic_esw_func_cfg *) buf;
3930 ret = validate_esw_config(adapter, esw_cfg, count);
3931 if (ret)
3932 return ret;
3933
3934 for (i = 0; i < count; i++) {
0325d69b
RB		 3935 if (adapter->op_mode == QLCNIC_MGMT_FUNC)
3936 if (qlcnic_config_switch_port(adapter, &esw_cfg[i]))
3937 return QL_STATUS_INVALID_PARAM;
e9a47700 3938
b1fc6d3c 3939 if (adapter->ahw->pci_func != esw_cfg[i].pci_func)
e9a47700
RB		 3940 continue;
3941
3942 op_mode = esw_cfg[i].op_mode;
3943 qlcnic_get_eswitch_port_config(adapter, &esw_cfg[i]);
3944 esw_cfg[i].op_mode = op_mode;
b1fc6d3c 3945 esw_cfg[i].pci_func = adapter->ahw->pci_func;
e9a47700
RB		 3946
3947 switch (esw_cfg[i].op_mode) {
3948 case QLCNIC_PORT_DEFAULTS:
3949 qlcnic_set_eswitch_port_features(adapter, &esw_cfg[i]);
3950 break;
8cf61f89
AKS		 3951 case QLCNIC_ADD_VLAN:
3952 qlcnic_set_vlan_config(adapter, &esw_cfg[i]);
3953 break;
3954 case QLCNIC_DEL_VLAN:
3955 esw_cfg[i].vlan_id = 0;
3956 qlcnic_set_vlan_config(adapter, &esw_cfg[i]);
3957 break;
0325d69b 3958 }
346fe763
RB		 3959 }
3960
0325d69b
RB		 3961 if (adapter->op_mode != QLCNIC_MGMT_FUNC)
3962 goto out;
e9a47700 3963
346fe763
RB		 3964 for (i = 0; i < count; i++) {
3965 pci_func = esw_cfg[i].pci_func;
4e8acb01
RB		 3966 npar = &adapter->npars[pci_func];
3967 switch (esw_cfg[i].op_mode) {
3968 case QLCNIC_PORT_DEFAULTS:
3969 npar->promisc_mode = esw_cfg[i].promisc_mode;
7373373d 3970 npar->mac_override = esw_cfg[i].mac_override;
4e8acb01
RB		 3971 npar->offload_flags = esw_cfg[i].offload_flags;
3972 npar->mac_anti_spoof = esw_cfg[i].mac_anti_spoof;
3973 npar->discard_tagged = esw_cfg[i].discard_tagged;
3974 break;
3975 case QLCNIC_ADD_VLAN:
3976 npar->pvid = esw_cfg[i].vlan_id;
3977 break;
3978 case QLCNIC_DEL_VLAN:
3979 npar->pvid = 0;
3980 break;
3981 }
346fe763 3982 }
0325d69b 3983out:
346fe763
RB		 3984 return size;
3985}
3986
3987static ssize_t
3988qlcnic_sysfs_read_esw_config(struct file *file, struct kobject *kobj,
3989 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
3990{
3991 struct device *dev = container_of(kobj, struct device, kobj);
3992 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
3993 struct qlcnic_esw_func_cfg esw_cfg[QLCNIC_MAX_PCI_FUNC];
4e8acb01 3994 u8 i;
346fe763
RB		 3995
3996 if (size != sizeof(esw_cfg))
3997 return QL_STATUS_INVALID_PARAM;
3998
3999 for (i = 0; i < QLCNIC_MAX_PCI_FUNC; i++) {
4000 if (adapter->npars[i].type != QLCNIC_TYPE_NIC)
4001 continue;
4e8acb01
RB		 4002 esw_cfg[i].pci_func = i;
4003 if (qlcnic_get_eswitch_port_config(adapter, &esw_cfg[i]))
4004 return QL_STATUS_INVALID_PARAM;
346fe763
RB		 4005 }
4006 memcpy(buf, &esw_cfg, size);
4007
4008 return size;
4009}
4010
cea8975e 4011static int
346fe763
RB		 4012validate_npar_config(struct qlcnic_adapter *adapter,
4013 struct qlcnic_npar_func_cfg *np_cfg, int count)
4014{
4015 u8 pci_func, i;
4016
4017 for (i = 0; i < count; i++) {
4018 pci_func = np_cfg[i].pci_func;
4019 if (pci_func >= QLCNIC_MAX_PCI_FUNC)
4020 return QL_STATUS_INVALID_PARAM;
4021
4022 if (adapter->npars[pci_func].type != QLCNIC_TYPE_NIC)
4023 return QL_STATUS_INVALID_PARAM;
4024
d12b0d9a
RB		 4025 if (!IS_VALID_BW(np_cfg[i].min_bw) ||
4026 !IS_VALID_BW(np_cfg[i].max_bw))
346fe763
RB		 4027 return QL_STATUS_INVALID_PARAM;
4028 }
4029 return 0;
4030}
4031
4032static ssize_t
4033qlcnic_sysfs_write_npar_config(struct file *file, struct kobject *kobj,
4034 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4035{
4036 struct device *dev = container_of(kobj, struct device, kobj);
4037 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4038 struct qlcnic_info nic_info;
4039 struct qlcnic_npar_func_cfg *np_cfg;
4040 int i, count, rem, ret;
4041 u8 pci_func;
4042
4043 count = size / sizeof(struct qlcnic_npar_func_cfg);
4044 rem = size % sizeof(struct qlcnic_npar_func_cfg);
4045 if (rem)
4046 return QL_STATUS_INVALID_PARAM;
4047
4048 np_cfg = (struct qlcnic_npar_func_cfg *) buf;
4049 ret = validate_npar_config(adapter, np_cfg, count);
4050 if (ret)
4051 return ret;
4052
4053 for (i = 0; i < count ; i++) {
4054 pci_func = np_cfg[i].pci_func;
4055 ret = qlcnic_get_nic_info(adapter, &nic_info, pci_func);
4056 if (ret)
4057 return ret;
4058 nic_info.pci_func = pci_func;
4059 nic_info.min_tx_bw = np_cfg[i].min_bw;
4060 nic_info.max_tx_bw = np_cfg[i].max_bw;
4061 ret = qlcnic_set_nic_info(adapter, &nic_info);
4062 if (ret)
4063 return ret;
cea8975e
AC		 4064 adapter->npars[i].min_bw = nic_info.min_tx_bw;
4065 adapter->npars[i].max_bw = nic_info.max_tx_bw;
346fe763
RB		 4066 }
4067
4068 return size;
4069
4070}
4071static ssize_t
4072qlcnic_sysfs_read_npar_config(struct file *file, struct kobject *kobj,
4073 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4074{
4075 struct device *dev = container_of(kobj, struct device, kobj);
4076 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4077 struct qlcnic_info nic_info;
4078 struct qlcnic_npar_func_cfg np_cfg[QLCNIC_MAX_PCI_FUNC];
4079 int i, ret;
4080
4081 if (size != sizeof(np_cfg))
4082 return QL_STATUS_INVALID_PARAM;
4083
4084 for (i = 0; i < QLCNIC_MAX_PCI_FUNC ; i++) {
4085 if (adapter->npars[i].type != QLCNIC_TYPE_NIC)
4086 continue;
4087 ret = qlcnic_get_nic_info(adapter, &nic_info, i);
4088 if (ret)
4089 return ret;
4090
4091 np_cfg[i].pci_func = i;
a1c0c459 4092 np_cfg[i].op_mode = (u8)nic_info.op_mode;
346fe763
RB		 4093 np_cfg[i].port_num = nic_info.phys_port;
4094 np_cfg[i].fw_capab = nic_info.capabilities;
4095 np_cfg[i].min_bw = nic_info.min_tx_bw ;
4096 np_cfg[i].max_bw = nic_info.max_tx_bw;
4097 np_cfg[i].max_tx_queues = nic_info.max_tx_ques;
4098 np_cfg[i].max_rx_queues = nic_info.max_rx_ques;
4099 }
4100 memcpy(buf, &np_cfg, size);
4101 return size;
4102}
4103
b6021212
AKS		 4104static ssize_t
4105qlcnic_sysfs_get_port_stats(struct file *file, struct kobject *kobj,
4106 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4107{
4108 struct device *dev = container_of(kobj, struct device, kobj);
4109 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4110 struct qlcnic_esw_statistics port_stats;
4111 int ret;
4112
4113 if (size != sizeof(struct qlcnic_esw_statistics))
4114 return QL_STATUS_INVALID_PARAM;
4115
4116 if (offset >= QLCNIC_MAX_PCI_FUNC)
4117 return QL_STATUS_INVALID_PARAM;
4118
4119 memset(&port_stats, 0, size);
4120 ret = qlcnic_get_port_stats(adapter, offset, QLCNIC_QUERY_RX_COUNTER,
4121 &port_stats.rx);
4122 if (ret)
4123 return ret;
4124
4125 ret = qlcnic_get_port_stats(adapter, offset, QLCNIC_QUERY_TX_COUNTER,
4126 &port_stats.tx);
4127 if (ret)
4128 return ret;
4129
4130 memcpy(buf, &port_stats, size);
4131 return size;
4132}
4133
4134static ssize_t
4135qlcnic_sysfs_get_esw_stats(struct file *file, struct kobject *kobj,
4136 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4137{
4138 struct device *dev = container_of(kobj, struct device, kobj);
4139 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4140 struct qlcnic_esw_statistics esw_stats;
4141 int ret;
4142
4143 if (size != sizeof(struct qlcnic_esw_statistics))
4144 return QL_STATUS_INVALID_PARAM;
4145
4146 if (offset >= QLCNIC_NIU_MAX_XG_PORTS)
4147 return QL_STATUS_INVALID_PARAM;
4148
4149 memset(&esw_stats, 0, size);
4150 ret = qlcnic_get_eswitch_stats(adapter, offset, QLCNIC_QUERY_RX_COUNTER,
4151 &esw_stats.rx);
4152 if (ret)
4153 return ret;
4154
4155 ret = qlcnic_get_eswitch_stats(adapter, offset, QLCNIC_QUERY_TX_COUNTER,
4156 &esw_stats.tx);
4157 if (ret)
4158 return ret;
4159
4160 memcpy(buf, &esw_stats, size);
4161 return size;
4162}
4163
4164static ssize_t
4165qlcnic_sysfs_clear_esw_stats(struct file *file, struct kobject *kobj,
4166 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4167{
4168 struct device *dev = container_of(kobj, struct device, kobj);
4169 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4170 int ret;
4171
4172 if (offset >= QLCNIC_NIU_MAX_XG_PORTS)
4173 return QL_STATUS_INVALID_PARAM;
4174
4175 ret = qlcnic_clear_esw_stats(adapter, QLCNIC_STATS_ESWITCH, offset,
4176 QLCNIC_QUERY_RX_COUNTER);
4177 if (ret)
4178 return ret;
4179
4180 ret = qlcnic_clear_esw_stats(adapter, QLCNIC_STATS_ESWITCH, offset,
4181 QLCNIC_QUERY_TX_COUNTER);
4182 if (ret)
4183 return ret;
4184
4185 return size;
4186}
4187
4188static ssize_t
4189qlcnic_sysfs_clear_port_stats(struct file *file, struct kobject *kobj,
4190 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4191{
4192
4193 struct device *dev = container_of(kobj, struct device, kobj);
4194 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4195 int ret;
4196
4197 if (offset >= QLCNIC_MAX_PCI_FUNC)
4198 return QL_STATUS_INVALID_PARAM;
4199
4200 ret = qlcnic_clear_esw_stats(adapter, QLCNIC_STATS_PORT, offset,
4201 QLCNIC_QUERY_RX_COUNTER);
4202 if (ret)
4203 return ret;
4204
4205 ret = qlcnic_clear_esw_stats(adapter, QLCNIC_STATS_PORT, offset,
4206 QLCNIC_QUERY_TX_COUNTER);
4207 if (ret)
4208 return ret;
4209
4210 return size;
4211}
4212
346fe763
RB		 4213static ssize_t
4214qlcnic_sysfs_read_pci_config(struct file *file, struct kobject *kobj,
4215 struct bin_attribute *attr, char *buf, loff_t offset, size_t size)
4216{
4217 struct device *dev = container_of(kobj, struct device, kobj);
4218 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
4219 struct qlcnic_pci_func_cfg pci_cfg[QLCNIC_MAX_PCI_FUNC];
e88db3bd 4220 struct qlcnic_pci_info *pci_info;
346fe763
RB		 4221 int i, ret;
4222
4223 if (size != sizeof(pci_cfg))
4224 return QL_STATUS_INVALID_PARAM;
4225
e88db3bd
DC		 4226 pci_info = kcalloc(QLCNIC_MAX_PCI_FUNC, sizeof(*pci_info), GFP_KERNEL);
4227 if (!pci_info)
4228 return -ENOMEM;
4229
346fe763 4230 ret = qlcnic_get_pci_info(adapter, pci_info);
e88db3bd
DC		 4231 if (ret) {
4232 kfree(pci_info);
346fe763 4233 return ret;
e88db3bd 4234 }
346fe763
RB		 4235
4236 for (i = 0; i < QLCNIC_MAX_PCI_FUNC ; i++) {
4237 pci_cfg[i].pci_func = pci_info[i].id;
4238 pci_cfg[i].func_type = pci_info[i].type;
4239 pci_cfg[i].port_num = pci_info[i].default_port;
4240 pci_cfg[i].min_bw = pci_info[i].tx_min_bw;
4241 pci_cfg[i].max_bw = pci_info[i].tx_max_bw;
4242 memcpy(&pci_cfg[i].def_mac_addr, &pci_info[i].mac, ETH_ALEN);
4243 }
4244 memcpy(buf, &pci_cfg, size);
e88db3bd 4245 kfree(pci_info);
346fe763 4246 return size;
346fe763
RB		 4247}
4248static struct bin_attribute bin_attr_npar_config = {
4249 .attr = {.name = "npar_config", .mode = (S_IRUGO | S_IWUSR)},
4250 .size = 0,
4251 .read = qlcnic_sysfs_read_npar_config,
4252 .write = qlcnic_sysfs_write_npar_config,
4253};
4254
4255static struct bin_attribute bin_attr_pci_config = {
4256 .attr = {.name = "pci_config", .mode = (S_IRUGO | S_IWUSR)},
4257 .size = 0,
4258 .read = qlcnic_sysfs_read_pci_config,
4259 .write = NULL,
4260};
4261
b6021212
AKS		 4262static struct bin_attribute bin_attr_port_stats = {
4263 .attr = {.name = "port_stats", .mode = (S_IRUGO | S_IWUSR)},
4264 .size = 0,
4265 .read = qlcnic_sysfs_get_port_stats,
4266 .write = qlcnic_sysfs_clear_port_stats,
4267};
4268
4269static struct bin_attribute bin_attr_esw_stats = {
4270 .attr = {.name = "esw_stats", .mode = (S_IRUGO | S_IWUSR)},
4271 .size = 0,
4272 .read = qlcnic_sysfs_get_esw_stats,
4273 .write = qlcnic_sysfs_clear_esw_stats,
4274};
4275
346fe763
RB		 4276static struct bin_attribute bin_attr_esw_config = {
4277 .attr = {.name = "esw_config", .mode = (S_IRUGO | S_IWUSR)},
4278 .size = 0,
4279 .read = qlcnic_sysfs_read_esw_config,
4280 .write = qlcnic_sysfs_write_esw_config,
4281};
4282
4283static struct bin_attribute bin_attr_pm_config = {
4284 .attr = {.name = "pm_config", .mode = (S_IRUGO | S_IWUSR)},
4285 .size = 0,
4286 .read = qlcnic_sysfs_read_pm_config,
4287 .write = qlcnic_sysfs_write_pm_config,
4288};
4289
af19b491
AKS		 4290static void
4291qlcnic_create_sysfs_entries(struct qlcnic_adapter *adapter)
4292{
4293 struct device *dev = &adapter->pdev->dev;
4294
4295 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG)
4296 if (device_create_file(dev, &dev_attr_bridged_mode))
4297 dev_warn(dev,
4298 "failed to create bridged_mode sysfs entry\n");
4299}
4300
4301static void
4302qlcnic_remove_sysfs_entries(struct qlcnic_adapter *adapter)
4303{
4304 struct device *dev = &adapter->pdev->dev;
4305
4306 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG)
4307 device_remove_file(dev, &dev_attr_bridged_mode);
4308}
4309
4310static void
4311qlcnic_create_diag_entries(struct qlcnic_adapter *adapter)
4312{
4313 struct device *dev = &adapter->pdev->dev;
b43e5ee7 4314 u32 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
af19b491 4315
b6021212
AKS		 4316 if (device_create_bin_file(dev, &bin_attr_port_stats))
4317 dev_info(dev, "failed to create port stats sysfs entry");
4318
132ff00a
AC		 4319 if (adapter->op_mode == QLCNIC_NON_PRIV_FUNC)
4320 return;
af19b491
AKS		 4321 if (device_create_file(dev, &dev_attr_diag_mode))
4322 dev_info(dev, "failed to create diag_mode sysfs entry\n");
4323 if (device_create_bin_file(dev, &bin_attr_crb))
4324 dev_info(dev, "failed to create crb sysfs entry\n");
4325 if (device_create_bin_file(dev, &bin_attr_mem))
4326 dev_info(dev, "failed to create mem sysfs entry\n");
b43e5ee7
SC		 4327
4328 if (state == QLCNIC_DEV_FAILED || (state == QLCNIC_DEV_BADBAD))
4329 return;
4330
53478fef
SC		 4331 if (device_create_bin_file(dev, &bin_attr_pci_config))
4332 dev_info(dev, "failed to create pci config sysfs entry");
b43e5ee7
SC		 4333 if (device_create_file(dev, &dev_attr_beacon))
4334 dev_info(dev, "failed to create beacon sysfs entry");
4335
4e8acb01
RB		 4336 if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED))
4337 return;
4338 if (device_create_bin_file(dev, &bin_attr_esw_config))
4339 dev_info(dev, "failed to create esw config sysfs entry");
4340 if (adapter->op_mode != QLCNIC_MGMT_FUNC)
346fe763 4341 return;
346fe763
RB		 4342 if (device_create_bin_file(dev, &bin_attr_npar_config))
4343 dev_info(dev, "failed to create npar config sysfs entry");
346fe763
RB		 4344 if (device_create_bin_file(dev, &bin_attr_pm_config))
4345 dev_info(dev, "failed to create pm config sysfs entry");
b6021212
AKS		 4346 if (device_create_bin_file(dev, &bin_attr_esw_stats))
4347 dev_info(dev, "failed to create eswitch stats sysfs entry");
af19b491
AKS		 4348}
4349
af19b491
AKS		 4350static void
4351qlcnic_remove_diag_entries(struct qlcnic_adapter *adapter)
4352{
4353 struct device *dev = &adapter->pdev->dev;
b43e5ee7 4354 u32 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
af19b491 4355
b6021212
AKS		 4356 device_remove_bin_file(dev, &bin_attr_port_stats);
4357
132ff00a
AC		 4358 if (adapter->op_mode == QLCNIC_NON_PRIV_FUNC)
4359 return;
af19b491
AKS		 4360 device_remove_file(dev, &dev_attr_diag_mode);
4361 device_remove_bin_file(dev, &bin_attr_crb);
4362 device_remove_bin_file(dev, &bin_attr_mem);
b43e5ee7
SC		 4363 if (state == QLCNIC_DEV_FAILED || (state == QLCNIC_DEV_BADBAD))
4364 return;
53478fef 4365 device_remove_bin_file(dev, &bin_attr_pci_config);
b43e5ee7 4366 device_remove_file(dev, &dev_attr_beacon);
4e8acb01
RB		 4367 if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED))
4368 return;
4369 device_remove_bin_file(dev, &bin_attr_esw_config);
4370 if (adapter->op_mode != QLCNIC_MGMT_FUNC)
346fe763 4371 return;
346fe763 4372 device_remove_bin_file(dev, &bin_attr_npar_config);
346fe763 4373 device_remove_bin_file(dev, &bin_attr_pm_config);
b6021212 4374 device_remove_bin_file(dev, &bin_attr_esw_stats);
af19b491
AKS		 4375}
4376
4377#ifdef CONFIG_INET
4378
4379#define is_qlcnic_netdev(dev) (dev->netdev_ops == &qlcnic_netdev_ops)
4380
af19b491 4381static void
aec1e845
AKS		 4382qlcnic_config_indev_addr(struct qlcnic_adapter *adapter,
4383 struct net_device *dev, unsigned long event)
af19b491
AKS		 4384{
4385 struct in_device *indev;
af19b491 4386
af19b491
AKS		 4387 indev = in_dev_get(dev);
4388 if (!indev)
4389 return;
4390
4391 for_ifa(indev) {
4392 switch (event) {
4393 case NETDEV_UP:
4394 qlcnic_config_ipaddr(adapter,
4395 ifa->ifa_address, QLCNIC_IP_UP);
4396 break;
4397 case NETDEV_DOWN:
4398 qlcnic_config_ipaddr(adapter,
4399 ifa->ifa_address, QLCNIC_IP_DOWN);
4400 break;
4401 default:
4402 break;
4403 }
4404 } endfor_ifa(indev);
4405
4406 in_dev_put(indev);
af19b491
AKS		 4407}
4408
aec1e845
AKS		 4409static void
4410qlcnic_restore_indev_addr(struct net_device *netdev, unsigned long event)
4411{
4412 struct qlcnic_adapter *adapter = netdev_priv(netdev);
4413 struct net_device *dev;
4414 u16 vid;
4415
4416 qlcnic_config_indev_addr(adapter, netdev, event);
4417
b9796a14 4418 for_each_set_bit(vid, adapter->vlans, VLAN_N_VID) {
223bb15e 4419 dev = __vlan_find_dev_deep(netdev, vid);
aec1e845
AKS		 4420 if (!dev)
4421 continue;
aec1e845
AKS		 4422 qlcnic_config_indev_addr(adapter, dev, event);
4423 }
4424}
4425
af19b491
AKS		 4426static int qlcnic_netdev_event(struct notifier_block *this,
4427 unsigned long event, void *ptr)
4428{
4429 struct qlcnic_adapter *adapter;
4430 struct net_device *dev = (struct net_device *)ptr;
4431
4432recheck:
4433 if (dev == NULL)
4434 goto done;
4435
4436 if (dev->priv_flags & IFF_802_1Q_VLAN) {
4437 dev = vlan_dev_real_dev(dev);
4438 goto recheck;
4439 }
4440
4441 if (!is_qlcnic_netdev(dev))
4442 goto done;
4443
4444 adapter = netdev_priv(dev);
4445
4446 if (!adapter)
4447 goto done;
4448
8a15ad1f 4449 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
af19b491
AKS		 4450 goto done;
4451
aec1e845 4452 qlcnic_config_indev_addr(adapter, dev, event);
af19b491
AKS		 4453done:
4454 return NOTIFY_DONE;
4455}
4456
4457static int
4458qlcnic_inetaddr_event(struct notifier_block *this,
4459 unsigned long event, void *ptr)
4460{
4461 struct qlcnic_adapter *adapter;
4462 struct net_device *dev;
4463
4464 struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;
4465
4466 dev = ifa->ifa_dev ? ifa->ifa_dev->dev : NULL;
4467
4468recheck:
aec1e845 4469 if (dev == NULL)
af19b491
AKS		 4470 goto done;
4471
4472 if (dev->priv_flags & IFF_802_1Q_VLAN) {
4473 dev = vlan_dev_real_dev(dev);
4474 goto recheck;
4475 }
4476
4477 if (!is_qlcnic_netdev(dev))
4478 goto done;
4479
4480 adapter = netdev_priv(dev);
4481
251a84c9 4482 if (!adapter)
af19b491
AKS		 4483 goto done;
4484
8a15ad1f 4485 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
af19b491
AKS		 4486 goto done;
4487
4488 switch (event) {
4489 case NETDEV_UP:
4490 qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_UP);
4491 break;
4492 case NETDEV_DOWN:
4493 qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_DOWN);
4494 break;
4495 default:
4496 break;
4497 }
4498
4499done:
4500 return NOTIFY_DONE;
4501}
4502
4503static struct notifier_block qlcnic_netdev_cb = {
4504 .notifier_call = qlcnic_netdev_event,
4505};
4506
4507static struct notifier_block qlcnic_inetaddr_cb = {
4508 .notifier_call = qlcnic_inetaddr_event,
4509};
4510#else
4511static void
aec1e845 4512qlcnic_restore_indev_addr(struct net_device *dev, unsigned long event)
af19b491
AKS		 4513{ }
4514#endif
451724c8
SC		 4515static struct pci_error_handlers qlcnic_err_handler = {
4516 .error_detected = qlcnic_io_error_detected,
4517 .slot_reset = qlcnic_io_slot_reset,
4518 .resume = qlcnic_io_resume,
4519};
af19b491
AKS		 4520
4521static struct pci_driver qlcnic_driver = {
4522 .name = qlcnic_driver_name,
4523 .id_table = qlcnic_pci_tbl,
4524 .probe = qlcnic_probe,
4525 .remove = __devexit_p(qlcnic_remove),
4526#ifdef CONFIG_PM
4527 .suspend = qlcnic_suspend,
4528 .resume = qlcnic_resume,
4529#endif
451724c8
SC		 4530 .shutdown = qlcnic_shutdown,
4531 .err_handler = &qlcnic_err_handler
4532
af19b491
AKS		 4533};
4534
4535static int __init qlcnic_init_module(void)
4536{
0cf3a14c 4537 int ret;
af19b491
AKS		 4538
4539 printk(KERN_INFO "%s\n", qlcnic_driver_string);
4540
f7ec804a
AKS		 4541 qlcnic_wq = create_singlethread_workqueue("qlcnic");
4542 if (qlcnic_wq == NULL) {
4543 printk(KERN_ERR "qlcnic: cannot create workqueue\n");
4544 return -ENOMEM;
4545 }
4546
af19b491
AKS		 4547#ifdef CONFIG_INET
4548 register_netdevice_notifier(&qlcnic_netdev_cb);
4549 register_inetaddr_notifier(&qlcnic_inetaddr_cb);
4550#endif
4551
0cf3a14c
AKS		 4552 ret = pci_register_driver(&qlcnic_driver);
4553 if (ret) {
4554#ifdef CONFIG_INET
4555 unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4556 unregister_netdevice_notifier(&qlcnic_netdev_cb);
4557#endif
f7ec804a 4558 destroy_workqueue(qlcnic_wq);
0cf3a14c 4559 }
af19b491 4560
0cf3a14c 4561 return ret;
af19b491
AKS		 4562}
4563
4564module_init(qlcnic_init_module);
4565
4566static void __exit qlcnic_exit_module(void)
4567{
4568
4569 pci_unregister_driver(&qlcnic_driver);
4570
4571#ifdef CONFIG_INET
4572 unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4573 unregister_netdevice_notifier(&qlcnic_netdev_cb);
4574#endif
f7ec804a 4575 destroy_workqueue(qlcnic_wq);
af19b491
AKS		 4576}
4577
4578module_exit(qlcnic_exit_module);
Linux kernel - Deliverables
This page took 0.635967 seconds and 5 git commands to generate.