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 | ||
915b4d11 | 130 | 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 | 140 | master->unique_len = strlen(master->unique); |
8410ea3b | 141 | return 0; |
8410ea3b | 142 | } |
915b4d11 | 143 | EXPORT_SYMBOL(drm_pci_set_busid); |
8410ea3b | 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; | |
1e444be0 | 152 | master->unique = kmalloc(master->unique_len + 1, GFP_KERNEL); |
8410ea3b DA |
153 | if (!master->unique) { |
154 | ret = -ENOMEM; | |
155 | goto err; | |
156 | } | |
157 | ||
158 | if (copy_from_user(master->unique, u->unique, master->unique_len)) { | |
159 | ret = -EFAULT; | |
160 | goto err; | |
161 | } | |
162 | ||
163 | master->unique[master->unique_len] = '\0'; | |
164 | ||
8410ea3b DA |
165 | /* Return error if the busid submitted doesn't match the device's actual |
166 | * busid. | |
167 | */ | |
168 | ret = sscanf(master->unique, "PCI:%d:%d:%d", &bus, &slot, &func); | |
169 | if (ret != 3) { | |
170 | ret = -EINVAL; | |
171 | goto err; | |
172 | } | |
173 | ||
174 | domain = bus >> 8; | |
175 | bus &= 0xff; | |
176 | ||
177 | if ((domain != drm_get_pci_domain(dev)) || | |
178 | (bus != dev->pdev->bus->number) || | |
179 | (slot != PCI_SLOT(dev->pdev->devfn)) || | |
180 | (func != PCI_FUNC(dev->pdev->devfn))) { | |
181 | ret = -EINVAL; | |
182 | goto err; | |
183 | } | |
184 | return 0; | |
185 | err: | |
186 | return ret; | |
187 | } | |
188 | ||
45e97ab6 | 189 | static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p) |
8410ea3b DA |
190 | { |
191 | if ((p->busnum >> 8) != drm_get_pci_domain(dev) || | |
192 | (p->busnum & 0xff) != dev->pdev->bus->number || | |
193 | p->devnum != PCI_SLOT(dev->pdev->devfn) || p->funcnum != PCI_FUNC(dev->pdev->devfn)) | |
194 | return -EINVAL; | |
195 | ||
196 | p->irq = dev->pdev->irq; | |
197 | ||
198 | DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum, | |
199 | p->irq); | |
200 | return 0; | |
201 | } | |
202 | ||
eaaf8f0f | 203 | /** |
c6a1af8a TR |
204 | * drm_irq_by_busid - Get interrupt from bus ID |
205 | * @dev: DRM device | |
206 | * @data: IOCTL parameter pointing to a drm_irq_busid structure | |
207 | * @file_priv: DRM file private. | |
eaaf8f0f DV |
208 | * |
209 | * Finds the PCI device with the specified bus id and gets its IRQ number. | |
210 | * This IOCTL is deprecated, and will now return EINVAL for any busid not equal | |
211 | * to that of the device that this DRM instance attached to. | |
c6a1af8a TR |
212 | * |
213 | * Return: 0 on success or a negative error code on failure. | |
eaaf8f0f DV |
214 | */ |
215 | int drm_irq_by_busid(struct drm_device *dev, void *data, | |
216 | struct drm_file *file_priv) | |
217 | { | |
218 | struct drm_irq_busid *p = data; | |
219 | ||
220 | if (drm_core_check_feature(dev, DRIVER_MODESET)) | |
221 | return -EINVAL; | |
222 | ||
223 | /* UMS was only ever support on PCI devices. */ | |
224 | if (WARN_ON(!dev->pdev)) | |
225 | return -EINVAL; | |
226 | ||
227 | if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ)) | |
228 | return -EINVAL; | |
229 | ||
230 | return drm_pci_irq_by_busid(dev, p); | |
231 | } | |
232 | ||
8da79ccd | 233 | static void drm_pci_agp_init(struct drm_device *dev) |
8410ea3b | 234 | { |
d9906753 | 235 | if (drm_core_check_feature(dev, DRIVER_USE_AGP)) { |
8410ea3b DA |
236 | if (drm_pci_device_is_agp(dev)) |
237 | dev->agp = drm_agp_init(dev); | |
28185647 DV |
238 | if (dev->agp) { |
239 | dev->agp->agp_mtrr = arch_phys_wc_add( | |
240 | dev->agp->agp_info.aper_base, | |
241 | dev->agp->agp_info.aper_size * | |
242 | 1024 * 1024); | |
8410ea3b DA |
243 | } |
244 | } | |
8410ea3b DA |
245 | } |
246 | ||
4efafebe | 247 | void drm_pci_agp_destroy(struct drm_device *dev) |
28ec711c | 248 | { |
d9906753 | 249 | if (dev->agp) { |
28185647 | 250 | arch_phys_wc_del(dev->agp->agp_mtrr); |
28ec711c | 251 | drm_agp_clear(dev); |
d6e4b28b | 252 | kfree(dev->agp); |
28ec711c DH |
253 | dev->agp = NULL; |
254 | } | |
255 | } | |
256 | ||
dcdb1674 | 257 | /** |
c6a1af8a TR |
258 | * drm_get_pci_dev - Register a PCI device with the DRM subsystem |
259 | * @pdev: PCI device | |
260 | * @ent: entry from the PCI ID table that matches @pdev | |
261 | * @driver: DRM device driver | |
dcdb1674 JC |
262 | * |
263 | * Attempt to gets inter module "drm" information. If we are first | |
264 | * then register the character device and inter module information. | |
265 | * Try and register, if we fail to register, backout previous work. | |
c6a1af8a TR |
266 | * |
267 | * Return: 0 on success or a negative error code on failure. | |
dcdb1674 JC |
268 | */ |
269 | int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent, | |
270 | struct drm_driver *driver) | |
271 | { | |
272 | struct drm_device *dev; | |
273 | int ret; | |
274 | ||
275 | DRM_DEBUG("\n"); | |
276 | ||
1bb72532 | 277 | dev = drm_dev_alloc(driver, &pdev->dev); |
dcdb1674 JC |
278 | if (!dev) |
279 | return -ENOMEM; | |
280 | ||
281 | ret = pci_enable_device(pdev); | |
282 | if (ret) | |
c22f0ace | 283 | goto err_free; |
dcdb1674 | 284 | |
dcdb1674 | 285 | dev->pdev = pdev; |
dcdb1674 JC |
286 | #ifdef __alpha__ |
287 | dev->hose = pdev->sysdata; | |
288 | #endif | |
289 | ||
c22f0ace | 290 | if (drm_core_check_feature(dev, DRIVER_MODESET)) |
dcdb1674 | 291 | pci_set_drvdata(pdev, dev); |
1793126f | 292 | |
2c695fa0 | 293 | drm_pci_agp_init(dev); |
2c695fa0 | 294 | |
c22f0ace DH |
295 | ret = drm_dev_register(dev, ent->driver_data); |
296 | if (ret) | |
2c695fa0 | 297 | goto err_agp; |
dcdb1674 JC |
298 | |
299 | DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d\n", | |
300 | driver->name, driver->major, driver->minor, driver->patchlevel, | |
301 | driver->date, pci_name(pdev), dev->primary->index); | |
302 | ||
b3f2333d DV |
303 | /* No locking needed since shadow-attach is single-threaded since it may |
304 | * only be called from the per-driver module init hook. */ | |
305 | if (!drm_core_check_feature(dev, DRIVER_MODESET)) | |
306 | list_add_tail(&dev->legacy_dev_list, &driver->legacy_dev_list); | |
307 | ||
dcdb1674 JC |
308 | return 0; |
309 | ||
2c695fa0 | 310 | err_agp: |
2c695fa0 | 311 | drm_pci_agp_destroy(dev); |
dcdb1674 | 312 | pci_disable_device(pdev); |
c22f0ace | 313 | err_free: |
099d1c29 | 314 | drm_dev_unref(dev); |
dcdb1674 JC |
315 | return ret; |
316 | } | |
317 | EXPORT_SYMBOL(drm_get_pci_dev); | |
318 | ||
319 | /** | |
c6a1af8a TR |
320 | * drm_pci_init - Register matching PCI devices with the DRM subsystem |
321 | * @driver: DRM device driver | |
322 | * @pdriver: PCI device driver | |
dcdb1674 | 323 | * |
c6a1af8a TR |
324 | * Initializes a drm_device structures, registering the stubs and initializing |
325 | * the AGP device. | |
dcdb1674 | 326 | * |
c6a1af8a | 327 | * Return: 0 on success or a negative error code on failure. |
dcdb1674 | 328 | */ |
8410ea3b | 329 | int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver) |
dcdb1674 JC |
330 | { |
331 | struct pci_dev *pdev = NULL; | |
332 | const struct pci_device_id *pid; | |
333 | int i; | |
334 | ||
8410ea3b DA |
335 | DRM_DEBUG("\n"); |
336 | ||
dcdb1674 | 337 | if (driver->driver_features & DRIVER_MODESET) |
8410ea3b | 338 | return pci_register_driver(pdriver); |
dcdb1674 JC |
339 | |
340 | /* If not using KMS, fall back to stealth mode manual scanning. */ | |
b3f2333d | 341 | INIT_LIST_HEAD(&driver->legacy_dev_list); |
8410ea3b DA |
342 | for (i = 0; pdriver->id_table[i].vendor != 0; i++) { |
343 | pid = &pdriver->id_table[i]; | |
dcdb1674 JC |
344 | |
345 | /* Loop around setting up a DRM device for each PCI device | |
346 | * matching our ID and device class. If we had the internal | |
347 | * function that pci_get_subsys and pci_get_class used, we'd | |
348 | * be able to just pass pid in instead of doing a two-stage | |
349 | * thing. | |
350 | */ | |
351 | pdev = NULL; | |
352 | while ((pdev = | |
353 | pci_get_subsys(pid->vendor, pid->device, pid->subvendor, | |
354 | pid->subdevice, pdev)) != NULL) { | |
355 | if ((pdev->class & pid->class_mask) != pid->class) | |
356 | continue; | |
357 | ||
358 | /* stealth mode requires a manual probe */ | |
359 | pci_dev_get(pdev); | |
360 | drm_get_pci_dev(pdev, pid, driver); | |
361 | } | |
362 | } | |
363 | return 0; | |
364 | } | |
365 | ||
f4297784 DA |
366 | int drm_pcie_get_speed_cap_mask(struct drm_device *dev, u32 *mask) |
367 | { | |
368 | struct pci_dev *root; | |
dd66cc2e | 369 | u32 lnkcap, lnkcap2; |
f4297784 DA |
370 | |
371 | *mask = 0; | |
372 | if (!dev->pdev) | |
373 | return -EINVAL; | |
374 | ||
f4297784 DA |
375 | root = dev->pdev->bus->self; |
376 | ||
f4297784 DA |
377 | /* we've been informed via and serverworks don't make the cut */ |
378 | if (root->vendor == PCI_VENDOR_ID_VIA || | |
379 | root->vendor == PCI_VENDOR_ID_SERVERWORKS) | |
380 | return -EINVAL; | |
381 | ||
dd66cc2e BH |
382 | pcie_capability_read_dword(root, PCI_EXP_LNKCAP, &lnkcap); |
383 | pcie_capability_read_dword(root, PCI_EXP_LNKCAP2, &lnkcap2); | |
f4297784 | 384 | |
dd66cc2e | 385 | if (lnkcap2) { /* PCIe r3.0-compliant */ |
f4297784 DA |
386 | if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_2_5GB) |
387 | *mask |= DRM_PCIE_SPEED_25; | |
388 | if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_5_0GB) | |
389 | *mask |= DRM_PCIE_SPEED_50; | |
390 | if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_8_0GB) | |
391 | *mask |= DRM_PCIE_SPEED_80; | |
dd66cc2e | 392 | } else { /* pre-r3.0 */ |
9fe0423e | 393 | if (lnkcap & PCI_EXP_LNKCAP_SLS_2_5GB) |
f4297784 | 394 | *mask |= DRM_PCIE_SPEED_25; |
9fe0423e | 395 | if (lnkcap & PCI_EXP_LNKCAP_SLS_5_0GB) |
f8acf6f4 | 396 | *mask |= (DRM_PCIE_SPEED_25 | DRM_PCIE_SPEED_50); |
f4297784 DA |
397 | } |
398 | ||
399 | DRM_INFO("probing gen 2 caps for device %x:%x = %x/%x\n", root->vendor, root->device, lnkcap, lnkcap2); | |
400 | return 0; | |
401 | } | |
402 | EXPORT_SYMBOL(drm_pcie_get_speed_cap_mask); | |
93711d8b BH |
403 | |
404 | #else | |
405 | ||
406 | int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver) | |
407 | { | |
408 | return -1; | |
409 | } | |
410 | ||
4efafebe | 411 | void drm_pci_agp_destroy(struct drm_device *dev) {} |
eaaf8f0f DV |
412 | |
413 | int drm_irq_by_busid(struct drm_device *dev, void *data, | |
414 | struct drm_file *file_priv) | |
415 | { | |
416 | return -EINVAL; | |
417 | } | |
53bf2a2b DV |
418 | |
419 | int drm_pci_set_unique(struct drm_device *dev, | |
420 | struct drm_master *master, | |
421 | struct drm_unique *u) | |
422 | { | |
423 | return -EINVAL; | |
424 | } | |
93711d8b BH |
425 | #endif |
426 | ||
427 | EXPORT_SYMBOL(drm_pci_init); | |
428 | ||
c6a1af8a TR |
429 | /** |
430 | * drm_pci_exit - Unregister matching PCI devices from the DRM subsystem | |
431 | * @driver: DRM device driver | |
432 | * @pdriver: PCI device driver | |
433 | * | |
434 | * Unregisters one or more devices matched by a PCI driver from the DRM | |
435 | * subsystem. | |
436 | */ | |
93711d8b BH |
437 | void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver) |
438 | { | |
439 | struct drm_device *dev, *tmp; | |
440 | DRM_DEBUG("\n"); | |
441 | ||
442 | if (driver->driver_features & DRIVER_MODESET) { | |
443 | pci_unregister_driver(pdriver); | |
444 | } else { | |
b3f2333d DV |
445 | list_for_each_entry_safe(dev, tmp, &driver->legacy_dev_list, |
446 | legacy_dev_list) { | |
b3f2333d | 447 | list_del(&dev->legacy_dev_list); |
c94adc4a | 448 | drm_put_dev(dev); |
b3f2333d | 449 | } |
93711d8b BH |
450 | } |
451 | DRM_INFO("Module unloaded\n"); | |
452 | } | |
453 | EXPORT_SYMBOL(drm_pci_exit); |