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