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