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/dma-mapping.h>
  27 #include <linux/export.h>
  28 #include <drm/drmP.h>
  29 #include "drm_internal.h"
  30 #include "drm_legacy.h"
  31
  32 /**
  33  * drm_pci_alloc - Allocate a PCI consistent memory block, for DMA.
  34  * @dev: DRM device
  35  * @size: size of block to allocate
  36  * @align: alignment of block
  37  *
  38  * Return: A handle to the allocated memory block on success or NULL on
  39  * failure.
  40  */
  41 drm_dma_handle_t *drm_pci_alloc(struct drm_device * dev, size_t size, size_t align)
  42 {
  43         drm_dma_handle_t *dmah;
  44         unsigned long addr;
  45         size_t sz;
  46
  47         /* pci_alloc_consistent only guarantees alignment to the smallest
  48          * PAGE_SIZE order which is greater than or equal to the requested size.
  49          * Return NULL here for now to make sure nobody tries for larger alignment
  50          */
  51         if (align > size)
  52                 return NULL;
  53
  54         dmah = kmalloc(sizeof(drm_dma_handle_t), M_DRM, M_WAITOK | M_NULLOK);
  55         if (!dmah)
  56                 return NULL;
  57
  58         dmah->size = size;
  59         dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size, &dmah->busaddr, GFP_KERNEL);
  60
  61         if (dmah->vaddr == NULL) {
  62                 kfree(dmah);
  63                 return NULL;
  64         }
  65
  66         memset(dmah->vaddr, 0, size);
  67
  68         /* XXX - Is virt_to_page() legal for consistent mem? */
  69         /* Reserve */
  70         for (addr = (unsigned long)dmah->vaddr, sz = size;
  71              sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) {
  72 #if 0
  73                 SetPageReserved(virt_to_page((void *)addr));
  74 #endif
  75         }
  76
  77         return dmah;
  78 }
  79
  80 EXPORT_SYMBOL(drm_pci_alloc);
  81
  82 /*
  83  * Free a PCI consistent memory block without freeing its descriptor.
  84  *
  85  * This function is for internal use in the Linux-specific DRM core code.
  86  */
  87 void __drm_legacy_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
  88 {
  89         unsigned long addr;
  90         size_t sz;
  91
  92         if (dmah->vaddr) {
  93                 /* XXX - Is virt_to_page() legal for consistent mem? */
  94                 /* Unreserve */
  95                 for (addr = (unsigned long)dmah->vaddr, sz = dmah->size;
  96                      sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) {
  97 #if 0
  98                         ClearPageReserved(virt_to_page((void *)addr));
  99 #endif
 100                 }
 101                 dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr,
 102                                   dmah->busaddr);
 103         }
 104 }
 105
 106 /**
 107  * drm_pci_free - Free a PCI consistent memory block
 108  * @dev: DRM device
 109  * @dmah: handle to memory block
 110  */
 111 void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
 112 {
 113         __drm_legacy_pci_free(dev, dmah);
 114         kfree(dmah);
 115 }
 116
 117 EXPORT_SYMBOL(drm_pci_free);
 118
 119 #ifdef CONFIG_PCI
 120
 121 static int drm_get_pci_domain(struct drm_device *dev)
 122 {
 123 #ifndef __alpha__
 124         /* For historical reasons, drm_get_pci_domain() is busticated
 125          * on most archs and has to remain so for userspace interface
 126          * < 1.4, except on alpha which was right from the beginning
 127          */
 128         if (dev->if_version < 0x10004)
 129                 return 0;
 130 #endif /* __alpha__ */
 131
 132 #if 0
 133         return pci_domain_nr(dev->pdev->bus);
 134 #else
 135         return dev->pci_domain;
 136 #endif
 137 }
 138
 139 int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master)
 140 {
 141         master->unique = kasprintf(GFP_KERNEL, "pci:%04x:%02x:%02x.%d",
 142                                         drm_get_pci_domain(dev),
 143                                         dev->pdev->bus->number,
 144                                         PCI_SLOT(dev->pdev->devfn),
 145                                         PCI_FUNC(dev->pdev->devfn));
 146         if (!master->unique)
 147                 return -ENOMEM;
 148
 149         master->unique_len = strlen(master->unique);
 150         return 0;
 151 }
 152 EXPORT_SYMBOL(drm_pci_set_busid);
 153
 154 int drm_pci_set_unique(struct drm_device *dev,
 155                        struct drm_master *master,
 156                        struct drm_unique *u)
 157 {
 158         int domain, bus, slot, func, ret;
 159
 160         master->unique_len = u->unique_len;
 161         master->unique = kmalloc(master->unique_len + 1, M_DRM, M_NOWAIT);
 162         if (!master->unique) {
 163                 ret = -ENOMEM;
 164                 goto err;
 165         }
 166
 167         if (copy_from_user(master->unique, u->unique, master->unique_len)) {
 168                 ret = -EFAULT;
 169                 goto err;
 170         }
 171
 172         master->unique[master->unique_len] = '\0';
 173
 174         /* Return error if the busid submitted doesn't match the device's actual
 175          * busid.
 176          */
 177         ret = ksscanf(master->unique, "PCI:%d:%d:%d", &bus, &slot, &func);
 178         if (ret != 3) {
 179                 ret = -EINVAL;
 180                 goto err;
 181         }
 182
 183         domain = bus >> 8;
 184         bus &= 0xff;
 185
 186         if ((domain != drm_get_pci_domain(dev)) ||
 187             (bus != dev->pdev->bus->number) ||
 188             (slot != PCI_SLOT(dev->pdev->devfn)) ||
 189             (func != PCI_FUNC(dev->pdev->devfn))) {
 190                 ret = -EINVAL;
 191                 goto err;
 192         }
 193         return 0;
 194 err:
 195         return ret;
 196 }
 197
 198 static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p)
 199 {
 200         if ((p->busnum >> 8) != dev->pci_domain ||
 201             (p->busnum & 0xff) != dev->pci_bus ||
 202             p->devnum != dev->pci_slot || p->funcnum != dev->pci_func)
 203                 return -EINVAL;
 204
 205         p->irq = dev->pdev->irq;
 206
 207         DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum,
 208                   p->irq);
 209         return 0;
 210 }
 211
 212 #ifdef __DragonFly__
 213 int
 214 drm_getpciinfo(struct drm_device *dev, void *data, struct drm_file *file_priv)
 215 {
 216         struct drm_pciinfo *info = data;
 217
 218         info->domain = 0;
 219         info->bus = dev->pci_bus;
 220         info->dev = PCI_SLOT(dev->pdev->devfn);
 221         info->func = PCI_FUNC(dev->pdev->devfn);
 222         info->vendor_id = dev->pdev->vendor;
 223         info->device_id = dev->pdev->device;
 224         info->subvendor_id = dev->pdev->subsystem_vendor;
 225         info->subdevice_id = dev->pdev->subsystem_device;
 226         info->revision_id = 0;
 227
 228         return 0;
 229 }
 230 #endif
 231
 232 /**
 233  * drm_irq_by_busid - Get interrupt from bus ID
 234  * @dev: DRM device
 235  * @data: IOCTL parameter pointing to a drm_irq_busid structure
 236  * @file_priv: DRM file private.
 237  *
 238  * Finds the PCI device with the specified bus id and gets its IRQ number.
 239  * This IOCTL is deprecated, and will now return EINVAL for any busid not equal
 240  * to that of the device that this DRM instance attached to.
 241  *
 242  * Return: 0 on success or a negative error code on failure.
 243  */
 244 int drm_irq_by_busid(struct drm_device *dev, void *data,
 245                      struct drm_file *file_priv)
 246 {
 247         struct drm_irq_busid *p = data;
 248
 249         if (drm_core_check_feature(dev, DRIVER_MODESET))
 250                 return -EINVAL;
 251
 252         /* UMS was only ever support on PCI devices. */
 253         if (WARN_ON(!dev->pdev))
 254                 return -EINVAL;
 255
 256         if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
 257                 return -EINVAL;
 258
 259         return drm_pci_irq_by_busid(dev, p);
 260 }
 261
 262 /**
 263  * drm_get_pci_dev - Register a PCI device with the DRM subsystem
 264  * @pdev: PCI device
 265  * @ent: entry from the PCI ID table that matches @pdev
 266  * @driver: DRM device driver
 267  *
 268  * Attempt to gets inter module "drm" information. If we are first
 269  * then register the character device and inter module information.
 270  * Try and register, if we fail to register, backout previous work.
 271  *
 272  * NOTE: This function is deprecated, please use drm_dev_alloc() and
 273  * drm_dev_register() instead and remove your ->load() callback.
 274  *
 275  * Return: 0 on success or a negative error code on failure.
 276  */
 277 int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent,
 278                     struct drm_driver *driver)
 279 {
 280         struct drm_device *dev;
 281         int ret;
 282
 283         DRM_DEBUG("\n");
 284
 285         dev = drm_dev_alloc(driver, &pdev->dev);
 286         if (!dev)
 287                 return -ENOMEM;
 288
 289 #if 0
 290         ret = pci_enable_device(pdev);
 291         if (ret)
 292                 goto err_free;
 293 #endif
 294
 295         dev->pdev = pdev;
 296 #ifdef __alpha__
 297         dev->hose = pdev->sysdata;
 298 #endif
 299
 300         if (drm_core_check_feature(dev, DRIVER_MODESET))
 301                 pci_set_drvdata(pdev, dev);
 302
 303 #if 0
 304         drm_pci_agp_init(dev);
 305 #endif
 306
 307         ret = drm_dev_register(dev, ent->driver_data);
 308         if (ret)
 309                 goto err_agp;
 310
 311         DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d\n",
 312                  driver->name, driver->major, driver->minor, driver->patchlevel,
 313                  driver->date, pci_name(pdev), dev->primary->index);
 314
 315         /* No locking needed since shadow-attach is single-threaded since it may
 316          * only be called from the per-driver module init hook. */
 317         if (!drm_core_check_feature(dev, DRIVER_MODESET))
 318                 list_add_tail(&dev->legacy_dev_list, &driver->legacy_dev_list);
 319
 320         return 0;
 321
 322 err_agp:
 323 #if 0
 324         drm_pci_agp_destroy(dev);
 325         pci_disable_device(pdev);
 326 err_free:
 327         drm_dev_unref(dev);
 328 #endif
 329         return ret;
 330 }
 331 EXPORT_SYMBOL(drm_get_pci_dev);
 332
 333 /**
 334  * drm_pci_init - Register matching PCI devices with the DRM subsystem
 335  * @driver: DRM device driver
 336  * @pdriver: PCI device driver
 337  *
 338  * Initializes a drm_device structures, registering the stubs and initializing
 339  * the AGP device.
 340  *
 341  * NOTE: This function is deprecated. Modern modesetting drm drivers should use
 342  * pci_register_driver() directly, this function only provides shadow-binding
 343  * support for old legacy drivers on top of that core pci function.
 344  *
 345  * Return: 0 on success or a negative error code on failure.
 346  */
 347 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
 348 {
 349 #if 0
 350         struct pci_dev *pdev = NULL;
 351         const struct pci_device_id *pid;
 352         int i;
 353 #endif
 354
 355         DRM_DEBUG("\n");
 356
 357         if (driver->driver_features & DRIVER_MODESET)
 358                 return pci_register_driver(pdriver);
 359
 360 #if 0
 361         /* If not using KMS, fall back to stealth mode manual scanning. */
 362         INIT_LIST_HEAD(&driver->legacy_dev_list);
 363         for (i = 0; pdriver->id_table[i].vendor != 0; i++) {
 364                 pid = &pdriver->id_table[i];
 365
 366                 /* Loop around setting up a DRM device for each PCI device
 367                  * matching our ID and device class.  If we had the internal
 368                  * function that pci_get_subsys and pci_get_class used, we'd
 369                  * be able to just pass pid in instead of doing a two-stage
 370                  * thing.
 371                  */
 372                 pdev = NULL;
 373                 while ((pdev =
 374                         pci_get_subsys(pid->vendor, pid->device, pid->subvendor,
 375                                        pid->subdevice, pdev)) != NULL) {
 376                         if ((pdev->class & pid->class_mask) != pid->class)
 377                                 continue;
 378
 379                         /* stealth mode requires a manual probe */
 380                         pci_dev_get(pdev);
 381                         drm_get_pci_dev(pdev, pid, driver);
 382                 }
 383         }
 384 #endif
 385         return 0;
 386 }
 387
 388 int drm_pcie_get_speed_cap_mask(struct drm_device *dev, u32 *mask)
 389 {
 390         device_t root;
 391         int pos;
 392         u32 lnkcap = 0, lnkcap2 = 0;
 393
 394         *mask = 0;
 395         if (!dev->pdev)
 396                 return -EINVAL;
 397
 398         root = device_get_parent(dev->dev->bsddev);
 399
 400         /* we've been informed via and serverworks don't make the cut */
 401         if (pci_get_vendor(root) == PCI_VENDOR_ID_VIA ||
 402             pci_get_vendor(root) == PCI_VENDOR_ID_SERVERWORKS)
 403                 return -EINVAL;
 404
 405         pos = 0;
 406         pci_find_extcap(root, PCIY_EXPRESS, &pos);
 407         if (!pos)
 408                 return -EINVAL;
 409
 410         lnkcap = pci_read_config(root, pos + PCIER_LINKCAP, 4);
 411         lnkcap2 = pci_read_config(root, pos + PCIER_LINK_CAP2, 4);
 412
 413         lnkcap &= PCIEM_LNKCAP_SPEED_MASK;
 414         lnkcap2 &= 0xfe;
 415
 416 #define PCI_EXP_LNKCAP_SLS_2_5GB        PCIEM_LNKCAP_SPEED_2_5
 417 #define PCI_EXP_LNKCAP_SLS_5_0GB        PCIEM_LNKCAP_SPEED_5
 418 #define PCI_EXP_LNKCAP2_SLS_2_5GB 0x02  /* Supported Link Speed 2.5GT/s */
 419 #define PCI_EXP_LNKCAP2_SLS_5_0GB 0x04  /* Supported Link Speed 5.0GT/s */
 420 #define PCI_EXP_LNKCAP2_SLS_8_0GB 0x08  /* Supported Link Speed 8.0GT/s */
 421
 422         if (lnkcap2) {  /* PCIe r3.0-compliant */
 423                 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_2_5GB)
 424                         *mask |= DRM_PCIE_SPEED_25;
 425                 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_5_0GB)
 426                         *mask |= DRM_PCIE_SPEED_50;
 427                 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_8_0GB)
 428                         *mask |= DRM_PCIE_SPEED_80;
 429         } else {        /* pre-r3.0 */
 430                 if (lnkcap & PCI_EXP_LNKCAP_SLS_2_5GB)
 431                         *mask |= DRM_PCIE_SPEED_25;
 432                 if (lnkcap & PCI_EXP_LNKCAP_SLS_5_0GB)
 433                         *mask |= (DRM_PCIE_SPEED_25 | DRM_PCIE_SPEED_50);
 434         }
 435
 436         DRM_INFO("probing gen 2 caps for device %x:%x = %x/%x\n", pci_get_vendor(root), pci_get_device(root), lnkcap, lnkcap2);
 437         return 0;
 438 }
 439 EXPORT_SYMBOL(drm_pcie_get_speed_cap_mask);
 440
 441 #if 0
 442 int drm_pcie_get_max_link_width(struct drm_device *dev, u32 *mlw)
 443 {
 444         struct pci_dev *root;
 445         u32 lnkcap;
 446
 447         *mlw = 0;
 448         if (!dev->pdev)
 449                 return -EINVAL;
 450
 451         root = dev->pdev->bus->self;
 452
 453         pcie_capability_read_dword(root, PCI_EXP_LNKCAP, &lnkcap);
 454
 455         *mlw = (lnkcap & PCI_EXP_LNKCAP_MLW) >> 4;
 456
 457         DRM_INFO("probing mlw for device %x:%x = %x\n", root->vendor, root->device, lnkcap);
 458         return 0;
 459 }
 460 EXPORT_SYMBOL(drm_pcie_get_max_link_width);
 461 #endif
 462
 463 #else
 464
 465
 466 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
 467 {
 468         return -1;
 469 }
 470
 471 void drm_pci_agp_destroy(struct drm_device *dev) {}
 472
 473 int drm_irq_by_busid(struct drm_device *dev, void *data,
 474                      struct drm_file *file_priv)
 475 {
 476         return -EINVAL;
 477 }
 478
 479 int drm_pci_set_unique(struct drm_device *dev,
 480                        struct drm_master *master,
 481                        struct drm_unique *u)
 482 {
 483         return -EINVAL;
 484 }
 485 #endif
 486
 487 EXPORT_SYMBOL(drm_pci_init);