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 static 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         .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  */
 310 int 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
 378 err_g4:
 379         drm_put_minor(&dev->primary);
 380 err_g3:
 381         if (drm_core_check_feature(dev, DRIVER_MODESET))
 382                 drm_put_minor(&dev->control);
 383 err_g2:
 384         pci_disable_device(pdev);
 385 err_g1:
 386         kfree(dev);
 387         mutex_unlock(&drm_global_mutex);
 388         return ret;
 389 }
 390 EXPORT_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  */
 403 int 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
 445 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
 446 {
 447         return -1;
 448 }
 449
 450 #endif
 451
 452 EXPORT_SYMBOL(drm_pci_init);
 453
 454 /*@}*/
 455 void 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 }
 468 EXPORT_SYMBOL(drm_pci_exit);