1fe56b9e6SYuval Mintz /* QLogic qed NIC Driver
2fe56b9e6SYuval Mintz  * Copyright (c) 2015 QLogic Corporation
3fe56b9e6SYuval Mintz  *
4fe56b9e6SYuval Mintz  * This software is available under the terms of the GNU General Public License
5fe56b9e6SYuval Mintz  * (GPL) Version 2, available from the file COPYING in the main directory of
6fe56b9e6SYuval Mintz  * this source tree.
7fe56b9e6SYuval Mintz  */
8fe56b9e6SYuval Mintz 
9fe56b9e6SYuval Mintz #include <linux/stddef.h>
10fe56b9e6SYuval Mintz #include <linux/pci.h>
11fe56b9e6SYuval Mintz #include <linux/kernel.h>
12fe56b9e6SYuval Mintz #include <linux/slab.h>
13fe56b9e6SYuval Mintz #include <linux/version.h>
14fe56b9e6SYuval Mintz #include <linux/delay.h>
15fe56b9e6SYuval Mintz #include <asm/byteorder.h>
16fe56b9e6SYuval Mintz #include <linux/dma-mapping.h>
17fe56b9e6SYuval Mintz #include <linux/string.h>
18fe56b9e6SYuval Mintz #include <linux/module.h>
19fe56b9e6SYuval Mintz #include <linux/interrupt.h>
20fe56b9e6SYuval Mintz #include <linux/workqueue.h>
21fe56b9e6SYuval Mintz #include <linux/ethtool.h>
22fe56b9e6SYuval Mintz #include <linux/etherdevice.h>
23fe56b9e6SYuval Mintz #include <linux/vmalloc.h>
24fe56b9e6SYuval Mintz #include <linux/qed/qed_if.h>
25fe56b9e6SYuval Mintz 
26fe56b9e6SYuval Mintz #include "qed.h"
27fe56b9e6SYuval Mintz #include "qed_sp.h"
28fe56b9e6SYuval Mintz #include "qed_dev_api.h"
29fe56b9e6SYuval Mintz #include "qed_mcp.h"
30fe56b9e6SYuval Mintz #include "qed_hw.h"
31fe56b9e6SYuval Mintz 
32fe56b9e6SYuval Mintz static const char version[] =
33fe56b9e6SYuval Mintz 	"QLogic QL4xxx 40G/100G Ethernet Driver qed " DRV_MODULE_VERSION "\n";
34fe56b9e6SYuval Mintz 
35fe56b9e6SYuval Mintz MODULE_DESCRIPTION("QLogic 25G/40G/50G/100G Core Module");
36fe56b9e6SYuval Mintz MODULE_LICENSE("GPL");
37fe56b9e6SYuval Mintz MODULE_VERSION(DRV_MODULE_VERSION);
38fe56b9e6SYuval Mintz 
39fe56b9e6SYuval Mintz #define FW_FILE_VERSION				\
40fe56b9e6SYuval Mintz 	__stringify(FW_MAJOR_VERSION) "."	\
41fe56b9e6SYuval Mintz 	__stringify(FW_MINOR_VERSION) "."	\
42fe56b9e6SYuval Mintz 	__stringify(FW_REVISION_VERSION) "."	\
43fe56b9e6SYuval Mintz 	__stringify(FW_ENGINEERING_VERSION)
44fe56b9e6SYuval Mintz 
45fe56b9e6SYuval Mintz #define QED_FW_FILE_NAME	\
46fe56b9e6SYuval Mintz 	"qed/qed_init_values_zipped-" FW_FILE_VERSION ".bin"
47fe56b9e6SYuval Mintz 
48fe56b9e6SYuval Mintz static int __init qed_init(void)
49fe56b9e6SYuval Mintz {
50fe56b9e6SYuval Mintz 	pr_notice("qed_init called\n");
51fe56b9e6SYuval Mintz 
52fe56b9e6SYuval Mintz 	pr_info("%s", version);
53fe56b9e6SYuval Mintz 
54fe56b9e6SYuval Mintz 	return 0;
55fe56b9e6SYuval Mintz }
56fe56b9e6SYuval Mintz 
57fe56b9e6SYuval Mintz static void __exit qed_cleanup(void)
58fe56b9e6SYuval Mintz {
59fe56b9e6SYuval Mintz 	pr_notice("qed_cleanup called\n");
60fe56b9e6SYuval Mintz }
61fe56b9e6SYuval Mintz 
62fe56b9e6SYuval Mintz module_init(qed_init);
63fe56b9e6SYuval Mintz module_exit(qed_cleanup);
64fe56b9e6SYuval Mintz 
65fe56b9e6SYuval Mintz /* Check if the DMA controller on the machine can properly handle the DMA
66fe56b9e6SYuval Mintz  * addressing required by the device.
67fe56b9e6SYuval Mintz */
68fe56b9e6SYuval Mintz static int qed_set_coherency_mask(struct qed_dev *cdev)
69fe56b9e6SYuval Mintz {
70fe56b9e6SYuval Mintz 	struct device *dev = &cdev->pdev->dev;
71fe56b9e6SYuval Mintz 
72fe56b9e6SYuval Mintz 	if (dma_set_mask(dev, DMA_BIT_MASK(64)) == 0) {
73fe56b9e6SYuval Mintz 		if (dma_set_coherent_mask(dev, DMA_BIT_MASK(64)) != 0) {
74fe56b9e6SYuval Mintz 			DP_NOTICE(cdev,
75fe56b9e6SYuval Mintz 				  "Can't request 64-bit consistent allocations\n");
76fe56b9e6SYuval Mintz 			return -EIO;
77fe56b9e6SYuval Mintz 		}
78fe56b9e6SYuval Mintz 	} else if (dma_set_mask(dev, DMA_BIT_MASK(32)) != 0) {
79fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "Can't request 64b/32b DMA addresses\n");
80fe56b9e6SYuval Mintz 		return -EIO;
81fe56b9e6SYuval Mintz 	}
82fe56b9e6SYuval Mintz 
83fe56b9e6SYuval Mintz 	return 0;
84fe56b9e6SYuval Mintz }
85fe56b9e6SYuval Mintz 
86fe56b9e6SYuval Mintz static void qed_free_pci(struct qed_dev *cdev)
87fe56b9e6SYuval Mintz {
88fe56b9e6SYuval Mintz 	struct pci_dev *pdev = cdev->pdev;
89fe56b9e6SYuval Mintz 
90fe56b9e6SYuval Mintz 	if (cdev->doorbells)
91fe56b9e6SYuval Mintz 		iounmap(cdev->doorbells);
92fe56b9e6SYuval Mintz 	if (cdev->regview)
93fe56b9e6SYuval Mintz 		iounmap(cdev->regview);
94fe56b9e6SYuval Mintz 	if (atomic_read(&pdev->enable_cnt) == 1)
95fe56b9e6SYuval Mintz 		pci_release_regions(pdev);
96fe56b9e6SYuval Mintz 
97fe56b9e6SYuval Mintz 	pci_disable_device(pdev);
98fe56b9e6SYuval Mintz }
99fe56b9e6SYuval Mintz 
100fe56b9e6SYuval Mintz /* Performs PCI initializations as well as initializing PCI-related parameters
101fe56b9e6SYuval Mintz  * in the device structrue. Returns 0 in case of success.
102fe56b9e6SYuval Mintz  */
103fe56b9e6SYuval Mintz static int qed_init_pci(struct qed_dev *cdev,
104fe56b9e6SYuval Mintz 			struct pci_dev *pdev)
105fe56b9e6SYuval Mintz {
106fe56b9e6SYuval Mintz 	int rc;
107fe56b9e6SYuval Mintz 
108fe56b9e6SYuval Mintz 	cdev->pdev = pdev;
109fe56b9e6SYuval Mintz 
110fe56b9e6SYuval Mintz 	rc = pci_enable_device(pdev);
111fe56b9e6SYuval Mintz 	if (rc) {
112fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "Cannot enable PCI device\n");
113fe56b9e6SYuval Mintz 		goto err0;
114fe56b9e6SYuval Mintz 	}
115fe56b9e6SYuval Mintz 
116fe56b9e6SYuval Mintz 	if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
117fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "No memory region found in bar #0\n");
118fe56b9e6SYuval Mintz 		rc = -EIO;
119fe56b9e6SYuval Mintz 		goto err1;
120fe56b9e6SYuval Mintz 	}
121fe56b9e6SYuval Mintz 
122fe56b9e6SYuval Mintz 	if (!(pci_resource_flags(pdev, 2) & IORESOURCE_MEM)) {
123fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "No memory region found in bar #2\n");
124fe56b9e6SYuval Mintz 		rc = -EIO;
125fe56b9e6SYuval Mintz 		goto err1;
126fe56b9e6SYuval Mintz 	}
127fe56b9e6SYuval Mintz 
128fe56b9e6SYuval Mintz 	if (atomic_read(&pdev->enable_cnt) == 1) {
129fe56b9e6SYuval Mintz 		rc = pci_request_regions(pdev, "qed");
130fe56b9e6SYuval Mintz 		if (rc) {
131fe56b9e6SYuval Mintz 			DP_NOTICE(cdev,
132fe56b9e6SYuval Mintz 				  "Failed to request PCI memory resources\n");
133fe56b9e6SYuval Mintz 			goto err1;
134fe56b9e6SYuval Mintz 		}
135fe56b9e6SYuval Mintz 		pci_set_master(pdev);
136fe56b9e6SYuval Mintz 		pci_save_state(pdev);
137fe56b9e6SYuval Mintz 	}
138fe56b9e6SYuval Mintz 
139fe56b9e6SYuval Mintz 	if (!pci_is_pcie(pdev)) {
140fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "The bus is not PCI Express\n");
141fe56b9e6SYuval Mintz 		rc = -EIO;
142fe56b9e6SYuval Mintz 		goto err2;
143fe56b9e6SYuval Mintz 	}
144fe56b9e6SYuval Mintz 
145fe56b9e6SYuval Mintz 	cdev->pci_params.pm_cap = pci_find_capability(pdev, PCI_CAP_ID_PM);
146fe56b9e6SYuval Mintz 	if (cdev->pci_params.pm_cap == 0)
147fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "Cannot find power management capability\n");
148fe56b9e6SYuval Mintz 
149fe56b9e6SYuval Mintz 	rc = qed_set_coherency_mask(cdev);
150fe56b9e6SYuval Mintz 	if (rc)
151fe56b9e6SYuval Mintz 		goto err2;
152fe56b9e6SYuval Mintz 
153fe56b9e6SYuval Mintz 	cdev->pci_params.mem_start = pci_resource_start(pdev, 0);
154fe56b9e6SYuval Mintz 	cdev->pci_params.mem_end = pci_resource_end(pdev, 0);
155fe56b9e6SYuval Mintz 	cdev->pci_params.irq = pdev->irq;
156fe56b9e6SYuval Mintz 
157fe56b9e6SYuval Mintz 	cdev->regview = pci_ioremap_bar(pdev, 0);
158fe56b9e6SYuval Mintz 	if (!cdev->regview) {
159fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "Cannot map register space, aborting\n");
160fe56b9e6SYuval Mintz 		rc = -ENOMEM;
161fe56b9e6SYuval Mintz 		goto err2;
162fe56b9e6SYuval Mintz 	}
163fe56b9e6SYuval Mintz 
164fe56b9e6SYuval Mintz 	cdev->db_phys_addr = pci_resource_start(cdev->pdev, 2);
165fe56b9e6SYuval Mintz 	cdev->db_size = pci_resource_len(cdev->pdev, 2);
166fe56b9e6SYuval Mintz 	cdev->doorbells = ioremap_wc(cdev->db_phys_addr, cdev->db_size);
167fe56b9e6SYuval Mintz 	if (!cdev->doorbells) {
168fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "Cannot map doorbell space\n");
169fe56b9e6SYuval Mintz 		return -ENOMEM;
170fe56b9e6SYuval Mintz 	}
171fe56b9e6SYuval Mintz 
172fe56b9e6SYuval Mintz 	return 0;
173fe56b9e6SYuval Mintz 
174fe56b9e6SYuval Mintz err2:
175fe56b9e6SYuval Mintz 	pci_release_regions(pdev);
176fe56b9e6SYuval Mintz err1:
177fe56b9e6SYuval Mintz 	pci_disable_device(pdev);
178fe56b9e6SYuval Mintz err0:
179fe56b9e6SYuval Mintz 	return rc;
180fe56b9e6SYuval Mintz }
181fe56b9e6SYuval Mintz 
182fe56b9e6SYuval Mintz int qed_fill_dev_info(struct qed_dev *cdev,
183fe56b9e6SYuval Mintz 		      struct qed_dev_info *dev_info)
184fe56b9e6SYuval Mintz {
185cee4d264SManish Chopra 	struct qed_ptt  *ptt;
186cee4d264SManish Chopra 
187fe56b9e6SYuval Mintz 	memset(dev_info, 0, sizeof(struct qed_dev_info));
188fe56b9e6SYuval Mintz 
189fe56b9e6SYuval Mintz 	dev_info->num_hwfns = cdev->num_hwfns;
190fe56b9e6SYuval Mintz 	dev_info->pci_mem_start = cdev->pci_params.mem_start;
191fe56b9e6SYuval Mintz 	dev_info->pci_mem_end = cdev->pci_params.mem_end;
192fe56b9e6SYuval Mintz 	dev_info->pci_irq = cdev->pci_params.irq;
193fe56b9e6SYuval Mintz 	dev_info->is_mf = IS_MF(&cdev->hwfns[0]);
194fe56b9e6SYuval Mintz 	ether_addr_copy(dev_info->hw_mac, cdev->hwfns[0].hw_info.hw_mac_addr);
195fe56b9e6SYuval Mintz 
196fe56b9e6SYuval Mintz 	dev_info->fw_major = FW_MAJOR_VERSION;
197fe56b9e6SYuval Mintz 	dev_info->fw_minor = FW_MINOR_VERSION;
198fe56b9e6SYuval Mintz 	dev_info->fw_rev = FW_REVISION_VERSION;
199fe56b9e6SYuval Mintz 	dev_info->fw_eng = FW_ENGINEERING_VERSION;
200fe56b9e6SYuval Mintz 	dev_info->mf_mode = cdev->mf_mode;
201fe56b9e6SYuval Mintz 
202fe56b9e6SYuval Mintz 	qed_mcp_get_mfw_ver(cdev, &dev_info->mfw_rev);
203fe56b9e6SYuval Mintz 
204cee4d264SManish Chopra 	ptt = qed_ptt_acquire(QED_LEADING_HWFN(cdev));
205cee4d264SManish Chopra 	if (ptt) {
206cee4d264SManish Chopra 		qed_mcp_get_flash_size(QED_LEADING_HWFN(cdev), ptt,
207cee4d264SManish Chopra 				       &dev_info->flash_size);
208cee4d264SManish Chopra 
209cee4d264SManish Chopra 		qed_ptt_release(QED_LEADING_HWFN(cdev), ptt);
210cee4d264SManish Chopra 	}
211cee4d264SManish Chopra 
212fe56b9e6SYuval Mintz 	return 0;
213fe56b9e6SYuval Mintz }
214fe56b9e6SYuval Mintz 
215fe56b9e6SYuval Mintz static void qed_free_cdev(struct qed_dev *cdev)
216fe56b9e6SYuval Mintz {
217fe56b9e6SYuval Mintz 	kfree((void *)cdev);
218fe56b9e6SYuval Mintz }
219fe56b9e6SYuval Mintz 
220fe56b9e6SYuval Mintz static struct qed_dev *qed_alloc_cdev(struct pci_dev *pdev)
221fe56b9e6SYuval Mintz {
222fe56b9e6SYuval Mintz 	struct qed_dev *cdev;
223fe56b9e6SYuval Mintz 
224fe56b9e6SYuval Mintz 	cdev = kzalloc(sizeof(*cdev), GFP_KERNEL);
225fe56b9e6SYuval Mintz 	if (!cdev)
226fe56b9e6SYuval Mintz 		return cdev;
227fe56b9e6SYuval Mintz 
228fe56b9e6SYuval Mintz 	qed_init_struct(cdev);
229fe56b9e6SYuval Mintz 
230fe56b9e6SYuval Mintz 	return cdev;
231fe56b9e6SYuval Mintz }
232fe56b9e6SYuval Mintz 
233fe56b9e6SYuval Mintz /* Sets the requested power state */
234fe56b9e6SYuval Mintz static int qed_set_power_state(struct qed_dev *cdev,
235fe56b9e6SYuval Mintz 			       pci_power_t state)
236fe56b9e6SYuval Mintz {
237fe56b9e6SYuval Mintz 	if (!cdev)
238fe56b9e6SYuval Mintz 		return -ENODEV;
239fe56b9e6SYuval Mintz 
240fe56b9e6SYuval Mintz 	DP_VERBOSE(cdev, NETIF_MSG_DRV, "Omitting Power state change\n");
241fe56b9e6SYuval Mintz 	return 0;
242fe56b9e6SYuval Mintz }
243fe56b9e6SYuval Mintz 
244fe56b9e6SYuval Mintz /* probing */
245fe56b9e6SYuval Mintz static struct qed_dev *qed_probe(struct pci_dev *pdev,
246fe56b9e6SYuval Mintz 				 enum qed_protocol protocol,
247fe56b9e6SYuval Mintz 				 u32 dp_module,
248fe56b9e6SYuval Mintz 				 u8 dp_level)
249fe56b9e6SYuval Mintz {
250fe56b9e6SYuval Mintz 	struct qed_dev *cdev;
251fe56b9e6SYuval Mintz 	int rc;
252fe56b9e6SYuval Mintz 
253fe56b9e6SYuval Mintz 	cdev = qed_alloc_cdev(pdev);
254fe56b9e6SYuval Mintz 	if (!cdev)
255fe56b9e6SYuval Mintz 		goto err0;
256fe56b9e6SYuval Mintz 
257fe56b9e6SYuval Mintz 	cdev->protocol = protocol;
258fe56b9e6SYuval Mintz 
259fe56b9e6SYuval Mintz 	qed_init_dp(cdev, dp_module, dp_level);
260fe56b9e6SYuval Mintz 
261fe56b9e6SYuval Mintz 	rc = qed_init_pci(cdev, pdev);
262fe56b9e6SYuval Mintz 	if (rc) {
263fe56b9e6SYuval Mintz 		DP_ERR(cdev, "init pci failed\n");
264fe56b9e6SYuval Mintz 		goto err1;
265fe56b9e6SYuval Mintz 	}
266fe56b9e6SYuval Mintz 	DP_INFO(cdev, "PCI init completed successfully\n");
267fe56b9e6SYuval Mintz 
268fe56b9e6SYuval Mintz 	rc = qed_hw_prepare(cdev, QED_PCI_DEFAULT);
269fe56b9e6SYuval Mintz 	if (rc) {
270fe56b9e6SYuval Mintz 		DP_ERR(cdev, "hw prepare failed\n");
271fe56b9e6SYuval Mintz 		goto err2;
272fe56b9e6SYuval Mintz 	}
273fe56b9e6SYuval Mintz 
274fe56b9e6SYuval Mintz 	DP_INFO(cdev, "qed_probe completed successffuly\n");
275fe56b9e6SYuval Mintz 
276fe56b9e6SYuval Mintz 	return cdev;
277fe56b9e6SYuval Mintz 
278fe56b9e6SYuval Mintz err2:
279fe56b9e6SYuval Mintz 	qed_free_pci(cdev);
280fe56b9e6SYuval Mintz err1:
281fe56b9e6SYuval Mintz 	qed_free_cdev(cdev);
282fe56b9e6SYuval Mintz err0:
283fe56b9e6SYuval Mintz 	return NULL;
284fe56b9e6SYuval Mintz }
285fe56b9e6SYuval Mintz 
286fe56b9e6SYuval Mintz static void qed_remove(struct qed_dev *cdev)
287fe56b9e6SYuval Mintz {
288fe56b9e6SYuval Mintz 	if (!cdev)
289fe56b9e6SYuval Mintz 		return;
290fe56b9e6SYuval Mintz 
291fe56b9e6SYuval Mintz 	qed_hw_remove(cdev);
292fe56b9e6SYuval Mintz 
293fe56b9e6SYuval Mintz 	qed_free_pci(cdev);
294fe56b9e6SYuval Mintz 
295fe56b9e6SYuval Mintz 	qed_set_power_state(cdev, PCI_D3hot);
296fe56b9e6SYuval Mintz 
297fe56b9e6SYuval Mintz 	qed_free_cdev(cdev);
298fe56b9e6SYuval Mintz }
299fe56b9e6SYuval Mintz 
300fe56b9e6SYuval Mintz static void qed_disable_msix(struct qed_dev *cdev)
301fe56b9e6SYuval Mintz {
302fe56b9e6SYuval Mintz 	if (cdev->int_params.out.int_mode == QED_INT_MODE_MSIX) {
303fe56b9e6SYuval Mintz 		pci_disable_msix(cdev->pdev);
304fe56b9e6SYuval Mintz 		kfree(cdev->int_params.msix_table);
305fe56b9e6SYuval Mintz 	} else if (cdev->int_params.out.int_mode == QED_INT_MODE_MSI) {
306fe56b9e6SYuval Mintz 		pci_disable_msi(cdev->pdev);
307fe56b9e6SYuval Mintz 	}
308fe56b9e6SYuval Mintz 
309fe56b9e6SYuval Mintz 	memset(&cdev->int_params.out, 0, sizeof(struct qed_int_param));
310fe56b9e6SYuval Mintz }
311fe56b9e6SYuval Mintz 
312fe56b9e6SYuval Mintz static int qed_enable_msix(struct qed_dev *cdev,
313fe56b9e6SYuval Mintz 			   struct qed_int_params *int_params)
314fe56b9e6SYuval Mintz {
315fe56b9e6SYuval Mintz 	int i, rc, cnt;
316fe56b9e6SYuval Mintz 
317fe56b9e6SYuval Mintz 	cnt = int_params->in.num_vectors;
318fe56b9e6SYuval Mintz 
319fe56b9e6SYuval Mintz 	for (i = 0; i < cnt; i++)
320fe56b9e6SYuval Mintz 		int_params->msix_table[i].entry = i;
321fe56b9e6SYuval Mintz 
322fe56b9e6SYuval Mintz 	rc = pci_enable_msix_range(cdev->pdev, int_params->msix_table,
323fe56b9e6SYuval Mintz 				   int_params->in.min_msix_cnt, cnt);
324fe56b9e6SYuval Mintz 	if (rc < cnt && rc >= int_params->in.min_msix_cnt &&
325fe56b9e6SYuval Mintz 	    (rc % cdev->num_hwfns)) {
326fe56b9e6SYuval Mintz 		pci_disable_msix(cdev->pdev);
327fe56b9e6SYuval Mintz 
328fe56b9e6SYuval Mintz 		/* If fastpath is initialized, we need at least one interrupt
329fe56b9e6SYuval Mintz 		 * per hwfn [and the slow path interrupts]. New requested number
330fe56b9e6SYuval Mintz 		 * should be a multiple of the number of hwfns.
331fe56b9e6SYuval Mintz 		 */
332fe56b9e6SYuval Mintz 		cnt = (rc / cdev->num_hwfns) * cdev->num_hwfns;
333fe56b9e6SYuval Mintz 		DP_NOTICE(cdev,
334fe56b9e6SYuval Mintz 			  "Trying to enable MSI-X with less vectors (%d out of %d)\n",
335fe56b9e6SYuval Mintz 			  cnt, int_params->in.num_vectors);
336fe56b9e6SYuval Mintz 		rc = pci_enable_msix_exact(cdev->pdev,
337fe56b9e6SYuval Mintz 					   int_params->msix_table, cnt);
338fe56b9e6SYuval Mintz 		if (!rc)
339fe56b9e6SYuval Mintz 			rc = cnt;
340fe56b9e6SYuval Mintz 	}
341fe56b9e6SYuval Mintz 
342fe56b9e6SYuval Mintz 	if (rc > 0) {
343fe56b9e6SYuval Mintz 		/* MSI-x configuration was achieved */
344fe56b9e6SYuval Mintz 		int_params->out.int_mode = QED_INT_MODE_MSIX;
345fe56b9e6SYuval Mintz 		int_params->out.num_vectors = rc;
346fe56b9e6SYuval Mintz 		rc = 0;
347fe56b9e6SYuval Mintz 	} else {
348fe56b9e6SYuval Mintz 		DP_NOTICE(cdev,
349fe56b9e6SYuval Mintz 			  "Failed to enable MSI-X [Requested %d vectors][rc %d]\n",
350fe56b9e6SYuval Mintz 			  cnt, rc);
351fe56b9e6SYuval Mintz 	}
352fe56b9e6SYuval Mintz 
353fe56b9e6SYuval Mintz 	return rc;
354fe56b9e6SYuval Mintz }
355fe56b9e6SYuval Mintz 
356fe56b9e6SYuval Mintz /* This function outputs the int mode and the number of enabled msix vector */
357fe56b9e6SYuval Mintz static int qed_set_int_mode(struct qed_dev *cdev, bool force_mode)
358fe56b9e6SYuval Mintz {
359fe56b9e6SYuval Mintz 	struct qed_int_params *int_params = &cdev->int_params;
360fe56b9e6SYuval Mintz 	struct msix_entry *tbl;
361fe56b9e6SYuval Mintz 	int rc = 0, cnt;
362fe56b9e6SYuval Mintz 
363fe56b9e6SYuval Mintz 	switch (int_params->in.int_mode) {
364fe56b9e6SYuval Mintz 	case QED_INT_MODE_MSIX:
365fe56b9e6SYuval Mintz 		/* Allocate MSIX table */
366fe56b9e6SYuval Mintz 		cnt = int_params->in.num_vectors;
367fe56b9e6SYuval Mintz 		int_params->msix_table = kcalloc(cnt, sizeof(*tbl), GFP_KERNEL);
368fe56b9e6SYuval Mintz 		if (!int_params->msix_table) {
369fe56b9e6SYuval Mintz 			rc = -ENOMEM;
370fe56b9e6SYuval Mintz 			goto out;
371fe56b9e6SYuval Mintz 		}
372fe56b9e6SYuval Mintz 
373fe56b9e6SYuval Mintz 		/* Enable MSIX */
374fe56b9e6SYuval Mintz 		rc = qed_enable_msix(cdev, int_params);
375fe56b9e6SYuval Mintz 		if (!rc)
376fe56b9e6SYuval Mintz 			goto out;
377fe56b9e6SYuval Mintz 
378fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "Failed to enable MSI-X\n");
379fe56b9e6SYuval Mintz 		kfree(int_params->msix_table);
380fe56b9e6SYuval Mintz 		if (force_mode)
381fe56b9e6SYuval Mintz 			goto out;
382fe56b9e6SYuval Mintz 		/* Fallthrough */
383fe56b9e6SYuval Mintz 
384fe56b9e6SYuval Mintz 	case QED_INT_MODE_MSI:
385fe56b9e6SYuval Mintz 		rc = pci_enable_msi(cdev->pdev);
386fe56b9e6SYuval Mintz 		if (!rc) {
387fe56b9e6SYuval Mintz 			int_params->out.int_mode = QED_INT_MODE_MSI;
388fe56b9e6SYuval Mintz 			goto out;
389fe56b9e6SYuval Mintz 		}
390fe56b9e6SYuval Mintz 
391fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "Failed to enable MSI\n");
392fe56b9e6SYuval Mintz 		if (force_mode)
393fe56b9e6SYuval Mintz 			goto out;
394fe56b9e6SYuval Mintz 		/* Fallthrough */
395fe56b9e6SYuval Mintz 
396fe56b9e6SYuval Mintz 	case QED_INT_MODE_INTA:
397fe56b9e6SYuval Mintz 			int_params->out.int_mode = QED_INT_MODE_INTA;
398fe56b9e6SYuval Mintz 			rc = 0;
399fe56b9e6SYuval Mintz 			goto out;
400fe56b9e6SYuval Mintz 	default:
401fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "Unknown int_mode value %d\n",
402fe56b9e6SYuval Mintz 			  int_params->in.int_mode);
403fe56b9e6SYuval Mintz 		rc = -EINVAL;
404fe56b9e6SYuval Mintz 	}
405fe56b9e6SYuval Mintz 
406fe56b9e6SYuval Mintz out:
407fe56b9e6SYuval Mintz 	cdev->int_coalescing_mode = QED_COAL_MODE_ENABLE;
408fe56b9e6SYuval Mintz 
409fe56b9e6SYuval Mintz 	return rc;
410fe56b9e6SYuval Mintz }
411fe56b9e6SYuval Mintz 
412fe56b9e6SYuval Mintz static void qed_simd_handler_config(struct qed_dev *cdev, void *token,
413fe56b9e6SYuval Mintz 				    int index, void(*handler)(void *))
414fe56b9e6SYuval Mintz {
415fe56b9e6SYuval Mintz 	struct qed_hwfn *hwfn = &cdev->hwfns[index % cdev->num_hwfns];
416fe56b9e6SYuval Mintz 	int relative_idx = index / cdev->num_hwfns;
417fe56b9e6SYuval Mintz 
418fe56b9e6SYuval Mintz 	hwfn->simd_proto_handler[relative_idx].func = handler;
419fe56b9e6SYuval Mintz 	hwfn->simd_proto_handler[relative_idx].token = token;
420fe56b9e6SYuval Mintz }
421fe56b9e6SYuval Mintz 
422fe56b9e6SYuval Mintz static void qed_simd_handler_clean(struct qed_dev *cdev, int index)
423fe56b9e6SYuval Mintz {
424fe56b9e6SYuval Mintz 	struct qed_hwfn *hwfn = &cdev->hwfns[index % cdev->num_hwfns];
425fe56b9e6SYuval Mintz 	int relative_idx = index / cdev->num_hwfns;
426fe56b9e6SYuval Mintz 
427fe56b9e6SYuval Mintz 	memset(&hwfn->simd_proto_handler[relative_idx], 0,
428fe56b9e6SYuval Mintz 	       sizeof(struct qed_simd_fp_handler));
429fe56b9e6SYuval Mintz }
430fe56b9e6SYuval Mintz 
431fe56b9e6SYuval Mintz static irqreturn_t qed_msix_sp_int(int irq, void *tasklet)
432fe56b9e6SYuval Mintz {
433fe56b9e6SYuval Mintz 	tasklet_schedule((struct tasklet_struct *)tasklet);
434fe56b9e6SYuval Mintz 	return IRQ_HANDLED;
435fe56b9e6SYuval Mintz }
436fe56b9e6SYuval Mintz 
437fe56b9e6SYuval Mintz static irqreturn_t qed_single_int(int irq, void *dev_instance)
438fe56b9e6SYuval Mintz {
439fe56b9e6SYuval Mintz 	struct qed_dev *cdev = (struct qed_dev *)dev_instance;
440fe56b9e6SYuval Mintz 	struct qed_hwfn *hwfn;
441fe56b9e6SYuval Mintz 	irqreturn_t rc = IRQ_NONE;
442fe56b9e6SYuval Mintz 	u64 status;
443fe56b9e6SYuval Mintz 	int i, j;
444fe56b9e6SYuval Mintz 
445fe56b9e6SYuval Mintz 	for (i = 0; i < cdev->num_hwfns; i++) {
446fe56b9e6SYuval Mintz 		status = qed_int_igu_read_sisr_reg(&cdev->hwfns[i]);
447fe56b9e6SYuval Mintz 
448fe56b9e6SYuval Mintz 		if (!status)
449fe56b9e6SYuval Mintz 			continue;
450fe56b9e6SYuval Mintz 
451fe56b9e6SYuval Mintz 		hwfn = &cdev->hwfns[i];
452fe56b9e6SYuval Mintz 
453fe56b9e6SYuval Mintz 		/* Slowpath interrupt */
454fe56b9e6SYuval Mintz 		if (unlikely(status & 0x1)) {
455fe56b9e6SYuval Mintz 			tasklet_schedule(hwfn->sp_dpc);
456fe56b9e6SYuval Mintz 			status &= ~0x1;
457fe56b9e6SYuval Mintz 			rc = IRQ_HANDLED;
458fe56b9e6SYuval Mintz 		}
459fe56b9e6SYuval Mintz 
460fe56b9e6SYuval Mintz 		/* Fastpath interrupts */
461fe56b9e6SYuval Mintz 		for (j = 0; j < 64; j++) {
462fe56b9e6SYuval Mintz 			if ((0x2ULL << j) & status) {
463fe56b9e6SYuval Mintz 				hwfn->simd_proto_handler[j].func(
464fe56b9e6SYuval Mintz 					hwfn->simd_proto_handler[j].token);
465fe56b9e6SYuval Mintz 				status &= ~(0x2ULL << j);
466fe56b9e6SYuval Mintz 				rc = IRQ_HANDLED;
467fe56b9e6SYuval Mintz 			}
468fe56b9e6SYuval Mintz 		}
469fe56b9e6SYuval Mintz 
470fe56b9e6SYuval Mintz 		if (unlikely(status))
471fe56b9e6SYuval Mintz 			DP_VERBOSE(hwfn, NETIF_MSG_INTR,
472fe56b9e6SYuval Mintz 				   "got an unknown interrupt status 0x%llx\n",
473fe56b9e6SYuval Mintz 				   status);
474fe56b9e6SYuval Mintz 	}
475fe56b9e6SYuval Mintz 
476fe56b9e6SYuval Mintz 	return rc;
477fe56b9e6SYuval Mintz }
478fe56b9e6SYuval Mintz 
479fe56b9e6SYuval Mintz static int qed_slowpath_irq_req(struct qed_dev *cdev)
480fe56b9e6SYuval Mintz {
481fe56b9e6SYuval Mintz 	int i = 0, rc = 0;
482fe56b9e6SYuval Mintz 
483fe56b9e6SYuval Mintz 	if (cdev->int_params.out.int_mode == QED_INT_MODE_MSIX) {
484fe56b9e6SYuval Mintz 		/* Request all the slowpath MSI-X vectors */
485fe56b9e6SYuval Mintz 		for (i = 0; i < cdev->num_hwfns; i++) {
486fe56b9e6SYuval Mintz 			snprintf(cdev->hwfns[i].name, NAME_SIZE,
487fe56b9e6SYuval Mintz 				 "sp-%d-%02x:%02x.%02x",
488fe56b9e6SYuval Mintz 				 i, cdev->pdev->bus->number,
489fe56b9e6SYuval Mintz 				 PCI_SLOT(cdev->pdev->devfn),
490fe56b9e6SYuval Mintz 				 cdev->hwfns[i].abs_pf_id);
491fe56b9e6SYuval Mintz 
492fe56b9e6SYuval Mintz 			rc = request_irq(cdev->int_params.msix_table[i].vector,
493fe56b9e6SYuval Mintz 					 qed_msix_sp_int, 0,
494fe56b9e6SYuval Mintz 					 cdev->hwfns[i].name,
495fe56b9e6SYuval Mintz 					 cdev->hwfns[i].sp_dpc);
496fe56b9e6SYuval Mintz 			if (rc)
497fe56b9e6SYuval Mintz 				break;
498fe56b9e6SYuval Mintz 
499fe56b9e6SYuval Mintz 			DP_VERBOSE(&cdev->hwfns[i],
500fe56b9e6SYuval Mintz 				   (NETIF_MSG_INTR | QED_MSG_SP),
501fe56b9e6SYuval Mintz 				   "Requested slowpath MSI-X\n");
502fe56b9e6SYuval Mintz 		}
503fe56b9e6SYuval Mintz 
504fe56b9e6SYuval Mintz 		if (i != cdev->num_hwfns) {
505fe56b9e6SYuval Mintz 			/* Free already request MSI-X vectors */
506fe56b9e6SYuval Mintz 			for (i--; i >= 0; i--) {
507fe56b9e6SYuval Mintz 				unsigned int vec =
508fe56b9e6SYuval Mintz 					cdev->int_params.msix_table[i].vector;
509fe56b9e6SYuval Mintz 				synchronize_irq(vec);
510fe56b9e6SYuval Mintz 				free_irq(cdev->int_params.msix_table[i].vector,
511fe56b9e6SYuval Mintz 					 cdev->hwfns[i].sp_dpc);
512fe56b9e6SYuval Mintz 			}
513fe56b9e6SYuval Mintz 		}
514fe56b9e6SYuval Mintz 	} else {
515fe56b9e6SYuval Mintz 		unsigned long flags = 0;
516fe56b9e6SYuval Mintz 
517fe56b9e6SYuval Mintz 		snprintf(cdev->name, NAME_SIZE, "%02x:%02x.%02x",
518fe56b9e6SYuval Mintz 			 cdev->pdev->bus->number, PCI_SLOT(cdev->pdev->devfn),
519fe56b9e6SYuval Mintz 			 PCI_FUNC(cdev->pdev->devfn));
520fe56b9e6SYuval Mintz 
521fe56b9e6SYuval Mintz 		if (cdev->int_params.out.int_mode == QED_INT_MODE_INTA)
522fe56b9e6SYuval Mintz 			flags |= IRQF_SHARED;
523fe56b9e6SYuval Mintz 
524fe56b9e6SYuval Mintz 		rc = request_irq(cdev->pdev->irq, qed_single_int,
525fe56b9e6SYuval Mintz 				 flags, cdev->name, cdev);
526fe56b9e6SYuval Mintz 	}
527fe56b9e6SYuval Mintz 
528fe56b9e6SYuval Mintz 	return rc;
529fe56b9e6SYuval Mintz }
530fe56b9e6SYuval Mintz 
531fe56b9e6SYuval Mintz static void qed_slowpath_irq_free(struct qed_dev *cdev)
532fe56b9e6SYuval Mintz {
533fe56b9e6SYuval Mintz 	int i;
534fe56b9e6SYuval Mintz 
535fe56b9e6SYuval Mintz 	if (cdev->int_params.out.int_mode == QED_INT_MODE_MSIX) {
536fe56b9e6SYuval Mintz 		for_each_hwfn(cdev, i) {
537fe56b9e6SYuval Mintz 			synchronize_irq(cdev->int_params.msix_table[i].vector);
538fe56b9e6SYuval Mintz 			free_irq(cdev->int_params.msix_table[i].vector,
539fe56b9e6SYuval Mintz 				 cdev->hwfns[i].sp_dpc);
540fe56b9e6SYuval Mintz 		}
541fe56b9e6SYuval Mintz 	} else {
542fe56b9e6SYuval Mintz 		free_irq(cdev->pdev->irq, cdev);
543fe56b9e6SYuval Mintz 	}
544fe56b9e6SYuval Mintz }
545fe56b9e6SYuval Mintz 
546fe56b9e6SYuval Mintz static int qed_nic_stop(struct qed_dev *cdev)
547fe56b9e6SYuval Mintz {
548fe56b9e6SYuval Mintz 	int i, rc;
549fe56b9e6SYuval Mintz 
550fe56b9e6SYuval Mintz 	rc = qed_hw_stop(cdev);
551fe56b9e6SYuval Mintz 
552fe56b9e6SYuval Mintz 	for (i = 0; i < cdev->num_hwfns; i++) {
553fe56b9e6SYuval Mintz 		struct qed_hwfn *p_hwfn = &cdev->hwfns[i];
554fe56b9e6SYuval Mintz 
555fe56b9e6SYuval Mintz 		if (p_hwfn->b_sp_dpc_enabled) {
556fe56b9e6SYuval Mintz 			tasklet_disable(p_hwfn->sp_dpc);
557fe56b9e6SYuval Mintz 			p_hwfn->b_sp_dpc_enabled = false;
558fe56b9e6SYuval Mintz 			DP_VERBOSE(cdev, NETIF_MSG_IFDOWN,
559fe56b9e6SYuval Mintz 				   "Disabled sp taskelt [hwfn %d] at %p\n",
560fe56b9e6SYuval Mintz 				   i, p_hwfn->sp_dpc);
561fe56b9e6SYuval Mintz 		}
562fe56b9e6SYuval Mintz 	}
563fe56b9e6SYuval Mintz 
564fe56b9e6SYuval Mintz 	return rc;
565fe56b9e6SYuval Mintz }
566fe56b9e6SYuval Mintz 
567fe56b9e6SYuval Mintz static int qed_nic_reset(struct qed_dev *cdev)
568fe56b9e6SYuval Mintz {
569fe56b9e6SYuval Mintz 	int rc;
570fe56b9e6SYuval Mintz 
571fe56b9e6SYuval Mintz 	rc = qed_hw_reset(cdev);
572fe56b9e6SYuval Mintz 	if (rc)
573fe56b9e6SYuval Mintz 		return rc;
574fe56b9e6SYuval Mintz 
575fe56b9e6SYuval Mintz 	qed_resc_free(cdev);
576fe56b9e6SYuval Mintz 
577fe56b9e6SYuval Mintz 	return 0;
578fe56b9e6SYuval Mintz }
579fe56b9e6SYuval Mintz 
580fe56b9e6SYuval Mintz static int qed_nic_setup(struct qed_dev *cdev)
581fe56b9e6SYuval Mintz {
582fe56b9e6SYuval Mintz 	int rc;
583fe56b9e6SYuval Mintz 
584fe56b9e6SYuval Mintz 	rc = qed_resc_alloc(cdev);
585fe56b9e6SYuval Mintz 	if (rc)
586fe56b9e6SYuval Mintz 		return rc;
587fe56b9e6SYuval Mintz 
588fe56b9e6SYuval Mintz 	DP_INFO(cdev, "Allocated qed resources\n");
589fe56b9e6SYuval Mintz 
590fe56b9e6SYuval Mintz 	qed_resc_setup(cdev);
591fe56b9e6SYuval Mintz 
592fe56b9e6SYuval Mintz 	return rc;
593fe56b9e6SYuval Mintz }
594fe56b9e6SYuval Mintz 
595fe56b9e6SYuval Mintz static int qed_set_int_fp(struct qed_dev *cdev, u16 cnt)
596fe56b9e6SYuval Mintz {
597fe56b9e6SYuval Mintz 	int limit = 0;
598fe56b9e6SYuval Mintz 
599fe56b9e6SYuval Mintz 	/* Mark the fastpath as free/used */
600fe56b9e6SYuval Mintz 	cdev->int_params.fp_initialized = cnt ? true : false;
601fe56b9e6SYuval Mintz 
602fe56b9e6SYuval Mintz 	if (cdev->int_params.out.int_mode != QED_INT_MODE_MSIX)
603fe56b9e6SYuval Mintz 		limit = cdev->num_hwfns * 63;
604fe56b9e6SYuval Mintz 	else if (cdev->int_params.fp_msix_cnt)
605fe56b9e6SYuval Mintz 		limit = cdev->int_params.fp_msix_cnt;
606fe56b9e6SYuval Mintz 
607fe56b9e6SYuval Mintz 	if (!limit)
608fe56b9e6SYuval Mintz 		return -ENOMEM;
609fe56b9e6SYuval Mintz 
610fe56b9e6SYuval Mintz 	return min_t(int, cnt, limit);
611fe56b9e6SYuval Mintz }
612fe56b9e6SYuval Mintz 
613fe56b9e6SYuval Mintz static int qed_get_int_fp(struct qed_dev *cdev, struct qed_int_info *info)
614fe56b9e6SYuval Mintz {
615fe56b9e6SYuval Mintz 	memset(info, 0, sizeof(struct qed_int_info));
616fe56b9e6SYuval Mintz 
617fe56b9e6SYuval Mintz 	if (!cdev->int_params.fp_initialized) {
618fe56b9e6SYuval Mintz 		DP_INFO(cdev,
619fe56b9e6SYuval Mintz 			"Protocol driver requested interrupt information, but its support is not yet configured\n");
620fe56b9e6SYuval Mintz 		return -EINVAL;
621fe56b9e6SYuval Mintz 	}
622fe56b9e6SYuval Mintz 
623fe56b9e6SYuval Mintz 	/* Need to expose only MSI-X information; Single IRQ is handled solely
624fe56b9e6SYuval Mintz 	 * by qed.
625fe56b9e6SYuval Mintz 	 */
626fe56b9e6SYuval Mintz 	if (cdev->int_params.out.int_mode == QED_INT_MODE_MSIX) {
627fe56b9e6SYuval Mintz 		int msix_base = cdev->int_params.fp_msix_base;
628fe56b9e6SYuval Mintz 
629fe56b9e6SYuval Mintz 		info->msix_cnt = cdev->int_params.fp_msix_cnt;
630fe56b9e6SYuval Mintz 		info->msix = &cdev->int_params.msix_table[msix_base];
631fe56b9e6SYuval Mintz 	}
632fe56b9e6SYuval Mintz 
633fe56b9e6SYuval Mintz 	return 0;
634fe56b9e6SYuval Mintz }
635fe56b9e6SYuval Mintz 
636fe56b9e6SYuval Mintz static int qed_slowpath_setup_int(struct qed_dev *cdev,
637fe56b9e6SYuval Mintz 				  enum qed_int_mode int_mode)
638fe56b9e6SYuval Mintz {
639fe56b9e6SYuval Mintz 	int rc, i;
640fe56b9e6SYuval Mintz 	u8 num_vectors = 0;
641fe56b9e6SYuval Mintz 
642fe56b9e6SYuval Mintz 	memset(&cdev->int_params, 0, sizeof(struct qed_int_params));
643fe56b9e6SYuval Mintz 
644fe56b9e6SYuval Mintz 	cdev->int_params.in.int_mode = int_mode;
645fe56b9e6SYuval Mintz 	for_each_hwfn(cdev, i)
646fe56b9e6SYuval Mintz 		num_vectors +=  qed_int_get_num_sbs(&cdev->hwfns[i], NULL) + 1;
647fe56b9e6SYuval Mintz 	cdev->int_params.in.num_vectors = num_vectors;
648fe56b9e6SYuval Mintz 
649fe56b9e6SYuval Mintz 	/* We want a minimum of one slowpath and one fastpath vector per hwfn */
650fe56b9e6SYuval Mintz 	cdev->int_params.in.min_msix_cnt = cdev->num_hwfns * 2;
651fe56b9e6SYuval Mintz 
652fe56b9e6SYuval Mintz 	rc = qed_set_int_mode(cdev, false);
653fe56b9e6SYuval Mintz 	if (rc)  {
654fe56b9e6SYuval Mintz 		DP_ERR(cdev, "qed_slowpath_setup_int ERR\n");
655fe56b9e6SYuval Mintz 		return rc;
656fe56b9e6SYuval Mintz 	}
657fe56b9e6SYuval Mintz 
658fe56b9e6SYuval Mintz 	cdev->int_params.fp_msix_base = cdev->num_hwfns;
659fe56b9e6SYuval Mintz 	cdev->int_params.fp_msix_cnt = cdev->int_params.out.num_vectors -
660fe56b9e6SYuval Mintz 				       cdev->num_hwfns;
661fe56b9e6SYuval Mintz 
662fe56b9e6SYuval Mintz 	return 0;
663fe56b9e6SYuval Mintz }
664fe56b9e6SYuval Mintz 
665fe56b9e6SYuval Mintz u32 qed_unzip_data(struct qed_hwfn *p_hwfn, u32 input_len,
666fe56b9e6SYuval Mintz 		   u8 *input_buf, u32 max_size, u8 *unzip_buf)
667fe56b9e6SYuval Mintz {
668fe56b9e6SYuval Mintz 	int rc;
669fe56b9e6SYuval Mintz 
670fe56b9e6SYuval Mintz 	p_hwfn->stream->next_in = input_buf;
671fe56b9e6SYuval Mintz 	p_hwfn->stream->avail_in = input_len;
672fe56b9e6SYuval Mintz 	p_hwfn->stream->next_out = unzip_buf;
673fe56b9e6SYuval Mintz 	p_hwfn->stream->avail_out = max_size;
674fe56b9e6SYuval Mintz 
675fe56b9e6SYuval Mintz 	rc = zlib_inflateInit2(p_hwfn->stream, MAX_WBITS);
676fe56b9e6SYuval Mintz 
677fe56b9e6SYuval Mintz 	if (rc != Z_OK) {
678fe56b9e6SYuval Mintz 		DP_VERBOSE(p_hwfn, NETIF_MSG_DRV, "zlib init failed, rc = %d\n",
679fe56b9e6SYuval Mintz 			   rc);
680fe56b9e6SYuval Mintz 		return 0;
681fe56b9e6SYuval Mintz 	}
682fe56b9e6SYuval Mintz 
683fe56b9e6SYuval Mintz 	rc = zlib_inflate(p_hwfn->stream, Z_FINISH);
684fe56b9e6SYuval Mintz 	zlib_inflateEnd(p_hwfn->stream);
685fe56b9e6SYuval Mintz 
686fe56b9e6SYuval Mintz 	if (rc != Z_OK && rc != Z_STREAM_END) {
687fe56b9e6SYuval Mintz 		DP_VERBOSE(p_hwfn, NETIF_MSG_DRV, "FW unzip error: %s, rc=%d\n",
688fe56b9e6SYuval Mintz 			   p_hwfn->stream->msg, rc);
689fe56b9e6SYuval Mintz 		return 0;
690fe56b9e6SYuval Mintz 	}
691fe56b9e6SYuval Mintz 
692fe56b9e6SYuval Mintz 	return p_hwfn->stream->total_out / 4;
693fe56b9e6SYuval Mintz }
694fe56b9e6SYuval Mintz 
695fe56b9e6SYuval Mintz static int qed_alloc_stream_mem(struct qed_dev *cdev)
696fe56b9e6SYuval Mintz {
697fe56b9e6SYuval Mintz 	int i;
698fe56b9e6SYuval Mintz 	void *workspace;
699fe56b9e6SYuval Mintz 
700fe56b9e6SYuval Mintz 	for_each_hwfn(cdev, i) {
701fe56b9e6SYuval Mintz 		struct qed_hwfn *p_hwfn = &cdev->hwfns[i];
702fe56b9e6SYuval Mintz 
703fe56b9e6SYuval Mintz 		p_hwfn->stream = kzalloc(sizeof(*p_hwfn->stream), GFP_KERNEL);
704fe56b9e6SYuval Mintz 		if (!p_hwfn->stream)
705fe56b9e6SYuval Mintz 			return -ENOMEM;
706fe56b9e6SYuval Mintz 
707fe56b9e6SYuval Mintz 		workspace = vzalloc(zlib_inflate_workspacesize());
708fe56b9e6SYuval Mintz 		if (!workspace)
709fe56b9e6SYuval Mintz 			return -ENOMEM;
710fe56b9e6SYuval Mintz 		p_hwfn->stream->workspace = workspace;
711fe56b9e6SYuval Mintz 	}
712fe56b9e6SYuval Mintz 
713fe56b9e6SYuval Mintz 	return 0;
714fe56b9e6SYuval Mintz }
715fe56b9e6SYuval Mintz 
716fe56b9e6SYuval Mintz static void qed_free_stream_mem(struct qed_dev *cdev)
717fe56b9e6SYuval Mintz {
718fe56b9e6SYuval Mintz 	int i;
719fe56b9e6SYuval Mintz 
720fe56b9e6SYuval Mintz 	for_each_hwfn(cdev, i) {
721fe56b9e6SYuval Mintz 		struct qed_hwfn *p_hwfn = &cdev->hwfns[i];
722fe56b9e6SYuval Mintz 
723fe56b9e6SYuval Mintz 		if (!p_hwfn->stream)
724fe56b9e6SYuval Mintz 			return;
725fe56b9e6SYuval Mintz 
726fe56b9e6SYuval Mintz 		vfree(p_hwfn->stream->workspace);
727fe56b9e6SYuval Mintz 		kfree(p_hwfn->stream);
728fe56b9e6SYuval Mintz 	}
729fe56b9e6SYuval Mintz }
730fe56b9e6SYuval Mintz 
731fe56b9e6SYuval Mintz static void qed_update_pf_params(struct qed_dev *cdev,
732fe56b9e6SYuval Mintz 				 struct qed_pf_params *params)
733fe56b9e6SYuval Mintz {
734fe56b9e6SYuval Mintz 	int i;
735fe56b9e6SYuval Mintz 
736fe56b9e6SYuval Mintz 	for (i = 0; i < cdev->num_hwfns; i++) {
737fe56b9e6SYuval Mintz 		struct qed_hwfn *p_hwfn = &cdev->hwfns[i];
738fe56b9e6SYuval Mintz 
739fe56b9e6SYuval Mintz 		p_hwfn->pf_params = *params;
740fe56b9e6SYuval Mintz 	}
741fe56b9e6SYuval Mintz }
742fe56b9e6SYuval Mintz 
743fe56b9e6SYuval Mintz static int qed_slowpath_start(struct qed_dev *cdev,
744fe56b9e6SYuval Mintz 			      struct qed_slowpath_params *params)
745fe56b9e6SYuval Mintz {
746fe56b9e6SYuval Mintz 	struct qed_mcp_drv_version drv_version;
747fe56b9e6SYuval Mintz 	const u8 *data = NULL;
748fe56b9e6SYuval Mintz 	struct qed_hwfn *hwfn;
749fe56b9e6SYuval Mintz 	int rc;
750fe56b9e6SYuval Mintz 
751fe56b9e6SYuval Mintz 	rc = request_firmware(&cdev->firmware, QED_FW_FILE_NAME,
752fe56b9e6SYuval Mintz 			      &cdev->pdev->dev);
753fe56b9e6SYuval Mintz 	if (rc) {
754fe56b9e6SYuval Mintz 		DP_NOTICE(cdev,
755fe56b9e6SYuval Mintz 			  "Failed to find fw file - /lib/firmware/%s\n",
756fe56b9e6SYuval Mintz 			  QED_FW_FILE_NAME);
757fe56b9e6SYuval Mintz 		goto err;
758fe56b9e6SYuval Mintz 	}
759fe56b9e6SYuval Mintz 
760fe56b9e6SYuval Mintz 	rc = qed_nic_setup(cdev);
761fe56b9e6SYuval Mintz 	if (rc)
762fe56b9e6SYuval Mintz 		goto err;
763fe56b9e6SYuval Mintz 
764fe56b9e6SYuval Mintz 	rc = qed_slowpath_setup_int(cdev, params->int_mode);
765fe56b9e6SYuval Mintz 	if (rc)
766fe56b9e6SYuval Mintz 		goto err1;
767fe56b9e6SYuval Mintz 
768fe56b9e6SYuval Mintz 	/* Request the slowpath IRQ */
769fe56b9e6SYuval Mintz 	rc = qed_slowpath_irq_req(cdev);
770fe56b9e6SYuval Mintz 	if (rc)
771fe56b9e6SYuval Mintz 		goto err2;
772fe56b9e6SYuval Mintz 
773fe56b9e6SYuval Mintz 	/* Allocate stream for unzipping */
774fe56b9e6SYuval Mintz 	rc = qed_alloc_stream_mem(cdev);
775fe56b9e6SYuval Mintz 	if (rc) {
776fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "Failed to allocate stream memory\n");
777fe56b9e6SYuval Mintz 		goto err3;
778fe56b9e6SYuval Mintz 	}
779fe56b9e6SYuval Mintz 
780fe56b9e6SYuval Mintz 	/* Start the slowpath */
781fe56b9e6SYuval Mintz 	data = cdev->firmware->data;
782fe56b9e6SYuval Mintz 
783fe56b9e6SYuval Mintz 	rc = qed_hw_init(cdev, true, cdev->int_params.out.int_mode,
784fe56b9e6SYuval Mintz 			 true, data);
785fe56b9e6SYuval Mintz 	if (rc)
786fe56b9e6SYuval Mintz 		goto err3;
787fe56b9e6SYuval Mintz 
788fe56b9e6SYuval Mintz 	DP_INFO(cdev,
789fe56b9e6SYuval Mintz 		"HW initialization and function start completed successfully\n");
790fe56b9e6SYuval Mintz 
791fe56b9e6SYuval Mintz 	hwfn = QED_LEADING_HWFN(cdev);
792fe56b9e6SYuval Mintz 	drv_version.version = (params->drv_major << 24) |
793fe56b9e6SYuval Mintz 			      (params->drv_minor << 16) |
794fe56b9e6SYuval Mintz 			      (params->drv_rev << 8) |
795fe56b9e6SYuval Mintz 			      (params->drv_eng);
796fe56b9e6SYuval Mintz 	strlcpy(drv_version.name, params->name,
797fe56b9e6SYuval Mintz 		MCP_DRV_VER_STR_SIZE - 4);
798fe56b9e6SYuval Mintz 	rc = qed_mcp_send_drv_version(hwfn, hwfn->p_main_ptt,
799fe56b9e6SYuval Mintz 				      &drv_version);
800fe56b9e6SYuval Mintz 	if (rc) {
801fe56b9e6SYuval Mintz 		DP_NOTICE(cdev, "Failed sending drv version command\n");
802fe56b9e6SYuval Mintz 		return rc;
803fe56b9e6SYuval Mintz 	}
804fe56b9e6SYuval Mintz 
805fe56b9e6SYuval Mintz 	return 0;
806fe56b9e6SYuval Mintz 
807fe56b9e6SYuval Mintz err3:
808fe56b9e6SYuval Mintz 	qed_free_stream_mem(cdev);
809fe56b9e6SYuval Mintz 	qed_slowpath_irq_free(cdev);
810fe56b9e6SYuval Mintz err2:
811fe56b9e6SYuval Mintz 	qed_disable_msix(cdev);
812fe56b9e6SYuval Mintz err1:
813fe56b9e6SYuval Mintz 	qed_resc_free(cdev);
814fe56b9e6SYuval Mintz err:
815fe56b9e6SYuval Mintz 	release_firmware(cdev->firmware);
816fe56b9e6SYuval Mintz 
817fe56b9e6SYuval Mintz 	return rc;
818fe56b9e6SYuval Mintz }
819fe56b9e6SYuval Mintz 
820fe56b9e6SYuval Mintz static int qed_slowpath_stop(struct qed_dev *cdev)
821fe56b9e6SYuval Mintz {
822fe56b9e6SYuval Mintz 	if (!cdev)
823fe56b9e6SYuval Mintz 		return -ENODEV;
824fe56b9e6SYuval Mintz 
825fe56b9e6SYuval Mintz 	qed_free_stream_mem(cdev);
826fe56b9e6SYuval Mintz 
827fe56b9e6SYuval Mintz 	qed_nic_stop(cdev);
828fe56b9e6SYuval Mintz 	qed_slowpath_irq_free(cdev);
829fe56b9e6SYuval Mintz 
830fe56b9e6SYuval Mintz 	qed_disable_msix(cdev);
831fe56b9e6SYuval Mintz 	qed_nic_reset(cdev);
832fe56b9e6SYuval Mintz 
833fe56b9e6SYuval Mintz 	release_firmware(cdev->firmware);
834fe56b9e6SYuval Mintz 
835fe56b9e6SYuval Mintz 	return 0;
836fe56b9e6SYuval Mintz }
837fe56b9e6SYuval Mintz 
838fe56b9e6SYuval Mintz static void qed_set_id(struct qed_dev *cdev, char name[NAME_SIZE],
839fe56b9e6SYuval Mintz 		       char ver_str[VER_SIZE])
840fe56b9e6SYuval Mintz {
841fe56b9e6SYuval Mintz 	int i;
842fe56b9e6SYuval Mintz 
843fe56b9e6SYuval Mintz 	memcpy(cdev->name, name, NAME_SIZE);
844fe56b9e6SYuval Mintz 	for_each_hwfn(cdev, i)
845fe56b9e6SYuval Mintz 		snprintf(cdev->hwfns[i].name, NAME_SIZE, "%s-%d", name, i);
846fe56b9e6SYuval Mintz 
847fe56b9e6SYuval Mintz 	memcpy(cdev->ver_str, ver_str, VER_SIZE);
848fe56b9e6SYuval Mintz 	cdev->drv_type = DRV_ID_DRV_TYPE_LINUX;
849fe56b9e6SYuval Mintz }
850fe56b9e6SYuval Mintz 
851fe56b9e6SYuval Mintz static u32 qed_sb_init(struct qed_dev *cdev,
852fe56b9e6SYuval Mintz 		       struct qed_sb_info *sb_info,
853fe56b9e6SYuval Mintz 		       void *sb_virt_addr,
854fe56b9e6SYuval Mintz 		       dma_addr_t sb_phy_addr, u16 sb_id,
855fe56b9e6SYuval Mintz 		       enum qed_sb_type type)
856fe56b9e6SYuval Mintz {
857fe56b9e6SYuval Mintz 	struct qed_hwfn *p_hwfn;
858fe56b9e6SYuval Mintz 	int hwfn_index;
859fe56b9e6SYuval Mintz 	u16 rel_sb_id;
860fe56b9e6SYuval Mintz 	u8 n_hwfns;
861fe56b9e6SYuval Mintz 	u32 rc;
862fe56b9e6SYuval Mintz 
863fe56b9e6SYuval Mintz 	/* RoCE uses single engine and CMT uses two engines. When using both
864fe56b9e6SYuval Mintz 	 * we force only a single engine. Storage uses only engine 0 too.
865fe56b9e6SYuval Mintz 	 */
866fe56b9e6SYuval Mintz 	if (type == QED_SB_TYPE_L2_QUEUE)
867fe56b9e6SYuval Mintz 		n_hwfns = cdev->num_hwfns;
868fe56b9e6SYuval Mintz 	else
869fe56b9e6SYuval Mintz 		n_hwfns = 1;
870fe56b9e6SYuval Mintz 
871fe56b9e6SYuval Mintz 	hwfn_index = sb_id % n_hwfns;
872fe56b9e6SYuval Mintz 	p_hwfn = &cdev->hwfns[hwfn_index];
873fe56b9e6SYuval Mintz 	rel_sb_id = sb_id / n_hwfns;
874fe56b9e6SYuval Mintz 
875fe56b9e6SYuval Mintz 	DP_VERBOSE(cdev, NETIF_MSG_INTR,
876fe56b9e6SYuval Mintz 		   "hwfn [%d] <--[init]-- SB %04x [0x%04x upper]\n",
877fe56b9e6SYuval Mintz 		   hwfn_index, rel_sb_id, sb_id);
878fe56b9e6SYuval Mintz 
879fe56b9e6SYuval Mintz 	rc = qed_int_sb_init(p_hwfn, p_hwfn->p_main_ptt, sb_info,
880fe56b9e6SYuval Mintz 			     sb_virt_addr, sb_phy_addr, rel_sb_id);
881fe56b9e6SYuval Mintz 
882fe56b9e6SYuval Mintz 	return rc;
883fe56b9e6SYuval Mintz }
884fe56b9e6SYuval Mintz 
885fe56b9e6SYuval Mintz static u32 qed_sb_release(struct qed_dev *cdev,
886fe56b9e6SYuval Mintz 			  struct qed_sb_info *sb_info,
887fe56b9e6SYuval Mintz 			  u16 sb_id)
888fe56b9e6SYuval Mintz {
889fe56b9e6SYuval Mintz 	struct qed_hwfn *p_hwfn;
890fe56b9e6SYuval Mintz 	int hwfn_index;
891fe56b9e6SYuval Mintz 	u16 rel_sb_id;
892fe56b9e6SYuval Mintz 	u32 rc;
893fe56b9e6SYuval Mintz 
894fe56b9e6SYuval Mintz 	hwfn_index = sb_id % cdev->num_hwfns;
895fe56b9e6SYuval Mintz 	p_hwfn = &cdev->hwfns[hwfn_index];
896fe56b9e6SYuval Mintz 	rel_sb_id = sb_id / cdev->num_hwfns;
897fe56b9e6SYuval Mintz 
898fe56b9e6SYuval Mintz 	DP_VERBOSE(cdev, NETIF_MSG_INTR,
899fe56b9e6SYuval Mintz 		   "hwfn [%d] <--[init]-- SB %04x [0x%04x upper]\n",
900fe56b9e6SYuval Mintz 		   hwfn_index, rel_sb_id, sb_id);
901fe56b9e6SYuval Mintz 
902fe56b9e6SYuval Mintz 	rc = qed_int_sb_release(p_hwfn, sb_info, rel_sb_id);
903fe56b9e6SYuval Mintz 
904fe56b9e6SYuval Mintz 	return rc;
905fe56b9e6SYuval Mintz }
906fe56b9e6SYuval Mintz 
907fe56b9e6SYuval Mintz static int qed_drain(struct qed_dev *cdev)
908fe56b9e6SYuval Mintz {
909fe56b9e6SYuval Mintz 	struct qed_hwfn *hwfn;
910fe56b9e6SYuval Mintz 	struct qed_ptt *ptt;
911fe56b9e6SYuval Mintz 	int i, rc;
912fe56b9e6SYuval Mintz 
913fe56b9e6SYuval Mintz 	for_each_hwfn(cdev, i) {
914fe56b9e6SYuval Mintz 		hwfn = &cdev->hwfns[i];
915fe56b9e6SYuval Mintz 		ptt = qed_ptt_acquire(hwfn);
916fe56b9e6SYuval Mintz 		if (!ptt) {
917fe56b9e6SYuval Mintz 			DP_NOTICE(hwfn, "Failed to drain NIG; No PTT\n");
918fe56b9e6SYuval Mintz 			return -EBUSY;
919fe56b9e6SYuval Mintz 		}
920fe56b9e6SYuval Mintz 		rc = qed_mcp_drain(hwfn, ptt);
921fe56b9e6SYuval Mintz 		if (rc)
922fe56b9e6SYuval Mintz 			return rc;
923fe56b9e6SYuval Mintz 		qed_ptt_release(hwfn, ptt);
924fe56b9e6SYuval Mintz 	}
925fe56b9e6SYuval Mintz 
926fe56b9e6SYuval Mintz 	return 0;
927fe56b9e6SYuval Mintz }
928fe56b9e6SYuval Mintz 
929fe56b9e6SYuval Mintz const struct qed_common_ops qed_common_ops_pass = {
930fe56b9e6SYuval Mintz 	.probe = &qed_probe,
931fe56b9e6SYuval Mintz 	.remove = &qed_remove,
932fe56b9e6SYuval Mintz 	.set_power_state = &qed_set_power_state,
933fe56b9e6SYuval Mintz 	.set_id = &qed_set_id,
934fe56b9e6SYuval Mintz 	.update_pf_params = &qed_update_pf_params,
935fe56b9e6SYuval Mintz 	.slowpath_start = &qed_slowpath_start,
936fe56b9e6SYuval Mintz 	.slowpath_stop = &qed_slowpath_stop,
937fe56b9e6SYuval Mintz 	.set_fp_int = &qed_set_int_fp,
938fe56b9e6SYuval Mintz 	.get_fp_int = &qed_get_int_fp,
939fe56b9e6SYuval Mintz 	.sb_init = &qed_sb_init,
940fe56b9e6SYuval Mintz 	.sb_release = &qed_sb_release,
941fe56b9e6SYuval Mintz 	.simd_handler_config = &qed_simd_handler_config,
942fe56b9e6SYuval Mintz 	.simd_handler_clean = &qed_simd_handler_clean,
943fe56b9e6SYuval Mintz 	.drain = &qed_drain,
944fe56b9e6SYuval Mintz 	.update_msglvl = &qed_init_dp,
945fe56b9e6SYuval Mintz 	.chain_alloc = &qed_chain_alloc,
946fe56b9e6SYuval Mintz 	.chain_free = &qed_chain_free,
947fe56b9e6SYuval Mintz };
948fe56b9e6SYuval Mintz 
949fe56b9e6SYuval Mintz u32 qed_get_protocol_version(enum qed_protocol protocol)
950fe56b9e6SYuval Mintz {
951fe56b9e6SYuval Mintz 	switch (protocol) {
952fe56b9e6SYuval Mintz 	case QED_PROTOCOL_ETH:
953fe56b9e6SYuval Mintz 		return QED_ETH_INTERFACE_VERSION;
954fe56b9e6SYuval Mintz 	default:
955fe56b9e6SYuval Mintz 		return 0;
956fe56b9e6SYuval Mintz 	}
957fe56b9e6SYuval Mintz }
958fe56b9e6SYuval Mintz EXPORT_SYMBOL(qed_get_protocol_version);
959