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