8a2aeb85e32044aa00d32181e1eb65cf4a61657a
[deliverable/linux.git] / drivers / net / ethernet / qlogic / qlcnic / qlcnic_main.c
1 /*
2 * QLogic qlcnic NIC Driver
3 * Copyright (c) 2009-2013 QLogic Corporation
4 *
5 * See LICENSE.qlcnic for copyright and licensing details.
6 */
7
8 #include <linux/vmalloc.h>
9 #include <linux/interrupt.h>
10
11 #include "qlcnic.h"
12 #include "qlcnic_sriov.h"
13 #include "qlcnic_hw.h"
14
15 #include <linux/swab.h>
16 #include <linux/dma-mapping.h>
17 #include <linux/if_vlan.h>
18 #include <net/ip.h>
19 #include <linux/ipv6.h>
20 #include <linux/inetdevice.h>
21 #include <linux/aer.h>
22 #include <linux/log2.h>
23 #include <linux/pci.h>
24 #ifdef CONFIG_QLCNIC_VXLAN
25 #include <net/vxlan.h>
26 #endif
27
28 MODULE_DESCRIPTION("QLogic 1/10 GbE Converged/Intelligent Ethernet Driver");
29 MODULE_LICENSE("GPL");
30 MODULE_VERSION(QLCNIC_LINUX_VERSIONID);
31 MODULE_FIRMWARE(QLCNIC_UNIFIED_ROMIMAGE_NAME);
32
33 char qlcnic_driver_name[] = "qlcnic";
34 static const char qlcnic_driver_string[] = "QLogic 1/10 GbE "
35 "Converged/Intelligent Ethernet Driver v" QLCNIC_LINUX_VERSIONID;
36
37 static int qlcnic_mac_learn;
38 module_param(qlcnic_mac_learn, int, 0444);
39 MODULE_PARM_DESC(qlcnic_mac_learn,
40 "Mac Filter (0=learning is disabled, 1=Driver learning is enabled, 2=FDB learning is enabled)");
41
42 int qlcnic_use_msi = 1;
43 MODULE_PARM_DESC(use_msi, "MSI interrupt (0=disabled, 1=enabled)");
44 module_param_named(use_msi, qlcnic_use_msi, int, 0444);
45
46 int qlcnic_use_msi_x = 1;
47 MODULE_PARM_DESC(use_msi_x, "MSI-X interrupt (0=disabled, 1=enabled)");
48 module_param_named(use_msi_x, qlcnic_use_msi_x, int, 0444);
49
50 int qlcnic_auto_fw_reset = 1;
51 MODULE_PARM_DESC(auto_fw_reset, "Auto firmware reset (0=disabled, 1=enabled)");
52 module_param_named(auto_fw_reset, qlcnic_auto_fw_reset, int, 0644);
53
54 int qlcnic_load_fw_file;
55 MODULE_PARM_DESC(load_fw_file, "Load firmware from (0=flash, 1=file)");
56 module_param_named(load_fw_file, qlcnic_load_fw_file, int, 0444);
57
58 static int qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent);
59 static void qlcnic_remove(struct pci_dev *pdev);
60 static int qlcnic_open(struct net_device *netdev);
61 static int qlcnic_close(struct net_device *netdev);
62 static void qlcnic_tx_timeout(struct net_device *netdev);
63 static void qlcnic_attach_work(struct work_struct *work);
64 static void qlcnic_fwinit_work(struct work_struct *work);
65 #ifdef CONFIG_NET_POLL_CONTROLLER
66 static void qlcnic_poll_controller(struct net_device *netdev);
67 #endif
68
69 static void qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding);
70 static int qlcnic_can_start_firmware(struct qlcnic_adapter *adapter);
71
72 static irqreturn_t qlcnic_tmp_intr(int irq, void *data);
73 static irqreturn_t qlcnic_intr(int irq, void *data);
74 static irqreturn_t qlcnic_msi_intr(int irq, void *data);
75 static irqreturn_t qlcnic_msix_intr(int irq, void *data);
76 static irqreturn_t qlcnic_msix_tx_intr(int irq, void *data);
77
78 static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev);
79 static int qlcnic_start_firmware(struct qlcnic_adapter *);
80
81 static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter);
82 static void qlcnic_dev_set_npar_ready(struct qlcnic_adapter *);
83 static int qlcnicvf_start_firmware(struct qlcnic_adapter *);
84 static int qlcnic_vlan_rx_add(struct net_device *, __be16, u16);
85 static int qlcnic_vlan_rx_del(struct net_device *, __be16, u16);
86
87 static int qlcnic_82xx_setup_intr(struct qlcnic_adapter *);
88 static void qlcnic_82xx_dev_request_reset(struct qlcnic_adapter *, u32);
89 static irqreturn_t qlcnic_82xx_clear_legacy_intr(struct qlcnic_adapter *);
90 static pci_ers_result_t qlcnic_82xx_io_slot_reset(struct pci_dev *);
91 static int qlcnic_82xx_start_firmware(struct qlcnic_adapter *);
92 static void qlcnic_82xx_io_resume(struct pci_dev *);
93 static void qlcnic_82xx_set_mac_filter_count(struct qlcnic_adapter *);
94 static pci_ers_result_t qlcnic_82xx_io_error_detected(struct pci_dev *,
95 pci_channel_state_t);
96 static u32 qlcnic_vlan_tx_check(struct qlcnic_adapter *adapter)
97 {
98 struct qlcnic_hardware_context *ahw = adapter->ahw;
99
100 if (adapter->pdev->device == PCI_DEVICE_ID_QLOGIC_QLE824X)
101 return ahw->capabilities & QLCNIC_FW_CAPABILITY_FVLANTX;
102 else
103 return 1;
104 }
105
106 /* PCI Device ID Table */
107 #define ENTRY(device) \
108 {PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, (device)), \
109 .class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}
110
111 static DEFINE_PCI_DEVICE_TABLE(qlcnic_pci_tbl) = {
112 ENTRY(PCI_DEVICE_ID_QLOGIC_QLE824X),
113 ENTRY(PCI_DEVICE_ID_QLOGIC_QLE834X),
114 ENTRY(PCI_DEVICE_ID_QLOGIC_VF_QLE834X),
115 ENTRY(PCI_DEVICE_ID_QLOGIC_QLE844X),
116 ENTRY(PCI_DEVICE_ID_QLOGIC_VF_QLE844X),
117 {0,}
118 };
119
120 MODULE_DEVICE_TABLE(pci, qlcnic_pci_tbl);
121
122
123 inline void qlcnic_update_cmd_producer(struct qlcnic_host_tx_ring *tx_ring)
124 {
125 writel(tx_ring->producer, tx_ring->crb_cmd_producer);
126 }
127
128 static const u32 msi_tgt_status[8] = {
129 ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1,
130 ISR_INT_TARGET_STATUS_F2, ISR_INT_TARGET_STATUS_F3,
131 ISR_INT_TARGET_STATUS_F4, ISR_INT_TARGET_STATUS_F5,
132 ISR_INT_TARGET_STATUS_F6, ISR_INT_TARGET_STATUS_F7
133 };
134
135 static const u32 qlcnic_reg_tbl[] = {
136 0x1B20A8, /* PEG_HALT_STAT1 */
137 0x1B20AC, /* PEG_HALT_STAT2 */
138 0x1B20B0, /* FW_HEARTBEAT */
139 0x1B2100, /* LOCK ID */
140 0x1B2128, /* FW_CAPABILITIES */
141 0x1B2138, /* drv active */
142 0x1B2140, /* dev state */
143 0x1B2144, /* drv state */
144 0x1B2148, /* drv scratch */
145 0x1B214C, /* dev partition info */
146 0x1B2174, /* drv idc ver */
147 0x1B2150, /* fw version major */
148 0x1B2154, /* fw version minor */
149 0x1B2158, /* fw version sub */
150 0x1B219C, /* npar state */
151 0x1B21FC, /* FW_IMG_VALID */
152 0x1B2250, /* CMD_PEG_STATE */
153 0x1B233C, /* RCV_PEG_STATE */
154 0x1B23B4, /* ASIC TEMP */
155 0x1B216C, /* FW api */
156 0x1B2170, /* drv op mode */
157 0x13C010, /* flash lock */
158 0x13C014, /* flash unlock */
159 };
160
161 static const struct qlcnic_board_info qlcnic_boards[] = {
162 { PCI_VENDOR_ID_QLOGIC,
163 PCI_DEVICE_ID_QLOGIC_QLE844X,
164 0x0,
165 0x0,
166 "8400 series 10GbE Converged Network Adapter (TCP/IP Networking)" },
167 { PCI_VENDOR_ID_QLOGIC,
168 PCI_DEVICE_ID_QLOGIC_QLE834X,
169 PCI_VENDOR_ID_QLOGIC,
170 0x24e,
171 "8300 Series Dual Port 10GbE Converged Network Adapter "
172 "(TCP/IP Networking)" },
173 { PCI_VENDOR_ID_QLOGIC,
174 PCI_DEVICE_ID_QLOGIC_QLE834X,
175 PCI_VENDOR_ID_QLOGIC,
176 0x243,
177 "8300 Series Single Port 10GbE Converged Network Adapter "
178 "(TCP/IP Networking)" },
179 { PCI_VENDOR_ID_QLOGIC,
180 PCI_DEVICE_ID_QLOGIC_QLE834X,
181 PCI_VENDOR_ID_QLOGIC,
182 0x24a,
183 "8300 Series Dual Port 10GbE Converged Network Adapter "
184 "(TCP/IP Networking)" },
185 { PCI_VENDOR_ID_QLOGIC,
186 PCI_DEVICE_ID_QLOGIC_QLE834X,
187 PCI_VENDOR_ID_QLOGIC,
188 0x246,
189 "8300 Series Dual Port 10GbE Converged Network Adapter "
190 "(TCP/IP Networking)" },
191 { PCI_VENDOR_ID_QLOGIC,
192 PCI_DEVICE_ID_QLOGIC_QLE834X,
193 PCI_VENDOR_ID_QLOGIC,
194 0x252,
195 "8300 Series Dual Port 10GbE Converged Network Adapter "
196 "(TCP/IP Networking)" },
197 { PCI_VENDOR_ID_QLOGIC,
198 PCI_DEVICE_ID_QLOGIC_QLE834X,
199 PCI_VENDOR_ID_QLOGIC,
200 0x26e,
201 "8300 Series Dual Port 10GbE Converged Network Adapter "
202 "(TCP/IP Networking)" },
203 { PCI_VENDOR_ID_QLOGIC,
204 PCI_DEVICE_ID_QLOGIC_QLE834X,
205 PCI_VENDOR_ID_QLOGIC,
206 0x260,
207 "8300 Series Dual Port 10GbE Converged Network Adapter "
208 "(TCP/IP Networking)" },
209 { PCI_VENDOR_ID_QLOGIC,
210 PCI_DEVICE_ID_QLOGIC_QLE834X,
211 PCI_VENDOR_ID_QLOGIC,
212 0x266,
213 "8300 Series Single Port 10GbE Converged Network Adapter "
214 "(TCP/IP Networking)" },
215 { PCI_VENDOR_ID_QLOGIC,
216 PCI_DEVICE_ID_QLOGIC_QLE834X,
217 PCI_VENDOR_ID_QLOGIC,
218 0x269,
219 "8300 Series Dual Port 10GbE Converged Network Adapter "
220 "(TCP/IP Networking)" },
221 { PCI_VENDOR_ID_QLOGIC,
222 PCI_DEVICE_ID_QLOGIC_QLE834X,
223 PCI_VENDOR_ID_QLOGIC,
224 0x271,
225 "8300 Series Dual Port 10GbE Converged Network Adapter "
226 "(TCP/IP Networking)" },
227 { PCI_VENDOR_ID_QLOGIC,
228 PCI_DEVICE_ID_QLOGIC_QLE834X,
229 0x0, 0x0, "8300 Series 1/10GbE Controller" },
230 { PCI_VENDOR_ID_QLOGIC,
231 PCI_DEVICE_ID_QLOGIC_QLE824X,
232 PCI_VENDOR_ID_QLOGIC,
233 0x203,
234 "8200 Series Single Port 10GbE Converged Network Adapter"
235 "(TCP/IP Networking)" },
236 { PCI_VENDOR_ID_QLOGIC,
237 PCI_DEVICE_ID_QLOGIC_QLE824X,
238 PCI_VENDOR_ID_QLOGIC,
239 0x207,
240 "8200 Series Dual Port 10GbE Converged Network Adapter"
241 "(TCP/IP Networking)" },
242 { PCI_VENDOR_ID_QLOGIC,
243 PCI_DEVICE_ID_QLOGIC_QLE824X,
244 PCI_VENDOR_ID_QLOGIC,
245 0x20b,
246 "3200 Series Dual Port 10Gb Intelligent Ethernet Adapter" },
247 { PCI_VENDOR_ID_QLOGIC,
248 PCI_DEVICE_ID_QLOGIC_QLE824X,
249 PCI_VENDOR_ID_QLOGIC,
250 0x20c,
251 "3200 Series Quad Port 1Gb Intelligent Ethernet Adapter" },
252 { PCI_VENDOR_ID_QLOGIC,
253 PCI_DEVICE_ID_QLOGIC_QLE824X,
254 PCI_VENDOR_ID_QLOGIC,
255 0x20f,
256 "3200 Series Single Port 10Gb Intelligent Ethernet Adapter" },
257 { PCI_VENDOR_ID_QLOGIC,
258 PCI_DEVICE_ID_QLOGIC_QLE824X,
259 0x103c, 0x3733,
260 "NC523SFP 10Gb 2-port Server Adapter" },
261 { PCI_VENDOR_ID_QLOGIC,
262 PCI_DEVICE_ID_QLOGIC_QLE824X,
263 0x103c, 0x3346,
264 "CN1000Q Dual Port Converged Network Adapter" },
265 { PCI_VENDOR_ID_QLOGIC,
266 PCI_DEVICE_ID_QLOGIC_QLE824X,
267 PCI_VENDOR_ID_QLOGIC,
268 0x210,
269 "QME8242-k 10GbE Dual Port Mezzanine Card" },
270 { PCI_VENDOR_ID_QLOGIC,
271 PCI_DEVICE_ID_QLOGIC_QLE824X,
272 0x0, 0x0, "cLOM8214 1/10GbE Controller" },
273 };
274
275 #define NUM_SUPPORTED_BOARDS ARRAY_SIZE(qlcnic_boards)
276
277 static const
278 struct qlcnic_legacy_intr_set legacy_intr[] = QLCNIC_LEGACY_INTR_CONFIG;
279
280 int qlcnic_alloc_sds_rings(struct qlcnic_recv_context *recv_ctx, int count)
281 {
282 int size = sizeof(struct qlcnic_host_sds_ring) * count;
283
284 recv_ctx->sds_rings = kzalloc(size, GFP_KERNEL);
285
286 return recv_ctx->sds_rings == NULL;
287 }
288
289 void qlcnic_free_sds_rings(struct qlcnic_recv_context *recv_ctx)
290 {
291 if (recv_ctx->sds_rings != NULL)
292 kfree(recv_ctx->sds_rings);
293
294 recv_ctx->sds_rings = NULL;
295 }
296
297 int qlcnic_read_mac_addr(struct qlcnic_adapter *adapter)
298 {
299 struct net_device *netdev = adapter->netdev;
300 struct pci_dev *pdev = adapter->pdev;
301 u8 mac_addr[ETH_ALEN];
302 int ret;
303
304 ret = qlcnic_get_mac_address(adapter, mac_addr,
305 adapter->ahw->pci_func);
306 if (ret)
307 return ret;
308
309 memcpy(netdev->dev_addr, mac_addr, ETH_ALEN);
310 memcpy(adapter->mac_addr, netdev->dev_addr, netdev->addr_len);
311
312 /* set station address */
313
314 if (!is_valid_ether_addr(netdev->dev_addr))
315 dev_warn(&pdev->dev, "Bad MAC address %pM.\n",
316 netdev->dev_addr);
317
318 return 0;
319 }
320
321 static void qlcnic_delete_adapter_mac(struct qlcnic_adapter *adapter)
322 {
323 struct qlcnic_mac_vlan_list *cur;
324 struct list_head *head;
325
326 list_for_each(head, &adapter->mac_list) {
327 cur = list_entry(head, struct qlcnic_mac_vlan_list, list);
328 if (ether_addr_equal_unaligned(adapter->mac_addr, cur->mac_addr)) {
329 qlcnic_sre_macaddr_change(adapter, cur->mac_addr,
330 0, QLCNIC_MAC_DEL);
331 list_del(&cur->list);
332 kfree(cur);
333 return;
334 }
335 }
336 }
337
338 static int qlcnic_set_mac(struct net_device *netdev, void *p)
339 {
340 struct qlcnic_adapter *adapter = netdev_priv(netdev);
341 struct sockaddr *addr = p;
342
343 if (qlcnic_sriov_vf_check(adapter))
344 return -EINVAL;
345
346 if ((adapter->flags & QLCNIC_MAC_OVERRIDE_DISABLED))
347 return -EOPNOTSUPP;
348
349 if (!is_valid_ether_addr(addr->sa_data))
350 return -EINVAL;
351
352 if (ether_addr_equal_unaligned(adapter->mac_addr, addr->sa_data))
353 return 0;
354
355 if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
356 netif_device_detach(netdev);
357 qlcnic_napi_disable(adapter);
358 }
359
360 qlcnic_delete_adapter_mac(adapter);
361 memcpy(adapter->mac_addr, addr->sa_data, netdev->addr_len);
362 memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
363 qlcnic_set_multi(adapter->netdev);
364
365 if (test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
366 netif_device_attach(netdev);
367 qlcnic_napi_enable(adapter);
368 }
369 return 0;
370 }
371
372 static int qlcnic_fdb_del(struct ndmsg *ndm, struct nlattr *tb[],
373 struct net_device *netdev, const unsigned char *addr)
374 {
375 struct qlcnic_adapter *adapter = netdev_priv(netdev);
376 int err = -EOPNOTSUPP;
377
378 if (!adapter->fdb_mac_learn)
379 return ndo_dflt_fdb_del(ndm, tb, netdev, addr);
380
381 if ((adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
382 qlcnic_sriov_check(adapter)) {
383 if (is_unicast_ether_addr(addr)) {
384 err = dev_uc_del(netdev, addr);
385 if (!err)
386 err = qlcnic_nic_del_mac(adapter, addr);
387 } else if (is_multicast_ether_addr(addr)) {
388 err = dev_mc_del(netdev, addr);
389 } else {
390 err = -EINVAL;
391 }
392 }
393 return err;
394 }
395
396 static int qlcnic_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
397 struct net_device *netdev,
398 const unsigned char *addr, u16 flags)
399 {
400 struct qlcnic_adapter *adapter = netdev_priv(netdev);
401 int err = 0;
402
403 if (!adapter->fdb_mac_learn)
404 return ndo_dflt_fdb_add(ndm, tb, netdev, addr, flags);
405
406 if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) &&
407 !qlcnic_sriov_check(adapter)) {
408 pr_info("%s: FDB e-switch is not enabled\n", __func__);
409 return -EOPNOTSUPP;
410 }
411
412 if (ether_addr_equal(addr, adapter->mac_addr))
413 return err;
414
415 if (is_unicast_ether_addr(addr)) {
416 if (netdev_uc_count(netdev) < adapter->ahw->max_uc_count)
417 err = dev_uc_add_excl(netdev, addr);
418 else
419 err = -ENOMEM;
420 } else if (is_multicast_ether_addr(addr)) {
421 err = dev_mc_add_excl(netdev, addr);
422 } else {
423 err = -EINVAL;
424 }
425
426 return err;
427 }
428
429 static int qlcnic_fdb_dump(struct sk_buff *skb, struct netlink_callback *ncb,
430 struct net_device *netdev, int idx)
431 {
432 struct qlcnic_adapter *adapter = netdev_priv(netdev);
433
434 if (!adapter->fdb_mac_learn)
435 return ndo_dflt_fdb_dump(skb, ncb, netdev, idx);
436
437 if ((adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
438 qlcnic_sriov_check(adapter))
439 idx = ndo_dflt_fdb_dump(skb, ncb, netdev, idx);
440
441 return idx;
442 }
443
444 static void qlcnic_82xx_cancel_idc_work(struct qlcnic_adapter *adapter)
445 {
446 while (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
447 usleep_range(10000, 11000);
448
449 if (!adapter->fw_work.work.func)
450 return;
451
452 cancel_delayed_work_sync(&adapter->fw_work);
453 }
454
455 static int qlcnic_get_phys_port_id(struct net_device *netdev,
456 struct netdev_phys_port_id *ppid)
457 {
458 struct qlcnic_adapter *adapter = netdev_priv(netdev);
459 struct qlcnic_hardware_context *ahw = adapter->ahw;
460
461 if (!(adapter->flags & QLCNIC_HAS_PHYS_PORT_ID))
462 return -EOPNOTSUPP;
463
464 ppid->id_len = sizeof(ahw->phys_port_id);
465 memcpy(ppid->id, ahw->phys_port_id, ppid->id_len);
466
467 return 0;
468 }
469
470 #ifdef CONFIG_QLCNIC_VXLAN
471 static void qlcnic_add_vxlan_port(struct net_device *netdev,
472 sa_family_t sa_family, __be16 port)
473 {
474 struct qlcnic_adapter *adapter = netdev_priv(netdev);
475 struct qlcnic_hardware_context *ahw = adapter->ahw;
476
477 /* Adapter supports only one VXLAN port. Use very first port
478 * for enabling offload
479 */
480 if (!qlcnic_encap_rx_offload(adapter) || ahw->vxlan_port)
481 return;
482
483 ahw->vxlan_port = ntohs(port);
484 adapter->flags |= QLCNIC_ADD_VXLAN_PORT;
485 }
486
487 static void qlcnic_del_vxlan_port(struct net_device *netdev,
488 sa_family_t sa_family, __be16 port)
489 {
490 struct qlcnic_adapter *adapter = netdev_priv(netdev);
491 struct qlcnic_hardware_context *ahw = adapter->ahw;
492
493 if (!qlcnic_encap_rx_offload(adapter) || !ahw->vxlan_port ||
494 (ahw->vxlan_port != ntohs(port)))
495 return;
496
497 adapter->flags |= QLCNIC_DEL_VXLAN_PORT;
498 }
499 #endif
500
501 static const struct net_device_ops qlcnic_netdev_ops = {
502 .ndo_open = qlcnic_open,
503 .ndo_stop = qlcnic_close,
504 .ndo_start_xmit = qlcnic_xmit_frame,
505 .ndo_get_stats = qlcnic_get_stats,
506 .ndo_validate_addr = eth_validate_addr,
507 .ndo_set_rx_mode = qlcnic_set_multi,
508 .ndo_set_mac_address = qlcnic_set_mac,
509 .ndo_change_mtu = qlcnic_change_mtu,
510 .ndo_fix_features = qlcnic_fix_features,
511 .ndo_set_features = qlcnic_set_features,
512 .ndo_tx_timeout = qlcnic_tx_timeout,
513 .ndo_vlan_rx_add_vid = qlcnic_vlan_rx_add,
514 .ndo_vlan_rx_kill_vid = qlcnic_vlan_rx_del,
515 .ndo_fdb_add = qlcnic_fdb_add,
516 .ndo_fdb_del = qlcnic_fdb_del,
517 .ndo_fdb_dump = qlcnic_fdb_dump,
518 .ndo_get_phys_port_id = qlcnic_get_phys_port_id,
519 #ifdef CONFIG_QLCNIC_VXLAN
520 .ndo_add_vxlan_port = qlcnic_add_vxlan_port,
521 .ndo_del_vxlan_port = qlcnic_del_vxlan_port,
522 #endif
523 #ifdef CONFIG_NET_POLL_CONTROLLER
524 .ndo_poll_controller = qlcnic_poll_controller,
525 #endif
526 #ifdef CONFIG_QLCNIC_SRIOV
527 .ndo_set_vf_mac = qlcnic_sriov_set_vf_mac,
528 .ndo_set_vf_tx_rate = qlcnic_sriov_set_vf_tx_rate,
529 .ndo_get_vf_config = qlcnic_sriov_get_vf_config,
530 .ndo_set_vf_vlan = qlcnic_sriov_set_vf_vlan,
531 .ndo_set_vf_spoofchk = qlcnic_sriov_set_vf_spoofchk,
532 #endif
533 };
534
535 static const struct net_device_ops qlcnic_netdev_failed_ops = {
536 .ndo_open = qlcnic_open,
537 };
538
539 static struct qlcnic_nic_template qlcnic_ops = {
540 .config_bridged_mode = qlcnic_config_bridged_mode,
541 .config_led = qlcnic_82xx_config_led,
542 .start_firmware = qlcnic_82xx_start_firmware,
543 .request_reset = qlcnic_82xx_dev_request_reset,
544 .cancel_idc_work = qlcnic_82xx_cancel_idc_work,
545 .napi_add = qlcnic_82xx_napi_add,
546 .napi_del = qlcnic_82xx_napi_del,
547 .config_ipaddr = qlcnic_82xx_config_ipaddr,
548 .shutdown = qlcnic_82xx_shutdown,
549 .resume = qlcnic_82xx_resume,
550 .clear_legacy_intr = qlcnic_82xx_clear_legacy_intr,
551 };
552
553 struct qlcnic_nic_template qlcnic_vf_ops = {
554 .config_bridged_mode = qlcnicvf_config_bridged_mode,
555 .config_led = qlcnicvf_config_led,
556 .start_firmware = qlcnicvf_start_firmware
557 };
558
559 static struct qlcnic_hardware_ops qlcnic_hw_ops = {
560 .read_crb = qlcnic_82xx_read_crb,
561 .write_crb = qlcnic_82xx_write_crb,
562 .read_reg = qlcnic_82xx_hw_read_wx_2M,
563 .write_reg = qlcnic_82xx_hw_write_wx_2M,
564 .get_mac_address = qlcnic_82xx_get_mac_address,
565 .setup_intr = qlcnic_82xx_setup_intr,
566 .alloc_mbx_args = qlcnic_82xx_alloc_mbx_args,
567 .mbx_cmd = qlcnic_82xx_issue_cmd,
568 .get_func_no = qlcnic_82xx_get_func_no,
569 .api_lock = qlcnic_82xx_api_lock,
570 .api_unlock = qlcnic_82xx_api_unlock,
571 .add_sysfs = qlcnic_82xx_add_sysfs,
572 .remove_sysfs = qlcnic_82xx_remove_sysfs,
573 .process_lb_rcv_ring_diag = qlcnic_82xx_process_rcv_ring_diag,
574 .create_rx_ctx = qlcnic_82xx_fw_cmd_create_rx_ctx,
575 .create_tx_ctx = qlcnic_82xx_fw_cmd_create_tx_ctx,
576 .del_rx_ctx = qlcnic_82xx_fw_cmd_del_rx_ctx,
577 .del_tx_ctx = qlcnic_82xx_fw_cmd_del_tx_ctx,
578 .setup_link_event = qlcnic_82xx_linkevent_request,
579 .get_nic_info = qlcnic_82xx_get_nic_info,
580 .get_pci_info = qlcnic_82xx_get_pci_info,
581 .set_nic_info = qlcnic_82xx_set_nic_info,
582 .change_macvlan = qlcnic_82xx_sre_macaddr_change,
583 .napi_enable = qlcnic_82xx_napi_enable,
584 .napi_disable = qlcnic_82xx_napi_disable,
585 .config_intr_coal = qlcnic_82xx_config_intr_coalesce,
586 .config_rss = qlcnic_82xx_config_rss,
587 .config_hw_lro = qlcnic_82xx_config_hw_lro,
588 .config_loopback = qlcnic_82xx_set_lb_mode,
589 .clear_loopback = qlcnic_82xx_clear_lb_mode,
590 .config_promisc_mode = qlcnic_82xx_nic_set_promisc,
591 .change_l2_filter = qlcnic_82xx_change_filter,
592 .get_board_info = qlcnic_82xx_get_board_info,
593 .set_mac_filter_count = qlcnic_82xx_set_mac_filter_count,
594 .free_mac_list = qlcnic_82xx_free_mac_list,
595 .read_phys_port_id = qlcnic_82xx_read_phys_port_id,
596 .io_error_detected = qlcnic_82xx_io_error_detected,
597 .io_slot_reset = qlcnic_82xx_io_slot_reset,
598 .io_resume = qlcnic_82xx_io_resume,
599 .get_beacon_state = qlcnic_82xx_get_beacon_state,
600 .enable_sds_intr = qlcnic_82xx_enable_sds_intr,
601 .disable_sds_intr = qlcnic_82xx_disable_sds_intr,
602 .enable_tx_intr = qlcnic_82xx_enable_tx_intr,
603 .disable_tx_intr = qlcnic_82xx_disable_tx_intr,
604 .get_saved_state = qlcnic_82xx_get_saved_state,
605 .set_saved_state = qlcnic_82xx_set_saved_state,
606 .cache_tmpl_hdr_values = qlcnic_82xx_cache_tmpl_hdr_values,
607 .get_cap_size = qlcnic_82xx_get_cap_size,
608 .set_sys_info = qlcnic_82xx_set_sys_info,
609 .store_cap_mask = qlcnic_82xx_store_cap_mask,
610 };
611
612 static int qlcnic_check_multi_tx_capability(struct qlcnic_adapter *adapter)
613 {
614 struct qlcnic_hardware_context *ahw = adapter->ahw;
615
616 if (qlcnic_82xx_check(adapter) &&
617 (ahw->extra_capability[0] & QLCNIC_FW_CAPABILITY_2_MULTI_TX)) {
618 test_and_set_bit(__QLCNIC_MULTI_TX_UNIQUE, &adapter->state);
619 return 0;
620 } else {
621 return 1;
622 }
623 }
624
625 static int qlcnic_max_rings(struct qlcnic_adapter *adapter, u8 ring_cnt,
626 int queue_type)
627 {
628 int num_rings, max_rings = QLCNIC_MAX_SDS_RINGS;
629
630 if (queue_type == QLCNIC_RX_QUEUE)
631 max_rings = adapter->max_sds_rings;
632 else if (queue_type == QLCNIC_TX_QUEUE)
633 max_rings = adapter->max_tx_rings;
634
635 num_rings = rounddown_pow_of_two(min_t(int, num_online_cpus(),
636 max_rings));
637
638 if (ring_cnt > num_rings)
639 return num_rings;
640 else
641 return ring_cnt;
642 }
643
644 void qlcnic_set_tx_ring_count(struct qlcnic_adapter *adapter, u8 tx_cnt)
645 {
646 /* 83xx adapter does not have max_tx_rings intialized in probe */
647 if (adapter->max_tx_rings)
648 adapter->drv_tx_rings = qlcnic_max_rings(adapter, tx_cnt,
649 QLCNIC_TX_QUEUE);
650 else
651 adapter->drv_tx_rings = tx_cnt;
652 }
653
654 void qlcnic_set_sds_ring_count(struct qlcnic_adapter *adapter, u8 rx_cnt)
655 {
656 /* 83xx adapter does not have max_sds_rings intialized in probe */
657 if (adapter->max_sds_rings)
658 adapter->drv_sds_rings = qlcnic_max_rings(adapter, rx_cnt,
659 QLCNIC_RX_QUEUE);
660 else
661 adapter->drv_sds_rings = rx_cnt;
662 }
663
664 int qlcnic_setup_tss_rss_intr(struct qlcnic_adapter *adapter)
665 {
666 struct pci_dev *pdev = adapter->pdev;
667 int num_msix = 0, err = 0, vector;
668
669 adapter->flags &= ~QLCNIC_TSS_RSS;
670
671 if (adapter->drv_tss_rings > 0)
672 num_msix += adapter->drv_tss_rings;
673 else
674 num_msix += adapter->drv_tx_rings;
675
676 if (adapter->drv_rss_rings > 0)
677 num_msix += adapter->drv_rss_rings;
678 else
679 num_msix += adapter->drv_sds_rings;
680
681 if (qlcnic_83xx_check(adapter))
682 num_msix += 1;
683
684 if (!adapter->msix_entries) {
685 adapter->msix_entries = kcalloc(num_msix,
686 sizeof(struct msix_entry),
687 GFP_KERNEL);
688 if (!adapter->msix_entries)
689 return -ENOMEM;
690 }
691
692 for (vector = 0; vector < num_msix; vector++)
693 adapter->msix_entries[vector].entry = vector;
694
695 restore:
696 err = pci_enable_msix_exact(pdev, adapter->msix_entries, num_msix);
697 if (err == -ENOSPC) {
698 if (!adapter->drv_tss_rings && !adapter->drv_rss_rings)
699 return err;
700
701 netdev_info(adapter->netdev,
702 "Unable to allocate %d MSI-X vectors, Available vectors %d\n",
703 num_msix, err);
704
705 num_msix = adapter->drv_tx_rings + adapter->drv_sds_rings;
706
707 /* Set rings to 0 so we can restore original TSS/RSS count */
708 adapter->drv_tss_rings = 0;
709 adapter->drv_rss_rings = 0;
710
711 if (qlcnic_83xx_check(adapter))
712 num_msix += 1;
713
714 netdev_info(adapter->netdev,
715 "Restoring %d Tx, %d SDS rings for total %d vectors.\n",
716 adapter->drv_tx_rings, adapter->drv_sds_rings,
717 num_msix);
718
719 goto restore;
720 } else if (err < 0) {
721 return err;
722 }
723
724 adapter->ahw->num_msix = num_msix;
725 if (adapter->drv_tss_rings > 0)
726 adapter->drv_tx_rings = adapter->drv_tss_rings;
727
728 if (adapter->drv_rss_rings > 0)
729 adapter->drv_sds_rings = adapter->drv_rss_rings;
730
731 return 0;
732 }
733
734 int qlcnic_enable_msix(struct qlcnic_adapter *adapter, u32 num_msix)
735 {
736 struct pci_dev *pdev = adapter->pdev;
737 int err, vector;
738
739 if (!adapter->msix_entries) {
740 adapter->msix_entries = kcalloc(num_msix,
741 sizeof(struct msix_entry),
742 GFP_KERNEL);
743 if (!adapter->msix_entries)
744 return -ENOMEM;
745 }
746
747 adapter->flags &= ~(QLCNIC_MSI_ENABLED | QLCNIC_MSIX_ENABLED);
748
749 if (adapter->ahw->msix_supported) {
750 enable_msix:
751 for (vector = 0; vector < num_msix; vector++)
752 adapter->msix_entries[vector].entry = vector;
753
754 err = pci_enable_msix_range(pdev,
755 adapter->msix_entries, 1, num_msix);
756
757 if (err == num_msix) {
758 adapter->flags |= QLCNIC_MSIX_ENABLED;
759 adapter->ahw->num_msix = num_msix;
760 dev_info(&pdev->dev, "using msi-x interrupts\n");
761 return 0;
762 } else if (err > 0) {
763 pci_disable_msix(pdev);
764
765 dev_info(&pdev->dev,
766 "Unable to allocate %d MSI-X vectors, Available vectors %d\n",
767 num_msix, err);
768
769 if (qlcnic_82xx_check(adapter)) {
770 num_msix = rounddown_pow_of_two(err);
771 if (err < QLCNIC_82XX_MINIMUM_VECTOR)
772 return -ENOSPC;
773 } else {
774 num_msix = rounddown_pow_of_two(err - 1);
775 num_msix += 1;
776 if (err < QLCNIC_83XX_MINIMUM_VECTOR)
777 return -ENOSPC;
778 }
779
780 if (qlcnic_82xx_check(adapter) &&
781 !qlcnic_check_multi_tx(adapter)) {
782 adapter->drv_sds_rings = num_msix;
783 adapter->drv_tx_rings = QLCNIC_SINGLE_RING;
784 } else {
785 /* Distribute vectors equally */
786 adapter->drv_tx_rings = num_msix / 2;
787 adapter->drv_sds_rings = adapter->drv_tx_rings;
788 }
789
790 if (num_msix) {
791 dev_info(&pdev->dev,
792 "Trying to allocate %d MSI-X interrupt vectors\n",
793 num_msix);
794 goto enable_msix;
795 }
796 } else {
797 dev_info(&pdev->dev,
798 "Unable to allocate %d MSI-X vectors, err=%d\n",
799 num_msix, err);
800 return err;
801 }
802 }
803
804 return -EIO;
805 }
806
807 static int qlcnic_82xx_calculate_msix_vector(struct qlcnic_adapter *adapter)
808 {
809 int num_msix;
810
811 num_msix = adapter->drv_sds_rings;
812
813 if (qlcnic_check_multi_tx(adapter))
814 num_msix += adapter->drv_tx_rings;
815 else
816 num_msix += QLCNIC_SINGLE_RING;
817
818 return num_msix;
819 }
820
821 static int qlcnic_enable_msi_legacy(struct qlcnic_adapter *adapter)
822 {
823 int err = 0;
824 u32 offset, mask_reg;
825 const struct qlcnic_legacy_intr_set *legacy_intrp;
826 struct qlcnic_hardware_context *ahw = adapter->ahw;
827 struct pci_dev *pdev = adapter->pdev;
828
829 if (qlcnic_use_msi && !pci_enable_msi(pdev)) {
830 adapter->flags |= QLCNIC_MSI_ENABLED;
831 offset = msi_tgt_status[adapter->ahw->pci_func];
832 adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter->ahw,
833 offset);
834 dev_info(&pdev->dev, "using msi interrupts\n");
835 adapter->msix_entries[0].vector = pdev->irq;
836 return err;
837 }
838
839 if (qlcnic_use_msi || qlcnic_use_msi_x)
840 return -EOPNOTSUPP;
841
842 legacy_intrp = &legacy_intr[adapter->ahw->pci_func];
843 adapter->ahw->int_vec_bit = legacy_intrp->int_vec_bit;
844 offset = legacy_intrp->tgt_status_reg;
845 adapter->tgt_status_reg = qlcnic_get_ioaddr(ahw, offset);
846 mask_reg = legacy_intrp->tgt_mask_reg;
847 adapter->tgt_mask_reg = qlcnic_get_ioaddr(ahw, mask_reg);
848 adapter->isr_int_vec = qlcnic_get_ioaddr(ahw, ISR_INT_VECTOR);
849 adapter->crb_int_state_reg = qlcnic_get_ioaddr(ahw, ISR_INT_STATE_REG);
850 dev_info(&pdev->dev, "using legacy interrupts\n");
851 adapter->msix_entries[0].vector = pdev->irq;
852 return err;
853 }
854
855 static int qlcnic_82xx_setup_intr(struct qlcnic_adapter *adapter)
856 {
857 int num_msix, err = 0;
858
859 if (adapter->flags & QLCNIC_TSS_RSS) {
860 err = qlcnic_setup_tss_rss_intr(adapter);
861 if (err < 0)
862 return err;
863 num_msix = adapter->ahw->num_msix;
864 } else {
865 num_msix = qlcnic_82xx_calculate_msix_vector(adapter);
866
867 err = qlcnic_enable_msix(adapter, num_msix);
868 if (err == -ENOMEM)
869 return err;
870
871 if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) {
872 qlcnic_disable_multi_tx(adapter);
873 adapter->drv_sds_rings = QLCNIC_SINGLE_RING;
874
875 err = qlcnic_enable_msi_legacy(adapter);
876 if (err)
877 return err;
878 }
879 }
880
881 return 0;
882 }
883
884 int qlcnic_82xx_mq_intrpt(struct qlcnic_adapter *adapter, int op_type)
885 {
886 struct qlcnic_hardware_context *ahw = adapter->ahw;
887 int err, i;
888
889 if (qlcnic_check_multi_tx(adapter) &&
890 !ahw->diag_test &&
891 (adapter->flags & QLCNIC_MSIX_ENABLED)) {
892 ahw->intr_tbl = vzalloc(ahw->num_msix *
893 sizeof(struct qlcnic_intrpt_config));
894 if (!ahw->intr_tbl)
895 return -ENOMEM;
896
897 for (i = 0; i < ahw->num_msix; i++) {
898 ahw->intr_tbl[i].type = QLCNIC_INTRPT_MSIX;
899 ahw->intr_tbl[i].id = i;
900 ahw->intr_tbl[i].src = 0;
901 }
902
903 err = qlcnic_82xx_config_intrpt(adapter, 1);
904 if (err)
905 dev_err(&adapter->pdev->dev,
906 "Failed to configure Interrupt for %d vector\n",
907 ahw->num_msix);
908 return err;
909 }
910
911 return 0;
912 }
913
914 void qlcnic_teardown_intr(struct qlcnic_adapter *adapter)
915 {
916 if (adapter->flags & QLCNIC_MSIX_ENABLED)
917 pci_disable_msix(adapter->pdev);
918 if (adapter->flags & QLCNIC_MSI_ENABLED)
919 pci_disable_msi(adapter->pdev);
920
921 kfree(adapter->msix_entries);
922 adapter->msix_entries = NULL;
923
924 if (adapter->ahw->intr_tbl) {
925 vfree(adapter->ahw->intr_tbl);
926 adapter->ahw->intr_tbl = NULL;
927 }
928 }
929
930 static void qlcnic_cleanup_pci_map(struct qlcnic_hardware_context *ahw)
931 {
932 if (ahw->pci_base0 != NULL)
933 iounmap(ahw->pci_base0);
934 }
935
936 static int qlcnic_get_act_pci_func(struct qlcnic_adapter *adapter)
937 {
938 struct qlcnic_hardware_context *ahw = adapter->ahw;
939 struct qlcnic_pci_info *pci_info;
940 int ret;
941
942 if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED)) {
943 switch (ahw->port_type) {
944 case QLCNIC_GBE:
945 ahw->total_nic_func = QLCNIC_NIU_MAX_GBE_PORTS;
946 break;
947 case QLCNIC_XGBE:
948 ahw->total_nic_func = QLCNIC_NIU_MAX_XG_PORTS;
949 break;
950 }
951 return 0;
952 }
953
954 if (ahw->op_mode == QLCNIC_MGMT_FUNC)
955 return 0;
956
957 pci_info = kcalloc(ahw->max_vnic_func, sizeof(*pci_info), GFP_KERNEL);
958 if (!pci_info)
959 return -ENOMEM;
960
961 ret = qlcnic_get_pci_info(adapter, pci_info);
962 kfree(pci_info);
963 return ret;
964 }
965
966 static bool qlcnic_port_eswitch_cfg_capability(struct qlcnic_adapter *adapter)
967 {
968 bool ret = false;
969
970 if (qlcnic_84xx_check(adapter)) {
971 ret = true;
972 } else if (qlcnic_83xx_check(adapter)) {
973 if (adapter->ahw->extra_capability[0] &
974 QLCNIC_FW_CAPABILITY_2_PER_PORT_ESWITCH_CFG)
975 ret = true;
976 else
977 ret = false;
978 }
979
980 return ret;
981 }
982
983 int qlcnic_init_pci_info(struct qlcnic_adapter *adapter)
984 {
985 struct qlcnic_hardware_context *ahw = adapter->ahw;
986 struct qlcnic_pci_info *pci_info;
987 int i, id = 0, ret = 0, j = 0;
988 u16 act_pci_func;
989 u8 pfn;
990
991 pci_info = kcalloc(ahw->max_vnic_func, sizeof(*pci_info), GFP_KERNEL);
992 if (!pci_info)
993 return -ENOMEM;
994
995 ret = qlcnic_get_pci_info(adapter, pci_info);
996 if (ret)
997 goto err_pci_info;
998
999 act_pci_func = ahw->total_nic_func;
1000
1001 adapter->npars = kzalloc(sizeof(struct qlcnic_npar_info) *
1002 act_pci_func, GFP_KERNEL);
1003 if (!adapter->npars) {
1004 ret = -ENOMEM;
1005 goto err_pci_info;
1006 }
1007
1008 adapter->eswitch = kzalloc(sizeof(struct qlcnic_eswitch) *
1009 QLCNIC_NIU_MAX_XG_PORTS, GFP_KERNEL);
1010 if (!adapter->eswitch) {
1011 ret = -ENOMEM;
1012 goto err_npars;
1013 }
1014
1015 for (i = 0; i < ahw->max_vnic_func; i++) {
1016 pfn = pci_info[i].id;
1017
1018 if (pfn >= ahw->max_vnic_func) {
1019 ret = QL_STATUS_INVALID_PARAM;
1020 dev_err(&adapter->pdev->dev, "%s: Invalid function 0x%x, max 0x%x\n",
1021 __func__, pfn, ahw->max_vnic_func);
1022 goto err_eswitch;
1023 }
1024
1025 if (!pci_info[i].active ||
1026 (pci_info[i].type != QLCNIC_TYPE_NIC))
1027 continue;
1028
1029 if (qlcnic_port_eswitch_cfg_capability(adapter)) {
1030 if (!qlcnic_83xx_set_port_eswitch_status(adapter, pfn,
1031 &id))
1032 adapter->npars[j].eswitch_status = true;
1033 else
1034 continue;
1035 } else {
1036 adapter->npars[j].eswitch_status = true;
1037 }
1038
1039 adapter->npars[j].pci_func = pfn;
1040 adapter->npars[j].active = (u8)pci_info[i].active;
1041 adapter->npars[j].type = (u8)pci_info[i].type;
1042 adapter->npars[j].phy_port = (u8)pci_info[i].default_port;
1043 adapter->npars[j].min_bw = pci_info[i].tx_min_bw;
1044 adapter->npars[j].max_bw = pci_info[i].tx_max_bw;
1045
1046 memcpy(&adapter->npars[j].mac, &pci_info[i].mac, ETH_ALEN);
1047 j++;
1048 }
1049
1050 /* Update eSwitch status for adapters without per port eSwitch
1051 * configuration capability
1052 */
1053 if (!qlcnic_port_eswitch_cfg_capability(adapter)) {
1054 for (i = 0; i < QLCNIC_NIU_MAX_XG_PORTS; i++)
1055 adapter->eswitch[i].flags |= QLCNIC_SWITCH_ENABLE;
1056 }
1057
1058 kfree(pci_info);
1059 return 0;
1060
1061 err_eswitch:
1062 kfree(adapter->eswitch);
1063 adapter->eswitch = NULL;
1064 err_npars:
1065 kfree(adapter->npars);
1066 adapter->npars = NULL;
1067 err_pci_info:
1068 kfree(pci_info);
1069
1070 return ret;
1071 }
1072
1073 static int
1074 qlcnic_set_function_modes(struct qlcnic_adapter *adapter)
1075 {
1076 u8 id;
1077 int ret;
1078 u32 data = QLCNIC_MGMT_FUNC;
1079 struct qlcnic_hardware_context *ahw = adapter->ahw;
1080
1081 ret = qlcnic_api_lock(adapter);
1082 if (ret)
1083 goto err_lock;
1084
1085 id = ahw->pci_func;
1086 data = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
1087 data = (data & ~QLC_DEV_SET_DRV(0xf, id)) |
1088 QLC_DEV_SET_DRV(QLCNIC_MGMT_FUNC, id);
1089 QLC_SHARED_REG_WR32(adapter, QLCNIC_DRV_OP_MODE, data);
1090 qlcnic_api_unlock(adapter);
1091 err_lock:
1092 return ret;
1093 }
1094
1095 static void qlcnic_check_vf(struct qlcnic_adapter *adapter,
1096 const struct pci_device_id *ent)
1097 {
1098 u32 op_mode, priv_level;
1099
1100 /* Determine FW API version */
1101 adapter->ahw->fw_hal_version = QLC_SHARED_REG_RD32(adapter,
1102 QLCNIC_FW_API);
1103
1104 /* Find PCI function number */
1105 qlcnic_get_func_no(adapter);
1106
1107 /* Determine function privilege level */
1108 op_mode = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
1109 if (op_mode == QLC_DEV_DRV_DEFAULT)
1110 priv_level = QLCNIC_MGMT_FUNC;
1111 else
1112 priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
1113
1114 if (priv_level == QLCNIC_NON_PRIV_FUNC) {
1115 adapter->ahw->op_mode = QLCNIC_NON_PRIV_FUNC;
1116 dev_info(&adapter->pdev->dev,
1117 "HAL Version: %d Non Privileged function\n",
1118 adapter->ahw->fw_hal_version);
1119 adapter->nic_ops = &qlcnic_vf_ops;
1120 } else
1121 adapter->nic_ops = &qlcnic_ops;
1122 }
1123
1124 #define QLCNIC_82XX_BAR0_LENGTH 0x00200000UL
1125 #define QLCNIC_83XX_BAR0_LENGTH 0x4000
1126 static void qlcnic_get_bar_length(u32 dev_id, ulong *bar)
1127 {
1128 switch (dev_id) {
1129 case PCI_DEVICE_ID_QLOGIC_QLE824X:
1130 *bar = QLCNIC_82XX_BAR0_LENGTH;
1131 break;
1132 case PCI_DEVICE_ID_QLOGIC_QLE834X:
1133 case PCI_DEVICE_ID_QLOGIC_QLE844X:
1134 case PCI_DEVICE_ID_QLOGIC_VF_QLE834X:
1135 case PCI_DEVICE_ID_QLOGIC_VF_QLE844X:
1136 *bar = QLCNIC_83XX_BAR0_LENGTH;
1137 break;
1138 default:
1139 *bar = 0;
1140 }
1141 }
1142
1143 static int qlcnic_setup_pci_map(struct pci_dev *pdev,
1144 struct qlcnic_hardware_context *ahw)
1145 {
1146 u32 offset;
1147 void __iomem *mem_ptr0 = NULL;
1148 unsigned long mem_len, pci_len0 = 0, bar0_len;
1149
1150 /* remap phys address */
1151 mem_len = pci_resource_len(pdev, 0);
1152
1153 qlcnic_get_bar_length(pdev->device, &bar0_len);
1154 if (mem_len >= bar0_len) {
1155
1156 mem_ptr0 = pci_ioremap_bar(pdev, 0);
1157 if (mem_ptr0 == NULL) {
1158 dev_err(&pdev->dev, "failed to map PCI bar 0\n");
1159 return -EIO;
1160 }
1161 pci_len0 = mem_len;
1162 } else {
1163 return -EIO;
1164 }
1165
1166 dev_info(&pdev->dev, "%dKB memory map\n", (int)(mem_len >> 10));
1167
1168 ahw->pci_base0 = mem_ptr0;
1169 ahw->pci_len0 = pci_len0;
1170 offset = QLCNIC_PCIX_PS_REG(PCIX_OCM_WINDOW_REG(ahw->pci_func));
1171 qlcnic_get_ioaddr(ahw, offset);
1172
1173 return 0;
1174 }
1175
1176 static bool qlcnic_validate_subsystem_id(struct qlcnic_adapter *adapter,
1177 int index)
1178 {
1179 struct pci_dev *pdev = adapter->pdev;
1180 unsigned short subsystem_vendor;
1181 bool ret = true;
1182
1183 subsystem_vendor = pdev->subsystem_vendor;
1184
1185 if (pdev->device == PCI_DEVICE_ID_QLOGIC_QLE824X ||
1186 pdev->device == PCI_DEVICE_ID_QLOGIC_QLE834X) {
1187 if (qlcnic_boards[index].sub_vendor == subsystem_vendor &&
1188 qlcnic_boards[index].sub_device == pdev->subsystem_device)
1189 ret = true;
1190 else
1191 ret = false;
1192 }
1193
1194 return ret;
1195 }
1196
1197 static void qlcnic_get_board_name(struct qlcnic_adapter *adapter, char *name)
1198 {
1199 struct pci_dev *pdev = adapter->pdev;
1200 int i, found = 0;
1201
1202 for (i = 0; i < NUM_SUPPORTED_BOARDS; ++i) {
1203 if (qlcnic_boards[i].vendor == pdev->vendor &&
1204 qlcnic_boards[i].device == pdev->device &&
1205 qlcnic_validate_subsystem_id(adapter, i)) {
1206 found = 1;
1207 break;
1208 }
1209 }
1210
1211 if (!found)
1212 sprintf(name, "%pM Gigabit Ethernet", adapter->mac_addr);
1213 else
1214 sprintf(name, "%pM: %s" , adapter->mac_addr,
1215 qlcnic_boards[i].short_name);
1216 }
1217
1218 static void
1219 qlcnic_check_options(struct qlcnic_adapter *adapter)
1220 {
1221 int err;
1222 u32 fw_major, fw_minor, fw_build, prev_fw_version;
1223 struct pci_dev *pdev = adapter->pdev;
1224 struct qlcnic_hardware_context *ahw = adapter->ahw;
1225 struct qlcnic_fw_dump *fw_dump = &ahw->fw_dump;
1226
1227 prev_fw_version = adapter->fw_version;
1228
1229 fw_major = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MAJOR);
1230 fw_minor = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MINOR);
1231 fw_build = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_SUB);
1232
1233 adapter->fw_version = QLCNIC_VERSION_CODE(fw_major, fw_minor, fw_build);
1234
1235 err = qlcnic_get_board_info(adapter);
1236 if (err) {
1237 dev_err(&pdev->dev, "Error getting board config info.\n");
1238 return;
1239 }
1240 if (ahw->op_mode != QLCNIC_NON_PRIV_FUNC) {
1241 if (fw_dump->tmpl_hdr == NULL ||
1242 adapter->fw_version > prev_fw_version) {
1243 if (fw_dump->tmpl_hdr)
1244 vfree(fw_dump->tmpl_hdr);
1245 if (!qlcnic_fw_cmd_get_minidump_temp(adapter))
1246 dev_info(&pdev->dev,
1247 "Supports FW dump capability\n");
1248 }
1249 }
1250
1251 dev_info(&pdev->dev, "Driver v%s, firmware v%d.%d.%d\n",
1252 QLCNIC_LINUX_VERSIONID, fw_major, fw_minor, fw_build);
1253
1254 if (adapter->ahw->port_type == QLCNIC_XGBE) {
1255 if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
1256 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_VF;
1257 adapter->max_rxd = MAX_RCV_DESCRIPTORS_VF;
1258 } else {
1259 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_10G;
1260 adapter->max_rxd = MAX_RCV_DESCRIPTORS_10G;
1261 }
1262
1263 adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
1264 adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
1265
1266 } else if (adapter->ahw->port_type == QLCNIC_GBE) {
1267 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
1268 adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
1269 adapter->max_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
1270 adapter->max_rxd = MAX_RCV_DESCRIPTORS_1G;
1271 }
1272
1273 adapter->ahw->msix_supported = !!qlcnic_use_msi_x;
1274
1275 adapter->num_txd = MAX_CMD_DESCRIPTORS;
1276
1277 adapter->max_rds_rings = MAX_RDS_RINGS;
1278 }
1279
1280 static int
1281 qlcnic_initialize_nic(struct qlcnic_adapter *adapter)
1282 {
1283 struct qlcnic_info nic_info;
1284 int err = 0;
1285
1286 memset(&nic_info, 0, sizeof(struct qlcnic_info));
1287 err = qlcnic_get_nic_info(adapter, &nic_info, adapter->ahw->pci_func);
1288 if (err)
1289 return err;
1290
1291 adapter->ahw->physical_port = (u8)nic_info.phys_port;
1292 adapter->ahw->switch_mode = nic_info.switch_mode;
1293 adapter->ahw->max_tx_ques = nic_info.max_tx_ques;
1294 adapter->ahw->max_rx_ques = nic_info.max_rx_ques;
1295 adapter->ahw->capabilities = nic_info.capabilities;
1296
1297 if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_MORE_CAPS) {
1298 u32 temp;
1299 temp = QLCRD32(adapter, CRB_FW_CAPABILITIES_2, &err);
1300 if (err == -EIO)
1301 return err;
1302 adapter->ahw->extra_capability[0] = temp;
1303 } else {
1304 adapter->ahw->extra_capability[0] = 0;
1305 }
1306
1307 adapter->ahw->max_mac_filters = nic_info.max_mac_filters;
1308 adapter->ahw->max_mtu = nic_info.max_mtu;
1309
1310 if (adapter->ahw->capabilities & BIT_6) {
1311 adapter->flags |= QLCNIC_ESWITCH_ENABLED;
1312 adapter->ahw->nic_mode = QLCNIC_VNIC_MODE;
1313 adapter->max_tx_rings = QLCNIC_MAX_HW_VNIC_TX_RINGS;
1314 adapter->max_sds_rings = QLCNIC_MAX_VNIC_SDS_RINGS;
1315
1316 dev_info(&adapter->pdev->dev, "vNIC mode enabled.\n");
1317 } else {
1318 adapter->ahw->nic_mode = QLCNIC_DEFAULT_MODE;
1319 adapter->max_tx_rings = QLCNIC_MAX_HW_TX_RINGS;
1320 adapter->max_sds_rings = QLCNIC_MAX_SDS_RINGS;
1321 adapter->flags &= ~QLCNIC_ESWITCH_ENABLED;
1322 }
1323
1324 return err;
1325 }
1326
1327 void qlcnic_set_vlan_config(struct qlcnic_adapter *adapter,
1328 struct qlcnic_esw_func_cfg *esw_cfg)
1329 {
1330 if (esw_cfg->discard_tagged)
1331 adapter->flags &= ~QLCNIC_TAGGING_ENABLED;
1332 else
1333 adapter->flags |= QLCNIC_TAGGING_ENABLED;
1334
1335 if (esw_cfg->vlan_id) {
1336 adapter->rx_pvid = esw_cfg->vlan_id;
1337 adapter->tx_pvid = esw_cfg->vlan_id;
1338 } else {
1339 adapter->rx_pvid = 0;
1340 adapter->tx_pvid = 0;
1341 }
1342 }
1343
1344 static int
1345 qlcnic_vlan_rx_add(struct net_device *netdev, __be16 proto, u16 vid)
1346 {
1347 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1348 int err;
1349
1350 if (qlcnic_sriov_vf_check(adapter)) {
1351 err = qlcnic_sriov_cfg_vf_guest_vlan(adapter, vid, 1);
1352 if (err) {
1353 netdev_err(netdev,
1354 "Cannot add VLAN filter for VLAN id %d, err=%d",
1355 vid, err);
1356 return err;
1357 }
1358 }
1359
1360 set_bit(vid, adapter->vlans);
1361 return 0;
1362 }
1363
1364 static int
1365 qlcnic_vlan_rx_del(struct net_device *netdev, __be16 proto, u16 vid)
1366 {
1367 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1368 int err;
1369
1370 if (qlcnic_sriov_vf_check(adapter)) {
1371 err = qlcnic_sriov_cfg_vf_guest_vlan(adapter, vid, 0);
1372 if (err) {
1373 netdev_err(netdev,
1374 "Cannot delete VLAN filter for VLAN id %d, err=%d",
1375 vid, err);
1376 return err;
1377 }
1378 }
1379
1380 qlcnic_restore_indev_addr(netdev, NETDEV_DOWN);
1381 clear_bit(vid, adapter->vlans);
1382 return 0;
1383 }
1384
1385 void qlcnic_set_eswitch_port_features(struct qlcnic_adapter *adapter,
1386 struct qlcnic_esw_func_cfg *esw_cfg)
1387 {
1388 adapter->flags &= ~(QLCNIC_MACSPOOF | QLCNIC_MAC_OVERRIDE_DISABLED |
1389 QLCNIC_PROMISC_DISABLED);
1390
1391 if (esw_cfg->mac_anti_spoof)
1392 adapter->flags |= QLCNIC_MACSPOOF;
1393
1394 if (!esw_cfg->mac_override)
1395 adapter->flags |= QLCNIC_MAC_OVERRIDE_DISABLED;
1396
1397 if (!esw_cfg->promisc_mode)
1398 adapter->flags |= QLCNIC_PROMISC_DISABLED;
1399 }
1400
1401 int qlcnic_set_eswitch_port_config(struct qlcnic_adapter *adapter)
1402 {
1403 struct qlcnic_esw_func_cfg esw_cfg;
1404
1405 if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED))
1406 return 0;
1407
1408 esw_cfg.pci_func = adapter->ahw->pci_func;
1409 if (qlcnic_get_eswitch_port_config(adapter, &esw_cfg))
1410 return -EIO;
1411 qlcnic_set_vlan_config(adapter, &esw_cfg);
1412 qlcnic_set_eswitch_port_features(adapter, &esw_cfg);
1413 qlcnic_set_netdev_features(adapter, &esw_cfg);
1414
1415 return 0;
1416 }
1417
1418 void qlcnic_set_netdev_features(struct qlcnic_adapter *adapter,
1419 struct qlcnic_esw_func_cfg *esw_cfg)
1420 {
1421 struct net_device *netdev = adapter->netdev;
1422
1423 if (qlcnic_83xx_check(adapter))
1424 return;
1425
1426 adapter->offload_flags = esw_cfg->offload_flags;
1427 adapter->flags |= QLCNIC_APP_CHANGED_FLAGS;
1428 netdev_update_features(netdev);
1429 adapter->flags &= ~QLCNIC_APP_CHANGED_FLAGS;
1430 }
1431
1432 static int
1433 qlcnic_check_eswitch_mode(struct qlcnic_adapter *adapter)
1434 {
1435 u32 op_mode, priv_level;
1436 int err = 0;
1437
1438 err = qlcnic_initialize_nic(adapter);
1439 if (err)
1440 return err;
1441
1442 if (adapter->flags & QLCNIC_ADAPTER_INITIALIZED)
1443 return 0;
1444
1445 op_mode = QLC_SHARED_REG_RD32(adapter, QLCNIC_DRV_OP_MODE);
1446 priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
1447
1448 if (op_mode == QLC_DEV_DRV_DEFAULT)
1449 priv_level = QLCNIC_MGMT_FUNC;
1450 else
1451 priv_level = QLC_DEV_GET_DRV(op_mode, adapter->ahw->pci_func);
1452
1453 if (adapter->flags & QLCNIC_ESWITCH_ENABLED) {
1454 if (priv_level == QLCNIC_MGMT_FUNC) {
1455 adapter->ahw->op_mode = QLCNIC_MGMT_FUNC;
1456 err = qlcnic_init_pci_info(adapter);
1457 if (err)
1458 return err;
1459 /* Set privilege level for other functions */
1460 qlcnic_set_function_modes(adapter);
1461 dev_info(&adapter->pdev->dev,
1462 "HAL Version: %d, Management function\n",
1463 adapter->ahw->fw_hal_version);
1464 } else if (priv_level == QLCNIC_PRIV_FUNC) {
1465 adapter->ahw->op_mode = QLCNIC_PRIV_FUNC;
1466 dev_info(&adapter->pdev->dev,
1467 "HAL Version: %d, Privileged function\n",
1468 adapter->ahw->fw_hal_version);
1469 }
1470 } else {
1471 adapter->ahw->nic_mode = QLCNIC_DEFAULT_MODE;
1472 }
1473
1474 adapter->flags |= QLCNIC_ADAPTER_INITIALIZED;
1475
1476 return err;
1477 }
1478
1479 int qlcnic_set_default_offload_settings(struct qlcnic_adapter *adapter)
1480 {
1481 struct qlcnic_esw_func_cfg esw_cfg;
1482 struct qlcnic_npar_info *npar;
1483 u8 i;
1484
1485 if (adapter->need_fw_reset)
1486 return 0;
1487
1488 for (i = 0; i < adapter->ahw->total_nic_func; i++) {
1489 if (!adapter->npars[i].eswitch_status)
1490 continue;
1491
1492 memset(&esw_cfg, 0, sizeof(struct qlcnic_esw_func_cfg));
1493 esw_cfg.pci_func = adapter->npars[i].pci_func;
1494 esw_cfg.mac_override = BIT_0;
1495 esw_cfg.promisc_mode = BIT_0;
1496 if (qlcnic_82xx_check(adapter)) {
1497 esw_cfg.offload_flags = BIT_0;
1498 if (QLCNIC_IS_TSO_CAPABLE(adapter))
1499 esw_cfg.offload_flags |= (BIT_1 | BIT_2);
1500 }
1501 if (qlcnic_config_switch_port(adapter, &esw_cfg))
1502 return -EIO;
1503 npar = &adapter->npars[i];
1504 npar->pvid = esw_cfg.vlan_id;
1505 npar->mac_override = esw_cfg.mac_override;
1506 npar->mac_anti_spoof = esw_cfg.mac_anti_spoof;
1507 npar->discard_tagged = esw_cfg.discard_tagged;
1508 npar->promisc_mode = esw_cfg.promisc_mode;
1509 npar->offload_flags = esw_cfg.offload_flags;
1510 }
1511
1512 return 0;
1513 }
1514
1515
1516 static int
1517 qlcnic_reset_eswitch_config(struct qlcnic_adapter *adapter,
1518 struct qlcnic_npar_info *npar, int pci_func)
1519 {
1520 struct qlcnic_esw_func_cfg esw_cfg;
1521 esw_cfg.op_mode = QLCNIC_PORT_DEFAULTS;
1522 esw_cfg.pci_func = pci_func;
1523 esw_cfg.vlan_id = npar->pvid;
1524 esw_cfg.mac_override = npar->mac_override;
1525 esw_cfg.discard_tagged = npar->discard_tagged;
1526 esw_cfg.mac_anti_spoof = npar->mac_anti_spoof;
1527 esw_cfg.offload_flags = npar->offload_flags;
1528 esw_cfg.promisc_mode = npar->promisc_mode;
1529 if (qlcnic_config_switch_port(adapter, &esw_cfg))
1530 return -EIO;
1531
1532 esw_cfg.op_mode = QLCNIC_ADD_VLAN;
1533 if (qlcnic_config_switch_port(adapter, &esw_cfg))
1534 return -EIO;
1535
1536 return 0;
1537 }
1538
1539 int qlcnic_reset_npar_config(struct qlcnic_adapter *adapter)
1540 {
1541 int i, err;
1542 struct qlcnic_npar_info *npar;
1543 struct qlcnic_info nic_info;
1544 u8 pci_func;
1545
1546 if (qlcnic_82xx_check(adapter))
1547 if (!adapter->need_fw_reset)
1548 return 0;
1549
1550 /* Set the NPAR config data after FW reset */
1551 for (i = 0; i < adapter->ahw->total_nic_func; i++) {
1552 npar = &adapter->npars[i];
1553 pci_func = npar->pci_func;
1554 if (!adapter->npars[i].eswitch_status)
1555 continue;
1556
1557 memset(&nic_info, 0, sizeof(struct qlcnic_info));
1558 err = qlcnic_get_nic_info(adapter, &nic_info, pci_func);
1559 if (err)
1560 return err;
1561 nic_info.min_tx_bw = npar->min_bw;
1562 nic_info.max_tx_bw = npar->max_bw;
1563 err = qlcnic_set_nic_info(adapter, &nic_info);
1564 if (err)
1565 return err;
1566
1567 if (npar->enable_pm) {
1568 err = qlcnic_config_port_mirroring(adapter,
1569 npar->dest_npar, 1,
1570 pci_func);
1571 if (err)
1572 return err;
1573 }
1574 err = qlcnic_reset_eswitch_config(adapter, npar, pci_func);
1575 if (err)
1576 return err;
1577 }
1578 return 0;
1579 }
1580
1581 static int qlcnic_check_npar_opertional(struct qlcnic_adapter *adapter)
1582 {
1583 u8 npar_opt_timeo = QLCNIC_DEV_NPAR_OPER_TIMEO;
1584 u32 npar_state;
1585
1586 if (adapter->ahw->op_mode == QLCNIC_MGMT_FUNC)
1587 return 0;
1588
1589 npar_state = QLC_SHARED_REG_RD32(adapter,
1590 QLCNIC_CRB_DEV_NPAR_STATE);
1591 while (npar_state != QLCNIC_DEV_NPAR_OPER && --npar_opt_timeo) {
1592 msleep(1000);
1593 npar_state = QLC_SHARED_REG_RD32(adapter,
1594 QLCNIC_CRB_DEV_NPAR_STATE);
1595 }
1596 if (!npar_opt_timeo) {
1597 dev_err(&adapter->pdev->dev,
1598 "Waiting for NPAR state to operational timeout\n");
1599 return -EIO;
1600 }
1601 return 0;
1602 }
1603
1604 static int
1605 qlcnic_set_mgmt_operations(struct qlcnic_adapter *adapter)
1606 {
1607 int err;
1608
1609 if (!(adapter->flags & QLCNIC_ESWITCH_ENABLED) ||
1610 adapter->ahw->op_mode != QLCNIC_MGMT_FUNC)
1611 return 0;
1612
1613 err = qlcnic_set_default_offload_settings(adapter);
1614 if (err)
1615 return err;
1616
1617 err = qlcnic_reset_npar_config(adapter);
1618 if (err)
1619 return err;
1620
1621 qlcnic_dev_set_npar_ready(adapter);
1622
1623 return err;
1624 }
1625
1626 static int qlcnic_82xx_start_firmware(struct qlcnic_adapter *adapter)
1627 {
1628 int err;
1629
1630 err = qlcnic_can_start_firmware(adapter);
1631 if (err < 0)
1632 return err;
1633 else if (!err)
1634 goto check_fw_status;
1635
1636 if (qlcnic_load_fw_file)
1637 qlcnic_request_firmware(adapter);
1638 else {
1639 err = qlcnic_check_flash_fw_ver(adapter);
1640 if (err)
1641 goto err_out;
1642
1643 adapter->ahw->fw_type = QLCNIC_FLASH_ROMIMAGE;
1644 }
1645
1646 err = qlcnic_need_fw_reset(adapter);
1647 if (err == 0)
1648 goto check_fw_status;
1649
1650 err = qlcnic_pinit_from_rom(adapter);
1651 if (err)
1652 goto err_out;
1653
1654 err = qlcnic_load_firmware(adapter);
1655 if (err)
1656 goto err_out;
1657
1658 qlcnic_release_firmware(adapter);
1659 QLCWR32(adapter, CRB_DRIVER_VERSION, QLCNIC_DRIVER_VERSION);
1660
1661 check_fw_status:
1662 err = qlcnic_check_fw_status(adapter);
1663 if (err)
1664 goto err_out;
1665
1666 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_READY);
1667 qlcnic_idc_debug_info(adapter, 1);
1668 err = qlcnic_check_eswitch_mode(adapter);
1669 if (err) {
1670 dev_err(&adapter->pdev->dev,
1671 "Memory allocation failed for eswitch\n");
1672 goto err_out;
1673 }
1674 err = qlcnic_set_mgmt_operations(adapter);
1675 if (err)
1676 goto err_out;
1677
1678 qlcnic_check_options(adapter);
1679 adapter->need_fw_reset = 0;
1680
1681 qlcnic_release_firmware(adapter);
1682 return 0;
1683
1684 err_out:
1685 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_FAILED);
1686 dev_err(&adapter->pdev->dev, "Device state set to failed\n");
1687
1688 qlcnic_release_firmware(adapter);
1689 return err;
1690 }
1691
1692 static int
1693 qlcnic_request_irq(struct qlcnic_adapter *adapter)
1694 {
1695 irq_handler_t handler;
1696 struct qlcnic_host_sds_ring *sds_ring;
1697 struct qlcnic_host_tx_ring *tx_ring;
1698 int err, ring, num_sds_rings;
1699
1700 unsigned long flags = 0;
1701 struct net_device *netdev = adapter->netdev;
1702 struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1703
1704 if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
1705 if (qlcnic_82xx_check(adapter))
1706 handler = qlcnic_tmp_intr;
1707 else
1708 handler = qlcnic_83xx_tmp_intr;
1709 if (!QLCNIC_IS_MSI_FAMILY(adapter))
1710 flags |= IRQF_SHARED;
1711
1712 } else {
1713 if (adapter->flags & QLCNIC_MSIX_ENABLED)
1714 handler = qlcnic_msix_intr;
1715 else if (adapter->flags & QLCNIC_MSI_ENABLED)
1716 handler = qlcnic_msi_intr;
1717 else {
1718 flags |= IRQF_SHARED;
1719 if (qlcnic_82xx_check(adapter))
1720 handler = qlcnic_intr;
1721 else
1722 handler = qlcnic_83xx_intr;
1723 }
1724 }
1725 adapter->irq = netdev->irq;
1726
1727 if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST) {
1728 if (qlcnic_82xx_check(adapter) ||
1729 (qlcnic_83xx_check(adapter) &&
1730 (adapter->flags & QLCNIC_MSIX_ENABLED))) {
1731 num_sds_rings = adapter->drv_sds_rings;
1732 for (ring = 0; ring < num_sds_rings; ring++) {
1733 sds_ring = &recv_ctx->sds_rings[ring];
1734 if (qlcnic_82xx_check(adapter) &&
1735 !qlcnic_check_multi_tx(adapter) &&
1736 (ring == (num_sds_rings - 1))) {
1737 if (!(adapter->flags &
1738 QLCNIC_MSIX_ENABLED))
1739 snprintf(sds_ring->name,
1740 sizeof(sds_ring->name),
1741 "qlcnic");
1742 else
1743 snprintf(sds_ring->name,
1744 sizeof(sds_ring->name),
1745 "%s-tx-0-rx-%d",
1746 netdev->name, ring);
1747 } else {
1748 snprintf(sds_ring->name,
1749 sizeof(sds_ring->name),
1750 "%s-rx-%d",
1751 netdev->name, ring);
1752 }
1753 err = request_irq(sds_ring->irq, handler, flags,
1754 sds_ring->name, sds_ring);
1755 if (err)
1756 return err;
1757 }
1758 }
1759 if ((qlcnic_82xx_check(adapter) &&
1760 qlcnic_check_multi_tx(adapter)) ||
1761 (qlcnic_83xx_check(adapter) &&
1762 (adapter->flags & QLCNIC_MSIX_ENABLED) &&
1763 !(adapter->flags & QLCNIC_TX_INTR_SHARED))) {
1764 handler = qlcnic_msix_tx_intr;
1765 for (ring = 0; ring < adapter->drv_tx_rings;
1766 ring++) {
1767 tx_ring = &adapter->tx_ring[ring];
1768 snprintf(tx_ring->name, sizeof(tx_ring->name),
1769 "%s-tx-%d", netdev->name, ring);
1770 err = request_irq(tx_ring->irq, handler, flags,
1771 tx_ring->name, tx_ring);
1772 if (err)
1773 return err;
1774 }
1775 }
1776 }
1777 return 0;
1778 }
1779
1780 static void
1781 qlcnic_free_irq(struct qlcnic_adapter *adapter)
1782 {
1783 int ring;
1784 struct qlcnic_host_sds_ring *sds_ring;
1785 struct qlcnic_host_tx_ring *tx_ring;
1786
1787 struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
1788
1789 if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST) {
1790 if (qlcnic_82xx_check(adapter) ||
1791 (qlcnic_83xx_check(adapter) &&
1792 (adapter->flags & QLCNIC_MSIX_ENABLED))) {
1793 for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
1794 sds_ring = &recv_ctx->sds_rings[ring];
1795 free_irq(sds_ring->irq, sds_ring);
1796 }
1797 }
1798 if ((qlcnic_83xx_check(adapter) &&
1799 !(adapter->flags & QLCNIC_TX_INTR_SHARED)) ||
1800 (qlcnic_82xx_check(adapter) &&
1801 qlcnic_check_multi_tx(adapter))) {
1802 for (ring = 0; ring < adapter->drv_tx_rings;
1803 ring++) {
1804 tx_ring = &adapter->tx_ring[ring];
1805 if (tx_ring->irq)
1806 free_irq(tx_ring->irq, tx_ring);
1807 }
1808 }
1809 }
1810 }
1811
1812 static void qlcnic_get_lro_mss_capability(struct qlcnic_adapter *adapter)
1813 {
1814 u32 capab = 0;
1815
1816 if (qlcnic_82xx_check(adapter)) {
1817 if (adapter->ahw->extra_capability[0] &
1818 QLCNIC_FW_CAPABILITY_2_LRO_MAX_TCP_SEG)
1819 adapter->flags |= QLCNIC_FW_LRO_MSS_CAP;
1820 } else {
1821 capab = adapter->ahw->capabilities;
1822 if (QLC_83XX_GET_FW_LRO_MSS_CAPABILITY(capab))
1823 adapter->flags |= QLCNIC_FW_LRO_MSS_CAP;
1824 }
1825 }
1826
1827 static int qlcnic_config_def_intr_coalesce(struct qlcnic_adapter *adapter)
1828 {
1829 struct qlcnic_hardware_context *ahw = adapter->ahw;
1830 int err;
1831
1832 /* Initialize interrupt coalesce parameters */
1833 ahw->coal.flag = QLCNIC_INTR_DEFAULT;
1834
1835 if (qlcnic_83xx_check(adapter)) {
1836 ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX_TX;
1837 ahw->coal.tx_time_us = QLCNIC_DEF_INTR_COALESCE_TX_TIME_US;
1838 ahw->coal.tx_packets = QLCNIC_DEF_INTR_COALESCE_TX_PACKETS;
1839 ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
1840 ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
1841
1842 err = qlcnic_83xx_set_rx_tx_intr_coal(adapter);
1843 } else {
1844 ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX;
1845 ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
1846 ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
1847
1848 err = qlcnic_82xx_set_rx_coalesce(adapter);
1849 }
1850
1851 return err;
1852 }
1853
1854 int __qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1855 {
1856 int ring;
1857 struct qlcnic_host_rds_ring *rds_ring;
1858
1859 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1860 return -EIO;
1861
1862 if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
1863 return 0;
1864
1865 if (qlcnic_set_eswitch_port_config(adapter))
1866 return -EIO;
1867
1868 qlcnic_get_lro_mss_capability(adapter);
1869
1870 if (qlcnic_fw_create_ctx(adapter))
1871 return -EIO;
1872
1873 for (ring = 0; ring < adapter->max_rds_rings; ring++) {
1874 rds_ring = &adapter->recv_ctx->rds_rings[ring];
1875 qlcnic_post_rx_buffers(adapter, rds_ring, ring);
1876 }
1877
1878 qlcnic_set_multi(netdev);
1879 qlcnic_fw_cmd_set_mtu(adapter, netdev->mtu);
1880
1881 adapter->ahw->linkup = 0;
1882
1883 if (adapter->drv_sds_rings > 1)
1884 qlcnic_config_rss(adapter, 1);
1885
1886 qlcnic_config_def_intr_coalesce(adapter);
1887
1888 if (netdev->features & NETIF_F_LRO)
1889 qlcnic_config_hw_lro(adapter, QLCNIC_LRO_ENABLED);
1890
1891 set_bit(__QLCNIC_DEV_UP, &adapter->state);
1892 qlcnic_napi_enable(adapter);
1893
1894 qlcnic_linkevent_request(adapter, 1);
1895
1896 adapter->ahw->reset_context = 0;
1897 netif_tx_start_all_queues(netdev);
1898 return 0;
1899 }
1900
1901 int qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
1902 {
1903 int err = 0;
1904
1905 rtnl_lock();
1906 if (netif_running(netdev))
1907 err = __qlcnic_up(adapter, netdev);
1908 rtnl_unlock();
1909
1910 return err;
1911 }
1912
1913 void __qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1914 {
1915 int ring;
1916
1917 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
1918 return;
1919
1920 if (!test_and_clear_bit(__QLCNIC_DEV_UP, &adapter->state))
1921 return;
1922
1923 smp_mb();
1924 netif_carrier_off(netdev);
1925 adapter->ahw->linkup = 0;
1926 netif_tx_disable(netdev);
1927
1928 qlcnic_free_mac_list(adapter);
1929
1930 if (adapter->fhash.fnum)
1931 qlcnic_delete_lb_filters(adapter);
1932
1933 qlcnic_nic_set_promisc(adapter, QLCNIC_NIU_NON_PROMISC_MODE);
1934 if (qlcnic_sriov_vf_check(adapter))
1935 qlcnic_sriov_cleanup_async_list(&adapter->ahw->sriov->bc);
1936
1937 qlcnic_napi_disable(adapter);
1938
1939 qlcnic_fw_destroy_ctx(adapter);
1940 adapter->flags &= ~QLCNIC_FW_LRO_MSS_CAP;
1941
1942 qlcnic_reset_rx_buffers_list(adapter);
1943
1944 for (ring = 0; ring < adapter->drv_tx_rings; ring++)
1945 qlcnic_release_tx_buffers(adapter, &adapter->tx_ring[ring]);
1946 }
1947
1948 /* Usage: During suspend and firmware recovery module */
1949
1950 void qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
1951 {
1952 rtnl_lock();
1953 if (netif_running(netdev))
1954 __qlcnic_down(adapter, netdev);
1955 rtnl_unlock();
1956
1957 }
1958
1959 int
1960 qlcnic_attach(struct qlcnic_adapter *adapter)
1961 {
1962 struct net_device *netdev = adapter->netdev;
1963 struct pci_dev *pdev = adapter->pdev;
1964 int err;
1965
1966 if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC)
1967 return 0;
1968
1969 err = qlcnic_napi_add(adapter, netdev);
1970 if (err)
1971 return err;
1972
1973 err = qlcnic_alloc_sw_resources(adapter);
1974 if (err) {
1975 dev_err(&pdev->dev, "Error in setting sw resources\n");
1976 goto err_out_napi_del;
1977 }
1978
1979 err = qlcnic_alloc_hw_resources(adapter);
1980 if (err) {
1981 dev_err(&pdev->dev, "Error in setting hw resources\n");
1982 goto err_out_free_sw;
1983 }
1984
1985 err = qlcnic_request_irq(adapter);
1986 if (err) {
1987 dev_err(&pdev->dev, "failed to setup interrupt\n");
1988 goto err_out_free_hw;
1989 }
1990
1991 qlcnic_create_sysfs_entries(adapter);
1992
1993 #ifdef CONFIG_QLCNIC_VXLAN
1994 if (qlcnic_encap_rx_offload(adapter))
1995 vxlan_get_rx_port(netdev);
1996 #endif
1997
1998 adapter->is_up = QLCNIC_ADAPTER_UP_MAGIC;
1999 return 0;
2000
2001 err_out_free_hw:
2002 qlcnic_free_hw_resources(adapter);
2003 err_out_free_sw:
2004 qlcnic_free_sw_resources(adapter);
2005 err_out_napi_del:
2006 qlcnic_napi_del(adapter);
2007 return err;
2008 }
2009
2010 void qlcnic_detach(struct qlcnic_adapter *adapter)
2011 {
2012 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
2013 return;
2014
2015 qlcnic_remove_sysfs_entries(adapter);
2016
2017 qlcnic_free_hw_resources(adapter);
2018 qlcnic_release_rx_buffers(adapter);
2019 qlcnic_free_irq(adapter);
2020 qlcnic_napi_del(adapter);
2021 qlcnic_free_sw_resources(adapter);
2022
2023 adapter->is_up = 0;
2024 }
2025
2026 void qlcnic_diag_free_res(struct net_device *netdev, int drv_sds_rings)
2027 {
2028 struct qlcnic_adapter *adapter = netdev_priv(netdev);
2029 struct qlcnic_host_sds_ring *sds_ring;
2030 int drv_tx_rings = adapter->drv_tx_rings;
2031 int ring;
2032
2033 clear_bit(__QLCNIC_DEV_UP, &adapter->state);
2034 if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
2035 for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
2036 sds_ring = &adapter->recv_ctx->sds_rings[ring];
2037 qlcnic_disable_sds_intr(adapter, sds_ring);
2038 }
2039 }
2040
2041 qlcnic_fw_destroy_ctx(adapter);
2042
2043 qlcnic_detach(adapter);
2044
2045 adapter->ahw->diag_test = 0;
2046 adapter->drv_sds_rings = drv_sds_rings;
2047 adapter->drv_tx_rings = drv_tx_rings;
2048
2049 if (qlcnic_attach(adapter))
2050 goto out;
2051
2052 if (netif_running(netdev))
2053 __qlcnic_up(adapter, netdev);
2054 out:
2055 netif_device_attach(netdev);
2056 }
2057
2058 static int qlcnic_alloc_adapter_resources(struct qlcnic_adapter *adapter)
2059 {
2060 struct qlcnic_hardware_context *ahw = adapter->ahw;
2061 int err = 0;
2062
2063 adapter->recv_ctx = kzalloc(sizeof(struct qlcnic_recv_context),
2064 GFP_KERNEL);
2065 if (!adapter->recv_ctx) {
2066 err = -ENOMEM;
2067 goto err_out;
2068 }
2069
2070 if (qlcnic_83xx_check(adapter)) {
2071 ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX_TX;
2072 ahw->coal.tx_time_us = QLCNIC_DEF_INTR_COALESCE_TX_TIME_US;
2073 ahw->coal.tx_packets = QLCNIC_DEF_INTR_COALESCE_TX_PACKETS;
2074 ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
2075 ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
2076 } else {
2077 ahw->coal.type = QLCNIC_INTR_COAL_TYPE_RX;
2078 ahw->coal.rx_time_us = QLCNIC_DEF_INTR_COALESCE_RX_TIME_US;
2079 ahw->coal.rx_packets = QLCNIC_DEF_INTR_COALESCE_RX_PACKETS;
2080 }
2081
2082 /* clear stats */
2083 memset(&adapter->stats, 0, sizeof(adapter->stats));
2084 err_out:
2085 return err;
2086 }
2087
2088 static void qlcnic_free_adapter_resources(struct qlcnic_adapter *adapter)
2089 {
2090 kfree(adapter->recv_ctx);
2091 adapter->recv_ctx = NULL;
2092
2093 if (adapter->ahw->fw_dump.tmpl_hdr) {
2094 vfree(adapter->ahw->fw_dump.tmpl_hdr);
2095 adapter->ahw->fw_dump.tmpl_hdr = NULL;
2096 }
2097
2098 kfree(adapter->ahw->reset.buff);
2099 adapter->ahw->fw_dump.tmpl_hdr = NULL;
2100 }
2101
2102 int qlcnic_diag_alloc_res(struct net_device *netdev, int test)
2103 {
2104 struct qlcnic_adapter *adapter = netdev_priv(netdev);
2105 struct qlcnic_host_sds_ring *sds_ring;
2106 struct qlcnic_host_rds_ring *rds_ring;
2107 int ring;
2108 int ret;
2109
2110 netif_device_detach(netdev);
2111
2112 if (netif_running(netdev))
2113 __qlcnic_down(adapter, netdev);
2114
2115 qlcnic_detach(adapter);
2116
2117 adapter->drv_sds_rings = QLCNIC_SINGLE_RING;
2118 adapter->ahw->diag_test = test;
2119 adapter->ahw->linkup = 0;
2120
2121 ret = qlcnic_attach(adapter);
2122 if (ret) {
2123 netif_device_attach(netdev);
2124 return ret;
2125 }
2126
2127 ret = qlcnic_fw_create_ctx(adapter);
2128 if (ret) {
2129 qlcnic_detach(adapter);
2130 netif_device_attach(netdev);
2131 return ret;
2132 }
2133
2134 for (ring = 0; ring < adapter->max_rds_rings; ring++) {
2135 rds_ring = &adapter->recv_ctx->rds_rings[ring];
2136 qlcnic_post_rx_buffers(adapter, rds_ring, ring);
2137 }
2138
2139 if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
2140 for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
2141 sds_ring = &adapter->recv_ctx->sds_rings[ring];
2142 qlcnic_enable_sds_intr(adapter, sds_ring);
2143 }
2144 }
2145
2146 if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
2147 adapter->ahw->loopback_state = 0;
2148 qlcnic_linkevent_request(adapter, 1);
2149 }
2150
2151 set_bit(__QLCNIC_DEV_UP, &adapter->state);
2152
2153 return 0;
2154 }
2155
2156 /* Reset context in hardware only */
2157 static int
2158 qlcnic_reset_hw_context(struct qlcnic_adapter *adapter)
2159 {
2160 struct net_device *netdev = adapter->netdev;
2161
2162 if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
2163 return -EBUSY;
2164
2165 netif_device_detach(netdev);
2166
2167 qlcnic_down(adapter, netdev);
2168
2169 qlcnic_up(adapter, netdev);
2170
2171 netif_device_attach(netdev);
2172
2173 clear_bit(__QLCNIC_RESETTING, &adapter->state);
2174 netdev_info(adapter->netdev, "%s: soft reset complete\n", __func__);
2175 return 0;
2176 }
2177
2178 int
2179 qlcnic_reset_context(struct qlcnic_adapter *adapter)
2180 {
2181 int err = 0;
2182 struct net_device *netdev = adapter->netdev;
2183
2184 if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
2185 return -EBUSY;
2186
2187 if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC) {
2188
2189 netif_device_detach(netdev);
2190
2191 if (netif_running(netdev))
2192 __qlcnic_down(adapter, netdev);
2193
2194 qlcnic_detach(adapter);
2195
2196 if (netif_running(netdev)) {
2197 err = qlcnic_attach(adapter);
2198 if (!err) {
2199 __qlcnic_up(adapter, netdev);
2200 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
2201 }
2202 }
2203
2204 netif_device_attach(netdev);
2205 }
2206
2207 clear_bit(__QLCNIC_RESETTING, &adapter->state);
2208 return err;
2209 }
2210
2211 static void qlcnic_82xx_set_mac_filter_count(struct qlcnic_adapter *adapter)
2212 {
2213 struct qlcnic_hardware_context *ahw = adapter->ahw;
2214 u16 act_pci_fn = ahw->total_nic_func;
2215 u16 count;
2216
2217 ahw->max_mc_count = QLCNIC_MAX_MC_COUNT;
2218 if (act_pci_fn <= 2)
2219 count = (QLCNIC_MAX_UC_COUNT - QLCNIC_MAX_MC_COUNT) /
2220 act_pci_fn;
2221 else
2222 count = (QLCNIC_LB_MAX_FILTERS - QLCNIC_MAX_MC_COUNT) /
2223 act_pci_fn;
2224 ahw->max_uc_count = count;
2225 }
2226
2227 static int qlcnic_set_real_num_queues(struct qlcnic_adapter *adapter,
2228 u8 tx_queues, u8 rx_queues)
2229 {
2230 struct net_device *netdev = adapter->netdev;
2231 int err = 0;
2232
2233 if (tx_queues) {
2234 err = netif_set_real_num_tx_queues(netdev, tx_queues);
2235 if (err) {
2236 netdev_err(netdev, "failed to set %d Tx queues\n",
2237 tx_queues);
2238 return err;
2239 }
2240 }
2241
2242 if (rx_queues) {
2243 err = netif_set_real_num_rx_queues(netdev, rx_queues);
2244 if (err)
2245 netdev_err(netdev, "failed to set %d Rx queues\n",
2246 rx_queues);
2247 }
2248
2249 return err;
2250 }
2251
2252 int
2253 qlcnic_setup_netdev(struct qlcnic_adapter *adapter, struct net_device *netdev,
2254 int pci_using_dac)
2255 {
2256 int err;
2257 struct pci_dev *pdev = adapter->pdev;
2258
2259 adapter->rx_csum = 1;
2260 adapter->ahw->mc_enabled = 0;
2261 qlcnic_set_mac_filter_count(adapter);
2262
2263 netdev->netdev_ops = &qlcnic_netdev_ops;
2264 netdev->watchdog_timeo = QLCNIC_WATCHDOG_TIMEOUTVALUE * HZ;
2265
2266 qlcnic_change_mtu(netdev, netdev->mtu);
2267
2268 if (qlcnic_sriov_vf_check(adapter))
2269 SET_ETHTOOL_OPS(netdev, &qlcnic_sriov_vf_ethtool_ops);
2270 else
2271 SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_ops);
2272
2273 netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
2274 NETIF_F_IPV6_CSUM | NETIF_F_GRO |
2275 NETIF_F_HW_VLAN_CTAG_RX);
2276 netdev->vlan_features |= (NETIF_F_SG | NETIF_F_IP_CSUM |
2277 NETIF_F_IPV6_CSUM);
2278
2279 if (QLCNIC_IS_TSO_CAPABLE(adapter)) {
2280 netdev->features |= (NETIF_F_TSO | NETIF_F_TSO6);
2281 netdev->vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
2282 }
2283
2284 if (pci_using_dac) {
2285 netdev->features |= NETIF_F_HIGHDMA;
2286 netdev->vlan_features |= NETIF_F_HIGHDMA;
2287 }
2288
2289 if (qlcnic_vlan_tx_check(adapter))
2290 netdev->features |= (NETIF_F_HW_VLAN_CTAG_TX);
2291
2292 if (qlcnic_sriov_vf_check(adapter))
2293 netdev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
2294
2295 if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
2296 netdev->features |= NETIF_F_LRO;
2297
2298 if (qlcnic_encap_tx_offload(adapter)) {
2299 netdev->features |= NETIF_F_GSO_UDP_TUNNEL;
2300
2301 /* encapsulation Tx offload supported by Adapter */
2302 netdev->hw_enc_features = NETIF_F_IP_CSUM |
2303 NETIF_F_GSO_UDP_TUNNEL |
2304 NETIF_F_TSO |
2305 NETIF_F_TSO6;
2306 }
2307
2308 if (qlcnic_encap_rx_offload(adapter))
2309 netdev->hw_enc_features |= NETIF_F_RXCSUM;
2310
2311 netdev->hw_features = netdev->features;
2312 netdev->priv_flags |= IFF_UNICAST_FLT;
2313 netdev->irq = adapter->msix_entries[0].vector;
2314
2315 err = qlcnic_set_real_num_queues(adapter, adapter->drv_tx_rings,
2316 adapter->drv_sds_rings);
2317 if (err)
2318 return err;
2319
2320 err = register_netdev(netdev);
2321 if (err) {
2322 dev_err(&pdev->dev, "failed to register net device\n");
2323 return err;
2324 }
2325
2326 qlcnic_dcb_init_dcbnl_ops(adapter->dcb);
2327
2328 return 0;
2329 }
2330
2331 static int qlcnic_set_dma_mask(struct pci_dev *pdev, int *pci_using_dac)
2332 {
2333 if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) &&
2334 !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)))
2335 *pci_using_dac = 1;
2336 else if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) &&
2337 !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)))
2338 *pci_using_dac = 0;
2339 else {
2340 dev_err(&pdev->dev, "Unable to set DMA mask, aborting\n");
2341 return -EIO;
2342 }
2343
2344 return 0;
2345 }
2346
2347 void qlcnic_free_tx_rings(struct qlcnic_adapter *adapter)
2348 {
2349 int ring;
2350 struct qlcnic_host_tx_ring *tx_ring;
2351
2352 for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2353 tx_ring = &adapter->tx_ring[ring];
2354 if (tx_ring && tx_ring->cmd_buf_arr != NULL) {
2355 vfree(tx_ring->cmd_buf_arr);
2356 tx_ring->cmd_buf_arr = NULL;
2357 }
2358 }
2359 if (adapter->tx_ring != NULL)
2360 kfree(adapter->tx_ring);
2361 }
2362
2363 int qlcnic_alloc_tx_rings(struct qlcnic_adapter *adapter,
2364 struct net_device *netdev)
2365 {
2366 int ring, vector, index;
2367 struct qlcnic_host_tx_ring *tx_ring;
2368 struct qlcnic_cmd_buffer *cmd_buf_arr;
2369
2370 tx_ring = kcalloc(adapter->drv_tx_rings,
2371 sizeof(struct qlcnic_host_tx_ring), GFP_KERNEL);
2372 if (tx_ring == NULL)
2373 return -ENOMEM;
2374
2375 adapter->tx_ring = tx_ring;
2376
2377 for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2378 tx_ring = &adapter->tx_ring[ring];
2379 tx_ring->num_desc = adapter->num_txd;
2380 tx_ring->txq = netdev_get_tx_queue(netdev, ring);
2381 cmd_buf_arr = vzalloc(TX_BUFF_RINGSIZE(tx_ring));
2382 if (cmd_buf_arr == NULL) {
2383 qlcnic_free_tx_rings(adapter);
2384 return -ENOMEM;
2385 }
2386 memset(cmd_buf_arr, 0, TX_BUFF_RINGSIZE(tx_ring));
2387 tx_ring->cmd_buf_arr = cmd_buf_arr;
2388 spin_lock_init(&tx_ring->tx_clean_lock);
2389 }
2390
2391 if (qlcnic_83xx_check(adapter) ||
2392 (qlcnic_82xx_check(adapter) && qlcnic_check_multi_tx(adapter))) {
2393 for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2394 tx_ring = &adapter->tx_ring[ring];
2395 tx_ring->adapter = adapter;
2396 if (adapter->flags & QLCNIC_MSIX_ENABLED) {
2397 index = adapter->drv_sds_rings + ring;
2398 vector = adapter->msix_entries[index].vector;
2399 tx_ring->irq = vector;
2400 }
2401 }
2402 }
2403
2404 return 0;
2405 }
2406
2407 void qlcnic_set_drv_version(struct qlcnic_adapter *adapter)
2408 {
2409 struct qlcnic_hardware_context *ahw = adapter->ahw;
2410 u32 fw_cmd = 0;
2411
2412 if (qlcnic_82xx_check(adapter))
2413 fw_cmd = QLCNIC_CMD_82XX_SET_DRV_VER;
2414 else if (qlcnic_83xx_check(adapter))
2415 fw_cmd = QLCNIC_CMD_83XX_SET_DRV_VER;
2416
2417 if (ahw->extra_capability[0] & QLCNIC_FW_CAPABILITY_SET_DRV_VER)
2418 qlcnic_fw_cmd_set_drv_version(adapter, fw_cmd);
2419 }
2420
2421 /* Reset firmware API lock */
2422 static void qlcnic_reset_api_lock(struct qlcnic_adapter *adapter)
2423 {
2424 qlcnic_api_lock(adapter);
2425 qlcnic_api_unlock(adapter);
2426 }
2427
2428
2429 static int
2430 qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
2431 {
2432 struct net_device *netdev = NULL;
2433 struct qlcnic_adapter *adapter = NULL;
2434 struct qlcnic_hardware_context *ahw;
2435 int err, pci_using_dac = -1;
2436 char board_name[QLCNIC_MAX_BOARD_NAME_LEN + 19]; /* MAC + ": " + name */
2437
2438 err = pci_enable_device(pdev);
2439 if (err)
2440 return err;
2441
2442 if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
2443 err = -ENODEV;
2444 goto err_out_disable_pdev;
2445 }
2446
2447 err = qlcnic_set_dma_mask(pdev, &pci_using_dac);
2448 if (err)
2449 goto err_out_disable_pdev;
2450
2451 err = pci_request_regions(pdev, qlcnic_driver_name);
2452 if (err)
2453 goto err_out_disable_pdev;
2454
2455 pci_set_master(pdev);
2456 pci_enable_pcie_error_reporting(pdev);
2457
2458 ahw = kzalloc(sizeof(struct qlcnic_hardware_context), GFP_KERNEL);
2459 if (!ahw) {
2460 err = -ENOMEM;
2461 goto err_out_free_res;
2462 }
2463
2464 switch (ent->device) {
2465 case PCI_DEVICE_ID_QLOGIC_QLE824X:
2466 ahw->hw_ops = &qlcnic_hw_ops;
2467 ahw->reg_tbl = (u32 *) qlcnic_reg_tbl;
2468 break;
2469 case PCI_DEVICE_ID_QLOGIC_QLE834X:
2470 case PCI_DEVICE_ID_QLOGIC_QLE844X:
2471 qlcnic_83xx_register_map(ahw);
2472 break;
2473 case PCI_DEVICE_ID_QLOGIC_VF_QLE834X:
2474 case PCI_DEVICE_ID_QLOGIC_VF_QLE844X:
2475 qlcnic_sriov_vf_register_map(ahw);
2476 break;
2477 default:
2478 goto err_out_free_hw_res;
2479 }
2480
2481 err = qlcnic_setup_pci_map(pdev, ahw);
2482 if (err)
2483 goto err_out_free_hw_res;
2484
2485 netdev = alloc_etherdev_mq(sizeof(struct qlcnic_adapter),
2486 QLCNIC_MAX_TX_RINGS);
2487 if (!netdev) {
2488 err = -ENOMEM;
2489 goto err_out_iounmap;
2490 }
2491
2492 SET_NETDEV_DEV(netdev, &pdev->dev);
2493
2494 adapter = netdev_priv(netdev);
2495 adapter->netdev = netdev;
2496 adapter->pdev = pdev;
2497 adapter->ahw = ahw;
2498
2499 adapter->qlcnic_wq = create_singlethread_workqueue("qlcnic");
2500 if (adapter->qlcnic_wq == NULL) {
2501 err = -ENOMEM;
2502 dev_err(&pdev->dev, "Failed to create workqueue\n");
2503 goto err_out_free_netdev;
2504 }
2505
2506 err = qlcnic_alloc_adapter_resources(adapter);
2507 if (err)
2508 goto err_out_free_wq;
2509
2510 adapter->dev_rst_time = jiffies;
2511 ahw->revision_id = pdev->revision;
2512 ahw->max_vnic_func = qlcnic_get_vnic_func_count(adapter);
2513 if (qlcnic_mac_learn == FDB_MAC_LEARN)
2514 adapter->fdb_mac_learn = true;
2515 else if (qlcnic_mac_learn == DRV_MAC_LEARN)
2516 adapter->drv_mac_learn = true;
2517
2518 rwlock_init(&adapter->ahw->crb_lock);
2519 mutex_init(&adapter->ahw->mem_lock);
2520
2521 INIT_LIST_HEAD(&adapter->mac_list);
2522
2523 qlcnic_register_dcb(adapter);
2524
2525 if (qlcnic_82xx_check(adapter)) {
2526 qlcnic_check_vf(adapter, ent);
2527 adapter->portnum = adapter->ahw->pci_func;
2528 qlcnic_reset_api_lock(adapter);
2529 err = qlcnic_start_firmware(adapter);
2530 if (err) {
2531 dev_err(&pdev->dev, "Loading fw failed.Please Reboot\n"
2532 "\t\tIf reboot doesn't help, try flashing the card\n");
2533 goto err_out_maintenance_mode;
2534 }
2535
2536 /* compute and set default and max tx/sds rings */
2537 if (adapter->ahw->msix_supported) {
2538 if (qlcnic_check_multi_tx_capability(adapter) == 1)
2539 qlcnic_set_tx_ring_count(adapter,
2540 QLCNIC_SINGLE_RING);
2541 else
2542 qlcnic_set_tx_ring_count(adapter,
2543 QLCNIC_DEF_TX_RINGS);
2544 qlcnic_set_sds_ring_count(adapter,
2545 QLCNIC_DEF_SDS_RINGS);
2546 } else {
2547 qlcnic_set_tx_ring_count(adapter, QLCNIC_SINGLE_RING);
2548 qlcnic_set_sds_ring_count(adapter, QLCNIC_SINGLE_RING);
2549 }
2550
2551 err = qlcnic_setup_idc_param(adapter);
2552 if (err)
2553 goto err_out_free_hw;
2554
2555 adapter->flags |= QLCNIC_NEED_FLR;
2556
2557 } else if (qlcnic_83xx_check(adapter)) {
2558 qlcnic_83xx_check_vf(adapter, ent);
2559 adapter->portnum = adapter->ahw->pci_func;
2560 err = qlcnic_83xx_init(adapter, pci_using_dac);
2561 if (err) {
2562 switch (err) {
2563 case -ENOTRECOVERABLE:
2564 dev_err(&pdev->dev, "Adapter initialization failed due to a faulty hardware\n");
2565 dev_err(&pdev->dev, "Please replace the adapter with new one and return the faulty adapter for repair\n");
2566 goto err_out_free_hw;
2567 case -ENOMEM:
2568 dev_err(&pdev->dev, "Adapter initialization failed. Please reboot\n");
2569 goto err_out_free_hw;
2570 case -EOPNOTSUPP:
2571 dev_err(&pdev->dev, "Adapter initialization failed\n");
2572 goto err_out_free_hw;
2573 default:
2574 dev_err(&pdev->dev, "Adapter initialization failed. Driver will load in maintenance mode to recover the adapter using the application\n");
2575 goto err_out_maintenance_mode;
2576 }
2577 }
2578
2579 if (qlcnic_sriov_vf_check(adapter))
2580 return 0;
2581 } else {
2582 dev_err(&pdev->dev,
2583 "%s: failed. Please Reboot\n", __func__);
2584 goto err_out_free_hw;
2585 }
2586
2587 if (qlcnic_read_mac_addr(adapter))
2588 dev_warn(&pdev->dev, "failed to read mac addr\n");
2589
2590 qlcnic_read_phys_port_id(adapter);
2591
2592 if (adapter->portnum == 0) {
2593 qlcnic_get_board_name(adapter, board_name);
2594
2595 pr_info("%s: %s Board Chip rev 0x%x\n",
2596 module_name(THIS_MODULE),
2597 board_name, adapter->ahw->revision_id);
2598 }
2599
2600 if (qlcnic_83xx_check(adapter) && !qlcnic_use_msi_x &&
2601 !!qlcnic_use_msi)
2602 dev_warn(&pdev->dev,
2603 "Device does not support MSI interrupts\n");
2604
2605 if (qlcnic_82xx_check(adapter)) {
2606 qlcnic_dcb_enable(adapter->dcb);
2607 qlcnic_dcb_get_info(adapter->dcb);
2608 err = qlcnic_setup_intr(adapter);
2609
2610 if (err) {
2611 dev_err(&pdev->dev, "Failed to setup interrupt\n");
2612 goto err_out_disable_msi;
2613 }
2614 }
2615
2616 err = qlcnic_get_act_pci_func(adapter);
2617 if (err)
2618 goto err_out_disable_mbx_intr;
2619
2620 err = qlcnic_setup_netdev(adapter, netdev, pci_using_dac);
2621 if (err)
2622 goto err_out_disable_mbx_intr;
2623
2624 if (adapter->portnum == 0)
2625 qlcnic_set_drv_version(adapter);
2626
2627 pci_set_drvdata(pdev, adapter);
2628
2629 if (qlcnic_82xx_check(adapter))
2630 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
2631 FW_POLL_DELAY);
2632
2633 switch (adapter->ahw->port_type) {
2634 case QLCNIC_GBE:
2635 dev_info(&adapter->pdev->dev, "%s: GbE port initialized\n",
2636 adapter->netdev->name);
2637 break;
2638 case QLCNIC_XGBE:
2639 dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n",
2640 adapter->netdev->name);
2641 break;
2642 }
2643
2644 if (adapter->drv_mac_learn)
2645 qlcnic_alloc_lb_filters_mem(adapter);
2646
2647 qlcnic_add_sysfs(adapter);
2648 qlcnic_register_hwmon_dev(adapter);
2649 return 0;
2650
2651 err_out_disable_mbx_intr:
2652 if (qlcnic_83xx_check(adapter))
2653 qlcnic_83xx_free_mbx_intr(adapter);
2654
2655 err_out_disable_msi:
2656 qlcnic_teardown_intr(adapter);
2657 qlcnic_cancel_idc_work(adapter);
2658 qlcnic_clr_all_drv_state(adapter, 0);
2659
2660 err_out_free_hw:
2661 qlcnic_free_adapter_resources(adapter);
2662
2663 err_out_free_wq:
2664 destroy_workqueue(adapter->qlcnic_wq);
2665
2666 err_out_free_netdev:
2667 free_netdev(netdev);
2668
2669 err_out_iounmap:
2670 qlcnic_cleanup_pci_map(ahw);
2671
2672 err_out_free_hw_res:
2673 kfree(ahw);
2674
2675 err_out_free_res:
2676 pci_release_regions(pdev);
2677
2678 err_out_disable_pdev:
2679 pci_disable_device(pdev);
2680 return err;
2681
2682 err_out_maintenance_mode:
2683 set_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state);
2684 netdev->netdev_ops = &qlcnic_netdev_failed_ops;
2685 SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_failed_ops);
2686 ahw->port_type = QLCNIC_XGBE;
2687
2688 if (qlcnic_83xx_check(adapter))
2689 adapter->tgt_status_reg = NULL;
2690 else
2691 ahw->board_type = QLCNIC_BRDTYPE_P3P_10G_SFP_PLUS;
2692
2693 err = register_netdev(netdev);
2694
2695 if (err) {
2696 dev_err(&pdev->dev, "Failed to register net device\n");
2697 qlcnic_clr_all_drv_state(adapter, 0);
2698 goto err_out_free_hw;
2699 }
2700
2701 pci_set_drvdata(pdev, adapter);
2702 qlcnic_add_sysfs(adapter);
2703
2704 return 0;
2705 }
2706
2707 static void qlcnic_remove(struct pci_dev *pdev)
2708 {
2709 struct qlcnic_adapter *adapter;
2710 struct net_device *netdev;
2711 struct qlcnic_hardware_context *ahw;
2712
2713 adapter = pci_get_drvdata(pdev);
2714 if (adapter == NULL)
2715 return;
2716
2717 netdev = adapter->netdev;
2718
2719 qlcnic_cancel_idc_work(adapter);
2720 qlcnic_sriov_pf_disable(adapter);
2721 ahw = adapter->ahw;
2722
2723 unregister_netdev(netdev);
2724 qlcnic_sriov_cleanup(adapter);
2725
2726 if (qlcnic_83xx_check(adapter)) {
2727 qlcnic_83xx_initialize_nic(adapter, 0);
2728 cancel_delayed_work_sync(&adapter->idc_aen_work);
2729 qlcnic_83xx_free_mbx_intr(adapter);
2730 qlcnic_83xx_detach_mailbox_work(adapter);
2731 qlcnic_83xx_free_mailbox(ahw->mailbox);
2732 kfree(ahw->fw_info);
2733 }
2734
2735 qlcnic_dcb_free(adapter->dcb);
2736
2737 qlcnic_detach(adapter);
2738
2739 if (adapter->npars != NULL)
2740 kfree(adapter->npars);
2741 if (adapter->eswitch != NULL)
2742 kfree(adapter->eswitch);
2743
2744 if (qlcnic_82xx_check(adapter))
2745 qlcnic_clr_all_drv_state(adapter, 0);
2746
2747 clear_bit(__QLCNIC_RESETTING, &adapter->state);
2748
2749 qlcnic_free_lb_filters_mem(adapter);
2750
2751 qlcnic_teardown_intr(adapter);
2752
2753 qlcnic_remove_sysfs(adapter);
2754
2755 qlcnic_unregister_hwmon_dev(adapter);
2756
2757 qlcnic_cleanup_pci_map(adapter->ahw);
2758
2759 qlcnic_release_firmware(adapter);
2760
2761 pci_disable_pcie_error_reporting(pdev);
2762 pci_release_regions(pdev);
2763 pci_disable_device(pdev);
2764
2765 if (adapter->qlcnic_wq) {
2766 destroy_workqueue(adapter->qlcnic_wq);
2767 adapter->qlcnic_wq = NULL;
2768 }
2769
2770 qlcnic_free_adapter_resources(adapter);
2771 kfree(ahw);
2772 free_netdev(netdev);
2773 }
2774
2775 static void qlcnic_shutdown(struct pci_dev *pdev)
2776 {
2777 if (__qlcnic_shutdown(pdev))
2778 return;
2779
2780 pci_disable_device(pdev);
2781 }
2782
2783 #ifdef CONFIG_PM
2784 static int qlcnic_suspend(struct pci_dev *pdev, pm_message_t state)
2785 {
2786 int retval;
2787
2788 retval = __qlcnic_shutdown(pdev);
2789 if (retval)
2790 return retval;
2791
2792 pci_set_power_state(pdev, pci_choose_state(pdev, state));
2793 return 0;
2794 }
2795
2796 static int qlcnic_resume(struct pci_dev *pdev)
2797 {
2798 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
2799 int err;
2800
2801 err = pci_enable_device(pdev);
2802 if (err)
2803 return err;
2804
2805 pci_set_power_state(pdev, PCI_D0);
2806 pci_set_master(pdev);
2807 pci_restore_state(pdev);
2808
2809 return __qlcnic_resume(adapter);
2810 }
2811 #endif
2812
2813 static int qlcnic_open(struct net_device *netdev)
2814 {
2815 struct qlcnic_adapter *adapter = netdev_priv(netdev);
2816 int err;
2817
2818 if (test_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state)) {
2819 netdev_err(netdev, "%s: Device is in non-operational state\n",
2820 __func__);
2821
2822 return -EIO;
2823 }
2824
2825 netif_carrier_off(netdev);
2826
2827 err = qlcnic_attach(adapter);
2828 if (err)
2829 return err;
2830
2831 err = __qlcnic_up(adapter, netdev);
2832 if (err)
2833 qlcnic_detach(adapter);
2834
2835 return err;
2836 }
2837
2838 /*
2839 * qlcnic_close - Disables a network interface entry point
2840 */
2841 static int qlcnic_close(struct net_device *netdev)
2842 {
2843 struct qlcnic_adapter *adapter = netdev_priv(netdev);
2844
2845 __qlcnic_down(adapter, netdev);
2846
2847 return 0;
2848 }
2849
2850 #define QLCNIC_VF_LB_BUCKET_SIZE 1
2851
2852 void qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter *adapter)
2853 {
2854 void *head;
2855 int i;
2856 struct net_device *netdev = adapter->netdev;
2857 u32 filter_size = 0;
2858 u16 act_pci_func = 0;
2859
2860 if (adapter->fhash.fmax && adapter->fhash.fhead)
2861 return;
2862
2863 act_pci_func = adapter->ahw->total_nic_func;
2864 spin_lock_init(&adapter->mac_learn_lock);
2865 spin_lock_init(&adapter->rx_mac_learn_lock);
2866
2867 if (qlcnic_sriov_vf_check(adapter)) {
2868 filter_size = QLCNIC_83XX_SRIOV_VF_MAX_MAC - 1;
2869 adapter->fhash.fbucket_size = QLCNIC_VF_LB_BUCKET_SIZE;
2870 } else if (qlcnic_82xx_check(adapter)) {
2871 filter_size = QLCNIC_LB_MAX_FILTERS;
2872 adapter->fhash.fbucket_size = QLCNIC_LB_BUCKET_SIZE;
2873 } else {
2874 filter_size = QLC_83XX_LB_MAX_FILTERS;
2875 adapter->fhash.fbucket_size = QLC_83XX_LB_BUCKET_SIZE;
2876 }
2877
2878 head = kcalloc(adapter->fhash.fbucket_size,
2879 sizeof(struct hlist_head), GFP_ATOMIC);
2880
2881 if (!head)
2882 return;
2883
2884 adapter->fhash.fmax = (filter_size / act_pci_func);
2885 adapter->fhash.fhead = head;
2886
2887 netdev_info(netdev, "active nic func = %d, mac filter size=%d\n",
2888 act_pci_func, adapter->fhash.fmax);
2889
2890 for (i = 0; i < adapter->fhash.fbucket_size; i++)
2891 INIT_HLIST_HEAD(&adapter->fhash.fhead[i]);
2892
2893 adapter->rx_fhash.fbucket_size = adapter->fhash.fbucket_size;
2894
2895 head = kcalloc(adapter->rx_fhash.fbucket_size,
2896 sizeof(struct hlist_head), GFP_ATOMIC);
2897
2898 if (!head)
2899 return;
2900
2901 adapter->rx_fhash.fmax = (filter_size / act_pci_func);
2902 adapter->rx_fhash.fhead = head;
2903
2904 for (i = 0; i < adapter->rx_fhash.fbucket_size; i++)
2905 INIT_HLIST_HEAD(&adapter->rx_fhash.fhead[i]);
2906 }
2907
2908 static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter)
2909 {
2910 if (adapter->fhash.fmax && adapter->fhash.fhead)
2911 kfree(adapter->fhash.fhead);
2912
2913 adapter->fhash.fhead = NULL;
2914 adapter->fhash.fmax = 0;
2915
2916 if (adapter->rx_fhash.fmax && adapter->rx_fhash.fhead)
2917 kfree(adapter->rx_fhash.fhead);
2918
2919 adapter->rx_fhash.fmax = 0;
2920 adapter->rx_fhash.fhead = NULL;
2921 }
2922
2923 int qlcnic_check_temp(struct qlcnic_adapter *adapter)
2924 {
2925 struct net_device *netdev = adapter->netdev;
2926 u32 temp_state, temp_val, temp = 0;
2927 int rv = 0;
2928
2929 if (qlcnic_83xx_check(adapter))
2930 temp = QLCRDX(adapter->ahw, QLC_83XX_ASIC_TEMP);
2931
2932 if (qlcnic_82xx_check(adapter))
2933 temp = QLC_SHARED_REG_RD32(adapter, QLCNIC_ASIC_TEMP);
2934
2935 temp_state = qlcnic_get_temp_state(temp);
2936 temp_val = qlcnic_get_temp_val(temp);
2937
2938 if (temp_state == QLCNIC_TEMP_PANIC) {
2939 dev_err(&netdev->dev,
2940 "Device temperature %d degrees C exceeds"
2941 " maximum allowed. Hardware has been shut down.\n",
2942 temp_val);
2943 rv = 1;
2944 } else if (temp_state == QLCNIC_TEMP_WARN) {
2945 if (adapter->ahw->temp == QLCNIC_TEMP_NORMAL) {
2946 dev_err(&netdev->dev,
2947 "Device temperature %d degrees C "
2948 "exceeds operating range."
2949 " Immediate action needed.\n",
2950 temp_val);
2951 }
2952 } else {
2953 if (adapter->ahw->temp == QLCNIC_TEMP_WARN) {
2954 dev_info(&netdev->dev,
2955 "Device temperature is now %d degrees C"
2956 " in normal range.\n", temp_val);
2957 }
2958 }
2959 adapter->ahw->temp = temp_state;
2960 return rv;
2961 }
2962
2963 static inline void dump_tx_ring_desc(struct qlcnic_host_tx_ring *tx_ring)
2964 {
2965 int i;
2966 struct cmd_desc_type0 *tx_desc_info;
2967
2968 for (i = 0; i < tx_ring->num_desc; i++) {
2969 tx_desc_info = &tx_ring->desc_head[i];
2970 pr_info("TX Desc: %d\n", i);
2971 print_hex_dump(KERN_INFO, "TX: ", DUMP_PREFIX_OFFSET, 16, 1,
2972 &tx_ring->desc_head[i],
2973 sizeof(struct cmd_desc_type0), true);
2974 }
2975 }
2976
2977 static void qlcnic_dump_tx_rings(struct qlcnic_adapter *adapter)
2978 {
2979 struct net_device *netdev = adapter->netdev;
2980 struct qlcnic_host_tx_ring *tx_ring;
2981 int ring;
2982
2983 if (!netdev || !netif_running(netdev))
2984 return;
2985
2986 for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2987 tx_ring = &adapter->tx_ring[ring];
2988 netdev_info(netdev, "Tx ring=%d Context Id=0x%x\n",
2989 ring, tx_ring->ctx_id);
2990 netdev_info(netdev,
2991 "xmit_finished=%llu, xmit_called=%llu, xmit_on=%llu, xmit_off=%llu\n",
2992 tx_ring->tx_stats.xmit_finished,
2993 tx_ring->tx_stats.xmit_called,
2994 tx_ring->tx_stats.xmit_on,
2995 tx_ring->tx_stats.xmit_off);
2996
2997 if (tx_ring->crb_intr_mask)
2998 netdev_info(netdev, "crb_intr_mask=%d\n",
2999 readl(tx_ring->crb_intr_mask));
3000
3001 netdev_info(netdev,
3002 "hw_producer=%d, sw_producer=%d sw_consumer=%d, hw_consumer=%d\n",
3003 readl(tx_ring->crb_cmd_producer),
3004 tx_ring->producer, tx_ring->sw_consumer,
3005 le32_to_cpu(*(tx_ring->hw_consumer)));
3006
3007 netdev_info(netdev, "Total desc=%d, Available desc=%d\n",
3008 tx_ring->num_desc, qlcnic_tx_avail(tx_ring));
3009
3010 if (netif_msg_tx_done(adapter->ahw))
3011 dump_tx_ring_desc(tx_ring);
3012 }
3013 }
3014
3015 static void qlcnic_tx_timeout(struct net_device *netdev)
3016 {
3017 struct qlcnic_adapter *adapter = netdev_priv(netdev);
3018
3019 if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3020 return;
3021
3022 if (++adapter->tx_timeo_cnt >= QLCNIC_MAX_TX_TIMEOUTS) {
3023 netdev_info(netdev, "Tx timeout, reset the adapter.\n");
3024 if (qlcnic_82xx_check(adapter))
3025 adapter->need_fw_reset = 1;
3026 else if (qlcnic_83xx_check(adapter))
3027 qlcnic_83xx_idc_request_reset(adapter,
3028 QLCNIC_FORCE_FW_DUMP_KEY);
3029 } else {
3030 netdev_info(netdev, "Tx timeout, reset adapter context.\n");
3031 qlcnic_dump_tx_rings(adapter);
3032 adapter->ahw->reset_context = 1;
3033 }
3034 }
3035
3036 static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev)
3037 {
3038 struct qlcnic_adapter *adapter = netdev_priv(netdev);
3039 struct net_device_stats *stats = &netdev->stats;
3040
3041 if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
3042 qlcnic_update_stats(adapter);
3043
3044 stats->rx_packets = adapter->stats.rx_pkts + adapter->stats.lro_pkts;
3045 stats->tx_packets = adapter->stats.xmitfinished;
3046 stats->rx_bytes = adapter->stats.rxbytes + adapter->stats.lrobytes;
3047 stats->tx_bytes = adapter->stats.txbytes;
3048 stats->rx_dropped = adapter->stats.rxdropped;
3049 stats->tx_dropped = adapter->stats.txdropped;
3050
3051 return stats;
3052 }
3053
3054 static irqreturn_t qlcnic_82xx_clear_legacy_intr(struct qlcnic_adapter *adapter)
3055 {
3056 u32 status;
3057
3058 status = readl(adapter->isr_int_vec);
3059
3060 if (!(status & adapter->ahw->int_vec_bit))
3061 return IRQ_NONE;
3062
3063 /* check interrupt state machine, to be sure */
3064 status = readl(adapter->crb_int_state_reg);
3065 if (!ISR_LEGACY_INT_TRIGGERED(status))
3066 return IRQ_NONE;
3067
3068 writel(0xffffffff, adapter->tgt_status_reg);
3069 /* read twice to ensure write is flushed */
3070 readl(adapter->isr_int_vec);
3071 readl(adapter->isr_int_vec);
3072
3073 return IRQ_HANDLED;
3074 }
3075
3076 static irqreturn_t qlcnic_tmp_intr(int irq, void *data)
3077 {
3078 struct qlcnic_host_sds_ring *sds_ring = data;
3079 struct qlcnic_adapter *adapter = sds_ring->adapter;
3080
3081 if (adapter->flags & QLCNIC_MSIX_ENABLED)
3082 goto done;
3083 else if (adapter->flags & QLCNIC_MSI_ENABLED) {
3084 writel(0xffffffff, adapter->tgt_status_reg);
3085 goto done;
3086 }
3087
3088 if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
3089 return IRQ_NONE;
3090
3091 done:
3092 adapter->ahw->diag_cnt++;
3093 qlcnic_enable_sds_intr(adapter, sds_ring);
3094 return IRQ_HANDLED;
3095 }
3096
3097 static irqreturn_t qlcnic_intr(int irq, void *data)
3098 {
3099 struct qlcnic_host_sds_ring *sds_ring = data;
3100 struct qlcnic_adapter *adapter = sds_ring->adapter;
3101
3102 if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
3103 return IRQ_NONE;
3104
3105 napi_schedule(&sds_ring->napi);
3106
3107 return IRQ_HANDLED;
3108 }
3109
3110 static irqreturn_t qlcnic_msi_intr(int irq, void *data)
3111 {
3112 struct qlcnic_host_sds_ring *sds_ring = data;
3113 struct qlcnic_adapter *adapter = sds_ring->adapter;
3114
3115 /* clear interrupt */
3116 writel(0xffffffff, adapter->tgt_status_reg);
3117
3118 napi_schedule(&sds_ring->napi);
3119 return IRQ_HANDLED;
3120 }
3121
3122 static irqreturn_t qlcnic_msix_intr(int irq, void *data)
3123 {
3124 struct qlcnic_host_sds_ring *sds_ring = data;
3125
3126 napi_schedule(&sds_ring->napi);
3127 return IRQ_HANDLED;
3128 }
3129
3130 static irqreturn_t qlcnic_msix_tx_intr(int irq, void *data)
3131 {
3132 struct qlcnic_host_tx_ring *tx_ring = data;
3133
3134 napi_schedule(&tx_ring->napi);
3135 return IRQ_HANDLED;
3136 }
3137
3138 #ifdef CONFIG_NET_POLL_CONTROLLER
3139 static void qlcnic_poll_controller(struct net_device *netdev)
3140 {
3141 struct qlcnic_adapter *adapter = netdev_priv(netdev);
3142 struct qlcnic_host_sds_ring *sds_ring;
3143 struct qlcnic_recv_context *recv_ctx;
3144 struct qlcnic_host_tx_ring *tx_ring;
3145 int ring;
3146
3147 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
3148 return;
3149
3150 recv_ctx = adapter->recv_ctx;
3151
3152 for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
3153 sds_ring = &recv_ctx->sds_rings[ring];
3154 qlcnic_disable_sds_intr(adapter, sds_ring);
3155 napi_schedule(&sds_ring->napi);
3156 }
3157
3158 if (adapter->flags & QLCNIC_MSIX_ENABLED) {
3159 /* Only Multi-Tx queue capable devices need to
3160 * schedule NAPI for TX rings
3161 */
3162 if ((qlcnic_83xx_check(adapter) &&
3163 (adapter->flags & QLCNIC_TX_INTR_SHARED)) ||
3164 (qlcnic_82xx_check(adapter) &&
3165 !qlcnic_check_multi_tx(adapter)))
3166 return;
3167
3168 for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
3169 tx_ring = &adapter->tx_ring[ring];
3170 qlcnic_disable_tx_intr(adapter, tx_ring);
3171 napi_schedule(&tx_ring->napi);
3172 }
3173 }
3174 }
3175 #endif
3176
3177 static void
3178 qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding)
3179 {
3180 u32 val;
3181
3182 val = adapter->portnum & 0xf;
3183 val |= encoding << 7;
3184 val |= (jiffies - adapter->dev_rst_time) << 8;
3185
3186 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_SCRATCH, val);
3187 adapter->dev_rst_time = jiffies;
3188 }
3189
3190 static int
3191 qlcnic_set_drv_state(struct qlcnic_adapter *adapter, u8 state)
3192 {
3193 u32 val;
3194
3195 WARN_ON(state != QLCNIC_DEV_NEED_RESET &&
3196 state != QLCNIC_DEV_NEED_QUISCENT);
3197
3198 if (qlcnic_api_lock(adapter))
3199 return -EIO;
3200
3201 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3202
3203 if (state == QLCNIC_DEV_NEED_RESET)
3204 QLC_DEV_SET_RST_RDY(val, adapter->portnum);
3205 else if (state == QLCNIC_DEV_NEED_QUISCENT)
3206 QLC_DEV_SET_QSCNT_RDY(val, adapter->portnum);
3207
3208 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3209
3210 qlcnic_api_unlock(adapter);
3211
3212 return 0;
3213 }
3214
3215 static int
3216 qlcnic_clr_drv_state(struct qlcnic_adapter *adapter)
3217 {
3218 u32 val;
3219
3220 if (qlcnic_api_lock(adapter))
3221 return -EBUSY;
3222
3223 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3224 QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
3225 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3226
3227 qlcnic_api_unlock(adapter);
3228
3229 return 0;
3230 }
3231
3232 void qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8 failed)
3233 {
3234 u32 val;
3235
3236 if (qlcnic_api_lock(adapter))
3237 goto err;
3238
3239 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3240 QLC_DEV_CLR_REF_CNT(val, adapter->portnum);
3241 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
3242
3243 if (failed) {
3244 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3245 QLCNIC_DEV_FAILED);
3246 dev_info(&adapter->pdev->dev,
3247 "Device state set to Failed. Please Reboot\n");
3248 } else if (!(val & 0x11111111))
3249 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3250 QLCNIC_DEV_COLD);
3251
3252 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3253 QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
3254 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3255
3256 qlcnic_api_unlock(adapter);
3257 err:
3258 adapter->fw_fail_cnt = 0;
3259 adapter->flags &= ~QLCNIC_FW_HANG;
3260 clear_bit(__QLCNIC_START_FW, &adapter->state);
3261 clear_bit(__QLCNIC_RESETTING, &adapter->state);
3262 }
3263
3264 /* Grab api lock, before checking state */
3265 static int
3266 qlcnic_check_drv_state(struct qlcnic_adapter *adapter)
3267 {
3268 int act, state, active_mask;
3269 struct qlcnic_hardware_context *ahw = adapter->ahw;
3270
3271 state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3272 act = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3273
3274 if (adapter->flags & QLCNIC_FW_RESET_OWNER) {
3275 active_mask = (~(1 << (ahw->pci_func * 4)));
3276 act = act & active_mask;
3277 }
3278
3279 if (((state & 0x11111111) == (act & 0x11111111)) ||
3280 ((act & 0x11111111) == ((state >> 1) & 0x11111111)))
3281 return 0;
3282 else
3283 return 1;
3284 }
3285
3286 static int qlcnic_check_idc_ver(struct qlcnic_adapter *adapter)
3287 {
3288 u32 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_IDC_VER);
3289
3290 if (val != QLCNIC_DRV_IDC_VER) {
3291 dev_warn(&adapter->pdev->dev, "IDC Version mismatch, driver's"
3292 " idc ver = %x; reqd = %x\n", QLCNIC_DRV_IDC_VER, val);
3293 }
3294
3295 return 0;
3296 }
3297
3298 static int
3299 qlcnic_can_start_firmware(struct qlcnic_adapter *adapter)
3300 {
3301 u32 val, prev_state;
3302 u8 dev_init_timeo = adapter->dev_init_timeo;
3303 u8 portnum = adapter->portnum;
3304 u8 ret;
3305
3306 if (test_and_clear_bit(__QLCNIC_START_FW, &adapter->state))
3307 return 1;
3308
3309 if (qlcnic_api_lock(adapter))
3310 return -1;
3311
3312 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3313 if (!(val & (1 << (portnum * 4)))) {
3314 QLC_DEV_SET_REF_CNT(val, portnum);
3315 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
3316 }
3317
3318 prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3319 QLCDB(adapter, HW, "Device state = %u\n", prev_state);
3320
3321 switch (prev_state) {
3322 case QLCNIC_DEV_COLD:
3323 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3324 QLCNIC_DEV_INITIALIZING);
3325 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_IDC_VER,
3326 QLCNIC_DRV_IDC_VER);
3327 qlcnic_idc_debug_info(adapter, 0);
3328 qlcnic_api_unlock(adapter);
3329 return 1;
3330
3331 case QLCNIC_DEV_READY:
3332 ret = qlcnic_check_idc_ver(adapter);
3333 qlcnic_api_unlock(adapter);
3334 return ret;
3335
3336 case QLCNIC_DEV_NEED_RESET:
3337 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3338 QLC_DEV_SET_RST_RDY(val, portnum);
3339 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3340 break;
3341
3342 case QLCNIC_DEV_NEED_QUISCENT:
3343 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3344 QLC_DEV_SET_QSCNT_RDY(val, portnum);
3345 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3346 break;
3347
3348 case QLCNIC_DEV_FAILED:
3349 dev_err(&adapter->pdev->dev, "Device in failed state.\n");
3350 qlcnic_api_unlock(adapter);
3351 return -1;
3352
3353 case QLCNIC_DEV_INITIALIZING:
3354 case QLCNIC_DEV_QUISCENT:
3355 break;
3356 }
3357
3358 qlcnic_api_unlock(adapter);
3359
3360 do {
3361 msleep(1000);
3362 prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3363
3364 if (prev_state == QLCNIC_DEV_QUISCENT)
3365 continue;
3366 } while ((prev_state != QLCNIC_DEV_READY) && --dev_init_timeo);
3367
3368 if (!dev_init_timeo) {
3369 dev_err(&adapter->pdev->dev,
3370 "Waiting for device to initialize timeout\n");
3371 return -1;
3372 }
3373
3374 if (qlcnic_api_lock(adapter))
3375 return -1;
3376
3377 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3378 QLC_DEV_CLR_RST_QSCNT(val, portnum);
3379 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3380
3381 ret = qlcnic_check_idc_ver(adapter);
3382 qlcnic_api_unlock(adapter);
3383
3384 return ret;
3385 }
3386
3387 static void
3388 qlcnic_fwinit_work(struct work_struct *work)
3389 {
3390 struct qlcnic_adapter *adapter = container_of(work,
3391 struct qlcnic_adapter, fw_work.work);
3392 u32 dev_state = 0xf;
3393 u32 val;
3394
3395 if (qlcnic_api_lock(adapter))
3396 goto err_ret;
3397
3398 dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3399 if (dev_state == QLCNIC_DEV_QUISCENT ||
3400 dev_state == QLCNIC_DEV_NEED_QUISCENT) {
3401 qlcnic_api_unlock(adapter);
3402 qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
3403 FW_POLL_DELAY * 2);
3404 return;
3405 }
3406
3407 if (adapter->ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
3408 qlcnic_api_unlock(adapter);
3409 goto wait_npar;
3410 }
3411
3412 if (dev_state == QLCNIC_DEV_INITIALIZING ||
3413 dev_state == QLCNIC_DEV_READY) {
3414 dev_info(&adapter->pdev->dev, "Detected state change from "
3415 "DEV_NEED_RESET, skipping ack check\n");
3416 goto skip_ack_check;
3417 }
3418
3419 if (adapter->fw_wait_cnt++ > adapter->reset_ack_timeo) {
3420 dev_info(&adapter->pdev->dev, "Reset:Failed to get ack %d sec\n",
3421 adapter->reset_ack_timeo);
3422 goto skip_ack_check;
3423 }
3424
3425 if (!qlcnic_check_drv_state(adapter)) {
3426 skip_ack_check:
3427 dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3428
3429 if (dev_state == QLCNIC_DEV_NEED_RESET) {
3430 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3431 QLCNIC_DEV_INITIALIZING);
3432 set_bit(__QLCNIC_START_FW, &adapter->state);
3433 QLCDB(adapter, DRV, "Restarting fw\n");
3434 qlcnic_idc_debug_info(adapter, 0);
3435 val = QLC_SHARED_REG_RD32(adapter,
3436 QLCNIC_CRB_DRV_STATE);
3437 QLC_DEV_SET_RST_RDY(val, adapter->portnum);
3438 QLC_SHARED_REG_WR32(adapter,
3439 QLCNIC_CRB_DRV_STATE, val);
3440 }
3441
3442 qlcnic_api_unlock(adapter);
3443
3444 rtnl_lock();
3445 if (qlcnic_check_fw_dump_state(adapter) &&
3446 (adapter->flags & QLCNIC_FW_RESET_OWNER)) {
3447 QLCDB(adapter, DRV, "Take FW dump\n");
3448 qlcnic_dump_fw(adapter);
3449 adapter->flags |= QLCNIC_FW_HANG;
3450 }
3451 rtnl_unlock();
3452
3453 adapter->flags &= ~QLCNIC_FW_RESET_OWNER;
3454 if (!adapter->nic_ops->start_firmware(adapter)) {
3455 qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
3456 adapter->fw_wait_cnt = 0;
3457 return;
3458 }
3459 goto err_ret;
3460 }
3461
3462 qlcnic_api_unlock(adapter);
3463
3464 wait_npar:
3465 dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3466 QLCDB(adapter, HW, "Func waiting: Device state=%u\n", dev_state);
3467
3468 switch (dev_state) {
3469 case QLCNIC_DEV_READY:
3470 if (!qlcnic_start_firmware(adapter)) {
3471 qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
3472 adapter->fw_wait_cnt = 0;
3473 return;
3474 }
3475 case QLCNIC_DEV_FAILED:
3476 break;
3477 default:
3478 qlcnic_schedule_work(adapter,
3479 qlcnic_fwinit_work, FW_POLL_DELAY);
3480 return;
3481 }
3482
3483 err_ret:
3484 dev_err(&adapter->pdev->dev, "Fwinit work failed state=%u "
3485 "fw_wait_cnt=%u\n", dev_state, adapter->fw_wait_cnt);
3486 netif_device_attach(adapter->netdev);
3487 qlcnic_clr_all_drv_state(adapter, 0);
3488 }
3489
3490 static void
3491 qlcnic_detach_work(struct work_struct *work)
3492 {
3493 struct qlcnic_adapter *adapter = container_of(work,
3494 struct qlcnic_adapter, fw_work.work);
3495 struct net_device *netdev = adapter->netdev;
3496 u32 status;
3497
3498 netif_device_detach(netdev);
3499
3500 /* Dont grab rtnl lock during Quiscent mode */
3501 if (adapter->dev_state == QLCNIC_DEV_NEED_QUISCENT) {
3502 if (netif_running(netdev))
3503 __qlcnic_down(adapter, netdev);
3504 } else
3505 qlcnic_down(adapter, netdev);
3506
3507 status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
3508
3509 if (status & QLCNIC_RCODE_FATAL_ERROR) {
3510 dev_err(&adapter->pdev->dev,
3511 "Detaching the device: peg halt status1=0x%x\n",
3512 status);
3513
3514 if (QLCNIC_FWERROR_CODE(status) == QLCNIC_FWERROR_FAN_FAILURE) {
3515 dev_err(&adapter->pdev->dev,
3516 "On board active cooling fan failed. "
3517 "Device has been halted.\n");
3518 dev_err(&adapter->pdev->dev,
3519 "Replace the adapter.\n");
3520 }
3521
3522 goto err_ret;
3523 }
3524
3525 if (adapter->ahw->temp == QLCNIC_TEMP_PANIC) {
3526 dev_err(&adapter->pdev->dev, "Detaching the device: temp=%d\n",
3527 adapter->ahw->temp);
3528 goto err_ret;
3529 }
3530
3531 /* Dont ack if this instance is the reset owner */
3532 if (!(adapter->flags & QLCNIC_FW_RESET_OWNER)) {
3533 if (qlcnic_set_drv_state(adapter, adapter->dev_state)) {
3534 dev_err(&adapter->pdev->dev,
3535 "Failed to set driver state,"
3536 "detaching the device.\n");
3537 goto err_ret;
3538 }
3539 }
3540
3541 adapter->fw_wait_cnt = 0;
3542
3543 qlcnic_schedule_work(adapter, qlcnic_fwinit_work, FW_POLL_DELAY);
3544
3545 return;
3546
3547 err_ret:
3548 netif_device_attach(netdev);
3549 qlcnic_clr_all_drv_state(adapter, 1);
3550 }
3551
3552 /*Transit NPAR state to NON Operational */
3553 static void
3554 qlcnic_set_npar_non_operational(struct qlcnic_adapter *adapter)
3555 {
3556 u32 state;
3557
3558 state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
3559 if (state == QLCNIC_DEV_NPAR_NON_OPER)
3560 return;
3561
3562 if (qlcnic_api_lock(adapter))
3563 return;
3564 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3565 QLCNIC_DEV_NPAR_NON_OPER);
3566 qlcnic_api_unlock(adapter);
3567 }
3568
3569 static void qlcnic_82xx_dev_request_reset(struct qlcnic_adapter *adapter,
3570 u32 key)
3571 {
3572 u32 state, xg_val = 0, gb_val = 0;
3573
3574 qlcnic_xg_set_xg0_mask(xg_val);
3575 qlcnic_xg_set_xg1_mask(xg_val);
3576 QLCWR32(adapter, QLCNIC_NIU_XG_PAUSE_CTL, xg_val);
3577 qlcnic_gb_set_gb0_mask(gb_val);
3578 qlcnic_gb_set_gb1_mask(gb_val);
3579 qlcnic_gb_set_gb2_mask(gb_val);
3580 qlcnic_gb_set_gb3_mask(gb_val);
3581 QLCWR32(adapter, QLCNIC_NIU_GB_PAUSE_CTL, gb_val);
3582 dev_info(&adapter->pdev->dev, "Pause control frames disabled"
3583 " on all ports\n");
3584 adapter->need_fw_reset = 1;
3585
3586 if (qlcnic_api_lock(adapter))
3587 return;
3588
3589 state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3590
3591 if (test_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state)) {
3592 netdev_err(adapter->netdev, "%s: Device is in non-operational state\n",
3593 __func__);
3594 qlcnic_api_unlock(adapter);
3595
3596 return;
3597 }
3598
3599 if (state == QLCNIC_DEV_READY) {
3600 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3601 QLCNIC_DEV_NEED_RESET);
3602 adapter->flags |= QLCNIC_FW_RESET_OWNER;
3603 QLCDB(adapter, DRV, "NEED_RESET state set\n");
3604 qlcnic_idc_debug_info(adapter, 0);
3605 }
3606
3607 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3608 QLCNIC_DEV_NPAR_NON_OPER);
3609 qlcnic_api_unlock(adapter);
3610 }
3611
3612 /* Transit to NPAR READY state from NPAR NOT READY state */
3613 static void
3614 qlcnic_dev_set_npar_ready(struct qlcnic_adapter *adapter)
3615 {
3616 if (qlcnic_api_lock(adapter))
3617 return;
3618
3619 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3620 QLCNIC_DEV_NPAR_OPER);
3621 QLCDB(adapter, DRV, "NPAR operational state set\n");
3622
3623 qlcnic_api_unlock(adapter);
3624 }
3625
3626 void qlcnic_schedule_work(struct qlcnic_adapter *adapter,
3627 work_func_t func, int delay)
3628 {
3629 if (test_bit(__QLCNIC_AER, &adapter->state))
3630 return;
3631
3632 INIT_DELAYED_WORK(&adapter->fw_work, func);
3633 queue_delayed_work(adapter->qlcnic_wq, &adapter->fw_work,
3634 round_jiffies_relative(delay));
3635 }
3636
3637 static void
3638 qlcnic_attach_work(struct work_struct *work)
3639 {
3640 struct qlcnic_adapter *adapter = container_of(work,
3641 struct qlcnic_adapter, fw_work.work);
3642 struct net_device *netdev = adapter->netdev;
3643 u32 npar_state;
3644
3645 if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
3646 npar_state = QLC_SHARED_REG_RD32(adapter,
3647 QLCNIC_CRB_DEV_NPAR_STATE);
3648 if (adapter->fw_wait_cnt++ > QLCNIC_DEV_NPAR_OPER_TIMEO)
3649 qlcnic_clr_all_drv_state(adapter, 0);
3650 else if (npar_state != QLCNIC_DEV_NPAR_OPER)
3651 qlcnic_schedule_work(adapter, qlcnic_attach_work,
3652 FW_POLL_DELAY);
3653 else
3654 goto attach;
3655 QLCDB(adapter, DRV, "Waiting for NPAR state to operational\n");
3656 return;
3657 }
3658 attach:
3659 qlcnic_dcb_get_info(adapter->dcb);
3660
3661 if (netif_running(netdev)) {
3662 if (qlcnic_up(adapter, netdev))
3663 goto done;
3664
3665 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3666 }
3667
3668 done:
3669 netif_device_attach(netdev);
3670 adapter->fw_fail_cnt = 0;
3671 adapter->flags &= ~QLCNIC_FW_HANG;
3672 clear_bit(__QLCNIC_RESETTING, &adapter->state);
3673 if (adapter->portnum == 0)
3674 qlcnic_set_drv_version(adapter);
3675
3676 if (!qlcnic_clr_drv_state(adapter))
3677 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3678 FW_POLL_DELAY);
3679 }
3680
3681 static int
3682 qlcnic_check_health(struct qlcnic_adapter *adapter)
3683 {
3684 struct qlcnic_hardware_context *ahw = adapter->ahw;
3685 struct qlcnic_fw_dump *fw_dump = &ahw->fw_dump;
3686 u32 state = 0, heartbeat;
3687 u32 peg_status;
3688 int err = 0;
3689
3690 if (qlcnic_check_temp(adapter))
3691 goto detach;
3692
3693 if (adapter->need_fw_reset)
3694 qlcnic_dev_request_reset(adapter, 0);
3695
3696 state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3697 if (state == QLCNIC_DEV_NEED_RESET) {
3698 qlcnic_set_npar_non_operational(adapter);
3699 adapter->need_fw_reset = 1;
3700 } else if (state == QLCNIC_DEV_NEED_QUISCENT)
3701 goto detach;
3702
3703 heartbeat = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_ALIVE_COUNTER);
3704 if (heartbeat != adapter->heartbeat) {
3705 adapter->heartbeat = heartbeat;
3706 adapter->fw_fail_cnt = 0;
3707 if (adapter->need_fw_reset)
3708 goto detach;
3709
3710 if (ahw->reset_context && qlcnic_auto_fw_reset)
3711 qlcnic_reset_hw_context(adapter);
3712
3713 return 0;
3714 }
3715
3716 if (++adapter->fw_fail_cnt < FW_FAIL_THRESH)
3717 return 0;
3718
3719 adapter->flags |= QLCNIC_FW_HANG;
3720
3721 qlcnic_dev_request_reset(adapter, 0);
3722
3723 if (qlcnic_auto_fw_reset)
3724 clear_bit(__QLCNIC_FW_ATTACHED, &adapter->state);
3725
3726 dev_err(&adapter->pdev->dev, "firmware hang detected\n");
3727 peg_status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
3728 dev_err(&adapter->pdev->dev, "Dumping hw/fw registers\n"
3729 "PEG_HALT_STATUS1: 0x%x, PEG_HALT_STATUS2: 0x%x,\n"
3730 "PEG_NET_0_PC: 0x%x, PEG_NET_1_PC: 0x%x,\n"
3731 "PEG_NET_2_PC: 0x%x, PEG_NET_3_PC: 0x%x,\n"
3732 "PEG_NET_4_PC: 0x%x\n",
3733 peg_status,
3734 QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS2),
3735 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_0 + 0x3c, &err),
3736 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_1 + 0x3c, &err),
3737 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_2 + 0x3c, &err),
3738 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_3 + 0x3c, &err),
3739 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_4 + 0x3c, &err));
3740 if (QLCNIC_FWERROR_CODE(peg_status) == 0x67)
3741 dev_err(&adapter->pdev->dev,
3742 "Firmware aborted with error code 0x00006700. "
3743 "Device is being reset.\n");
3744 detach:
3745 adapter->dev_state = (state == QLCNIC_DEV_NEED_QUISCENT) ? state :
3746 QLCNIC_DEV_NEED_RESET;
3747
3748 if (qlcnic_auto_fw_reset && !test_and_set_bit(__QLCNIC_RESETTING,
3749 &adapter->state)) {
3750
3751 qlcnic_schedule_work(adapter, qlcnic_detach_work, 0);
3752 QLCDB(adapter, DRV, "fw recovery scheduled.\n");
3753 } else if (!qlcnic_auto_fw_reset && fw_dump->enable &&
3754 adapter->flags & QLCNIC_FW_RESET_OWNER) {
3755 qlcnic_dump_fw(adapter);
3756 }
3757
3758 return 1;
3759 }
3760
3761 void qlcnic_fw_poll_work(struct work_struct *work)
3762 {
3763 struct qlcnic_adapter *adapter = container_of(work,
3764 struct qlcnic_adapter, fw_work.work);
3765
3766 if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3767 goto reschedule;
3768
3769
3770 if (qlcnic_check_health(adapter))
3771 return;
3772
3773 if (adapter->fhash.fnum)
3774 qlcnic_prune_lb_filters(adapter);
3775
3776 reschedule:
3777 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
3778 }
3779
3780 static int qlcnic_is_first_func(struct pci_dev *pdev)
3781 {
3782 struct pci_dev *oth_pdev;
3783 int val = pdev->devfn;
3784
3785 while (val-- > 0) {
3786 oth_pdev = pci_get_domain_bus_and_slot(pci_domain_nr
3787 (pdev->bus), pdev->bus->number,
3788 PCI_DEVFN(PCI_SLOT(pdev->devfn), val));
3789 if (!oth_pdev)
3790 continue;
3791
3792 if (oth_pdev->current_state != PCI_D3cold) {
3793 pci_dev_put(oth_pdev);
3794 return 0;
3795 }
3796 pci_dev_put(oth_pdev);
3797 }
3798 return 1;
3799 }
3800
3801 static int qlcnic_attach_func(struct pci_dev *pdev)
3802 {
3803 int err, first_func;
3804 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3805 struct net_device *netdev = adapter->netdev;
3806
3807 pdev->error_state = pci_channel_io_normal;
3808
3809 err = pci_enable_device(pdev);
3810 if (err)
3811 return err;
3812
3813 pci_set_master(pdev);
3814 pci_restore_state(pdev);
3815
3816 first_func = qlcnic_is_first_func(pdev);
3817
3818 if (qlcnic_api_lock(adapter))
3819 return -EINVAL;
3820
3821 if (adapter->ahw->op_mode != QLCNIC_NON_PRIV_FUNC && first_func) {
3822 adapter->need_fw_reset = 1;
3823 set_bit(__QLCNIC_START_FW, &adapter->state);
3824 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3825 QLCNIC_DEV_INITIALIZING);
3826 QLCDB(adapter, DRV, "Restarting fw\n");
3827 }
3828 qlcnic_api_unlock(adapter);
3829
3830 err = qlcnic_start_firmware(adapter);
3831 if (err)
3832 return err;
3833
3834 qlcnic_clr_drv_state(adapter);
3835 kfree(adapter->msix_entries);
3836 adapter->msix_entries = NULL;
3837 err = qlcnic_setup_intr(adapter);
3838
3839 if (err) {
3840 kfree(adapter->msix_entries);
3841 netdev_err(netdev, "failed to setup interrupt\n");
3842 return err;
3843 }
3844
3845 if (netif_running(netdev)) {
3846 err = qlcnic_attach(adapter);
3847 if (err) {
3848 qlcnic_clr_all_drv_state(adapter, 1);
3849 clear_bit(__QLCNIC_AER, &adapter->state);
3850 netif_device_attach(netdev);
3851 return err;
3852 }
3853
3854 err = qlcnic_up(adapter, netdev);
3855 if (err)
3856 goto done;
3857
3858 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3859 }
3860 done:
3861 netif_device_attach(netdev);
3862 return err;
3863 }
3864
3865 static pci_ers_result_t qlcnic_82xx_io_error_detected(struct pci_dev *pdev,
3866 pci_channel_state_t state)
3867 {
3868 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3869 struct net_device *netdev = adapter->netdev;
3870
3871 if (state == pci_channel_io_perm_failure)
3872 return PCI_ERS_RESULT_DISCONNECT;
3873
3874 if (state == pci_channel_io_normal)
3875 return PCI_ERS_RESULT_RECOVERED;
3876
3877 set_bit(__QLCNIC_AER, &adapter->state);
3878 netif_device_detach(netdev);
3879
3880 cancel_delayed_work_sync(&adapter->fw_work);
3881
3882 if (netif_running(netdev))
3883 qlcnic_down(adapter, netdev);
3884
3885 qlcnic_detach(adapter);
3886 qlcnic_teardown_intr(adapter);
3887
3888 clear_bit(__QLCNIC_RESETTING, &adapter->state);
3889
3890 pci_save_state(pdev);
3891 pci_disable_device(pdev);
3892
3893 return PCI_ERS_RESULT_NEED_RESET;
3894 }
3895
3896 static pci_ers_result_t qlcnic_82xx_io_slot_reset(struct pci_dev *pdev)
3897 {
3898 return qlcnic_attach_func(pdev) ? PCI_ERS_RESULT_DISCONNECT :
3899 PCI_ERS_RESULT_RECOVERED;
3900 }
3901
3902 static void qlcnic_82xx_io_resume(struct pci_dev *pdev)
3903 {
3904 u32 state;
3905 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3906
3907 pci_cleanup_aer_uncorrect_error_status(pdev);
3908 state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3909 if (state == QLCNIC_DEV_READY && test_and_clear_bit(__QLCNIC_AER,
3910 &adapter->state))
3911 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3912 FW_POLL_DELAY);
3913 }
3914
3915 static pci_ers_result_t qlcnic_io_error_detected(struct pci_dev *pdev,
3916 pci_channel_state_t state)
3917 {
3918 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3919 struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
3920
3921 if (hw_ops->io_error_detected) {
3922 return hw_ops->io_error_detected(pdev, state);
3923 } else {
3924 dev_err(&pdev->dev, "AER error_detected handler not registered.\n");
3925 return PCI_ERS_RESULT_DISCONNECT;
3926 }
3927 }
3928
3929 static pci_ers_result_t qlcnic_io_slot_reset(struct pci_dev *pdev)
3930 {
3931 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3932 struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
3933
3934 if (hw_ops->io_slot_reset) {
3935 return hw_ops->io_slot_reset(pdev);
3936 } else {
3937 dev_err(&pdev->dev, "AER slot_reset handler not registered.\n");
3938 return PCI_ERS_RESULT_DISCONNECT;
3939 }
3940 }
3941
3942 static void qlcnic_io_resume(struct pci_dev *pdev)
3943 {
3944 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3945 struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
3946
3947 if (hw_ops->io_resume)
3948 hw_ops->io_resume(pdev);
3949 else
3950 dev_err(&pdev->dev, "AER resume handler not registered.\n");
3951 }
3952
3953
3954 static int
3955 qlcnicvf_start_firmware(struct qlcnic_adapter *adapter)
3956 {
3957 int err;
3958
3959 err = qlcnic_can_start_firmware(adapter);
3960 if (err)
3961 return err;
3962
3963 err = qlcnic_check_npar_opertional(adapter);
3964 if (err)
3965 return err;
3966
3967 err = qlcnic_initialize_nic(adapter);
3968 if (err)
3969 return err;
3970
3971 qlcnic_check_options(adapter);
3972
3973 err = qlcnic_set_eswitch_port_config(adapter);
3974 if (err)
3975 return err;
3976
3977 adapter->need_fw_reset = 0;
3978
3979 return err;
3980 }
3981
3982 int qlcnic_validate_rings(struct qlcnic_adapter *adapter, __u32 ring_cnt,
3983 int queue_type)
3984 {
3985 struct net_device *netdev = adapter->netdev;
3986 u8 max_hw_rings = 0;
3987 char buf[8];
3988 int cur_rings;
3989
3990 if (queue_type == QLCNIC_RX_QUEUE) {
3991 max_hw_rings = adapter->max_sds_rings;
3992 cur_rings = adapter->drv_sds_rings;
3993 strcpy(buf, "SDS");
3994 } else if (queue_type == QLCNIC_TX_QUEUE) {
3995 max_hw_rings = adapter->max_tx_rings;
3996 cur_rings = adapter->drv_tx_rings;
3997 strcpy(buf, "Tx");
3998 }
3999
4000 if (!QLCNIC_IS_MSI_FAMILY(adapter)) {
4001 netdev_err(netdev, "No RSS/TSS support in INT-x mode\n");
4002 return -EINVAL;
4003 }
4004
4005 if (adapter->flags & QLCNIC_MSI_ENABLED) {
4006 netdev_err(netdev, "No RSS/TSS support in MSI mode\n");
4007 return -EINVAL;
4008 }
4009
4010 if (!is_power_of_2(ring_cnt)) {
4011 netdev_err(netdev, "%s rings value should be a power of 2\n",
4012 buf);
4013 return -EINVAL;
4014 }
4015
4016 if (qlcnic_82xx_check(adapter) && (queue_type == QLCNIC_TX_QUEUE) &&
4017 !qlcnic_check_multi_tx(adapter)) {
4018 netdev_err(netdev, "No Multi Tx queue support\n");
4019 return -EINVAL;
4020 }
4021
4022 if (ring_cnt > num_online_cpus()) {
4023 netdev_err(netdev,
4024 "%s value[%u] should not be higher than, number of online CPUs\n",
4025 buf, num_online_cpus());
4026 return -EINVAL;
4027 }
4028
4029 return 0;
4030 }
4031
4032 int qlcnic_setup_rings(struct qlcnic_adapter *adapter)
4033 {
4034 struct net_device *netdev = adapter->netdev;
4035 u8 tx_rings, rx_rings;
4036 int err;
4037
4038 if (test_bit(__QLCNIC_RESETTING, &adapter->state))
4039 return -EBUSY;
4040
4041 tx_rings = adapter->drv_tss_rings;
4042 rx_rings = adapter->drv_rss_rings;
4043
4044 netif_device_detach(netdev);
4045
4046 err = qlcnic_set_real_num_queues(adapter, tx_rings, rx_rings);
4047 if (err)
4048 goto done;
4049
4050 if (netif_running(netdev))
4051 __qlcnic_down(adapter, netdev);
4052
4053 qlcnic_detach(adapter);
4054
4055 if (qlcnic_83xx_check(adapter)) {
4056 qlcnic_83xx_free_mbx_intr(adapter);
4057 qlcnic_83xx_enable_mbx_poll(adapter);
4058 }
4059
4060 qlcnic_teardown_intr(adapter);
4061
4062 err = qlcnic_setup_intr(adapter);
4063 if (err) {
4064 kfree(adapter->msix_entries);
4065 netdev_err(netdev, "failed to setup interrupt\n");
4066 return err;
4067 }
4068
4069 /* Check if we need to update real_num_{tx|rx}_queues because
4070 * qlcnic_setup_intr() may change Tx/Rx rings size
4071 */
4072 if ((tx_rings != adapter->drv_tx_rings) ||
4073 (rx_rings != adapter->drv_sds_rings)) {
4074 err = qlcnic_set_real_num_queues(adapter,
4075 adapter->drv_tx_rings,
4076 adapter->drv_sds_rings);
4077 if (err)
4078 goto done;
4079 }
4080
4081 if (qlcnic_83xx_check(adapter)) {
4082 qlcnic_83xx_initialize_nic(adapter, 1);
4083 err = qlcnic_83xx_setup_mbx_intr(adapter);
4084 qlcnic_83xx_disable_mbx_poll(adapter);
4085 if (err) {
4086 dev_err(&adapter->pdev->dev,
4087 "failed to setup mbx interrupt\n");
4088 goto done;
4089 }
4090 }
4091
4092 if (netif_running(netdev)) {
4093 err = qlcnic_attach(adapter);
4094 if (err)
4095 goto done;
4096 err = __qlcnic_up(adapter, netdev);
4097 if (err)
4098 goto done;
4099 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
4100 }
4101 done:
4102 netif_device_attach(netdev);
4103 clear_bit(__QLCNIC_RESETTING, &adapter->state);
4104 return err;
4105 }
4106
4107 #ifdef CONFIG_INET
4108
4109 #define is_qlcnic_netdev(dev) (dev->netdev_ops == &qlcnic_netdev_ops)
4110
4111 static void
4112 qlcnic_config_indev_addr(struct qlcnic_adapter *adapter,
4113 struct net_device *dev, unsigned long event)
4114 {
4115 struct in_device *indev;
4116
4117 indev = in_dev_get(dev);
4118 if (!indev)
4119 return;
4120
4121 for_ifa(indev) {
4122 switch (event) {
4123 case NETDEV_UP:
4124 qlcnic_config_ipaddr(adapter,
4125 ifa->ifa_address, QLCNIC_IP_UP);
4126 break;
4127 case NETDEV_DOWN:
4128 qlcnic_config_ipaddr(adapter,
4129 ifa->ifa_address, QLCNIC_IP_DOWN);
4130 break;
4131 default:
4132 break;
4133 }
4134 } endfor_ifa(indev);
4135
4136 in_dev_put(indev);
4137 }
4138
4139 void qlcnic_restore_indev_addr(struct net_device *netdev, unsigned long event)
4140 {
4141 struct qlcnic_adapter *adapter = netdev_priv(netdev);
4142 struct net_device *dev;
4143 u16 vid;
4144
4145 qlcnic_config_indev_addr(adapter, netdev, event);
4146
4147 rcu_read_lock();
4148 for_each_set_bit(vid, adapter->vlans, VLAN_N_VID) {
4149 dev = __vlan_find_dev_deep_rcu(netdev, htons(ETH_P_8021Q), vid);
4150 if (!dev)
4151 continue;
4152 qlcnic_config_indev_addr(adapter, dev, event);
4153 }
4154 rcu_read_unlock();
4155 }
4156
4157 static int qlcnic_netdev_event(struct notifier_block *this,
4158 unsigned long event, void *ptr)
4159 {
4160 struct qlcnic_adapter *adapter;
4161 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
4162
4163 recheck:
4164 if (dev == NULL)
4165 goto done;
4166
4167 if (dev->priv_flags & IFF_802_1Q_VLAN) {
4168 dev = vlan_dev_real_dev(dev);
4169 goto recheck;
4170 }
4171
4172 if (!is_qlcnic_netdev(dev))
4173 goto done;
4174
4175 adapter = netdev_priv(dev);
4176
4177 if (!adapter)
4178 goto done;
4179
4180 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
4181 goto done;
4182
4183 qlcnic_config_indev_addr(adapter, dev, event);
4184 done:
4185 return NOTIFY_DONE;
4186 }
4187
4188 static int
4189 qlcnic_inetaddr_event(struct notifier_block *this,
4190 unsigned long event, void *ptr)
4191 {
4192 struct qlcnic_adapter *adapter;
4193 struct net_device *dev;
4194
4195 struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;
4196
4197 dev = ifa->ifa_dev ? ifa->ifa_dev->dev : NULL;
4198
4199 recheck:
4200 if (dev == NULL)
4201 goto done;
4202
4203 if (dev->priv_flags & IFF_802_1Q_VLAN) {
4204 dev = vlan_dev_real_dev(dev);
4205 goto recheck;
4206 }
4207
4208 if (!is_qlcnic_netdev(dev))
4209 goto done;
4210
4211 adapter = netdev_priv(dev);
4212
4213 if (!adapter)
4214 goto done;
4215
4216 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
4217 goto done;
4218
4219 switch (event) {
4220 case NETDEV_UP:
4221 qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_UP);
4222
4223 break;
4224 case NETDEV_DOWN:
4225 qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_DOWN);
4226
4227 break;
4228 default:
4229 break;
4230 }
4231
4232 done:
4233 return NOTIFY_DONE;
4234 }
4235
4236 static struct notifier_block qlcnic_netdev_cb = {
4237 .notifier_call = qlcnic_netdev_event,
4238 };
4239
4240 static struct notifier_block qlcnic_inetaddr_cb = {
4241 .notifier_call = qlcnic_inetaddr_event,
4242 };
4243 #else
4244 void qlcnic_restore_indev_addr(struct net_device *dev, unsigned long event)
4245 { }
4246 #endif
4247 static const struct pci_error_handlers qlcnic_err_handler = {
4248 .error_detected = qlcnic_io_error_detected,
4249 .slot_reset = qlcnic_io_slot_reset,
4250 .resume = qlcnic_io_resume,
4251 };
4252
4253 static struct pci_driver qlcnic_driver = {
4254 .name = qlcnic_driver_name,
4255 .id_table = qlcnic_pci_tbl,
4256 .probe = qlcnic_probe,
4257 .remove = qlcnic_remove,
4258 #ifdef CONFIG_PM
4259 .suspend = qlcnic_suspend,
4260 .resume = qlcnic_resume,
4261 #endif
4262 .shutdown = qlcnic_shutdown,
4263 .err_handler = &qlcnic_err_handler,
4264 #ifdef CONFIG_QLCNIC_SRIOV
4265 .sriov_configure = qlcnic_pci_sriov_configure,
4266 #endif
4267
4268 };
4269
4270 static int __init qlcnic_init_module(void)
4271 {
4272 int ret;
4273
4274 printk(KERN_INFO "%s\n", qlcnic_driver_string);
4275
4276 #ifdef CONFIG_INET
4277 register_netdevice_notifier(&qlcnic_netdev_cb);
4278 register_inetaddr_notifier(&qlcnic_inetaddr_cb);
4279 #endif
4280
4281 ret = pci_register_driver(&qlcnic_driver);
4282 if (ret) {
4283 #ifdef CONFIG_INET
4284 unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4285 unregister_netdevice_notifier(&qlcnic_netdev_cb);
4286 #endif
4287 }
4288
4289 return ret;
4290 }
4291
4292 module_init(qlcnic_init_module);
4293
4294 static void __exit qlcnic_exit_module(void)
4295 {
4296 pci_unregister_driver(&qlcnic_driver);
4297
4298 #ifdef CONFIG_INET
4299 unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4300 unregister_netdevice_notifier(&qlcnic_netdev_cb);
4301 #endif
4302 }
4303
4304 module_exit(qlcnic_exit_module);
This page took 0.179021 seconds and 5 git commands to generate.