1 // SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0-only)
2 /* Copyright(c) 2015 - 2021 Intel Corporation */
3 #include <linux/workqueue.h>
4 #include <linux/pci.h>
5 #include <linux/device.h>
6 #include "adf_common_drv.h"
7 #include "adf_cfg.h"
8 #include "adf_pfvf_pf_msg.h"
9 
10 #define ADF_VF2PF_RATELIMIT_INTERVAL	8
11 #define ADF_VF2PF_RATELIMIT_BURST	130
12 
13 static struct workqueue_struct *pf2vf_resp_wq;
14 
15 struct adf_pf2vf_resp {
16 	struct work_struct pf2vf_resp_work;
17 	struct adf_accel_vf_info *vf_info;
18 };
19 
20 static void adf_iov_send_resp(struct work_struct *work)
21 {
22 	struct adf_pf2vf_resp *pf2vf_resp =
23 		container_of(work, struct adf_pf2vf_resp, pf2vf_resp_work);
24 	struct adf_accel_vf_info *vf_info = pf2vf_resp->vf_info;
25 	struct adf_accel_dev *accel_dev = vf_info->accel_dev;
26 	u32 vf_nr = vf_info->vf_nr;
27 	bool ret;
28 
29 	ret = adf_recv_and_handle_vf2pf_msg(accel_dev, vf_nr);
30 	if (ret)
31 		/* re-enable interrupt on PF from this VF */
32 		adf_enable_vf2pf_interrupts(accel_dev, 1 << vf_nr);
33 
34 	kfree(pf2vf_resp);
35 }
36 
37 void adf_schedule_vf2pf_handler(struct adf_accel_vf_info *vf_info)
38 {
39 	struct adf_pf2vf_resp *pf2vf_resp;
40 
41 	pf2vf_resp = kzalloc(sizeof(*pf2vf_resp), GFP_ATOMIC);
42 	if (!pf2vf_resp)
43 		return;
44 
45 	pf2vf_resp->vf_info = vf_info;
46 	INIT_WORK(&pf2vf_resp->pf2vf_resp_work, adf_iov_send_resp);
47 	queue_work(pf2vf_resp_wq, &pf2vf_resp->pf2vf_resp_work);
48 }
49 
50 static int adf_enable_sriov(struct adf_accel_dev *accel_dev)
51 {
52 	struct pci_dev *pdev = accel_to_pci_dev(accel_dev);
53 	int totalvfs = pci_sriov_get_totalvfs(pdev);
54 	struct adf_hw_device_data *hw_data = accel_dev->hw_device;
55 	struct adf_accel_vf_info *vf_info;
56 	int i;
57 
58 	for (i = 0, vf_info = accel_dev->pf.vf_info; i < totalvfs;
59 	     i++, vf_info++) {
60 		/* This ptr will be populated when VFs will be created */
61 		vf_info->accel_dev = accel_dev;
62 		vf_info->vf_nr = i;
63 		vf_info->vf_compat_ver = 0;
64 
65 		mutex_init(&vf_info->pf2vf_lock);
66 		ratelimit_state_init(&vf_info->vf2pf_ratelimit,
67 				     ADF_VF2PF_RATELIMIT_INTERVAL,
68 				     ADF_VF2PF_RATELIMIT_BURST);
69 	}
70 
71 	/* Set Valid bits in AE Thread to PCIe Function Mapping */
72 	if (hw_data->configure_iov_threads)
73 		hw_data->configure_iov_threads(accel_dev, true);
74 
75 	/* Enable VF to PF interrupts for all VFs */
76 	adf_enable_vf2pf_interrupts(accel_dev, BIT_ULL(totalvfs) - 1);
77 
78 	/*
79 	 * Due to the hardware design, when SR-IOV and the ring arbiter
80 	 * are enabled all the VFs supported in hardware must be enabled in
81 	 * order for all the hardware resources (i.e. bundles) to be usable.
82 	 * When SR-IOV is enabled, each of the VFs will own one bundle.
83 	 */
84 	return pci_enable_sriov(pdev, totalvfs);
85 }
86 
87 /**
88  * adf_disable_sriov() - Disable SRIOV for the device
89  * @accel_dev:  Pointer to accel device.
90  *
91  * Function disables SRIOV for the accel device.
92  *
93  * Return: 0 on success, error code otherwise.
94  */
95 void adf_disable_sriov(struct adf_accel_dev *accel_dev)
96 {
97 	struct adf_hw_device_data *hw_data = accel_dev->hw_device;
98 	int totalvfs = pci_sriov_get_totalvfs(accel_to_pci_dev(accel_dev));
99 	struct adf_accel_vf_info *vf;
100 	int i;
101 
102 	if (!accel_dev->pf.vf_info)
103 		return;
104 
105 	adf_pf2vf_notify_restarting(accel_dev);
106 	pci_disable_sriov(accel_to_pci_dev(accel_dev));
107 
108 	/* Disable VF to PF interrupts */
109 	adf_disable_all_vf2pf_interrupts(accel_dev);
110 
111 	/* Clear Valid bits in AE Thread to PCIe Function Mapping */
112 	if (hw_data->configure_iov_threads)
113 		hw_data->configure_iov_threads(accel_dev, false);
114 
115 	for (i = 0, vf = accel_dev->pf.vf_info; i < totalvfs; i++, vf++)
116 		mutex_destroy(&vf->pf2vf_lock);
117 
118 	kfree(accel_dev->pf.vf_info);
119 	accel_dev->pf.vf_info = NULL;
120 }
121 EXPORT_SYMBOL_GPL(adf_disable_sriov);
122 
123 /**
124  * adf_sriov_configure() - Enable SRIOV for the device
125  * @pdev:  Pointer to PCI device.
126  * @numvfs: Number of virtual functions (VFs) to enable.
127  *
128  * Note that the @numvfs parameter is ignored and all VFs supported by the
129  * device are enabled due to the design of the hardware.
130  *
131  * Function enables SRIOV for the PCI device.
132  *
133  * Return: number of VFs enabled on success, error code otherwise.
134  */
135 int adf_sriov_configure(struct pci_dev *pdev, int numvfs)
136 {
137 	struct adf_accel_dev *accel_dev = adf_devmgr_pci_to_accel_dev(pdev);
138 	int totalvfs = pci_sriov_get_totalvfs(pdev);
139 	unsigned long val;
140 	int ret;
141 
142 	if (!accel_dev) {
143 		dev_err(&pdev->dev, "Failed to find accel_dev\n");
144 		return -EFAULT;
145 	}
146 
147 	if (!device_iommu_mapped(&pdev->dev))
148 		dev_warn(&pdev->dev, "IOMMU should be enabled for SR-IOV to work correctly\n");
149 
150 	if (accel_dev->pf.vf_info) {
151 		dev_info(&pdev->dev, "Already enabled for this device\n");
152 		return -EINVAL;
153 	}
154 
155 	if (adf_dev_started(accel_dev)) {
156 		if (adf_devmgr_in_reset(accel_dev) ||
157 		    adf_dev_in_use(accel_dev)) {
158 			dev_err(&GET_DEV(accel_dev), "Device busy\n");
159 			return -EBUSY;
160 		}
161 
162 		ret = adf_dev_down(accel_dev, true);
163 		if (ret)
164 			return ret;
165 	}
166 
167 	if (adf_cfg_section_add(accel_dev, ADF_KERNEL_SEC))
168 		return -EFAULT;
169 	val = 0;
170 	if (adf_cfg_add_key_value_param(accel_dev, ADF_KERNEL_SEC,
171 					ADF_NUM_CY, (void *)&val, ADF_DEC))
172 		return -EFAULT;
173 	ret = adf_cfg_add_key_value_param(accel_dev, ADF_KERNEL_SEC, ADF_NUM_DC,
174 					  &val, ADF_DEC);
175 	if (ret)
176 		return ret;
177 
178 	set_bit(ADF_STATUS_CONFIGURED, &accel_dev->status);
179 
180 	/* Allocate memory for VF info structs */
181 	accel_dev->pf.vf_info = kcalloc(totalvfs,
182 					sizeof(struct adf_accel_vf_info),
183 					GFP_KERNEL);
184 	if (!accel_dev->pf.vf_info)
185 		return -ENOMEM;
186 
187 	if (adf_dev_up(accel_dev, false)) {
188 		dev_err(&GET_DEV(accel_dev), "Failed to start qat_dev%d\n",
189 			accel_dev->accel_id);
190 		return -EFAULT;
191 	}
192 
193 	ret = adf_enable_sriov(accel_dev);
194 	if (ret)
195 		return ret;
196 
197 	return numvfs;
198 }
199 EXPORT_SYMBOL_GPL(adf_sriov_configure);
200 
201 int __init adf_init_pf_wq(void)
202 {
203 	/* Workqueue for PF2VF responses */
204 	pf2vf_resp_wq = alloc_workqueue("qat_pf2vf_resp_wq", WQ_MEM_RECLAIM, 0);
205 
206 	return !pf2vf_resp_wq ? -ENOMEM : 0;
207 }
208 
209 void adf_exit_pf_wq(void)
210 {
211 	if (pf2vf_resp_wq) {
212 		destroy_workqueue(pf2vf_resp_wq);
213 		pf2vf_resp_wq = NULL;
214 	}
215 }
216