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