xref: /openbmc/linux/drivers/pci/p2pdma.c (revision 14474950)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * PCI Peer 2 Peer DMA support.
4  *
5  * Copyright (c) 2016-2018, Logan Gunthorpe
6  * Copyright (c) 2016-2017, Microsemi Corporation
7  * Copyright (c) 2017, Christoph Hellwig
8  * Copyright (c) 2018, Eideticom Inc.
9  */
10 
11 #define pr_fmt(fmt) "pci-p2pdma: " fmt
12 #include <linux/ctype.h>
13 #include <linux/pci-p2pdma.h>
14 #include <linux/module.h>
15 #include <linux/slab.h>
16 #include <linux/genalloc.h>
17 #include <linux/memremap.h>
18 #include <linux/percpu-refcount.h>
19 #include <linux/random.h>
20 #include <linux/seq_buf.h>
21 #include <linux/xarray.h>
22 
23 enum pci_p2pdma_map_type {
24 	PCI_P2PDMA_MAP_UNKNOWN = 0,
25 	PCI_P2PDMA_MAP_NOT_SUPPORTED,
26 	PCI_P2PDMA_MAP_BUS_ADDR,
27 	PCI_P2PDMA_MAP_THRU_HOST_BRIDGE,
28 };
29 
30 struct pci_p2pdma {
31 	struct gen_pool *pool;
32 	bool p2pmem_published;
33 	struct xarray map_types;
34 };
35 
36 struct pci_p2pdma_pagemap {
37 	struct dev_pagemap pgmap;
38 	struct pci_dev *provider;
39 	u64 bus_offset;
40 };
41 
42 static struct pci_p2pdma_pagemap *to_p2p_pgmap(struct dev_pagemap *pgmap)
43 {
44 	return container_of(pgmap, struct pci_p2pdma_pagemap, pgmap);
45 }
46 
47 static ssize_t size_show(struct device *dev, struct device_attribute *attr,
48 			 char *buf)
49 {
50 	struct pci_dev *pdev = to_pci_dev(dev);
51 	size_t size = 0;
52 
53 	if (pdev->p2pdma->pool)
54 		size = gen_pool_size(pdev->p2pdma->pool);
55 
56 	return snprintf(buf, PAGE_SIZE, "%zd\n", size);
57 }
58 static DEVICE_ATTR_RO(size);
59 
60 static ssize_t available_show(struct device *dev, struct device_attribute *attr,
61 			      char *buf)
62 {
63 	struct pci_dev *pdev = to_pci_dev(dev);
64 	size_t avail = 0;
65 
66 	if (pdev->p2pdma->pool)
67 		avail = gen_pool_avail(pdev->p2pdma->pool);
68 
69 	return snprintf(buf, PAGE_SIZE, "%zd\n", avail);
70 }
71 static DEVICE_ATTR_RO(available);
72 
73 static ssize_t published_show(struct device *dev, struct device_attribute *attr,
74 			      char *buf)
75 {
76 	struct pci_dev *pdev = to_pci_dev(dev);
77 
78 	return snprintf(buf, PAGE_SIZE, "%d\n",
79 			pdev->p2pdma->p2pmem_published);
80 }
81 static DEVICE_ATTR_RO(published);
82 
83 static struct attribute *p2pmem_attrs[] = {
84 	&dev_attr_size.attr,
85 	&dev_attr_available.attr,
86 	&dev_attr_published.attr,
87 	NULL,
88 };
89 
90 static const struct attribute_group p2pmem_group = {
91 	.attrs = p2pmem_attrs,
92 	.name = "p2pmem",
93 };
94 
95 static void pci_p2pdma_release(void *data)
96 {
97 	struct pci_dev *pdev = data;
98 	struct pci_p2pdma *p2pdma = pdev->p2pdma;
99 
100 	if (!p2pdma)
101 		return;
102 
103 	/* Flush and disable pci_alloc_p2p_mem() */
104 	pdev->p2pdma = NULL;
105 	synchronize_rcu();
106 
107 	gen_pool_destroy(p2pdma->pool);
108 	sysfs_remove_group(&pdev->dev.kobj, &p2pmem_group);
109 	xa_destroy(&p2pdma->map_types);
110 }
111 
112 static int pci_p2pdma_setup(struct pci_dev *pdev)
113 {
114 	int error = -ENOMEM;
115 	struct pci_p2pdma *p2p;
116 
117 	p2p = devm_kzalloc(&pdev->dev, sizeof(*p2p), GFP_KERNEL);
118 	if (!p2p)
119 		return -ENOMEM;
120 
121 	xa_init(&p2p->map_types);
122 
123 	p2p->pool = gen_pool_create(PAGE_SHIFT, dev_to_node(&pdev->dev));
124 	if (!p2p->pool)
125 		goto out;
126 
127 	error = devm_add_action_or_reset(&pdev->dev, pci_p2pdma_release, pdev);
128 	if (error)
129 		goto out_pool_destroy;
130 
131 	pdev->p2pdma = p2p;
132 
133 	error = sysfs_create_group(&pdev->dev.kobj, &p2pmem_group);
134 	if (error)
135 		goto out_pool_destroy;
136 
137 	return 0;
138 
139 out_pool_destroy:
140 	pdev->p2pdma = NULL;
141 	gen_pool_destroy(p2p->pool);
142 out:
143 	devm_kfree(&pdev->dev, p2p);
144 	return error;
145 }
146 
147 /**
148  * pci_p2pdma_add_resource - add memory for use as p2p memory
149  * @pdev: the device to add the memory to
150  * @bar: PCI BAR to add
151  * @size: size of the memory to add, may be zero to use the whole BAR
152  * @offset: offset into the PCI BAR
153  *
154  * The memory will be given ZONE_DEVICE struct pages so that it may
155  * be used with any DMA request.
156  */
157 int pci_p2pdma_add_resource(struct pci_dev *pdev, int bar, size_t size,
158 			    u64 offset)
159 {
160 	struct pci_p2pdma_pagemap *p2p_pgmap;
161 	struct dev_pagemap *pgmap;
162 	void *addr;
163 	int error;
164 
165 	if (!(pci_resource_flags(pdev, bar) & IORESOURCE_MEM))
166 		return -EINVAL;
167 
168 	if (offset >= pci_resource_len(pdev, bar))
169 		return -EINVAL;
170 
171 	if (!size)
172 		size = pci_resource_len(pdev, bar) - offset;
173 
174 	if (size + offset > pci_resource_len(pdev, bar))
175 		return -EINVAL;
176 
177 	if (!pdev->p2pdma) {
178 		error = pci_p2pdma_setup(pdev);
179 		if (error)
180 			return error;
181 	}
182 
183 	p2p_pgmap = devm_kzalloc(&pdev->dev, sizeof(*p2p_pgmap), GFP_KERNEL);
184 	if (!p2p_pgmap)
185 		return -ENOMEM;
186 
187 	pgmap = &p2p_pgmap->pgmap;
188 	pgmap->res.start = pci_resource_start(pdev, bar) + offset;
189 	pgmap->res.end = pgmap->res.start + size - 1;
190 	pgmap->res.flags = pci_resource_flags(pdev, bar);
191 	pgmap->type = MEMORY_DEVICE_PCI_P2PDMA;
192 
193 	p2p_pgmap->provider = pdev;
194 	p2p_pgmap->bus_offset = pci_bus_address(pdev, bar) -
195 		pci_resource_start(pdev, bar);
196 
197 	addr = devm_memremap_pages(&pdev->dev, pgmap);
198 	if (IS_ERR(addr)) {
199 		error = PTR_ERR(addr);
200 		goto pgmap_free;
201 	}
202 
203 	error = gen_pool_add_owner(pdev->p2pdma->pool, (unsigned long)addr,
204 			pci_bus_address(pdev, bar) + offset,
205 			resource_size(&pgmap->res), dev_to_node(&pdev->dev),
206 			pgmap->ref);
207 	if (error)
208 		goto pages_free;
209 
210 	pci_info(pdev, "added peer-to-peer DMA memory %pR\n",
211 		 &pgmap->res);
212 
213 	return 0;
214 
215 pages_free:
216 	devm_memunmap_pages(&pdev->dev, pgmap);
217 pgmap_free:
218 	devm_kfree(&pdev->dev, pgmap);
219 	return error;
220 }
221 EXPORT_SYMBOL_GPL(pci_p2pdma_add_resource);
222 
223 /*
224  * Note this function returns the parent PCI device with a
225  * reference taken. It is the caller's responsibility to drop
226  * the reference.
227  */
228 static struct pci_dev *find_parent_pci_dev(struct device *dev)
229 {
230 	struct device *parent;
231 
232 	dev = get_device(dev);
233 
234 	while (dev) {
235 		if (dev_is_pci(dev))
236 			return to_pci_dev(dev);
237 
238 		parent = get_device(dev->parent);
239 		put_device(dev);
240 		dev = parent;
241 	}
242 
243 	return NULL;
244 }
245 
246 /*
247  * Check if a PCI bridge has its ACS redirection bits set to redirect P2P
248  * TLPs upstream via ACS. Returns 1 if the packets will be redirected
249  * upstream, 0 otherwise.
250  */
251 static int pci_bridge_has_acs_redir(struct pci_dev *pdev)
252 {
253 	int pos;
254 	u16 ctrl;
255 
256 	pos = pci_find_ext_capability(pdev, PCI_EXT_CAP_ID_ACS);
257 	if (!pos)
258 		return 0;
259 
260 	pci_read_config_word(pdev, pos + PCI_ACS_CTRL, &ctrl);
261 
262 	if (ctrl & (PCI_ACS_RR | PCI_ACS_CR | PCI_ACS_EC))
263 		return 1;
264 
265 	return 0;
266 }
267 
268 static void seq_buf_print_bus_devfn(struct seq_buf *buf, struct pci_dev *pdev)
269 {
270 	if (!buf)
271 		return;
272 
273 	seq_buf_printf(buf, "%s;", pci_name(pdev));
274 }
275 
276 static const struct pci_p2pdma_whitelist_entry {
277 	unsigned short vendor;
278 	unsigned short device;
279 	enum {
280 		REQ_SAME_HOST_BRIDGE	= 1 << 0,
281 	} flags;
282 } pci_p2pdma_whitelist[] = {
283 	/* AMD ZEN */
284 	{PCI_VENDOR_ID_AMD,	0x1450,	0},
285 	{PCI_VENDOR_ID_AMD,	0x15d0,	0},
286 	{PCI_VENDOR_ID_AMD,	0x1630,	0},
287 
288 	/* Intel Xeon E5/Core i7 */
289 	{PCI_VENDOR_ID_INTEL,	0x3c00, REQ_SAME_HOST_BRIDGE},
290 	{PCI_VENDOR_ID_INTEL,	0x3c01, REQ_SAME_HOST_BRIDGE},
291 	/* Intel Xeon E7 v3/Xeon E5 v3/Core i7 */
292 	{PCI_VENDOR_ID_INTEL,	0x2f00, REQ_SAME_HOST_BRIDGE},
293 	{PCI_VENDOR_ID_INTEL,	0x2f01, REQ_SAME_HOST_BRIDGE},
294 	/* Intel SkyLake-E */
295 	{PCI_VENDOR_ID_INTEL,	0x2030, 0},
296 	{PCI_VENDOR_ID_INTEL,	0x2031, 0},
297 	{PCI_VENDOR_ID_INTEL,	0x2032, 0},
298 	{PCI_VENDOR_ID_INTEL,	0x2033, 0},
299 	{PCI_VENDOR_ID_INTEL,	0x2020, 0},
300 	{}
301 };
302 
303 static bool __host_bridge_whitelist(struct pci_host_bridge *host,
304 				    bool same_host_bridge)
305 {
306 	struct pci_dev *root = pci_get_slot(host->bus, PCI_DEVFN(0, 0));
307 	const struct pci_p2pdma_whitelist_entry *entry;
308 	unsigned short vendor, device;
309 
310 	if (!root)
311 		return false;
312 
313 	vendor = root->vendor;
314 	device = root->device;
315 	pci_dev_put(root);
316 
317 	for (entry = pci_p2pdma_whitelist; entry->vendor; entry++) {
318 		if (vendor != entry->vendor || device != entry->device)
319 			continue;
320 		if (entry->flags & REQ_SAME_HOST_BRIDGE && !same_host_bridge)
321 			return false;
322 
323 		return true;
324 	}
325 
326 	return false;
327 }
328 
329 /*
330  * If we can't find a common upstream bridge take a look at the root
331  * complex and compare it to a whitelist of known good hardware.
332  */
333 static bool host_bridge_whitelist(struct pci_dev *a, struct pci_dev *b)
334 {
335 	struct pci_host_bridge *host_a = pci_find_host_bridge(a->bus);
336 	struct pci_host_bridge *host_b = pci_find_host_bridge(b->bus);
337 
338 	if (host_a == host_b)
339 		return __host_bridge_whitelist(host_a, true);
340 
341 	if (__host_bridge_whitelist(host_a, false) &&
342 	    __host_bridge_whitelist(host_b, false))
343 		return true;
344 
345 	return false;
346 }
347 
348 static enum pci_p2pdma_map_type
349 __upstream_bridge_distance(struct pci_dev *provider, struct pci_dev *client,
350 		int *dist, bool *acs_redirects, struct seq_buf *acs_list)
351 {
352 	struct pci_dev *a = provider, *b = client, *bb;
353 	int dist_a = 0;
354 	int dist_b = 0;
355 	int acs_cnt = 0;
356 
357 	if (acs_redirects)
358 		*acs_redirects = false;
359 
360 	/*
361 	 * Note, we don't need to take references to devices returned by
362 	 * pci_upstream_bridge() seeing we hold a reference to a child
363 	 * device which will already hold a reference to the upstream bridge.
364 	 */
365 
366 	while (a) {
367 		dist_b = 0;
368 
369 		if (pci_bridge_has_acs_redir(a)) {
370 			seq_buf_print_bus_devfn(acs_list, a);
371 			acs_cnt++;
372 		}
373 
374 		bb = b;
375 
376 		while (bb) {
377 			if (a == bb)
378 				goto check_b_path_acs;
379 
380 			bb = pci_upstream_bridge(bb);
381 			dist_b++;
382 		}
383 
384 		a = pci_upstream_bridge(a);
385 		dist_a++;
386 	}
387 
388 	if (dist)
389 		*dist = dist_a + dist_b;
390 
391 	return PCI_P2PDMA_MAP_THRU_HOST_BRIDGE;
392 
393 check_b_path_acs:
394 	bb = b;
395 
396 	while (bb) {
397 		if (a == bb)
398 			break;
399 
400 		if (pci_bridge_has_acs_redir(bb)) {
401 			seq_buf_print_bus_devfn(acs_list, bb);
402 			acs_cnt++;
403 		}
404 
405 		bb = pci_upstream_bridge(bb);
406 	}
407 
408 	if (dist)
409 		*dist = dist_a + dist_b;
410 
411 	if (acs_cnt) {
412 		if (acs_redirects)
413 			*acs_redirects = true;
414 
415 		return PCI_P2PDMA_MAP_THRU_HOST_BRIDGE;
416 	}
417 
418 	return PCI_P2PDMA_MAP_BUS_ADDR;
419 }
420 
421 static unsigned long map_types_idx(struct pci_dev *client)
422 {
423 	return (pci_domain_nr(client->bus) << 16) |
424 		(client->bus->number << 8) | client->devfn;
425 }
426 
427 /*
428  * Find the distance through the nearest common upstream bridge between
429  * two PCI devices.
430  *
431  * If the two devices are the same device then 0 will be returned.
432  *
433  * If there are two virtual functions of the same device behind the same
434  * bridge port then 2 will be returned (one step down to the PCIe switch,
435  * then one step back to the same device).
436  *
437  * In the case where two devices are connected to the same PCIe switch, the
438  * value 4 will be returned. This corresponds to the following PCI tree:
439  *
440  *     -+  Root Port
441  *      \+ Switch Upstream Port
442  *       +-+ Switch Downstream Port
443  *       + \- Device A
444  *       \-+ Switch Downstream Port
445  *         \- Device B
446  *
447  * The distance is 4 because we traverse from Device A through the downstream
448  * port of the switch, to the common upstream port, back up to the second
449  * downstream port and then to Device B.
450  *
451  * Any two devices that cannot communicate using p2pdma will return
452  * PCI_P2PDMA_MAP_NOT_SUPPORTED.
453  *
454  * Any two devices that have a data path that goes through the host bridge
455  * will consult a whitelist. If the host bridges are on the whitelist,
456  * this function will return PCI_P2PDMA_MAP_THRU_HOST_BRIDGE.
457  *
458  * If either bridge is not on the whitelist this function returns
459  * PCI_P2PDMA_MAP_NOT_SUPPORTED.
460  *
461  * If a bridge which has any ACS redirection bits set is in the path,
462  * acs_redirects will be set to true. In this case, a list of all infringing
463  * bridge addresses will be populated in acs_list (assuming it's non-null)
464  * for printk purposes.
465  */
466 static enum pci_p2pdma_map_type
467 upstream_bridge_distance(struct pci_dev *provider, struct pci_dev *client,
468 		int *dist, bool *acs_redirects, struct seq_buf *acs_list)
469 {
470 	enum pci_p2pdma_map_type map_type;
471 
472 	map_type = __upstream_bridge_distance(provider, client, dist,
473 					      acs_redirects, acs_list);
474 
475 	if (map_type == PCI_P2PDMA_MAP_THRU_HOST_BRIDGE) {
476 		if (!host_bridge_whitelist(provider, client))
477 			map_type = PCI_P2PDMA_MAP_NOT_SUPPORTED;
478 	}
479 
480 	if (provider->p2pdma)
481 		xa_store(&provider->p2pdma->map_types, map_types_idx(client),
482 			 xa_mk_value(map_type), GFP_KERNEL);
483 
484 	return map_type;
485 }
486 
487 static enum pci_p2pdma_map_type
488 upstream_bridge_distance_warn(struct pci_dev *provider, struct pci_dev *client,
489 			      int *dist)
490 {
491 	struct seq_buf acs_list;
492 	bool acs_redirects;
493 	int ret;
494 
495 	seq_buf_init(&acs_list, kmalloc(PAGE_SIZE, GFP_KERNEL), PAGE_SIZE);
496 	if (!acs_list.buffer)
497 		return -ENOMEM;
498 
499 	ret = upstream_bridge_distance(provider, client, dist, &acs_redirects,
500 				       &acs_list);
501 	if (acs_redirects) {
502 		pci_warn(client, "ACS redirect is set between the client and provider (%s)\n",
503 			 pci_name(provider));
504 		/* Drop final semicolon */
505 		acs_list.buffer[acs_list.len-1] = 0;
506 		pci_warn(client, "to disable ACS redirect for this path, add the kernel parameter: pci=disable_acs_redir=%s\n",
507 			 acs_list.buffer);
508 	}
509 
510 	if (ret == PCI_P2PDMA_MAP_NOT_SUPPORTED) {
511 		pci_warn(client, "cannot be used for peer-to-peer DMA as the client and provider (%s) do not share an upstream bridge or whitelisted host bridge\n",
512 			 pci_name(provider));
513 	}
514 
515 	kfree(acs_list.buffer);
516 
517 	return ret;
518 }
519 
520 /**
521  * pci_p2pdma_distance_many - Determine the cumulative distance between
522  *	a p2pdma provider and the clients in use.
523  * @provider: p2pdma provider to check against the client list
524  * @clients: array of devices to check (NULL-terminated)
525  * @num_clients: number of clients in the array
526  * @verbose: if true, print warnings for devices when we return -1
527  *
528  * Returns -1 if any of the clients are not compatible, otherwise returns a
529  * positive number where a lower number is the preferable choice. (If there's
530  * one client that's the same as the provider it will return 0, which is best
531  * choice).
532  *
533  * "compatible" means the provider and the clients are either all behind
534  * the same PCI root port or the host bridges connected to each of the devices
535  * are listed in the 'pci_p2pdma_whitelist'.
536  */
537 int pci_p2pdma_distance_many(struct pci_dev *provider, struct device **clients,
538 			     int num_clients, bool verbose)
539 {
540 	bool not_supported = false;
541 	struct pci_dev *pci_client;
542 	int total_dist = 0;
543 	int distance;
544 	int i, ret;
545 
546 	if (num_clients == 0)
547 		return -1;
548 
549 	for (i = 0; i < num_clients; i++) {
550 		if (IS_ENABLED(CONFIG_DMA_VIRT_OPS) &&
551 		    clients[i]->dma_ops == &dma_virt_ops) {
552 			if (verbose)
553 				dev_warn(clients[i],
554 					 "cannot be used for peer-to-peer DMA because the driver makes use of dma_virt_ops\n");
555 			return -1;
556 		}
557 
558 		pci_client = find_parent_pci_dev(clients[i]);
559 		if (!pci_client) {
560 			if (verbose)
561 				dev_warn(clients[i],
562 					 "cannot be used for peer-to-peer DMA as it is not a PCI device\n");
563 			return -1;
564 		}
565 
566 		if (verbose)
567 			ret = upstream_bridge_distance_warn(provider,
568 					pci_client, &distance);
569 		else
570 			ret = upstream_bridge_distance(provider, pci_client,
571 						       &distance, NULL, NULL);
572 
573 		pci_dev_put(pci_client);
574 
575 		if (ret == PCI_P2PDMA_MAP_NOT_SUPPORTED)
576 			not_supported = true;
577 
578 		if (not_supported && !verbose)
579 			break;
580 
581 		total_dist += distance;
582 	}
583 
584 	if (not_supported)
585 		return -1;
586 
587 	return total_dist;
588 }
589 EXPORT_SYMBOL_GPL(pci_p2pdma_distance_many);
590 
591 /**
592  * pci_has_p2pmem - check if a given PCI device has published any p2pmem
593  * @pdev: PCI device to check
594  */
595 bool pci_has_p2pmem(struct pci_dev *pdev)
596 {
597 	return pdev->p2pdma && pdev->p2pdma->p2pmem_published;
598 }
599 EXPORT_SYMBOL_GPL(pci_has_p2pmem);
600 
601 /**
602  * pci_p2pmem_find - find a peer-to-peer DMA memory device compatible with
603  *	the specified list of clients and shortest distance (as determined
604  *	by pci_p2pmem_dma())
605  * @clients: array of devices to check (NULL-terminated)
606  * @num_clients: number of client devices in the list
607  *
608  * If multiple devices are behind the same switch, the one "closest" to the
609  * client devices in use will be chosen first. (So if one of the providers is
610  * the same as one of the clients, that provider will be used ahead of any
611  * other providers that are unrelated). If multiple providers are an equal
612  * distance away, one will be chosen at random.
613  *
614  * Returns a pointer to the PCI device with a reference taken (use pci_dev_put
615  * to return the reference) or NULL if no compatible device is found. The
616  * found provider will also be assigned to the client list.
617  */
618 struct pci_dev *pci_p2pmem_find_many(struct device **clients, int num_clients)
619 {
620 	struct pci_dev *pdev = NULL;
621 	int distance;
622 	int closest_distance = INT_MAX;
623 	struct pci_dev **closest_pdevs;
624 	int dev_cnt = 0;
625 	const int max_devs = PAGE_SIZE / sizeof(*closest_pdevs);
626 	int i;
627 
628 	closest_pdevs = kmalloc(PAGE_SIZE, GFP_KERNEL);
629 	if (!closest_pdevs)
630 		return NULL;
631 
632 	while ((pdev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, pdev))) {
633 		if (!pci_has_p2pmem(pdev))
634 			continue;
635 
636 		distance = pci_p2pdma_distance_many(pdev, clients,
637 						    num_clients, false);
638 		if (distance < 0 || distance > closest_distance)
639 			continue;
640 
641 		if (distance == closest_distance && dev_cnt >= max_devs)
642 			continue;
643 
644 		if (distance < closest_distance) {
645 			for (i = 0; i < dev_cnt; i++)
646 				pci_dev_put(closest_pdevs[i]);
647 
648 			dev_cnt = 0;
649 			closest_distance = distance;
650 		}
651 
652 		closest_pdevs[dev_cnt++] = pci_dev_get(pdev);
653 	}
654 
655 	if (dev_cnt)
656 		pdev = pci_dev_get(closest_pdevs[prandom_u32_max(dev_cnt)]);
657 
658 	for (i = 0; i < dev_cnt; i++)
659 		pci_dev_put(closest_pdevs[i]);
660 
661 	kfree(closest_pdevs);
662 	return pdev;
663 }
664 EXPORT_SYMBOL_GPL(pci_p2pmem_find_many);
665 
666 /**
667  * pci_alloc_p2p_mem - allocate peer-to-peer DMA memory
668  * @pdev: the device to allocate memory from
669  * @size: number of bytes to allocate
670  *
671  * Returns the allocated memory or NULL on error.
672  */
673 void *pci_alloc_p2pmem(struct pci_dev *pdev, size_t size)
674 {
675 	void *ret = NULL;
676 	struct percpu_ref *ref;
677 
678 	/*
679 	 * Pairs with synchronize_rcu() in pci_p2pdma_release() to
680 	 * ensure pdev->p2pdma is non-NULL for the duration of the
681 	 * read-lock.
682 	 */
683 	rcu_read_lock();
684 	if (unlikely(!pdev->p2pdma))
685 		goto out;
686 
687 	ret = (void *)gen_pool_alloc_owner(pdev->p2pdma->pool, size,
688 			(void **) &ref);
689 	if (!ret)
690 		goto out;
691 
692 	if (unlikely(!percpu_ref_tryget_live(ref))) {
693 		gen_pool_free(pdev->p2pdma->pool, (unsigned long) ret, size);
694 		ret = NULL;
695 		goto out;
696 	}
697 out:
698 	rcu_read_unlock();
699 	return ret;
700 }
701 EXPORT_SYMBOL_GPL(pci_alloc_p2pmem);
702 
703 /**
704  * pci_free_p2pmem - free peer-to-peer DMA memory
705  * @pdev: the device the memory was allocated from
706  * @addr: address of the memory that was allocated
707  * @size: number of bytes that were allocated
708  */
709 void pci_free_p2pmem(struct pci_dev *pdev, void *addr, size_t size)
710 {
711 	struct percpu_ref *ref;
712 
713 	gen_pool_free_owner(pdev->p2pdma->pool, (uintptr_t)addr, size,
714 			(void **) &ref);
715 	percpu_ref_put(ref);
716 }
717 EXPORT_SYMBOL_GPL(pci_free_p2pmem);
718 
719 /**
720  * pci_virt_to_bus - return the PCI bus address for a given virtual
721  *	address obtained with pci_alloc_p2pmem()
722  * @pdev: the device the memory was allocated from
723  * @addr: address of the memory that was allocated
724  */
725 pci_bus_addr_t pci_p2pmem_virt_to_bus(struct pci_dev *pdev, void *addr)
726 {
727 	if (!addr)
728 		return 0;
729 	if (!pdev->p2pdma)
730 		return 0;
731 
732 	/*
733 	 * Note: when we added the memory to the pool we used the PCI
734 	 * bus address as the physical address. So gen_pool_virt_to_phys()
735 	 * actually returns the bus address despite the misleading name.
736 	 */
737 	return gen_pool_virt_to_phys(pdev->p2pdma->pool, (unsigned long)addr);
738 }
739 EXPORT_SYMBOL_GPL(pci_p2pmem_virt_to_bus);
740 
741 /**
742  * pci_p2pmem_alloc_sgl - allocate peer-to-peer DMA memory in a scatterlist
743  * @pdev: the device to allocate memory from
744  * @nents: the number of SG entries in the list
745  * @length: number of bytes to allocate
746  *
747  * Return: %NULL on error or &struct scatterlist pointer and @nents on success
748  */
749 struct scatterlist *pci_p2pmem_alloc_sgl(struct pci_dev *pdev,
750 					 unsigned int *nents, u32 length)
751 {
752 	struct scatterlist *sg;
753 	void *addr;
754 
755 	sg = kzalloc(sizeof(*sg), GFP_KERNEL);
756 	if (!sg)
757 		return NULL;
758 
759 	sg_init_table(sg, 1);
760 
761 	addr = pci_alloc_p2pmem(pdev, length);
762 	if (!addr)
763 		goto out_free_sg;
764 
765 	sg_set_buf(sg, addr, length);
766 	*nents = 1;
767 	return sg;
768 
769 out_free_sg:
770 	kfree(sg);
771 	return NULL;
772 }
773 EXPORT_SYMBOL_GPL(pci_p2pmem_alloc_sgl);
774 
775 /**
776  * pci_p2pmem_free_sgl - free a scatterlist allocated by pci_p2pmem_alloc_sgl()
777  * @pdev: the device to allocate memory from
778  * @sgl: the allocated scatterlist
779  */
780 void pci_p2pmem_free_sgl(struct pci_dev *pdev, struct scatterlist *sgl)
781 {
782 	struct scatterlist *sg;
783 	int count;
784 
785 	for_each_sg(sgl, sg, INT_MAX, count) {
786 		if (!sg)
787 			break;
788 
789 		pci_free_p2pmem(pdev, sg_virt(sg), sg->length);
790 	}
791 	kfree(sgl);
792 }
793 EXPORT_SYMBOL_GPL(pci_p2pmem_free_sgl);
794 
795 /**
796  * pci_p2pmem_publish - publish the peer-to-peer DMA memory for use by
797  *	other devices with pci_p2pmem_find()
798  * @pdev: the device with peer-to-peer DMA memory to publish
799  * @publish: set to true to publish the memory, false to unpublish it
800  *
801  * Published memory can be used by other PCI device drivers for
802  * peer-2-peer DMA operations. Non-published memory is reserved for
803  * exclusive use of the device driver that registers the peer-to-peer
804  * memory.
805  */
806 void pci_p2pmem_publish(struct pci_dev *pdev, bool publish)
807 {
808 	if (pdev->p2pdma)
809 		pdev->p2pdma->p2pmem_published = publish;
810 }
811 EXPORT_SYMBOL_GPL(pci_p2pmem_publish);
812 
813 static enum pci_p2pdma_map_type pci_p2pdma_map_type(struct pci_dev *provider,
814 						    struct pci_dev *client)
815 {
816 	if (!provider->p2pdma)
817 		return PCI_P2PDMA_MAP_NOT_SUPPORTED;
818 
819 	return xa_to_value(xa_load(&provider->p2pdma->map_types,
820 				   map_types_idx(client)));
821 }
822 
823 static int __pci_p2pdma_map_sg(struct pci_p2pdma_pagemap *p2p_pgmap,
824 		struct device *dev, struct scatterlist *sg, int nents)
825 {
826 	struct scatterlist *s;
827 	phys_addr_t paddr;
828 	int i;
829 
830 	/*
831 	 * p2pdma mappings are not compatible with devices that use
832 	 * dma_virt_ops. If the upper layers do the right thing
833 	 * this should never happen because it will be prevented
834 	 * by the check in pci_p2pdma_distance_many()
835 	 */
836 	if (WARN_ON_ONCE(IS_ENABLED(CONFIG_DMA_VIRT_OPS) &&
837 			 dev->dma_ops == &dma_virt_ops))
838 		return 0;
839 
840 	for_each_sg(sg, s, nents, i) {
841 		paddr = sg_phys(s);
842 
843 		s->dma_address = paddr - p2p_pgmap->bus_offset;
844 		sg_dma_len(s) = s->length;
845 	}
846 
847 	return nents;
848 }
849 
850 /**
851  * pci_p2pdma_map_sg - map a PCI peer-to-peer scatterlist for DMA
852  * @dev: device doing the DMA request
853  * @sg: scatter list to map
854  * @nents: elements in the scatterlist
855  * @dir: DMA direction
856  * @attrs: DMA attributes passed to dma_map_sg() (if called)
857  *
858  * Scatterlists mapped with this function should be unmapped using
859  * pci_p2pdma_unmap_sg_attrs().
860  *
861  * Returns the number of SG entries mapped or 0 on error.
862  */
863 int pci_p2pdma_map_sg_attrs(struct device *dev, struct scatterlist *sg,
864 		int nents, enum dma_data_direction dir, unsigned long attrs)
865 {
866 	struct pci_p2pdma_pagemap *p2p_pgmap =
867 		to_p2p_pgmap(sg_page(sg)->pgmap);
868 	struct pci_dev *client;
869 
870 	if (WARN_ON_ONCE(!dev_is_pci(dev)))
871 		return 0;
872 
873 	client = to_pci_dev(dev);
874 
875 	switch (pci_p2pdma_map_type(p2p_pgmap->provider, client)) {
876 	case PCI_P2PDMA_MAP_THRU_HOST_BRIDGE:
877 		return dma_map_sg_attrs(dev, sg, nents, dir, attrs);
878 	case PCI_P2PDMA_MAP_BUS_ADDR:
879 		return __pci_p2pdma_map_sg(p2p_pgmap, dev, sg, nents);
880 	default:
881 		WARN_ON_ONCE(1);
882 		return 0;
883 	}
884 }
885 EXPORT_SYMBOL_GPL(pci_p2pdma_map_sg_attrs);
886 
887 /**
888  * pci_p2pdma_unmap_sg - unmap a PCI peer-to-peer scatterlist that was
889  *	mapped with pci_p2pdma_map_sg()
890  * @dev: device doing the DMA request
891  * @sg: scatter list to map
892  * @nents: number of elements returned by pci_p2pdma_map_sg()
893  * @dir: DMA direction
894  * @attrs: DMA attributes passed to dma_unmap_sg() (if called)
895  */
896 void pci_p2pdma_unmap_sg_attrs(struct device *dev, struct scatterlist *sg,
897 		int nents, enum dma_data_direction dir, unsigned long attrs)
898 {
899 	struct pci_p2pdma_pagemap *p2p_pgmap =
900 		to_p2p_pgmap(sg_page(sg)->pgmap);
901 	enum pci_p2pdma_map_type map_type;
902 	struct pci_dev *client;
903 
904 	if (WARN_ON_ONCE(!dev_is_pci(dev)))
905 		return;
906 
907 	client = to_pci_dev(dev);
908 
909 	map_type = pci_p2pdma_map_type(p2p_pgmap->provider, client);
910 
911 	if (map_type == PCI_P2PDMA_MAP_THRU_HOST_BRIDGE)
912 		dma_unmap_sg_attrs(dev, sg, nents, dir, attrs);
913 }
914 EXPORT_SYMBOL_GPL(pci_p2pdma_unmap_sg_attrs);
915 
916 /**
917  * pci_p2pdma_enable_store - parse a configfs/sysfs attribute store
918  *		to enable p2pdma
919  * @page: contents of the value to be stored
920  * @p2p_dev: returns the PCI device that was selected to be used
921  *		(if one was specified in the stored value)
922  * @use_p2pdma: returns whether to enable p2pdma or not
923  *
924  * Parses an attribute value to decide whether to enable p2pdma.
925  * The value can select a PCI device (using its full BDF device
926  * name) or a boolean (in any format strtobool() accepts). A false
927  * value disables p2pdma, a true value expects the caller
928  * to automatically find a compatible device and specifying a PCI device
929  * expects the caller to use the specific provider.
930  *
931  * pci_p2pdma_enable_show() should be used as the show operation for
932  * the attribute.
933  *
934  * Returns 0 on success
935  */
936 int pci_p2pdma_enable_store(const char *page, struct pci_dev **p2p_dev,
937 			    bool *use_p2pdma)
938 {
939 	struct device *dev;
940 
941 	dev = bus_find_device_by_name(&pci_bus_type, NULL, page);
942 	if (dev) {
943 		*use_p2pdma = true;
944 		*p2p_dev = to_pci_dev(dev);
945 
946 		if (!pci_has_p2pmem(*p2p_dev)) {
947 			pci_err(*p2p_dev,
948 				"PCI device has no peer-to-peer memory: %s\n",
949 				page);
950 			pci_dev_put(*p2p_dev);
951 			return -ENODEV;
952 		}
953 
954 		return 0;
955 	} else if ((page[0] == '0' || page[0] == '1') && !iscntrl(page[1])) {
956 		/*
957 		 * If the user enters a PCI device that  doesn't exist
958 		 * like "0000:01:00.1", we don't want strtobool to think
959 		 * it's a '0' when it's clearly not what the user wanted.
960 		 * So we require 0's and 1's to be exactly one character.
961 		 */
962 	} else if (!strtobool(page, use_p2pdma)) {
963 		return 0;
964 	}
965 
966 	pr_err("No such PCI device: %.*s\n", (int)strcspn(page, "\n"), page);
967 	return -ENODEV;
968 }
969 EXPORT_SYMBOL_GPL(pci_p2pdma_enable_store);
970 
971 /**
972  * pci_p2pdma_enable_show - show a configfs/sysfs attribute indicating
973  *		whether p2pdma is enabled
974  * @page: contents of the stored value
975  * @p2p_dev: the selected p2p device (NULL if no device is selected)
976  * @use_p2pdma: whether p2pdma has been enabled
977  *
978  * Attributes that use pci_p2pdma_enable_store() should use this function
979  * to show the value of the attribute.
980  *
981  * Returns 0 on success
982  */
983 ssize_t pci_p2pdma_enable_show(char *page, struct pci_dev *p2p_dev,
984 			       bool use_p2pdma)
985 {
986 	if (!use_p2pdma)
987 		return sprintf(page, "0\n");
988 
989 	if (!p2p_dev)
990 		return sprintf(page, "1\n");
991 
992 	return sprintf(page, "%s\n", pci_name(p2p_dev));
993 }
994 EXPORT_SYMBOL_GPL(pci_p2pdma_enable_show);
995