Merge git://git.kernel.org/pub/scm/linux/kernel/git/ebiederm/linux-2.6-nsfd
[pandora-kernel.git] / drivers / gpu / drm / drm_pci.c
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  */
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  */
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  */
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
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
143 static int drm_pci_get_irq(struct drm_device *dev)
144 {
145         return dev->pdev->irq;
146 }
147
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
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
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
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
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  */
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  */
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
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 /*@}*/
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);