1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright (C) 2023 Intel Corporation */
3 
4 #include "idpf.h"
5 #include "idpf_devids.h"
6 #include "idpf_virtchnl.h"
7 
8 #define DRV_SUMMARY	"Intel(R) Infrastructure Data Path Function Linux Driver"
9 
10 MODULE_DESCRIPTION(DRV_SUMMARY);
11 MODULE_IMPORT_NS("LIBETH");
12 MODULE_LICENSE("GPL");
13 
14 /**
15  * idpf_remove - Device removal routine
16  * @pdev: PCI device information struct
17  */
idpf_remove(struct pci_dev * pdev)18 static void idpf_remove(struct pci_dev *pdev)
19 {
20 	struct idpf_adapter *adapter = pci_get_drvdata(pdev);
21 	int i;
22 
23 	set_bit(IDPF_REMOVE_IN_PROG, adapter->flags);
24 
25 	/* Wait until vc_event_task is done to consider if any hard reset is
26 	 * in progress else we may go ahead and release the resources but the
27 	 * thread doing the hard reset might continue the init path and
28 	 * end up in bad state.
29 	 */
30 	cancel_delayed_work_sync(&adapter->vc_event_task);
31 	if (adapter->num_vfs)
32 		idpf_sriov_configure(pdev, 0);
33 
34 	idpf_vc_core_deinit(adapter);
35 
36 	/* Be a good citizen and leave the device clean on exit */
37 	adapter->dev_ops.reg_ops.trigger_reset(adapter, IDPF_HR_FUNC_RESET);
38 	idpf_deinit_dflt_mbx(adapter);
39 
40 	if (!adapter->netdevs)
41 		goto destroy_wqs;
42 
43 	/* There are some cases where it's possible to still have netdevs
44 	 * registered with the stack at this point, e.g. if the driver detected
45 	 * a HW reset and rmmod is called before it fully recovers. Unregister
46 	 * any stale netdevs here.
47 	 */
48 	for (i = 0; i < adapter->max_vports; i++) {
49 		if (!adapter->netdevs[i])
50 			continue;
51 		if (adapter->netdevs[i]->reg_state != NETREG_UNINITIALIZED)
52 			unregister_netdev(adapter->netdevs[i]);
53 		free_netdev(adapter->netdevs[i]);
54 		adapter->netdevs[i] = NULL;
55 	}
56 
57 destroy_wqs:
58 	destroy_workqueue(adapter->init_wq);
59 	destroy_workqueue(adapter->serv_wq);
60 	destroy_workqueue(adapter->mbx_wq);
61 	destroy_workqueue(adapter->stats_wq);
62 	destroy_workqueue(adapter->vc_event_wq);
63 
64 	for (i = 0; i < adapter->max_vports; i++) {
65 		kfree(adapter->vport_config[i]);
66 		adapter->vport_config[i] = NULL;
67 	}
68 	kfree(adapter->vport_config);
69 	adapter->vport_config = NULL;
70 	kfree(adapter->netdevs);
71 	adapter->netdevs = NULL;
72 	kfree(adapter->vcxn_mngr);
73 	adapter->vcxn_mngr = NULL;
74 
75 	mutex_destroy(&adapter->vport_ctrl_lock);
76 	mutex_destroy(&adapter->vector_lock);
77 	mutex_destroy(&adapter->queue_lock);
78 	mutex_destroy(&adapter->vc_buf_lock);
79 
80 	pci_set_drvdata(pdev, NULL);
81 	kfree(adapter);
82 }
83 
84 /**
85  * idpf_shutdown - PCI callback for shutting down device
86  * @pdev: PCI device information struct
87  */
idpf_shutdown(struct pci_dev * pdev)88 static void idpf_shutdown(struct pci_dev *pdev)
89 {
90 	struct idpf_adapter *adapter = pci_get_drvdata(pdev);
91 
92 	cancel_delayed_work_sync(&adapter->vc_event_task);
93 	idpf_vc_core_deinit(adapter);
94 	idpf_deinit_dflt_mbx(adapter);
95 
96 	if (system_state == SYSTEM_POWER_OFF)
97 		pci_set_power_state(pdev, PCI_D3hot);
98 }
99 
100 /**
101  * idpf_cfg_hw - Initialize HW struct
102  * @adapter: adapter to setup hw struct for
103  *
104  * Returns 0 on success, negative on failure
105  */
idpf_cfg_hw(struct idpf_adapter * adapter)106 static int idpf_cfg_hw(struct idpf_adapter *adapter)
107 {
108 	struct pci_dev *pdev = adapter->pdev;
109 	struct idpf_hw *hw = &adapter->hw;
110 
111 	hw->hw_addr = pcim_iomap_table(pdev)[0];
112 	if (!hw->hw_addr) {
113 		pci_err(pdev, "failed to allocate PCI iomap table\n");
114 
115 		return -ENOMEM;
116 	}
117 
118 	hw->back = adapter;
119 
120 	return 0;
121 }
122 
123 /**
124  * idpf_probe - Device initialization routine
125  * @pdev: PCI device information struct
126  * @ent: entry in idpf_pci_tbl
127  *
128  * Returns 0 on success, negative on failure
129  */
idpf_probe(struct pci_dev * pdev,const struct pci_device_id * ent)130 static int idpf_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
131 {
132 	struct device *dev = &pdev->dev;
133 	struct idpf_adapter *adapter;
134 	int err;
135 
136 	adapter = kzalloc(sizeof(*adapter), GFP_KERNEL);
137 	if (!adapter)
138 		return -ENOMEM;
139 
140 	adapter->req_tx_splitq = true;
141 	adapter->req_rx_splitq = true;
142 
143 	switch (ent->device) {
144 	case IDPF_DEV_ID_PF:
145 		idpf_dev_ops_init(adapter);
146 		break;
147 	case IDPF_DEV_ID_VF:
148 		idpf_vf_dev_ops_init(adapter);
149 		adapter->crc_enable = true;
150 		break;
151 	default:
152 		err = -ENODEV;
153 		dev_err(&pdev->dev, "Unexpected dev ID 0x%x in idpf probe\n",
154 			ent->device);
155 		goto err_free;
156 	}
157 
158 	adapter->pdev = pdev;
159 	err = pcim_enable_device(pdev);
160 	if (err)
161 		goto err_free;
162 
163 	err = pcim_iomap_regions(pdev, BIT(0), pci_name(pdev));
164 	if (err) {
165 		pci_err(pdev, "pcim_iomap_regions failed %pe\n", ERR_PTR(err));
166 
167 		goto err_free;
168 	}
169 
170 	/* set up for high or low dma */
171 	err = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(64));
172 	if (err) {
173 		pci_err(pdev, "DMA configuration failed: %pe\n", ERR_PTR(err));
174 
175 		goto err_free;
176 	}
177 
178 	pci_set_master(pdev);
179 	pci_set_drvdata(pdev, adapter);
180 
181 	adapter->init_wq = alloc_workqueue("%s-%s-init",
182 					   WQ_UNBOUND | WQ_MEM_RECLAIM, 0,
183 					   dev_driver_string(dev),
184 					   dev_name(dev));
185 	if (!adapter->init_wq) {
186 		dev_err(dev, "Failed to allocate init workqueue\n");
187 		err = -ENOMEM;
188 		goto err_free;
189 	}
190 
191 	adapter->serv_wq = alloc_workqueue("%s-%s-service",
192 					   WQ_UNBOUND | WQ_MEM_RECLAIM, 0,
193 					   dev_driver_string(dev),
194 					   dev_name(dev));
195 	if (!adapter->serv_wq) {
196 		dev_err(dev, "Failed to allocate service workqueue\n");
197 		err = -ENOMEM;
198 		goto err_serv_wq_alloc;
199 	}
200 
201 	adapter->mbx_wq = alloc_workqueue("%s-%s-mbx",
202 					  WQ_UNBOUND | WQ_MEM_RECLAIM, 0,
203 					  dev_driver_string(dev),
204 					  dev_name(dev));
205 	if (!adapter->mbx_wq) {
206 		dev_err(dev, "Failed to allocate mailbox workqueue\n");
207 		err = -ENOMEM;
208 		goto err_mbx_wq_alloc;
209 	}
210 
211 	adapter->stats_wq = alloc_workqueue("%s-%s-stats",
212 					    WQ_UNBOUND | WQ_MEM_RECLAIM, 0,
213 					    dev_driver_string(dev),
214 					    dev_name(dev));
215 	if (!adapter->stats_wq) {
216 		dev_err(dev, "Failed to allocate workqueue\n");
217 		err = -ENOMEM;
218 		goto err_stats_wq_alloc;
219 	}
220 
221 	adapter->vc_event_wq = alloc_workqueue("%s-%s-vc_event",
222 					       WQ_UNBOUND | WQ_MEM_RECLAIM, 0,
223 					       dev_driver_string(dev),
224 					       dev_name(dev));
225 	if (!adapter->vc_event_wq) {
226 		dev_err(dev, "Failed to allocate virtchnl event workqueue\n");
227 		err = -ENOMEM;
228 		goto err_vc_event_wq_alloc;
229 	}
230 
231 	/* setup msglvl */
232 	adapter->msg_enable = netif_msg_init(-1, IDPF_AVAIL_NETIF_M);
233 
234 	err = idpf_cfg_hw(adapter);
235 	if (err) {
236 		dev_err(dev, "Failed to configure HW structure for adapter: %d\n",
237 			err);
238 		goto err_cfg_hw;
239 	}
240 
241 	mutex_init(&adapter->vport_ctrl_lock);
242 	mutex_init(&adapter->vector_lock);
243 	mutex_init(&adapter->queue_lock);
244 	mutex_init(&adapter->vc_buf_lock);
245 
246 	INIT_DELAYED_WORK(&adapter->init_task, idpf_init_task);
247 	INIT_DELAYED_WORK(&adapter->serv_task, idpf_service_task);
248 	INIT_DELAYED_WORK(&adapter->mbx_task, idpf_mbx_task);
249 	INIT_DELAYED_WORK(&adapter->stats_task, idpf_statistics_task);
250 	INIT_DELAYED_WORK(&adapter->vc_event_task, idpf_vc_event_task);
251 
252 	adapter->dev_ops.reg_ops.reset_reg_init(adapter);
253 	set_bit(IDPF_HR_DRV_LOAD, adapter->flags);
254 	queue_delayed_work(adapter->vc_event_wq, &adapter->vc_event_task,
255 			   msecs_to_jiffies(10 * (pdev->devfn & 0x07)));
256 
257 	return 0;
258 
259 err_cfg_hw:
260 	destroy_workqueue(adapter->vc_event_wq);
261 err_vc_event_wq_alloc:
262 	destroy_workqueue(adapter->stats_wq);
263 err_stats_wq_alloc:
264 	destroy_workqueue(adapter->mbx_wq);
265 err_mbx_wq_alloc:
266 	destroy_workqueue(adapter->serv_wq);
267 err_serv_wq_alloc:
268 	destroy_workqueue(adapter->init_wq);
269 err_free:
270 	kfree(adapter);
271 	return err;
272 }
273 
274 /* idpf_pci_tbl - PCI Dev idpf ID Table
275  */
276 static const struct pci_device_id idpf_pci_tbl[] = {
277 	{ PCI_VDEVICE(INTEL, IDPF_DEV_ID_PF)},
278 	{ PCI_VDEVICE(INTEL, IDPF_DEV_ID_VF)},
279 	{ /* Sentinel */ }
280 };
281 MODULE_DEVICE_TABLE(pci, idpf_pci_tbl);
282 
283 static struct pci_driver idpf_driver = {
284 	.name			= KBUILD_MODNAME,
285 	.id_table		= idpf_pci_tbl,
286 	.probe			= idpf_probe,
287 	.sriov_configure	= idpf_sriov_configure,
288 	.remove			= idpf_remove,
289 	.shutdown		= idpf_shutdown,
290 };
291 module_pci_driver(idpf_driver);
292