Loading...
1/* drm_pci.h -- PCI DMA memory management wrappers for DRM -*- linux-c -*- */
2/**
3 * \file drm_pci.c
4 * \brief Functions and ioctls to manage PCI memory
5 *
6 * \warning These interfaces aren't stable yet.
7 *
8 * \todo Implement the remaining ioctl's for the PCI pools.
9 * \todo The wrappers here are so thin that they would be better off inlined..
10 *
11 * \author José Fonseca <jrfonseca@tungstengraphics.com>
12 * \author Leif Delgass <ldelgass@retinalburn.net>
13 */
14
15/*
16 * Copyright 2003 José Fonseca.
17 * Copyright 2003 Leif Delgass.
18 * All Rights Reserved.
19 *
20 * Permission is hereby granted, free of charge, to any person obtaining a
21 * copy of this software and associated documentation files (the "Software"),
22 * to deal in the Software without restriction, including without limitation
23 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
24 * and/or sell copies of the Software, and to permit persons to whom the
25 * Software is furnished to do so, subject to the following conditions:
26 *
27 * The above copyright notice and this permission notice (including the next
28 * paragraph) shall be included in all copies or substantial portions of the
29 * Software.
30 *
31 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
32 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
33 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
34 * AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
35 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
36 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
37 */
38
39#include <linux/pci.h>
40#include <linux/slab.h>
41#include <linux/dma-mapping.h>
42#include "drmP.h"
43
44/**********************************************************************/
45/** \name PCI memory */
46/*@{*/
47
48/**
49 * \brief Allocate a PCI consistent memory block, for DMA.
50 */
51drm_dma_handle_t *drm_pci_alloc(struct drm_device * dev, size_t size, size_t align)
52{
53 drm_dma_handle_t *dmah;
54#if 1
55 unsigned long addr;
56 size_t sz;
57#endif
58
59 /* pci_alloc_consistent only guarantees alignment to the smallest
60 * PAGE_SIZE order which is greater than or equal to the requested size.
61 * Return NULL here for now to make sure nobody tries for larger alignment
62 */
63 if (align > size)
64 return NULL;
65
66 dmah = kmalloc(sizeof(drm_dma_handle_t), GFP_KERNEL);
67 if (!dmah)
68 return NULL;
69
70 dmah->size = size;
71 dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size, &dmah->busaddr, GFP_KERNEL | __GFP_COMP);
72
73 if (dmah->vaddr == NULL) {
74 kfree(dmah);
75 return NULL;
76 }
77
78 memset(dmah->vaddr, 0, size);
79
80 /* XXX - Is virt_to_page() legal for consistent mem? */
81 /* Reserve */
82 for (addr = (unsigned long)dmah->vaddr, sz = size;
83 sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) {
84 SetPageReserved(virt_to_page(addr));
85 }
86
87 return dmah;
88}
89
90EXPORT_SYMBOL(drm_pci_alloc);
91
92/**
93 * \brief Free a PCI consistent memory block without freeing its descriptor.
94 *
95 * This function is for internal use in the Linux-specific DRM core code.
96 */
97void __drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
98{
99#if 1
100 unsigned long addr;
101 size_t sz;
102#endif
103
104 if (dmah->vaddr) {
105 /* XXX - Is virt_to_page() legal for consistent mem? */
106 /* Unreserve */
107 for (addr = (unsigned long)dmah->vaddr, sz = dmah->size;
108 sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) {
109 ClearPageReserved(virt_to_page(addr));
110 }
111 dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr,
112 dmah->busaddr);
113 }
114}
115
116/**
117 * \brief Free a PCI consistent memory block
118 */
119void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
120{
121 __drm_pci_free(dev, dmah);
122 kfree(dmah);
123}
124
125EXPORT_SYMBOL(drm_pci_free);
126
127#ifdef CONFIG_PCI
128
129static int drm_get_pci_domain(struct drm_device *dev)
130{
131#ifndef __alpha__
132 /* For historical reasons, drm_get_pci_domain() is busticated
133 * on most archs and has to remain so for userspace interface
134 * < 1.4, except on alpha which was right from the beginning
135 */
136 if (dev->if_version < 0x10004)
137 return 0;
138#endif /* __alpha__ */
139
140 return pci_domain_nr(dev->pdev->bus);
141}
142
143static int drm_pci_get_irq(struct drm_device *dev)
144{
145 return dev->pdev->irq;
146}
147
148static const char *drm_pci_get_name(struct drm_device *dev)
149{
150 struct pci_driver *pdriver = dev->driver->kdriver.pci;
151 return pdriver->name;
152}
153
154int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master)
155{
156 int len, ret;
157 struct pci_driver *pdriver = dev->driver->kdriver.pci;
158 master->unique_len = 40;
159 master->unique_size = master->unique_len;
160 master->unique = kmalloc(master->unique_size, GFP_KERNEL);
161 if (master->unique == NULL)
162 return -ENOMEM;
163
164
165 len = snprintf(master->unique, master->unique_len,
166 "pci:%04x:%02x:%02x.%d",
167 drm_get_pci_domain(dev),
168 dev->pdev->bus->number,
169 PCI_SLOT(dev->pdev->devfn),
170 PCI_FUNC(dev->pdev->devfn));
171
172 if (len >= master->unique_len) {
173 DRM_ERROR("buffer overflow");
174 ret = -EINVAL;
175 goto err;
176 } else
177 master->unique_len = len;
178
179 dev->devname =
180 kmalloc(strlen(pdriver->name) +
181 master->unique_len + 2, GFP_KERNEL);
182
183 if (dev->devname == NULL) {
184 ret = -ENOMEM;
185 goto err;
186 }
187
188 sprintf(dev->devname, "%s@%s", pdriver->name,
189 master->unique);
190
191 return 0;
192err:
193 return ret;
194}
195
196int drm_pci_set_unique(struct drm_device *dev,
197 struct drm_master *master,
198 struct drm_unique *u)
199{
200 int domain, bus, slot, func, ret;
201 const char *bus_name;
202
203 master->unique_len = u->unique_len;
204 master->unique_size = u->unique_len + 1;
205 master->unique = kmalloc(master->unique_size, GFP_KERNEL);
206 if (!master->unique) {
207 ret = -ENOMEM;
208 goto err;
209 }
210
211 if (copy_from_user(master->unique, u->unique, master->unique_len)) {
212 ret = -EFAULT;
213 goto err;
214 }
215
216 master->unique[master->unique_len] = '\0';
217
218 bus_name = dev->driver->bus->get_name(dev);
219 dev->devname = kmalloc(strlen(bus_name) +
220 strlen(master->unique) + 2, GFP_KERNEL);
221 if (!dev->devname) {
222 ret = -ENOMEM;
223 goto err;
224 }
225
226 sprintf(dev->devname, "%s@%s", bus_name,
227 master->unique);
228
229 /* Return error if the busid submitted doesn't match the device's actual
230 * busid.
231 */
232 ret = sscanf(master->unique, "PCI:%d:%d:%d", &bus, &slot, &func);
233 if (ret != 3) {
234 ret = -EINVAL;
235 goto err;
236 }
237
238 domain = bus >> 8;
239 bus &= 0xff;
240
241 if ((domain != drm_get_pci_domain(dev)) ||
242 (bus != dev->pdev->bus->number) ||
243 (slot != PCI_SLOT(dev->pdev->devfn)) ||
244 (func != PCI_FUNC(dev->pdev->devfn))) {
245 ret = -EINVAL;
246 goto err;
247 }
248 return 0;
249err:
250 return ret;
251}
252
253
254static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p)
255{
256 if ((p->busnum >> 8) != drm_get_pci_domain(dev) ||
257 (p->busnum & 0xff) != dev->pdev->bus->number ||
258 p->devnum != PCI_SLOT(dev->pdev->devfn) || p->funcnum != PCI_FUNC(dev->pdev->devfn))
259 return -EINVAL;
260
261 p->irq = dev->pdev->irq;
262
263 DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum,
264 p->irq);
265 return 0;
266}
267
268int drm_pci_agp_init(struct drm_device *dev)
269{
270 if (drm_core_has_AGP(dev)) {
271 if (drm_pci_device_is_agp(dev))
272 dev->agp = drm_agp_init(dev);
273 if (drm_core_check_feature(dev, DRIVER_REQUIRE_AGP)
274 && (dev->agp == NULL)) {
275 DRM_ERROR("Cannot initialize the agpgart module.\n");
276 return -EINVAL;
277 }
278 if (drm_core_has_MTRR(dev)) {
279 if (dev->agp)
280 dev->agp->agp_mtrr =
281 mtrr_add(dev->agp->agp_info.aper_base,
282 dev->agp->agp_info.aper_size *
283 1024 * 1024, MTRR_TYPE_WRCOMB, 1);
284 }
285 }
286 return 0;
287}
288
289static struct drm_bus drm_pci_bus = {
290 .bus_type = DRIVER_BUS_PCI,
291 .get_irq = drm_pci_get_irq,
292 .get_name = drm_pci_get_name,
293 .set_busid = drm_pci_set_busid,
294 .set_unique = drm_pci_set_unique,
295 .irq_by_busid = drm_pci_irq_by_busid,
296 .agp_init = drm_pci_agp_init,
297};
298
299/**
300 * Register.
301 *
302 * \param pdev - PCI device structure
303 * \param ent entry from the PCI ID table with device type flags
304 * \return zero on success or a negative number on failure.
305 *
306 * Attempt to gets inter module "drm" information. If we are first
307 * then register the character device and inter module information.
308 * Try and register, if we fail to register, backout previous work.
309 */
310int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent,
311 struct drm_driver *driver)
312{
313 struct drm_device *dev;
314 int ret;
315
316 DRM_DEBUG("\n");
317
318 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
319 if (!dev)
320 return -ENOMEM;
321
322 ret = pci_enable_device(pdev);
323 if (ret)
324 goto err_g1;
325
326 pci_set_master(pdev);
327
328 dev->pdev = pdev;
329 dev->dev = &pdev->dev;
330
331 dev->pci_device = pdev->device;
332 dev->pci_vendor = pdev->vendor;
333
334#ifdef __alpha__
335 dev->hose = pdev->sysdata;
336#endif
337
338 mutex_lock(&drm_global_mutex);
339
340 if ((ret = drm_fill_in_dev(dev, ent, driver))) {
341 printk(KERN_ERR "DRM: Fill_in_dev failed.\n");
342 goto err_g2;
343 }
344
345 if (drm_core_check_feature(dev, DRIVER_MODESET)) {
346 pci_set_drvdata(pdev, dev);
347 ret = drm_get_minor(dev, &dev->control, DRM_MINOR_CONTROL);
348 if (ret)
349 goto err_g2;
350 }
351
352 if ((ret = drm_get_minor(dev, &dev->primary, DRM_MINOR_LEGACY)))
353 goto err_g3;
354
355 if (dev->driver->load) {
356 ret = dev->driver->load(dev, ent->driver_data);
357 if (ret)
358 goto err_g4;
359 }
360
361 /* setup the grouping for the legacy output */
362 if (drm_core_check_feature(dev, DRIVER_MODESET)) {
363 ret = drm_mode_group_init_legacy_group(dev,
364 &dev->primary->mode_group);
365 if (ret)
366 goto err_g4;
367 }
368
369 list_add_tail(&dev->driver_item, &driver->device_list);
370
371 DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d\n",
372 driver->name, driver->major, driver->minor, driver->patchlevel,
373 driver->date, pci_name(pdev), dev->primary->index);
374
375 mutex_unlock(&drm_global_mutex);
376 return 0;
377
378err_g4:
379 drm_put_minor(&dev->primary);
380err_g3:
381 if (drm_core_check_feature(dev, DRIVER_MODESET))
382 drm_put_minor(&dev->control);
383err_g2:
384 pci_disable_device(pdev);
385err_g1:
386 kfree(dev);
387 mutex_unlock(&drm_global_mutex);
388 return ret;
389}
390EXPORT_SYMBOL(drm_get_pci_dev);
391
392/**
393 * PCI device initialization. Called direct from modules at load time.
394 *
395 * \return zero on success or a negative number on failure.
396 *
397 * Initializes a drm_device structures,registering the
398 * stubs and initializing the AGP device.
399 *
400 * Expands the \c DRIVER_PREINIT and \c DRIVER_POST_INIT macros before and
401 * after the initialization for driver customization.
402 */
403int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
404{
405 struct pci_dev *pdev = NULL;
406 const struct pci_device_id *pid;
407 int i;
408
409 DRM_DEBUG("\n");
410
411 INIT_LIST_HEAD(&driver->device_list);
412 driver->kdriver.pci = pdriver;
413 driver->bus = &drm_pci_bus;
414
415 if (driver->driver_features & DRIVER_MODESET)
416 return pci_register_driver(pdriver);
417
418 /* If not using KMS, fall back to stealth mode manual scanning. */
419 for (i = 0; pdriver->id_table[i].vendor != 0; i++) {
420 pid = &pdriver->id_table[i];
421
422 /* Loop around setting up a DRM device for each PCI device
423 * matching our ID and device class. If we had the internal
424 * function that pci_get_subsys and pci_get_class used, we'd
425 * be able to just pass pid in instead of doing a two-stage
426 * thing.
427 */
428 pdev = NULL;
429 while ((pdev =
430 pci_get_subsys(pid->vendor, pid->device, pid->subvendor,
431 pid->subdevice, pdev)) != NULL) {
432 if ((pdev->class & pid->class_mask) != pid->class)
433 continue;
434
435 /* stealth mode requires a manual probe */
436 pci_dev_get(pdev);
437 drm_get_pci_dev(pdev, pid, driver);
438 }
439 }
440 return 0;
441}
442
443#else
444
445int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
446{
447 return -1;
448}
449
450#endif
451
452EXPORT_SYMBOL(drm_pci_init);
453
454/*@}*/
455void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver)
456{
457 struct drm_device *dev, *tmp;
458 DRM_DEBUG("\n");
459
460 if (driver->driver_features & DRIVER_MODESET) {
461 pci_unregister_driver(pdriver);
462 } else {
463 list_for_each_entry_safe(dev, tmp, &driver->device_list, driver_item)
464 drm_put_dev(dev);
465 }
466 DRM_INFO("Module unloaded\n");
467}
468EXPORT_SYMBOL(drm_pci_exit);
1/*
2 * Copyright 2003 José Fonseca.
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>
26#include <linux/slab.h>
27#include <linux/dma-mapping.h>
28#include <linux/export.h>
29#include <drm/drmP.h>
30#include "drm_internal.h"
31#include "drm_legacy.h"
32
33/**
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.
41 */
42drm_dma_handle_t *drm_pci_alloc(struct drm_device * dev, size_t size, size_t align)
43{
44 drm_dma_handle_t *dmah;
45 unsigned long addr;
46 size_t sz;
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
55 dmah = kmalloc(sizeof(drm_dma_handle_t), GFP_KERNEL);
56 if (!dmah)
57 return NULL;
58
59 dmah->size = size;
60 dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size, &dmah->busaddr, GFP_KERNEL | __GFP_COMP);
61
62 if (dmah->vaddr == NULL) {
63 kfree(dmah);
64 return NULL;
65 }
66
67 memset(dmah->vaddr, 0, size);
68
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) {
73 SetPageReserved(virt_to_page((void *)addr));
74 }
75
76 return dmah;
77}
78
79EXPORT_SYMBOL(drm_pci_alloc);
80
81/*
82 * Free a PCI consistent memory block without freeing its descriptor.
83 *
84 * This function is for internal use in the Linux-specific DRM core code.
85 */
86void __drm_legacy_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
87{
88 unsigned long addr;
89 size_t sz;
90
91 if (dmah->vaddr) {
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) {
96 ClearPageReserved(virt_to_page((void *)addr));
97 }
98 dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr,
99 dmah->busaddr);
100 }
101}
102
103/**
104 * drm_pci_free - Free a PCI consistent memory block
105 * @dev: DRM device
106 * @dmah: handle to memory block
107 */
108void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
109{
110 __drm_legacy_pci_free(dev, dmah);
111 kfree(dmah);
112}
113
114EXPORT_SYMBOL(drm_pci_free);
115
116#ifdef CONFIG_PCI
117
118static 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
132int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master)
133{
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)
140 return -ENOMEM;
141
142 master->unique_len = strlen(master->unique);
143 return 0;
144}
145EXPORT_SYMBOL(drm_pci_set_busid);
146
147static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p)
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
161/**
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.
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.
170 *
171 * Return: 0 on success or a negative error code on failure.
172 */
173int 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
178 if (!drm_core_check_feature(dev, DRIVER_LEGACY))
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
191static void drm_pci_agp_init(struct drm_device *dev)
192{
193 if (drm_core_check_feature(dev, DRIVER_USE_AGP)) {
194 if (drm_pci_device_is_agp(dev))
195 dev->agp = drm_agp_init(dev);
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);
201 }
202 }
203}
204
205void drm_pci_agp_destroy(struct drm_device *dev)
206{
207 if (dev->agp) {
208 arch_phys_wc_del(dev->agp->agp_mtrr);
209 drm_legacy_agp_clear(dev);
210 kfree(dev->agp);
211 dev->agp = NULL;
212 }
213}
214
215/**
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
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.
224 *
225 * NOTE: This function is deprecated, please use drm_dev_alloc() and
226 * drm_dev_register() instead and remove your ->load() callback.
227 *
228 * Return: 0 on success or a negative error code on failure.
229 */
230int 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
238 dev = drm_dev_alloc(driver, &pdev->dev);
239 if (IS_ERR(dev))
240 return PTR_ERR(dev);
241
242 ret = pci_enable_device(pdev);
243 if (ret)
244 goto err_free;
245
246 dev->pdev = pdev;
247#ifdef __alpha__
248 dev->hose = pdev->sysdata;
249#endif
250
251 if (drm_core_check_feature(dev, DRIVER_MODESET))
252 pci_set_drvdata(pdev, dev);
253
254 drm_pci_agp_init(dev);
255
256 ret = drm_dev_register(dev, ent->driver_data);
257 if (ret)
258 goto err_agp;
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
264 /* No locking needed since shadow-attach is single-threaded since it may
265 * only be called from the per-driver module init hook. */
266 if (drm_core_check_feature(dev, DRIVER_LEGACY))
267 list_add_tail(&dev->legacy_dev_list, &driver->legacy_dev_list);
268
269 return 0;
270
271err_agp:
272 drm_pci_agp_destroy(dev);
273 pci_disable_device(pdev);
274err_free:
275 drm_dev_unref(dev);
276 return ret;
277}
278EXPORT_SYMBOL(drm_get_pci_dev);
279
280/**
281 * drm_pci_init - Register matching PCI devices with the DRM subsystem
282 * @driver: DRM device driver
283 * @pdriver: PCI device driver
284 *
285 * Initializes a drm_device structures, registering the stubs and initializing
286 * the AGP device.
287 *
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 *
292 * Return: 0 on success or a negative error code on failure.
293 */
294int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
295{
296 struct pci_dev *pdev = NULL;
297 const struct pci_device_id *pid;
298 int i;
299
300 DRM_DEBUG("\n");
301
302 if (!(driver->driver_features & DRIVER_LEGACY))
303 return pci_register_driver(pdriver);
304
305 /* If not using KMS, fall back to stealth mode manual scanning. */
306 INIT_LIST_HEAD(&driver->legacy_dev_list);
307 for (i = 0; pdriver->id_table[i].vendor != 0; i++) {
308 pid = &pdriver->id_table[i];
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
331int drm_pcie_get_speed_cap_mask(struct drm_device *dev, u32 *mask)
332{
333 struct pci_dev *root;
334 u32 lnkcap, lnkcap2;
335
336 *mask = 0;
337 if (!dev->pdev)
338 return -EINVAL;
339
340 root = dev->pdev->bus->self;
341
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
347 pcie_capability_read_dword(root, PCI_EXP_LNKCAP, &lnkcap);
348 pcie_capability_read_dword(root, PCI_EXP_LNKCAP2, &lnkcap2);
349
350 if (lnkcap2) { /* PCIe r3.0-compliant */
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;
357 } else { /* pre-r3.0 */
358 if (lnkcap & PCI_EXP_LNKCAP_SLS_2_5GB)
359 *mask |= DRM_PCIE_SPEED_25;
360 if (lnkcap & PCI_EXP_LNKCAP_SLS_5_0GB)
361 *mask |= (DRM_PCIE_SPEED_25 | DRM_PCIE_SPEED_50);
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}
367EXPORT_SYMBOL(drm_pcie_get_speed_cap_mask);
368
369int 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}
387EXPORT_SYMBOL(drm_pcie_get_max_link_width);
388
389#else
390
391int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
392{
393 return -1;
394}
395
396void drm_pci_agp_destroy(struct drm_device *dev) {}
397
398int drm_irq_by_busid(struct drm_device *dev, void *data,
399 struct drm_file *file_priv)
400{
401 return -EINVAL;
402}
403#endif
404
405EXPORT_SYMBOL(drm_pci_init);
406
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.
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.
418 */
419void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver)
420{
421 struct drm_device *dev, *tmp;
422 DRM_DEBUG("\n");
423
424 if (!(driver->driver_features & DRIVER_LEGACY)) {
425 pci_unregister_driver(pdriver);
426 } else {
427 list_for_each_entry_safe(dev, tmp, &driver->legacy_dev_list,
428 legacy_dev_list) {
429 list_del(&dev->legacy_dev_list);
430 drm_put_dev(dev);
431 }
432 }
433 DRM_INFO("Module unloaded\n");
434}
435EXPORT_SYMBOL(drm_pci_exit);