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 */
drm_pci_alloc(struct drm_device * dev,size_t size,size_t align)51 drm_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
90 EXPORT_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 */
__drm_pci_free(struct drm_device * dev,drm_dma_handle_t * dmah)97 void __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 */
drm_pci_free(struct drm_device * dev,drm_dma_handle_t * dmah)119 void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
120 {
121 __drm_pci_free(dev, dmah);
122 kfree(dmah);
123 }
124
125 EXPORT_SYMBOL(drm_pci_free);
126
127 #ifdef CONFIG_PCI
128
drm_get_pci_domain(struct drm_device * dev)129 static 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
drm_pci_get_irq(struct drm_device * dev)143 static int drm_pci_get_irq(struct drm_device *dev)
144 {
145 return dev->pdev->irq;
146 }
147
drm_pci_get_name(struct drm_device * dev)148 static 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
drm_pci_set_busid(struct drm_device * dev,struct drm_master * master)154 int 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;
192 err:
193 return ret;
194 }
195
drm_pci_set_unique(struct drm_device * dev,struct drm_master * master,struct drm_unique * u)196 int 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;
249 err:
250 return ret;
251 }
252
253
drm_pci_irq_by_busid(struct drm_device * dev,struct drm_irq_busid * p)254 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
drm_pci_agp_init(struct drm_device * dev)268 int 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
289 static 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 .agp_init = drm_pci_agp_init,
296 };
297
298 /**
299 * Register.
300 *
301 * \param pdev - PCI device structure
302 * \param ent entry from the PCI ID table with device type flags
303 * \return zero on success or a negative number on failure.
304 *
305 * Attempt to gets inter module "drm" information. If we are first
306 * then register the character device and inter module information.
307 * Try and register, if we fail to register, backout previous work.
308 */
drm_get_pci_dev(struct pci_dev * pdev,const struct pci_device_id * ent,struct drm_driver * driver)309 int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent,
310 struct drm_driver *driver)
311 {
312 struct drm_device *dev;
313 int ret;
314
315 DRM_DEBUG("\n");
316
317 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
318 if (!dev)
319 return -ENOMEM;
320
321 ret = pci_enable_device(pdev);
322 if (ret)
323 goto err_g1;
324
325 pci_set_master(pdev);
326
327 dev->pdev = pdev;
328 dev->dev = &pdev->dev;
329
330 dev->pci_device = pdev->device;
331 dev->pci_vendor = pdev->vendor;
332
333 #ifdef __alpha__
334 dev->hose = pdev->sysdata;
335 #endif
336
337 mutex_lock(&drm_global_mutex);
338
339 if ((ret = drm_fill_in_dev(dev, ent, driver))) {
340 printk(KERN_ERR "DRM: Fill_in_dev failed.\n");
341 goto err_g2;
342 }
343
344 if (drm_core_check_feature(dev, DRIVER_MODESET)) {
345 pci_set_drvdata(pdev, dev);
346 ret = drm_get_minor(dev, &dev->control, DRM_MINOR_CONTROL);
347 if (ret)
348 goto err_g2;
349 }
350
351 if ((ret = drm_get_minor(dev, &dev->primary, DRM_MINOR_LEGACY)))
352 goto err_g3;
353
354 if (dev->driver->load) {
355 ret = dev->driver->load(dev, ent->driver_data);
356 if (ret)
357 goto err_g4;
358 }
359
360 /* setup the grouping for the legacy output */
361 if (drm_core_check_feature(dev, DRIVER_MODESET)) {
362 ret = drm_mode_group_init_legacy_group(dev,
363 &dev->primary->mode_group);
364 if (ret)
365 goto err_g4;
366 }
367
368 list_add_tail(&dev->driver_item, &driver->device_list);
369
370 DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d\n",
371 driver->name, driver->major, driver->minor, driver->patchlevel,
372 driver->date, pci_name(pdev), dev->primary->index);
373
374 mutex_unlock(&drm_global_mutex);
375 return 0;
376
377 err_g4:
378 drm_put_minor(&dev->primary);
379 err_g3:
380 if (drm_core_check_feature(dev, DRIVER_MODESET))
381 drm_put_minor(&dev->control);
382 err_g2:
383 pci_disable_device(pdev);
384 err_g1:
385 kfree(dev);
386 mutex_unlock(&drm_global_mutex);
387 return ret;
388 }
389 EXPORT_SYMBOL(drm_get_pci_dev);
390
391 /**
392 * PCI device initialization. Called direct from modules at load time.
393 *
394 * \return zero on success or a negative number on failure.
395 *
396 * Initializes a drm_device structures,registering the
397 * stubs and initializing the AGP device.
398 *
399 * Expands the \c DRIVER_PREINIT and \c DRIVER_POST_INIT macros before and
400 * after the initialization for driver customization.
401 */
drm_pci_init(struct drm_driver * driver,struct pci_driver * pdriver)402 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
403 {
404 struct pci_dev *pdev = NULL;
405 const struct pci_device_id *pid;
406 int i;
407
408 DRM_DEBUG("\n");
409
410 INIT_LIST_HEAD(&driver->device_list);
411 driver->kdriver.pci = pdriver;
412 driver->bus = &drm_pci_bus;
413
414 if (driver->driver_features & DRIVER_MODESET)
415 return pci_register_driver(pdriver);
416
417 /* If not using KMS, fall back to stealth mode manual scanning. */
418 for (i = 0; pdriver->id_table[i].vendor != 0; i++) {
419 pid = &pdriver->id_table[i];
420
421 /* Loop around setting up a DRM device for each PCI device
422 * matching our ID and device class. If we had the internal
423 * function that pci_get_subsys and pci_get_class used, we'd
424 * be able to just pass pid in instead of doing a two-stage
425 * thing.
426 */
427 pdev = NULL;
428 while ((pdev =
429 pci_get_subsys(pid->vendor, pid->device, pid->subvendor,
430 pid->subdevice, pdev)) != NULL) {
431 if ((pdev->class & pid->class_mask) != pid->class)
432 continue;
433
434 /* stealth mode requires a manual probe */
435 pci_dev_get(pdev);
436 drm_get_pci_dev(pdev, pid, driver);
437 }
438 }
439 return 0;
440 }
441
442 #else
443
drm_pci_init(struct drm_driver * driver,struct pci_driver * pdriver)444 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
445 {
446 return -1;
447 }
448
449 #endif
450
451 EXPORT_SYMBOL(drm_pci_init);
452
453 /*@}*/
drm_pci_exit(struct drm_driver * driver,struct pci_driver * pdriver)454 void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver)
455 {
456 struct drm_device *dev, *tmp;
457 DRM_DEBUG("\n");
458
459 if (driver->driver_features & DRIVER_MODESET) {
460 pci_unregister_driver(pdriver);
461 } else {
462 list_for_each_entry_safe(dev, tmp, &driver->device_list, driver_item)
463 drm_put_dev(dev);
464 }
465 DRM_INFO("Module unloaded\n");
466 }
467 EXPORT_SYMBOL(drm_pci_exit);
468