projects / deliverable / linux.git / blob
? search:


f0a285359e6654e5a796f85a69da025006392b94
[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 netdev->ethtool_ops = (qlcnic_sriov_vf_check(adapter)) ?
2269 &qlcnic_sriov_vf_ethtool_ops : &qlcnic_ethtool_ops;
2270
2271 netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_RXCSUM |
2272 NETIF_F_IPV6_CSUM | NETIF_F_GRO |
2273 NETIF_F_HW_VLAN_CTAG_RX);
2274 netdev->vlan_features |= (NETIF_F_SG | NETIF_F_IP_CSUM |
2275 NETIF_F_IPV6_CSUM);
2276
2277 if (QLCNIC_IS_TSO_CAPABLE(adapter)) {
2278 netdev->features |= (NETIF_F_TSO | NETIF_F_TSO6);
2279 netdev->vlan_features |= (NETIF_F_TSO | NETIF_F_TSO6);
2280 }
2281
2282 if (pci_using_dac) {
2283 netdev->features |= NETIF_F_HIGHDMA;
2284 netdev->vlan_features |= NETIF_F_HIGHDMA;
2285 }
2286
2287 if (qlcnic_vlan_tx_check(adapter))
2288 netdev->features |= (NETIF_F_HW_VLAN_CTAG_TX);
2289
2290 if (qlcnic_sriov_vf_check(adapter))
2291 netdev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
2292
2293 if (adapter->ahw->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
2294 netdev->features |= NETIF_F_LRO;
2295
2296 if (qlcnic_encap_tx_offload(adapter)) {
2297 netdev->features |= NETIF_F_GSO_UDP_TUNNEL;
2298
2299 /* encapsulation Tx offload supported by Adapter */
2300 netdev->hw_enc_features = NETIF_F_IP_CSUM |
2301 NETIF_F_GSO_UDP_TUNNEL |
2302 NETIF_F_TSO |
2303 NETIF_F_TSO6;
2304 }
2305
2306 if (qlcnic_encap_rx_offload(adapter))
2307 netdev->hw_enc_features |= NETIF_F_RXCSUM;
2308
2309 netdev->hw_features = netdev->features;
2310 netdev->priv_flags |= IFF_UNICAST_FLT;
2311 netdev->irq = adapter->msix_entries[0].vector;
2312
2313 err = qlcnic_set_real_num_queues(adapter, adapter->drv_tx_rings,
2314 adapter->drv_sds_rings);
2315 if (err)
2316 return err;
2317
2318 err = register_netdev(netdev);
2319 if (err) {
2320 dev_err(&pdev->dev, "failed to register net device\n");
2321 return err;
2322 }
2323
2324 qlcnic_dcb_init_dcbnl_ops(adapter->dcb);
2325
2326 return 0;
2327 }
2328
2329 static int qlcnic_set_dma_mask(struct pci_dev *pdev, int *pci_using_dac)
2330 {
2331 if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) &&
2332 !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)))
2333 *pci_using_dac = 1;
2334 else if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) &&
2335 !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)))
2336 *pci_using_dac = 0;
2337 else {
2338 dev_err(&pdev->dev, "Unable to set DMA mask, aborting\n");
2339 return -EIO;
2340 }
2341
2342 return 0;
2343 }
2344
2345 void qlcnic_free_tx_rings(struct qlcnic_adapter *adapter)
2346 {
2347 int ring;
2348 struct qlcnic_host_tx_ring *tx_ring;
2349
2350 for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2351 tx_ring = &adapter->tx_ring[ring];
2352 if (tx_ring && tx_ring->cmd_buf_arr != NULL) {
2353 vfree(tx_ring->cmd_buf_arr);
2354 tx_ring->cmd_buf_arr = NULL;
2355 }
2356 }
2357 if (adapter->tx_ring != NULL)
2358 kfree(adapter->tx_ring);
2359 }
2360
2361 int qlcnic_alloc_tx_rings(struct qlcnic_adapter *adapter,
2362 struct net_device *netdev)
2363 {
2364 int ring, vector, index;
2365 struct qlcnic_host_tx_ring *tx_ring;
2366 struct qlcnic_cmd_buffer *cmd_buf_arr;
2367
2368 tx_ring = kcalloc(adapter->drv_tx_rings,
2369 sizeof(struct qlcnic_host_tx_ring), GFP_KERNEL);
2370 if (tx_ring == NULL)
2371 return -ENOMEM;
2372
2373 adapter->tx_ring = tx_ring;
2374
2375 for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2376 tx_ring = &adapter->tx_ring[ring];
2377 tx_ring->num_desc = adapter->num_txd;
2378 tx_ring->txq = netdev_get_tx_queue(netdev, ring);
2379 cmd_buf_arr = vzalloc(TX_BUFF_RINGSIZE(tx_ring));
2380 if (cmd_buf_arr == NULL) {
2381 qlcnic_free_tx_rings(adapter);
2382 return -ENOMEM;
2383 }
2384 memset(cmd_buf_arr, 0, TX_BUFF_RINGSIZE(tx_ring));
2385 tx_ring->cmd_buf_arr = cmd_buf_arr;
2386 spin_lock_init(&tx_ring->tx_clean_lock);
2387 }
2388
2389 if (qlcnic_83xx_check(adapter) ||
2390 (qlcnic_82xx_check(adapter) && qlcnic_check_multi_tx(adapter))) {
2391 for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2392 tx_ring = &adapter->tx_ring[ring];
2393 tx_ring->adapter = adapter;
2394 if (adapter->flags & QLCNIC_MSIX_ENABLED) {
2395 index = adapter->drv_sds_rings + ring;
2396 vector = adapter->msix_entries[index].vector;
2397 tx_ring->irq = vector;
2398 }
2399 }
2400 }
2401
2402 return 0;
2403 }
2404
2405 void qlcnic_set_drv_version(struct qlcnic_adapter *adapter)
2406 {
2407 struct qlcnic_hardware_context *ahw = adapter->ahw;
2408 u32 fw_cmd = 0;
2409
2410 if (qlcnic_82xx_check(adapter))
2411 fw_cmd = QLCNIC_CMD_82XX_SET_DRV_VER;
2412 else if (qlcnic_83xx_check(adapter))
2413 fw_cmd = QLCNIC_CMD_83XX_SET_DRV_VER;
2414
2415 if (ahw->extra_capability[0] & QLCNIC_FW_CAPABILITY_SET_DRV_VER)
2416 qlcnic_fw_cmd_set_drv_version(adapter, fw_cmd);
2417 }
2418
2419 /* Reset firmware API lock */
2420 static void qlcnic_reset_api_lock(struct qlcnic_adapter *adapter)
2421 {
2422 qlcnic_api_lock(adapter);
2423 qlcnic_api_unlock(adapter);
2424 }
2425
2426
2427 static int
2428 qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
2429 {
2430 struct net_device *netdev = NULL;
2431 struct qlcnic_adapter *adapter = NULL;
2432 struct qlcnic_hardware_context *ahw;
2433 int err, pci_using_dac = -1;
2434 char board_name[QLCNIC_MAX_BOARD_NAME_LEN + 19]; /* MAC + ": " + name */
2435
2436 err = pci_enable_device(pdev);
2437 if (err)
2438 return err;
2439
2440 if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
2441 err = -ENODEV;
2442 goto err_out_disable_pdev;
2443 }
2444
2445 err = qlcnic_set_dma_mask(pdev, &pci_using_dac);
2446 if (err)
2447 goto err_out_disable_pdev;
2448
2449 err = pci_request_regions(pdev, qlcnic_driver_name);
2450 if (err)
2451 goto err_out_disable_pdev;
2452
2453 pci_set_master(pdev);
2454 pci_enable_pcie_error_reporting(pdev);
2455
2456 ahw = kzalloc(sizeof(struct qlcnic_hardware_context), GFP_KERNEL);
2457 if (!ahw) {
2458 err = -ENOMEM;
2459 goto err_out_free_res;
2460 }
2461
2462 switch (ent->device) {
2463 case PCI_DEVICE_ID_QLOGIC_QLE824X:
2464 ahw->hw_ops = &qlcnic_hw_ops;
2465 ahw->reg_tbl = (u32 *) qlcnic_reg_tbl;
2466 break;
2467 case PCI_DEVICE_ID_QLOGIC_QLE834X:
2468 case PCI_DEVICE_ID_QLOGIC_QLE844X:
2469 qlcnic_83xx_register_map(ahw);
2470 break;
2471 case PCI_DEVICE_ID_QLOGIC_VF_QLE834X:
2472 case PCI_DEVICE_ID_QLOGIC_VF_QLE844X:
2473 qlcnic_sriov_vf_register_map(ahw);
2474 break;
2475 default:
2476 goto err_out_free_hw_res;
2477 }
2478
2479 err = qlcnic_setup_pci_map(pdev, ahw);
2480 if (err)
2481 goto err_out_free_hw_res;
2482
2483 netdev = alloc_etherdev_mq(sizeof(struct qlcnic_adapter),
2484 QLCNIC_MAX_TX_RINGS);
2485 if (!netdev) {
2486 err = -ENOMEM;
2487 goto err_out_iounmap;
2488 }
2489
2490 SET_NETDEV_DEV(netdev, &pdev->dev);
2491
2492 adapter = netdev_priv(netdev);
2493 adapter->netdev = netdev;
2494 adapter->pdev = pdev;
2495 adapter->ahw = ahw;
2496
2497 adapter->qlcnic_wq = create_singlethread_workqueue("qlcnic");
2498 if (adapter->qlcnic_wq == NULL) {
2499 err = -ENOMEM;
2500 dev_err(&pdev->dev, "Failed to create workqueue\n");
2501 goto err_out_free_netdev;
2502 }
2503
2504 err = qlcnic_alloc_adapter_resources(adapter);
2505 if (err)
2506 goto err_out_free_wq;
2507
2508 adapter->dev_rst_time = jiffies;
2509 ahw->revision_id = pdev->revision;
2510 ahw->max_vnic_func = qlcnic_get_vnic_func_count(adapter);
2511 if (qlcnic_mac_learn == FDB_MAC_LEARN)
2512 adapter->fdb_mac_learn = true;
2513 else if (qlcnic_mac_learn == DRV_MAC_LEARN)
2514 adapter->drv_mac_learn = true;
2515
2516 rwlock_init(&adapter->ahw->crb_lock);
2517 mutex_init(&adapter->ahw->mem_lock);
2518
2519 INIT_LIST_HEAD(&adapter->mac_list);
2520
2521 qlcnic_register_dcb(adapter);
2522
2523 if (qlcnic_82xx_check(adapter)) {
2524 qlcnic_check_vf(adapter, ent);
2525 adapter->portnum = adapter->ahw->pci_func;
2526 qlcnic_reset_api_lock(adapter);
2527 err = qlcnic_start_firmware(adapter);
2528 if (err) {
2529 dev_err(&pdev->dev, "Loading fw failed.Please Reboot\n"
2530 "\t\tIf reboot doesn't help, try flashing the card\n");
2531 goto err_out_maintenance_mode;
2532 }
2533
2534 /* compute and set default and max tx/sds rings */
2535 if (adapter->ahw->msix_supported) {
2536 if (qlcnic_check_multi_tx_capability(adapter) == 1)
2537 qlcnic_set_tx_ring_count(adapter,
2538 QLCNIC_SINGLE_RING);
2539 else
2540 qlcnic_set_tx_ring_count(adapter,
2541 QLCNIC_DEF_TX_RINGS);
2542 qlcnic_set_sds_ring_count(adapter,
2543 QLCNIC_DEF_SDS_RINGS);
2544 } else {
2545 qlcnic_set_tx_ring_count(adapter, QLCNIC_SINGLE_RING);
2546 qlcnic_set_sds_ring_count(adapter, QLCNIC_SINGLE_RING);
2547 }
2548
2549 err = qlcnic_setup_idc_param(adapter);
2550 if (err)
2551 goto err_out_free_hw;
2552
2553 adapter->flags |= QLCNIC_NEED_FLR;
2554
2555 } else if (qlcnic_83xx_check(adapter)) {
2556 qlcnic_83xx_check_vf(adapter, ent);
2557 adapter->portnum = adapter->ahw->pci_func;
2558 err = qlcnic_83xx_init(adapter, pci_using_dac);
2559 if (err) {
2560 switch (err) {
2561 case -ENOTRECOVERABLE:
2562 dev_err(&pdev->dev, "Adapter initialization failed due to a faulty hardware\n");
2563 dev_err(&pdev->dev, "Please replace the adapter with new one and return the faulty adapter for repair\n");
2564 goto err_out_free_hw;
2565 case -ENOMEM:
2566 dev_err(&pdev->dev, "Adapter initialization failed. Please reboot\n");
2567 goto err_out_free_hw;
2568 case -EOPNOTSUPP:
2569 dev_err(&pdev->dev, "Adapter initialization failed\n");
2570 goto err_out_free_hw;
2571 default:
2572 dev_err(&pdev->dev, "Adapter initialization failed. Driver will load in maintenance mode to recover the adapter using the application\n");
2573 goto err_out_maintenance_mode;
2574 }
2575 }
2576
2577 if (qlcnic_sriov_vf_check(adapter))
2578 return 0;
2579 } else {
2580 dev_err(&pdev->dev,
2581 "%s: failed. Please Reboot\n", __func__);
2582 goto err_out_free_hw;
2583 }
2584
2585 if (qlcnic_read_mac_addr(adapter))
2586 dev_warn(&pdev->dev, "failed to read mac addr\n");
2587
2588 qlcnic_read_phys_port_id(adapter);
2589
2590 if (adapter->portnum == 0) {
2591 qlcnic_get_board_name(adapter, board_name);
2592
2593 pr_info("%s: %s Board Chip rev 0x%x\n",
2594 module_name(THIS_MODULE),
2595 board_name, adapter->ahw->revision_id);
2596 }
2597
2598 if (qlcnic_83xx_check(adapter) && !qlcnic_use_msi_x &&
2599 !!qlcnic_use_msi)
2600 dev_warn(&pdev->dev,
2601 "Device does not support MSI interrupts\n");
2602
2603 if (qlcnic_82xx_check(adapter)) {
2604 qlcnic_dcb_enable(adapter->dcb);
2605 qlcnic_dcb_get_info(adapter->dcb);
2606 err = qlcnic_setup_intr(adapter);
2607
2608 if (err) {
2609 dev_err(&pdev->dev, "Failed to setup interrupt\n");
2610 goto err_out_disable_msi;
2611 }
2612 }
2613
2614 err = qlcnic_get_act_pci_func(adapter);
2615 if (err)
2616 goto err_out_disable_mbx_intr;
2617
2618 err = qlcnic_setup_netdev(adapter, netdev, pci_using_dac);
2619 if (err)
2620 goto err_out_disable_mbx_intr;
2621
2622 if (adapter->portnum == 0)
2623 qlcnic_set_drv_version(adapter);
2624
2625 pci_set_drvdata(pdev, adapter);
2626
2627 if (qlcnic_82xx_check(adapter))
2628 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
2629 FW_POLL_DELAY);
2630
2631 switch (adapter->ahw->port_type) {
2632 case QLCNIC_GBE:
2633 dev_info(&adapter->pdev->dev, "%s: GbE port initialized\n",
2634 adapter->netdev->name);
2635 break;
2636 case QLCNIC_XGBE:
2637 dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n",
2638 adapter->netdev->name);
2639 break;
2640 }
2641
2642 if (adapter->drv_mac_learn)
2643 qlcnic_alloc_lb_filters_mem(adapter);
2644
2645 qlcnic_add_sysfs(adapter);
2646 qlcnic_register_hwmon_dev(adapter);
2647 return 0;
2648
2649 err_out_disable_mbx_intr:
2650 if (qlcnic_83xx_check(adapter))
2651 qlcnic_83xx_free_mbx_intr(adapter);
2652
2653 err_out_disable_msi:
2654 qlcnic_teardown_intr(adapter);
2655 qlcnic_cancel_idc_work(adapter);
2656 qlcnic_clr_all_drv_state(adapter, 0);
2657
2658 err_out_free_hw:
2659 qlcnic_free_adapter_resources(adapter);
2660
2661 err_out_free_wq:
2662 destroy_workqueue(adapter->qlcnic_wq);
2663
2664 err_out_free_netdev:
2665 free_netdev(netdev);
2666
2667 err_out_iounmap:
2668 qlcnic_cleanup_pci_map(ahw);
2669
2670 err_out_free_hw_res:
2671 kfree(ahw);
2672
2673 err_out_free_res:
2674 pci_release_regions(pdev);
2675
2676 err_out_disable_pdev:
2677 pci_disable_device(pdev);
2678 return err;
2679
2680 err_out_maintenance_mode:
2681 set_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state);
2682 netdev->netdev_ops = &qlcnic_netdev_failed_ops;
2683 netdev->ethtool_ops = &qlcnic_ethtool_failed_ops;
2684 ahw->port_type = QLCNIC_XGBE;
2685
2686 if (qlcnic_83xx_check(adapter))
2687 adapter->tgt_status_reg = NULL;
2688 else
2689 ahw->board_type = QLCNIC_BRDTYPE_P3P_10G_SFP_PLUS;
2690
2691 err = register_netdev(netdev);
2692
2693 if (err) {
2694 dev_err(&pdev->dev, "Failed to register net device\n");
2695 qlcnic_clr_all_drv_state(adapter, 0);
2696 goto err_out_free_hw;
2697 }
2698
2699 pci_set_drvdata(pdev, adapter);
2700 qlcnic_add_sysfs(adapter);
2701
2702 return 0;
2703 }
2704
2705 static void qlcnic_remove(struct pci_dev *pdev)
2706 {
2707 struct qlcnic_adapter *adapter;
2708 struct net_device *netdev;
2709 struct qlcnic_hardware_context *ahw;
2710
2711 adapter = pci_get_drvdata(pdev);
2712 if (adapter == NULL)
2713 return;
2714
2715 netdev = adapter->netdev;
2716
2717 qlcnic_cancel_idc_work(adapter);
2718 qlcnic_sriov_pf_disable(adapter);
2719 ahw = adapter->ahw;
2720
2721 unregister_netdev(netdev);
2722 qlcnic_sriov_cleanup(adapter);
2723
2724 if (qlcnic_83xx_check(adapter)) {
2725 qlcnic_83xx_initialize_nic(adapter, 0);
2726 cancel_delayed_work_sync(&adapter->idc_aen_work);
2727 qlcnic_83xx_free_mbx_intr(adapter);
2728 qlcnic_83xx_detach_mailbox_work(adapter);
2729 qlcnic_83xx_free_mailbox(ahw->mailbox);
2730 kfree(ahw->fw_info);
2731 }
2732
2733 qlcnic_dcb_free(adapter->dcb);
2734
2735 qlcnic_detach(adapter);
2736
2737 if (adapter->npars != NULL)
2738 kfree(adapter->npars);
2739 if (adapter->eswitch != NULL)
2740 kfree(adapter->eswitch);
2741
2742 if (qlcnic_82xx_check(adapter))
2743 qlcnic_clr_all_drv_state(adapter, 0);
2744
2745 clear_bit(__QLCNIC_RESETTING, &adapter->state);
2746
2747 qlcnic_free_lb_filters_mem(adapter);
2748
2749 qlcnic_teardown_intr(adapter);
2750
2751 qlcnic_remove_sysfs(adapter);
2752
2753 qlcnic_unregister_hwmon_dev(adapter);
2754
2755 qlcnic_cleanup_pci_map(adapter->ahw);
2756
2757 qlcnic_release_firmware(adapter);
2758
2759 pci_disable_pcie_error_reporting(pdev);
2760 pci_release_regions(pdev);
2761 pci_disable_device(pdev);
2762
2763 if (adapter->qlcnic_wq) {
2764 destroy_workqueue(adapter->qlcnic_wq);
2765 adapter->qlcnic_wq = NULL;
2766 }
2767
2768 qlcnic_free_adapter_resources(adapter);
2769 kfree(ahw);
2770 free_netdev(netdev);
2771 }
2772
2773 static void qlcnic_shutdown(struct pci_dev *pdev)
2774 {
2775 if (__qlcnic_shutdown(pdev))
2776 return;
2777
2778 pci_disable_device(pdev);
2779 }
2780
2781 #ifdef CONFIG_PM
2782 static int qlcnic_suspend(struct pci_dev *pdev, pm_message_t state)
2783 {
2784 int retval;
2785
2786 retval = __qlcnic_shutdown(pdev);
2787 if (retval)
2788 return retval;
2789
2790 pci_set_power_state(pdev, pci_choose_state(pdev, state));
2791 return 0;
2792 }
2793
2794 static int qlcnic_resume(struct pci_dev *pdev)
2795 {
2796 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
2797 int err;
2798
2799 err = pci_enable_device(pdev);
2800 if (err)
2801 return err;
2802
2803 pci_set_power_state(pdev, PCI_D0);
2804 pci_set_master(pdev);
2805 pci_restore_state(pdev);
2806
2807 return __qlcnic_resume(adapter);
2808 }
2809 #endif
2810
2811 static int qlcnic_open(struct net_device *netdev)
2812 {
2813 struct qlcnic_adapter *adapter = netdev_priv(netdev);
2814 int err;
2815
2816 if (test_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state)) {
2817 netdev_err(netdev, "%s: Device is in non-operational state\n",
2818 __func__);
2819
2820 return -EIO;
2821 }
2822
2823 netif_carrier_off(netdev);
2824
2825 err = qlcnic_attach(adapter);
2826 if (err)
2827 return err;
2828
2829 err = __qlcnic_up(adapter, netdev);
2830 if (err)
2831 qlcnic_detach(adapter);
2832
2833 return err;
2834 }
2835
2836 /*
2837 * qlcnic_close - Disables a network interface entry point
2838 */
2839 static int qlcnic_close(struct net_device *netdev)
2840 {
2841 struct qlcnic_adapter *adapter = netdev_priv(netdev);
2842
2843 __qlcnic_down(adapter, netdev);
2844
2845 return 0;
2846 }
2847
2848 #define QLCNIC_VF_LB_BUCKET_SIZE 1
2849
2850 void qlcnic_alloc_lb_filters_mem(struct qlcnic_adapter *adapter)
2851 {
2852 void *head;
2853 int i;
2854 struct net_device *netdev = adapter->netdev;
2855 u32 filter_size = 0;
2856 u16 act_pci_func = 0;
2857
2858 if (adapter->fhash.fmax && adapter->fhash.fhead)
2859 return;
2860
2861 act_pci_func = adapter->ahw->total_nic_func;
2862 spin_lock_init(&adapter->mac_learn_lock);
2863 spin_lock_init(&adapter->rx_mac_learn_lock);
2864
2865 if (qlcnic_sriov_vf_check(adapter)) {
2866 filter_size = QLCNIC_83XX_SRIOV_VF_MAX_MAC - 1;
2867 adapter->fhash.fbucket_size = QLCNIC_VF_LB_BUCKET_SIZE;
2868 } else if (qlcnic_82xx_check(adapter)) {
2869 filter_size = QLCNIC_LB_MAX_FILTERS;
2870 adapter->fhash.fbucket_size = QLCNIC_LB_BUCKET_SIZE;
2871 } else {
2872 filter_size = QLC_83XX_LB_MAX_FILTERS;
2873 adapter->fhash.fbucket_size = QLC_83XX_LB_BUCKET_SIZE;
2874 }
2875
2876 head = kcalloc(adapter->fhash.fbucket_size,
2877 sizeof(struct hlist_head), GFP_ATOMIC);
2878
2879 if (!head)
2880 return;
2881
2882 adapter->fhash.fmax = (filter_size / act_pci_func);
2883 adapter->fhash.fhead = head;
2884
2885 netdev_info(netdev, "active nic func = %d, mac filter size=%d\n",
2886 act_pci_func, adapter->fhash.fmax);
2887
2888 for (i = 0; i < adapter->fhash.fbucket_size; i++)
2889 INIT_HLIST_HEAD(&adapter->fhash.fhead[i]);
2890
2891 adapter->rx_fhash.fbucket_size = adapter->fhash.fbucket_size;
2892
2893 head = kcalloc(adapter->rx_fhash.fbucket_size,
2894 sizeof(struct hlist_head), GFP_ATOMIC);
2895
2896 if (!head)
2897 return;
2898
2899 adapter->rx_fhash.fmax = (filter_size / act_pci_func);
2900 adapter->rx_fhash.fhead = head;
2901
2902 for (i = 0; i < adapter->rx_fhash.fbucket_size; i++)
2903 INIT_HLIST_HEAD(&adapter->rx_fhash.fhead[i]);
2904 }
2905
2906 static void qlcnic_free_lb_filters_mem(struct qlcnic_adapter *adapter)
2907 {
2908 if (adapter->fhash.fmax && adapter->fhash.fhead)
2909 kfree(adapter->fhash.fhead);
2910
2911 adapter->fhash.fhead = NULL;
2912 adapter->fhash.fmax = 0;
2913
2914 if (adapter->rx_fhash.fmax && adapter->rx_fhash.fhead)
2915 kfree(adapter->rx_fhash.fhead);
2916
2917 adapter->rx_fhash.fmax = 0;
2918 adapter->rx_fhash.fhead = NULL;
2919 }
2920
2921 int qlcnic_check_temp(struct qlcnic_adapter *adapter)
2922 {
2923 struct net_device *netdev = adapter->netdev;
2924 u32 temp_state, temp_val, temp = 0;
2925 int rv = 0;
2926
2927 if (qlcnic_83xx_check(adapter))
2928 temp = QLCRDX(adapter->ahw, QLC_83XX_ASIC_TEMP);
2929
2930 if (qlcnic_82xx_check(adapter))
2931 temp = QLC_SHARED_REG_RD32(adapter, QLCNIC_ASIC_TEMP);
2932
2933 temp_state = qlcnic_get_temp_state(temp);
2934 temp_val = qlcnic_get_temp_val(temp);
2935
2936 if (temp_state == QLCNIC_TEMP_PANIC) {
2937 dev_err(&netdev->dev,
2938 "Device temperature %d degrees C exceeds"
2939 " maximum allowed. Hardware has been shut down.\n",
2940 temp_val);
2941 rv = 1;
2942 } else if (temp_state == QLCNIC_TEMP_WARN) {
2943 if (adapter->ahw->temp == QLCNIC_TEMP_NORMAL) {
2944 dev_err(&netdev->dev,
2945 "Device temperature %d degrees C "
2946 "exceeds operating range."
2947 " Immediate action needed.\n",
2948 temp_val);
2949 }
2950 } else {
2951 if (adapter->ahw->temp == QLCNIC_TEMP_WARN) {
2952 dev_info(&netdev->dev,
2953 "Device temperature is now %d degrees C"
2954 " in normal range.\n", temp_val);
2955 }
2956 }
2957 adapter->ahw->temp = temp_state;
2958 return rv;
2959 }
2960
2961 static inline void dump_tx_ring_desc(struct qlcnic_host_tx_ring *tx_ring)
2962 {
2963 int i;
2964 struct cmd_desc_type0 *tx_desc_info;
2965
2966 for (i = 0; i < tx_ring->num_desc; i++) {
2967 tx_desc_info = &tx_ring->desc_head[i];
2968 pr_info("TX Desc: %d\n", i);
2969 print_hex_dump(KERN_INFO, "TX: ", DUMP_PREFIX_OFFSET, 16, 1,
2970 &tx_ring->desc_head[i],
2971 sizeof(struct cmd_desc_type0), true);
2972 }
2973 }
2974
2975 static void qlcnic_dump_tx_rings(struct qlcnic_adapter *adapter)
2976 {
2977 struct net_device *netdev = adapter->netdev;
2978 struct qlcnic_host_tx_ring *tx_ring;
2979 int ring;
2980
2981 if (!netdev || !netif_running(netdev))
2982 return;
2983
2984 for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
2985 tx_ring = &adapter->tx_ring[ring];
2986 netdev_info(netdev, "Tx ring=%d Context Id=0x%x\n",
2987 ring, tx_ring->ctx_id);
2988 netdev_info(netdev,
2989 "xmit_finished=%llu, xmit_called=%llu, xmit_on=%llu, xmit_off=%llu\n",
2990 tx_ring->tx_stats.xmit_finished,
2991 tx_ring->tx_stats.xmit_called,
2992 tx_ring->tx_stats.xmit_on,
2993 tx_ring->tx_stats.xmit_off);
2994
2995 if (tx_ring->crb_intr_mask)
2996 netdev_info(netdev, "crb_intr_mask=%d\n",
2997 readl(tx_ring->crb_intr_mask));
2998
2999 netdev_info(netdev,
3000 "hw_producer=%d, sw_producer=%d sw_consumer=%d, hw_consumer=%d\n",
3001 readl(tx_ring->crb_cmd_producer),
3002 tx_ring->producer, tx_ring->sw_consumer,
3003 le32_to_cpu(*(tx_ring->hw_consumer)));
3004
3005 netdev_info(netdev, "Total desc=%d, Available desc=%d\n",
3006 tx_ring->num_desc, qlcnic_tx_avail(tx_ring));
3007
3008 if (netif_msg_tx_done(adapter->ahw))
3009 dump_tx_ring_desc(tx_ring);
3010 }
3011 }
3012
3013 static void qlcnic_tx_timeout(struct net_device *netdev)
3014 {
3015 struct qlcnic_adapter *adapter = netdev_priv(netdev);
3016
3017 if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3018 return;
3019
3020 if (++adapter->tx_timeo_cnt >= QLCNIC_MAX_TX_TIMEOUTS) {
3021 netdev_info(netdev, "Tx timeout, reset the adapter.\n");
3022 if (qlcnic_82xx_check(adapter))
3023 adapter->need_fw_reset = 1;
3024 else if (qlcnic_83xx_check(adapter))
3025 qlcnic_83xx_idc_request_reset(adapter,
3026 QLCNIC_FORCE_FW_DUMP_KEY);
3027 } else {
3028 netdev_info(netdev, "Tx timeout, reset adapter context.\n");
3029 qlcnic_dump_tx_rings(adapter);
3030 adapter->ahw->reset_context = 1;
3031 }
3032 }
3033
3034 static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev)
3035 {
3036 struct qlcnic_adapter *adapter = netdev_priv(netdev);
3037 struct net_device_stats *stats = &netdev->stats;
3038
3039 if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
3040 qlcnic_update_stats(adapter);
3041
3042 stats->rx_packets = adapter->stats.rx_pkts + adapter->stats.lro_pkts;
3043 stats->tx_packets = adapter->stats.xmitfinished;
3044 stats->rx_bytes = adapter->stats.rxbytes + adapter->stats.lrobytes;
3045 stats->tx_bytes = adapter->stats.txbytes;
3046 stats->rx_dropped = adapter->stats.rxdropped;
3047 stats->tx_dropped = adapter->stats.txdropped;
3048
3049 return stats;
3050 }
3051
3052 static irqreturn_t qlcnic_82xx_clear_legacy_intr(struct qlcnic_adapter *adapter)
3053 {
3054 u32 status;
3055
3056 status = readl(adapter->isr_int_vec);
3057
3058 if (!(status & adapter->ahw->int_vec_bit))
3059 return IRQ_NONE;
3060
3061 /* check interrupt state machine, to be sure */
3062 status = readl(adapter->crb_int_state_reg);
3063 if (!ISR_LEGACY_INT_TRIGGERED(status))
3064 return IRQ_NONE;
3065
3066 writel(0xffffffff, adapter->tgt_status_reg);
3067 /* read twice to ensure write is flushed */
3068 readl(adapter->isr_int_vec);
3069 readl(adapter->isr_int_vec);
3070
3071 return IRQ_HANDLED;
3072 }
3073
3074 static irqreturn_t qlcnic_tmp_intr(int irq, void *data)
3075 {
3076 struct qlcnic_host_sds_ring *sds_ring = data;
3077 struct qlcnic_adapter *adapter = sds_ring->adapter;
3078
3079 if (adapter->flags & QLCNIC_MSIX_ENABLED)
3080 goto done;
3081 else if (adapter->flags & QLCNIC_MSI_ENABLED) {
3082 writel(0xffffffff, adapter->tgt_status_reg);
3083 goto done;
3084 }
3085
3086 if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
3087 return IRQ_NONE;
3088
3089 done:
3090 adapter->ahw->diag_cnt++;
3091 qlcnic_enable_sds_intr(adapter, sds_ring);
3092 return IRQ_HANDLED;
3093 }
3094
3095 static irqreturn_t qlcnic_intr(int irq, void *data)
3096 {
3097 struct qlcnic_host_sds_ring *sds_ring = data;
3098 struct qlcnic_adapter *adapter = sds_ring->adapter;
3099
3100 if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
3101 return IRQ_NONE;
3102
3103 napi_schedule(&sds_ring->napi);
3104
3105 return IRQ_HANDLED;
3106 }
3107
3108 static irqreturn_t qlcnic_msi_intr(int irq, void *data)
3109 {
3110 struct qlcnic_host_sds_ring *sds_ring = data;
3111 struct qlcnic_adapter *adapter = sds_ring->adapter;
3112
3113 /* clear interrupt */
3114 writel(0xffffffff, adapter->tgt_status_reg);
3115
3116 napi_schedule(&sds_ring->napi);
3117 return IRQ_HANDLED;
3118 }
3119
3120 static irqreturn_t qlcnic_msix_intr(int irq, void *data)
3121 {
3122 struct qlcnic_host_sds_ring *sds_ring = data;
3123
3124 napi_schedule(&sds_ring->napi);
3125 return IRQ_HANDLED;
3126 }
3127
3128 static irqreturn_t qlcnic_msix_tx_intr(int irq, void *data)
3129 {
3130 struct qlcnic_host_tx_ring *tx_ring = data;
3131
3132 napi_schedule(&tx_ring->napi);
3133 return IRQ_HANDLED;
3134 }
3135
3136 #ifdef CONFIG_NET_POLL_CONTROLLER
3137 static void qlcnic_poll_controller(struct net_device *netdev)
3138 {
3139 struct qlcnic_adapter *adapter = netdev_priv(netdev);
3140 struct qlcnic_host_sds_ring *sds_ring;
3141 struct qlcnic_recv_context *recv_ctx;
3142 struct qlcnic_host_tx_ring *tx_ring;
3143 int ring;
3144
3145 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
3146 return;
3147
3148 recv_ctx = adapter->recv_ctx;
3149
3150 for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
3151 sds_ring = &recv_ctx->sds_rings[ring];
3152 qlcnic_disable_sds_intr(adapter, sds_ring);
3153 napi_schedule(&sds_ring->napi);
3154 }
3155
3156 if (adapter->flags & QLCNIC_MSIX_ENABLED) {
3157 /* Only Multi-Tx queue capable devices need to
3158 * schedule NAPI for TX rings
3159 */
3160 if ((qlcnic_83xx_check(adapter) &&
3161 (adapter->flags & QLCNIC_TX_INTR_SHARED)) ||
3162 (qlcnic_82xx_check(adapter) &&
3163 !qlcnic_check_multi_tx(adapter)))
3164 return;
3165
3166 for (ring = 0; ring < adapter->drv_tx_rings; ring++) {
3167 tx_ring = &adapter->tx_ring[ring];
3168 qlcnic_disable_tx_intr(adapter, tx_ring);
3169 napi_schedule(&tx_ring->napi);
3170 }
3171 }
3172 }
3173 #endif
3174
3175 static void
3176 qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding)
3177 {
3178 u32 val;
3179
3180 val = adapter->portnum & 0xf;
3181 val |= encoding << 7;
3182 val |= (jiffies - adapter->dev_rst_time) << 8;
3183
3184 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_SCRATCH, val);
3185 adapter->dev_rst_time = jiffies;
3186 }
3187
3188 static int
3189 qlcnic_set_drv_state(struct qlcnic_adapter *adapter, u8 state)
3190 {
3191 u32 val;
3192
3193 WARN_ON(state != QLCNIC_DEV_NEED_RESET &&
3194 state != QLCNIC_DEV_NEED_QUISCENT);
3195
3196 if (qlcnic_api_lock(adapter))
3197 return -EIO;
3198
3199 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3200
3201 if (state == QLCNIC_DEV_NEED_RESET)
3202 QLC_DEV_SET_RST_RDY(val, adapter->portnum);
3203 else if (state == QLCNIC_DEV_NEED_QUISCENT)
3204 QLC_DEV_SET_QSCNT_RDY(val, adapter->portnum);
3205
3206 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3207
3208 qlcnic_api_unlock(adapter);
3209
3210 return 0;
3211 }
3212
3213 static int
3214 qlcnic_clr_drv_state(struct qlcnic_adapter *adapter)
3215 {
3216 u32 val;
3217
3218 if (qlcnic_api_lock(adapter))
3219 return -EBUSY;
3220
3221 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3222 QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
3223 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3224
3225 qlcnic_api_unlock(adapter);
3226
3227 return 0;
3228 }
3229
3230 void qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter, u8 failed)
3231 {
3232 u32 val;
3233
3234 if (qlcnic_api_lock(adapter))
3235 goto err;
3236
3237 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3238 QLC_DEV_CLR_REF_CNT(val, adapter->portnum);
3239 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
3240
3241 if (failed) {
3242 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3243 QLCNIC_DEV_FAILED);
3244 dev_info(&adapter->pdev->dev,
3245 "Device state set to Failed. Please Reboot\n");
3246 } else if (!(val & 0x11111111))
3247 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3248 QLCNIC_DEV_COLD);
3249
3250 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3251 QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
3252 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3253
3254 qlcnic_api_unlock(adapter);
3255 err:
3256 adapter->fw_fail_cnt = 0;
3257 adapter->flags &= ~QLCNIC_FW_HANG;
3258 clear_bit(__QLCNIC_START_FW, &adapter->state);
3259 clear_bit(__QLCNIC_RESETTING, &adapter->state);
3260 }
3261
3262 /* Grab api lock, before checking state */
3263 static int
3264 qlcnic_check_drv_state(struct qlcnic_adapter *adapter)
3265 {
3266 int act, state, active_mask;
3267 struct qlcnic_hardware_context *ahw = adapter->ahw;
3268
3269 state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3270 act = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3271
3272 if (adapter->flags & QLCNIC_FW_RESET_OWNER) {
3273 active_mask = (~(1 << (ahw->pci_func * 4)));
3274 act = act & active_mask;
3275 }
3276
3277 if (((state & 0x11111111) == (act & 0x11111111)) ||
3278 ((act & 0x11111111) == ((state >> 1) & 0x11111111)))
3279 return 0;
3280 else
3281 return 1;
3282 }
3283
3284 static int qlcnic_check_idc_ver(struct qlcnic_adapter *adapter)
3285 {
3286 u32 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_IDC_VER);
3287
3288 if (val != QLCNIC_DRV_IDC_VER) {
3289 dev_warn(&adapter->pdev->dev, "IDC Version mismatch, driver's"
3290 " idc ver = %x; reqd = %x\n", QLCNIC_DRV_IDC_VER, val);
3291 }
3292
3293 return 0;
3294 }
3295
3296 static int
3297 qlcnic_can_start_firmware(struct qlcnic_adapter *adapter)
3298 {
3299 u32 val, prev_state;
3300 u8 dev_init_timeo = adapter->dev_init_timeo;
3301 u8 portnum = adapter->portnum;
3302 u8 ret;
3303
3304 if (test_and_clear_bit(__QLCNIC_START_FW, &adapter->state))
3305 return 1;
3306
3307 if (qlcnic_api_lock(adapter))
3308 return -1;
3309
3310 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_ACTIVE);
3311 if (!(val & (1 << (portnum * 4)))) {
3312 QLC_DEV_SET_REF_CNT(val, portnum);
3313 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_ACTIVE, val);
3314 }
3315
3316 prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3317 QLCDB(adapter, HW, "Device state = %u\n", prev_state);
3318
3319 switch (prev_state) {
3320 case QLCNIC_DEV_COLD:
3321 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3322 QLCNIC_DEV_INITIALIZING);
3323 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_IDC_VER,
3324 QLCNIC_DRV_IDC_VER);
3325 qlcnic_idc_debug_info(adapter, 0);
3326 qlcnic_api_unlock(adapter);
3327 return 1;
3328
3329 case QLCNIC_DEV_READY:
3330 ret = qlcnic_check_idc_ver(adapter);
3331 qlcnic_api_unlock(adapter);
3332 return ret;
3333
3334 case QLCNIC_DEV_NEED_RESET:
3335 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3336 QLC_DEV_SET_RST_RDY(val, portnum);
3337 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3338 break;
3339
3340 case QLCNIC_DEV_NEED_QUISCENT:
3341 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3342 QLC_DEV_SET_QSCNT_RDY(val, portnum);
3343 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3344 break;
3345
3346 case QLCNIC_DEV_FAILED:
3347 dev_err(&adapter->pdev->dev, "Device in failed state.\n");
3348 qlcnic_api_unlock(adapter);
3349 return -1;
3350
3351 case QLCNIC_DEV_INITIALIZING:
3352 case QLCNIC_DEV_QUISCENT:
3353 break;
3354 }
3355
3356 qlcnic_api_unlock(adapter);
3357
3358 do {
3359 msleep(1000);
3360 prev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3361
3362 if (prev_state == QLCNIC_DEV_QUISCENT)
3363 continue;
3364 } while ((prev_state != QLCNIC_DEV_READY) && --dev_init_timeo);
3365
3366 if (!dev_init_timeo) {
3367 dev_err(&adapter->pdev->dev,
3368 "Waiting for device to initialize timeout\n");
3369 return -1;
3370 }
3371
3372 if (qlcnic_api_lock(adapter))
3373 return -1;
3374
3375 val = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DRV_STATE);
3376 QLC_DEV_CLR_RST_QSCNT(val, portnum);
3377 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DRV_STATE, val);
3378
3379 ret = qlcnic_check_idc_ver(adapter);
3380 qlcnic_api_unlock(adapter);
3381
3382 return ret;
3383 }
3384
3385 static void
3386 qlcnic_fwinit_work(struct work_struct *work)
3387 {
3388 struct qlcnic_adapter *adapter = container_of(work,
3389 struct qlcnic_adapter, fw_work.work);
3390 u32 dev_state = 0xf;
3391 u32 val;
3392
3393 if (qlcnic_api_lock(adapter))
3394 goto err_ret;
3395
3396 dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3397 if (dev_state == QLCNIC_DEV_QUISCENT ||
3398 dev_state == QLCNIC_DEV_NEED_QUISCENT) {
3399 qlcnic_api_unlock(adapter);
3400 qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
3401 FW_POLL_DELAY * 2);
3402 return;
3403 }
3404
3405 if (adapter->ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
3406 qlcnic_api_unlock(adapter);
3407 goto wait_npar;
3408 }
3409
3410 if (dev_state == QLCNIC_DEV_INITIALIZING ||
3411 dev_state == QLCNIC_DEV_READY) {
3412 dev_info(&adapter->pdev->dev, "Detected state change from "
3413 "DEV_NEED_RESET, skipping ack check\n");
3414 goto skip_ack_check;
3415 }
3416
3417 if (adapter->fw_wait_cnt++ > adapter->reset_ack_timeo) {
3418 dev_info(&adapter->pdev->dev, "Reset:Failed to get ack %d sec\n",
3419 adapter->reset_ack_timeo);
3420 goto skip_ack_check;
3421 }
3422
3423 if (!qlcnic_check_drv_state(adapter)) {
3424 skip_ack_check:
3425 dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3426
3427 if (dev_state == QLCNIC_DEV_NEED_RESET) {
3428 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3429 QLCNIC_DEV_INITIALIZING);
3430 set_bit(__QLCNIC_START_FW, &adapter->state);
3431 QLCDB(adapter, DRV, "Restarting fw\n");
3432 qlcnic_idc_debug_info(adapter, 0);
3433 val = QLC_SHARED_REG_RD32(adapter,
3434 QLCNIC_CRB_DRV_STATE);
3435 QLC_DEV_SET_RST_RDY(val, adapter->portnum);
3436 QLC_SHARED_REG_WR32(adapter,
3437 QLCNIC_CRB_DRV_STATE, val);
3438 }
3439
3440 qlcnic_api_unlock(adapter);
3441
3442 rtnl_lock();
3443 if (qlcnic_check_fw_dump_state(adapter) &&
3444 (adapter->flags & QLCNIC_FW_RESET_OWNER)) {
3445 QLCDB(adapter, DRV, "Take FW dump\n");
3446 qlcnic_dump_fw(adapter);
3447 adapter->flags |= QLCNIC_FW_HANG;
3448 }
3449 rtnl_unlock();
3450
3451 adapter->flags &= ~QLCNIC_FW_RESET_OWNER;
3452 if (!adapter->nic_ops->start_firmware(adapter)) {
3453 qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
3454 adapter->fw_wait_cnt = 0;
3455 return;
3456 }
3457 goto err_ret;
3458 }
3459
3460 qlcnic_api_unlock(adapter);
3461
3462 wait_npar:
3463 dev_state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3464 QLCDB(adapter, HW, "Func waiting: Device state=%u\n", dev_state);
3465
3466 switch (dev_state) {
3467 case QLCNIC_DEV_READY:
3468 if (!qlcnic_start_firmware(adapter)) {
3469 qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
3470 adapter->fw_wait_cnt = 0;
3471 return;
3472 }
3473 case QLCNIC_DEV_FAILED:
3474 break;
3475 default:
3476 qlcnic_schedule_work(adapter,
3477 qlcnic_fwinit_work, FW_POLL_DELAY);
3478 return;
3479 }
3480
3481 err_ret:
3482 dev_err(&adapter->pdev->dev, "Fwinit work failed state=%u "
3483 "fw_wait_cnt=%u\n", dev_state, adapter->fw_wait_cnt);
3484 netif_device_attach(adapter->netdev);
3485 qlcnic_clr_all_drv_state(adapter, 0);
3486 }
3487
3488 static void
3489 qlcnic_detach_work(struct work_struct *work)
3490 {
3491 struct qlcnic_adapter *adapter = container_of(work,
3492 struct qlcnic_adapter, fw_work.work);
3493 struct net_device *netdev = adapter->netdev;
3494 u32 status;
3495
3496 netif_device_detach(netdev);
3497
3498 /* Dont grab rtnl lock during Quiscent mode */
3499 if (adapter->dev_state == QLCNIC_DEV_NEED_QUISCENT) {
3500 if (netif_running(netdev))
3501 __qlcnic_down(adapter, netdev);
3502 } else
3503 qlcnic_down(adapter, netdev);
3504
3505 status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
3506
3507 if (status & QLCNIC_RCODE_FATAL_ERROR) {
3508 dev_err(&adapter->pdev->dev,
3509 "Detaching the device: peg halt status1=0x%x\n",
3510 status);
3511
3512 if (QLCNIC_FWERROR_CODE(status) == QLCNIC_FWERROR_FAN_FAILURE) {
3513 dev_err(&adapter->pdev->dev,
3514 "On board active cooling fan failed. "
3515 "Device has been halted.\n");
3516 dev_err(&adapter->pdev->dev,
3517 "Replace the adapter.\n");
3518 }
3519
3520 goto err_ret;
3521 }
3522
3523 if (adapter->ahw->temp == QLCNIC_TEMP_PANIC) {
3524 dev_err(&adapter->pdev->dev, "Detaching the device: temp=%d\n",
3525 adapter->ahw->temp);
3526 goto err_ret;
3527 }
3528
3529 /* Dont ack if this instance is the reset owner */
3530 if (!(adapter->flags & QLCNIC_FW_RESET_OWNER)) {
3531 if (qlcnic_set_drv_state(adapter, adapter->dev_state)) {
3532 dev_err(&adapter->pdev->dev,
3533 "Failed to set driver state,"
3534 "detaching the device.\n");
3535 goto err_ret;
3536 }
3537 }
3538
3539 adapter->fw_wait_cnt = 0;
3540
3541 qlcnic_schedule_work(adapter, qlcnic_fwinit_work, FW_POLL_DELAY);
3542
3543 return;
3544
3545 err_ret:
3546 netif_device_attach(netdev);
3547 qlcnic_clr_all_drv_state(adapter, 1);
3548 }
3549
3550 /*Transit NPAR state to NON Operational */
3551 static void
3552 qlcnic_set_npar_non_operational(struct qlcnic_adapter *adapter)
3553 {
3554 u32 state;
3555
3556 state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_NPAR_STATE);
3557 if (state == QLCNIC_DEV_NPAR_NON_OPER)
3558 return;
3559
3560 if (qlcnic_api_lock(adapter))
3561 return;
3562 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3563 QLCNIC_DEV_NPAR_NON_OPER);
3564 qlcnic_api_unlock(adapter);
3565 }
3566
3567 static void qlcnic_82xx_dev_request_reset(struct qlcnic_adapter *adapter,
3568 u32 key)
3569 {
3570 u32 state, xg_val = 0, gb_val = 0;
3571
3572 qlcnic_xg_set_xg0_mask(xg_val);
3573 qlcnic_xg_set_xg1_mask(xg_val);
3574 QLCWR32(adapter, QLCNIC_NIU_XG_PAUSE_CTL, xg_val);
3575 qlcnic_gb_set_gb0_mask(gb_val);
3576 qlcnic_gb_set_gb1_mask(gb_val);
3577 qlcnic_gb_set_gb2_mask(gb_val);
3578 qlcnic_gb_set_gb3_mask(gb_val);
3579 QLCWR32(adapter, QLCNIC_NIU_GB_PAUSE_CTL, gb_val);
3580 dev_info(&adapter->pdev->dev, "Pause control frames disabled"
3581 " on all ports\n");
3582 adapter->need_fw_reset = 1;
3583
3584 if (qlcnic_api_lock(adapter))
3585 return;
3586
3587 state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3588
3589 if (test_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state)) {
3590 netdev_err(adapter->netdev, "%s: Device is in non-operational state\n",
3591 __func__);
3592 qlcnic_api_unlock(adapter);
3593
3594 return;
3595 }
3596
3597 if (state == QLCNIC_DEV_READY) {
3598 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3599 QLCNIC_DEV_NEED_RESET);
3600 adapter->flags |= QLCNIC_FW_RESET_OWNER;
3601 QLCDB(adapter, DRV, "NEED_RESET state set\n");
3602 qlcnic_idc_debug_info(adapter, 0);
3603 }
3604
3605 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3606 QLCNIC_DEV_NPAR_NON_OPER);
3607 qlcnic_api_unlock(adapter);
3608 }
3609
3610 /* Transit to NPAR READY state from NPAR NOT READY state */
3611 static void
3612 qlcnic_dev_set_npar_ready(struct qlcnic_adapter *adapter)
3613 {
3614 if (qlcnic_api_lock(adapter))
3615 return;
3616
3617 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_NPAR_STATE,
3618 QLCNIC_DEV_NPAR_OPER);
3619 QLCDB(adapter, DRV, "NPAR operational state set\n");
3620
3621 qlcnic_api_unlock(adapter);
3622 }
3623
3624 void qlcnic_schedule_work(struct qlcnic_adapter *adapter,
3625 work_func_t func, int delay)
3626 {
3627 if (test_bit(__QLCNIC_AER, &adapter->state))
3628 return;
3629
3630 INIT_DELAYED_WORK(&adapter->fw_work, func);
3631 queue_delayed_work(adapter->qlcnic_wq, &adapter->fw_work,
3632 round_jiffies_relative(delay));
3633 }
3634
3635 static void
3636 qlcnic_attach_work(struct work_struct *work)
3637 {
3638 struct qlcnic_adapter *adapter = container_of(work,
3639 struct qlcnic_adapter, fw_work.work);
3640 struct net_device *netdev = adapter->netdev;
3641 u32 npar_state;
3642
3643 if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
3644 npar_state = QLC_SHARED_REG_RD32(adapter,
3645 QLCNIC_CRB_DEV_NPAR_STATE);
3646 if (adapter->fw_wait_cnt++ > QLCNIC_DEV_NPAR_OPER_TIMEO)
3647 qlcnic_clr_all_drv_state(adapter, 0);
3648 else if (npar_state != QLCNIC_DEV_NPAR_OPER)
3649 qlcnic_schedule_work(adapter, qlcnic_attach_work,
3650 FW_POLL_DELAY);
3651 else
3652 goto attach;
3653 QLCDB(adapter, DRV, "Waiting for NPAR state to operational\n");
3654 return;
3655 }
3656 attach:
3657 qlcnic_dcb_get_info(adapter->dcb);
3658
3659 if (netif_running(netdev)) {
3660 if (qlcnic_up(adapter, netdev))
3661 goto done;
3662
3663 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3664 }
3665
3666 done:
3667 netif_device_attach(netdev);
3668 adapter->fw_fail_cnt = 0;
3669 adapter->flags &= ~QLCNIC_FW_HANG;
3670 clear_bit(__QLCNIC_RESETTING, &adapter->state);
3671 if (adapter->portnum == 0)
3672 qlcnic_set_drv_version(adapter);
3673
3674 if (!qlcnic_clr_drv_state(adapter))
3675 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3676 FW_POLL_DELAY);
3677 }
3678
3679 static int
3680 qlcnic_check_health(struct qlcnic_adapter *adapter)
3681 {
3682 struct qlcnic_hardware_context *ahw = adapter->ahw;
3683 struct qlcnic_fw_dump *fw_dump = &ahw->fw_dump;
3684 u32 state = 0, heartbeat;
3685 u32 peg_status;
3686 int err = 0;
3687
3688 if (qlcnic_check_temp(adapter))
3689 goto detach;
3690
3691 if (adapter->need_fw_reset)
3692 qlcnic_dev_request_reset(adapter, 0);
3693
3694 state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3695 if (state == QLCNIC_DEV_NEED_RESET) {
3696 qlcnic_set_npar_non_operational(adapter);
3697 adapter->need_fw_reset = 1;
3698 } else if (state == QLCNIC_DEV_NEED_QUISCENT)
3699 goto detach;
3700
3701 heartbeat = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_ALIVE_COUNTER);
3702 if (heartbeat != adapter->heartbeat) {
3703 adapter->heartbeat = heartbeat;
3704 adapter->fw_fail_cnt = 0;
3705 if (adapter->need_fw_reset)
3706 goto detach;
3707
3708 if (ahw->reset_context && qlcnic_auto_fw_reset)
3709 qlcnic_reset_hw_context(adapter);
3710
3711 return 0;
3712 }
3713
3714 if (++adapter->fw_fail_cnt < FW_FAIL_THRESH)
3715 return 0;
3716
3717 adapter->flags |= QLCNIC_FW_HANG;
3718
3719 qlcnic_dev_request_reset(adapter, 0);
3720
3721 if (qlcnic_auto_fw_reset)
3722 clear_bit(__QLCNIC_FW_ATTACHED, &adapter->state);
3723
3724 dev_err(&adapter->pdev->dev, "firmware hang detected\n");
3725 peg_status = QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS1);
3726 dev_err(&adapter->pdev->dev, "Dumping hw/fw registers\n"
3727 "PEG_HALT_STATUS1: 0x%x, PEG_HALT_STATUS2: 0x%x,\n"
3728 "PEG_NET_0_PC: 0x%x, PEG_NET_1_PC: 0x%x,\n"
3729 "PEG_NET_2_PC: 0x%x, PEG_NET_3_PC: 0x%x,\n"
3730 "PEG_NET_4_PC: 0x%x\n",
3731 peg_status,
3732 QLC_SHARED_REG_RD32(adapter, QLCNIC_PEG_HALT_STATUS2),
3733 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_0 + 0x3c, &err),
3734 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_1 + 0x3c, &err),
3735 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_2 + 0x3c, &err),
3736 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_3 + 0x3c, &err),
3737 QLCRD32(adapter, QLCNIC_CRB_PEG_NET_4 + 0x3c, &err));
3738 if (QLCNIC_FWERROR_CODE(peg_status) == 0x67)
3739 dev_err(&adapter->pdev->dev,
3740 "Firmware aborted with error code 0x00006700. "
3741 "Device is being reset.\n");
3742 detach:
3743 adapter->dev_state = (state == QLCNIC_DEV_NEED_QUISCENT) ? state :
3744 QLCNIC_DEV_NEED_RESET;
3745
3746 if (qlcnic_auto_fw_reset && !test_and_set_bit(__QLCNIC_RESETTING,
3747 &adapter->state)) {
3748
3749 qlcnic_schedule_work(adapter, qlcnic_detach_work, 0);
3750 QLCDB(adapter, DRV, "fw recovery scheduled.\n");
3751 } else if (!qlcnic_auto_fw_reset && fw_dump->enable &&
3752 adapter->flags & QLCNIC_FW_RESET_OWNER) {
3753 qlcnic_dump_fw(adapter);
3754 }
3755
3756 return 1;
3757 }
3758
3759 void qlcnic_fw_poll_work(struct work_struct *work)
3760 {
3761 struct qlcnic_adapter *adapter = container_of(work,
3762 struct qlcnic_adapter, fw_work.work);
3763
3764 if (test_bit(__QLCNIC_RESETTING, &adapter->state))
3765 goto reschedule;
3766
3767
3768 if (qlcnic_check_health(adapter))
3769 return;
3770
3771 if (adapter->fhash.fnum)
3772 qlcnic_prune_lb_filters(adapter);
3773
3774 reschedule:
3775 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
3776 }
3777
3778 static int qlcnic_is_first_func(struct pci_dev *pdev)
3779 {
3780 struct pci_dev *oth_pdev;
3781 int val = pdev->devfn;
3782
3783 while (val-- > 0) {
3784 oth_pdev = pci_get_domain_bus_and_slot(pci_domain_nr
3785 (pdev->bus), pdev->bus->number,
3786 PCI_DEVFN(PCI_SLOT(pdev->devfn), val));
3787 if (!oth_pdev)
3788 continue;
3789
3790 if (oth_pdev->current_state != PCI_D3cold) {
3791 pci_dev_put(oth_pdev);
3792 return 0;
3793 }
3794 pci_dev_put(oth_pdev);
3795 }
3796 return 1;
3797 }
3798
3799 static int qlcnic_attach_func(struct pci_dev *pdev)
3800 {
3801 int err, first_func;
3802 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3803 struct net_device *netdev = adapter->netdev;
3804
3805 pdev->error_state = pci_channel_io_normal;
3806
3807 err = pci_enable_device(pdev);
3808 if (err)
3809 return err;
3810
3811 pci_set_master(pdev);
3812 pci_restore_state(pdev);
3813
3814 first_func = qlcnic_is_first_func(pdev);
3815
3816 if (qlcnic_api_lock(adapter))
3817 return -EINVAL;
3818
3819 if (adapter->ahw->op_mode != QLCNIC_NON_PRIV_FUNC && first_func) {
3820 adapter->need_fw_reset = 1;
3821 set_bit(__QLCNIC_START_FW, &adapter->state);
3822 QLC_SHARED_REG_WR32(adapter, QLCNIC_CRB_DEV_STATE,
3823 QLCNIC_DEV_INITIALIZING);
3824 QLCDB(adapter, DRV, "Restarting fw\n");
3825 }
3826 qlcnic_api_unlock(adapter);
3827
3828 err = qlcnic_start_firmware(adapter);
3829 if (err)
3830 return err;
3831
3832 qlcnic_clr_drv_state(adapter);
3833 kfree(adapter->msix_entries);
3834 adapter->msix_entries = NULL;
3835 err = qlcnic_setup_intr(adapter);
3836
3837 if (err) {
3838 kfree(adapter->msix_entries);
3839 netdev_err(netdev, "failed to setup interrupt\n");
3840 return err;
3841 }
3842
3843 if (netif_running(netdev)) {
3844 err = qlcnic_attach(adapter);
3845 if (err) {
3846 qlcnic_clr_all_drv_state(adapter, 1);
3847 clear_bit(__QLCNIC_AER, &adapter->state);
3848 netif_device_attach(netdev);
3849 return err;
3850 }
3851
3852 err = qlcnic_up(adapter, netdev);
3853 if (err)
3854 goto done;
3855
3856 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
3857 }
3858 done:
3859 netif_device_attach(netdev);
3860 return err;
3861 }
3862
3863 static pci_ers_result_t qlcnic_82xx_io_error_detected(struct pci_dev *pdev,
3864 pci_channel_state_t state)
3865 {
3866 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3867 struct net_device *netdev = adapter->netdev;
3868
3869 if (state == pci_channel_io_perm_failure)
3870 return PCI_ERS_RESULT_DISCONNECT;
3871
3872 if (state == pci_channel_io_normal)
3873 return PCI_ERS_RESULT_RECOVERED;
3874
3875 set_bit(__QLCNIC_AER, &adapter->state);
3876 netif_device_detach(netdev);
3877
3878 cancel_delayed_work_sync(&adapter->fw_work);
3879
3880 if (netif_running(netdev))
3881 qlcnic_down(adapter, netdev);
3882
3883 qlcnic_detach(adapter);
3884 qlcnic_teardown_intr(adapter);
3885
3886 clear_bit(__QLCNIC_RESETTING, &adapter->state);
3887
3888 pci_save_state(pdev);
3889 pci_disable_device(pdev);
3890
3891 return PCI_ERS_RESULT_NEED_RESET;
3892 }
3893
3894 static pci_ers_result_t qlcnic_82xx_io_slot_reset(struct pci_dev *pdev)
3895 {
3896 return qlcnic_attach_func(pdev) ? PCI_ERS_RESULT_DISCONNECT :
3897 PCI_ERS_RESULT_RECOVERED;
3898 }
3899
3900 static void qlcnic_82xx_io_resume(struct pci_dev *pdev)
3901 {
3902 u32 state;
3903 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3904
3905 pci_cleanup_aer_uncorrect_error_status(pdev);
3906 state = QLC_SHARED_REG_RD32(adapter, QLCNIC_CRB_DEV_STATE);
3907 if (state == QLCNIC_DEV_READY && test_and_clear_bit(__QLCNIC_AER,
3908 &adapter->state))
3909 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
3910 FW_POLL_DELAY);
3911 }
3912
3913 static pci_ers_result_t qlcnic_io_error_detected(struct pci_dev *pdev,
3914 pci_channel_state_t state)
3915 {
3916 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3917 struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
3918
3919 if (hw_ops->io_error_detected) {
3920 return hw_ops->io_error_detected(pdev, state);
3921 } else {
3922 dev_err(&pdev->dev, "AER error_detected handler not registered.\n");
3923 return PCI_ERS_RESULT_DISCONNECT;
3924 }
3925 }
3926
3927 static pci_ers_result_t qlcnic_io_slot_reset(struct pci_dev *pdev)
3928 {
3929 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3930 struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
3931
3932 if (hw_ops->io_slot_reset) {
3933 return hw_ops->io_slot_reset(pdev);
3934 } else {
3935 dev_err(&pdev->dev, "AER slot_reset handler not registered.\n");
3936 return PCI_ERS_RESULT_DISCONNECT;
3937 }
3938 }
3939
3940 static void qlcnic_io_resume(struct pci_dev *pdev)
3941 {
3942 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
3943 struct qlcnic_hardware_ops *hw_ops = adapter->ahw->hw_ops;
3944
3945 if (hw_ops->io_resume)
3946 hw_ops->io_resume(pdev);
3947 else
3948 dev_err(&pdev->dev, "AER resume handler not registered.\n");
3949 }
3950
3951
3952 static int
3953 qlcnicvf_start_firmware(struct qlcnic_adapter *adapter)
3954 {
3955 int err;
3956
3957 err = qlcnic_can_start_firmware(adapter);
3958 if (err)
3959 return err;
3960
3961 err = qlcnic_check_npar_opertional(adapter);
3962 if (err)
3963 return err;
3964
3965 err = qlcnic_initialize_nic(adapter);
3966 if (err)
3967 return err;
3968
3969 qlcnic_check_options(adapter);
3970
3971 err = qlcnic_set_eswitch_port_config(adapter);
3972 if (err)
3973 return err;
3974
3975 adapter->need_fw_reset = 0;
3976
3977 return err;
3978 }
3979
3980 int qlcnic_validate_rings(struct qlcnic_adapter *adapter, __u32 ring_cnt,
3981 int queue_type)
3982 {
3983 struct net_device *netdev = adapter->netdev;
3984 u8 max_hw_rings = 0;
3985 char buf[8];
3986 int cur_rings;
3987
3988 if (queue_type == QLCNIC_RX_QUEUE) {
3989 max_hw_rings = adapter->max_sds_rings;
3990 cur_rings = adapter->drv_sds_rings;
3991 strcpy(buf, "SDS");
3992 } else if (queue_type == QLCNIC_TX_QUEUE) {
3993 max_hw_rings = adapter->max_tx_rings;
3994 cur_rings = adapter->drv_tx_rings;
3995 strcpy(buf, "Tx");
3996 }
3997
3998 if (!QLCNIC_IS_MSI_FAMILY(adapter)) {
3999 netdev_err(netdev, "No RSS/TSS support in INT-x mode\n");
4000 return -EINVAL;
4001 }
4002
4003 if (adapter->flags & QLCNIC_MSI_ENABLED) {
4004 netdev_err(netdev, "No RSS/TSS support in MSI mode\n");
4005 return -EINVAL;
4006 }
4007
4008 if (!is_power_of_2(ring_cnt)) {
4009 netdev_err(netdev, "%s rings value should be a power of 2\n",
4010 buf);
4011 return -EINVAL;
4012 }
4013
4014 if (qlcnic_82xx_check(adapter) && (queue_type == QLCNIC_TX_QUEUE) &&
4015 !qlcnic_check_multi_tx(adapter)) {
4016 netdev_err(netdev, "No Multi Tx queue support\n");
4017 return -EINVAL;
4018 }
4019
4020 if (ring_cnt > num_online_cpus()) {
4021 netdev_err(netdev,
4022 "%s value[%u] should not be higher than, number of online CPUs\n",
4023 buf, num_online_cpus());
4024 return -EINVAL;
4025 }
4026
4027 return 0;
4028 }
4029
4030 int qlcnic_setup_rings(struct qlcnic_adapter *adapter)
4031 {
4032 struct net_device *netdev = adapter->netdev;
4033 u8 tx_rings, rx_rings;
4034 int err;
4035
4036 if (test_bit(__QLCNIC_RESETTING, &adapter->state))
4037 return -EBUSY;
4038
4039 tx_rings = adapter->drv_tss_rings;
4040 rx_rings = adapter->drv_rss_rings;
4041
4042 netif_device_detach(netdev);
4043
4044 err = qlcnic_set_real_num_queues(adapter, tx_rings, rx_rings);
4045 if (err)
4046 goto done;
4047
4048 if (netif_running(netdev))
4049 __qlcnic_down(adapter, netdev);
4050
4051 qlcnic_detach(adapter);
4052
4053 if (qlcnic_83xx_check(adapter)) {
4054 qlcnic_83xx_free_mbx_intr(adapter);
4055 qlcnic_83xx_enable_mbx_poll(adapter);
4056 }
4057
4058 qlcnic_teardown_intr(adapter);
4059
4060 err = qlcnic_setup_intr(adapter);
4061 if (err) {
4062 kfree(adapter->msix_entries);
4063 netdev_err(netdev, "failed to setup interrupt\n");
4064 return err;
4065 }
4066
4067 /* Check if we need to update real_num_{tx|rx}_queues because
4068 * qlcnic_setup_intr() may change Tx/Rx rings size
4069 */
4070 if ((tx_rings != adapter->drv_tx_rings) ||
4071 (rx_rings != adapter->drv_sds_rings)) {
4072 err = qlcnic_set_real_num_queues(adapter,
4073 adapter->drv_tx_rings,
4074 adapter->drv_sds_rings);
4075 if (err)
4076 goto done;
4077 }
4078
4079 if (qlcnic_83xx_check(adapter)) {
4080 qlcnic_83xx_initialize_nic(adapter, 1);
4081 err = qlcnic_83xx_setup_mbx_intr(adapter);
4082 qlcnic_83xx_disable_mbx_poll(adapter);
4083 if (err) {
4084 dev_err(&adapter->pdev->dev,
4085 "failed to setup mbx interrupt\n");
4086 goto done;
4087 }
4088 }
4089
4090 if (netif_running(netdev)) {
4091 err = qlcnic_attach(adapter);
4092 if (err)
4093 goto done;
4094 err = __qlcnic_up(adapter, netdev);
4095 if (err)
4096 goto done;
4097 qlcnic_restore_indev_addr(netdev, NETDEV_UP);
4098 }
4099 done:
4100 netif_device_attach(netdev);
4101 clear_bit(__QLCNIC_RESETTING, &adapter->state);
4102 return err;
4103 }
4104
4105 #ifdef CONFIG_INET
4106
4107 #define is_qlcnic_netdev(dev) (dev->netdev_ops == &qlcnic_netdev_ops)
4108
4109 static void
4110 qlcnic_config_indev_addr(struct qlcnic_adapter *adapter,
4111 struct net_device *dev, unsigned long event)
4112 {
4113 struct in_device *indev;
4114
4115 indev = in_dev_get(dev);
4116 if (!indev)
4117 return;
4118
4119 for_ifa(indev) {
4120 switch (event) {
4121 case NETDEV_UP:
4122 qlcnic_config_ipaddr(adapter,
4123 ifa->ifa_address, QLCNIC_IP_UP);
4124 break;
4125 case NETDEV_DOWN:
4126 qlcnic_config_ipaddr(adapter,
4127 ifa->ifa_address, QLCNIC_IP_DOWN);
4128 break;
4129 default:
4130 break;
4131 }
4132 } endfor_ifa(indev);
4133
4134 in_dev_put(indev);
4135 }
4136
4137 void qlcnic_restore_indev_addr(struct net_device *netdev, unsigned long event)
4138 {
4139 struct qlcnic_adapter *adapter = netdev_priv(netdev);
4140 struct net_device *dev;
4141 u16 vid;
4142
4143 qlcnic_config_indev_addr(adapter, netdev, event);
4144
4145 rcu_read_lock();
4146 for_each_set_bit(vid, adapter->vlans, VLAN_N_VID) {
4147 dev = __vlan_find_dev_deep_rcu(netdev, htons(ETH_P_8021Q), vid);
4148 if (!dev)
4149 continue;
4150 qlcnic_config_indev_addr(adapter, dev, event);
4151 }
4152 rcu_read_unlock();
4153 }
4154
4155 static int qlcnic_netdev_event(struct notifier_block *this,
4156 unsigned long event, void *ptr)
4157 {
4158 struct qlcnic_adapter *adapter;
4159 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
4160
4161 recheck:
4162 if (dev == NULL)
4163 goto done;
4164
4165 if (dev->priv_flags & IFF_802_1Q_VLAN) {
4166 dev = vlan_dev_real_dev(dev);
4167 goto recheck;
4168 }
4169
4170 if (!is_qlcnic_netdev(dev))
4171 goto done;
4172
4173 adapter = netdev_priv(dev);
4174
4175 if (!adapter)
4176 goto done;
4177
4178 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
4179 goto done;
4180
4181 qlcnic_config_indev_addr(adapter, dev, event);
4182 done:
4183 return NOTIFY_DONE;
4184 }
4185
4186 static int
4187 qlcnic_inetaddr_event(struct notifier_block *this,
4188 unsigned long event, void *ptr)
4189 {
4190 struct qlcnic_adapter *adapter;
4191 struct net_device *dev;
4192
4193 struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;
4194
4195 dev = ifa->ifa_dev ? ifa->ifa_dev->dev : NULL;
4196
4197 recheck:
4198 if (dev == NULL)
4199 goto done;
4200
4201 if (dev->priv_flags & IFF_802_1Q_VLAN) {
4202 dev = vlan_dev_real_dev(dev);
4203 goto recheck;
4204 }
4205
4206 if (!is_qlcnic_netdev(dev))
4207 goto done;
4208
4209 adapter = netdev_priv(dev);
4210
4211 if (!adapter)
4212 goto done;
4213
4214 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state))
4215 goto done;
4216
4217 switch (event) {
4218 case NETDEV_UP:
4219 qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_UP);
4220
4221 break;
4222 case NETDEV_DOWN:
4223 qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_DOWN);
4224
4225 break;
4226 default:
4227 break;
4228 }
4229
4230 done:
4231 return NOTIFY_DONE;
4232 }
4233
4234 static struct notifier_block qlcnic_netdev_cb = {
4235 .notifier_call = qlcnic_netdev_event,
4236 };
4237
4238 static struct notifier_block qlcnic_inetaddr_cb = {
4239 .notifier_call = qlcnic_inetaddr_event,
4240 };
4241 #else
4242 void qlcnic_restore_indev_addr(struct net_device *dev, unsigned long event)
4243 { }
4244 #endif
4245 static const struct pci_error_handlers qlcnic_err_handler = {
4246 .error_detected = qlcnic_io_error_detected,
4247 .slot_reset = qlcnic_io_slot_reset,
4248 .resume = qlcnic_io_resume,
4249 };
4250
4251 static struct pci_driver qlcnic_driver = {
4252 .name = qlcnic_driver_name,
4253 .id_table = qlcnic_pci_tbl,
4254 .probe = qlcnic_probe,
4255 .remove = qlcnic_remove,
4256 #ifdef CONFIG_PM
4257 .suspend = qlcnic_suspend,
4258 .resume = qlcnic_resume,
4259 #endif
4260 .shutdown = qlcnic_shutdown,
4261 .err_handler = &qlcnic_err_handler,
4262 #ifdef CONFIG_QLCNIC_SRIOV
4263 .sriov_configure = qlcnic_pci_sriov_configure,
4264 #endif
4265
4266 };
4267
4268 static int __init qlcnic_init_module(void)
4269 {
4270 int ret;
4271
4272 printk(KERN_INFO "%s\n", qlcnic_driver_string);
4273
4274 #ifdef CONFIG_INET
4275 register_netdevice_notifier(&qlcnic_netdev_cb);
4276 register_inetaddr_notifier(&qlcnic_inetaddr_cb);
4277 #endif
4278
4279 ret = pci_register_driver(&qlcnic_driver);
4280 if (ret) {
4281 #ifdef CONFIG_INET
4282 unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4283 unregister_netdevice_notifier(&qlcnic_netdev_cb);
4284 #endif
4285 }
4286
4287 return ret;
4288 }
4289
4290 module_init(qlcnic_init_module);
4291
4292 static void __exit qlcnic_exit_module(void)
4293 {
4294 pci_unregister_driver(&qlcnic_driver);
4295
4296 #ifdef CONFIG_INET
4297 unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
4298 unregister_netdevice_notifier(&qlcnic_netdev_cb);
4299 #endif
4300 }
4301
4302 module_exit(qlcnic_exit_module);
Linux kernel - Deliverables
This page took 0.134275 seconds and 5 git commands to generate.