drivers/gpu/drm/drm_pci.c

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