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 | 131 | { |
d0a39164 DH |
132 | master->unique = kasprintf(GFP_KERNEL, "pci:%04x:%02x:%02x.%d", |
133 | drm_get_pci_domain(dev), | |
134 | dev->pdev->bus->number, | |
135 | PCI_SLOT(dev->pdev->devfn), | |
136 | PCI_FUNC(dev->pdev->devfn)); | |
137 | if (!master->unique) | |
8410ea3b DA |
138 | return -ENOMEM; |
139 | ||
d0a39164 DH |
140 | master->unique_len = strlen(master->unique); |
141 | master->unique_size = master->unique_len + 1; | |
8410ea3b | 142 | return 0; |
8410ea3b DA |
143 | } |
144 | ||
53bf2a2b DV |
145 | int drm_pci_set_unique(struct drm_device *dev, |
146 | struct drm_master *master, | |
147 | struct drm_unique *u) | |
8410ea3b DA |
148 | { |
149 | int domain, bus, slot, func, ret; | |
8410ea3b DA |
150 | |
151 | master->unique_len = u->unique_len; | |
152 | master->unique_size = u->unique_len + 1; | |
153 | master->unique = kmalloc(master->unique_size, 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 | ||
8410ea3b DA |
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 | ||
45e97ab6 | 190 | static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p) |
8410ea3b DA |
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 | ||
eaaf8f0f | 204 | /** |
c6a1af8a TR |
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. | |
eaaf8f0f DV |
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. | |
c6a1af8a TR |
213 | * |
214 | * Return: 0 on success or a negative error code on failure. | |
eaaf8f0f DV |
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 | ||
8da79ccd | 234 | static void drm_pci_agp_init(struct drm_device *dev) |
8410ea3b | 235 | { |
d9906753 | 236 | if (drm_core_check_feature(dev, DRIVER_USE_AGP)) { |
8410ea3b DA |
237 | if (drm_pci_device_is_agp(dev)) |
238 | dev->agp = drm_agp_init(dev); | |
28185647 DV |
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); | |
8410ea3b DA |
244 | } |
245 | } | |
8410ea3b DA |
246 | } |
247 | ||
4efafebe | 248 | void drm_pci_agp_destroy(struct drm_device *dev) |
28ec711c | 249 | { |
d9906753 | 250 | if (dev->agp) { |
28185647 | 251 | arch_phys_wc_del(dev->agp->agp_mtrr); |
28ec711c | 252 | drm_agp_clear(dev); |
d6e4b28b | 253 | kfree(dev->agp); |
28ec711c DH |
254 | dev->agp = NULL; |
255 | } | |
256 | } | |
257 | ||
8410ea3b | 258 | static struct drm_bus drm_pci_bus = { |
8410ea3b | 259 | .set_busid = drm_pci_set_busid, |
8410ea3b DA |
260 | }; |
261 | ||
dcdb1674 | 262 | /** |
c6a1af8a TR |
263 | * drm_get_pci_dev - Register a PCI device with the DRM subsystem |
264 | * @pdev: PCI device | |
265 | * @ent: entry from the PCI ID table that matches @pdev | |
266 | * @driver: DRM device driver | |
dcdb1674 JC |
267 | * |
268 | * Attempt to gets inter module "drm" information. If we are first | |
269 | * then register the character device and inter module information. | |
270 | * Try and register, if we fail to register, backout previous work. | |
c6a1af8a TR |
271 | * |
272 | * Return: 0 on success or a negative error code on failure. | |
dcdb1674 JC |
273 | */ |
274 | int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent, | |
275 | struct drm_driver *driver) | |
276 | { | |
277 | struct drm_device *dev; | |
278 | int ret; | |
279 | ||
280 | DRM_DEBUG("\n"); | |
281 | ||
1bb72532 | 282 | dev = drm_dev_alloc(driver, &pdev->dev); |
dcdb1674 JC |
283 | if (!dev) |
284 | return -ENOMEM; | |
285 | ||
286 | ret = pci_enable_device(pdev); | |
287 | if (ret) | |
c22f0ace | 288 | goto err_free; |
dcdb1674 | 289 | |
dcdb1674 | 290 | dev->pdev = pdev; |
dcdb1674 JC |
291 | #ifdef __alpha__ |
292 | dev->hose = pdev->sysdata; | |
293 | #endif | |
294 | ||
c22f0ace | 295 | if (drm_core_check_feature(dev, DRIVER_MODESET)) |
dcdb1674 | 296 | pci_set_drvdata(pdev, dev); |
1793126f | 297 | |
2c695fa0 | 298 | drm_pci_agp_init(dev); |
2c695fa0 | 299 | |
c22f0ace DH |
300 | ret = drm_dev_register(dev, ent->driver_data); |
301 | if (ret) | |
2c695fa0 | 302 | goto err_agp; |
dcdb1674 JC |
303 | |
304 | DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d\n", | |
305 | driver->name, driver->major, driver->minor, driver->patchlevel, | |
306 | driver->date, pci_name(pdev), dev->primary->index); | |
307 | ||
b3f2333d DV |
308 | /* No locking needed since shadow-attach is single-threaded since it may |
309 | * only be called from the per-driver module init hook. */ | |
310 | if (!drm_core_check_feature(dev, DRIVER_MODESET)) | |
311 | list_add_tail(&dev->legacy_dev_list, &driver->legacy_dev_list); | |
312 | ||
dcdb1674 JC |
313 | return 0; |
314 | ||
2c695fa0 | 315 | err_agp: |
2c695fa0 | 316 | drm_pci_agp_destroy(dev); |
dcdb1674 | 317 | pci_disable_device(pdev); |
c22f0ace | 318 | err_free: |
099d1c29 | 319 | drm_dev_unref(dev); |
dcdb1674 JC |
320 | return ret; |
321 | } | |
322 | EXPORT_SYMBOL(drm_get_pci_dev); | |
323 | ||
324 | /** | |
c6a1af8a TR |
325 | * drm_pci_init - Register matching PCI devices with the DRM subsystem |
326 | * @driver: DRM device driver | |
327 | * @pdriver: PCI device driver | |
dcdb1674 | 328 | * |
c6a1af8a TR |
329 | * Initializes a drm_device structures, registering the stubs and initializing |
330 | * the AGP device. | |
dcdb1674 | 331 | * |
c6a1af8a | 332 | * Return: 0 on success or a negative error code on failure. |
dcdb1674 | 333 | */ |
8410ea3b | 334 | int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver) |
dcdb1674 JC |
335 | { |
336 | struct pci_dev *pdev = NULL; | |
337 | const struct pci_device_id *pid; | |
338 | int i; | |
339 | ||
8410ea3b DA |
340 | DRM_DEBUG("\n"); |
341 | ||
8410ea3b DA |
342 | driver->bus = &drm_pci_bus; |
343 | ||
dcdb1674 | 344 | if (driver->driver_features & DRIVER_MODESET) |
8410ea3b | 345 | return pci_register_driver(pdriver); |
dcdb1674 JC |
346 | |
347 | /* If not using KMS, fall back to stealth mode manual scanning. */ | |
b3f2333d | 348 | INIT_LIST_HEAD(&driver->legacy_dev_list); |
8410ea3b DA |
349 | for (i = 0; pdriver->id_table[i].vendor != 0; i++) { |
350 | pid = &pdriver->id_table[i]; | |
dcdb1674 JC |
351 | |
352 | /* Loop around setting up a DRM device for each PCI device | |
353 | * matching our ID and device class. If we had the internal | |
354 | * function that pci_get_subsys and pci_get_class used, we'd | |
355 | * be able to just pass pid in instead of doing a two-stage | |
356 | * thing. | |
357 | */ | |
358 | pdev = NULL; | |
359 | while ((pdev = | |
360 | pci_get_subsys(pid->vendor, pid->device, pid->subvendor, | |
361 | pid->subdevice, pdev)) != NULL) { | |
362 | if ((pdev->class & pid->class_mask) != pid->class) | |
363 | continue; | |
364 | ||
365 | /* stealth mode requires a manual probe */ | |
366 | pci_dev_get(pdev); | |
367 | drm_get_pci_dev(pdev, pid, driver); | |
368 | } | |
369 | } | |
370 | return 0; | |
371 | } | |
372 | ||
f4297784 DA |
373 | int drm_pcie_get_speed_cap_mask(struct drm_device *dev, u32 *mask) |
374 | { | |
375 | struct pci_dev *root; | |
dd66cc2e | 376 | u32 lnkcap, lnkcap2; |
f4297784 DA |
377 | |
378 | *mask = 0; | |
379 | if (!dev->pdev) | |
380 | return -EINVAL; | |
381 | ||
f4297784 DA |
382 | root = dev->pdev->bus->self; |
383 | ||
f4297784 DA |
384 | /* we've been informed via and serverworks don't make the cut */ |
385 | if (root->vendor == PCI_VENDOR_ID_VIA || | |
386 | root->vendor == PCI_VENDOR_ID_SERVERWORKS) | |
387 | return -EINVAL; | |
388 | ||
dd66cc2e BH |
389 | pcie_capability_read_dword(root, PCI_EXP_LNKCAP, &lnkcap); |
390 | pcie_capability_read_dword(root, PCI_EXP_LNKCAP2, &lnkcap2); | |
f4297784 | 391 | |
dd66cc2e | 392 | if (lnkcap2) { /* PCIe r3.0-compliant */ |
f4297784 DA |
393 | if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_2_5GB) |
394 | *mask |= DRM_PCIE_SPEED_25; | |
395 | if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_5_0GB) | |
396 | *mask |= DRM_PCIE_SPEED_50; | |
397 | if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_8_0GB) | |
398 | *mask |= DRM_PCIE_SPEED_80; | |
dd66cc2e | 399 | } else { /* pre-r3.0 */ |
9fe0423e | 400 | if (lnkcap & PCI_EXP_LNKCAP_SLS_2_5GB) |
f4297784 | 401 | *mask |= DRM_PCIE_SPEED_25; |
9fe0423e | 402 | if (lnkcap & PCI_EXP_LNKCAP_SLS_5_0GB) |
f8acf6f4 | 403 | *mask |= (DRM_PCIE_SPEED_25 | DRM_PCIE_SPEED_50); |
f4297784 DA |
404 | } |
405 | ||
406 | DRM_INFO("probing gen 2 caps for device %x:%x = %x/%x\n", root->vendor, root->device, lnkcap, lnkcap2); | |
407 | return 0; | |
408 | } | |
409 | EXPORT_SYMBOL(drm_pcie_get_speed_cap_mask); | |
93711d8b BH |
410 | |
411 | #else | |
412 | ||
413 | int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver) | |
414 | { | |
415 | return -1; | |
416 | } | |
417 | ||
4efafebe | 418 | void drm_pci_agp_destroy(struct drm_device *dev) {} |
eaaf8f0f DV |
419 | |
420 | int drm_irq_by_busid(struct drm_device *dev, void *data, | |
421 | struct drm_file *file_priv) | |
422 | { | |
423 | return -EINVAL; | |
424 | } | |
53bf2a2b DV |
425 | |
426 | int drm_pci_set_unique(struct drm_device *dev, | |
427 | struct drm_master *master, | |
428 | struct drm_unique *u) | |
429 | { | |
430 | return -EINVAL; | |
431 | } | |
93711d8b BH |
432 | #endif |
433 | ||
434 | EXPORT_SYMBOL(drm_pci_init); | |
435 | ||
c6a1af8a TR |
436 | /** |
437 | * drm_pci_exit - Unregister matching PCI devices from the DRM subsystem | |
438 | * @driver: DRM device driver | |
439 | * @pdriver: PCI device driver | |
440 | * | |
441 | * Unregisters one or more devices matched by a PCI driver from the DRM | |
442 | * subsystem. | |
443 | */ | |
93711d8b BH |
444 | void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver) |
445 | { | |
446 | struct drm_device *dev, *tmp; | |
447 | DRM_DEBUG("\n"); | |
448 | ||
449 | if (driver->driver_features & DRIVER_MODESET) { | |
450 | pci_unregister_driver(pdriver); | |
451 | } else { | |
b3f2333d DV |
452 | list_for_each_entry_safe(dev, tmp, &driver->legacy_dev_list, |
453 | legacy_dev_list) { | |
b3f2333d | 454 | list_del(&dev->legacy_dev_list); |
c94adc4a | 455 | drm_put_dev(dev); |
b3f2333d | 456 | } |
93711d8b BH |
457 | } |
458 | DRM_INFO("Module unloaded\n"); | |
459 | } | |
460 | EXPORT_SYMBOL(drm_pci_exit); |