xref: /openbmc/linux/drivers/gpu/drm/drm_pci.c (revision c819e2cf)
1 /*
2  * Copyright 2003 José Fonseca.
3  * Copyright 2003 Leif Delgass.
4  * All Rights Reserved.
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining a
7  * copy of this software and associated documentation files (the "Software"),
8  * to deal in the Software without restriction, including without limitation
9  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
10  * and/or sell copies of the Software, and to permit persons to whom the
11  * Software is furnished to do so, subject to the following conditions:
12  *
13  * The above copyright notice and this permission notice (including the next
14  * paragraph) shall be included in all copies or substantial portions of the
15  * Software.
16  *
17  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL THE
20  * AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
21  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
22  * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
23  */
24 
25 #include <linux/pci.h>
26 #include <linux/slab.h>
27 #include <linux/dma-mapping.h>
28 #include <linux/export.h>
29 #include <drm/drmP.h>
30 #include "drm_legacy.h"
31 
32 /**
33  * drm_pci_alloc - Allocate a PCI consistent memory block, for DMA.
34  * @dev: DRM device
35  * @size: size of block to allocate
36  * @align: alignment of block
37  *
38  * Return: A handle to the allocated memory block on success or NULL on
39  * failure.
40  */
41 drm_dma_handle_t *drm_pci_alloc(struct drm_device * dev, size_t size, size_t align)
42 {
43 	drm_dma_handle_t *dmah;
44 	unsigned long addr;
45 	size_t sz;
46 
47 	/* pci_alloc_consistent only guarantees alignment to the smallest
48 	 * PAGE_SIZE order which is greater than or equal to the requested size.
49 	 * Return NULL here for now to make sure nobody tries for larger alignment
50 	 */
51 	if (align > size)
52 		return NULL;
53 
54 	dmah = kmalloc(sizeof(drm_dma_handle_t), GFP_KERNEL);
55 	if (!dmah)
56 		return NULL;
57 
58 	dmah->size = size;
59 	dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size, &dmah->busaddr, GFP_KERNEL | __GFP_COMP);
60 
61 	if (dmah->vaddr == NULL) {
62 		kfree(dmah);
63 		return NULL;
64 	}
65 
66 	memset(dmah->vaddr, 0, size);
67 
68 	/* XXX - Is virt_to_page() legal for consistent mem? */
69 	/* Reserve */
70 	for (addr = (unsigned long)dmah->vaddr, sz = size;
71 	     sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) {
72 		SetPageReserved(virt_to_page((void *)addr));
73 	}
74 
75 	return dmah;
76 }
77 
78 EXPORT_SYMBOL(drm_pci_alloc);
79 
80 /*
81  * Free a PCI consistent memory block without freeing its descriptor.
82  *
83  * This function is for internal use in the Linux-specific DRM core code.
84  */
85 void __drm_legacy_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
86 {
87 	unsigned long addr;
88 	size_t sz;
89 
90 	if (dmah->vaddr) {
91 		/* XXX - Is virt_to_page() legal for consistent mem? */
92 		/* Unreserve */
93 		for (addr = (unsigned long)dmah->vaddr, sz = dmah->size;
94 		     sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) {
95 			ClearPageReserved(virt_to_page((void *)addr));
96 		}
97 		dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr,
98 				  dmah->busaddr);
99 	}
100 }
101 
102 /**
103  * drm_pci_free - Free a PCI consistent memory block
104  * @dev: DRM device
105  * @dmah: handle to memory block
106  */
107 void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
108 {
109 	__drm_legacy_pci_free(dev, dmah);
110 	kfree(dmah);
111 }
112 
113 EXPORT_SYMBOL(drm_pci_free);
114 
115 #ifdef CONFIG_PCI
116 
117 static int drm_get_pci_domain(struct drm_device *dev)
118 {
119 #ifndef __alpha__
120 	/* For historical reasons, drm_get_pci_domain() is busticated
121 	 * on most archs and has to remain so for userspace interface
122 	 * < 1.4, except on alpha which was right from the beginning
123 	 */
124 	if (dev->if_version < 0x10004)
125 		return 0;
126 #endif /* __alpha__ */
127 
128 	return pci_domain_nr(dev->pdev->bus);
129 }
130 
131 int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master)
132 {
133 	master->unique = kasprintf(GFP_KERNEL, "pci:%04x:%02x:%02x.%d",
134 					drm_get_pci_domain(dev),
135 					dev->pdev->bus->number,
136 					PCI_SLOT(dev->pdev->devfn),
137 					PCI_FUNC(dev->pdev->devfn));
138 	if (!master->unique)
139 		return -ENOMEM;
140 
141 	master->unique_len = strlen(master->unique);
142 	return 0;
143 }
144 EXPORT_SYMBOL(drm_pci_set_busid);
145 
146 int drm_pci_set_unique(struct drm_device *dev,
147 		       struct drm_master *master,
148 		       struct drm_unique *u)
149 {
150 	int domain, bus, slot, func, ret;
151 
152 	master->unique_len = u->unique_len;
153 	master->unique = kmalloc(master->unique_len + 1, GFP_KERNEL);
154 	if (!master->unique) {
155 		ret = -ENOMEM;
156 		goto err;
157 	}
158 
159 	if (copy_from_user(master->unique, u->unique, master->unique_len)) {
160 		ret = -EFAULT;
161 		goto err;
162 	}
163 
164 	master->unique[master->unique_len] = '\0';
165 
166 	/* Return error if the busid submitted doesn't match the device's actual
167 	 * busid.
168 	 */
169 	ret = sscanf(master->unique, "PCI:%d:%d:%d", &bus, &slot, &func);
170 	if (ret != 3) {
171 		ret = -EINVAL;
172 		goto err;
173 	}
174 
175 	domain = bus >> 8;
176 	bus &= 0xff;
177 
178 	if ((domain != drm_get_pci_domain(dev)) ||
179 	    (bus != dev->pdev->bus->number) ||
180 	    (slot != PCI_SLOT(dev->pdev->devfn)) ||
181 	    (func != PCI_FUNC(dev->pdev->devfn))) {
182 		ret = -EINVAL;
183 		goto err;
184 	}
185 	return 0;
186 err:
187 	return ret;
188 }
189 
190 static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p)
191 {
192 	if ((p->busnum >> 8) != drm_get_pci_domain(dev) ||
193 	    (p->busnum & 0xff) != dev->pdev->bus->number ||
194 	    p->devnum != PCI_SLOT(dev->pdev->devfn) || p->funcnum != PCI_FUNC(dev->pdev->devfn))
195 		return -EINVAL;
196 
197 	p->irq = dev->pdev->irq;
198 
199 	DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum,
200 		  p->irq);
201 	return 0;
202 }
203 
204 /**
205  * drm_irq_by_busid - Get interrupt from bus ID
206  * @dev: DRM device
207  * @data: IOCTL parameter pointing to a drm_irq_busid structure
208  * @file_priv: DRM file private.
209  *
210  * Finds the PCI device with the specified bus id and gets its IRQ number.
211  * This IOCTL is deprecated, and will now return EINVAL for any busid not equal
212  * to that of the device that this DRM instance attached to.
213  *
214  * Return: 0 on success or a negative error code on failure.
215  */
216 int drm_irq_by_busid(struct drm_device *dev, void *data,
217 		     struct drm_file *file_priv)
218 {
219 	struct drm_irq_busid *p = data;
220 
221 	if (drm_core_check_feature(dev, DRIVER_MODESET))
222 		return -EINVAL;
223 
224 	/* UMS was only ever support on PCI devices. */
225 	if (WARN_ON(!dev->pdev))
226 		return -EINVAL;
227 
228 	if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
229 		return -EINVAL;
230 
231 	return drm_pci_irq_by_busid(dev, p);
232 }
233 
234 static void drm_pci_agp_init(struct drm_device *dev)
235 {
236 	if (drm_core_check_feature(dev, DRIVER_USE_AGP)) {
237 		if (drm_pci_device_is_agp(dev))
238 			dev->agp = drm_agp_init(dev);
239 		if (dev->agp) {
240 			dev->agp->agp_mtrr = arch_phys_wc_add(
241 				dev->agp->agp_info.aper_base,
242 				dev->agp->agp_info.aper_size *
243 				1024 * 1024);
244 		}
245 	}
246 }
247 
248 void drm_pci_agp_destroy(struct drm_device *dev)
249 {
250 	if (dev->agp) {
251 		arch_phys_wc_del(dev->agp->agp_mtrr);
252 		drm_agp_clear(dev);
253 		kfree(dev->agp);
254 		dev->agp = NULL;
255 	}
256 }
257 
258 /**
259  * drm_get_pci_dev - Register a PCI device with the DRM subsystem
260  * @pdev: PCI device
261  * @ent: entry from the PCI ID table that matches @pdev
262  * @driver: DRM device driver
263  *
264  * Attempt to gets inter module "drm" information. If we are first
265  * then register the character device and inter module information.
266  * Try and register, if we fail to register, backout previous work.
267  *
268  * Return: 0 on success or a negative error code on failure.
269  */
270 int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent,
271 		    struct drm_driver *driver)
272 {
273 	struct drm_device *dev;
274 	int ret;
275 
276 	DRM_DEBUG("\n");
277 
278 	dev = drm_dev_alloc(driver, &pdev->dev);
279 	if (!dev)
280 		return -ENOMEM;
281 
282 	ret = pci_enable_device(pdev);
283 	if (ret)
284 		goto err_free;
285 
286 	dev->pdev = pdev;
287 #ifdef __alpha__
288 	dev->hose = pdev->sysdata;
289 #endif
290 
291 	if (drm_core_check_feature(dev, DRIVER_MODESET))
292 		pci_set_drvdata(pdev, dev);
293 
294 	drm_pci_agp_init(dev);
295 
296 	ret = drm_dev_register(dev, ent->driver_data);
297 	if (ret)
298 		goto err_agp;
299 
300 	DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d\n",
301 		 driver->name, driver->major, driver->minor, driver->patchlevel,
302 		 driver->date, pci_name(pdev), dev->primary->index);
303 
304 	/* No locking needed since shadow-attach is single-threaded since it may
305 	 * only be called from the per-driver module init hook. */
306 	if (!drm_core_check_feature(dev, DRIVER_MODESET))
307 		list_add_tail(&dev->legacy_dev_list, &driver->legacy_dev_list);
308 
309 	return 0;
310 
311 err_agp:
312 	drm_pci_agp_destroy(dev);
313 	pci_disable_device(pdev);
314 err_free:
315 	drm_dev_unref(dev);
316 	return ret;
317 }
318 EXPORT_SYMBOL(drm_get_pci_dev);
319 
320 /**
321  * drm_pci_init - Register matching PCI devices with the DRM subsystem
322  * @driver: DRM device driver
323  * @pdriver: PCI device driver
324  *
325  * Initializes a drm_device structures, registering the stubs and initializing
326  * the AGP device.
327  *
328  * Return: 0 on success or a negative error code on failure.
329  */
330 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
331 {
332 	struct pci_dev *pdev = NULL;
333 	const struct pci_device_id *pid;
334 	int i;
335 
336 	DRM_DEBUG("\n");
337 
338 	if (driver->driver_features & DRIVER_MODESET)
339 		return pci_register_driver(pdriver);
340 
341 	/* If not using KMS, fall back to stealth mode manual scanning. */
342 	INIT_LIST_HEAD(&driver->legacy_dev_list);
343 	for (i = 0; pdriver->id_table[i].vendor != 0; i++) {
344 		pid = &pdriver->id_table[i];
345 
346 		/* Loop around setting up a DRM device for each PCI device
347 		 * matching our ID and device class.  If we had the internal
348 		 * function that pci_get_subsys and pci_get_class used, we'd
349 		 * be able to just pass pid in instead of doing a two-stage
350 		 * thing.
351 		 */
352 		pdev = NULL;
353 		while ((pdev =
354 			pci_get_subsys(pid->vendor, pid->device, pid->subvendor,
355 				       pid->subdevice, pdev)) != NULL) {
356 			if ((pdev->class & pid->class_mask) != pid->class)
357 				continue;
358 
359 			/* stealth mode requires a manual probe */
360 			pci_dev_get(pdev);
361 			drm_get_pci_dev(pdev, pid, driver);
362 		}
363 	}
364 	return 0;
365 }
366 
367 int drm_pcie_get_speed_cap_mask(struct drm_device *dev, u32 *mask)
368 {
369 	struct pci_dev *root;
370 	u32 lnkcap, lnkcap2;
371 
372 	*mask = 0;
373 	if (!dev->pdev)
374 		return -EINVAL;
375 
376 	root = dev->pdev->bus->self;
377 
378 	/* we've been informed via and serverworks don't make the cut */
379 	if (root->vendor == PCI_VENDOR_ID_VIA ||
380 	    root->vendor == PCI_VENDOR_ID_SERVERWORKS)
381 		return -EINVAL;
382 
383 	pcie_capability_read_dword(root, PCI_EXP_LNKCAP, &lnkcap);
384 	pcie_capability_read_dword(root, PCI_EXP_LNKCAP2, &lnkcap2);
385 
386 	if (lnkcap2) {	/* PCIe r3.0-compliant */
387 		if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_2_5GB)
388 			*mask |= DRM_PCIE_SPEED_25;
389 		if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_5_0GB)
390 			*mask |= DRM_PCIE_SPEED_50;
391 		if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_8_0GB)
392 			*mask |= DRM_PCIE_SPEED_80;
393 	} else {	/* pre-r3.0 */
394 		if (lnkcap & PCI_EXP_LNKCAP_SLS_2_5GB)
395 			*mask |= DRM_PCIE_SPEED_25;
396 		if (lnkcap & PCI_EXP_LNKCAP_SLS_5_0GB)
397 			*mask |= (DRM_PCIE_SPEED_25 | DRM_PCIE_SPEED_50);
398 	}
399 
400 	DRM_INFO("probing gen 2 caps for device %x:%x = %x/%x\n", root->vendor, root->device, lnkcap, lnkcap2);
401 	return 0;
402 }
403 EXPORT_SYMBOL(drm_pcie_get_speed_cap_mask);
404 
405 #else
406 
407 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
408 {
409 	return -1;
410 }
411 
412 void drm_pci_agp_destroy(struct drm_device *dev) {}
413 
414 int drm_irq_by_busid(struct drm_device *dev, void *data,
415 		     struct drm_file *file_priv)
416 {
417 	return -EINVAL;
418 }
419 
420 int drm_pci_set_unique(struct drm_device *dev,
421 		       struct drm_master *master,
422 		       struct drm_unique *u)
423 {
424 	return -EINVAL;
425 }
426 #endif
427 
428 EXPORT_SYMBOL(drm_pci_init);
429 
430 /**
431  * drm_pci_exit - Unregister matching PCI devices from the DRM subsystem
432  * @driver: DRM device driver
433  * @pdriver: PCI device driver
434  *
435  * Unregisters one or more devices matched by a PCI driver from the DRM
436  * subsystem.
437  */
438 void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver)
439 {
440 	struct drm_device *dev, *tmp;
441 	DRM_DEBUG("\n");
442 
443 	if (driver->driver_features & DRIVER_MODESET) {
444 		pci_unregister_driver(pdriver);
445 	} else {
446 		list_for_each_entry_safe(dev, tmp, &driver->legacy_dev_list,
447 					 legacy_dev_list) {
448 			list_del(&dev->legacy_dev_list);
449 			drm_put_dev(dev);
450 		}
451 	}
452 	DRM_INFO("Module unloaded\n");
453 }
454 EXPORT_SYMBOL(drm_pci_exit);
455