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