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